Merge tag 'samsung-soc-5.10' of https://git.kernel.org/pub/scm/linux/kernel/git/krzk...
[linux-2.6-microblaze.git] / drivers / scsi / megaraid / megaraid_sas_base.c
1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3  *  Linux MegaRAID driver for SAS based RAID controllers
4  *
5  *  Copyright (c) 2003-2013  LSI Corporation
6  *  Copyright (c) 2013-2016  Avago Technologies
7  *  Copyright (c) 2016-2018  Broadcom Inc.
8  *
9  *  Authors: Broadcom Inc.
10  *           Sreenivas Bagalkote
11  *           Sumant Patro
12  *           Bo Yang
13  *           Adam Radford
14  *           Kashyap Desai <kashyap.desai@broadcom.com>
15  *           Sumit Saxena <sumit.saxena@broadcom.com>
16  *
17  *  Send feedback to: megaraidlinux.pdl@broadcom.com
18  */
19
20 #include <linux/kernel.h>
21 #include <linux/types.h>
22 #include <linux/pci.h>
23 #include <linux/list.h>
24 #include <linux/moduleparam.h>
25 #include <linux/module.h>
26 #include <linux/spinlock.h>
27 #include <linux/interrupt.h>
28 #include <linux/delay.h>
29 #include <linux/uio.h>
30 #include <linux/slab.h>
31 #include <linux/uaccess.h>
32 #include <asm/unaligned.h>
33 #include <linux/fs.h>
34 #include <linux/compat.h>
35 #include <linux/blkdev.h>
36 #include <linux/mutex.h>
37 #include <linux/poll.h>
38 #include <linux/vmalloc.h>
39 #include <linux/irq_poll.h>
40
41 #include <scsi/scsi.h>
42 #include <scsi/scsi_cmnd.h>
43 #include <scsi/scsi_device.h>
44 #include <scsi/scsi_host.h>
45 #include <scsi/scsi_tcq.h>
46 #include <scsi/scsi_dbg.h>
47 #include "megaraid_sas_fusion.h"
48 #include "megaraid_sas.h"
49
50 /*
51  * Number of sectors per IO command
52  * Will be set in megasas_init_mfi if user does not provide
53  */
54 static unsigned int max_sectors;
55 module_param_named(max_sectors, max_sectors, int, 0444);
56 MODULE_PARM_DESC(max_sectors,
57         "Maximum number of sectors per IO command");
58
59 static int msix_disable;
60 module_param(msix_disable, int, 0444);
61 MODULE_PARM_DESC(msix_disable, "Disable MSI-X interrupt handling. Default: 0");
62
63 static unsigned int msix_vectors;
64 module_param(msix_vectors, int, 0444);
65 MODULE_PARM_DESC(msix_vectors, "MSI-X max vector count. Default: Set by FW");
66
67 static int allow_vf_ioctls;
68 module_param(allow_vf_ioctls, int, 0444);
69 MODULE_PARM_DESC(allow_vf_ioctls, "Allow ioctls in SR-IOV VF mode. Default: 0");
70
71 static unsigned int throttlequeuedepth = MEGASAS_THROTTLE_QUEUE_DEPTH;
72 module_param(throttlequeuedepth, int, 0444);
73 MODULE_PARM_DESC(throttlequeuedepth,
74         "Adapter queue depth when throttled due to I/O timeout. Default: 16");
75
76 unsigned int resetwaittime = MEGASAS_RESET_WAIT_TIME;
77 module_param(resetwaittime, int, 0444);
78 MODULE_PARM_DESC(resetwaittime, "Wait time in (1-180s) after I/O timeout before resetting adapter. Default: 180s");
79
80 int smp_affinity_enable = 1;
81 module_param(smp_affinity_enable, int, 0444);
82 MODULE_PARM_DESC(smp_affinity_enable, "SMP affinity feature enable/disable Default: enable(1)");
83
84 static int rdpq_enable = 1;
85 module_param(rdpq_enable, int, 0444);
86 MODULE_PARM_DESC(rdpq_enable, "Allocate reply queue in chunks for large queue depth enable/disable Default: enable(1)");
87
88 unsigned int dual_qdepth_disable;
89 module_param(dual_qdepth_disable, int, 0444);
90 MODULE_PARM_DESC(dual_qdepth_disable, "Disable dual queue depth feature. Default: 0");
91
92 static unsigned int scmd_timeout = MEGASAS_DEFAULT_CMD_TIMEOUT;
93 module_param(scmd_timeout, int, 0444);
94 MODULE_PARM_DESC(scmd_timeout, "scsi command timeout (10-90s), default 90s. See megasas_reset_timer.");
95
96 int perf_mode = -1;
97 module_param(perf_mode, int, 0444);
98 MODULE_PARM_DESC(perf_mode, "Performance mode (only for Aero adapters), options:\n\t\t"
99                 "0 - balanced: High iops and low latency queues are allocated &\n\t\t"
100                 "interrupt coalescing is enabled only on high iops queues\n\t\t"
101                 "1 - iops: High iops queues are not allocated &\n\t\t"
102                 "interrupt coalescing is enabled on all queues\n\t\t"
103                 "2 - latency: High iops queues are not allocated &\n\t\t"
104                 "interrupt coalescing is disabled on all queues\n\t\t"
105                 "default mode is 'balanced'"
106                 );
107
108 int event_log_level = MFI_EVT_CLASS_CRITICAL;
109 module_param(event_log_level, int, 0644);
110 MODULE_PARM_DESC(event_log_level, "Asynchronous event logging level- range is: -2(CLASS_DEBUG) to 4(CLASS_DEAD), Default: 2(CLASS_CRITICAL)");
111
112 unsigned int enable_sdev_max_qd;
113 module_param(enable_sdev_max_qd, int, 0444);
114 MODULE_PARM_DESC(enable_sdev_max_qd, "Enable sdev max qd as can_queue. Default: 0");
115
116 MODULE_LICENSE("GPL");
117 MODULE_VERSION(MEGASAS_VERSION);
118 MODULE_AUTHOR("megaraidlinux.pdl@broadcom.com");
119 MODULE_DESCRIPTION("Broadcom MegaRAID SAS Driver");
120
121 int megasas_transition_to_ready(struct megasas_instance *instance, int ocr);
122 static int megasas_get_pd_list(struct megasas_instance *instance);
123 static int megasas_ld_list_query(struct megasas_instance *instance,
124                                  u8 query_type);
125 static int megasas_issue_init_mfi(struct megasas_instance *instance);
126 static int megasas_register_aen(struct megasas_instance *instance,
127                                 u32 seq_num, u32 class_locale_word);
128 static void megasas_get_pd_info(struct megasas_instance *instance,
129                                 struct scsi_device *sdev);
130
131 /*
132  * PCI ID table for all supported controllers
133  */
134 static struct pci_device_id megasas_pci_table[] = {
135
136         {PCI_DEVICE(PCI_VENDOR_ID_LSI_LOGIC, PCI_DEVICE_ID_LSI_SAS1064R)},
137         /* xscale IOP */
138         {PCI_DEVICE(PCI_VENDOR_ID_LSI_LOGIC, PCI_DEVICE_ID_LSI_SAS1078R)},
139         /* ppc IOP */
140         {PCI_DEVICE(PCI_VENDOR_ID_LSI_LOGIC, PCI_DEVICE_ID_LSI_SAS1078DE)},
141         /* ppc IOP */
142         {PCI_DEVICE(PCI_VENDOR_ID_LSI_LOGIC, PCI_DEVICE_ID_LSI_SAS1078GEN2)},
143         /* gen2*/
144         {PCI_DEVICE(PCI_VENDOR_ID_LSI_LOGIC, PCI_DEVICE_ID_LSI_SAS0079GEN2)},
145         /* gen2*/
146         {PCI_DEVICE(PCI_VENDOR_ID_LSI_LOGIC, PCI_DEVICE_ID_LSI_SAS0073SKINNY)},
147         /* skinny*/
148         {PCI_DEVICE(PCI_VENDOR_ID_LSI_LOGIC, PCI_DEVICE_ID_LSI_SAS0071SKINNY)},
149         /* skinny*/
150         {PCI_DEVICE(PCI_VENDOR_ID_LSI_LOGIC, PCI_DEVICE_ID_LSI_VERDE_ZCR)},
151         /* xscale IOP, vega */
152         {PCI_DEVICE(PCI_VENDOR_ID_DELL, PCI_DEVICE_ID_DELL_PERC5)},
153         /* xscale IOP */
154         {PCI_DEVICE(PCI_VENDOR_ID_LSI_LOGIC, PCI_DEVICE_ID_LSI_FUSION)},
155         /* Fusion */
156         {PCI_DEVICE(PCI_VENDOR_ID_LSI_LOGIC, PCI_DEVICE_ID_LSI_PLASMA)},
157         /* Plasma */
158         {PCI_DEVICE(PCI_VENDOR_ID_LSI_LOGIC, PCI_DEVICE_ID_LSI_INVADER)},
159         /* Invader */
160         {PCI_DEVICE(PCI_VENDOR_ID_LSI_LOGIC, PCI_DEVICE_ID_LSI_FURY)},
161         /* Fury */
162         {PCI_DEVICE(PCI_VENDOR_ID_LSI_LOGIC, PCI_DEVICE_ID_LSI_INTRUDER)},
163         /* Intruder */
164         {PCI_DEVICE(PCI_VENDOR_ID_LSI_LOGIC, PCI_DEVICE_ID_LSI_INTRUDER_24)},
165         /* Intruder 24 port*/
166         {PCI_DEVICE(PCI_VENDOR_ID_LSI_LOGIC, PCI_DEVICE_ID_LSI_CUTLASS_52)},
167         {PCI_DEVICE(PCI_VENDOR_ID_LSI_LOGIC, PCI_DEVICE_ID_LSI_CUTLASS_53)},
168         /* VENTURA */
169         {PCI_DEVICE(PCI_VENDOR_ID_LSI_LOGIC, PCI_DEVICE_ID_LSI_VENTURA)},
170         {PCI_DEVICE(PCI_VENDOR_ID_LSI_LOGIC, PCI_DEVICE_ID_LSI_CRUSADER)},
171         {PCI_DEVICE(PCI_VENDOR_ID_LSI_LOGIC, PCI_DEVICE_ID_LSI_HARPOON)},
172         {PCI_DEVICE(PCI_VENDOR_ID_LSI_LOGIC, PCI_DEVICE_ID_LSI_TOMCAT)},
173         {PCI_DEVICE(PCI_VENDOR_ID_LSI_LOGIC, PCI_DEVICE_ID_LSI_VENTURA_4PORT)},
174         {PCI_DEVICE(PCI_VENDOR_ID_LSI_LOGIC, PCI_DEVICE_ID_LSI_CRUSADER_4PORT)},
175         {PCI_DEVICE(PCI_VENDOR_ID_LSI_LOGIC, PCI_DEVICE_ID_LSI_AERO_10E1)},
176         {PCI_DEVICE(PCI_VENDOR_ID_LSI_LOGIC, PCI_DEVICE_ID_LSI_AERO_10E2)},
177         {PCI_DEVICE(PCI_VENDOR_ID_LSI_LOGIC, PCI_DEVICE_ID_LSI_AERO_10E5)},
178         {PCI_DEVICE(PCI_VENDOR_ID_LSI_LOGIC, PCI_DEVICE_ID_LSI_AERO_10E6)},
179         {PCI_DEVICE(PCI_VENDOR_ID_LSI_LOGIC, PCI_DEVICE_ID_LSI_AERO_10E0)},
180         {PCI_DEVICE(PCI_VENDOR_ID_LSI_LOGIC, PCI_DEVICE_ID_LSI_AERO_10E3)},
181         {PCI_DEVICE(PCI_VENDOR_ID_LSI_LOGIC, PCI_DEVICE_ID_LSI_AERO_10E4)},
182         {PCI_DEVICE(PCI_VENDOR_ID_LSI_LOGIC, PCI_DEVICE_ID_LSI_AERO_10E7)},
183         {}
184 };
185
186 MODULE_DEVICE_TABLE(pci, megasas_pci_table);
187
188 static int megasas_mgmt_majorno;
189 struct megasas_mgmt_info megasas_mgmt_info;
190 static struct fasync_struct *megasas_async_queue;
191 static DEFINE_MUTEX(megasas_async_queue_mutex);
192
193 static int megasas_poll_wait_aen;
194 static DECLARE_WAIT_QUEUE_HEAD(megasas_poll_wait);
195 static u32 support_poll_for_event;
196 u32 megasas_dbg_lvl;
197 static u32 support_device_change;
198 static bool support_nvme_encapsulation;
199 static bool support_pci_lane_margining;
200
201 /* define lock for aen poll */
202 static spinlock_t poll_aen_lock;
203
204 extern struct dentry *megasas_debugfs_root;
205
206 void
207 megasas_complete_cmd(struct megasas_instance *instance, struct megasas_cmd *cmd,
208                      u8 alt_status);
209 static u32
210 megasas_read_fw_status_reg_gen2(struct megasas_instance *instance);
211 static int
212 megasas_adp_reset_gen2(struct megasas_instance *instance,
213                        struct megasas_register_set __iomem *reg_set);
214 static irqreturn_t megasas_isr(int irq, void *devp);
215 static u32
216 megasas_init_adapter_mfi(struct megasas_instance *instance);
217 u32
218 megasas_build_and_issue_cmd(struct megasas_instance *instance,
219                             struct scsi_cmnd *scmd);
220 static void megasas_complete_cmd_dpc(unsigned long instance_addr);
221 int
222 wait_and_poll(struct megasas_instance *instance, struct megasas_cmd *cmd,
223         int seconds);
224 void megasas_fusion_ocr_wq(struct work_struct *work);
225 static int megasas_get_ld_vf_affiliation(struct megasas_instance *instance,
226                                          int initial);
227 static int
228 megasas_set_dma_mask(struct megasas_instance *instance);
229 static int
230 megasas_alloc_ctrl_mem(struct megasas_instance *instance);
231 static inline void
232 megasas_free_ctrl_mem(struct megasas_instance *instance);
233 static inline int
234 megasas_alloc_ctrl_dma_buffers(struct megasas_instance *instance);
235 static inline void
236 megasas_free_ctrl_dma_buffers(struct megasas_instance *instance);
237 static inline void
238 megasas_init_ctrl_params(struct megasas_instance *instance);
239
240 u32 megasas_readl(struct megasas_instance *instance,
241                   const volatile void __iomem *addr)
242 {
243         u32 i = 0, ret_val;
244         /*
245          * Due to a HW errata in Aero controllers, reads to certain
246          * Fusion registers could intermittently return all zeroes.
247          * This behavior is transient in nature and subsequent reads will
248          * return valid value. As a workaround in driver, retry readl for
249          * upto three times until a non-zero value is read.
250          */
251         if (instance->adapter_type == AERO_SERIES) {
252                 do {
253                         ret_val = readl(addr);
254                         i++;
255                 } while (ret_val == 0 && i < 3);
256                 return ret_val;
257         } else {
258                 return readl(addr);
259         }
260 }
261
262 /**
263  * megasas_set_dma_settings -   Populate DMA address, length and flags for DCMDs
264  * @instance:                   Adapter soft state
265  * @dcmd:                       DCMD frame inside MFI command
266  * @dma_addr:                   DMA address of buffer to be passed to FW
267  * @dma_len:                    Length of DMA buffer to be passed to FW
268  * @return:                     void
269  */
270 void megasas_set_dma_settings(struct megasas_instance *instance,
271                               struct megasas_dcmd_frame *dcmd,
272                               dma_addr_t dma_addr, u32 dma_len)
273 {
274         if (instance->consistent_mask_64bit) {
275                 dcmd->sgl.sge64[0].phys_addr = cpu_to_le64(dma_addr);
276                 dcmd->sgl.sge64[0].length = cpu_to_le32(dma_len);
277                 dcmd->flags = cpu_to_le16(dcmd->flags | MFI_FRAME_SGL64);
278
279         } else {
280                 dcmd->sgl.sge32[0].phys_addr =
281                                 cpu_to_le32(lower_32_bits(dma_addr));
282                 dcmd->sgl.sge32[0].length = cpu_to_le32(dma_len);
283                 dcmd->flags = cpu_to_le16(dcmd->flags);
284         }
285 }
286
287 static void
288 megasas_issue_dcmd(struct megasas_instance *instance, struct megasas_cmd *cmd)
289 {
290         instance->instancet->fire_cmd(instance,
291                 cmd->frame_phys_addr, 0, instance->reg_set);
292         return;
293 }
294
295 /**
296  * megasas_get_cmd -    Get a command from the free pool
297  * @instance:           Adapter soft state
298  *
299  * Returns a free command from the pool
300  */
301 struct megasas_cmd *megasas_get_cmd(struct megasas_instance
302                                                   *instance)
303 {
304         unsigned long flags;
305         struct megasas_cmd *cmd = NULL;
306
307         spin_lock_irqsave(&instance->mfi_pool_lock, flags);
308
309         if (!list_empty(&instance->cmd_pool)) {
310                 cmd = list_entry((&instance->cmd_pool)->next,
311                                  struct megasas_cmd, list);
312                 list_del_init(&cmd->list);
313         } else {
314                 dev_err(&instance->pdev->dev, "Command pool empty!\n");
315         }
316
317         spin_unlock_irqrestore(&instance->mfi_pool_lock, flags);
318         return cmd;
319 }
320
321 /**
322  * megasas_return_cmd - Return a cmd to free command pool
323  * @instance:           Adapter soft state
324  * @cmd:                Command packet to be returned to free command pool
325  */
326 void
327 megasas_return_cmd(struct megasas_instance *instance, struct megasas_cmd *cmd)
328 {
329         unsigned long flags;
330         u32 blk_tags;
331         struct megasas_cmd_fusion *cmd_fusion;
332         struct fusion_context *fusion = instance->ctrl_context;
333
334         /* This flag is used only for fusion adapter.
335          * Wait for Interrupt for Polled mode DCMD
336          */
337         if (cmd->flags & DRV_DCMD_POLLED_MODE)
338                 return;
339
340         spin_lock_irqsave(&instance->mfi_pool_lock, flags);
341
342         if (fusion) {
343                 blk_tags = instance->max_scsi_cmds + cmd->index;
344                 cmd_fusion = fusion->cmd_list[blk_tags];
345                 megasas_return_cmd_fusion(instance, cmd_fusion);
346         }
347         cmd->scmd = NULL;
348         cmd->frame_count = 0;
349         cmd->flags = 0;
350         memset(cmd->frame, 0, instance->mfi_frame_size);
351         cmd->frame->io.context = cpu_to_le32(cmd->index);
352         if (!fusion && reset_devices)
353                 cmd->frame->hdr.cmd = MFI_CMD_INVALID;
354         list_add(&cmd->list, (&instance->cmd_pool)->next);
355
356         spin_unlock_irqrestore(&instance->mfi_pool_lock, flags);
357
358 }
359
360 static const char *
361 format_timestamp(uint32_t timestamp)
362 {
363         static char buffer[32];
364
365         if ((timestamp & 0xff000000) == 0xff000000)
366                 snprintf(buffer, sizeof(buffer), "boot + %us", timestamp &
367                 0x00ffffff);
368         else
369                 snprintf(buffer, sizeof(buffer), "%us", timestamp);
370         return buffer;
371 }
372
373 static const char *
374 format_class(int8_t class)
375 {
376         static char buffer[6];
377
378         switch (class) {
379         case MFI_EVT_CLASS_DEBUG:
380                 return "debug";
381         case MFI_EVT_CLASS_PROGRESS:
382                 return "progress";
383         case MFI_EVT_CLASS_INFO:
384                 return "info";
385         case MFI_EVT_CLASS_WARNING:
386                 return "WARN";
387         case MFI_EVT_CLASS_CRITICAL:
388                 return "CRIT";
389         case MFI_EVT_CLASS_FATAL:
390                 return "FATAL";
391         case MFI_EVT_CLASS_DEAD:
392                 return "DEAD";
393         default:
394                 snprintf(buffer, sizeof(buffer), "%d", class);
395                 return buffer;
396         }
397 }
398
399 /**
400   * megasas_decode_evt: Decode FW AEN event and print critical event
401   * for information.
402   * @instance:                  Adapter soft state
403   */
404 static void
405 megasas_decode_evt(struct megasas_instance *instance)
406 {
407         struct megasas_evt_detail *evt_detail = instance->evt_detail;
408         union megasas_evt_class_locale class_locale;
409         class_locale.word = le32_to_cpu(evt_detail->cl.word);
410
411         if ((event_log_level < MFI_EVT_CLASS_DEBUG) ||
412             (event_log_level > MFI_EVT_CLASS_DEAD)) {
413                 printk(KERN_WARNING "megaraid_sas: provided event log level is out of range, setting it to default 2(CLASS_CRITICAL), permissible range is: -2 to 4\n");
414                 event_log_level = MFI_EVT_CLASS_CRITICAL;
415         }
416
417         if (class_locale.members.class >= event_log_level)
418                 dev_info(&instance->pdev->dev, "%d (%s/0x%04x/%s) - %s\n",
419                         le32_to_cpu(evt_detail->seq_num),
420                         format_timestamp(le32_to_cpu(evt_detail->time_stamp)),
421                         (class_locale.members.locale),
422                         format_class(class_locale.members.class),
423                         evt_detail->description);
424 }
425
426 /*
427  * The following functions are defined for xscale
428  * (deviceid : 1064R, PERC5) controllers
429  */
430
431 /**
432  * megasas_enable_intr_xscale - Enables interrupts
433  * @instance:   Adapter soft state
434  */
435 static inline void
436 megasas_enable_intr_xscale(struct megasas_instance *instance)
437 {
438         struct megasas_register_set __iomem *regs;
439
440         regs = instance->reg_set;
441         writel(0, &(regs)->outbound_intr_mask);
442
443         /* Dummy readl to force pci flush */
444         readl(&regs->outbound_intr_mask);
445 }
446
447 /**
448  * megasas_disable_intr_xscale -Disables interrupt
449  * @instance:   Adapter soft state
450  */
451 static inline void
452 megasas_disable_intr_xscale(struct megasas_instance *instance)
453 {
454         struct megasas_register_set __iomem *regs;
455         u32 mask = 0x1f;
456
457         regs = instance->reg_set;
458         writel(mask, &regs->outbound_intr_mask);
459         /* Dummy readl to force pci flush */
460         readl(&regs->outbound_intr_mask);
461 }
462
463 /**
464  * megasas_read_fw_status_reg_xscale - returns the current FW status value
465  * @instance:   Adapter soft state
466  */
467 static u32
468 megasas_read_fw_status_reg_xscale(struct megasas_instance *instance)
469 {
470         return readl(&instance->reg_set->outbound_msg_0);
471 }
472 /**
473  * megasas_clear_interrupt_xscale -     Check & clear interrupt
474  * @instance:   Adapter soft state
475  */
476 static int
477 megasas_clear_intr_xscale(struct megasas_instance *instance)
478 {
479         u32 status;
480         u32 mfiStatus = 0;
481         struct megasas_register_set __iomem *regs;
482         regs = instance->reg_set;
483
484         /*
485          * Check if it is our interrupt
486          */
487         status = readl(&regs->outbound_intr_status);
488
489         if (status & MFI_OB_INTR_STATUS_MASK)
490                 mfiStatus = MFI_INTR_FLAG_REPLY_MESSAGE;
491         if (status & MFI_XSCALE_OMR0_CHANGE_INTERRUPT)
492                 mfiStatus |= MFI_INTR_FLAG_FIRMWARE_STATE_CHANGE;
493
494         /*
495          * Clear the interrupt by writing back the same value
496          */
497         if (mfiStatus)
498                 writel(status, &regs->outbound_intr_status);
499
500         /* Dummy readl to force pci flush */
501         readl(&regs->outbound_intr_status);
502
503         return mfiStatus;
504 }
505
506 /**
507  * megasas_fire_cmd_xscale -    Sends command to the FW
508  * @instance:           Adapter soft state
509  * @frame_phys_addr :   Physical address of cmd
510  * @frame_count :       Number of frames for the command
511  * @regs :              MFI register set
512  */
513 static inline void
514 megasas_fire_cmd_xscale(struct megasas_instance *instance,
515                 dma_addr_t frame_phys_addr,
516                 u32 frame_count,
517                 struct megasas_register_set __iomem *regs)
518 {
519         unsigned long flags;
520
521         spin_lock_irqsave(&instance->hba_lock, flags);
522         writel((frame_phys_addr >> 3)|(frame_count),
523                &(regs)->inbound_queue_port);
524         spin_unlock_irqrestore(&instance->hba_lock, flags);
525 }
526
527 /**
528  * megasas_adp_reset_xscale -  For controller reset
529  * @instance:   Adapter soft state
530  * @regs:       MFI register set
531  */
532 static int
533 megasas_adp_reset_xscale(struct megasas_instance *instance,
534         struct megasas_register_set __iomem *regs)
535 {
536         u32 i;
537         u32 pcidata;
538
539         writel(MFI_ADP_RESET, &regs->inbound_doorbell);
540
541         for (i = 0; i < 3; i++)
542                 msleep(1000); /* sleep for 3 secs */
543         pcidata  = 0;
544         pci_read_config_dword(instance->pdev, MFI_1068_PCSR_OFFSET, &pcidata);
545         dev_notice(&instance->pdev->dev, "pcidata = %x\n", pcidata);
546         if (pcidata & 0x2) {
547                 dev_notice(&instance->pdev->dev, "mfi 1068 offset read=%x\n", pcidata);
548                 pcidata &= ~0x2;
549                 pci_write_config_dword(instance->pdev,
550                                 MFI_1068_PCSR_OFFSET, pcidata);
551
552                 for (i = 0; i < 2; i++)
553                         msleep(1000); /* need to wait 2 secs again */
554
555                 pcidata  = 0;
556                 pci_read_config_dword(instance->pdev,
557                                 MFI_1068_FW_HANDSHAKE_OFFSET, &pcidata);
558                 dev_notice(&instance->pdev->dev, "1068 offset handshake read=%x\n", pcidata);
559                 if ((pcidata & 0xffff0000) == MFI_1068_FW_READY) {
560                         dev_notice(&instance->pdev->dev, "1068 offset pcidt=%x\n", pcidata);
561                         pcidata = 0;
562                         pci_write_config_dword(instance->pdev,
563                                 MFI_1068_FW_HANDSHAKE_OFFSET, pcidata);
564                 }
565         }
566         return 0;
567 }
568
569 /**
570  * megasas_check_reset_xscale - For controller reset check
571  * @instance:   Adapter soft state
572  * @regs:       MFI register set
573  */
574 static int
575 megasas_check_reset_xscale(struct megasas_instance *instance,
576                 struct megasas_register_set __iomem *regs)
577 {
578         if ((atomic_read(&instance->adprecovery) != MEGASAS_HBA_OPERATIONAL) &&
579             (le32_to_cpu(*instance->consumer) ==
580                 MEGASAS_ADPRESET_INPROG_SIGN))
581                 return 1;
582         return 0;
583 }
584
585 static struct megasas_instance_template megasas_instance_template_xscale = {
586
587         .fire_cmd = megasas_fire_cmd_xscale,
588         .enable_intr = megasas_enable_intr_xscale,
589         .disable_intr = megasas_disable_intr_xscale,
590         .clear_intr = megasas_clear_intr_xscale,
591         .read_fw_status_reg = megasas_read_fw_status_reg_xscale,
592         .adp_reset = megasas_adp_reset_xscale,
593         .check_reset = megasas_check_reset_xscale,
594         .service_isr = megasas_isr,
595         .tasklet = megasas_complete_cmd_dpc,
596         .init_adapter = megasas_init_adapter_mfi,
597         .build_and_issue_cmd = megasas_build_and_issue_cmd,
598         .issue_dcmd = megasas_issue_dcmd,
599 };
600
601 /*
602  * This is the end of set of functions & definitions specific
603  * to xscale (deviceid : 1064R, PERC5) controllers
604  */
605
606 /*
607  * The following functions are defined for ppc (deviceid : 0x60)
608  * controllers
609  */
610
611 /**
612  * megasas_enable_intr_ppc -    Enables interrupts
613  * @instance:   Adapter soft state
614  */
615 static inline void
616 megasas_enable_intr_ppc(struct megasas_instance *instance)
617 {
618         struct megasas_register_set __iomem *regs;
619
620         regs = instance->reg_set;
621         writel(0xFFFFFFFF, &(regs)->outbound_doorbell_clear);
622
623         writel(~0x80000000, &(regs)->outbound_intr_mask);
624
625         /* Dummy readl to force pci flush */
626         readl(&regs->outbound_intr_mask);
627 }
628
629 /**
630  * megasas_disable_intr_ppc -   Disable interrupt
631  * @instance:   Adapter soft state
632  */
633 static inline void
634 megasas_disable_intr_ppc(struct megasas_instance *instance)
635 {
636         struct megasas_register_set __iomem *regs;
637         u32 mask = 0xFFFFFFFF;
638
639         regs = instance->reg_set;
640         writel(mask, &regs->outbound_intr_mask);
641         /* Dummy readl to force pci flush */
642         readl(&regs->outbound_intr_mask);
643 }
644
645 /**
646  * megasas_read_fw_status_reg_ppc - returns the current FW status value
647  * @instance:   Adapter soft state
648  */
649 static u32
650 megasas_read_fw_status_reg_ppc(struct megasas_instance *instance)
651 {
652         return readl(&instance->reg_set->outbound_scratch_pad_0);
653 }
654
655 /**
656  * megasas_clear_interrupt_ppc -        Check & clear interrupt
657  * @instance:   Adapter soft state
658  */
659 static int
660 megasas_clear_intr_ppc(struct megasas_instance *instance)
661 {
662         u32 status, mfiStatus = 0;
663         struct megasas_register_set __iomem *regs;
664         regs = instance->reg_set;
665
666         /*
667          * Check if it is our interrupt
668          */
669         status = readl(&regs->outbound_intr_status);
670
671         if (status & MFI_REPLY_1078_MESSAGE_INTERRUPT)
672                 mfiStatus = MFI_INTR_FLAG_REPLY_MESSAGE;
673
674         if (status & MFI_G2_OUTBOUND_DOORBELL_CHANGE_INTERRUPT)
675                 mfiStatus |= MFI_INTR_FLAG_FIRMWARE_STATE_CHANGE;
676
677         /*
678          * Clear the interrupt by writing back the same value
679          */
680         writel(status, &regs->outbound_doorbell_clear);
681
682         /* Dummy readl to force pci flush */
683         readl(&regs->outbound_doorbell_clear);
684
685         return mfiStatus;
686 }
687
688 /**
689  * megasas_fire_cmd_ppc -       Sends command to the FW
690  * @instance:           Adapter soft state
691  * @frame_phys_addr:    Physical address of cmd
692  * @frame_count:        Number of frames for the command
693  * @regs:               MFI register set
694  */
695 static inline void
696 megasas_fire_cmd_ppc(struct megasas_instance *instance,
697                 dma_addr_t frame_phys_addr,
698                 u32 frame_count,
699                 struct megasas_register_set __iomem *regs)
700 {
701         unsigned long flags;
702
703         spin_lock_irqsave(&instance->hba_lock, flags);
704         writel((frame_phys_addr | (frame_count<<1))|1,
705                         &(regs)->inbound_queue_port);
706         spin_unlock_irqrestore(&instance->hba_lock, flags);
707 }
708
709 /**
710  * megasas_check_reset_ppc -    For controller reset check
711  * @instance:   Adapter soft state
712  * @regs:       MFI register set
713  */
714 static int
715 megasas_check_reset_ppc(struct megasas_instance *instance,
716                         struct megasas_register_set __iomem *regs)
717 {
718         if (atomic_read(&instance->adprecovery) != MEGASAS_HBA_OPERATIONAL)
719                 return 1;
720
721         return 0;
722 }
723
724 static struct megasas_instance_template megasas_instance_template_ppc = {
725
726         .fire_cmd = megasas_fire_cmd_ppc,
727         .enable_intr = megasas_enable_intr_ppc,
728         .disable_intr = megasas_disable_intr_ppc,
729         .clear_intr = megasas_clear_intr_ppc,
730         .read_fw_status_reg = megasas_read_fw_status_reg_ppc,
731         .adp_reset = megasas_adp_reset_xscale,
732         .check_reset = megasas_check_reset_ppc,
733         .service_isr = megasas_isr,
734         .tasklet = megasas_complete_cmd_dpc,
735         .init_adapter = megasas_init_adapter_mfi,
736         .build_and_issue_cmd = megasas_build_and_issue_cmd,
737         .issue_dcmd = megasas_issue_dcmd,
738 };
739
740 /**
741  * megasas_enable_intr_skinny - Enables interrupts
742  * @instance:   Adapter soft state
743  */
744 static inline void
745 megasas_enable_intr_skinny(struct megasas_instance *instance)
746 {
747         struct megasas_register_set __iomem *regs;
748
749         regs = instance->reg_set;
750         writel(0xFFFFFFFF, &(regs)->outbound_intr_mask);
751
752         writel(~MFI_SKINNY_ENABLE_INTERRUPT_MASK, &(regs)->outbound_intr_mask);
753
754         /* Dummy readl to force pci flush */
755         readl(&regs->outbound_intr_mask);
756 }
757
758 /**
759  * megasas_disable_intr_skinny -        Disables interrupt
760  * @instance:   Adapter soft state
761  */
762 static inline void
763 megasas_disable_intr_skinny(struct megasas_instance *instance)
764 {
765         struct megasas_register_set __iomem *regs;
766         u32 mask = 0xFFFFFFFF;
767
768         regs = instance->reg_set;
769         writel(mask, &regs->outbound_intr_mask);
770         /* Dummy readl to force pci flush */
771         readl(&regs->outbound_intr_mask);
772 }
773
774 /**
775  * megasas_read_fw_status_reg_skinny - returns the current FW status value
776  * @instance:   Adapter soft state
777  */
778 static u32
779 megasas_read_fw_status_reg_skinny(struct megasas_instance *instance)
780 {
781         return readl(&instance->reg_set->outbound_scratch_pad_0);
782 }
783
784 /**
785  * megasas_clear_interrupt_skinny -     Check & clear interrupt
786  * @instance:   Adapter soft state
787  */
788 static int
789 megasas_clear_intr_skinny(struct megasas_instance *instance)
790 {
791         u32 status;
792         u32 mfiStatus = 0;
793         struct megasas_register_set __iomem *regs;
794         regs = instance->reg_set;
795
796         /*
797          * Check if it is our interrupt
798          */
799         status = readl(&regs->outbound_intr_status);
800
801         if (!(status & MFI_SKINNY_ENABLE_INTERRUPT_MASK)) {
802                 return 0;
803         }
804
805         /*
806          * Check if it is our interrupt
807          */
808         if ((megasas_read_fw_status_reg_skinny(instance) & MFI_STATE_MASK) ==
809             MFI_STATE_FAULT) {
810                 mfiStatus = MFI_INTR_FLAG_FIRMWARE_STATE_CHANGE;
811         } else
812                 mfiStatus = MFI_INTR_FLAG_REPLY_MESSAGE;
813
814         /*
815          * Clear the interrupt by writing back the same value
816          */
817         writel(status, &regs->outbound_intr_status);
818
819         /*
820          * dummy read to flush PCI
821          */
822         readl(&regs->outbound_intr_status);
823
824         return mfiStatus;
825 }
826
827 /**
828  * megasas_fire_cmd_skinny -    Sends command to the FW
829  * @instance:           Adapter soft state
830  * @frame_phys_addr:    Physical address of cmd
831  * @frame_count:        Number of frames for the command
832  * @regs:               MFI register set
833  */
834 static inline void
835 megasas_fire_cmd_skinny(struct megasas_instance *instance,
836                         dma_addr_t frame_phys_addr,
837                         u32 frame_count,
838                         struct megasas_register_set __iomem *regs)
839 {
840         unsigned long flags;
841
842         spin_lock_irqsave(&instance->hba_lock, flags);
843         writel(upper_32_bits(frame_phys_addr),
844                &(regs)->inbound_high_queue_port);
845         writel((lower_32_bits(frame_phys_addr) | (frame_count<<1))|1,
846                &(regs)->inbound_low_queue_port);
847         spin_unlock_irqrestore(&instance->hba_lock, flags);
848 }
849
850 /**
851  * megasas_check_reset_skinny - For controller reset check
852  * @instance:   Adapter soft state
853  * @regs:       MFI register set
854  */
855 static int
856 megasas_check_reset_skinny(struct megasas_instance *instance,
857                                 struct megasas_register_set __iomem *regs)
858 {
859         if (atomic_read(&instance->adprecovery) != MEGASAS_HBA_OPERATIONAL)
860                 return 1;
861
862         return 0;
863 }
864
865 static struct megasas_instance_template megasas_instance_template_skinny = {
866
867         .fire_cmd = megasas_fire_cmd_skinny,
868         .enable_intr = megasas_enable_intr_skinny,
869         .disable_intr = megasas_disable_intr_skinny,
870         .clear_intr = megasas_clear_intr_skinny,
871         .read_fw_status_reg = megasas_read_fw_status_reg_skinny,
872         .adp_reset = megasas_adp_reset_gen2,
873         .check_reset = megasas_check_reset_skinny,
874         .service_isr = megasas_isr,
875         .tasklet = megasas_complete_cmd_dpc,
876         .init_adapter = megasas_init_adapter_mfi,
877         .build_and_issue_cmd = megasas_build_and_issue_cmd,
878         .issue_dcmd = megasas_issue_dcmd,
879 };
880
881
882 /*
883  * The following functions are defined for gen2 (deviceid : 0x78 0x79)
884  * controllers
885  */
886
887 /**
888  * megasas_enable_intr_gen2 -  Enables interrupts
889  * @instance:   Adapter soft state
890  */
891 static inline void
892 megasas_enable_intr_gen2(struct megasas_instance *instance)
893 {
894         struct megasas_register_set __iomem *regs;
895
896         regs = instance->reg_set;
897         writel(0xFFFFFFFF, &(regs)->outbound_doorbell_clear);
898
899         /* write ~0x00000005 (4 & 1) to the intr mask*/
900         writel(~MFI_GEN2_ENABLE_INTERRUPT_MASK, &(regs)->outbound_intr_mask);
901
902         /* Dummy readl to force pci flush */
903         readl(&regs->outbound_intr_mask);
904 }
905
906 /**
907  * megasas_disable_intr_gen2 - Disables interrupt
908  * @instance:   Adapter soft state
909  */
910 static inline void
911 megasas_disable_intr_gen2(struct megasas_instance *instance)
912 {
913         struct megasas_register_set __iomem *regs;
914         u32 mask = 0xFFFFFFFF;
915
916         regs = instance->reg_set;
917         writel(mask, &regs->outbound_intr_mask);
918         /* Dummy readl to force pci flush */
919         readl(&regs->outbound_intr_mask);
920 }
921
922 /**
923  * megasas_read_fw_status_reg_gen2 - returns the current FW status value
924  * @instance:   Adapter soft state
925  */
926 static u32
927 megasas_read_fw_status_reg_gen2(struct megasas_instance *instance)
928 {
929         return readl(&instance->reg_set->outbound_scratch_pad_0);
930 }
931
932 /**
933  * megasas_clear_interrupt_gen2 -      Check & clear interrupt
934  * @instance:   Adapter soft state
935  */
936 static int
937 megasas_clear_intr_gen2(struct megasas_instance *instance)
938 {
939         u32 status;
940         u32 mfiStatus = 0;
941         struct megasas_register_set __iomem *regs;
942         regs = instance->reg_set;
943
944         /*
945          * Check if it is our interrupt
946          */
947         status = readl(&regs->outbound_intr_status);
948
949         if (status & MFI_INTR_FLAG_REPLY_MESSAGE) {
950                 mfiStatus = MFI_INTR_FLAG_REPLY_MESSAGE;
951         }
952         if (status & MFI_G2_OUTBOUND_DOORBELL_CHANGE_INTERRUPT) {
953                 mfiStatus |= MFI_INTR_FLAG_FIRMWARE_STATE_CHANGE;
954         }
955
956         /*
957          * Clear the interrupt by writing back the same value
958          */
959         if (mfiStatus)
960                 writel(status, &regs->outbound_doorbell_clear);
961
962         /* Dummy readl to force pci flush */
963         readl(&regs->outbound_intr_status);
964
965         return mfiStatus;
966 }
967
968 /**
969  * megasas_fire_cmd_gen2 -     Sends command to the FW
970  * @instance:           Adapter soft state
971  * @frame_phys_addr:    Physical address of cmd
972  * @frame_count:        Number of frames for the command
973  * @regs:               MFI register set
974  */
975 static inline void
976 megasas_fire_cmd_gen2(struct megasas_instance *instance,
977                         dma_addr_t frame_phys_addr,
978                         u32 frame_count,
979                         struct megasas_register_set __iomem *regs)
980 {
981         unsigned long flags;
982
983         spin_lock_irqsave(&instance->hba_lock, flags);
984         writel((frame_phys_addr | (frame_count<<1))|1,
985                         &(regs)->inbound_queue_port);
986         spin_unlock_irqrestore(&instance->hba_lock, flags);
987 }
988
989 /**
990  * megasas_adp_reset_gen2 -     For controller reset
991  * @instance:   Adapter soft state
992  * @reg_set:    MFI register set
993  */
994 static int
995 megasas_adp_reset_gen2(struct megasas_instance *instance,
996                         struct megasas_register_set __iomem *reg_set)
997 {
998         u32 retry = 0 ;
999         u32 HostDiag;
1000         u32 __iomem *seq_offset = &reg_set->seq_offset;
1001         u32 __iomem *hostdiag_offset = &reg_set->host_diag;
1002
1003         if (instance->instancet == &megasas_instance_template_skinny) {
1004                 seq_offset = &reg_set->fusion_seq_offset;
1005                 hostdiag_offset = &reg_set->fusion_host_diag;
1006         }
1007
1008         writel(0, seq_offset);
1009         writel(4, seq_offset);
1010         writel(0xb, seq_offset);
1011         writel(2, seq_offset);
1012         writel(7, seq_offset);
1013         writel(0xd, seq_offset);
1014
1015         msleep(1000);
1016
1017         HostDiag = (u32)readl(hostdiag_offset);
1018
1019         while (!(HostDiag & DIAG_WRITE_ENABLE)) {
1020                 msleep(100);
1021                 HostDiag = (u32)readl(hostdiag_offset);
1022                 dev_notice(&instance->pdev->dev, "RESETGEN2: retry=%x, hostdiag=%x\n",
1023                                         retry, HostDiag);
1024
1025                 if (retry++ >= 100)
1026                         return 1;
1027
1028         }
1029
1030         dev_notice(&instance->pdev->dev, "ADP_RESET_GEN2: HostDiag=%x\n", HostDiag);
1031
1032         writel((HostDiag | DIAG_RESET_ADAPTER), hostdiag_offset);
1033
1034         ssleep(10);
1035
1036         HostDiag = (u32)readl(hostdiag_offset);
1037         while (HostDiag & DIAG_RESET_ADAPTER) {
1038                 msleep(100);
1039                 HostDiag = (u32)readl(hostdiag_offset);
1040                 dev_notice(&instance->pdev->dev, "RESET_GEN2: retry=%x, hostdiag=%x\n",
1041                                 retry, HostDiag);
1042
1043                 if (retry++ >= 1000)
1044                         return 1;
1045
1046         }
1047         return 0;
1048 }
1049
1050 /**
1051  * megasas_check_reset_gen2 -   For controller reset check
1052  * @instance:   Adapter soft state
1053  * @regs:       MFI register set
1054  */
1055 static int
1056 megasas_check_reset_gen2(struct megasas_instance *instance,
1057                 struct megasas_register_set __iomem *regs)
1058 {
1059         if (atomic_read(&instance->adprecovery) != MEGASAS_HBA_OPERATIONAL)
1060                 return 1;
1061
1062         return 0;
1063 }
1064
1065 static struct megasas_instance_template megasas_instance_template_gen2 = {
1066
1067         .fire_cmd = megasas_fire_cmd_gen2,
1068         .enable_intr = megasas_enable_intr_gen2,
1069         .disable_intr = megasas_disable_intr_gen2,
1070         .clear_intr = megasas_clear_intr_gen2,
1071         .read_fw_status_reg = megasas_read_fw_status_reg_gen2,
1072         .adp_reset = megasas_adp_reset_gen2,
1073         .check_reset = megasas_check_reset_gen2,
1074         .service_isr = megasas_isr,
1075         .tasklet = megasas_complete_cmd_dpc,
1076         .init_adapter = megasas_init_adapter_mfi,
1077         .build_and_issue_cmd = megasas_build_and_issue_cmd,
1078         .issue_dcmd = megasas_issue_dcmd,
1079 };
1080
1081 /*
1082  * This is the end of set of functions & definitions
1083  * specific to gen2 (deviceid : 0x78, 0x79) controllers
1084  */
1085
1086 /*
1087  * Template added for TB (Fusion)
1088  */
1089 extern struct megasas_instance_template megasas_instance_template_fusion;
1090
1091 /**
1092  * megasas_issue_polled -       Issues a polling command
1093  * @instance:                   Adapter soft state
1094  * @cmd:                        Command packet to be issued
1095  *
1096  * For polling, MFI requires the cmd_status to be set to MFI_STAT_INVALID_STATUS before posting.
1097  */
1098 int
1099 megasas_issue_polled(struct megasas_instance *instance, struct megasas_cmd *cmd)
1100 {
1101         struct megasas_header *frame_hdr = &cmd->frame->hdr;
1102
1103         frame_hdr->cmd_status = MFI_STAT_INVALID_STATUS;
1104         frame_hdr->flags |= cpu_to_le16(MFI_FRAME_DONT_POST_IN_REPLY_QUEUE);
1105
1106         if (atomic_read(&instance->adprecovery) == MEGASAS_HW_CRITICAL_ERROR) {
1107                 dev_err(&instance->pdev->dev, "Failed from %s %d\n",
1108                         __func__, __LINE__);
1109                 return DCMD_INIT;
1110         }
1111
1112         instance->instancet->issue_dcmd(instance, cmd);
1113
1114         return wait_and_poll(instance, cmd, instance->requestorId ?
1115                         MEGASAS_ROUTINE_WAIT_TIME_VF : MFI_IO_TIMEOUT_SECS);
1116 }
1117
1118 /**
1119  * megasas_issue_blocked_cmd -  Synchronous wrapper around regular FW cmds
1120  * @instance:                   Adapter soft state
1121  * @cmd:                        Command to be issued
1122  * @timeout:                    Timeout in seconds
1123  *
1124  * This function waits on an event for the command to be returned from ISR.
1125  * Max wait time is MEGASAS_INTERNAL_CMD_WAIT_TIME secs
1126  * Used to issue ioctl commands.
1127  */
1128 int
1129 megasas_issue_blocked_cmd(struct megasas_instance *instance,
1130                           struct megasas_cmd *cmd, int timeout)
1131 {
1132         int ret = 0;
1133         cmd->cmd_status_drv = DCMD_INIT;
1134
1135         if (atomic_read(&instance->adprecovery) == MEGASAS_HW_CRITICAL_ERROR) {
1136                 dev_err(&instance->pdev->dev, "Failed from %s %d\n",
1137                         __func__, __LINE__);
1138                 return DCMD_INIT;
1139         }
1140
1141         instance->instancet->issue_dcmd(instance, cmd);
1142
1143         if (timeout) {
1144                 ret = wait_event_timeout(instance->int_cmd_wait_q,
1145                 cmd->cmd_status_drv != DCMD_INIT, timeout * HZ);
1146                 if (!ret) {
1147                         dev_err(&instance->pdev->dev,
1148                                 "DCMD(opcode: 0x%x) is timed out, func:%s\n",
1149                                 cmd->frame->dcmd.opcode, __func__);
1150                         return DCMD_TIMEOUT;
1151                 }
1152         } else
1153                 wait_event(instance->int_cmd_wait_q,
1154                                 cmd->cmd_status_drv != DCMD_INIT);
1155
1156         return cmd->cmd_status_drv;
1157 }
1158
1159 /**
1160  * megasas_issue_blocked_abort_cmd -    Aborts previously issued cmd
1161  * @instance:                           Adapter soft state
1162  * @cmd_to_abort:                       Previously issued cmd to be aborted
1163  * @timeout:                            Timeout in seconds
1164  *
1165  * MFI firmware can abort previously issued AEN comamnd (automatic event
1166  * notification). The megasas_issue_blocked_abort_cmd() issues such abort
1167  * cmd and waits for return status.
1168  * Max wait time is MEGASAS_INTERNAL_CMD_WAIT_TIME secs
1169  */
1170 static int
1171 megasas_issue_blocked_abort_cmd(struct megasas_instance *instance,
1172                                 struct megasas_cmd *cmd_to_abort, int timeout)
1173 {
1174         struct megasas_cmd *cmd;
1175         struct megasas_abort_frame *abort_fr;
1176         int ret = 0;
1177         u32 opcode;
1178
1179         cmd = megasas_get_cmd(instance);
1180
1181         if (!cmd)
1182                 return -1;
1183
1184         abort_fr = &cmd->frame->abort;
1185
1186         /*
1187          * Prepare and issue the abort frame
1188          */
1189         abort_fr->cmd = MFI_CMD_ABORT;
1190         abort_fr->cmd_status = MFI_STAT_INVALID_STATUS;
1191         abort_fr->flags = cpu_to_le16(0);
1192         abort_fr->abort_context = cpu_to_le32(cmd_to_abort->index);
1193         abort_fr->abort_mfi_phys_addr_lo =
1194                 cpu_to_le32(lower_32_bits(cmd_to_abort->frame_phys_addr));
1195         abort_fr->abort_mfi_phys_addr_hi =
1196                 cpu_to_le32(upper_32_bits(cmd_to_abort->frame_phys_addr));
1197
1198         cmd->sync_cmd = 1;
1199         cmd->cmd_status_drv = DCMD_INIT;
1200
1201         if (atomic_read(&instance->adprecovery) == MEGASAS_HW_CRITICAL_ERROR) {
1202                 dev_err(&instance->pdev->dev, "Failed from %s %d\n",
1203                         __func__, __LINE__);
1204                 return DCMD_INIT;
1205         }
1206
1207         instance->instancet->issue_dcmd(instance, cmd);
1208
1209         if (timeout) {
1210                 ret = wait_event_timeout(instance->abort_cmd_wait_q,
1211                 cmd->cmd_status_drv != DCMD_INIT, timeout * HZ);
1212                 if (!ret) {
1213                         opcode = cmd_to_abort->frame->dcmd.opcode;
1214                         dev_err(&instance->pdev->dev,
1215                                 "Abort(to be aborted DCMD opcode: 0x%x) is timed out func:%s\n",
1216                                 opcode,  __func__);
1217                         return DCMD_TIMEOUT;
1218                 }
1219         } else
1220                 wait_event(instance->abort_cmd_wait_q,
1221                 cmd->cmd_status_drv != DCMD_INIT);
1222
1223         cmd->sync_cmd = 0;
1224
1225         megasas_return_cmd(instance, cmd);
1226         return cmd->cmd_status_drv;
1227 }
1228
1229 /**
1230  * megasas_make_sgl32 - Prepares 32-bit SGL
1231  * @instance:           Adapter soft state
1232  * @scp:                SCSI command from the mid-layer
1233  * @mfi_sgl:            SGL to be filled in
1234  *
1235  * If successful, this function returns the number of SG elements. Otherwise,
1236  * it returnes -1.
1237  */
1238 static int
1239 megasas_make_sgl32(struct megasas_instance *instance, struct scsi_cmnd *scp,
1240                    union megasas_sgl *mfi_sgl)
1241 {
1242         int i;
1243         int sge_count;
1244         struct scatterlist *os_sgl;
1245
1246         sge_count = scsi_dma_map(scp);
1247         BUG_ON(sge_count < 0);
1248
1249         if (sge_count) {
1250                 scsi_for_each_sg(scp, os_sgl, sge_count, i) {
1251                         mfi_sgl->sge32[i].length = cpu_to_le32(sg_dma_len(os_sgl));
1252                         mfi_sgl->sge32[i].phys_addr = cpu_to_le32(sg_dma_address(os_sgl));
1253                 }
1254         }
1255         return sge_count;
1256 }
1257
1258 /**
1259  * megasas_make_sgl64 - Prepares 64-bit SGL
1260  * @instance:           Adapter soft state
1261  * @scp:                SCSI command from the mid-layer
1262  * @mfi_sgl:            SGL to be filled in
1263  *
1264  * If successful, this function returns the number of SG elements. Otherwise,
1265  * it returnes -1.
1266  */
1267 static int
1268 megasas_make_sgl64(struct megasas_instance *instance, struct scsi_cmnd *scp,
1269                    union megasas_sgl *mfi_sgl)
1270 {
1271         int i;
1272         int sge_count;
1273         struct scatterlist *os_sgl;
1274
1275         sge_count = scsi_dma_map(scp);
1276         BUG_ON(sge_count < 0);
1277
1278         if (sge_count) {
1279                 scsi_for_each_sg(scp, os_sgl, sge_count, i) {
1280                         mfi_sgl->sge64[i].length = cpu_to_le32(sg_dma_len(os_sgl));
1281                         mfi_sgl->sge64[i].phys_addr = cpu_to_le64(sg_dma_address(os_sgl));
1282                 }
1283         }
1284         return sge_count;
1285 }
1286
1287 /**
1288  * megasas_make_sgl_skinny - Prepares IEEE SGL
1289  * @instance:           Adapter soft state
1290  * @scp:                SCSI command from the mid-layer
1291  * @mfi_sgl:            SGL to be filled in
1292  *
1293  * If successful, this function returns the number of SG elements. Otherwise,
1294  * it returnes -1.
1295  */
1296 static int
1297 megasas_make_sgl_skinny(struct megasas_instance *instance,
1298                 struct scsi_cmnd *scp, union megasas_sgl *mfi_sgl)
1299 {
1300         int i;
1301         int sge_count;
1302         struct scatterlist *os_sgl;
1303
1304         sge_count = scsi_dma_map(scp);
1305
1306         if (sge_count) {
1307                 scsi_for_each_sg(scp, os_sgl, sge_count, i) {
1308                         mfi_sgl->sge_skinny[i].length =
1309                                 cpu_to_le32(sg_dma_len(os_sgl));
1310                         mfi_sgl->sge_skinny[i].phys_addr =
1311                                 cpu_to_le64(sg_dma_address(os_sgl));
1312                         mfi_sgl->sge_skinny[i].flag = cpu_to_le32(0);
1313                 }
1314         }
1315         return sge_count;
1316 }
1317
1318  /**
1319  * megasas_get_frame_count - Computes the number of frames
1320  * @frame_type          : type of frame- io or pthru frame
1321  * @sge_count           : number of sg elements
1322  *
1323  * Returns the number of frames required for numnber of sge's (sge_count)
1324  */
1325
1326 static u32 megasas_get_frame_count(struct megasas_instance *instance,
1327                         u8 sge_count, u8 frame_type)
1328 {
1329         int num_cnt;
1330         int sge_bytes;
1331         u32 sge_sz;
1332         u32 frame_count = 0;
1333
1334         sge_sz = (IS_DMA64) ? sizeof(struct megasas_sge64) :
1335             sizeof(struct megasas_sge32);
1336
1337         if (instance->flag_ieee) {
1338                 sge_sz = sizeof(struct megasas_sge_skinny);
1339         }
1340
1341         /*
1342          * Main frame can contain 2 SGEs for 64-bit SGLs and
1343          * 3 SGEs for 32-bit SGLs for ldio &
1344          * 1 SGEs for 64-bit SGLs and
1345          * 2 SGEs for 32-bit SGLs for pthru frame
1346          */
1347         if (unlikely(frame_type == PTHRU_FRAME)) {
1348                 if (instance->flag_ieee == 1) {
1349                         num_cnt = sge_count - 1;
1350                 } else if (IS_DMA64)
1351                         num_cnt = sge_count - 1;
1352                 else
1353                         num_cnt = sge_count - 2;
1354         } else {
1355                 if (instance->flag_ieee == 1) {
1356                         num_cnt = sge_count - 1;
1357                 } else if (IS_DMA64)
1358                         num_cnt = sge_count - 2;
1359                 else
1360                         num_cnt = sge_count - 3;
1361         }
1362
1363         if (num_cnt > 0) {
1364                 sge_bytes = sge_sz * num_cnt;
1365
1366                 frame_count = (sge_bytes / MEGAMFI_FRAME_SIZE) +
1367                     ((sge_bytes % MEGAMFI_FRAME_SIZE) ? 1 : 0) ;
1368         }
1369         /* Main frame */
1370         frame_count += 1;
1371
1372         if (frame_count > 7)
1373                 frame_count = 8;
1374         return frame_count;
1375 }
1376
1377 /**
1378  * megasas_build_dcdb - Prepares a direct cdb (DCDB) command
1379  * @instance:           Adapter soft state
1380  * @scp:                SCSI command
1381  * @cmd:                Command to be prepared in
1382  *
1383  * This function prepares CDB commands. These are typcially pass-through
1384  * commands to the devices.
1385  */
1386 static int
1387 megasas_build_dcdb(struct megasas_instance *instance, struct scsi_cmnd *scp,
1388                    struct megasas_cmd *cmd)
1389 {
1390         u32 is_logical;
1391         u32 device_id;
1392         u16 flags = 0;
1393         struct megasas_pthru_frame *pthru;
1394
1395         is_logical = MEGASAS_IS_LOGICAL(scp->device);
1396         device_id = MEGASAS_DEV_INDEX(scp);
1397         pthru = (struct megasas_pthru_frame *)cmd->frame;
1398
1399         if (scp->sc_data_direction == DMA_TO_DEVICE)
1400                 flags = MFI_FRAME_DIR_WRITE;
1401         else if (scp->sc_data_direction == DMA_FROM_DEVICE)
1402                 flags = MFI_FRAME_DIR_READ;
1403         else if (scp->sc_data_direction == DMA_NONE)
1404                 flags = MFI_FRAME_DIR_NONE;
1405
1406         if (instance->flag_ieee == 1) {
1407                 flags |= MFI_FRAME_IEEE;
1408         }
1409
1410         /*
1411          * Prepare the DCDB frame
1412          */
1413         pthru->cmd = (is_logical) ? MFI_CMD_LD_SCSI_IO : MFI_CMD_PD_SCSI_IO;
1414         pthru->cmd_status = 0x0;
1415         pthru->scsi_status = 0x0;
1416         pthru->target_id = device_id;
1417         pthru->lun = scp->device->lun;
1418         pthru->cdb_len = scp->cmd_len;
1419         pthru->timeout = 0;
1420         pthru->pad_0 = 0;
1421         pthru->flags = cpu_to_le16(flags);
1422         pthru->data_xfer_len = cpu_to_le32(scsi_bufflen(scp));
1423
1424         memcpy(pthru->cdb, scp->cmnd, scp->cmd_len);
1425
1426         /*
1427          * If the command is for the tape device, set the
1428          * pthru timeout to the os layer timeout value.
1429          */
1430         if (scp->device->type == TYPE_TAPE) {
1431                 if ((scp->request->timeout / HZ) > 0xFFFF)
1432                         pthru->timeout = cpu_to_le16(0xFFFF);
1433                 else
1434                         pthru->timeout = cpu_to_le16(scp->request->timeout / HZ);
1435         }
1436
1437         /*
1438          * Construct SGL
1439          */
1440         if (instance->flag_ieee == 1) {
1441                 pthru->flags |= cpu_to_le16(MFI_FRAME_SGL64);
1442                 pthru->sge_count = megasas_make_sgl_skinny(instance, scp,
1443                                                       &pthru->sgl);
1444         } else if (IS_DMA64) {
1445                 pthru->flags |= cpu_to_le16(MFI_FRAME_SGL64);
1446                 pthru->sge_count = megasas_make_sgl64(instance, scp,
1447                                                       &pthru->sgl);
1448         } else
1449                 pthru->sge_count = megasas_make_sgl32(instance, scp,
1450                                                       &pthru->sgl);
1451
1452         if (pthru->sge_count > instance->max_num_sge) {
1453                 dev_err(&instance->pdev->dev, "DCDB too many SGE NUM=%x\n",
1454                         pthru->sge_count);
1455                 return 0;
1456         }
1457
1458         /*
1459          * Sense info specific
1460          */
1461         pthru->sense_len = SCSI_SENSE_BUFFERSIZE;
1462         pthru->sense_buf_phys_addr_hi =
1463                 cpu_to_le32(upper_32_bits(cmd->sense_phys_addr));
1464         pthru->sense_buf_phys_addr_lo =
1465                 cpu_to_le32(lower_32_bits(cmd->sense_phys_addr));
1466
1467         /*
1468          * Compute the total number of frames this command consumes. FW uses
1469          * this number to pull sufficient number of frames from host memory.
1470          */
1471         cmd->frame_count = megasas_get_frame_count(instance, pthru->sge_count,
1472                                                         PTHRU_FRAME);
1473
1474         return cmd->frame_count;
1475 }
1476
1477 /**
1478  * megasas_build_ldio - Prepares IOs to logical devices
1479  * @instance:           Adapter soft state
1480  * @scp:                SCSI command
1481  * @cmd:                Command to be prepared
1482  *
1483  * Frames (and accompanying SGLs) for regular SCSI IOs use this function.
1484  */
1485 static int
1486 megasas_build_ldio(struct megasas_instance *instance, struct scsi_cmnd *scp,
1487                    struct megasas_cmd *cmd)
1488 {
1489         u32 device_id;
1490         u8 sc = scp->cmnd[0];
1491         u16 flags = 0;
1492         struct megasas_io_frame *ldio;
1493
1494         device_id = MEGASAS_DEV_INDEX(scp);
1495         ldio = (struct megasas_io_frame *)cmd->frame;
1496
1497         if (scp->sc_data_direction == DMA_TO_DEVICE)
1498                 flags = MFI_FRAME_DIR_WRITE;
1499         else if (scp->sc_data_direction == DMA_FROM_DEVICE)
1500                 flags = MFI_FRAME_DIR_READ;
1501
1502         if (instance->flag_ieee == 1) {
1503                 flags |= MFI_FRAME_IEEE;
1504         }
1505
1506         /*
1507          * Prepare the Logical IO frame: 2nd bit is zero for all read cmds
1508          */
1509         ldio->cmd = (sc & 0x02) ? MFI_CMD_LD_WRITE : MFI_CMD_LD_READ;
1510         ldio->cmd_status = 0x0;
1511         ldio->scsi_status = 0x0;
1512         ldio->target_id = device_id;
1513         ldio->timeout = 0;
1514         ldio->reserved_0 = 0;
1515         ldio->pad_0 = 0;
1516         ldio->flags = cpu_to_le16(flags);
1517         ldio->start_lba_hi = 0;
1518         ldio->access_byte = (scp->cmd_len != 6) ? scp->cmnd[1] : 0;
1519
1520         /*
1521          * 6-byte READ(0x08) or WRITE(0x0A) cdb
1522          */
1523         if (scp->cmd_len == 6) {
1524                 ldio->lba_count = cpu_to_le32((u32) scp->cmnd[4]);
1525                 ldio->start_lba_lo = cpu_to_le32(((u32) scp->cmnd[1] << 16) |
1526                                                  ((u32) scp->cmnd[2] << 8) |
1527                                                  (u32) scp->cmnd[3]);
1528
1529                 ldio->start_lba_lo &= cpu_to_le32(0x1FFFFF);
1530         }
1531
1532         /*
1533          * 10-byte READ(0x28) or WRITE(0x2A) cdb
1534          */
1535         else if (scp->cmd_len == 10) {
1536                 ldio->lba_count = cpu_to_le32((u32) scp->cmnd[8] |
1537                                               ((u32) scp->cmnd[7] << 8));
1538                 ldio->start_lba_lo = cpu_to_le32(((u32) scp->cmnd[2] << 24) |
1539                                                  ((u32) scp->cmnd[3] << 16) |
1540                                                  ((u32) scp->cmnd[4] << 8) |
1541                                                  (u32) scp->cmnd[5]);
1542         }
1543
1544         /*
1545          * 12-byte READ(0xA8) or WRITE(0xAA) cdb
1546          */
1547         else if (scp->cmd_len == 12) {
1548                 ldio->lba_count = cpu_to_le32(((u32) scp->cmnd[6] << 24) |
1549                                               ((u32) scp->cmnd[7] << 16) |
1550                                               ((u32) scp->cmnd[8] << 8) |
1551                                               (u32) scp->cmnd[9]);
1552
1553                 ldio->start_lba_lo = cpu_to_le32(((u32) scp->cmnd[2] << 24) |
1554                                                  ((u32) scp->cmnd[3] << 16) |
1555                                                  ((u32) scp->cmnd[4] << 8) |
1556                                                  (u32) scp->cmnd[5]);
1557         }
1558
1559         /*
1560          * 16-byte READ(0x88) or WRITE(0x8A) cdb
1561          */
1562         else if (scp->cmd_len == 16) {
1563                 ldio->lba_count = cpu_to_le32(((u32) scp->cmnd[10] << 24) |
1564                                               ((u32) scp->cmnd[11] << 16) |
1565                                               ((u32) scp->cmnd[12] << 8) |
1566                                               (u32) scp->cmnd[13]);
1567
1568                 ldio->start_lba_lo = cpu_to_le32(((u32) scp->cmnd[6] << 24) |
1569                                                  ((u32) scp->cmnd[7] << 16) |
1570                                                  ((u32) scp->cmnd[8] << 8) |
1571                                                  (u32) scp->cmnd[9]);
1572
1573                 ldio->start_lba_hi = cpu_to_le32(((u32) scp->cmnd[2] << 24) |
1574                                                  ((u32) scp->cmnd[3] << 16) |
1575                                                  ((u32) scp->cmnd[4] << 8) |
1576                                                  (u32) scp->cmnd[5]);
1577
1578         }
1579
1580         /*
1581          * Construct SGL
1582          */
1583         if (instance->flag_ieee) {
1584                 ldio->flags |= cpu_to_le16(MFI_FRAME_SGL64);
1585                 ldio->sge_count = megasas_make_sgl_skinny(instance, scp,
1586                                               &ldio->sgl);
1587         } else if (IS_DMA64) {
1588                 ldio->flags |= cpu_to_le16(MFI_FRAME_SGL64);
1589                 ldio->sge_count = megasas_make_sgl64(instance, scp, &ldio->sgl);
1590         } else
1591                 ldio->sge_count = megasas_make_sgl32(instance, scp, &ldio->sgl);
1592
1593         if (ldio->sge_count > instance->max_num_sge) {
1594                 dev_err(&instance->pdev->dev, "build_ld_io: sge_count = %x\n",
1595                         ldio->sge_count);
1596                 return 0;
1597         }
1598
1599         /*
1600          * Sense info specific
1601          */
1602         ldio->sense_len = SCSI_SENSE_BUFFERSIZE;
1603         ldio->sense_buf_phys_addr_hi = 0;
1604         ldio->sense_buf_phys_addr_lo = cpu_to_le32(cmd->sense_phys_addr);
1605
1606         /*
1607          * Compute the total number of frames this command consumes. FW uses
1608          * this number to pull sufficient number of frames from host memory.
1609          */
1610         cmd->frame_count = megasas_get_frame_count(instance,
1611                         ldio->sge_count, IO_FRAME);
1612
1613         return cmd->frame_count;
1614 }
1615
1616 /**
1617  * megasas_cmd_type -           Checks if the cmd is for logical drive/sysPD
1618  *                              and whether it's RW or non RW
1619  * @cmd:                        SCSI command
1620  *
1621  */
1622 inline int megasas_cmd_type(struct scsi_cmnd *cmd)
1623 {
1624         int ret;
1625
1626         switch (cmd->cmnd[0]) {
1627         case READ_10:
1628         case WRITE_10:
1629         case READ_12:
1630         case WRITE_12:
1631         case READ_6:
1632         case WRITE_6:
1633         case READ_16:
1634         case WRITE_16:
1635                 ret = (MEGASAS_IS_LOGICAL(cmd->device)) ?
1636                         READ_WRITE_LDIO : READ_WRITE_SYSPDIO;
1637                 break;
1638         default:
1639                 ret = (MEGASAS_IS_LOGICAL(cmd->device)) ?
1640                         NON_READ_WRITE_LDIO : NON_READ_WRITE_SYSPDIO;
1641         }
1642         return ret;
1643 }
1644
1645  /**
1646  * megasas_dump_pending_frames -        Dumps the frame address of all pending cmds
1647  *                                      in FW
1648  * @instance:                           Adapter soft state
1649  */
1650 static inline void
1651 megasas_dump_pending_frames(struct megasas_instance *instance)
1652 {
1653         struct megasas_cmd *cmd;
1654         int i,n;
1655         union megasas_sgl *mfi_sgl;
1656         struct megasas_io_frame *ldio;
1657         struct megasas_pthru_frame *pthru;
1658         u32 sgcount;
1659         u16 max_cmd = instance->max_fw_cmds;
1660
1661         dev_err(&instance->pdev->dev, "[%d]: Dumping Frame Phys Address of all pending cmds in FW\n",instance->host->host_no);
1662         dev_err(&instance->pdev->dev, "[%d]: Total OS Pending cmds : %d\n",instance->host->host_no,atomic_read(&instance->fw_outstanding));
1663         if (IS_DMA64)
1664                 dev_err(&instance->pdev->dev, "[%d]: 64 bit SGLs were sent to FW\n",instance->host->host_no);
1665         else
1666                 dev_err(&instance->pdev->dev, "[%d]: 32 bit SGLs were sent to FW\n",instance->host->host_no);
1667
1668         dev_err(&instance->pdev->dev, "[%d]: Pending OS cmds in FW : \n",instance->host->host_no);
1669         for (i = 0; i < max_cmd; i++) {
1670                 cmd = instance->cmd_list[i];
1671                 if (!cmd->scmd)
1672                         continue;
1673                 dev_err(&instance->pdev->dev, "[%d]: Frame addr :0x%08lx : ",instance->host->host_no,(unsigned long)cmd->frame_phys_addr);
1674                 if (megasas_cmd_type(cmd->scmd) == READ_WRITE_LDIO) {
1675                         ldio = (struct megasas_io_frame *)cmd->frame;
1676                         mfi_sgl = &ldio->sgl;
1677                         sgcount = ldio->sge_count;
1678                         dev_err(&instance->pdev->dev, "[%d]: frame count : 0x%x, Cmd : 0x%x, Tgt id : 0x%x,"
1679                         " lba lo : 0x%x, lba_hi : 0x%x, sense_buf addr : 0x%x,sge count : 0x%x\n",
1680                         instance->host->host_no, cmd->frame_count, ldio->cmd, ldio->target_id,
1681                         le32_to_cpu(ldio->start_lba_lo), le32_to_cpu(ldio->start_lba_hi),
1682                         le32_to_cpu(ldio->sense_buf_phys_addr_lo), sgcount);
1683                 } else {
1684                         pthru = (struct megasas_pthru_frame *) cmd->frame;
1685                         mfi_sgl = &pthru->sgl;
1686                         sgcount = pthru->sge_count;
1687                         dev_err(&instance->pdev->dev, "[%d]: frame count : 0x%x, Cmd : 0x%x, Tgt id : 0x%x, "
1688                         "lun : 0x%x, cdb_len : 0x%x, data xfer len : 0x%x, sense_buf addr : 0x%x,sge count : 0x%x\n",
1689                         instance->host->host_no, cmd->frame_count, pthru->cmd, pthru->target_id,
1690                         pthru->lun, pthru->cdb_len, le32_to_cpu(pthru->data_xfer_len),
1691                         le32_to_cpu(pthru->sense_buf_phys_addr_lo), sgcount);
1692                 }
1693                 if (megasas_dbg_lvl & MEGASAS_DBG_LVL) {
1694                         for (n = 0; n < sgcount; n++) {
1695                                 if (IS_DMA64)
1696                                         dev_err(&instance->pdev->dev, "sgl len : 0x%x, sgl addr : 0x%llx\n",
1697                                                 le32_to_cpu(mfi_sgl->sge64[n].length),
1698                                                 le64_to_cpu(mfi_sgl->sge64[n].phys_addr));
1699                                 else
1700                                         dev_err(&instance->pdev->dev, "sgl len : 0x%x, sgl addr : 0x%x\n",
1701                                                 le32_to_cpu(mfi_sgl->sge32[n].length),
1702                                                 le32_to_cpu(mfi_sgl->sge32[n].phys_addr));
1703                         }
1704                 }
1705         } /*for max_cmd*/
1706         dev_err(&instance->pdev->dev, "[%d]: Pending Internal cmds in FW : \n",instance->host->host_no);
1707         for (i = 0; i < max_cmd; i++) {
1708
1709                 cmd = instance->cmd_list[i];
1710
1711                 if (cmd->sync_cmd == 1)
1712                         dev_err(&instance->pdev->dev, "0x%08lx : ", (unsigned long)cmd->frame_phys_addr);
1713         }
1714         dev_err(&instance->pdev->dev, "[%d]: Dumping Done\n\n",instance->host->host_no);
1715 }
1716
1717 u32
1718 megasas_build_and_issue_cmd(struct megasas_instance *instance,
1719                             struct scsi_cmnd *scmd)
1720 {
1721         struct megasas_cmd *cmd;
1722         u32 frame_count;
1723
1724         cmd = megasas_get_cmd(instance);
1725         if (!cmd)
1726                 return SCSI_MLQUEUE_HOST_BUSY;
1727
1728         /*
1729          * Logical drive command
1730          */
1731         if (megasas_cmd_type(scmd) == READ_WRITE_LDIO)
1732                 frame_count = megasas_build_ldio(instance, scmd, cmd);
1733         else
1734                 frame_count = megasas_build_dcdb(instance, scmd, cmd);
1735
1736         if (!frame_count)
1737                 goto out_return_cmd;
1738
1739         cmd->scmd = scmd;
1740         scmd->SCp.ptr = (char *)cmd;
1741
1742         /*
1743          * Issue the command to the FW
1744          */
1745         atomic_inc(&instance->fw_outstanding);
1746
1747         instance->instancet->fire_cmd(instance, cmd->frame_phys_addr,
1748                                 cmd->frame_count-1, instance->reg_set);
1749
1750         return 0;
1751 out_return_cmd:
1752         megasas_return_cmd(instance, cmd);
1753         return SCSI_MLQUEUE_HOST_BUSY;
1754 }
1755
1756
1757 /**
1758  * megasas_queue_command -      Queue entry point
1759  * @shost:                      adapter SCSI host
1760  * @scmd:                       SCSI command to be queued
1761  */
1762 static int
1763 megasas_queue_command(struct Scsi_Host *shost, struct scsi_cmnd *scmd)
1764 {
1765         struct megasas_instance *instance;
1766         struct MR_PRIV_DEVICE *mr_device_priv_data;
1767
1768         instance = (struct megasas_instance *)
1769             scmd->device->host->hostdata;
1770
1771         if (instance->unload == 1) {
1772                 scmd->result = DID_NO_CONNECT << 16;
1773                 scmd->scsi_done(scmd);
1774                 return 0;
1775         }
1776
1777         if (instance->issuepend_done == 0)
1778                 return SCSI_MLQUEUE_HOST_BUSY;
1779
1780
1781         /* Check for an mpio path and adjust behavior */
1782         if (atomic_read(&instance->adprecovery) == MEGASAS_ADPRESET_SM_INFAULT) {
1783                 if (megasas_check_mpio_paths(instance, scmd) ==
1784                     (DID_REQUEUE << 16)) {
1785                         return SCSI_MLQUEUE_HOST_BUSY;
1786                 } else {
1787                         scmd->result = DID_NO_CONNECT << 16;
1788                         scmd->scsi_done(scmd);
1789                         return 0;
1790                 }
1791         }
1792
1793         if (atomic_read(&instance->adprecovery) == MEGASAS_HW_CRITICAL_ERROR) {
1794                 scmd->result = DID_NO_CONNECT << 16;
1795                 scmd->scsi_done(scmd);
1796                 return 0;
1797         }
1798
1799         mr_device_priv_data = scmd->device->hostdata;
1800         if (!mr_device_priv_data) {
1801                 scmd->result = DID_NO_CONNECT << 16;
1802                 scmd->scsi_done(scmd);
1803                 return 0;
1804         }
1805
1806         if (atomic_read(&instance->adprecovery) != MEGASAS_HBA_OPERATIONAL)
1807                 return SCSI_MLQUEUE_HOST_BUSY;
1808
1809         if (mr_device_priv_data->tm_busy)
1810                 return SCSI_MLQUEUE_DEVICE_BUSY;
1811
1812
1813         scmd->result = 0;
1814
1815         if (MEGASAS_IS_LOGICAL(scmd->device) &&
1816             (scmd->device->id >= instance->fw_supported_vd_count ||
1817                 scmd->device->lun)) {
1818                 scmd->result = DID_BAD_TARGET << 16;
1819                 goto out_done;
1820         }
1821
1822         if ((scmd->cmnd[0] == SYNCHRONIZE_CACHE) &&
1823             MEGASAS_IS_LOGICAL(scmd->device) &&
1824             (!instance->fw_sync_cache_support)) {
1825                 scmd->result = DID_OK << 16;
1826                 goto out_done;
1827         }
1828
1829         return instance->instancet->build_and_issue_cmd(instance, scmd);
1830
1831  out_done:
1832         scmd->scsi_done(scmd);
1833         return 0;
1834 }
1835
1836 static struct megasas_instance *megasas_lookup_instance(u16 host_no)
1837 {
1838         int i;
1839
1840         for (i = 0; i < megasas_mgmt_info.max_index; i++) {
1841
1842                 if ((megasas_mgmt_info.instance[i]) &&
1843                     (megasas_mgmt_info.instance[i]->host->host_no == host_no))
1844                         return megasas_mgmt_info.instance[i];
1845         }
1846
1847         return NULL;
1848 }
1849
1850 /*
1851 * megasas_set_dynamic_target_properties -
1852 * Device property set by driver may not be static and it is required to be
1853 * updated after OCR
1854 *
1855 * set tm_capable.
1856 * set dma alignment (only for eedp protection enable vd).
1857 *
1858 * @sdev: OS provided scsi device
1859 *
1860 * Returns void
1861 */
1862 void megasas_set_dynamic_target_properties(struct scsi_device *sdev,
1863                                            bool is_target_prop)
1864 {
1865         u16 pd_index = 0, ld;
1866         u32 device_id;
1867         struct megasas_instance *instance;
1868         struct fusion_context *fusion;
1869         struct MR_PRIV_DEVICE *mr_device_priv_data;
1870         struct MR_PD_CFG_SEQ_NUM_SYNC *pd_sync;
1871         struct MR_LD_RAID *raid;
1872         struct MR_DRV_RAID_MAP_ALL *local_map_ptr;
1873
1874         instance = megasas_lookup_instance(sdev->host->host_no);
1875         fusion = instance->ctrl_context;
1876         mr_device_priv_data = sdev->hostdata;
1877
1878         if (!fusion || !mr_device_priv_data)
1879                 return;
1880
1881         if (MEGASAS_IS_LOGICAL(sdev)) {
1882                 device_id = ((sdev->channel % 2) * MEGASAS_MAX_DEV_PER_CHANNEL)
1883                                         + sdev->id;
1884                 local_map_ptr = fusion->ld_drv_map[(instance->map_id & 1)];
1885                 ld = MR_TargetIdToLdGet(device_id, local_map_ptr);
1886                 if (ld >= instance->fw_supported_vd_count)
1887                         return;
1888                 raid = MR_LdRaidGet(ld, local_map_ptr);
1889
1890                 if (raid->capability.ldPiMode == MR_PROT_INFO_TYPE_CONTROLLER)
1891                 blk_queue_update_dma_alignment(sdev->request_queue, 0x7);
1892
1893                 mr_device_priv_data->is_tm_capable =
1894                         raid->capability.tmCapable;
1895
1896                 if (!raid->flags.isEPD)
1897                         sdev->no_write_same = 1;
1898
1899         } else if (instance->use_seqnum_jbod_fp) {
1900                 pd_index = (sdev->channel * MEGASAS_MAX_DEV_PER_CHANNEL) +
1901                         sdev->id;
1902                 pd_sync = (void *)fusion->pd_seq_sync
1903                                 [(instance->pd_seq_map_id - 1) & 1];
1904                 mr_device_priv_data->is_tm_capable =
1905                         pd_sync->seq[pd_index].capability.tmCapable;
1906         }
1907
1908         if (is_target_prop && instance->tgt_prop->reset_tmo) {
1909                 /*
1910                  * If FW provides a target reset timeout value, driver will use
1911                  * it. If not set, fallback to default values.
1912                  */
1913                 mr_device_priv_data->target_reset_tmo =
1914                         min_t(u8, instance->max_reset_tmo,
1915                               instance->tgt_prop->reset_tmo);
1916                 mr_device_priv_data->task_abort_tmo = instance->task_abort_tmo;
1917         } else {
1918                 mr_device_priv_data->target_reset_tmo =
1919                                                 MEGASAS_DEFAULT_TM_TIMEOUT;
1920                 mr_device_priv_data->task_abort_tmo =
1921                                                 MEGASAS_DEFAULT_TM_TIMEOUT;
1922         }
1923 }
1924
1925 /*
1926  * megasas_set_nvme_device_properties -
1927  * set nomerges=2
1928  * set virtual page boundary = 4K (current mr_nvme_pg_size is 4K).
1929  * set maximum io transfer = MDTS of NVME device provided by MR firmware.
1930  *
1931  * MR firmware provides value in KB. Caller of this function converts
1932  * kb into bytes.
1933  *
1934  * e.a MDTS=5 means 2^5 * nvme page size. (In case of 4K page size,
1935  * MR firmware provides value 128 as (32 * 4K) = 128K.
1936  *
1937  * @sdev:                               scsi device
1938  * @max_io_size:                                maximum io transfer size
1939  *
1940  */
1941 static inline void
1942 megasas_set_nvme_device_properties(struct scsi_device *sdev, u32 max_io_size)
1943 {
1944         struct megasas_instance *instance;
1945         u32 mr_nvme_pg_size;
1946
1947         instance = (struct megasas_instance *)sdev->host->hostdata;
1948         mr_nvme_pg_size = max_t(u32, instance->nvme_page_size,
1949                                 MR_DEFAULT_NVME_PAGE_SIZE);
1950
1951         blk_queue_max_hw_sectors(sdev->request_queue, (max_io_size / 512));
1952
1953         blk_queue_flag_set(QUEUE_FLAG_NOMERGES, sdev->request_queue);
1954         blk_queue_virt_boundary(sdev->request_queue, mr_nvme_pg_size - 1);
1955 }
1956
1957 /*
1958  * megasas_set_fw_assisted_qd -
1959  * set device queue depth to can_queue
1960  * set device queue depth to fw assisted qd
1961  *
1962  * @sdev:                               scsi device
1963  * @is_target_prop                      true, if fw provided target properties.
1964  */
1965 static void megasas_set_fw_assisted_qd(struct scsi_device *sdev,
1966                                                  bool is_target_prop)
1967 {
1968         u8 interface_type;
1969         u32 device_qd = MEGASAS_DEFAULT_CMD_PER_LUN;
1970         u32 tgt_device_qd;
1971         struct megasas_instance *instance;
1972         struct MR_PRIV_DEVICE *mr_device_priv_data;
1973
1974         instance = megasas_lookup_instance(sdev->host->host_no);
1975         mr_device_priv_data = sdev->hostdata;
1976         interface_type  = mr_device_priv_data->interface_type;
1977
1978         switch (interface_type) {
1979         case SAS_PD:
1980                 device_qd = MEGASAS_SAS_QD;
1981                 break;
1982         case SATA_PD:
1983                 device_qd = MEGASAS_SATA_QD;
1984                 break;
1985         case NVME_PD:
1986                 device_qd = MEGASAS_NVME_QD;
1987                 break;
1988         }
1989
1990         if (is_target_prop) {
1991                 tgt_device_qd = le32_to_cpu(instance->tgt_prop->device_qdepth);
1992                 if (tgt_device_qd)
1993                         device_qd = min(instance->host->can_queue,
1994                                         (int)tgt_device_qd);
1995         }
1996
1997         if (instance->enable_sdev_max_qd && interface_type != UNKNOWN_DRIVE)
1998                 device_qd = instance->host->can_queue;
1999
2000         scsi_change_queue_depth(sdev, device_qd);
2001 }
2002
2003 /*
2004  * megasas_set_static_target_properties -
2005  * Device property set by driver are static and it is not required to be
2006  * updated after OCR.
2007  *
2008  * set io timeout
2009  * set device queue depth
2010  * set nvme device properties. see - megasas_set_nvme_device_properties
2011  *
2012  * @sdev:                               scsi device
2013  * @is_target_prop                      true, if fw provided target properties.
2014  */
2015 static void megasas_set_static_target_properties(struct scsi_device *sdev,
2016                                                  bool is_target_prop)
2017 {
2018         u32 max_io_size_kb = MR_DEFAULT_NVME_MDTS_KB;
2019         struct megasas_instance *instance;
2020
2021         instance = megasas_lookup_instance(sdev->host->host_no);
2022
2023         /*
2024          * The RAID firmware may require extended timeouts.
2025          */
2026         blk_queue_rq_timeout(sdev->request_queue, scmd_timeout * HZ);
2027
2028         /* max_io_size_kb will be set to non zero for
2029          * nvme based vd and syspd.
2030          */
2031         if (is_target_prop)
2032                 max_io_size_kb = le32_to_cpu(instance->tgt_prop->max_io_size_kb);
2033
2034         if (instance->nvme_page_size && max_io_size_kb)
2035                 megasas_set_nvme_device_properties(sdev, (max_io_size_kb << 10));
2036
2037         megasas_set_fw_assisted_qd(sdev, is_target_prop);
2038 }
2039
2040
2041 static int megasas_slave_configure(struct scsi_device *sdev)
2042 {
2043         u16 pd_index = 0;
2044         struct megasas_instance *instance;
2045         int ret_target_prop = DCMD_FAILED;
2046         bool is_target_prop = false;
2047
2048         instance = megasas_lookup_instance(sdev->host->host_no);
2049         if (instance->pd_list_not_supported) {
2050                 if (!MEGASAS_IS_LOGICAL(sdev) && sdev->type == TYPE_DISK) {
2051                         pd_index = (sdev->channel * MEGASAS_MAX_DEV_PER_CHANNEL) +
2052                                 sdev->id;
2053                         if (instance->pd_list[pd_index].driveState !=
2054                                 MR_PD_STATE_SYSTEM)
2055                                 return -ENXIO;
2056                 }
2057         }
2058
2059         mutex_lock(&instance->reset_mutex);
2060         /* Send DCMD to Firmware and cache the information */
2061         if ((instance->pd_info) && !MEGASAS_IS_LOGICAL(sdev))
2062                 megasas_get_pd_info(instance, sdev);
2063
2064         /* Some ventura firmware may not have instance->nvme_page_size set.
2065          * Do not send MR_DCMD_DRV_GET_TARGET_PROP
2066          */
2067         if ((instance->tgt_prop) && (instance->nvme_page_size))
2068                 ret_target_prop = megasas_get_target_prop(instance, sdev);
2069
2070         is_target_prop = (ret_target_prop == DCMD_SUCCESS) ? true : false;
2071         megasas_set_static_target_properties(sdev, is_target_prop);
2072
2073         /* This sdev property may change post OCR */
2074         megasas_set_dynamic_target_properties(sdev, is_target_prop);
2075
2076         mutex_unlock(&instance->reset_mutex);
2077
2078         return 0;
2079 }
2080
2081 static int megasas_slave_alloc(struct scsi_device *sdev)
2082 {
2083         u16 pd_index = 0;
2084         struct megasas_instance *instance ;
2085         struct MR_PRIV_DEVICE *mr_device_priv_data;
2086
2087         instance = megasas_lookup_instance(sdev->host->host_no);
2088         if (!MEGASAS_IS_LOGICAL(sdev)) {
2089                 /*
2090                  * Open the OS scan to the SYSTEM PD
2091                  */
2092                 pd_index =
2093                         (sdev->channel * MEGASAS_MAX_DEV_PER_CHANNEL) +
2094                         sdev->id;
2095                 if ((instance->pd_list_not_supported ||
2096                         instance->pd_list[pd_index].driveState ==
2097                         MR_PD_STATE_SYSTEM)) {
2098                         goto scan_target;
2099                 }
2100                 return -ENXIO;
2101         }
2102
2103 scan_target:
2104         mr_device_priv_data = kzalloc(sizeof(*mr_device_priv_data),
2105                                         GFP_KERNEL);
2106         if (!mr_device_priv_data)
2107                 return -ENOMEM;
2108         sdev->hostdata = mr_device_priv_data;
2109
2110         atomic_set(&mr_device_priv_data->r1_ldio_hint,
2111                    instance->r1_ldio_hint_default);
2112         return 0;
2113 }
2114
2115 static void megasas_slave_destroy(struct scsi_device *sdev)
2116 {
2117         kfree(sdev->hostdata);
2118         sdev->hostdata = NULL;
2119 }
2120
2121 /*
2122 * megasas_complete_outstanding_ioctls - Complete outstanding ioctls after a
2123 *                                       kill adapter
2124 * @instance:                            Adapter soft state
2125 *
2126 */
2127 static void megasas_complete_outstanding_ioctls(struct megasas_instance *instance)
2128 {
2129         int i;
2130         struct megasas_cmd *cmd_mfi;
2131         struct megasas_cmd_fusion *cmd_fusion;
2132         struct fusion_context *fusion = instance->ctrl_context;
2133
2134         /* Find all outstanding ioctls */
2135         if (fusion) {
2136                 for (i = 0; i < instance->max_fw_cmds; i++) {
2137                         cmd_fusion = fusion->cmd_list[i];
2138                         if (cmd_fusion->sync_cmd_idx != (u32)ULONG_MAX) {
2139                                 cmd_mfi = instance->cmd_list[cmd_fusion->sync_cmd_idx];
2140                                 if (cmd_mfi->sync_cmd &&
2141                                     (cmd_mfi->frame->hdr.cmd != MFI_CMD_ABORT)) {
2142                                         cmd_mfi->frame->hdr.cmd_status =
2143                                                         MFI_STAT_WRONG_STATE;
2144                                         megasas_complete_cmd(instance,
2145                                                              cmd_mfi, DID_OK);
2146                                 }
2147                         }
2148                 }
2149         } else {
2150                 for (i = 0; i < instance->max_fw_cmds; i++) {
2151                         cmd_mfi = instance->cmd_list[i];
2152                         if (cmd_mfi->sync_cmd && cmd_mfi->frame->hdr.cmd !=
2153                                 MFI_CMD_ABORT)
2154                                 megasas_complete_cmd(instance, cmd_mfi, DID_OK);
2155                 }
2156         }
2157 }
2158
2159
2160 void megaraid_sas_kill_hba(struct megasas_instance *instance)
2161 {
2162         if (atomic_read(&instance->adprecovery) == MEGASAS_HW_CRITICAL_ERROR) {
2163                 dev_warn(&instance->pdev->dev,
2164                          "Adapter already dead, skipping kill HBA\n");
2165                 return;
2166         }
2167
2168         /* Set critical error to block I/O & ioctls in case caller didn't */
2169         atomic_set(&instance->adprecovery, MEGASAS_HW_CRITICAL_ERROR);
2170         /* Wait 1 second to ensure IO or ioctls in build have posted */
2171         msleep(1000);
2172         if ((instance->pdev->device == PCI_DEVICE_ID_LSI_SAS0073SKINNY) ||
2173                 (instance->pdev->device == PCI_DEVICE_ID_LSI_SAS0071SKINNY) ||
2174                 (instance->adapter_type != MFI_SERIES)) {
2175                 if (!instance->requestorId) {
2176                         writel(MFI_STOP_ADP, &instance->reg_set->doorbell);
2177                         /* Flush */
2178                         readl(&instance->reg_set->doorbell);
2179                 }
2180                 if (instance->requestorId && instance->peerIsPresent)
2181                         memset(instance->ld_ids, 0xff, MEGASAS_MAX_LD_IDS);
2182         } else {
2183                 writel(MFI_STOP_ADP,
2184                         &instance->reg_set->inbound_doorbell);
2185         }
2186         /* Complete outstanding ioctls when adapter is killed */
2187         megasas_complete_outstanding_ioctls(instance);
2188 }
2189
2190  /**
2191   * megasas_check_and_restore_queue_depth - Check if queue depth needs to be
2192   *                                     restored to max value
2193   * @instance:                  Adapter soft state
2194   *
2195   */
2196 void
2197 megasas_check_and_restore_queue_depth(struct megasas_instance *instance)
2198 {
2199         unsigned long flags;
2200
2201         if (instance->flag & MEGASAS_FW_BUSY
2202             && time_after(jiffies, instance->last_time + 5 * HZ)
2203             && atomic_read(&instance->fw_outstanding) <
2204             instance->throttlequeuedepth + 1) {
2205
2206                 spin_lock_irqsave(instance->host->host_lock, flags);
2207                 instance->flag &= ~MEGASAS_FW_BUSY;
2208
2209                 instance->host->can_queue = instance->cur_can_queue;
2210                 spin_unlock_irqrestore(instance->host->host_lock, flags);
2211         }
2212 }
2213
2214 /**
2215  * megasas_complete_cmd_dpc      -      Returns FW's controller structure
2216  * @instance_addr:                      Address of adapter soft state
2217  *
2218  * Tasklet to complete cmds
2219  */
2220 static void megasas_complete_cmd_dpc(unsigned long instance_addr)
2221 {
2222         u32 producer;
2223         u32 consumer;
2224         u32 context;
2225         struct megasas_cmd *cmd;
2226         struct megasas_instance *instance =
2227                                 (struct megasas_instance *)instance_addr;
2228         unsigned long flags;
2229
2230         /* If we have already declared adapter dead, donot complete cmds */
2231         if (atomic_read(&instance->adprecovery) == MEGASAS_HW_CRITICAL_ERROR)
2232                 return;
2233
2234         spin_lock_irqsave(&instance->completion_lock, flags);
2235
2236         producer = le32_to_cpu(*instance->producer);
2237         consumer = le32_to_cpu(*instance->consumer);
2238
2239         while (consumer != producer) {
2240                 context = le32_to_cpu(instance->reply_queue[consumer]);
2241                 if (context >= instance->max_fw_cmds) {
2242                         dev_err(&instance->pdev->dev, "Unexpected context value %x\n",
2243                                 context);
2244                         BUG();
2245                 }
2246
2247                 cmd = instance->cmd_list[context];
2248
2249                 megasas_complete_cmd(instance, cmd, DID_OK);
2250
2251                 consumer++;
2252                 if (consumer == (instance->max_fw_cmds + 1)) {
2253                         consumer = 0;
2254                 }
2255         }
2256
2257         *instance->consumer = cpu_to_le32(producer);
2258
2259         spin_unlock_irqrestore(&instance->completion_lock, flags);
2260
2261         /*
2262          * Check if we can restore can_queue
2263          */
2264         megasas_check_and_restore_queue_depth(instance);
2265 }
2266
2267 static void megasas_sriov_heartbeat_handler(struct timer_list *t);
2268
2269 /**
2270  * megasas_start_timer - Initializes sriov heartbeat timer object
2271  * @instance:           Adapter soft state
2272  *
2273  */
2274 void megasas_start_timer(struct megasas_instance *instance)
2275 {
2276         struct timer_list *timer = &instance->sriov_heartbeat_timer;
2277
2278         timer_setup(timer, megasas_sriov_heartbeat_handler, 0);
2279         timer->expires = jiffies + MEGASAS_SRIOV_HEARTBEAT_INTERVAL_VF;
2280         add_timer(timer);
2281 }
2282
2283 static void
2284 megasas_internal_reset_defer_cmds(struct megasas_instance *instance);
2285
2286 static void
2287 process_fw_state_change_wq(struct work_struct *work);
2288
2289 static void megasas_do_ocr(struct megasas_instance *instance)
2290 {
2291         if ((instance->pdev->device == PCI_DEVICE_ID_LSI_SAS1064R) ||
2292         (instance->pdev->device == PCI_DEVICE_ID_DELL_PERC5) ||
2293         (instance->pdev->device == PCI_DEVICE_ID_LSI_VERDE_ZCR)) {
2294                 *instance->consumer = cpu_to_le32(MEGASAS_ADPRESET_INPROG_SIGN);
2295         }
2296         instance->instancet->disable_intr(instance);
2297         atomic_set(&instance->adprecovery, MEGASAS_ADPRESET_SM_INFAULT);
2298         instance->issuepend_done = 0;
2299
2300         atomic_set(&instance->fw_outstanding, 0);
2301         megasas_internal_reset_defer_cmds(instance);
2302         process_fw_state_change_wq(&instance->work_init);
2303 }
2304
2305 static int megasas_get_ld_vf_affiliation_111(struct megasas_instance *instance,
2306                                             int initial)
2307 {
2308         struct megasas_cmd *cmd;
2309         struct megasas_dcmd_frame *dcmd;
2310         struct MR_LD_VF_AFFILIATION_111 *new_affiliation_111 = NULL;
2311         dma_addr_t new_affiliation_111_h;
2312         int ld, retval = 0;
2313         u8 thisVf;
2314
2315         cmd = megasas_get_cmd(instance);
2316
2317         if (!cmd) {
2318                 dev_printk(KERN_DEBUG, &instance->pdev->dev, "megasas_get_ld_vf_affiliation_111:"
2319                        "Failed to get cmd for scsi%d\n",
2320                         instance->host->host_no);
2321                 return -ENOMEM;
2322         }
2323
2324         dcmd = &cmd->frame->dcmd;
2325
2326         if (!instance->vf_affiliation_111) {
2327                 dev_warn(&instance->pdev->dev, "SR-IOV: Couldn't get LD/VF "
2328                        "affiliation for scsi%d\n", instance->host->host_no);
2329                 megasas_return_cmd(instance, cmd);
2330                 return -ENOMEM;
2331         }
2332
2333         if (initial)
2334                         memset(instance->vf_affiliation_111, 0,
2335                                sizeof(struct MR_LD_VF_AFFILIATION_111));
2336         else {
2337                 new_affiliation_111 =
2338                         dma_alloc_coherent(&instance->pdev->dev,
2339                                            sizeof(struct MR_LD_VF_AFFILIATION_111),
2340                                            &new_affiliation_111_h, GFP_KERNEL);
2341                 if (!new_affiliation_111) {
2342                         dev_printk(KERN_DEBUG, &instance->pdev->dev, "SR-IOV: Couldn't allocate "
2343                                "memory for new affiliation for scsi%d\n",
2344                                instance->host->host_no);
2345                         megasas_return_cmd(instance, cmd);
2346                         return -ENOMEM;
2347                 }
2348         }
2349
2350         memset(dcmd->mbox.b, 0, MFI_MBOX_SIZE);
2351
2352         dcmd->cmd = MFI_CMD_DCMD;
2353         dcmd->cmd_status = MFI_STAT_INVALID_STATUS;
2354         dcmd->sge_count = 1;
2355         dcmd->flags = cpu_to_le16(MFI_FRAME_DIR_BOTH);
2356         dcmd->timeout = 0;
2357         dcmd->pad_0 = 0;
2358         dcmd->data_xfer_len =
2359                 cpu_to_le32(sizeof(struct MR_LD_VF_AFFILIATION_111));
2360         dcmd->opcode = cpu_to_le32(MR_DCMD_LD_VF_MAP_GET_ALL_LDS_111);
2361
2362         if (initial)
2363                 dcmd->sgl.sge32[0].phys_addr =
2364                         cpu_to_le32(instance->vf_affiliation_111_h);
2365         else
2366                 dcmd->sgl.sge32[0].phys_addr =
2367                         cpu_to_le32(new_affiliation_111_h);
2368
2369         dcmd->sgl.sge32[0].length = cpu_to_le32(
2370                 sizeof(struct MR_LD_VF_AFFILIATION_111));
2371
2372         dev_warn(&instance->pdev->dev, "SR-IOV: Getting LD/VF affiliation for "
2373                "scsi%d\n", instance->host->host_no);
2374
2375         if (megasas_issue_blocked_cmd(instance, cmd, 0) != DCMD_SUCCESS) {
2376                 dev_warn(&instance->pdev->dev, "SR-IOV: LD/VF affiliation DCMD"
2377                        " failed with status 0x%x for scsi%d\n",
2378                        dcmd->cmd_status, instance->host->host_no);
2379                 retval = 1; /* Do a scan if we couldn't get affiliation */
2380                 goto out;
2381         }
2382
2383         if (!initial) {
2384                 thisVf = new_affiliation_111->thisVf;
2385                 for (ld = 0 ; ld < new_affiliation_111->vdCount; ld++)
2386                         if (instance->vf_affiliation_111->map[ld].policy[thisVf] !=
2387                             new_affiliation_111->map[ld].policy[thisVf]) {
2388                                 dev_warn(&instance->pdev->dev, "SR-IOV: "
2389                                        "Got new LD/VF affiliation for scsi%d\n",
2390                                        instance->host->host_no);
2391                                 memcpy(instance->vf_affiliation_111,
2392                                        new_affiliation_111,
2393                                        sizeof(struct MR_LD_VF_AFFILIATION_111));
2394                                 retval = 1;
2395                                 goto out;
2396                         }
2397         }
2398 out:
2399         if (new_affiliation_111) {
2400                 dma_free_coherent(&instance->pdev->dev,
2401                                     sizeof(struct MR_LD_VF_AFFILIATION_111),
2402                                     new_affiliation_111,
2403                                     new_affiliation_111_h);
2404         }
2405
2406         megasas_return_cmd(instance, cmd);
2407
2408         return retval;
2409 }
2410
2411 static int megasas_get_ld_vf_affiliation_12(struct megasas_instance *instance,
2412                                             int initial)
2413 {
2414         struct megasas_cmd *cmd;
2415         struct megasas_dcmd_frame *dcmd;
2416         struct MR_LD_VF_AFFILIATION *new_affiliation = NULL;
2417         struct MR_LD_VF_MAP *newmap = NULL, *savedmap = NULL;
2418         dma_addr_t new_affiliation_h;
2419         int i, j, retval = 0, found = 0, doscan = 0;
2420         u8 thisVf;
2421
2422         cmd = megasas_get_cmd(instance);
2423
2424         if (!cmd) {
2425                 dev_printk(KERN_DEBUG, &instance->pdev->dev, "megasas_get_ld_vf_affiliation12: "
2426                        "Failed to get cmd for scsi%d\n",
2427                        instance->host->host_no);
2428                 return -ENOMEM;
2429         }
2430
2431         dcmd = &cmd->frame->dcmd;
2432
2433         if (!instance->vf_affiliation) {
2434                 dev_warn(&instance->pdev->dev, "SR-IOV: Couldn't get LD/VF "
2435                        "affiliation for scsi%d\n", instance->host->host_no);
2436                 megasas_return_cmd(instance, cmd);
2437                 return -ENOMEM;
2438         }
2439
2440         if (initial)
2441                 memset(instance->vf_affiliation, 0, (MAX_LOGICAL_DRIVES + 1) *
2442                        sizeof(struct MR_LD_VF_AFFILIATION));
2443         else {
2444                 new_affiliation =
2445                         dma_alloc_coherent(&instance->pdev->dev,
2446                                            (MAX_LOGICAL_DRIVES + 1) * sizeof(struct MR_LD_VF_AFFILIATION),
2447                                            &new_affiliation_h, GFP_KERNEL);
2448                 if (!new_affiliation) {
2449                         dev_printk(KERN_DEBUG, &instance->pdev->dev, "SR-IOV: Couldn't allocate "
2450                                "memory for new affiliation for scsi%d\n",
2451                                instance->host->host_no);
2452                         megasas_return_cmd(instance, cmd);
2453                         return -ENOMEM;
2454                 }
2455         }
2456
2457         memset(dcmd->mbox.b, 0, MFI_MBOX_SIZE);
2458
2459         dcmd->cmd = MFI_CMD_DCMD;
2460         dcmd->cmd_status = MFI_STAT_INVALID_STATUS;
2461         dcmd->sge_count = 1;
2462         dcmd->flags = cpu_to_le16(MFI_FRAME_DIR_BOTH);
2463         dcmd->timeout = 0;
2464         dcmd->pad_0 = 0;
2465         dcmd->data_xfer_len = cpu_to_le32((MAX_LOGICAL_DRIVES + 1) *
2466                 sizeof(struct MR_LD_VF_AFFILIATION));
2467         dcmd->opcode = cpu_to_le32(MR_DCMD_LD_VF_MAP_GET_ALL_LDS);
2468
2469         if (initial)
2470                 dcmd->sgl.sge32[0].phys_addr =
2471                         cpu_to_le32(instance->vf_affiliation_h);
2472         else
2473                 dcmd->sgl.sge32[0].phys_addr =
2474                         cpu_to_le32(new_affiliation_h);
2475
2476         dcmd->sgl.sge32[0].length = cpu_to_le32((MAX_LOGICAL_DRIVES + 1) *
2477                 sizeof(struct MR_LD_VF_AFFILIATION));
2478
2479         dev_warn(&instance->pdev->dev, "SR-IOV: Getting LD/VF affiliation for "
2480                "scsi%d\n", instance->host->host_no);
2481
2482
2483         if (megasas_issue_blocked_cmd(instance, cmd, 0) != DCMD_SUCCESS) {
2484                 dev_warn(&instance->pdev->dev, "SR-IOV: LD/VF affiliation DCMD"
2485                        " failed with status 0x%x for scsi%d\n",
2486                        dcmd->cmd_status, instance->host->host_no);
2487                 retval = 1; /* Do a scan if we couldn't get affiliation */
2488                 goto out;
2489         }
2490
2491         if (!initial) {
2492                 if (!new_affiliation->ldCount) {
2493                         dev_warn(&instance->pdev->dev, "SR-IOV: Got new LD/VF "
2494                                "affiliation for passive path for scsi%d\n",
2495                                instance->host->host_no);
2496                         retval = 1;
2497                         goto out;
2498                 }
2499                 newmap = new_affiliation->map;
2500                 savedmap = instance->vf_affiliation->map;
2501                 thisVf = new_affiliation->thisVf;
2502                 for (i = 0 ; i < new_affiliation->ldCount; i++) {
2503                         found = 0;
2504                         for (j = 0; j < instance->vf_affiliation->ldCount;
2505                              j++) {
2506                                 if (newmap->ref.targetId ==
2507                                     savedmap->ref.targetId) {
2508                                         found = 1;
2509                                         if (newmap->policy[thisVf] !=
2510                                             savedmap->policy[thisVf]) {
2511                                                 doscan = 1;
2512                                                 goto out;
2513                                         }
2514                                 }
2515                                 savedmap = (struct MR_LD_VF_MAP *)
2516                                         ((unsigned char *)savedmap +
2517                                          savedmap->size);
2518                         }
2519                         if (!found && newmap->policy[thisVf] !=
2520                             MR_LD_ACCESS_HIDDEN) {
2521                                 doscan = 1;
2522                                 goto out;
2523                         }
2524                         newmap = (struct MR_LD_VF_MAP *)
2525                                 ((unsigned char *)newmap + newmap->size);
2526                 }
2527
2528                 newmap = new_affiliation->map;
2529                 savedmap = instance->vf_affiliation->map;
2530
2531                 for (i = 0 ; i < instance->vf_affiliation->ldCount; i++) {
2532                         found = 0;
2533                         for (j = 0 ; j < new_affiliation->ldCount; j++) {
2534                                 if (savedmap->ref.targetId ==
2535                                     newmap->ref.targetId) {
2536                                         found = 1;
2537                                         if (savedmap->policy[thisVf] !=
2538                                             newmap->policy[thisVf]) {
2539                                                 doscan = 1;
2540                                                 goto out;
2541                                         }
2542                                 }
2543                                 newmap = (struct MR_LD_VF_MAP *)
2544                                         ((unsigned char *)newmap +
2545                                          newmap->size);
2546                         }
2547                         if (!found && savedmap->policy[thisVf] !=
2548                             MR_LD_ACCESS_HIDDEN) {
2549                                 doscan = 1;
2550                                 goto out;
2551                         }
2552                         savedmap = (struct MR_LD_VF_MAP *)
2553                                 ((unsigned char *)savedmap +
2554                                  savedmap->size);
2555                 }
2556         }
2557 out:
2558         if (doscan) {
2559                 dev_warn(&instance->pdev->dev, "SR-IOV: Got new LD/VF "
2560                        "affiliation for scsi%d\n", instance->host->host_no);
2561                 memcpy(instance->vf_affiliation, new_affiliation,
2562                        new_affiliation->size);
2563                 retval = 1;
2564         }
2565
2566         if (new_affiliation)
2567                 dma_free_coherent(&instance->pdev->dev,
2568                                     (MAX_LOGICAL_DRIVES + 1) *
2569                                     sizeof(struct MR_LD_VF_AFFILIATION),
2570                                     new_affiliation, new_affiliation_h);
2571         megasas_return_cmd(instance, cmd);
2572
2573         return retval;
2574 }
2575
2576 /* This function will get the current SR-IOV LD/VF affiliation */
2577 static int megasas_get_ld_vf_affiliation(struct megasas_instance *instance,
2578         int initial)
2579 {
2580         int retval;
2581
2582         if (instance->PlasmaFW111)
2583                 retval = megasas_get_ld_vf_affiliation_111(instance, initial);
2584         else
2585                 retval = megasas_get_ld_vf_affiliation_12(instance, initial);
2586         return retval;
2587 }
2588
2589 /* This function will tell FW to start the SR-IOV heartbeat */
2590 int megasas_sriov_start_heartbeat(struct megasas_instance *instance,
2591                                          int initial)
2592 {
2593         struct megasas_cmd *cmd;
2594         struct megasas_dcmd_frame *dcmd;
2595         int retval = 0;
2596
2597         cmd = megasas_get_cmd(instance);
2598
2599         if (!cmd) {
2600                 dev_printk(KERN_DEBUG, &instance->pdev->dev, "megasas_sriov_start_heartbeat: "
2601                        "Failed to get cmd for scsi%d\n",
2602                        instance->host->host_no);
2603                 return -ENOMEM;
2604         }
2605
2606         dcmd = &cmd->frame->dcmd;
2607
2608         if (initial) {
2609                 instance->hb_host_mem =
2610                         dma_alloc_coherent(&instance->pdev->dev,
2611                                            sizeof(struct MR_CTRL_HB_HOST_MEM),
2612                                            &instance->hb_host_mem_h,
2613                                            GFP_KERNEL);
2614                 if (!instance->hb_host_mem) {
2615                         dev_printk(KERN_DEBUG, &instance->pdev->dev, "SR-IOV: Couldn't allocate"
2616                                " memory for heartbeat host memory for scsi%d\n",
2617                                instance->host->host_no);
2618                         retval = -ENOMEM;
2619                         goto out;
2620                 }
2621         }
2622
2623         memset(dcmd->mbox.b, 0, MFI_MBOX_SIZE);
2624
2625         dcmd->mbox.s[0] = cpu_to_le16(sizeof(struct MR_CTRL_HB_HOST_MEM));
2626         dcmd->cmd = MFI_CMD_DCMD;
2627         dcmd->cmd_status = MFI_STAT_INVALID_STATUS;
2628         dcmd->sge_count = 1;
2629         dcmd->flags = cpu_to_le16(MFI_FRAME_DIR_BOTH);
2630         dcmd->timeout = 0;
2631         dcmd->pad_0 = 0;
2632         dcmd->data_xfer_len = cpu_to_le32(sizeof(struct MR_CTRL_HB_HOST_MEM));
2633         dcmd->opcode = cpu_to_le32(MR_DCMD_CTRL_SHARED_HOST_MEM_ALLOC);
2634
2635         megasas_set_dma_settings(instance, dcmd, instance->hb_host_mem_h,
2636                                  sizeof(struct MR_CTRL_HB_HOST_MEM));
2637
2638         dev_warn(&instance->pdev->dev, "SR-IOV: Starting heartbeat for scsi%d\n",
2639                instance->host->host_no);
2640
2641         if ((instance->adapter_type != MFI_SERIES) &&
2642             !instance->mask_interrupts)
2643                 retval = megasas_issue_blocked_cmd(instance, cmd,
2644                         MEGASAS_ROUTINE_WAIT_TIME_VF);
2645         else
2646                 retval = megasas_issue_polled(instance, cmd);
2647
2648         if (retval) {
2649                 dev_warn(&instance->pdev->dev, "SR-IOV: MR_DCMD_CTRL_SHARED_HOST"
2650                         "_MEM_ALLOC DCMD %s for scsi%d\n",
2651                         (dcmd->cmd_status == MFI_STAT_INVALID_STATUS) ?
2652                         "timed out" : "failed", instance->host->host_no);
2653                 retval = 1;
2654         }
2655
2656 out:
2657         megasas_return_cmd(instance, cmd);
2658
2659         return retval;
2660 }
2661
2662 /* Handler for SR-IOV heartbeat */
2663 static void megasas_sriov_heartbeat_handler(struct timer_list *t)
2664 {
2665         struct megasas_instance *instance =
2666                 from_timer(instance, t, sriov_heartbeat_timer);
2667
2668         if (instance->hb_host_mem->HB.fwCounter !=
2669             instance->hb_host_mem->HB.driverCounter) {
2670                 instance->hb_host_mem->HB.driverCounter =
2671                         instance->hb_host_mem->HB.fwCounter;
2672                 mod_timer(&instance->sriov_heartbeat_timer,
2673                           jiffies + MEGASAS_SRIOV_HEARTBEAT_INTERVAL_VF);
2674         } else {
2675                 dev_warn(&instance->pdev->dev, "SR-IOV: Heartbeat never "
2676                        "completed for scsi%d\n", instance->host->host_no);
2677                 schedule_work(&instance->work_init);
2678         }
2679 }
2680
2681 /**
2682  * megasas_wait_for_outstanding -       Wait for all outstanding cmds
2683  * @instance:                           Adapter soft state
2684  *
2685  * This function waits for up to MEGASAS_RESET_WAIT_TIME seconds for FW to
2686  * complete all its outstanding commands. Returns error if one or more IOs
2687  * are pending after this time period. It also marks the controller dead.
2688  */
2689 static int megasas_wait_for_outstanding(struct megasas_instance *instance)
2690 {
2691         int i, sl, outstanding;
2692         u32 reset_index;
2693         u32 wait_time = MEGASAS_RESET_WAIT_TIME;
2694         unsigned long flags;
2695         struct list_head clist_local;
2696         struct megasas_cmd *reset_cmd;
2697         u32 fw_state;
2698
2699         if (atomic_read(&instance->adprecovery) == MEGASAS_HW_CRITICAL_ERROR) {
2700                 dev_info(&instance->pdev->dev, "%s:%d HBA is killed.\n",
2701                 __func__, __LINE__);
2702                 return FAILED;
2703         }
2704
2705         if (atomic_read(&instance->adprecovery) != MEGASAS_HBA_OPERATIONAL) {
2706
2707                 INIT_LIST_HEAD(&clist_local);
2708                 spin_lock_irqsave(&instance->hba_lock, flags);
2709                 list_splice_init(&instance->internal_reset_pending_q,
2710                                 &clist_local);
2711                 spin_unlock_irqrestore(&instance->hba_lock, flags);
2712
2713                 dev_notice(&instance->pdev->dev, "HBA reset wait ...\n");
2714                 for (i = 0; i < wait_time; i++) {
2715                         msleep(1000);
2716                         if (atomic_read(&instance->adprecovery) == MEGASAS_HBA_OPERATIONAL)
2717                                 break;
2718                 }
2719
2720                 if (atomic_read(&instance->adprecovery) != MEGASAS_HBA_OPERATIONAL) {
2721                         dev_notice(&instance->pdev->dev, "reset: Stopping HBA.\n");
2722                         atomic_set(&instance->adprecovery, MEGASAS_HW_CRITICAL_ERROR);
2723                         return FAILED;
2724                 }
2725
2726                 reset_index = 0;
2727                 while (!list_empty(&clist_local)) {
2728                         reset_cmd = list_entry((&clist_local)->next,
2729                                                 struct megasas_cmd, list);
2730                         list_del_init(&reset_cmd->list);
2731                         if (reset_cmd->scmd) {
2732                                 reset_cmd->scmd->result = DID_REQUEUE << 16;
2733                                 dev_notice(&instance->pdev->dev, "%d:%p reset [%02x]\n",
2734                                         reset_index, reset_cmd,
2735                                         reset_cmd->scmd->cmnd[0]);
2736
2737                                 reset_cmd->scmd->scsi_done(reset_cmd->scmd);
2738                                 megasas_return_cmd(instance, reset_cmd);
2739                         } else if (reset_cmd->sync_cmd) {
2740                                 dev_notice(&instance->pdev->dev, "%p synch cmds"
2741                                                 "reset queue\n",
2742                                                 reset_cmd);
2743
2744                                 reset_cmd->cmd_status_drv = DCMD_INIT;
2745                                 instance->instancet->fire_cmd(instance,
2746                                                 reset_cmd->frame_phys_addr,
2747                                                 0, instance->reg_set);
2748                         } else {
2749                                 dev_notice(&instance->pdev->dev, "%p unexpected"
2750                                         "cmds lst\n",
2751                                         reset_cmd);
2752                         }
2753                         reset_index++;
2754                 }
2755
2756                 return SUCCESS;
2757         }
2758
2759         for (i = 0; i < resetwaittime; i++) {
2760                 outstanding = atomic_read(&instance->fw_outstanding);
2761
2762                 if (!outstanding)
2763                         break;
2764
2765                 if (!(i % MEGASAS_RESET_NOTICE_INTERVAL)) {
2766                         dev_notice(&instance->pdev->dev, "[%2d]waiting for %d "
2767                                "commands to complete\n",i,outstanding);
2768                         /*
2769                          * Call cmd completion routine. Cmd to be
2770                          * be completed directly without depending on isr.
2771                          */
2772                         megasas_complete_cmd_dpc((unsigned long)instance);
2773                 }
2774
2775                 msleep(1000);
2776         }
2777
2778         i = 0;
2779         outstanding = atomic_read(&instance->fw_outstanding);
2780         fw_state = instance->instancet->read_fw_status_reg(instance) & MFI_STATE_MASK;
2781
2782         if ((!outstanding && (fw_state == MFI_STATE_OPERATIONAL)))
2783                 goto no_outstanding;
2784
2785         if (instance->disableOnlineCtrlReset)
2786                 goto kill_hba_and_failed;
2787         do {
2788                 if ((fw_state == MFI_STATE_FAULT) || atomic_read(&instance->fw_outstanding)) {
2789                         dev_info(&instance->pdev->dev,
2790                                 "%s:%d waiting_for_outstanding: before issue OCR. FW state = 0x%x, outstanding 0x%x\n",
2791                                 __func__, __LINE__, fw_state, atomic_read(&instance->fw_outstanding));
2792                         if (i == 3)
2793                                 goto kill_hba_and_failed;
2794                         megasas_do_ocr(instance);
2795
2796                         if (atomic_read(&instance->adprecovery) == MEGASAS_HW_CRITICAL_ERROR) {
2797                                 dev_info(&instance->pdev->dev, "%s:%d OCR failed and HBA is killed.\n",
2798                                 __func__, __LINE__);
2799                                 return FAILED;
2800                         }
2801                         dev_info(&instance->pdev->dev, "%s:%d waiting_for_outstanding: after issue OCR.\n",
2802                                 __func__, __LINE__);
2803
2804                         for (sl = 0; sl < 10; sl++)
2805                                 msleep(500);
2806
2807                         outstanding = atomic_read(&instance->fw_outstanding);
2808
2809                         fw_state = instance->instancet->read_fw_status_reg(instance) & MFI_STATE_MASK;
2810                         if ((!outstanding && (fw_state == MFI_STATE_OPERATIONAL)))
2811                                 goto no_outstanding;
2812                 }
2813                 i++;
2814         } while (i <= 3);
2815
2816 no_outstanding:
2817
2818         dev_info(&instance->pdev->dev, "%s:%d no more pending commands remain after reset handling.\n",
2819                 __func__, __LINE__);
2820         return SUCCESS;
2821
2822 kill_hba_and_failed:
2823
2824         /* Reset not supported, kill adapter */
2825         dev_info(&instance->pdev->dev, "%s:%d killing adapter scsi%d"
2826                 " disableOnlineCtrlReset %d fw_outstanding %d \n",
2827                 __func__, __LINE__, instance->host->host_no, instance->disableOnlineCtrlReset,
2828                 atomic_read(&instance->fw_outstanding));
2829         megasas_dump_pending_frames(instance);
2830         megaraid_sas_kill_hba(instance);
2831
2832         return FAILED;
2833 }
2834
2835 /**
2836  * megasas_generic_reset -      Generic reset routine
2837  * @scmd:                       Mid-layer SCSI command
2838  *
2839  * This routine implements a generic reset handler for device, bus and host
2840  * reset requests. Device, bus and host specific reset handlers can use this
2841  * function after they do their specific tasks.
2842  */
2843 static int megasas_generic_reset(struct scsi_cmnd *scmd)
2844 {
2845         int ret_val;
2846         struct megasas_instance *instance;
2847
2848         instance = (struct megasas_instance *)scmd->device->host->hostdata;
2849
2850         scmd_printk(KERN_NOTICE, scmd, "megasas: RESET cmd=%x retries=%x\n",
2851                  scmd->cmnd[0], scmd->retries);
2852
2853         if (atomic_read(&instance->adprecovery) == MEGASAS_HW_CRITICAL_ERROR) {
2854                 dev_err(&instance->pdev->dev, "cannot recover from previous reset failures\n");
2855                 return FAILED;
2856         }
2857
2858         ret_val = megasas_wait_for_outstanding(instance);
2859         if (ret_val == SUCCESS)
2860                 dev_notice(&instance->pdev->dev, "reset successful\n");
2861         else
2862                 dev_err(&instance->pdev->dev, "failed to do reset\n");
2863
2864         return ret_val;
2865 }
2866
2867 /**
2868  * megasas_reset_timer - quiesce the adapter if required
2869  * @scmd:               scsi cmnd
2870  *
2871  * Sets the FW busy flag and reduces the host->can_queue if the
2872  * cmd has not been completed within the timeout period.
2873  */
2874 static enum
2875 blk_eh_timer_return megasas_reset_timer(struct scsi_cmnd *scmd)
2876 {
2877         struct megasas_instance *instance;
2878         unsigned long flags;
2879
2880         if (time_after(jiffies, scmd->jiffies_at_alloc +
2881                                 (scmd_timeout * 2) * HZ)) {
2882                 return BLK_EH_DONE;
2883         }
2884
2885         instance = (struct megasas_instance *)scmd->device->host->hostdata;
2886         if (!(instance->flag & MEGASAS_FW_BUSY)) {
2887                 /* FW is busy, throttle IO */
2888                 spin_lock_irqsave(instance->host->host_lock, flags);
2889
2890                 instance->host->can_queue = instance->throttlequeuedepth;
2891                 instance->last_time = jiffies;
2892                 instance->flag |= MEGASAS_FW_BUSY;
2893
2894                 spin_unlock_irqrestore(instance->host->host_lock, flags);
2895         }
2896         return BLK_EH_RESET_TIMER;
2897 }
2898
2899 /**
2900  * megasas_dump -       This function will print hexdump of provided buffer.
2901  * @buf:                Buffer to be dumped
2902  * @sz:         Size in bytes
2903  * @format:             Different formats of dumping e.g. format=n will
2904  *                      cause only 'n' 32 bit words to be dumped in a single
2905  *                      line.
2906  */
2907 inline void
2908 megasas_dump(void *buf, int sz, int format)
2909 {
2910         int i;
2911         __le32 *buf_loc = (__le32 *)buf;
2912
2913         for (i = 0; i < (sz / sizeof(__le32)); i++) {
2914                 if ((i % format) == 0) {
2915                         if (i != 0)
2916                                 printk(KERN_CONT "\n");
2917                         printk(KERN_CONT "%08x: ", (i * 4));
2918                 }
2919                 printk(KERN_CONT "%08x ", le32_to_cpu(buf_loc[i]));
2920         }
2921         printk(KERN_CONT "\n");
2922 }
2923
2924 /**
2925  * megasas_dump_reg_set -       This function will print hexdump of register set
2926  * @reg_set:    Register set to be dumped
2927  */
2928 inline void
2929 megasas_dump_reg_set(void __iomem *reg_set)
2930 {
2931         unsigned int i, sz = 256;
2932         u32 __iomem *reg = (u32 __iomem *)reg_set;
2933
2934         for (i = 0; i < (sz / sizeof(u32)); i++)
2935                 printk("%08x: %08x\n", (i * 4), readl(&reg[i]));
2936 }
2937
2938 /**
2939  * megasas_dump_fusion_io -     This function will print key details
2940  *                              of SCSI IO
2941  * @scmd:                       SCSI command pointer of SCSI IO
2942  */
2943 void
2944 megasas_dump_fusion_io(struct scsi_cmnd *scmd)
2945 {
2946         struct megasas_cmd_fusion *cmd;
2947         union MEGASAS_REQUEST_DESCRIPTOR_UNION *req_desc;
2948         struct megasas_instance *instance;
2949
2950         cmd = (struct megasas_cmd_fusion *)scmd->SCp.ptr;
2951         instance = (struct megasas_instance *)scmd->device->host->hostdata;
2952
2953         scmd_printk(KERN_INFO, scmd,
2954                     "scmd: (0x%p)  retries: 0x%x  allowed: 0x%x\n",
2955                     scmd, scmd->retries, scmd->allowed);
2956         scsi_print_command(scmd);
2957
2958         if (cmd) {
2959                 req_desc = (union MEGASAS_REQUEST_DESCRIPTOR_UNION *)cmd->request_desc;
2960                 scmd_printk(KERN_INFO, scmd, "Request descriptor details:\n");
2961                 scmd_printk(KERN_INFO, scmd,
2962                             "RequestFlags:0x%x  MSIxIndex:0x%x  SMID:0x%x  LMID:0x%x  DevHandle:0x%x\n",
2963                             req_desc->SCSIIO.RequestFlags,
2964                             req_desc->SCSIIO.MSIxIndex, req_desc->SCSIIO.SMID,
2965                             req_desc->SCSIIO.LMID, req_desc->SCSIIO.DevHandle);
2966
2967                 printk(KERN_INFO "IO request frame:\n");
2968                 megasas_dump(cmd->io_request,
2969                              MEGA_MPI2_RAID_DEFAULT_IO_FRAME_SIZE, 8);
2970                 printk(KERN_INFO "Chain frame:\n");
2971                 megasas_dump(cmd->sg_frame,
2972                              instance->max_chain_frame_sz, 8);
2973         }
2974
2975 }
2976
2977 /*
2978  * megasas_dump_sys_regs - This function will dump system registers through
2979  *                          sysfs.
2980  * @reg_set:                Pointer to System register set.
2981  * @buf:                    Buffer to which output is to be written.
2982  * @return:                 Number of bytes written to buffer.
2983  */
2984 static inline ssize_t
2985 megasas_dump_sys_regs(void __iomem *reg_set, char *buf)
2986 {
2987         unsigned int i, sz = 256;
2988         int bytes_wrote = 0;
2989         char *loc = (char *)buf;
2990         u32 __iomem *reg = (u32 __iomem *)reg_set;
2991
2992         for (i = 0; i < sz / sizeof(u32); i++) {
2993                 bytes_wrote += scnprintf(loc + bytes_wrote,
2994                                          PAGE_SIZE - bytes_wrote,
2995                                          "%08x: %08x\n", (i * 4),
2996                                          readl(&reg[i]));
2997         }
2998         return bytes_wrote;
2999 }
3000
3001 /**
3002  * megasas_reset_bus_host -     Bus & host reset handler entry point
3003  * @scmd:                       Mid-layer SCSI command
3004  */
3005 static int megasas_reset_bus_host(struct scsi_cmnd *scmd)
3006 {
3007         int ret;
3008         struct megasas_instance *instance;
3009
3010         instance = (struct megasas_instance *)scmd->device->host->hostdata;
3011
3012         scmd_printk(KERN_INFO, scmd,
3013                 "OCR is requested due to IO timeout!!\n");
3014
3015         scmd_printk(KERN_INFO, scmd,
3016                 "SCSI host state: %d  SCSI host busy: %d  FW outstanding: %d\n",
3017                 scmd->device->host->shost_state,
3018                 scsi_host_busy(scmd->device->host),
3019                 atomic_read(&instance->fw_outstanding));
3020         /*
3021          * First wait for all commands to complete
3022          */
3023         if (instance->adapter_type == MFI_SERIES) {
3024                 ret = megasas_generic_reset(scmd);
3025         } else {
3026                 megasas_dump_fusion_io(scmd);
3027                 ret = megasas_reset_fusion(scmd->device->host,
3028                                 SCSIIO_TIMEOUT_OCR);
3029         }
3030
3031         return ret;
3032 }
3033
3034 /**
3035  * megasas_task_abort - Issues task abort request to firmware
3036  *                      (supported only for fusion adapters)
3037  * @scmd:               SCSI command pointer
3038  */
3039 static int megasas_task_abort(struct scsi_cmnd *scmd)
3040 {
3041         int ret;
3042         struct megasas_instance *instance;
3043
3044         instance = (struct megasas_instance *)scmd->device->host->hostdata;
3045
3046         if (instance->adapter_type != MFI_SERIES)
3047                 ret = megasas_task_abort_fusion(scmd);
3048         else {
3049                 sdev_printk(KERN_NOTICE, scmd->device, "TASK ABORT not supported\n");
3050                 ret = FAILED;
3051         }
3052
3053         return ret;
3054 }
3055
3056 /**
3057  * megasas_reset_target:  Issues target reset request to firmware
3058  *                        (supported only for fusion adapters)
3059  * @scmd:                 SCSI command pointer
3060  */
3061 static int megasas_reset_target(struct scsi_cmnd *scmd)
3062 {
3063         int ret;
3064         struct megasas_instance *instance;
3065
3066         instance = (struct megasas_instance *)scmd->device->host->hostdata;
3067
3068         if (instance->adapter_type != MFI_SERIES)
3069                 ret = megasas_reset_target_fusion(scmd);
3070         else {
3071                 sdev_printk(KERN_NOTICE, scmd->device, "TARGET RESET not supported\n");
3072                 ret = FAILED;
3073         }
3074
3075         return ret;
3076 }
3077
3078 /**
3079  * megasas_bios_param - Returns disk geometry for a disk
3080  * @sdev:               device handle
3081  * @bdev:               block device
3082  * @capacity:           drive capacity
3083  * @geom:               geometry parameters
3084  */
3085 static int
3086 megasas_bios_param(struct scsi_device *sdev, struct block_device *bdev,
3087                  sector_t capacity, int geom[])
3088 {
3089         int heads;
3090         int sectors;
3091         sector_t cylinders;
3092         unsigned long tmp;
3093
3094         /* Default heads (64) & sectors (32) */
3095         heads = 64;
3096         sectors = 32;
3097
3098         tmp = heads * sectors;
3099         cylinders = capacity;
3100
3101         sector_div(cylinders, tmp);
3102
3103         /*
3104          * Handle extended translation size for logical drives > 1Gb
3105          */
3106
3107         if (capacity >= 0x200000) {
3108                 heads = 255;
3109                 sectors = 63;
3110                 tmp = heads*sectors;
3111                 cylinders = capacity;
3112                 sector_div(cylinders, tmp);
3113         }
3114
3115         geom[0] = heads;
3116         geom[1] = sectors;
3117         geom[2] = cylinders;
3118
3119         return 0;
3120 }
3121
3122 static void megasas_aen_polling(struct work_struct *work);
3123
3124 /**
3125  * megasas_service_aen -        Processes an event notification
3126  * @instance:                   Adapter soft state
3127  * @cmd:                        AEN command completed by the ISR
3128  *
3129  * For AEN, driver sends a command down to FW that is held by the FW till an
3130  * event occurs. When an event of interest occurs, FW completes the command
3131  * that it was previously holding.
3132  *
3133  * This routines sends SIGIO signal to processes that have registered with the
3134  * driver for AEN.
3135  */
3136 static void
3137 megasas_service_aen(struct megasas_instance *instance, struct megasas_cmd *cmd)
3138 {
3139         unsigned long flags;
3140
3141         /*
3142          * Don't signal app if it is just an aborted previously registered aen
3143          */
3144         if ((!cmd->abort_aen) && (instance->unload == 0)) {
3145                 spin_lock_irqsave(&poll_aen_lock, flags);
3146                 megasas_poll_wait_aen = 1;
3147                 spin_unlock_irqrestore(&poll_aen_lock, flags);
3148                 wake_up(&megasas_poll_wait);
3149                 kill_fasync(&megasas_async_queue, SIGIO, POLL_IN);
3150         }
3151         else
3152                 cmd->abort_aen = 0;
3153
3154         instance->aen_cmd = NULL;
3155
3156         megasas_return_cmd(instance, cmd);
3157
3158         if ((instance->unload == 0) &&
3159                 ((instance->issuepend_done == 1))) {
3160                 struct megasas_aen_event *ev;
3161
3162                 ev = kzalloc(sizeof(*ev), GFP_ATOMIC);
3163                 if (!ev) {
3164                         dev_err(&instance->pdev->dev, "megasas_service_aen: out of memory\n");
3165                 } else {
3166                         ev->instance = instance;
3167                         instance->ev = ev;
3168                         INIT_DELAYED_WORK(&ev->hotplug_work,
3169                                           megasas_aen_polling);
3170                         schedule_delayed_work(&ev->hotplug_work, 0);
3171                 }
3172         }
3173 }
3174
3175 static ssize_t
3176 fw_crash_buffer_store(struct device *cdev,
3177         struct device_attribute *attr, const char *buf, size_t count)
3178 {
3179         struct Scsi_Host *shost = class_to_shost(cdev);
3180         struct megasas_instance *instance =
3181                 (struct megasas_instance *) shost->hostdata;
3182         int val = 0;
3183         unsigned long flags;
3184
3185         if (kstrtoint(buf, 0, &val) != 0)
3186                 return -EINVAL;
3187
3188         spin_lock_irqsave(&instance->crashdump_lock, flags);
3189         instance->fw_crash_buffer_offset = val;
3190         spin_unlock_irqrestore(&instance->crashdump_lock, flags);
3191         return strlen(buf);
3192 }
3193
3194 static ssize_t
3195 fw_crash_buffer_show(struct device *cdev,
3196         struct device_attribute *attr, char *buf)
3197 {
3198         struct Scsi_Host *shost = class_to_shost(cdev);
3199         struct megasas_instance *instance =
3200                 (struct megasas_instance *) shost->hostdata;
3201         u32 size;
3202         unsigned long dmachunk = CRASH_DMA_BUF_SIZE;
3203         unsigned long chunk_left_bytes;
3204         unsigned long src_addr;
3205         unsigned long flags;
3206         u32 buff_offset;
3207
3208         spin_lock_irqsave(&instance->crashdump_lock, flags);
3209         buff_offset = instance->fw_crash_buffer_offset;
3210         if (!instance->crash_dump_buf &&
3211                 !((instance->fw_crash_state == AVAILABLE) ||
3212                 (instance->fw_crash_state == COPYING))) {
3213                 dev_err(&instance->pdev->dev,
3214                         "Firmware crash dump is not available\n");
3215                 spin_unlock_irqrestore(&instance->crashdump_lock, flags);
3216                 return -EINVAL;
3217         }
3218
3219         if (buff_offset > (instance->fw_crash_buffer_size * dmachunk)) {
3220                 dev_err(&instance->pdev->dev,
3221                         "Firmware crash dump offset is out of range\n");
3222                 spin_unlock_irqrestore(&instance->crashdump_lock, flags);
3223                 return 0;
3224         }
3225
3226         size = (instance->fw_crash_buffer_size * dmachunk) - buff_offset;
3227         chunk_left_bytes = dmachunk - (buff_offset % dmachunk);
3228         size = (size > chunk_left_bytes) ? chunk_left_bytes : size;
3229         size = (size >= PAGE_SIZE) ? (PAGE_SIZE - 1) : size;
3230
3231         src_addr = (unsigned long)instance->crash_buf[buff_offset / dmachunk] +
3232                 (buff_offset % dmachunk);
3233         memcpy(buf, (void *)src_addr, size);
3234         spin_unlock_irqrestore(&instance->crashdump_lock, flags);
3235
3236         return size;
3237 }
3238
3239 static ssize_t
3240 fw_crash_buffer_size_show(struct device *cdev,
3241         struct device_attribute *attr, char *buf)
3242 {
3243         struct Scsi_Host *shost = class_to_shost(cdev);
3244         struct megasas_instance *instance =
3245                 (struct megasas_instance *) shost->hostdata;
3246
3247         return snprintf(buf, PAGE_SIZE, "%ld\n", (unsigned long)
3248                 ((instance->fw_crash_buffer_size) * 1024 * 1024)/PAGE_SIZE);
3249 }
3250
3251 static ssize_t
3252 fw_crash_state_store(struct device *cdev,
3253         struct device_attribute *attr, const char *buf, size_t count)
3254 {
3255         struct Scsi_Host *shost = class_to_shost(cdev);
3256         struct megasas_instance *instance =
3257                 (struct megasas_instance *) shost->hostdata;
3258         int val = 0;
3259         unsigned long flags;
3260
3261         if (kstrtoint(buf, 0, &val) != 0)
3262                 return -EINVAL;
3263
3264         if ((val <= AVAILABLE || val > COPY_ERROR)) {
3265                 dev_err(&instance->pdev->dev, "application updates invalid "
3266                         "firmware crash state\n");
3267                 return -EINVAL;
3268         }
3269
3270         instance->fw_crash_state = val;
3271
3272         if ((val == COPIED) || (val == COPY_ERROR)) {
3273                 spin_lock_irqsave(&instance->crashdump_lock, flags);
3274                 megasas_free_host_crash_buffer(instance);
3275                 spin_unlock_irqrestore(&instance->crashdump_lock, flags);
3276                 if (val == COPY_ERROR)
3277                         dev_info(&instance->pdev->dev, "application failed to "
3278                                 "copy Firmware crash dump\n");
3279                 else
3280                         dev_info(&instance->pdev->dev, "Firmware crash dump "
3281                                 "copied successfully\n");
3282         }
3283         return strlen(buf);
3284 }
3285
3286 static ssize_t
3287 fw_crash_state_show(struct device *cdev,
3288         struct device_attribute *attr, char *buf)
3289 {
3290         struct Scsi_Host *shost = class_to_shost(cdev);
3291         struct megasas_instance *instance =
3292                 (struct megasas_instance *) shost->hostdata;
3293
3294         return snprintf(buf, PAGE_SIZE, "%d\n", instance->fw_crash_state);
3295 }
3296
3297 static ssize_t
3298 page_size_show(struct device *cdev,
3299         struct device_attribute *attr, char *buf)
3300 {
3301         return snprintf(buf, PAGE_SIZE, "%ld\n", (unsigned long)PAGE_SIZE - 1);
3302 }
3303
3304 static ssize_t
3305 ldio_outstanding_show(struct device *cdev, struct device_attribute *attr,
3306         char *buf)
3307 {
3308         struct Scsi_Host *shost = class_to_shost(cdev);
3309         struct megasas_instance *instance = (struct megasas_instance *)shost->hostdata;
3310
3311         return snprintf(buf, PAGE_SIZE, "%d\n", atomic_read(&instance->ldio_outstanding));
3312 }
3313
3314 static ssize_t
3315 fw_cmds_outstanding_show(struct device *cdev,
3316                                  struct device_attribute *attr, char *buf)
3317 {
3318         struct Scsi_Host *shost = class_to_shost(cdev);
3319         struct megasas_instance *instance = (struct megasas_instance *)shost->hostdata;
3320
3321         return snprintf(buf, PAGE_SIZE, "%d\n", atomic_read(&instance->fw_outstanding));
3322 }
3323
3324 static ssize_t
3325 enable_sdev_max_qd_show(struct device *cdev,
3326         struct device_attribute *attr, char *buf)
3327 {
3328         struct Scsi_Host *shost = class_to_shost(cdev);
3329         struct megasas_instance *instance = (struct megasas_instance *)shost->hostdata;
3330
3331         return snprintf(buf, PAGE_SIZE, "%d\n", instance->enable_sdev_max_qd);
3332 }
3333
3334 static ssize_t
3335 enable_sdev_max_qd_store(struct device *cdev,
3336         struct device_attribute *attr, const char *buf, size_t count)
3337 {
3338         struct Scsi_Host *shost = class_to_shost(cdev);
3339         struct megasas_instance *instance = (struct megasas_instance *)shost->hostdata;
3340         u32 val = 0;
3341         bool is_target_prop;
3342         int ret_target_prop = DCMD_FAILED;
3343         struct scsi_device *sdev;
3344
3345         if (kstrtou32(buf, 0, &val) != 0) {
3346                 pr_err("megasas: could not set enable_sdev_max_qd\n");
3347                 return -EINVAL;
3348         }
3349
3350         mutex_lock(&instance->reset_mutex);
3351         if (val)
3352                 instance->enable_sdev_max_qd = true;
3353         else
3354                 instance->enable_sdev_max_qd = false;
3355
3356         shost_for_each_device(sdev, shost) {
3357                 ret_target_prop = megasas_get_target_prop(instance, sdev);
3358                 is_target_prop = (ret_target_prop == DCMD_SUCCESS) ? true : false;
3359                 megasas_set_fw_assisted_qd(sdev, is_target_prop);
3360         }
3361         mutex_unlock(&instance->reset_mutex);
3362
3363         return strlen(buf);
3364 }
3365
3366 static ssize_t
3367 dump_system_regs_show(struct device *cdev,
3368                                struct device_attribute *attr, char *buf)
3369 {
3370         struct Scsi_Host *shost = class_to_shost(cdev);
3371         struct megasas_instance *instance =
3372                         (struct megasas_instance *)shost->hostdata;
3373
3374         return megasas_dump_sys_regs(instance->reg_set, buf);
3375 }
3376
3377 static ssize_t
3378 raid_map_id_show(struct device *cdev, struct device_attribute *attr,
3379                           char *buf)
3380 {
3381         struct Scsi_Host *shost = class_to_shost(cdev);
3382         struct megasas_instance *instance =
3383                         (struct megasas_instance *)shost->hostdata;
3384
3385         return snprintf(buf, PAGE_SIZE, "%ld\n",
3386                         (unsigned long)instance->map_id);
3387 }
3388
3389 static DEVICE_ATTR_RW(fw_crash_buffer);
3390 static DEVICE_ATTR_RO(fw_crash_buffer_size);
3391 static DEVICE_ATTR_RW(fw_crash_state);
3392 static DEVICE_ATTR_RO(page_size);
3393 static DEVICE_ATTR_RO(ldio_outstanding);
3394 static DEVICE_ATTR_RO(fw_cmds_outstanding);
3395 static DEVICE_ATTR_RW(enable_sdev_max_qd);
3396 static DEVICE_ATTR_RO(dump_system_regs);
3397 static DEVICE_ATTR_RO(raid_map_id);
3398
3399 static struct device_attribute *megaraid_host_attrs[] = {
3400         &dev_attr_fw_crash_buffer_size,
3401         &dev_attr_fw_crash_buffer,
3402         &dev_attr_fw_crash_state,
3403         &dev_attr_page_size,
3404         &dev_attr_ldio_outstanding,
3405         &dev_attr_fw_cmds_outstanding,
3406         &dev_attr_enable_sdev_max_qd,
3407         &dev_attr_dump_system_regs,
3408         &dev_attr_raid_map_id,
3409         NULL,
3410 };
3411
3412 /*
3413  * Scsi host template for megaraid_sas driver
3414  */
3415 static struct scsi_host_template megasas_template = {
3416
3417         .module = THIS_MODULE,
3418         .name = "Avago SAS based MegaRAID driver",
3419         .proc_name = "megaraid_sas",
3420         .slave_configure = megasas_slave_configure,
3421         .slave_alloc = megasas_slave_alloc,
3422         .slave_destroy = megasas_slave_destroy,
3423         .queuecommand = megasas_queue_command,
3424         .eh_target_reset_handler = megasas_reset_target,
3425         .eh_abort_handler = megasas_task_abort,
3426         .eh_host_reset_handler = megasas_reset_bus_host,
3427         .eh_timed_out = megasas_reset_timer,
3428         .shost_attrs = megaraid_host_attrs,
3429         .bios_param = megasas_bios_param,
3430         .change_queue_depth = scsi_change_queue_depth,
3431         .max_segment_size = 0xffffffff,
3432 };
3433
3434 /**
3435  * megasas_complete_int_cmd -   Completes an internal command
3436  * @instance:                   Adapter soft state
3437  * @cmd:                        Command to be completed
3438  *
3439  * The megasas_issue_blocked_cmd() function waits for a command to complete
3440  * after it issues a command. This function wakes up that waiting routine by
3441  * calling wake_up() on the wait queue.
3442  */
3443 static void
3444 megasas_complete_int_cmd(struct megasas_instance *instance,
3445                          struct megasas_cmd *cmd)
3446 {
3447         if (cmd->cmd_status_drv == DCMD_INIT)
3448                 cmd->cmd_status_drv =
3449                 (cmd->frame->io.cmd_status == MFI_STAT_OK) ?
3450                 DCMD_SUCCESS : DCMD_FAILED;
3451
3452         wake_up(&instance->int_cmd_wait_q);
3453 }
3454
3455 /**
3456  * megasas_complete_abort -     Completes aborting a command
3457  * @instance:                   Adapter soft state
3458  * @cmd:                        Cmd that was issued to abort another cmd
3459  *
3460  * The megasas_issue_blocked_abort_cmd() function waits on abort_cmd_wait_q
3461  * after it issues an abort on a previously issued command. This function
3462  * wakes up all functions waiting on the same wait queue.
3463  */
3464 static void
3465 megasas_complete_abort(struct megasas_instance *instance,
3466                        struct megasas_cmd *cmd)
3467 {
3468         if (cmd->sync_cmd) {
3469                 cmd->sync_cmd = 0;
3470                 cmd->cmd_status_drv = DCMD_SUCCESS;
3471                 wake_up(&instance->abort_cmd_wait_q);
3472         }
3473 }
3474
3475 /**
3476  * megasas_complete_cmd -       Completes a command
3477  * @instance:                   Adapter soft state
3478  * @cmd:                        Command to be completed
3479  * @alt_status:                 If non-zero, use this value as status to
3480  *                              SCSI mid-layer instead of the value returned
3481  *                              by the FW. This should be used if caller wants
3482  *                              an alternate status (as in the case of aborted
3483  *                              commands)
3484  */
3485 void
3486 megasas_complete_cmd(struct megasas_instance *instance, struct megasas_cmd *cmd,
3487                      u8 alt_status)
3488 {
3489         int exception = 0;
3490         struct megasas_header *hdr = &cmd->frame->hdr;
3491         unsigned long flags;
3492         struct fusion_context *fusion = instance->ctrl_context;
3493         u32 opcode, status;
3494
3495         /* flag for the retry reset */
3496         cmd->retry_for_fw_reset = 0;
3497
3498         if (cmd->scmd)
3499                 cmd->scmd->SCp.ptr = NULL;
3500
3501         switch (hdr->cmd) {
3502         case MFI_CMD_INVALID:
3503                 /* Some older 1068 controller FW may keep a pended
3504                    MR_DCMD_CTRL_EVENT_GET_INFO left over from the main kernel
3505                    when booting the kdump kernel.  Ignore this command to
3506                    prevent a kernel panic on shutdown of the kdump kernel. */
3507                 dev_warn(&instance->pdev->dev, "MFI_CMD_INVALID command "
3508                        "completed\n");
3509                 dev_warn(&instance->pdev->dev, "If you have a controller "
3510                        "other than PERC5, please upgrade your firmware\n");
3511                 break;
3512         case MFI_CMD_PD_SCSI_IO:
3513         case MFI_CMD_LD_SCSI_IO:
3514
3515                 /*
3516                  * MFI_CMD_PD_SCSI_IO and MFI_CMD_LD_SCSI_IO could have been
3517                  * issued either through an IO path or an IOCTL path. If it
3518                  * was via IOCTL, we will send it to internal completion.
3519                  */
3520                 if (cmd->sync_cmd) {
3521                         cmd->sync_cmd = 0;
3522                         megasas_complete_int_cmd(instance, cmd);
3523                         break;
3524                 }
3525                 fallthrough;
3526
3527         case MFI_CMD_LD_READ:
3528         case MFI_CMD_LD_WRITE:
3529
3530                 if (alt_status) {
3531                         cmd->scmd->result = alt_status << 16;
3532                         exception = 1;
3533                 }
3534
3535                 if (exception) {
3536
3537                         atomic_dec(&instance->fw_outstanding);
3538
3539                         scsi_dma_unmap(cmd->scmd);
3540                         cmd->scmd->scsi_done(cmd->scmd);
3541                         megasas_return_cmd(instance, cmd);
3542
3543                         break;
3544                 }
3545
3546                 switch (hdr->cmd_status) {
3547
3548                 case MFI_STAT_OK:
3549                         cmd->scmd->result = DID_OK << 16;
3550                         break;
3551
3552                 case MFI_STAT_SCSI_IO_FAILED:
3553                 case MFI_STAT_LD_INIT_IN_PROGRESS:
3554                         cmd->scmd->result =
3555                             (DID_ERROR << 16) | hdr->scsi_status;
3556                         break;
3557
3558                 case MFI_STAT_SCSI_DONE_WITH_ERROR:
3559
3560                         cmd->scmd->result = (DID_OK << 16) | hdr->scsi_status;
3561
3562                         if (hdr->scsi_status == SAM_STAT_CHECK_CONDITION) {
3563                                 memset(cmd->scmd->sense_buffer, 0,
3564                                        SCSI_SENSE_BUFFERSIZE);
3565                                 memcpy(cmd->scmd->sense_buffer, cmd->sense,
3566                                        hdr->sense_len);
3567
3568                                 cmd->scmd->result |= DRIVER_SENSE << 24;
3569                         }
3570
3571                         break;
3572
3573                 case MFI_STAT_LD_OFFLINE:
3574                 case MFI_STAT_DEVICE_NOT_FOUND:
3575                         cmd->scmd->result = DID_BAD_TARGET << 16;
3576                         break;
3577
3578                 default:
3579                         dev_printk(KERN_DEBUG, &instance->pdev->dev, "MFI FW status %#x\n",
3580                                hdr->cmd_status);
3581                         cmd->scmd->result = DID_ERROR << 16;
3582                         break;
3583                 }
3584
3585                 atomic_dec(&instance->fw_outstanding);
3586
3587                 scsi_dma_unmap(cmd->scmd);
3588                 cmd->scmd->scsi_done(cmd->scmd);
3589                 megasas_return_cmd(instance, cmd);
3590
3591                 break;
3592
3593         case MFI_CMD_SMP:
3594         case MFI_CMD_STP:
3595         case MFI_CMD_NVME:
3596         case MFI_CMD_TOOLBOX:
3597                 megasas_complete_int_cmd(instance, cmd);
3598                 break;
3599
3600         case MFI_CMD_DCMD:
3601                 opcode = le32_to_cpu(cmd->frame->dcmd.opcode);
3602                 /* Check for LD map update */
3603                 if ((opcode == MR_DCMD_LD_MAP_GET_INFO)
3604                         && (cmd->frame->dcmd.mbox.b[1] == 1)) {
3605                         fusion->fast_path_io = 0;
3606                         spin_lock_irqsave(instance->host->host_lock, flags);
3607                         status = cmd->frame->hdr.cmd_status;
3608                         instance->map_update_cmd = NULL;
3609                         if (status != MFI_STAT_OK) {
3610                                 if (status != MFI_STAT_NOT_FOUND)
3611                                         dev_warn(&instance->pdev->dev, "map syncfailed, status = 0x%x\n",
3612                                                cmd->frame->hdr.cmd_status);
3613                                 else {
3614                                         megasas_return_cmd(instance, cmd);
3615                                         spin_unlock_irqrestore(
3616                                                 instance->host->host_lock,
3617                                                 flags);
3618                                         break;
3619                                 }
3620                         }
3621
3622                         megasas_return_cmd(instance, cmd);
3623
3624                         /*
3625                          * Set fast path IO to ZERO.
3626                          * Validate Map will set proper value.
3627                          * Meanwhile all IOs will go as LD IO.
3628                          */
3629                         if (status == MFI_STAT_OK &&
3630                             (MR_ValidateMapInfo(instance, (instance->map_id + 1)))) {
3631                                 instance->map_id++;
3632                                 fusion->fast_path_io = 1;
3633                         } else {
3634                                 fusion->fast_path_io = 0;
3635                         }
3636
3637                         megasas_sync_map_info(instance);
3638                         spin_unlock_irqrestore(instance->host->host_lock,
3639                                                flags);
3640                         break;
3641                 }
3642                 if (opcode == MR_DCMD_CTRL_EVENT_GET_INFO ||
3643                     opcode == MR_DCMD_CTRL_EVENT_GET) {
3644                         spin_lock_irqsave(&poll_aen_lock, flags);
3645                         megasas_poll_wait_aen = 0;
3646                         spin_unlock_irqrestore(&poll_aen_lock, flags);
3647                 }
3648
3649                 /* FW has an updated PD sequence */
3650                 if ((opcode == MR_DCMD_SYSTEM_PD_MAP_GET_INFO) &&
3651                         (cmd->frame->dcmd.mbox.b[0] == 1)) {
3652
3653                         spin_lock_irqsave(instance->host->host_lock, flags);
3654                         status = cmd->frame->hdr.cmd_status;
3655                         instance->jbod_seq_cmd = NULL;
3656                         megasas_return_cmd(instance, cmd);
3657
3658                         if (status == MFI_STAT_OK) {
3659                                 instance->pd_seq_map_id++;
3660                                 /* Re-register a pd sync seq num cmd */
3661                                 if (megasas_sync_pd_seq_num(instance, true))
3662                                         instance->use_seqnum_jbod_fp = false;
3663                         } else
3664                                 instance->use_seqnum_jbod_fp = false;
3665
3666                         spin_unlock_irqrestore(instance->host->host_lock, flags);
3667                         break;
3668                 }
3669
3670                 /*
3671                  * See if got an event notification
3672                  */
3673                 if (opcode == MR_DCMD_CTRL_EVENT_WAIT)
3674                         megasas_service_aen(instance, cmd);
3675                 else
3676                         megasas_complete_int_cmd(instance, cmd);
3677
3678                 break;
3679
3680         case MFI_CMD_ABORT:
3681                 /*
3682                  * Cmd issued to abort another cmd returned
3683                  */
3684                 megasas_complete_abort(instance, cmd);
3685                 break;
3686
3687         default:
3688                 dev_info(&instance->pdev->dev, "Unknown command completed! [0x%X]\n",
3689                        hdr->cmd);
3690                 megasas_complete_int_cmd(instance, cmd);
3691                 break;
3692         }
3693 }
3694
3695 /**
3696  * megasas_issue_pending_cmds_again -   issue all pending cmds
3697  *                                      in FW again because of the fw reset
3698  * @instance:                           Adapter soft state
3699  */
3700 static inline void
3701 megasas_issue_pending_cmds_again(struct megasas_instance *instance)
3702 {
3703         struct megasas_cmd *cmd;
3704         struct list_head clist_local;
3705         union megasas_evt_class_locale class_locale;
3706         unsigned long flags;
3707         u32 seq_num;
3708
3709         INIT_LIST_HEAD(&clist_local);
3710         spin_lock_irqsave(&instance->hba_lock, flags);
3711         list_splice_init(&instance->internal_reset_pending_q, &clist_local);
3712         spin_unlock_irqrestore(&instance->hba_lock, flags);
3713
3714         while (!list_empty(&clist_local)) {
3715                 cmd = list_entry((&clist_local)->next,
3716                                         struct megasas_cmd, list);
3717                 list_del_init(&cmd->list);
3718
3719                 if (cmd->sync_cmd || cmd->scmd) {
3720                         dev_notice(&instance->pdev->dev, "command %p, %p:%d"
3721                                 "detected to be pending while HBA reset\n",
3722                                         cmd, cmd->scmd, cmd->sync_cmd);
3723
3724                         cmd->retry_for_fw_reset++;
3725
3726                         if (cmd->retry_for_fw_reset == 3) {
3727                                 dev_notice(&instance->pdev->dev, "cmd %p, %p:%d"
3728                                         "was tried multiple times during reset."
3729                                         "Shutting down the HBA\n",
3730                                         cmd, cmd->scmd, cmd->sync_cmd);
3731                                 instance->instancet->disable_intr(instance);
3732                                 atomic_set(&instance->fw_reset_no_pci_access, 1);
3733                                 megaraid_sas_kill_hba(instance);
3734                                 return;
3735                         }
3736                 }
3737
3738                 if (cmd->sync_cmd == 1) {
3739                         if (cmd->scmd) {
3740                                 dev_notice(&instance->pdev->dev, "unexpected"
3741                                         "cmd attached to internal command!\n");
3742                         }
3743                         dev_notice(&instance->pdev->dev, "%p synchronous cmd"
3744                                                 "on the internal reset queue,"
3745                                                 "issue it again.\n", cmd);
3746                         cmd->cmd_status_drv = DCMD_INIT;
3747                         instance->instancet->fire_cmd(instance,
3748                                                         cmd->frame_phys_addr,
3749                                                         0, instance->reg_set);
3750                 } else if (cmd->scmd) {
3751                         dev_notice(&instance->pdev->dev, "%p scsi cmd [%02x]"
3752                         "detected on the internal queue, issue again.\n",
3753                         cmd, cmd->scmd->cmnd[0]);
3754
3755                         atomic_inc(&instance->fw_outstanding);
3756                         instance->instancet->fire_cmd(instance,
3757                                         cmd->frame_phys_addr,
3758                                         cmd->frame_count-1, instance->reg_set);
3759                 } else {
3760                         dev_notice(&instance->pdev->dev, "%p unexpected cmd on the"
3761                                 "internal reset defer list while re-issue!!\n",
3762                                 cmd);
3763                 }
3764         }
3765
3766         if (instance->aen_cmd) {
3767                 dev_notice(&instance->pdev->dev, "aen_cmd in def process\n");
3768                 megasas_return_cmd(instance, instance->aen_cmd);
3769
3770                 instance->aen_cmd = NULL;
3771         }
3772
3773         /*
3774          * Initiate AEN (Asynchronous Event Notification)
3775          */
3776         seq_num = instance->last_seq_num;
3777         class_locale.members.reserved = 0;
3778         class_locale.members.locale = MR_EVT_LOCALE_ALL;
3779         class_locale.members.class = MR_EVT_CLASS_DEBUG;
3780
3781         megasas_register_aen(instance, seq_num, class_locale.word);
3782 }
3783
3784 /*
3785  * Move the internal reset pending commands to a deferred queue.
3786  *
3787  * We move the commands pending at internal reset time to a
3788  * pending queue. This queue would be flushed after successful
3789  * completion of the internal reset sequence. if the internal reset
3790  * did not complete in time, the kernel reset handler would flush
3791  * these commands.
3792  */
3793 static void
3794 megasas_internal_reset_defer_cmds(struct megasas_instance *instance)
3795 {
3796         struct megasas_cmd *cmd;
3797         int i;
3798         u16 max_cmd = instance->max_fw_cmds;
3799         u32 defer_index;
3800         unsigned long flags;
3801
3802         defer_index = 0;
3803         spin_lock_irqsave(&instance->mfi_pool_lock, flags);
3804         for (i = 0; i < max_cmd; i++) {
3805                 cmd = instance->cmd_list[i];
3806                 if (cmd->sync_cmd == 1 || cmd->scmd) {
3807                         dev_notice(&instance->pdev->dev, "moving cmd[%d]:%p:%d:%p"
3808                                         "on the defer queue as internal\n",
3809                                 defer_index, cmd, cmd->sync_cmd, cmd->scmd);
3810
3811                         if (!list_empty(&cmd->list)) {
3812                                 dev_notice(&instance->pdev->dev, "ERROR while"
3813                                         " moving this cmd:%p, %d %p, it was"
3814                                         "discovered on some list?\n",
3815                                         cmd, cmd->sync_cmd, cmd->scmd);
3816
3817                                 list_del_init(&cmd->list);
3818                         }
3819                         defer_index++;
3820                         list_add_tail(&cmd->list,
3821                                 &instance->internal_reset_pending_q);
3822                 }
3823         }
3824         spin_unlock_irqrestore(&instance->mfi_pool_lock, flags);
3825 }
3826
3827
3828 static void
3829 process_fw_state_change_wq(struct work_struct *work)
3830 {
3831         struct megasas_instance *instance =
3832                 container_of(work, struct megasas_instance, work_init);
3833         u32 wait;
3834         unsigned long flags;
3835
3836     if (atomic_read(&instance->adprecovery) != MEGASAS_ADPRESET_SM_INFAULT) {
3837                 dev_notice(&instance->pdev->dev, "error, recovery st %x\n",
3838                                 atomic_read(&instance->adprecovery));
3839                 return ;
3840         }
3841
3842         if (atomic_read(&instance->adprecovery) == MEGASAS_ADPRESET_SM_INFAULT) {
3843                 dev_notice(&instance->pdev->dev, "FW detected to be in fault"
3844                                         "state, restarting it...\n");
3845
3846                 instance->instancet->disable_intr(instance);
3847                 atomic_set(&instance->fw_outstanding, 0);
3848
3849                 atomic_set(&instance->fw_reset_no_pci_access, 1);
3850                 instance->instancet->adp_reset(instance, instance->reg_set);
3851                 atomic_set(&instance->fw_reset_no_pci_access, 0);
3852
3853                 dev_notice(&instance->pdev->dev, "FW restarted successfully,"
3854                                         "initiating next stage...\n");
3855
3856                 dev_notice(&instance->pdev->dev, "HBA recovery state machine,"
3857                                         "state 2 starting...\n");
3858
3859                 /* waiting for about 20 second before start the second init */
3860                 for (wait = 0; wait < 30; wait++) {
3861                         msleep(1000);
3862                 }
3863
3864                 if (megasas_transition_to_ready(instance, 1)) {
3865                         dev_notice(&instance->pdev->dev, "adapter not ready\n");
3866
3867                         atomic_set(&instance->fw_reset_no_pci_access, 1);
3868                         megaraid_sas_kill_hba(instance);
3869                         return ;
3870                 }
3871
3872                 if ((instance->pdev->device == PCI_DEVICE_ID_LSI_SAS1064R) ||
3873                         (instance->pdev->device == PCI_DEVICE_ID_DELL_PERC5) ||
3874                         (instance->pdev->device == PCI_DEVICE_ID_LSI_VERDE_ZCR)
3875                         ) {
3876                         *instance->consumer = *instance->producer;
3877                 } else {
3878                         *instance->consumer = 0;
3879                         *instance->producer = 0;
3880                 }
3881
3882                 megasas_issue_init_mfi(instance);
3883
3884                 spin_lock_irqsave(&instance->hba_lock, flags);
3885                 atomic_set(&instance->adprecovery, MEGASAS_HBA_OPERATIONAL);
3886                 spin_unlock_irqrestore(&instance->hba_lock, flags);
3887                 instance->instancet->enable_intr(instance);
3888
3889                 megasas_issue_pending_cmds_again(instance);
3890                 instance->issuepend_done = 1;
3891         }
3892 }
3893
3894 /**
3895  * megasas_deplete_reply_queue -        Processes all completed commands
3896  * @instance:                           Adapter soft state
3897  * @alt_status:                         Alternate status to be returned to
3898  *                                      SCSI mid-layer instead of the status
3899  *                                      returned by the FW
3900  * Note: this must be called with hba lock held
3901  */
3902 static int
3903 megasas_deplete_reply_queue(struct megasas_instance *instance,
3904                                         u8 alt_status)
3905 {
3906         u32 mfiStatus;
3907         u32 fw_state;
3908
3909         if ((mfiStatus = instance->instancet->check_reset(instance,
3910                                         instance->reg_set)) == 1) {
3911                 return IRQ_HANDLED;
3912         }
3913
3914         mfiStatus = instance->instancet->clear_intr(instance);
3915         if (mfiStatus == 0) {
3916                 /* Hardware may not set outbound_intr_status in MSI-X mode */
3917                 if (!instance->msix_vectors)
3918                         return IRQ_NONE;
3919         }
3920
3921         instance->mfiStatus = mfiStatus;
3922
3923         if ((mfiStatus & MFI_INTR_FLAG_FIRMWARE_STATE_CHANGE)) {
3924                 fw_state = instance->instancet->read_fw_status_reg(
3925                                 instance) & MFI_STATE_MASK;
3926
3927                 if (fw_state != MFI_STATE_FAULT) {
3928                         dev_notice(&instance->pdev->dev, "fw state:%x\n",
3929                                                 fw_state);
3930                 }
3931
3932                 if ((fw_state == MFI_STATE_FAULT) &&
3933                                 (instance->disableOnlineCtrlReset == 0)) {
3934                         dev_notice(&instance->pdev->dev, "wait adp restart\n");
3935
3936                         if ((instance->pdev->device ==
3937                                         PCI_DEVICE_ID_LSI_SAS1064R) ||
3938                                 (instance->pdev->device ==
3939                                         PCI_DEVICE_ID_DELL_PERC5) ||
3940                                 (instance->pdev->device ==
3941                                         PCI_DEVICE_ID_LSI_VERDE_ZCR)) {
3942
3943                                 *instance->consumer =
3944                                         cpu_to_le32(MEGASAS_ADPRESET_INPROG_SIGN);
3945                         }
3946
3947
3948                         instance->instancet->disable_intr(instance);
3949                         atomic_set(&instance->adprecovery, MEGASAS_ADPRESET_SM_INFAULT);
3950                         instance->issuepend_done = 0;
3951
3952                         atomic_set(&instance->fw_outstanding, 0);
3953                         megasas_internal_reset_defer_cmds(instance);
3954
3955                         dev_notice(&instance->pdev->dev, "fwState=%x, stage:%d\n",
3956                                         fw_state, atomic_read(&instance->adprecovery));
3957
3958                         schedule_work(&instance->work_init);
3959                         return IRQ_HANDLED;
3960
3961                 } else {
3962                         dev_notice(&instance->pdev->dev, "fwstate:%x, dis_OCR=%x\n",
3963                                 fw_state, instance->disableOnlineCtrlReset);
3964                 }
3965         }
3966
3967         tasklet_schedule(&instance->isr_tasklet);
3968         return IRQ_HANDLED;
3969 }
3970
3971 /**
3972  * megasas_isr - isr entry point
3973  * @irq:        IRQ number
3974  * @devp:       IRQ context address
3975  */
3976 static irqreturn_t megasas_isr(int irq, void *devp)
3977 {
3978         struct megasas_irq_context *irq_context = devp;
3979         struct megasas_instance *instance = irq_context->instance;
3980         unsigned long flags;
3981         irqreturn_t rc;
3982
3983         if (atomic_read(&instance->fw_reset_no_pci_access))
3984                 return IRQ_HANDLED;
3985
3986         spin_lock_irqsave(&instance->hba_lock, flags);
3987         rc = megasas_deplete_reply_queue(instance, DID_OK);
3988         spin_unlock_irqrestore(&instance->hba_lock, flags);
3989
3990         return rc;
3991 }
3992
3993 /**
3994  * megasas_transition_to_ready -        Move the FW to READY state
3995  * @instance:                           Adapter soft state
3996  * @ocr:                                Adapter reset state
3997  *
3998  * During the initialization, FW passes can potentially be in any one of
3999  * several possible states. If the FW in operational, waiting-for-handshake
4000  * states, driver must take steps to bring it to ready state. Otherwise, it
4001  * has to wait for the ready state.
4002  */
4003 int
4004 megasas_transition_to_ready(struct megasas_instance *instance, int ocr)
4005 {
4006         int i;
4007         u8 max_wait;
4008         u32 fw_state;
4009         u32 abs_state, curr_abs_state;
4010
4011         abs_state = instance->instancet->read_fw_status_reg(instance);
4012         fw_state = abs_state & MFI_STATE_MASK;
4013
4014         if (fw_state != MFI_STATE_READY)
4015                 dev_info(&instance->pdev->dev, "Waiting for FW to come to ready"
4016                        " state\n");
4017
4018         while (fw_state != MFI_STATE_READY) {
4019
4020                 switch (fw_state) {
4021
4022                 case MFI_STATE_FAULT:
4023                         dev_printk(KERN_ERR, &instance->pdev->dev,
4024                                    "FW in FAULT state, Fault code:0x%x subcode:0x%x func:%s\n",
4025                                    abs_state & MFI_STATE_FAULT_CODE,
4026                                    abs_state & MFI_STATE_FAULT_SUBCODE, __func__);
4027                         if (ocr) {
4028                                 max_wait = MEGASAS_RESET_WAIT_TIME;
4029                                 break;
4030                         } else {
4031                                 dev_printk(KERN_DEBUG, &instance->pdev->dev, "System Register set:\n");
4032                                 megasas_dump_reg_set(instance->reg_set);
4033                                 return -ENODEV;
4034                         }
4035
4036                 case MFI_STATE_WAIT_HANDSHAKE:
4037                         /*
4038                          * Set the CLR bit in inbound doorbell
4039                          */
4040                         if ((instance->pdev->device ==
4041                                 PCI_DEVICE_ID_LSI_SAS0073SKINNY) ||
4042                                 (instance->pdev->device ==
4043                                  PCI_DEVICE_ID_LSI_SAS0071SKINNY) ||
4044                                 (instance->adapter_type != MFI_SERIES))
4045                                 writel(
4046                                   MFI_INIT_CLEAR_HANDSHAKE|MFI_INIT_HOTPLUG,
4047                                   &instance->reg_set->doorbell);
4048                         else
4049                                 writel(
4050                                     MFI_INIT_CLEAR_HANDSHAKE|MFI_INIT_HOTPLUG,
4051                                         &instance->reg_set->inbound_doorbell);
4052
4053                         max_wait = MEGASAS_RESET_WAIT_TIME;
4054                         break;
4055
4056                 case MFI_STATE_BOOT_MESSAGE_PENDING:
4057                         if ((instance->pdev->device ==
4058                              PCI_DEVICE_ID_LSI_SAS0073SKINNY) ||
4059                                 (instance->pdev->device ==
4060                                  PCI_DEVICE_ID_LSI_SAS0071SKINNY) ||
4061                                 (instance->adapter_type != MFI_SERIES))
4062                                 writel(MFI_INIT_HOTPLUG,
4063                                        &instance->reg_set->doorbell);
4064                         else
4065                                 writel(MFI_INIT_HOTPLUG,
4066                                         &instance->reg_set->inbound_doorbell);
4067
4068                         max_wait = MEGASAS_RESET_WAIT_TIME;
4069                         break;
4070
4071                 case MFI_STATE_OPERATIONAL:
4072                         /*
4073                          * Bring it to READY state; assuming max wait 10 secs
4074                          */
4075                         instance->instancet->disable_intr(instance);
4076                         if ((instance->pdev->device ==
4077                                 PCI_DEVICE_ID_LSI_SAS0073SKINNY) ||
4078                                 (instance->pdev->device ==
4079                                 PCI_DEVICE_ID_LSI_SAS0071SKINNY)  ||
4080                                 (instance->adapter_type != MFI_SERIES)) {
4081                                 writel(MFI_RESET_FLAGS,
4082                                         &instance->reg_set->doorbell);
4083
4084                                 if (instance->adapter_type != MFI_SERIES) {
4085                                         for (i = 0; i < (10 * 1000); i += 20) {
4086                                                 if (megasas_readl(
4087                                                             instance,
4088                                                             &instance->
4089                                                             reg_set->
4090                                                             doorbell) & 1)
4091                                                         msleep(20);
4092                                                 else
4093                                                         break;
4094                                         }
4095                                 }
4096                         } else
4097                                 writel(MFI_RESET_FLAGS,
4098                                         &instance->reg_set->inbound_doorbell);
4099
4100                         max_wait = MEGASAS_RESET_WAIT_TIME;
4101                         break;
4102
4103                 case MFI_STATE_UNDEFINED:
4104                         /*
4105                          * This state should not last for more than 2 seconds
4106                          */
4107                         max_wait = MEGASAS_RESET_WAIT_TIME;
4108                         break;
4109
4110                 case MFI_STATE_BB_INIT:
4111                         max_wait = MEGASAS_RESET_WAIT_TIME;
4112                         break;
4113
4114                 case MFI_STATE_FW_INIT:
4115                         max_wait = MEGASAS_RESET_WAIT_TIME;
4116                         break;
4117
4118                 case MFI_STATE_FW_INIT_2:
4119                         max_wait = MEGASAS_RESET_WAIT_TIME;
4120                         break;
4121
4122                 case MFI_STATE_DEVICE_SCAN:
4123                         max_wait = MEGASAS_RESET_WAIT_TIME;
4124                         break;
4125
4126                 case MFI_STATE_FLUSH_CACHE:
4127                         max_wait = MEGASAS_RESET_WAIT_TIME;
4128                         break;
4129
4130                 default:
4131                         dev_printk(KERN_DEBUG, &instance->pdev->dev, "Unknown state 0x%x\n",
4132                                fw_state);
4133                         dev_printk(KERN_DEBUG, &instance->pdev->dev, "System Register set:\n");
4134                         megasas_dump_reg_set(instance->reg_set);
4135                         return -ENODEV;
4136                 }
4137
4138                 /*
4139                  * The cur_state should not last for more than max_wait secs
4140                  */
4141                 for (i = 0; i < max_wait * 50; i++) {
4142                         curr_abs_state = instance->instancet->
4143                                 read_fw_status_reg(instance);
4144
4145                         if (abs_state == curr_abs_state) {
4146                                 msleep(20);
4147                         } else
4148                                 break;
4149                 }
4150
4151                 /*
4152                  * Return error if fw_state hasn't changed after max_wait
4153                  */
4154                 if (curr_abs_state == abs_state) {
4155                         dev_printk(KERN_DEBUG, &instance->pdev->dev, "FW state [%d] hasn't changed "
4156                                "in %d secs\n", fw_state, max_wait);
4157                         dev_printk(KERN_DEBUG, &instance->pdev->dev, "System Register set:\n");
4158                         megasas_dump_reg_set(instance->reg_set);
4159                         return -ENODEV;
4160                 }
4161
4162                 abs_state = curr_abs_state;
4163                 fw_state = curr_abs_state & MFI_STATE_MASK;
4164         }
4165         dev_info(&instance->pdev->dev, "FW now in Ready state\n");
4166
4167         return 0;
4168 }
4169
4170 /**
4171  * megasas_teardown_frame_pool -        Destroy the cmd frame DMA pool
4172  * @instance:                           Adapter soft state
4173  */
4174 static void megasas_teardown_frame_pool(struct megasas_instance *instance)
4175 {
4176         int i;
4177         u16 max_cmd = instance->max_mfi_cmds;
4178         struct megasas_cmd *cmd;
4179
4180         if (!instance->frame_dma_pool)
4181                 return;
4182
4183         /*
4184          * Return all frames to pool
4185          */
4186         for (i = 0; i < max_cmd; i++) {
4187
4188                 cmd = instance->cmd_list[i];
4189
4190                 if (cmd->frame)
4191                         dma_pool_free(instance->frame_dma_pool, cmd->frame,
4192                                       cmd->frame_phys_addr);
4193
4194                 if (cmd->sense)
4195                         dma_pool_free(instance->sense_dma_pool, cmd->sense,
4196                                       cmd->sense_phys_addr);
4197         }
4198
4199         /*
4200          * Now destroy the pool itself
4201          */
4202         dma_pool_destroy(instance->frame_dma_pool);
4203         dma_pool_destroy(instance->sense_dma_pool);
4204
4205         instance->frame_dma_pool = NULL;
4206         instance->sense_dma_pool = NULL;
4207 }
4208
4209 /**
4210  * megasas_create_frame_pool -  Creates DMA pool for cmd frames
4211  * @instance:                   Adapter soft state
4212  *
4213  * Each command packet has an embedded DMA memory buffer that is used for
4214  * filling MFI frame and the SG list that immediately follows the frame. This
4215  * function creates those DMA memory buffers for each command packet by using
4216  * PCI pool facility.
4217  */
4218 static int megasas_create_frame_pool(struct megasas_instance *instance)
4219 {
4220         int i;
4221         u16 max_cmd;
4222         u32 frame_count;
4223         struct megasas_cmd *cmd;
4224
4225         max_cmd = instance->max_mfi_cmds;
4226
4227         /*
4228          * For MFI controllers.
4229          * max_num_sge = 60
4230          * max_sge_sz  = 16 byte (sizeof megasas_sge_skinny)
4231          * Total 960 byte (15 MFI frame of 64 byte)
4232          *
4233          * Fusion adapter require only 3 extra frame.
4234          * max_num_sge = 16 (defined as MAX_IOCTL_SGE)
4235          * max_sge_sz  = 12 byte (sizeof  megasas_sge64)
4236          * Total 192 byte (3 MFI frame of 64 byte)
4237          */
4238         frame_count = (instance->adapter_type == MFI_SERIES) ?
4239                         (15 + 1) : (3 + 1);
4240         instance->mfi_frame_size = MEGAMFI_FRAME_SIZE * frame_count;
4241         /*
4242          * Use DMA pool facility provided by PCI layer
4243          */
4244         instance->frame_dma_pool = dma_pool_create("megasas frame pool",
4245                                         &instance->pdev->dev,
4246                                         instance->mfi_frame_size, 256, 0);
4247
4248         if (!instance->frame_dma_pool) {
4249                 dev_printk(KERN_DEBUG, &instance->pdev->dev, "failed to setup frame pool\n");
4250                 return -ENOMEM;
4251         }
4252
4253         instance->sense_dma_pool = dma_pool_create("megasas sense pool",
4254                                                    &instance->pdev->dev, 128,
4255                                                    4, 0);
4256
4257         if (!instance->sense_dma_pool) {
4258                 dev_printk(KERN_DEBUG, &instance->pdev->dev, "failed to setup sense pool\n");
4259
4260                 dma_pool_destroy(instance->frame_dma_pool);
4261                 instance->frame_dma_pool = NULL;
4262
4263                 return -ENOMEM;
4264         }
4265
4266         /*
4267          * Allocate and attach a frame to each of the commands in cmd_list.
4268          * By making cmd->index as the context instead of the &cmd, we can
4269          * always use 32bit context regardless of the architecture
4270          */
4271         for (i = 0; i < max_cmd; i++) {
4272
4273                 cmd = instance->cmd_list[i];
4274
4275                 cmd->frame = dma_pool_zalloc(instance->frame_dma_pool,
4276                                             GFP_KERNEL, &cmd->frame_phys_addr);
4277
4278                 cmd->sense = dma_pool_alloc(instance->sense_dma_pool,
4279                                             GFP_KERNEL, &cmd->sense_phys_addr);
4280
4281                 /*
4282                  * megasas_teardown_frame_pool() takes care of freeing
4283                  * whatever has been allocated
4284                  */
4285                 if (!cmd->frame || !cmd->sense) {
4286                         dev_printk(KERN_DEBUG, &instance->pdev->dev, "dma_pool_alloc failed\n");
4287                         megasas_teardown_frame_pool(instance);
4288                         return -ENOMEM;
4289                 }
4290
4291                 cmd->frame->io.context = cpu_to_le32(cmd->index);
4292                 cmd->frame->io.pad_0 = 0;
4293                 if ((instance->adapter_type == MFI_SERIES) && reset_devices)
4294                         cmd->frame->hdr.cmd = MFI_CMD_INVALID;
4295         }
4296
4297         return 0;
4298 }
4299
4300 /**
4301  * megasas_free_cmds -  Free all the cmds in the free cmd pool
4302  * @instance:           Adapter soft state
4303  */
4304 void megasas_free_cmds(struct megasas_instance *instance)
4305 {
4306         int i;
4307
4308         /* First free the MFI frame pool */
4309         megasas_teardown_frame_pool(instance);
4310
4311         /* Free all the commands in the cmd_list */
4312         for (i = 0; i < instance->max_mfi_cmds; i++)
4313
4314                 kfree(instance->cmd_list[i]);
4315
4316         /* Free the cmd_list buffer itself */
4317         kfree(instance->cmd_list);
4318         instance->cmd_list = NULL;
4319
4320         INIT_LIST_HEAD(&instance->cmd_pool);
4321 }
4322
4323 /**
4324  * megasas_alloc_cmds - Allocates the command packets
4325  * @instance:           Adapter soft state
4326  *
4327  * Each command that is issued to the FW, whether IO commands from the OS or
4328  * internal commands like IOCTLs, are wrapped in local data structure called
4329  * megasas_cmd. The frame embedded in this megasas_cmd is actually issued to
4330  * the FW.
4331  *
4332  * Each frame has a 32-bit field called context (tag). This context is used
4333  * to get back the megasas_cmd from the frame when a frame gets completed in
4334  * the ISR. Typically the address of the megasas_cmd itself would be used as
4335  * the context. But we wanted to keep the differences between 32 and 64 bit
4336  * systems to the mininum. We always use 32 bit integers for the context. In
4337  * this driver, the 32 bit values are the indices into an array cmd_list.
4338  * This array is used only to look up the megasas_cmd given the context. The
4339  * free commands themselves are maintained in a linked list called cmd_pool.
4340  */
4341 int megasas_alloc_cmds(struct megasas_instance *instance)
4342 {
4343         int i;
4344         int j;
4345         u16 max_cmd;
4346         struct megasas_cmd *cmd;
4347
4348         max_cmd = instance->max_mfi_cmds;
4349
4350         /*
4351          * instance->cmd_list is an array of struct megasas_cmd pointers.
4352          * Allocate the dynamic array first and then allocate individual
4353          * commands.
4354          */
4355         instance->cmd_list = kcalloc(max_cmd, sizeof(struct megasas_cmd*), GFP_KERNEL);
4356
4357         if (!instance->cmd_list) {
4358                 dev_printk(KERN_DEBUG, &instance->pdev->dev, "out of memory\n");
4359                 return -ENOMEM;
4360         }
4361
4362         memset(instance->cmd_list, 0, sizeof(struct megasas_cmd *) *max_cmd);
4363
4364         for (i = 0; i < max_cmd; i++) {
4365                 instance->cmd_list[i] = kmalloc(sizeof(struct megasas_cmd),
4366                                                 GFP_KERNEL);
4367
4368                 if (!instance->cmd_list[i]) {
4369
4370                         for (j = 0; j < i; j++)
4371                                 kfree(instance->cmd_list[j]);
4372
4373                         kfree(instance->cmd_list);
4374                         instance->cmd_list = NULL;
4375
4376                         return -ENOMEM;
4377                 }
4378         }
4379
4380         for (i = 0; i < max_cmd; i++) {
4381                 cmd = instance->cmd_list[i];
4382                 memset(cmd, 0, sizeof(struct megasas_cmd));
4383                 cmd->index = i;
4384                 cmd->scmd = NULL;
4385                 cmd->instance = instance;
4386
4387                 list_add_tail(&cmd->list, &instance->cmd_pool);
4388         }
4389
4390         /*
4391          * Create a frame pool and assign one frame to each cmd
4392          */
4393         if (megasas_create_frame_pool(instance)) {
4394                 dev_printk(KERN_DEBUG, &instance->pdev->dev, "Error creating frame DMA pool\n");
4395                 megasas_free_cmds(instance);
4396                 return -ENOMEM;
4397         }
4398
4399         return 0;
4400 }
4401
4402 /*
4403  * dcmd_timeout_ocr_possible -  Check if OCR is possible based on Driver/FW state.
4404  * @instance:                           Adapter soft state
4405  *
4406  * Return 0 for only Fusion adapter, if driver load/unload is not in progress
4407  * or FW is not under OCR.
4408  */
4409 inline int
4410 dcmd_timeout_ocr_possible(struct megasas_instance *instance) {
4411
4412         if (instance->adapter_type == MFI_SERIES)
4413                 return KILL_ADAPTER;
4414         else if (instance->unload ||
4415                         test_bit(MEGASAS_FUSION_OCR_NOT_POSSIBLE,
4416                                  &instance->reset_flags))
4417                 return IGNORE_TIMEOUT;
4418         else
4419                 return INITIATE_OCR;
4420 }
4421
4422 static void
4423 megasas_get_pd_info(struct megasas_instance *instance, struct scsi_device *sdev)
4424 {
4425         int ret;
4426         struct megasas_cmd *cmd;
4427         struct megasas_dcmd_frame *dcmd;
4428
4429         struct MR_PRIV_DEVICE *mr_device_priv_data;
4430         u16 device_id = 0;
4431
4432         device_id = (sdev->channel * MEGASAS_MAX_DEV_PER_CHANNEL) + sdev->id;
4433         cmd = megasas_get_cmd(instance);
4434
4435         if (!cmd) {
4436                 dev_err(&instance->pdev->dev, "Failed to get cmd %s\n", __func__);
4437                 return;
4438         }
4439
4440         dcmd = &cmd->frame->dcmd;
4441
4442         memset(instance->pd_info, 0, sizeof(*instance->pd_info));
4443         memset(dcmd->mbox.b, 0, MFI_MBOX_SIZE);
4444
4445         dcmd->mbox.s[0] = cpu_to_le16(device_id);
4446         dcmd->cmd = MFI_CMD_DCMD;
4447         dcmd->cmd_status = 0xFF;
4448         dcmd->sge_count = 1;
4449         dcmd->flags = MFI_FRAME_DIR_READ;
4450         dcmd->timeout = 0;
4451         dcmd->pad_0 = 0;
4452         dcmd->data_xfer_len = cpu_to_le32(sizeof(struct MR_PD_INFO));
4453         dcmd->opcode = cpu_to_le32(MR_DCMD_PD_GET_INFO);
4454
4455         megasas_set_dma_settings(instance, dcmd, instance->pd_info_h,
4456                                  sizeof(struct MR_PD_INFO));
4457
4458         if ((instance->adapter_type != MFI_SERIES) &&
4459             !instance->mask_interrupts)
4460                 ret = megasas_issue_blocked_cmd(instance, cmd, MFI_IO_TIMEOUT_SECS);
4461         else
4462                 ret = megasas_issue_polled(instance, cmd);
4463
4464         switch (ret) {
4465         case DCMD_SUCCESS:
4466                 mr_device_priv_data = sdev->hostdata;
4467                 le16_to_cpus((u16 *)&instance->pd_info->state.ddf.pdType);
4468                 mr_device_priv_data->interface_type =
4469                                 instance->pd_info->state.ddf.pdType.intf;
4470                 break;
4471
4472         case DCMD_TIMEOUT:
4473
4474                 switch (dcmd_timeout_ocr_possible(instance)) {
4475                 case INITIATE_OCR:
4476                         cmd->flags |= DRV_DCMD_SKIP_REFIRE;
4477                         mutex_unlock(&instance->reset_mutex);
4478                         megasas_reset_fusion(instance->host,
4479                                 MFI_IO_TIMEOUT_OCR);
4480                         mutex_lock(&instance->reset_mutex);
4481                         break;
4482                 case KILL_ADAPTER:
4483                         megaraid_sas_kill_hba(instance);
4484                         break;
4485                 case IGNORE_TIMEOUT:
4486                         dev_info(&instance->pdev->dev, "Ignore DCMD timeout: %s %d\n",
4487                                 __func__, __LINE__);
4488                         break;
4489                 }
4490
4491                 break;
4492         }
4493
4494         if (ret != DCMD_TIMEOUT)
4495                 megasas_return_cmd(instance, cmd);
4496
4497         return;
4498 }
4499 /*
4500  * megasas_get_pd_list_info -   Returns FW's pd_list structure
4501  * @instance:                           Adapter soft state
4502  * @pd_list:                            pd_list structure
4503  *
4504  * Issues an internal command (DCMD) to get the FW's controller PD
4505  * list structure.  This information is mainly used to find out SYSTEM
4506  * supported by the FW.
4507  */
4508 static int
4509 megasas_get_pd_list(struct megasas_instance *instance)
4510 {
4511         int ret = 0, pd_index = 0;
4512         struct megasas_cmd *cmd;
4513         struct megasas_dcmd_frame *dcmd;
4514         struct MR_PD_LIST *ci;
4515         struct MR_PD_ADDRESS *pd_addr;
4516
4517         if (instance->pd_list_not_supported) {
4518                 dev_info(&instance->pdev->dev, "MR_DCMD_PD_LIST_QUERY "
4519                 "not supported by firmware\n");
4520                 return ret;
4521         }
4522
4523         ci = instance->pd_list_buf;
4524
4525         cmd = megasas_get_cmd(instance);
4526
4527         if (!cmd) {
4528                 dev_printk(KERN_DEBUG, &instance->pdev->dev, "(get_pd_list): Failed to get cmd\n");
4529                 return -ENOMEM;
4530         }
4531
4532         dcmd = &cmd->frame->dcmd;
4533
4534         memset(ci, 0, sizeof(*ci));
4535         memset(dcmd->mbox.b, 0, MFI_MBOX_SIZE);
4536
4537         dcmd->mbox.b[0] = MR_PD_QUERY_TYPE_EXPOSED_TO_HOST;
4538         dcmd->mbox.b[1] = 0;
4539         dcmd->cmd = MFI_CMD_DCMD;
4540         dcmd->cmd_status = MFI_STAT_INVALID_STATUS;
4541         dcmd->sge_count = 1;
4542         dcmd->flags = MFI_FRAME_DIR_READ;
4543         dcmd->timeout = 0;
4544         dcmd->pad_0 = 0;
4545         dcmd->data_xfer_len = cpu_to_le32(MEGASAS_MAX_PD * sizeof(struct MR_PD_LIST));
4546         dcmd->opcode = cpu_to_le32(MR_DCMD_PD_LIST_QUERY);
4547
4548         megasas_set_dma_settings(instance, dcmd, instance->pd_list_buf_h,
4549                                  (MEGASAS_MAX_PD * sizeof(struct MR_PD_LIST)));
4550
4551         if ((instance->adapter_type != MFI_SERIES) &&
4552             !instance->mask_interrupts)
4553                 ret = megasas_issue_blocked_cmd(instance, cmd,
4554                         MFI_IO_TIMEOUT_SECS);
4555         else
4556                 ret = megasas_issue_polled(instance, cmd);
4557
4558         switch (ret) {
4559         case DCMD_FAILED:
4560                 dev_info(&instance->pdev->dev, "MR_DCMD_PD_LIST_QUERY "
4561                         "failed/not supported by firmware\n");
4562
4563                 if (instance->adapter_type != MFI_SERIES)
4564                         megaraid_sas_kill_hba(instance);
4565                 else
4566                         instance->pd_list_not_supported = 1;
4567                 break;
4568         case DCMD_TIMEOUT:
4569
4570                 switch (dcmd_timeout_ocr_possible(instance)) {
4571                 case INITIATE_OCR:
4572                         cmd->flags |= DRV_DCMD_SKIP_REFIRE;
4573                         /*
4574                          * DCMD failed from AEN path.
4575                          * AEN path already hold reset_mutex to avoid PCI access
4576                          * while OCR is in progress.
4577                          */
4578                         mutex_unlock(&instance->reset_mutex);
4579                         megasas_reset_fusion(instance->host,
4580                                                 MFI_IO_TIMEOUT_OCR);
4581                         mutex_lock(&instance->reset_mutex);
4582                         break;
4583                 case KILL_ADAPTER:
4584                         megaraid_sas_kill_hba(instance);
4585                         break;
4586                 case IGNORE_TIMEOUT:
4587                         dev_info(&instance->pdev->dev, "Ignore DCMD timeout: %s %d \n",
4588                                 __func__, __LINE__);
4589                         break;
4590                 }
4591
4592                 break;
4593
4594         case DCMD_SUCCESS:
4595                 pd_addr = ci->addr;
4596                 if (megasas_dbg_lvl & LD_PD_DEBUG)
4597                         dev_info(&instance->pdev->dev, "%s, sysPD count: 0x%x\n",
4598                                  __func__, le32_to_cpu(ci->count));
4599
4600                 if ((le32_to_cpu(ci->count) >
4601                         (MEGASAS_MAX_PD_CHANNELS * MEGASAS_MAX_DEV_PER_CHANNEL)))
4602                         break;
4603
4604                 memset(instance->local_pd_list, 0,
4605                                 MEGASAS_MAX_PD * sizeof(struct megasas_pd_list));
4606
4607                 for (pd_index = 0; pd_index < le32_to_cpu(ci->count); pd_index++) {
4608                         instance->local_pd_list[le16_to_cpu(pd_addr->deviceId)].tid     =
4609                                         le16_to_cpu(pd_addr->deviceId);
4610                         instance->local_pd_list[le16_to_cpu(pd_addr->deviceId)].driveType       =
4611                                         pd_addr->scsiDevType;
4612                         instance->local_pd_list[le16_to_cpu(pd_addr->deviceId)].driveState      =
4613                                         MR_PD_STATE_SYSTEM;
4614                         if (megasas_dbg_lvl & LD_PD_DEBUG)
4615                                 dev_info(&instance->pdev->dev,
4616                                          "PD%d: targetID: 0x%03x deviceType:0x%x\n",
4617                                          pd_index, le16_to_cpu(pd_addr->deviceId),
4618                                          pd_addr->scsiDevType);
4619                         pd_addr++;
4620                 }
4621
4622                 memcpy(instance->pd_list, instance->local_pd_list,
4623                         sizeof(instance->pd_list));
4624                 break;
4625
4626         }
4627
4628         if (ret != DCMD_TIMEOUT)
4629                 megasas_return_cmd(instance, cmd);
4630
4631         return ret;
4632 }
4633
4634 /*
4635  * megasas_get_ld_list_info -   Returns FW's ld_list structure
4636  * @instance:                           Adapter soft state
4637  * @ld_list:                            ld_list structure
4638  *
4639  * Issues an internal command (DCMD) to get the FW's controller PD
4640  * list structure.  This information is mainly used to find out SYSTEM
4641  * supported by the FW.
4642  */
4643 static int
4644 megasas_get_ld_list(struct megasas_instance *instance)
4645 {
4646         int ret = 0, ld_index = 0, ids = 0;
4647         struct megasas_cmd *cmd;
4648         struct megasas_dcmd_frame *dcmd;
4649         struct MR_LD_LIST *ci;
4650         dma_addr_t ci_h = 0;
4651         u32 ld_count;
4652
4653         ci = instance->ld_list_buf;
4654         ci_h = instance->ld_list_buf_h;
4655
4656         cmd = megasas_get_cmd(instance);
4657
4658         if (!cmd) {
4659                 dev_printk(KERN_DEBUG, &instance->pdev->dev, "megasas_get_ld_list: Failed to get cmd\n");
4660                 return -ENOMEM;
4661         }
4662
4663         dcmd = &cmd->frame->dcmd;
4664
4665         memset(ci, 0, sizeof(*ci));
4666         memset(dcmd->mbox.b, 0, MFI_MBOX_SIZE);
4667
4668         if (instance->supportmax256vd)
4669                 dcmd->mbox.b[0] = 1;
4670         dcmd->cmd = MFI_CMD_DCMD;
4671         dcmd->cmd_status = MFI_STAT_INVALID_STATUS;
4672         dcmd->sge_count = 1;
4673         dcmd->flags = MFI_FRAME_DIR_READ;
4674         dcmd->timeout = 0;
4675         dcmd->data_xfer_len = cpu_to_le32(sizeof(struct MR_LD_LIST));
4676         dcmd->opcode = cpu_to_le32(MR_DCMD_LD_GET_LIST);
4677         dcmd->pad_0  = 0;
4678
4679         megasas_set_dma_settings(instance, dcmd, ci_h,
4680                                  sizeof(struct MR_LD_LIST));
4681
4682         if ((instance->adapter_type != MFI_SERIES) &&
4683             !instance->mask_interrupts)
4684                 ret = megasas_issue_blocked_cmd(instance, cmd,
4685                         MFI_IO_TIMEOUT_SECS);
4686         else
4687                 ret = megasas_issue_polled(instance, cmd);
4688
4689         ld_count = le32_to_cpu(ci->ldCount);
4690
4691         switch (ret) {
4692         case DCMD_FAILED:
4693                 megaraid_sas_kill_hba(instance);
4694                 break;
4695         case DCMD_TIMEOUT:
4696
4697                 switch (dcmd_timeout_ocr_possible(instance)) {
4698                 case INITIATE_OCR:
4699                         cmd->flags |= DRV_DCMD_SKIP_REFIRE;
4700                         /*
4701                          * DCMD failed from AEN path.
4702                          * AEN path already hold reset_mutex to avoid PCI access
4703                          * while OCR is in progress.
4704                          */
4705                         mutex_unlock(&instance->reset_mutex);
4706                         megasas_reset_fusion(instance->host,
4707                                                 MFI_IO_TIMEOUT_OCR);
4708                         mutex_lock(&instance->reset_mutex);
4709                         break;
4710                 case KILL_ADAPTER:
4711                         megaraid_sas_kill_hba(instance);
4712                         break;
4713                 case IGNORE_TIMEOUT:
4714                         dev_info(&instance->pdev->dev, "Ignore DCMD timeout: %s %d\n",
4715                                 __func__, __LINE__);
4716                         break;
4717                 }
4718
4719                 break;
4720
4721         case DCMD_SUCCESS:
4722                 if (megasas_dbg_lvl & LD_PD_DEBUG)
4723                         dev_info(&instance->pdev->dev, "%s, LD count: 0x%x\n",
4724                                  __func__, ld_count);
4725
4726                 if (ld_count > instance->fw_supported_vd_count)
4727                         break;
4728
4729                 memset(instance->ld_ids, 0xff, MAX_LOGICAL_DRIVES_EXT);
4730
4731                 for (ld_index = 0; ld_index < ld_count; ld_index++) {
4732                         if (ci->ldList[ld_index].state != 0) {
4733                                 ids = ci->ldList[ld_index].ref.targetId;
4734                                 instance->ld_ids[ids] = ci->ldList[ld_index].ref.targetId;
4735                                 if (megasas_dbg_lvl & LD_PD_DEBUG)
4736                                         dev_info(&instance->pdev->dev,
4737                                                  "LD%d: targetID: 0x%03x\n",
4738                                                  ld_index, ids);
4739                         }
4740                 }
4741
4742                 break;
4743         }
4744
4745         if (ret != DCMD_TIMEOUT)
4746                 megasas_return_cmd(instance, cmd);
4747
4748         return ret;
4749 }
4750
4751 /**
4752  * megasas_ld_list_query -      Returns FW's ld_list structure
4753  * @instance:                           Adapter soft state
4754  * @query_type:                         ld_list structure type
4755  *
4756  * Issues an internal command (DCMD) to get the FW's controller PD
4757  * list structure.  This information is mainly used to find out SYSTEM
4758  * supported by the FW.
4759  */
4760 static int
4761 megasas_ld_list_query(struct megasas_instance *instance, u8 query_type)
4762 {
4763         int ret = 0, ld_index = 0, ids = 0;
4764         struct megasas_cmd *cmd;
4765         struct megasas_dcmd_frame *dcmd;
4766         struct MR_LD_TARGETID_LIST *ci;
4767         dma_addr_t ci_h = 0;
4768         u32 tgtid_count;
4769
4770         ci = instance->ld_targetid_list_buf;
4771         ci_h = instance->ld_targetid_list_buf_h;
4772
4773         cmd = megasas_get_cmd(instance);
4774
4775         if (!cmd) {
4776                 dev_warn(&instance->pdev->dev,
4777                          "megasas_ld_list_query: Failed to get cmd\n");
4778                 return -ENOMEM;
4779         }
4780
4781         dcmd = &cmd->frame->dcmd;
4782
4783         memset(ci, 0, sizeof(*ci));
4784         memset(dcmd->mbox.b, 0, MFI_MBOX_SIZE);
4785
4786         dcmd->mbox.b[0] = query_type;
4787         if (instance->supportmax256vd)
4788                 dcmd->mbox.b[2] = 1;
4789
4790         dcmd->cmd = MFI_CMD_DCMD;
4791         dcmd->cmd_status = MFI_STAT_INVALID_STATUS;
4792         dcmd->sge_count = 1;
4793         dcmd->flags = MFI_FRAME_DIR_READ;
4794         dcmd->timeout = 0;
4795         dcmd->data_xfer_len = cpu_to_le32(sizeof(struct MR_LD_TARGETID_LIST));
4796         dcmd->opcode = cpu_to_le32(MR_DCMD_LD_LIST_QUERY);
4797         dcmd->pad_0  = 0;
4798
4799         megasas_set_dma_settings(instance, dcmd, ci_h,
4800                                  sizeof(struct MR_LD_TARGETID_LIST));
4801
4802         if ((instance->adapter_type != MFI_SERIES) &&
4803             !instance->mask_interrupts)
4804                 ret = megasas_issue_blocked_cmd(instance, cmd, MFI_IO_TIMEOUT_SECS);
4805         else
4806                 ret = megasas_issue_polled(instance, cmd);
4807
4808         switch (ret) {
4809         case DCMD_FAILED:
4810                 dev_info(&instance->pdev->dev,
4811                         "DCMD not supported by firmware - %s %d\n",
4812                                 __func__, __LINE__);
4813                 ret = megasas_get_ld_list(instance);
4814                 break;
4815         case DCMD_TIMEOUT:
4816                 switch (dcmd_timeout_ocr_possible(instance)) {
4817                 case INITIATE_OCR:
4818                         cmd->flags |= DRV_DCMD_SKIP_REFIRE;
4819                         /*
4820                          * DCMD failed from AEN path.
4821                          * AEN path already hold reset_mutex to avoid PCI access
4822                          * while OCR is in progress.
4823                          */
4824                         mutex_unlock(&instance->reset_mutex);
4825                         megasas_reset_fusion(instance->host,
4826                                                 MFI_IO_TIMEOUT_OCR);
4827                         mutex_lock(&instance->reset_mutex);
4828                         break;
4829                 case KILL_ADAPTER:
4830                         megaraid_sas_kill_hba(instance);
4831                         break;
4832                 case IGNORE_TIMEOUT:
4833                         dev_info(&instance->pdev->dev, "Ignore DCMD timeout: %s %d\n",
4834                                 __func__, __LINE__);
4835                         break;
4836                 }
4837
4838                 break;
4839         case DCMD_SUCCESS:
4840                 tgtid_count = le32_to_cpu(ci->count);
4841
4842                 if (megasas_dbg_lvl & LD_PD_DEBUG)
4843                         dev_info(&instance->pdev->dev, "%s, LD count: 0x%x\n",
4844                                  __func__, tgtid_count);
4845
4846                 if ((tgtid_count > (instance->fw_supported_vd_count)))
4847                         break;
4848
4849                 memset(instance->ld_ids, 0xff, MEGASAS_MAX_LD_IDS);
4850                 for (ld_index = 0; ld_index < tgtid_count; ld_index++) {
4851                         ids = ci->targetId[ld_index];
4852                         instance->ld_ids[ids] = ci->targetId[ld_index];
4853                         if (megasas_dbg_lvl & LD_PD_DEBUG)
4854                                 dev_info(&instance->pdev->dev, "LD%d: targetID: 0x%03x\n",
4855                                          ld_index, ci->targetId[ld_index]);
4856                 }
4857
4858                 break;
4859         }
4860
4861         if (ret != DCMD_TIMEOUT)
4862                 megasas_return_cmd(instance, cmd);
4863
4864         return ret;
4865 }
4866
4867 /**
4868  * dcmd.opcode            - MR_DCMD_CTRL_DEVICE_LIST_GET
4869  * dcmd.mbox              - reserved
4870  * dcmd.sge IN            - ptr to return MR_HOST_DEVICE_LIST structure
4871  * Desc:    This DCMD will return the combined device list
4872  * Status:  MFI_STAT_OK - List returned successfully
4873  *          MFI_STAT_INVALID_CMD - Firmware support for the feature has been
4874  *                                 disabled
4875  * @instance:                   Adapter soft state
4876  * @is_probe:                   Driver probe check
4877  * Return:                      0 if DCMD succeeded
4878  *                               non-zero if failed
4879  */
4880 static int
4881 megasas_host_device_list_query(struct megasas_instance *instance,
4882                                bool is_probe)
4883 {
4884         int ret, i, target_id;
4885         struct megasas_cmd *cmd;
4886         struct megasas_dcmd_frame *dcmd;
4887         struct MR_HOST_DEVICE_LIST *ci;
4888         u32 count;
4889         dma_addr_t ci_h;
4890
4891         ci = instance->host_device_list_buf;
4892         ci_h = instance->host_device_list_buf_h;
4893
4894         cmd = megasas_get_cmd(instance);
4895
4896         if (!cmd) {
4897                 dev_warn(&instance->pdev->dev,
4898                          "%s: failed to get cmd\n",
4899                          __func__);
4900                 return -ENOMEM;
4901         }
4902
4903         dcmd = &cmd->frame->dcmd;
4904
4905         memset(ci, 0, sizeof(*ci));
4906         memset(dcmd->mbox.b, 0, MFI_MBOX_SIZE);
4907
4908         dcmd->mbox.b[0] = is_probe ? 0 : 1;
4909         dcmd->cmd = MFI_CMD_DCMD;
4910         dcmd->cmd_status = MFI_STAT_INVALID_STATUS;
4911         dcmd->sge_count = 1;
4912         dcmd->flags = MFI_FRAME_DIR_READ;
4913         dcmd->timeout = 0;
4914         dcmd->pad_0 = 0;
4915         dcmd->data_xfer_len = cpu_to_le32(HOST_DEVICE_LIST_SZ);
4916         dcmd->opcode = cpu_to_le32(MR_DCMD_CTRL_DEVICE_LIST_GET);
4917
4918         megasas_set_dma_settings(instance, dcmd, ci_h, HOST_DEVICE_LIST_SZ);
4919
4920         if (!instance->mask_interrupts) {
4921                 ret = megasas_issue_blocked_cmd(instance, cmd,
4922                                                 MFI_IO_TIMEOUT_SECS);
4923         } else {
4924                 ret = megasas_issue_polled(instance, cmd);
4925                 cmd->flags |= DRV_DCMD_SKIP_REFIRE;
4926         }
4927
4928         switch (ret) {
4929         case DCMD_SUCCESS:
4930                 /* Fill the internal pd_list and ld_ids array based on
4931                  * targetIds returned by FW
4932                  */
4933                 count = le32_to_cpu(ci->count);
4934
4935                 if (count > (MEGASAS_MAX_PD + MAX_LOGICAL_DRIVES_EXT))
4936                         break;
4937
4938                 if (megasas_dbg_lvl & LD_PD_DEBUG)
4939                         dev_info(&instance->pdev->dev, "%s, Device count: 0x%x\n",
4940                                  __func__, count);
4941
4942                 memset(instance->local_pd_list, 0,
4943                        MEGASAS_MAX_PD * sizeof(struct megasas_pd_list));
4944                 memset(instance->ld_ids, 0xff, MAX_LOGICAL_DRIVES_EXT);
4945                 for (i = 0; i < count; i++) {
4946                         target_id = le16_to_cpu(ci->host_device_list[i].target_id);
4947                         if (ci->host_device_list[i].flags.u.bits.is_sys_pd) {
4948                                 instance->local_pd_list[target_id].tid = target_id;
4949                                 instance->local_pd_list[target_id].driveType =
4950                                                 ci->host_device_list[i].scsi_type;
4951                                 instance->local_pd_list[target_id].driveState =
4952                                                 MR_PD_STATE_SYSTEM;
4953                                 if (megasas_dbg_lvl & LD_PD_DEBUG)
4954                                         dev_info(&instance->pdev->dev,
4955                                                  "Device %d: PD targetID: 0x%03x deviceType:0x%x\n",
4956                                                  i, target_id, ci->host_device_list[i].scsi_type);
4957                         } else {
4958                                 instance->ld_ids[target_id] = target_id;
4959                                 if (megasas_dbg_lvl & LD_PD_DEBUG)
4960                                         dev_info(&instance->pdev->dev,
4961                                                  "Device %d: LD targetID: 0x%03x\n",
4962                                                  i, target_id);
4963                         }
4964                 }
4965
4966                 memcpy(instance->pd_list, instance->local_pd_list,
4967                        sizeof(instance->pd_list));
4968                 break;
4969
4970         case DCMD_TIMEOUT:
4971                 switch (dcmd_timeout_ocr_possible(instance)) {
4972                 case INITIATE_OCR:
4973                         cmd->flags |= DRV_DCMD_SKIP_REFIRE;
4974                         mutex_unlock(&instance->reset_mutex);
4975                         megasas_reset_fusion(instance->host,
4976                                 MFI_IO_TIMEOUT_OCR);
4977                         mutex_lock(&instance->reset_mutex);
4978                         break;
4979                 case KILL_ADAPTER:
4980                         megaraid_sas_kill_hba(instance);
4981                         break;
4982                 case IGNORE_TIMEOUT:
4983                         dev_info(&instance->pdev->dev, "Ignore DCMD timeout: %s %d\n",
4984                                  __func__, __LINE__);
4985                         break;
4986                 }
4987                 break;
4988         case DCMD_FAILED:
4989                 dev_err(&instance->pdev->dev,
4990                         "%s: MR_DCMD_CTRL_DEVICE_LIST_GET failed\n",
4991                         __func__);
4992                 break;
4993         }
4994
4995         if (ret != DCMD_TIMEOUT)
4996                 megasas_return_cmd(instance, cmd);
4997
4998         return ret;
4999 }
5000
5001 /*
5002  * megasas_update_ext_vd_details : Update details w.r.t Extended VD
5003  * instance                      : Controller's instance
5004 */
5005 static void megasas_update_ext_vd_details(struct megasas_instance *instance)
5006 {
5007         struct fusion_context *fusion;
5008         u32 ventura_map_sz = 0;
5009
5010         fusion = instance->ctrl_context;
5011         /* For MFI based controllers return dummy success */
5012         if (!fusion)
5013                 return;
5014
5015         instance->supportmax256vd =
5016                 instance->ctrl_info_buf->adapterOperations3.supportMaxExtLDs;
5017         /* Below is additional check to address future FW enhancement */
5018         if (instance->ctrl_info_buf->max_lds > 64)
5019                 instance->supportmax256vd = 1;
5020
5021         instance->drv_supported_vd_count = MEGASAS_MAX_LD_CHANNELS
5022                                         * MEGASAS_MAX_DEV_PER_CHANNEL;
5023         instance->drv_supported_pd_count = MEGASAS_MAX_PD_CHANNELS
5024                                         * MEGASAS_MAX_DEV_PER_CHANNEL;
5025         if (instance->supportmax256vd) {
5026                 instance->fw_supported_vd_count = MAX_LOGICAL_DRIVES_EXT;
5027                 instance->fw_supported_pd_count = MAX_PHYSICAL_DEVICES;
5028         } else {
5029                 instance->fw_supported_vd_count = MAX_LOGICAL_DRIVES;
5030                 instance->fw_supported_pd_count = MAX_PHYSICAL_DEVICES;
5031         }
5032
5033         dev_info(&instance->pdev->dev,
5034                 "FW provided supportMaxExtLDs: %d\tmax_lds: %d\n",
5035                 instance->ctrl_info_buf->adapterOperations3.supportMaxExtLDs ? 1 : 0,
5036                 instance->ctrl_info_buf->max_lds);
5037
5038         if (instance->max_raid_mapsize) {
5039                 ventura_map_sz = instance->max_raid_mapsize *
5040                                                 MR_MIN_MAP_SIZE; /* 64k */
5041                 fusion->current_map_sz = ventura_map_sz;
5042                 fusion->max_map_sz = ventura_map_sz;
5043         } else {
5044                 fusion->old_map_sz =  sizeof(struct MR_FW_RAID_MAP) +
5045                                         (sizeof(struct MR_LD_SPAN_MAP) *
5046                                         (instance->fw_supported_vd_count - 1));
5047                 fusion->new_map_sz =  sizeof(struct MR_FW_RAID_MAP_EXT);
5048
5049                 fusion->max_map_sz =
5050                         max(fusion->old_map_sz, fusion->new_map_sz);
5051
5052                 if (instance->supportmax256vd)
5053                         fusion->current_map_sz = fusion->new_map_sz;
5054                 else
5055                         fusion->current_map_sz = fusion->old_map_sz;
5056         }
5057         /* irrespective of FW raid maps, driver raid map is constant */
5058         fusion->drv_map_sz = sizeof(struct MR_DRV_RAID_MAP_ALL);
5059 }
5060
5061 /*
5062  * dcmd.opcode                - MR_DCMD_CTRL_SNAPDUMP_GET_PROPERTIES
5063  * dcmd.hdr.length            - number of bytes to read
5064  * dcmd.sge                   - Ptr to MR_SNAPDUMP_PROPERTIES
5065  * Desc:                         Fill in snapdump properties
5066  * Status:                       MFI_STAT_OK- Command successful
5067  */
5068 void megasas_get_snapdump_properties(struct megasas_instance *instance)
5069 {
5070         int ret = 0;
5071         struct megasas_cmd *cmd;
5072         struct megasas_dcmd_frame *dcmd;
5073         struct MR_SNAPDUMP_PROPERTIES *ci;
5074         dma_addr_t ci_h = 0;
5075
5076         ci = instance->snapdump_prop;
5077         ci_h = instance->snapdump_prop_h;
5078
5079         if (!ci)
5080                 return;
5081
5082         cmd = megasas_get_cmd(instance);
5083
5084         if (!cmd) {
5085                 dev_dbg(&instance->pdev->dev, "Failed to get a free cmd\n");
5086                 return;
5087         }
5088
5089         dcmd = &cmd->frame->dcmd;
5090
5091         memset(ci, 0, sizeof(*ci));
5092         memset(dcmd->mbox.b, 0, MFI_MBOX_SIZE);
5093
5094         dcmd->cmd = MFI_CMD_DCMD;
5095         dcmd->cmd_status = MFI_STAT_INVALID_STATUS;
5096         dcmd->sge_count = 1;
5097         dcmd->flags = MFI_FRAME_DIR_READ;
5098         dcmd->timeout = 0;
5099         dcmd->pad_0 = 0;
5100         dcmd->data_xfer_len = cpu_to_le32(sizeof(struct MR_SNAPDUMP_PROPERTIES));
5101         dcmd->opcode = cpu_to_le32(MR_DCMD_CTRL_SNAPDUMP_GET_PROPERTIES);
5102
5103         megasas_set_dma_settings(instance, dcmd, ci_h,
5104                                  sizeof(struct MR_SNAPDUMP_PROPERTIES));
5105
5106         if (!instance->mask_interrupts) {
5107                 ret = megasas_issue_blocked_cmd(instance, cmd,
5108                                                 MFI_IO_TIMEOUT_SECS);
5109         } else {
5110                 ret = megasas_issue_polled(instance, cmd);
5111                 cmd->flags |= DRV_DCMD_SKIP_REFIRE;
5112         }
5113
5114         switch (ret) {
5115         case DCMD_SUCCESS:
5116                 instance->snapdump_wait_time =
5117                         min_t(u8, ci->trigger_min_num_sec_before_ocr,
5118                                 MEGASAS_MAX_SNAP_DUMP_WAIT_TIME);
5119                 break;
5120
5121         case DCMD_TIMEOUT:
5122                 switch (dcmd_timeout_ocr_possible(instance)) {
5123                 case INITIATE_OCR:
5124                         cmd->flags |= DRV_DCMD_SKIP_REFIRE;
5125                         mutex_unlock(&instance->reset_mutex);
5126                         megasas_reset_fusion(instance->host,
5127                                 MFI_IO_TIMEOUT_OCR);
5128                         mutex_lock(&instance->reset_mutex);
5129                         break;
5130                 case KILL_ADAPTER:
5131                         megaraid_sas_kill_hba(instance);
5132                         break;
5133                 case IGNORE_TIMEOUT:
5134                         dev_info(&instance->pdev->dev, "Ignore DCMD timeout: %s %d\n",
5135                                 __func__, __LINE__);
5136                         break;
5137                 }
5138         }
5139
5140         if (ret != DCMD_TIMEOUT)
5141                 megasas_return_cmd(instance, cmd);
5142 }
5143
5144 /**
5145  * megasas_get_controller_info -        Returns FW's controller structure
5146  * @instance:                           Adapter soft state
5147  *
5148  * Issues an internal command (DCMD) to get the FW's controller structure.
5149  * This information is mainly used to find out the maximum IO transfer per
5150  * command supported by the FW.
5151  */
5152 int
5153 megasas_get_ctrl_info(struct megasas_instance *instance)
5154 {
5155         int ret = 0;
5156         struct megasas_cmd *cmd;
5157         struct megasas_dcmd_frame *dcmd;
5158         struct megasas_ctrl_info *ci;
5159         dma_addr_t ci_h = 0;
5160
5161         ci = instance->ctrl_info_buf;
5162         ci_h = instance->ctrl_info_buf_h;
5163
5164         cmd = megasas_get_cmd(instance);
5165
5166         if (!cmd) {
5167                 dev_printk(KERN_DEBUG, &instance->pdev->dev, "Failed to get a free cmd\n");
5168                 return -ENOMEM;
5169         }
5170
5171         dcmd = &cmd->frame->dcmd;
5172
5173         memset(ci, 0, sizeof(*ci));
5174         memset(dcmd->mbox.b, 0, MFI_MBOX_SIZE);
5175
5176         dcmd->cmd = MFI_CMD_DCMD;
5177         dcmd->cmd_status = MFI_STAT_INVALID_STATUS;
5178         dcmd->sge_count = 1;
5179         dcmd->flags = MFI_FRAME_DIR_READ;
5180         dcmd->timeout = 0;
5181         dcmd->pad_0 = 0;
5182         dcmd->data_xfer_len = cpu_to_le32(sizeof(struct megasas_ctrl_info));
5183         dcmd->opcode = cpu_to_le32(MR_DCMD_CTRL_GET_INFO);
5184         dcmd->mbox.b[0] = 1;
5185
5186         megasas_set_dma_settings(instance, dcmd, ci_h,
5187                                  sizeof(struct megasas_ctrl_info));
5188
5189         if ((instance->adapter_type != MFI_SERIES) &&
5190             !instance->mask_interrupts) {
5191                 ret = megasas_issue_blocked_cmd(instance, cmd, MFI_IO_TIMEOUT_SECS);
5192         } else {
5193                 ret = megasas_issue_polled(instance, cmd);
5194                 cmd->flags |= DRV_DCMD_SKIP_REFIRE;
5195         }
5196
5197         switch (ret) {
5198         case DCMD_SUCCESS:
5199                 /* Save required controller information in
5200                  * CPU endianness format.
5201                  */
5202                 le32_to_cpus((u32 *)&ci->properties.OnOffProperties);
5203                 le16_to_cpus((u16 *)&ci->properties.on_off_properties2);
5204                 le32_to_cpus((u32 *)&ci->adapterOperations2);
5205                 le32_to_cpus((u32 *)&ci->adapterOperations3);
5206                 le16_to_cpus((u16 *)&ci->adapter_operations4);
5207                 le32_to_cpus((u32 *)&ci->adapter_operations5);
5208
5209                 /* Update the latest Ext VD info.
5210                  * From Init path, store current firmware details.
5211                  * From OCR path, detect any firmware properties changes.
5212                  * in case of Firmware upgrade without system reboot.
5213                  */
5214                 megasas_update_ext_vd_details(instance);
5215                 instance->support_seqnum_jbod_fp =
5216                         ci->adapterOperations3.useSeqNumJbodFP;
5217                 instance->support_morethan256jbod =
5218                         ci->adapter_operations4.support_pd_map_target_id;
5219                 instance->support_nvme_passthru =
5220                         ci->adapter_operations4.support_nvme_passthru;
5221                 instance->support_pci_lane_margining =
5222                         ci->adapter_operations5.support_pci_lane_margining;
5223                 instance->task_abort_tmo = ci->TaskAbortTO;
5224                 instance->max_reset_tmo = ci->MaxResetTO;
5225
5226                 /*Check whether controller is iMR or MR */
5227                 instance->is_imr = (ci->memory_size ? 0 : 1);
5228
5229                 instance->snapdump_wait_time =
5230                         (ci->properties.on_off_properties2.enable_snap_dump ?
5231                          MEGASAS_DEFAULT_SNAP_DUMP_WAIT_TIME : 0);
5232
5233                 instance->enable_fw_dev_list =
5234                         ci->properties.on_off_properties2.enable_fw_dev_list;
5235
5236                 dev_info(&instance->pdev->dev,
5237                         "controller type\t: %s(%dMB)\n",
5238                         instance->is_imr ? "iMR" : "MR",
5239                         le16_to_cpu(ci->memory_size));
5240
5241                 instance->disableOnlineCtrlReset =
5242                         ci->properties.OnOffProperties.disableOnlineCtrlReset;
5243                 instance->secure_jbod_support =
5244                         ci->adapterOperations3.supportSecurityonJBOD;
5245                 dev_info(&instance->pdev->dev, "Online Controller Reset(OCR)\t: %s\n",
5246                         instance->disableOnlineCtrlReset ? "Disabled" : "Enabled");
5247                 dev_info(&instance->pdev->dev, "Secure JBOD support\t: %s\n",
5248                         instance->secure_jbod_support ? "Yes" : "No");
5249                 dev_info(&instance->pdev->dev, "NVMe passthru support\t: %s\n",
5250                          instance->support_nvme_passthru ? "Yes" : "No");
5251                 dev_info(&instance->pdev->dev,
5252                          "FW provided TM TaskAbort/Reset timeout\t: %d secs/%d secs\n",
5253                          instance->task_abort_tmo, instance->max_reset_tmo);
5254                 dev_info(&instance->pdev->dev, "JBOD sequence map support\t: %s\n",
5255                          instance->support_seqnum_jbod_fp ? "Yes" : "No");
5256                 dev_info(&instance->pdev->dev, "PCI Lane Margining support\t: %s\n",
5257                          instance->support_pci_lane_margining ? "Yes" : "No");
5258
5259                 break;
5260
5261         case DCMD_TIMEOUT:
5262                 switch (dcmd_timeout_ocr_possible(instance)) {
5263                 case INITIATE_OCR:
5264                         cmd->flags |= DRV_DCMD_SKIP_REFIRE;
5265                         mutex_unlock(&instance->reset_mutex);
5266                         megasas_reset_fusion(instance->host,
5267                                 MFI_IO_TIMEOUT_OCR);
5268                         mutex_lock(&instance->reset_mutex);
5269                         break;
5270                 case KILL_ADAPTER:
5271                         megaraid_sas_kill_hba(instance);
5272                         break;
5273                 case IGNORE_TIMEOUT:
5274                         dev_info(&instance->pdev->dev, "Ignore DCMD timeout: %s %d\n",
5275                                 __func__, __LINE__);
5276                         break;
5277                 }
5278                 break;
5279         case DCMD_FAILED:
5280                 megaraid_sas_kill_hba(instance);
5281                 break;
5282
5283         }
5284
5285         if (ret != DCMD_TIMEOUT)
5286                 megasas_return_cmd(instance, cmd);
5287
5288         return ret;
5289 }
5290
5291 /*
5292  * megasas_set_crash_dump_params -      Sends address of crash dump DMA buffer
5293  *                                      to firmware
5294  *
5295  * @instance:                           Adapter soft state
5296  * @crash_buf_state             -       tell FW to turn ON/OFF crash dump feature
5297                                         MR_CRASH_BUF_TURN_OFF = 0
5298                                         MR_CRASH_BUF_TURN_ON = 1
5299  * @return 0 on success non-zero on failure.
5300  * Issues an internal command (DCMD) to set parameters for crash dump feature.
5301  * Driver will send address of crash dump DMA buffer and set mbox to tell FW
5302  * that driver supports crash dump feature. This DCMD will be sent only if
5303  * crash dump feature is supported by the FW.
5304  *
5305  */
5306 int megasas_set_crash_dump_params(struct megasas_instance *instance,
5307         u8 crash_buf_state)
5308 {
5309         int ret = 0;
5310         struct megasas_cmd *cmd;
5311         struct megasas_dcmd_frame *dcmd;
5312
5313         cmd = megasas_get_cmd(instance);
5314
5315         if (!cmd) {
5316                 dev_err(&instance->pdev->dev, "Failed to get a free cmd\n");
5317                 return -ENOMEM;
5318         }
5319
5320
5321         dcmd = &cmd->frame->dcmd;
5322
5323         memset(dcmd->mbox.b, 0, MFI_MBOX_SIZE);
5324         dcmd->mbox.b[0] = crash_buf_state;
5325         dcmd->cmd = MFI_CMD_DCMD;
5326         dcmd->cmd_status = MFI_STAT_INVALID_STATUS;
5327         dcmd->sge_count = 1;
5328         dcmd->flags = MFI_FRAME_DIR_NONE;
5329         dcmd->timeout = 0;
5330         dcmd->pad_0 = 0;
5331         dcmd->data_xfer_len = cpu_to_le32(CRASH_DMA_BUF_SIZE);
5332         dcmd->opcode = cpu_to_le32(MR_DCMD_CTRL_SET_CRASH_DUMP_PARAMS);
5333
5334         megasas_set_dma_settings(instance, dcmd, instance->crash_dump_h,
5335                                  CRASH_DMA_BUF_SIZE);
5336
5337         if ((instance->adapter_type != MFI_SERIES) &&
5338             !instance->mask_interrupts)
5339                 ret = megasas_issue_blocked_cmd(instance, cmd, MFI_IO_TIMEOUT_SECS);
5340         else
5341                 ret = megasas_issue_polled(instance, cmd);
5342
5343         if (ret == DCMD_TIMEOUT) {
5344                 switch (dcmd_timeout_ocr_possible(instance)) {
5345                 case INITIATE_OCR:
5346                         cmd->flags |= DRV_DCMD_SKIP_REFIRE;
5347                         megasas_reset_fusion(instance->host,
5348                                         MFI_IO_TIMEOUT_OCR);
5349                         break;
5350                 case KILL_ADAPTER:
5351                         megaraid_sas_kill_hba(instance);
5352                         break;
5353                 case IGNORE_TIMEOUT:
5354                         dev_info(&instance->pdev->dev, "Ignore DCMD timeout: %s %d\n",
5355                                 __func__, __LINE__);
5356                         break;
5357                 }
5358         } else
5359                 megasas_return_cmd(instance, cmd);
5360
5361         return ret;
5362 }
5363
5364 /**
5365  * megasas_issue_init_mfi -     Initializes the FW
5366  * @instance:           Adapter soft state
5367  *
5368  * Issues the INIT MFI cmd
5369  */
5370 static int
5371 megasas_issue_init_mfi(struct megasas_instance *instance)
5372 {
5373         __le32 context;
5374         struct megasas_cmd *cmd;
5375         struct megasas_init_frame *init_frame;
5376         struct megasas_init_queue_info *initq_info;
5377         dma_addr_t init_frame_h;
5378         dma_addr_t initq_info_h;
5379
5380         /*
5381          * Prepare a init frame. Note the init frame points to queue info
5382          * structure. Each frame has SGL allocated after first 64 bytes. For
5383          * this frame - since we don't need any SGL - we use SGL's space as
5384          * queue info structure
5385          *
5386          * We will not get a NULL command below. We just created the pool.
5387          */
5388         cmd = megasas_get_cmd(instance);
5389
5390         init_frame = (struct megasas_init_frame *)cmd->frame;
5391         initq_info = (struct megasas_init_queue_info *)
5392                 ((unsigned long)init_frame + 64);
5393
5394         init_frame_h = cmd->frame_phys_addr;
5395         initq_info_h = init_frame_h + 64;
5396
5397         context = init_frame->context;
5398         memset(init_frame, 0, MEGAMFI_FRAME_SIZE);
5399         memset(initq_info, 0, sizeof(struct megasas_init_queue_info));
5400         init_frame->context = context;
5401
5402         initq_info->reply_queue_entries = cpu_to_le32(instance->max_fw_cmds + 1);
5403         initq_info->reply_queue_start_phys_addr_lo = cpu_to_le32(instance->reply_queue_h);
5404
5405         initq_info->producer_index_phys_addr_lo = cpu_to_le32(instance->producer_h);
5406         initq_info->consumer_index_phys_addr_lo = cpu_to_le32(instance->consumer_h);
5407
5408         init_frame->cmd = MFI_CMD_INIT;
5409         init_frame->cmd_status = MFI_STAT_INVALID_STATUS;
5410         init_frame->queue_info_new_phys_addr_lo =
5411                 cpu_to_le32(lower_32_bits(initq_info_h));
5412         init_frame->queue_info_new_phys_addr_hi =
5413                 cpu_to_le32(upper_32_bits(initq_info_h));
5414
5415         init_frame->data_xfer_len = cpu_to_le32(sizeof(struct megasas_init_queue_info));
5416
5417         /*
5418          * disable the intr before firing the init frame to FW
5419          */
5420         instance->instancet->disable_intr(instance);
5421
5422         /*
5423          * Issue the init frame in polled mode
5424          */
5425
5426         if (megasas_issue_polled(instance, cmd)) {
5427                 dev_err(&instance->pdev->dev, "Failed to init firmware\n");
5428                 megasas_return_cmd(instance, cmd);
5429                 goto fail_fw_init;
5430         }
5431
5432         megasas_return_cmd(instance, cmd);
5433
5434         return 0;
5435
5436 fail_fw_init:
5437         return -EINVAL;
5438 }
5439
5440 static u32
5441 megasas_init_adapter_mfi(struct megasas_instance *instance)
5442 {
5443         u32 context_sz;
5444         u32 reply_q_sz;
5445
5446         /*
5447          * Get various operational parameters from status register
5448          */
5449         instance->max_fw_cmds = instance->instancet->read_fw_status_reg(instance) & 0x00FFFF;
5450         /*
5451          * Reduce the max supported cmds by 1. This is to ensure that the
5452          * reply_q_sz (1 more than the max cmd that driver may send)
5453          * does not exceed max cmds that the FW can support
5454          */
5455         instance->max_fw_cmds = instance->max_fw_cmds-1;
5456         instance->max_mfi_cmds = instance->max_fw_cmds;
5457         instance->max_num_sge = (instance->instancet->read_fw_status_reg(instance) & 0xFF0000) >>
5458                                         0x10;
5459         /*
5460          * For MFI skinny adapters, MEGASAS_SKINNY_INT_CMDS commands
5461          * are reserved for IOCTL + driver's internal DCMDs.
5462          */
5463         if ((instance->pdev->device == PCI_DEVICE_ID_LSI_SAS0073SKINNY) ||
5464                 (instance->pdev->device == PCI_DEVICE_ID_LSI_SAS0071SKINNY)) {
5465                 instance->max_scsi_cmds = (instance->max_fw_cmds -
5466                         MEGASAS_SKINNY_INT_CMDS);
5467                 sema_init(&instance->ioctl_sem, MEGASAS_SKINNY_INT_CMDS);
5468         } else {
5469                 instance->max_scsi_cmds = (instance->max_fw_cmds -
5470                         MEGASAS_INT_CMDS);
5471                 sema_init(&instance->ioctl_sem, (MEGASAS_MFI_IOCTL_CMDS));
5472         }
5473
5474         instance->cur_can_queue = instance->max_scsi_cmds;
5475         /*
5476          * Create a pool of commands
5477          */
5478         if (megasas_alloc_cmds(instance))
5479                 goto fail_alloc_cmds;
5480
5481         /*
5482          * Allocate memory for reply queue. Length of reply queue should
5483          * be _one_ more than the maximum commands handled by the firmware.
5484          *
5485          * Note: When FW completes commands, it places corresponding contex
5486          * values in this circular reply queue. This circular queue is a fairly
5487          * typical producer-consumer queue. FW is the producer (of completed
5488          * commands) and the driver is the consumer.
5489          */
5490         context_sz = sizeof(u32);
5491         reply_q_sz = context_sz * (instance->max_fw_cmds + 1);
5492
5493         instance->reply_queue = dma_alloc_coherent(&instance->pdev->dev,
5494                         reply_q_sz, &instance->reply_queue_h, GFP_KERNEL);
5495
5496         if (!instance->reply_queue) {
5497                 dev_printk(KERN_DEBUG, &instance->pdev->dev, "Out of DMA mem for reply queue\n");
5498                 goto fail_reply_queue;
5499         }
5500
5501         if (megasas_issue_init_mfi(instance))
5502                 goto fail_fw_init;
5503
5504         if (megasas_get_ctrl_info(instance)) {
5505                 dev_err(&instance->pdev->dev, "(%d): Could get controller info "
5506                         "Fail from %s %d\n", instance->unique_id,
5507                         __func__, __LINE__);
5508                 goto fail_fw_init;
5509         }
5510
5511         instance->fw_support_ieee = 0;
5512         instance->fw_support_ieee =
5513                 (instance->instancet->read_fw_status_reg(instance) &
5514                 0x04000000);
5515
5516         dev_notice(&instance->pdev->dev, "megasas_init_mfi: fw_support_ieee=%d",
5517                         instance->fw_support_ieee);
5518
5519         if (instance->fw_support_ieee)
5520                 instance->flag_ieee = 1;
5521
5522         return 0;
5523
5524 fail_fw_init:
5525
5526         dma_free_coherent(&instance->pdev->dev, reply_q_sz,
5527                             instance->reply_queue, instance->reply_queue_h);
5528 fail_reply_queue:
5529         megasas_free_cmds(instance);
5530
5531 fail_alloc_cmds:
5532         return 1;
5533 }
5534
5535 static
5536 void megasas_setup_irq_poll(struct megasas_instance *instance)
5537 {
5538         struct megasas_irq_context *irq_ctx;
5539         u32 count, i;
5540
5541         count = instance->msix_vectors > 0 ? instance->msix_vectors : 1;
5542
5543         /* Initialize IRQ poll */
5544         for (i = 0; i < count; i++) {
5545                 irq_ctx = &instance->irq_context[i];
5546                 irq_ctx->os_irq = pci_irq_vector(instance->pdev, i);
5547                 irq_ctx->irq_poll_scheduled = false;
5548                 irq_poll_init(&irq_ctx->irqpoll,
5549                               instance->threshold_reply_count,
5550                               megasas_irqpoll);
5551         }
5552 }
5553
5554 /*
5555  * megasas_setup_irqs_ioapic -          register legacy interrupts.
5556  * @instance:                           Adapter soft state
5557  *
5558  * Do not enable interrupt, only setup ISRs.
5559  *
5560  * Return 0 on success.
5561  */
5562 static int
5563 megasas_setup_irqs_ioapic(struct megasas_instance *instance)
5564 {
5565         struct pci_dev *pdev;
5566
5567         pdev = instance->pdev;
5568         instance->irq_context[0].instance = instance;
5569         instance->irq_context[0].MSIxIndex = 0;
5570         snprintf(instance->irq_context->name, MEGASAS_MSIX_NAME_LEN, "%s%u",
5571                 "megasas", instance->host->host_no);
5572         if (request_irq(pci_irq_vector(pdev, 0),
5573                         instance->instancet->service_isr, IRQF_SHARED,
5574                         instance->irq_context->name, &instance->irq_context[0])) {
5575                 dev_err(&instance->pdev->dev,
5576                                 "Failed to register IRQ from %s %d\n",
5577                                 __func__, __LINE__);
5578                 return -1;
5579         }
5580         instance->perf_mode = MR_LATENCY_PERF_MODE;
5581         instance->low_latency_index_start = 0;
5582         return 0;
5583 }
5584
5585 /**
5586  * megasas_setup_irqs_msix -            register MSI-x interrupts.
5587  * @instance:                           Adapter soft state
5588  * @is_probe:                           Driver probe check
5589  *
5590  * Do not enable interrupt, only setup ISRs.
5591  *
5592  * Return 0 on success.
5593  */
5594 static int
5595 megasas_setup_irqs_msix(struct megasas_instance *instance, u8 is_probe)
5596 {
5597         int i, j;
5598         struct pci_dev *pdev;
5599
5600         pdev = instance->pdev;
5601
5602         /* Try MSI-x */
5603         for (i = 0; i < instance->msix_vectors; i++) {
5604                 instance->irq_context[i].instance = instance;
5605                 instance->irq_context[i].MSIxIndex = i;
5606                 snprintf(instance->irq_context[i].name, MEGASAS_MSIX_NAME_LEN, "%s%u-msix%u",
5607                         "megasas", instance->host->host_no, i);
5608                 if (request_irq(pci_irq_vector(pdev, i),
5609                         instance->instancet->service_isr, 0, instance->irq_context[i].name,
5610                         &instance->irq_context[i])) {
5611                         dev_err(&instance->pdev->dev,
5612                                 "Failed to register IRQ for vector %d.\n", i);
5613                         for (j = 0; j < i; j++) {
5614                                 if (j < instance->low_latency_index_start)
5615                                         irq_set_affinity_hint(
5616                                                 pci_irq_vector(pdev, j), NULL);
5617                                 free_irq(pci_irq_vector(pdev, j),
5618                                          &instance->irq_context[j]);
5619                         }
5620                         /* Retry irq register for IO_APIC*/
5621                         instance->msix_vectors = 0;
5622                         instance->msix_load_balance = false;
5623                         if (is_probe) {
5624                                 pci_free_irq_vectors(instance->pdev);
5625                                 return megasas_setup_irqs_ioapic(instance);
5626                         } else {
5627                                 return -1;
5628                         }
5629                 }
5630         }
5631
5632         return 0;
5633 }
5634
5635 /*
5636  * megasas_destroy_irqs-                unregister interrupts.
5637  * @instance:                           Adapter soft state
5638  * return:                              void
5639  */
5640 static void
5641 megasas_destroy_irqs(struct megasas_instance *instance) {
5642
5643         int i;
5644         int count;
5645         struct megasas_irq_context *irq_ctx;
5646
5647         count = instance->msix_vectors > 0 ? instance->msix_vectors : 1;
5648         if (instance->adapter_type != MFI_SERIES) {
5649                 for (i = 0; i < count; i++) {
5650                         irq_ctx = &instance->irq_context[i];
5651                         irq_poll_disable(&irq_ctx->irqpoll);
5652                 }
5653         }
5654
5655         if (instance->msix_vectors)
5656                 for (i = 0; i < instance->msix_vectors; i++) {
5657                         if (i < instance->low_latency_index_start)
5658                                 irq_set_affinity_hint(
5659                                     pci_irq_vector(instance->pdev, i), NULL);
5660                         free_irq(pci_irq_vector(instance->pdev, i),
5661                                  &instance->irq_context[i]);
5662                 }
5663         else
5664                 free_irq(pci_irq_vector(instance->pdev, 0),
5665                          &instance->irq_context[0]);
5666 }
5667
5668 /**
5669  * megasas_setup_jbod_map -     setup jbod map for FP seq_number.
5670  * @instance:                           Adapter soft state
5671  *
5672  * Return 0 on success.
5673  */
5674 void
5675 megasas_setup_jbod_map(struct megasas_instance *instance)
5676 {
5677         int i;
5678         struct fusion_context *fusion = instance->ctrl_context;
5679         u32 pd_seq_map_sz;
5680
5681         pd_seq_map_sz = sizeof(struct MR_PD_CFG_SEQ_NUM_SYNC) +
5682                 (sizeof(struct MR_PD_CFG_SEQ) * (MAX_PHYSICAL_DEVICES - 1));
5683
5684         instance->use_seqnum_jbod_fp =
5685                 instance->support_seqnum_jbod_fp;
5686         if (reset_devices || !fusion ||
5687                 !instance->support_seqnum_jbod_fp) {
5688                 dev_info(&instance->pdev->dev,
5689                         "JBOD sequence map is disabled %s %d\n",
5690                         __func__, __LINE__);
5691                 instance->use_seqnum_jbod_fp = false;
5692                 return;
5693         }
5694
5695         if (fusion->pd_seq_sync[0])
5696                 goto skip_alloc;
5697
5698         for (i = 0; i < JBOD_MAPS_COUNT; i++) {
5699                 fusion->pd_seq_sync[i] = dma_alloc_coherent
5700                         (&instance->pdev->dev, pd_seq_map_sz,
5701                         &fusion->pd_seq_phys[i], GFP_KERNEL);
5702                 if (!fusion->pd_seq_sync[i]) {
5703                         dev_err(&instance->pdev->dev,
5704                                 "Failed to allocate memory from %s %d\n",
5705                                 __func__, __LINE__);
5706                         if (i == 1) {
5707                                 dma_free_coherent(&instance->pdev->dev,
5708                                         pd_seq_map_sz, fusion->pd_seq_sync[0],
5709                                         fusion->pd_seq_phys[0]);
5710                                 fusion->pd_seq_sync[0] = NULL;
5711                         }
5712                         instance->use_seqnum_jbod_fp = false;
5713                         return;
5714                 }
5715         }
5716
5717 skip_alloc:
5718         if (!megasas_sync_pd_seq_num(instance, false) &&
5719                 !megasas_sync_pd_seq_num(instance, true))
5720                 instance->use_seqnum_jbod_fp = true;
5721         else
5722                 instance->use_seqnum_jbod_fp = false;
5723 }
5724
5725 static void megasas_setup_reply_map(struct megasas_instance *instance)
5726 {
5727         const struct cpumask *mask;
5728         unsigned int queue, cpu, low_latency_index_start;
5729
5730         low_latency_index_start = instance->low_latency_index_start;
5731
5732         for (queue = low_latency_index_start; queue < instance->msix_vectors; queue++) {
5733                 mask = pci_irq_get_affinity(instance->pdev, queue);
5734                 if (!mask)
5735                         goto fallback;
5736
5737                 for_each_cpu(cpu, mask)
5738                         instance->reply_map[cpu] = queue;
5739         }
5740         return;
5741
5742 fallback:
5743         queue = low_latency_index_start;
5744         for_each_possible_cpu(cpu) {
5745                 instance->reply_map[cpu] = queue;
5746                 if (queue == (instance->msix_vectors - 1))
5747                         queue = low_latency_index_start;
5748                 else
5749                         queue++;
5750         }
5751 }
5752
5753 /**
5754  * megasas_get_device_list -    Get the PD and LD device list from FW.
5755  * @instance:                   Adapter soft state
5756  * @return:                     Success or failure
5757  *
5758  * Issue DCMDs to Firmware to get the PD and LD list.
5759  * Based on the FW support, driver sends the HOST_DEVICE_LIST or combination
5760  * of PD_LIST/LD_LIST_QUERY DCMDs to get the device list.
5761  */
5762 static
5763 int megasas_get_device_list(struct megasas_instance *instance)
5764 {
5765         memset(instance->pd_list, 0,
5766                (MEGASAS_MAX_PD * sizeof(struct megasas_pd_list)));
5767         memset(instance->ld_ids, 0xff, MEGASAS_MAX_LD_IDS);
5768
5769         if (instance->enable_fw_dev_list) {
5770                 if (megasas_host_device_list_query(instance, true))
5771                         return FAILED;
5772         } else {
5773                 if (megasas_get_pd_list(instance) < 0) {
5774                         dev_err(&instance->pdev->dev, "failed to get PD list\n");
5775                         return FAILED;
5776                 }
5777
5778                 if (megasas_ld_list_query(instance,
5779                                           MR_LD_QUERY_TYPE_EXPOSED_TO_HOST)) {
5780                         dev_err(&instance->pdev->dev, "failed to get LD list\n");
5781                         return FAILED;
5782                 }
5783         }
5784
5785         return SUCCESS;
5786 }
5787
5788 /**
5789  * megasas_set_high_iops_queue_affinity_hint -  Set affinity hint for high IOPS queues
5790  * @instance:                                   Adapter soft state
5791  * return:                                      void
5792  */
5793 static inline void
5794 megasas_set_high_iops_queue_affinity_hint(struct megasas_instance *instance)
5795 {
5796         int i;
5797         int local_numa_node;
5798
5799         if (instance->perf_mode == MR_BALANCED_PERF_MODE) {
5800                 local_numa_node = dev_to_node(&instance->pdev->dev);
5801
5802                 for (i = 0; i < instance->low_latency_index_start; i++)
5803                         irq_set_affinity_hint(pci_irq_vector(instance->pdev, i),
5804                                 cpumask_of_node(local_numa_node));
5805         }
5806 }
5807
5808 static int
5809 __megasas_alloc_irq_vectors(struct megasas_instance *instance)
5810 {
5811         int i, irq_flags;
5812         struct irq_affinity desc = { .pre_vectors = instance->low_latency_index_start };
5813         struct irq_affinity *descp = &desc;
5814
5815         irq_flags = PCI_IRQ_MSIX;
5816
5817         if (instance->smp_affinity_enable)
5818                 irq_flags |= PCI_IRQ_AFFINITY;
5819         else
5820                 descp = NULL;
5821
5822         i = pci_alloc_irq_vectors_affinity(instance->pdev,
5823                 instance->low_latency_index_start,
5824                 instance->msix_vectors, irq_flags, descp);
5825
5826         return i;
5827 }
5828
5829 /**
5830  * megasas_alloc_irq_vectors -  Allocate IRQ vectors/enable MSI-x vectors
5831  * @instance:                   Adapter soft state
5832  * return:                      void
5833  */
5834 static void
5835 megasas_alloc_irq_vectors(struct megasas_instance *instance)
5836 {
5837         int i;
5838         unsigned int num_msix_req;
5839
5840         i = __megasas_alloc_irq_vectors(instance);
5841
5842         if ((instance->perf_mode == MR_BALANCED_PERF_MODE) &&
5843             (i != instance->msix_vectors)) {
5844                 if (instance->msix_vectors)
5845                         pci_free_irq_vectors(instance->pdev);
5846                 /* Disable Balanced IOPS mode and try realloc vectors */
5847                 instance->perf_mode = MR_LATENCY_PERF_MODE;
5848                 instance->low_latency_index_start = 1;
5849                 num_msix_req = num_online_cpus() + instance->low_latency_index_start;
5850
5851                 instance->msix_vectors = min(num_msix_req,
5852                                 instance->msix_vectors);
5853
5854                 i = __megasas_alloc_irq_vectors(instance);
5855
5856         }
5857
5858         dev_info(&instance->pdev->dev,
5859                 "requested/available msix %d/%d\n", instance->msix_vectors, i);
5860
5861         if (i > 0)
5862                 instance->msix_vectors = i;
5863         else
5864                 instance->msix_vectors = 0;
5865
5866         if (instance->smp_affinity_enable)
5867                 megasas_set_high_iops_queue_affinity_hint(instance);
5868 }
5869
5870 /**
5871  * megasas_init_fw -    Initializes the FW
5872  * @instance:           Adapter soft state
5873  *
5874  * This is the main function for initializing firmware
5875  */
5876
5877 static int megasas_init_fw(struct megasas_instance *instance)
5878 {
5879         u32 max_sectors_1;
5880         u32 max_sectors_2, tmp_sectors, msix_enable;
5881         u32 scratch_pad_1, scratch_pad_2, scratch_pad_3, status_reg;
5882         resource_size_t base_addr;
5883         void *base_addr_phys;
5884         struct megasas_ctrl_info *ctrl_info = NULL;
5885         unsigned long bar_list;
5886         int i, j, loop;
5887         struct IOV_111 *iovPtr;
5888         struct fusion_context *fusion;
5889         bool intr_coalescing;
5890         unsigned int num_msix_req;
5891         u16 lnksta, speed;
5892
5893         fusion = instance->ctrl_context;
5894
5895         /* Find first memory bar */
5896         bar_list = pci_select_bars(instance->pdev, IORESOURCE_MEM);
5897         instance->bar = find_first_bit(&bar_list, BITS_PER_LONG);
5898         if (pci_request_selected_regions(instance->pdev, 1<<instance->bar,
5899                                          "megasas: LSI")) {
5900                 dev_printk(KERN_DEBUG, &instance->pdev->dev, "IO memory region busy!\n");
5901                 return -EBUSY;
5902         }
5903
5904         base_addr = pci_resource_start(instance->pdev, instance->bar);
5905         instance->reg_set = ioremap(base_addr, 8192);
5906
5907         if (!instance->reg_set) {
5908                 dev_printk(KERN_DEBUG, &instance->pdev->dev, "Failed to map IO mem\n");
5909                 goto fail_ioremap;
5910         }
5911
5912         base_addr_phys = &base_addr;
5913         dev_printk(KERN_DEBUG, &instance->pdev->dev,
5914                    "BAR:0x%lx  BAR's base_addr(phys):%pa  mapped virt_addr:0x%p\n",
5915                    instance->bar, base_addr_phys, instance->reg_set);
5916
5917         if (instance->adapter_type != MFI_SERIES)
5918                 instance->instancet = &megasas_instance_template_fusion;
5919         else {
5920                 switch (instance->pdev->device) {
5921                 case PCI_DEVICE_ID_LSI_SAS1078R:
5922                 case PCI_DEVICE_ID_LSI_SAS1078DE:
5923                         instance->instancet = &megasas_instance_template_ppc;
5924                         break;
5925                 case PCI_DEVICE_ID_LSI_SAS1078GEN2:
5926                 case PCI_DEVICE_ID_LSI_SAS0079GEN2:
5927                         instance->instancet = &megasas_instance_template_gen2;
5928                         break;
5929                 case PCI_DEVICE_ID_LSI_SAS0073SKINNY:
5930                 case PCI_DEVICE_ID_LSI_SAS0071SKINNY:
5931                         instance->instancet = &megasas_instance_template_skinny;
5932                         break;
5933                 case PCI_DEVICE_ID_LSI_SAS1064R:
5934                 case PCI_DEVICE_ID_DELL_PERC5:
5935                 default:
5936                         instance->instancet = &megasas_instance_template_xscale;
5937                         instance->pd_list_not_supported = 1;
5938                         break;
5939                 }
5940         }
5941
5942         if (megasas_transition_to_ready(instance, 0)) {
5943                 dev_info(&instance->pdev->dev,
5944                          "Failed to transition controller to ready from %s!\n",
5945                          __func__);
5946                 if (instance->adapter_type != MFI_SERIES) {
5947                         status_reg = instance->instancet->read_fw_status_reg(
5948                                         instance);
5949                         if (status_reg & MFI_RESET_ADAPTER) {
5950                                 if (megasas_adp_reset_wait_for_ready
5951                                         (instance, true, 0) == FAILED)
5952                                         goto fail_ready_state;
5953                         } else {
5954                                 goto fail_ready_state;
5955                         }
5956                 } else {
5957                         atomic_set(&instance->fw_reset_no_pci_access, 1);
5958                         instance->instancet->adp_reset
5959                                 (instance, instance->reg_set);
5960                         atomic_set(&instance->fw_reset_no_pci_access, 0);
5961
5962                         /*waiting for about 30 second before retry*/
5963                         ssleep(30);
5964
5965                         if (megasas_transition_to_ready(instance, 0))
5966                                 goto fail_ready_state;
5967                 }
5968
5969                 dev_info(&instance->pdev->dev,
5970                          "FW restarted successfully from %s!\n",
5971                          __func__);
5972         }
5973
5974         megasas_init_ctrl_params(instance);
5975
5976         if (megasas_set_dma_mask(instance))
5977                 goto fail_ready_state;
5978
5979         if (megasas_alloc_ctrl_mem(instance))
5980                 goto fail_alloc_dma_buf;
5981
5982         if (megasas_alloc_ctrl_dma_buffers(instance))
5983                 goto fail_alloc_dma_buf;
5984
5985         fusion = instance->ctrl_context;
5986
5987         if (instance->adapter_type >= VENTURA_SERIES) {
5988                 scratch_pad_2 =
5989                         megasas_readl(instance,
5990                                       &instance->reg_set->outbound_scratch_pad_2);
5991                 instance->max_raid_mapsize = ((scratch_pad_2 >>
5992                         MR_MAX_RAID_MAP_SIZE_OFFSET_SHIFT) &
5993                         MR_MAX_RAID_MAP_SIZE_MASK);
5994         }
5995
5996         instance->enable_sdev_max_qd = enable_sdev_max_qd;
5997
5998         switch (instance->adapter_type) {
5999         case VENTURA_SERIES:
6000                 fusion->pcie_bw_limitation = true;
6001                 break;
6002         case AERO_SERIES:
6003                 fusion->r56_div_offload = true;
6004                 break;
6005         default:
6006                 break;
6007         }
6008
6009         /* Check if MSI-X is supported while in ready state */
6010         msix_enable = (instance->instancet->read_fw_status_reg(instance) &
6011                        0x4000000) >> 0x1a;
6012         if (msix_enable && !msix_disable) {
6013
6014                 scratch_pad_1 = megasas_readl
6015                         (instance, &instance->reg_set->outbound_scratch_pad_1);
6016                 /* Check max MSI-X vectors */
6017                 if (fusion) {
6018                         if (instance->adapter_type == THUNDERBOLT_SERIES) {
6019                                 /* Thunderbolt Series*/
6020                                 instance->msix_vectors = (scratch_pad_1
6021                                         & MR_MAX_REPLY_QUEUES_OFFSET) + 1;
6022                         } else {
6023                                 instance->msix_vectors = ((scratch_pad_1
6024                                         & MR_MAX_REPLY_QUEUES_EXT_OFFSET)
6025                                         >> MR_MAX_REPLY_QUEUES_EXT_OFFSET_SHIFT) + 1;
6026
6027                                 /*
6028                                  * For Invader series, > 8 MSI-x vectors
6029                                  * supported by FW/HW implies combined
6030                                  * reply queue mode is enabled.
6031                                  * For Ventura series, > 16 MSI-x vectors
6032                                  * supported by FW/HW implies combined
6033                                  * reply queue mode is enabled.
6034                                  */
6035                                 switch (instance->adapter_type) {
6036                                 case INVADER_SERIES:
6037                                         if (instance->msix_vectors > 8)
6038                                                 instance->msix_combined = true;
6039                                         break;
6040                                 case AERO_SERIES:
6041                                 case VENTURA_SERIES:
6042                                         if (instance->msix_vectors > 16)
6043                                                 instance->msix_combined = true;
6044                                         break;
6045                                 }
6046
6047                                 if (rdpq_enable)
6048                                         instance->is_rdpq = (scratch_pad_1 & MR_RDPQ_MODE_OFFSET) ?
6049                                                                 1 : 0;
6050
6051                                 if (instance->adapter_type >= INVADER_SERIES &&
6052                                     !instance->msix_combined) {
6053                                         instance->msix_load_balance = true;
6054                                         instance->smp_affinity_enable = false;
6055                                 }
6056
6057                                 /* Save 1-15 reply post index address to local memory
6058                                  * Index 0 is already saved from reg offset
6059                                  * MPI2_REPLY_POST_HOST_INDEX_OFFSET
6060                                  */
6061                                 for (loop = 1; loop < MR_MAX_MSIX_REG_ARRAY; loop++) {
6062                                         instance->reply_post_host_index_addr[loop] =
6063                                                 (u32 __iomem *)
6064                                                 ((u8 __iomem *)instance->reg_set +
6065                                                 MPI2_SUP_REPLY_POST_HOST_INDEX_OFFSET
6066                                                 + (loop * 0x10));
6067                                 }
6068                         }
6069
6070                         dev_info(&instance->pdev->dev,
6071                                  "firmware supports msix\t: (%d)",
6072                                  instance->msix_vectors);
6073                         if (msix_vectors)
6074                                 instance->msix_vectors = min(msix_vectors,
6075                                         instance->msix_vectors);
6076                 } else /* MFI adapters */
6077                         instance->msix_vectors = 1;
6078
6079
6080                 /*
6081                  * For Aero (if some conditions are met), driver will configure a
6082                  * few additional reply queues with interrupt coalescing enabled.
6083                  * These queues with interrupt coalescing enabled are called
6084                  * High IOPS queues and rest of reply queues (based on number of
6085                  * logical CPUs) are termed as Low latency queues.
6086                  *
6087                  * Total Number of reply queues = High IOPS queues + low latency queues
6088                  *
6089                  * For rest of fusion adapters, 1 additional reply queue will be
6090                  * reserved for management commands, rest of reply queues
6091                  * (based on number of logical CPUs) will be used for IOs and
6092                  * referenced as IO queues.
6093                  * Total Number of reply queues = 1 + IO queues
6094                  *
6095                  * MFI adapters supports single MSI-x so single reply queue
6096                  * will be used for IO and management commands.
6097                  */
6098
6099                 intr_coalescing = (scratch_pad_1 & MR_INTR_COALESCING_SUPPORT_OFFSET) ?
6100                                                                 true : false;
6101                 if (intr_coalescing &&
6102                         (num_online_cpus() >= MR_HIGH_IOPS_QUEUE_COUNT) &&
6103                         (instance->msix_vectors == MEGASAS_MAX_MSIX_QUEUES))
6104                         instance->perf_mode = MR_BALANCED_PERF_MODE;
6105                 else
6106                         instance->perf_mode = MR_LATENCY_PERF_MODE;
6107
6108
6109                 if (instance->adapter_type == AERO_SERIES) {
6110                         pcie_capability_read_word(instance->pdev, PCI_EXP_LNKSTA, &lnksta);
6111                         speed = lnksta & PCI_EXP_LNKSTA_CLS;
6112
6113                         /*
6114                          * For Aero, if PCIe link speed is <16 GT/s, then driver should operate
6115                          * in latency perf mode and enable R1 PCI bandwidth algorithm
6116                          */
6117                         if (speed < 0x4) {
6118                                 instance->perf_mode = MR_LATENCY_PERF_MODE;
6119                                 fusion->pcie_bw_limitation = true;
6120                         }
6121
6122                         /*
6123                          * Performance mode settings provided through module parameter-perf_mode will
6124                          * take affect only for:
6125                          * 1. Aero family of adapters.
6126                          * 2. When user sets module parameter- perf_mode in range of 0-2.
6127                          */
6128                         if ((perf_mode >= MR_BALANCED_PERF_MODE) &&
6129                                 (perf_mode <= MR_LATENCY_PERF_MODE))
6130                                 instance->perf_mode = perf_mode;
6131                         /*
6132                          * If intr coalescing is not supported by controller FW, then IOPS
6133                          * and Balanced modes are not feasible.
6134                          */
6135                         if (!intr_coalescing)
6136                                 instance->perf_mode = MR_LATENCY_PERF_MODE;
6137
6138                 }
6139
6140                 if (instance->perf_mode == MR_BALANCED_PERF_MODE)
6141                         instance->low_latency_index_start =
6142                                 MR_HIGH_IOPS_QUEUE_COUNT;
6143                 else
6144                         instance->low_latency_index_start = 1;
6145
6146                 num_msix_req = num_online_cpus() + instance->low_latency_index_start;
6147
6148                 instance->msix_vectors = min(num_msix_req,
6149                                 instance->msix_vectors);
6150
6151                 megasas_alloc_irq_vectors(instance);
6152                 if (!instance->msix_vectors)
6153                         instance->msix_load_balance = false;
6154         }
6155         /*
6156          * MSI-X host index 0 is common for all adapter.
6157          * It is used for all MPT based Adapters.
6158          */
6159         if (instance->msix_combined) {
6160                 instance->reply_post_host_index_addr[0] =
6161                                 (u32 *)((u8 *)instance->reg_set +
6162                                 MPI2_SUP_REPLY_POST_HOST_INDEX_OFFSET);
6163         } else {
6164                 instance->reply_post_host_index_addr[0] =
6165                         (u32 *)((u8 *)instance->reg_set +
6166                         MPI2_REPLY_POST_HOST_INDEX_OFFSET);
6167         }
6168
6169         if (!instance->msix_vectors) {
6170                 i = pci_alloc_irq_vectors(instance->pdev, 1, 1, PCI_IRQ_LEGACY);
6171                 if (i < 0)
6172                         goto fail_init_adapter;
6173         }
6174
6175         megasas_setup_reply_map(instance);
6176
6177         dev_info(&instance->pdev->dev,
6178                 "current msix/online cpus\t: (%d/%d)\n",
6179                 instance->msix_vectors, (unsigned int)num_online_cpus());
6180         dev_info(&instance->pdev->dev,
6181                 "RDPQ mode\t: (%s)\n", instance->is_rdpq ? "enabled" : "disabled");
6182
6183         tasklet_init(&instance->isr_tasklet, instance->instancet->tasklet,
6184                 (unsigned long)instance);
6185
6186         /*
6187          * Below are default value for legacy Firmware.
6188          * non-fusion based controllers
6189          */
6190         instance->fw_supported_vd_count = MAX_LOGICAL_DRIVES;
6191         instance->fw_supported_pd_count = MAX_PHYSICAL_DEVICES;
6192         /* Get operational params, sge flags, send init cmd to controller */
6193         if (instance->instancet->init_adapter(instance))
6194                 goto fail_init_adapter;
6195
6196         if (instance->adapter_type >= VENTURA_SERIES) {
6197                 scratch_pad_3 =
6198                         megasas_readl(instance,
6199                                       &instance->reg_set->outbound_scratch_pad_3);
6200                 if ((scratch_pad_3 & MR_NVME_PAGE_SIZE_MASK) >=
6201                         MR_DEFAULT_NVME_PAGE_SHIFT)
6202                         instance->nvme_page_size =
6203                                 (1 << (scratch_pad_3 & MR_NVME_PAGE_SIZE_MASK));
6204
6205                 dev_info(&instance->pdev->dev,
6206                          "NVME page size\t: (%d)\n", instance->nvme_page_size);
6207         }
6208
6209         if (instance->msix_vectors ?
6210                 megasas_setup_irqs_msix(instance, 1) :
6211                 megasas_setup_irqs_ioapic(instance))
6212                 goto fail_init_adapter;
6213
6214         if (instance->adapter_type != MFI_SERIES)
6215                 megasas_setup_irq_poll(instance);
6216
6217         instance->instancet->enable_intr(instance);
6218
6219         dev_info(&instance->pdev->dev, "INIT adapter done\n");
6220
6221         megasas_setup_jbod_map(instance);
6222
6223         if (megasas_get_device_list(instance) != SUCCESS) {
6224                 dev_err(&instance->pdev->dev,
6225                         "%s: megasas_get_device_list failed\n",
6226                         __func__);
6227                 goto fail_get_ld_pd_list;
6228         }
6229
6230         /* stream detection initialization */
6231         if (instance->adapter_type >= VENTURA_SERIES) {
6232                 fusion->stream_detect_by_ld =
6233                         kcalloc(MAX_LOGICAL_DRIVES_EXT,
6234                                 sizeof(struct LD_STREAM_DETECT *),
6235                                 GFP_KERNEL);
6236                 if (!fusion->stream_detect_by_ld) {
6237                         dev_err(&instance->pdev->dev,
6238                                 "unable to allocate stream detection for pool of LDs\n");
6239                         goto fail_get_ld_pd_list;
6240                 }
6241                 for (i = 0; i < MAX_LOGICAL_DRIVES_EXT; ++i) {
6242                         fusion->stream_detect_by_ld[i] =
6243                                 kzalloc(sizeof(struct LD_STREAM_DETECT),
6244                                 GFP_KERNEL);
6245                         if (!fusion->stream_detect_by_ld[i]) {
6246                                 dev_err(&instance->pdev->dev,
6247                                         "unable to allocate stream detect by LD\n ");
6248                                 for (j = 0; j < i; ++j)
6249                                         kfree(fusion->stream_detect_by_ld[j]);
6250                                 kfree(fusion->stream_detect_by_ld);
6251                                 fusion->stream_detect_by_ld = NULL;
6252                                 goto fail_get_ld_pd_list;
6253                         }
6254                         fusion->stream_detect_by_ld[i]->mru_bit_map
6255                                 = MR_STREAM_BITMAP;
6256                 }
6257         }
6258
6259         /*
6260          * Compute the max allowed sectors per IO: The controller info has two
6261          * limits on max sectors. Driver should use the minimum of these two.
6262          *
6263          * 1 << stripe_sz_ops.min = max sectors per strip
6264          *
6265          * Note that older firmwares ( < FW ver 30) didn't report information
6266          * to calculate max_sectors_1. So the number ended up as zero always.
6267          */
6268         tmp_sectors = 0;
6269         ctrl_info = instance->ctrl_info_buf;
6270
6271         max_sectors_1 = (1 << ctrl_info->stripe_sz_ops.min) *
6272                 le16_to_cpu(ctrl_info->max_strips_per_io);
6273         max_sectors_2 = le32_to_cpu(ctrl_info->max_request_size);
6274
6275         tmp_sectors = min_t(u32, max_sectors_1, max_sectors_2);
6276
6277         instance->peerIsPresent = ctrl_info->cluster.peerIsPresent;
6278         instance->passive = ctrl_info->cluster.passive;
6279         memcpy(instance->clusterId, ctrl_info->clusterId, sizeof(instance->clusterId));
6280         instance->UnevenSpanSupport =
6281                 ctrl_info->adapterOperations2.supportUnevenSpans;
6282         if (instance->UnevenSpanSupport) {
6283                 struct fusion_context *fusion = instance->ctrl_context;
6284                 if (MR_ValidateMapInfo(instance, instance->map_id))
6285                         fusion->fast_path_io = 1;
6286                 else
6287                         fusion->fast_path_io = 0;
6288
6289         }
6290         if (ctrl_info->host_interface.SRIOV) {
6291                 instance->requestorId = ctrl_info->iov.requestorId;
6292                 if (instance->pdev->device == PCI_DEVICE_ID_LSI_PLASMA) {
6293                         if (!ctrl_info->adapterOperations2.activePassive)
6294                             instance->PlasmaFW111 = 1;
6295
6296                         dev_info(&instance->pdev->dev, "SR-IOV: firmware type: %s\n",
6297                             instance->PlasmaFW111 ? "1.11" : "new");
6298
6299                         if (instance->PlasmaFW111) {
6300                             iovPtr = (struct IOV_111 *)
6301                                 ((unsigned char *)ctrl_info + IOV_111_OFFSET);
6302                             instance->requestorId = iovPtr->requestorId;
6303                         }
6304                 }
6305                 dev_info(&instance->pdev->dev, "SRIOV: VF requestorId %d\n",
6306                         instance->requestorId);
6307         }
6308
6309         instance->crash_dump_fw_support =
6310                 ctrl_info->adapterOperations3.supportCrashDump;
6311         instance->crash_dump_drv_support =
6312                 (instance->crash_dump_fw_support &&
6313                 instance->crash_dump_buf);
6314         if (instance->crash_dump_drv_support)
6315                 megasas_set_crash_dump_params(instance,
6316                         MR_CRASH_BUF_TURN_OFF);
6317
6318         else {
6319                 if (instance->crash_dump_buf)
6320                         dma_free_coherent(&instance->pdev->dev,
6321                                 CRASH_DMA_BUF_SIZE,
6322                                 instance->crash_dump_buf,
6323                                 instance->crash_dump_h);
6324                 instance->crash_dump_buf = NULL;
6325         }
6326
6327         if (instance->snapdump_wait_time) {
6328                 megasas_get_snapdump_properties(instance);
6329                 dev_info(&instance->pdev->dev, "Snap dump wait time\t: %d\n",
6330                          instance->snapdump_wait_time);
6331         }
6332
6333         dev_info(&instance->pdev->dev,
6334                 "pci id\t\t: (0x%04x)/(0x%04x)/(0x%04x)/(0x%04x)\n",
6335                 le16_to_cpu(ctrl_info->pci.vendor_id),
6336                 le16_to_cpu(ctrl_info->pci.device_id),
6337                 le16_to_cpu(ctrl_info->pci.sub_vendor_id),
6338                 le16_to_cpu(ctrl_info->pci.sub_device_id));
6339         dev_info(&instance->pdev->dev, "unevenspan support      : %s\n",
6340                 instance->UnevenSpanSupport ? "yes" : "no");
6341         dev_info(&instance->pdev->dev, "firmware crash dump     : %s\n",
6342                 instance->crash_dump_drv_support ? "yes" : "no");
6343         dev_info(&instance->pdev->dev, "JBOD sequence map       : %s\n",
6344                 instance->use_seqnum_jbod_fp ? "enabled" : "disabled");
6345
6346         instance->max_sectors_per_req = instance->max_num_sge *
6347                                                 SGE_BUFFER_SIZE / 512;
6348         if (tmp_sectors && (instance->max_sectors_per_req > tmp_sectors))
6349                 instance->max_sectors_per_req = tmp_sectors;
6350
6351         /* Check for valid throttlequeuedepth module parameter */
6352         if (throttlequeuedepth &&
6353                         throttlequeuedepth <= instance->max_scsi_cmds)
6354                 instance->throttlequeuedepth = throttlequeuedepth;
6355         else
6356                 instance->throttlequeuedepth =
6357                                 MEGASAS_THROTTLE_QUEUE_DEPTH;
6358
6359         if ((resetwaittime < 1) ||
6360             (resetwaittime > MEGASAS_RESET_WAIT_TIME))
6361                 resetwaittime = MEGASAS_RESET_WAIT_TIME;
6362
6363         if ((scmd_timeout < 10) || (scmd_timeout > MEGASAS_DEFAULT_CMD_TIMEOUT))
6364                 scmd_timeout = MEGASAS_DEFAULT_CMD_TIMEOUT;
6365
6366         /* Launch SR-IOV heartbeat timer */
6367         if (instance->requestorId) {
6368                 if (!megasas_sriov_start_heartbeat(instance, 1)) {
6369                         megasas_start_timer(instance);
6370                 } else {
6371                         instance->skip_heartbeat_timer_del = 1;
6372                         goto fail_get_ld_pd_list;
6373                 }
6374         }
6375
6376         /*
6377          * Create and start watchdog thread which will monitor
6378          * controller state every 1 sec and trigger OCR when
6379          * it enters fault state
6380          */
6381         if (instance->adapter_type != MFI_SERIES)
6382                 if (megasas_fusion_start_watchdog(instance) != SUCCESS)
6383                         goto fail_start_watchdog;
6384
6385         return 0;
6386
6387 fail_start_watchdog:
6388         if (instance->requestorId && !instance->skip_heartbeat_timer_del)
6389                 del_timer_sync(&instance->sriov_heartbeat_timer);
6390 fail_get_ld_pd_list:
6391         instance->instancet->disable_intr(instance);
6392         megasas_destroy_irqs(instance);
6393 fail_init_adapter:
6394         if (instance->msix_vectors)
6395                 pci_free_irq_vectors(instance->pdev);
6396         instance->msix_vectors = 0;
6397 fail_alloc_dma_buf:
6398         megasas_free_ctrl_dma_buffers(instance);
6399         megasas_free_ctrl_mem(instance);
6400 fail_ready_state:
6401         iounmap(instance->reg_set);
6402
6403 fail_ioremap:
6404         pci_release_selected_regions(instance->pdev, 1<<instance->bar);
6405
6406         dev_err(&instance->pdev->dev, "Failed from %s %d\n",
6407                 __func__, __LINE__);
6408         return -EINVAL;
6409 }
6410
6411 /**
6412  * megasas_release_mfi -        Reverses the FW initialization
6413  * @instance:                   Adapter soft state
6414  */
6415 static void megasas_release_mfi(struct megasas_instance *instance)
6416 {
6417         u32 reply_q_sz = sizeof(u32) *(instance->max_mfi_cmds + 1);
6418
6419         if (instance->reply_queue)
6420                 dma_free_coherent(&instance->pdev->dev, reply_q_sz,
6421                             instance->reply_queue, instance->reply_queue_h);
6422
6423         megasas_free_cmds(instance);
6424
6425         iounmap(instance->reg_set);
6426
6427         pci_release_selected_regions(instance->pdev, 1<<instance->bar);
6428 }
6429
6430 /**
6431  * megasas_get_seq_num -        Gets latest event sequence numbers
6432  * @instance:                   Adapter soft state
6433  * @eli:                        FW event log sequence numbers information
6434  *
6435  * FW maintains a log of all events in a non-volatile area. Upper layers would
6436  * usually find out the latest sequence number of the events, the seq number at
6437  * the boot etc. They would "read" all the events below the latest seq number
6438  * by issuing a direct fw cmd (DCMD). For the future events (beyond latest seq
6439  * number), they would subsribe to AEN (asynchronous event notification) and
6440  * wait for the events to happen.
6441  */
6442 static int
6443 megasas_get_seq_num(struct megasas_instance *instance,
6444                     struct megasas_evt_log_info *eli)
6445 {
6446         struct megasas_cmd *cmd;
6447         struct megasas_dcmd_frame *dcmd;
6448         struct megasas_evt_log_info *el_info;
6449         dma_addr_t el_info_h = 0;
6450         int ret;
6451
6452         cmd = megasas_get_cmd(instance);
6453
6454         if (!cmd) {
6455                 return -ENOMEM;
6456         }
6457
6458         dcmd = &cmd->frame->dcmd;
6459         el_info = dma_alloc_coherent(&instance->pdev->dev,
6460                                      sizeof(struct megasas_evt_log_info),
6461                                      &el_info_h, GFP_KERNEL);
6462         if (!el_info) {
6463                 megasas_return_cmd(instance, cmd);
6464                 return -ENOMEM;
6465         }
6466
6467         memset(dcmd->mbox.b, 0, MFI_MBOX_SIZE);
6468
6469         dcmd->cmd = MFI_CMD_DCMD;
6470         dcmd->cmd_status = 0x0;
6471         dcmd->sge_count = 1;
6472         dcmd->flags = MFI_FRAME_DIR_READ;
6473         dcmd->timeout = 0;
6474         dcmd->pad_0 = 0;
6475         dcmd->data_xfer_len = cpu_to_le32(sizeof(struct megasas_evt_log_info));
6476         dcmd->opcode = cpu_to_le32(MR_DCMD_CTRL_EVENT_GET_INFO);
6477
6478         megasas_set_dma_settings(instance, dcmd, el_info_h,
6479                                  sizeof(struct megasas_evt_log_info));
6480
6481         ret = megasas_issue_blocked_cmd(instance, cmd, MFI_IO_TIMEOUT_SECS);
6482         if (ret != DCMD_SUCCESS) {
6483                 dev_err(&instance->pdev->dev, "Failed from %s %d\n",
6484                         __func__, __LINE__);
6485                 goto dcmd_failed;
6486         }
6487
6488         /*
6489          * Copy the data back into callers buffer
6490          */
6491         eli->newest_seq_num = el_info->newest_seq_num;
6492         eli->oldest_seq_num = el_info->oldest_seq_num;
6493         eli->clear_seq_num = el_info->clear_seq_num;
6494         eli->shutdown_seq_num = el_info->shutdown_seq_num;
6495         eli->boot_seq_num = el_info->boot_seq_num;
6496
6497 dcmd_failed:
6498         dma_free_coherent(&instance->pdev->dev,
6499                         sizeof(struct megasas_evt_log_info),
6500                         el_info, el_info_h);
6501
6502         megasas_return_cmd(instance, cmd);
6503
6504         return ret;
6505 }
6506
6507 /**
6508  * megasas_register_aen -       Registers for asynchronous event notification
6509  * @instance:                   Adapter soft state
6510  * @seq_num:                    The starting sequence number
6511  * @class_locale_word:          Class of the event
6512  *
6513  * This function subscribes for AEN for events beyond the @seq_num. It requests
6514  * to be notified if and only if the event is of type @class_locale
6515  */
6516 static int
6517 megasas_register_aen(struct megasas_instance *instance, u32 seq_num,
6518                      u32 class_locale_word)
6519 {
6520         int ret_val;
6521         struct megasas_cmd *cmd;
6522         struct megasas_dcmd_frame *dcmd;
6523         union megasas_evt_class_locale curr_aen;
6524         union megasas_evt_class_locale prev_aen;
6525
6526         /*
6527          * If there an AEN pending already (aen_cmd), check if the
6528          * class_locale of that pending AEN is inclusive of the new
6529          * AEN request we currently have. If it is, then we don't have
6530          * to do anything. In other words, whichever events the current
6531          * AEN request is subscribing to, have already been subscribed
6532          * to.
6533          *
6534          * If the old_cmd is _not_ inclusive, then we have to abort
6535          * that command, form a class_locale that is superset of both
6536          * old and current and re-issue to the FW
6537          */
6538
6539         curr_aen.word = class_locale_word;
6540
6541         if (instance->aen_cmd) {
6542
6543                 prev_aen.word =
6544                         le32_to_cpu(instance->aen_cmd->frame->dcmd.mbox.w[1]);
6545
6546                 if ((curr_aen.members.class < MFI_EVT_CLASS_DEBUG) ||
6547                     (curr_aen.members.class > MFI_EVT_CLASS_DEAD)) {
6548                         dev_info(&instance->pdev->dev,
6549                                  "%s %d out of range class %d send by application\n",
6550                                  __func__, __LINE__, curr_aen.members.class);
6551                         return 0;
6552                 }
6553
6554                 /*
6555                  * A class whose enum value is smaller is inclusive of all
6556                  * higher values. If a PROGRESS (= -1) was previously
6557                  * registered, then a new registration requests for higher
6558                  * classes need not be sent to FW. They are automatically
6559                  * included.
6560                  *
6561                  * Locale numbers don't have such hierarchy. They are bitmap
6562                  * values
6563                  */
6564                 if ((prev_aen.members.class <= curr_aen.members.class) &&
6565                     !((prev_aen.members.locale & curr_aen.members.locale) ^
6566                       curr_aen.members.locale)) {
6567                         /*
6568                          * Previously issued event registration includes
6569                          * current request. Nothing to do.
6570                          */
6571                         return 0;
6572                 } else {
6573                         curr_aen.members.locale |= prev_aen.members.locale;
6574
6575                         if (prev_aen.members.class < curr_aen.members.class)
6576                                 curr_aen.members.class = prev_aen.members.class;
6577
6578                         instance->aen_cmd->abort_aen = 1;
6579                         ret_val = megasas_issue_blocked_abort_cmd(instance,
6580                                                                   instance->
6581                                                                   aen_cmd, 30);
6582
6583                         if (ret_val) {
6584                                 dev_printk(KERN_DEBUG, &instance->pdev->dev, "Failed to abort "
6585                                        "previous AEN command\n");
6586                                 return ret_val;
6587                         }
6588                 }
6589         }
6590
6591         cmd = megasas_get_cmd(instance);
6592
6593         if (!cmd)
6594                 return -ENOMEM;
6595
6596         dcmd = &cmd->frame->dcmd;
6597
6598         memset(instance->evt_detail, 0, sizeof(struct megasas_evt_detail));
6599
6600         /*
6601          * Prepare DCMD for aen registration
6602          */
6603         memset(dcmd->mbox.b, 0, MFI_MBOX_SIZE);
6604
6605         dcmd->cmd = MFI_CMD_DCMD;
6606         dcmd->cmd_status = 0x0;
6607         dcmd->sge_count = 1;
6608         dcmd->flags = MFI_FRAME_DIR_READ;
6609         dcmd->timeout = 0;
6610         dcmd->pad_0 = 0;
6611         dcmd->data_xfer_len = cpu_to_le32(sizeof(struct megasas_evt_detail));
6612         dcmd->opcode = cpu_to_le32(MR_DCMD_CTRL_EVENT_WAIT);
6613         dcmd->mbox.w[0] = cpu_to_le32(seq_num);
6614         instance->last_seq_num = seq_num;
6615         dcmd->mbox.w[1] = cpu_to_le32(curr_aen.word);
6616
6617         megasas_set_dma_settings(instance, dcmd, instance->evt_detail_h,
6618                                  sizeof(struct megasas_evt_detail));
6619
6620         if (instance->aen_cmd != NULL) {
6621                 megasas_return_cmd(instance, cmd);
6622                 return 0;
6623         }
6624
6625         /*
6626          * Store reference to the cmd used to register for AEN. When an
6627          * application wants us to register for AEN, we have to abort this
6628          * cmd and re-register with a new EVENT LOCALE supplied by that app
6629          */
6630         instance->aen_cmd = cmd;
6631
6632         /*
6633          * Issue the aen registration frame
6634          */
6635         instance->instancet->issue_dcmd(instance, cmd);
6636
6637         return 0;
6638 }
6639
6640 /* megasas_get_target_prop - Send DCMD with below details to firmware.
6641  *
6642  * This DCMD will fetch few properties of LD/system PD defined
6643  * in MR_TARGET_DEV_PROPERTIES. eg. Queue Depth, MDTS value.
6644  *
6645  * DCMD send by drivers whenever new target is added to the OS.
6646  *
6647  * dcmd.opcode         - MR_DCMD_DEV_GET_TARGET_PROP
6648  * dcmd.mbox.b[0]      - DCMD is to be fired for LD or system PD.
6649  *                       0 = system PD, 1 = LD.
6650  * dcmd.mbox.s[1]      - TargetID for LD/system PD.
6651  * dcmd.sge IN         - Pointer to return MR_TARGET_DEV_PROPERTIES.
6652  *
6653  * @instance:           Adapter soft state
6654  * @sdev:               OS provided scsi device
6655  *
6656  * Returns 0 on success non-zero on failure.
6657  */
6658 int
6659 megasas_get_target_prop(struct megasas_instance *instance,
6660                         struct scsi_device *sdev)
6661 {
6662         int ret;
6663         struct megasas_cmd *cmd;
6664         struct megasas_dcmd_frame *dcmd;
6665         u16 targetId = ((sdev->channel % 2) * MEGASAS_MAX_DEV_PER_CHANNEL) +
6666                         sdev->id;
6667
6668         cmd = megasas_get_cmd(instance);
6669
6670         if (!cmd) {
6671                 dev_err(&instance->pdev->dev,
6672                         "Failed to get cmd %s\n", __func__);
6673                 return -ENOMEM;
6674         }
6675
6676         dcmd = &cmd->frame->dcmd;
6677
6678         memset(instance->tgt_prop, 0, sizeof(*instance->tgt_prop));
6679         memset(dcmd->mbox.b, 0, MFI_MBOX_SIZE);
6680         dcmd->mbox.b[0] = MEGASAS_IS_LOGICAL(sdev);
6681
6682         dcmd->mbox.s[1] = cpu_to_le16(targetId);
6683         dcmd->cmd = MFI_CMD_DCMD;
6684         dcmd->cmd_status = 0xFF;
6685         dcmd->sge_count = 1;
6686         dcmd->flags = MFI_FRAME_DIR_READ;
6687         dcmd->timeout = 0;
6688         dcmd->pad_0 = 0;
6689         dcmd->data_xfer_len =
6690                 cpu_to_le32(sizeof(struct MR_TARGET_PROPERTIES));
6691         dcmd->opcode = cpu_to_le32(MR_DCMD_DRV_GET_TARGET_PROP);
6692
6693         megasas_set_dma_settings(instance, dcmd, instance->tgt_prop_h,
6694                                  sizeof(struct MR_TARGET_PROPERTIES));
6695
6696         if ((instance->adapter_type != MFI_SERIES) &&
6697             !instance->mask_interrupts)
6698                 ret = megasas_issue_blocked_cmd(instance,
6699                                                 cmd, MFI_IO_TIMEOUT_SECS);
6700         else
6701                 ret = megasas_issue_polled(instance, cmd);
6702
6703         switch (ret) {
6704         case DCMD_TIMEOUT:
6705                 switch (dcmd_timeout_ocr_possible(instance)) {
6706                 case INITIATE_OCR:
6707                         cmd->flags |= DRV_DCMD_SKIP_REFIRE;
6708                         mutex_unlock(&instance->reset_mutex);
6709                         megasas_reset_fusion(instance->host,
6710                                              MFI_IO_TIMEOUT_OCR);
6711                         mutex_lock(&instance->reset_mutex);
6712                         break;
6713                 case KILL_ADAPTER:
6714                         megaraid_sas_kill_hba(instance);
6715                         break;
6716                 case IGNORE_TIMEOUT:
6717                         dev_info(&instance->pdev->dev,
6718                                  "Ignore DCMD timeout: %s %d\n",
6719                                  __func__, __LINE__);
6720                         break;
6721                 }
6722                 break;
6723
6724         default:
6725                 megasas_return_cmd(instance, cmd);
6726         }
6727         if (ret != DCMD_SUCCESS)
6728                 dev_err(&instance->pdev->dev,
6729                         "return from %s %d return value %d\n",
6730                         __func__, __LINE__, ret);
6731
6732         return ret;
6733 }
6734
6735 /**
6736  * megasas_start_aen -  Subscribes to AEN during driver load time
6737  * @instance:           Adapter soft state
6738  */
6739 static int megasas_start_aen(struct megasas_instance *instance)
6740 {
6741         struct megasas_evt_log_info eli;
6742         union megasas_evt_class_locale class_locale;
6743
6744         /*
6745          * Get the latest sequence number from FW
6746          */
6747         memset(&eli, 0, sizeof(eli));
6748
6749         if (megasas_get_seq_num(instance, &eli))
6750                 return -1;
6751
6752         /*
6753          * Register AEN with FW for latest sequence number plus 1
6754          */
6755         class_locale.members.reserved = 0;
6756         class_locale.members.locale = MR_EVT_LOCALE_ALL;
6757         class_locale.members.class = MR_EVT_CLASS_DEBUG;
6758
6759         return megasas_register_aen(instance,
6760                         le32_to_cpu(eli.newest_seq_num) + 1,
6761                         class_locale.word);
6762 }
6763
6764 /**
6765  * megasas_io_attach -  Attaches this driver to SCSI mid-layer
6766  * @instance:           Adapter soft state
6767  */
6768 static int megasas_io_attach(struct megasas_instance *instance)
6769 {
6770         struct Scsi_Host *host = instance->host;
6771
6772         /*
6773          * Export parameters required by SCSI mid-layer
6774          */
6775         host->unique_id = instance->unique_id;
6776         host->can_queue = instance->max_scsi_cmds;
6777         host->this_id = instance->init_id;
6778         host->sg_tablesize = instance->max_num_sge;
6779
6780         if (instance->fw_support_ieee)
6781                 instance->max_sectors_per_req = MEGASAS_MAX_SECTORS_IEEE;
6782
6783         /*
6784          * Check if the module parameter value for max_sectors can be used
6785          */
6786         if (max_sectors && max_sectors < instance->max_sectors_per_req)
6787                 instance->max_sectors_per_req = max_sectors;
6788         else {
6789                 if (max_sectors) {
6790                         if (((instance->pdev->device ==
6791                                 PCI_DEVICE_ID_LSI_SAS1078GEN2) ||
6792                                 (instance->pdev->device ==
6793                                 PCI_DEVICE_ID_LSI_SAS0079GEN2)) &&
6794                                 (max_sectors <= MEGASAS_MAX_SECTORS)) {
6795                                 instance->max_sectors_per_req = max_sectors;
6796                         } else {
6797                         dev_info(&instance->pdev->dev, "max_sectors should be > 0"
6798                                 "and <= %d (or < 1MB for GEN2 controller)\n",
6799                                 instance->max_sectors_per_req);
6800                         }
6801                 }
6802         }
6803
6804         host->max_sectors = instance->max_sectors_per_req;
6805         host->cmd_per_lun = MEGASAS_DEFAULT_CMD_PER_LUN;
6806         host->max_channel = MEGASAS_MAX_CHANNELS - 1;
6807         host->max_id = MEGASAS_MAX_DEV_PER_CHANNEL;
6808         host->max_lun = MEGASAS_MAX_LUN;
6809         host->max_cmd_len = 16;
6810
6811         /*
6812          * Notify the mid-layer about the new controller
6813          */
6814         if (scsi_add_host(host, &instance->pdev->dev)) {
6815                 dev_err(&instance->pdev->dev,
6816                         "Failed to add host from %s %d\n",
6817                         __func__, __LINE__);
6818                 return -ENODEV;
6819         }
6820
6821         return 0;
6822 }
6823
6824 /**
6825  * megasas_set_dma_mask -       Set DMA mask for supported controllers
6826  *
6827  * @instance:           Adapter soft state
6828  * Description:
6829  *
6830  * For Ventura, driver/FW will operate in 63bit DMA addresses.
6831  *
6832  * For invader-
6833  *      By default, driver/FW will operate in 32bit DMA addresses
6834  *      for consistent DMA mapping but if 32 bit consistent
6835  *      DMA mask fails, driver will try with 63 bit consistent
6836  *      mask provided FW is true 63bit DMA capable
6837  *
6838  * For older controllers(Thunderbolt and MFI based adapters)-
6839  *      driver/FW will operate in 32 bit consistent DMA addresses.
6840  */
6841 static int
6842 megasas_set_dma_mask(struct megasas_instance *instance)
6843 {
6844         u64 consistent_mask;
6845         struct pci_dev *pdev;
6846         u32 scratch_pad_1;
6847
6848         pdev = instance->pdev;
6849         consistent_mask = (instance->adapter_type >= VENTURA_SERIES) ?
6850                                 DMA_BIT_MASK(63) : DMA_BIT_MASK(32);
6851
6852         if (IS_DMA64) {
6853                 if (dma_set_mask(&pdev->dev, DMA_BIT_MASK(63)) &&
6854                     dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(32)))
6855                         goto fail_set_dma_mask;
6856
6857                 if ((*pdev->dev.dma_mask == DMA_BIT_MASK(63)) &&
6858                     (dma_set_coherent_mask(&pdev->dev, consistent_mask) &&
6859                      dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(32)))) {
6860                         /*
6861                          * If 32 bit DMA mask fails, then try for 64 bit mask
6862                          * for FW capable of handling 64 bit DMA.
6863                          */
6864                         scratch_pad_1 = megasas_readl
6865                                 (instance, &instance->reg_set->outbound_scratch_pad_1);
6866
6867                         if (!(scratch_pad_1 & MR_CAN_HANDLE_64_BIT_DMA_OFFSET))
6868                                 goto fail_set_dma_mask;
6869                         else if (dma_set_mask_and_coherent(&pdev->dev,
6870                                                            DMA_BIT_MASK(63)))
6871                                 goto fail_set_dma_mask;
6872                 }
6873         } else if (dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(32)))
6874                 goto fail_set_dma_mask;
6875
6876         if (pdev->dev.coherent_dma_mask == DMA_BIT_MASK(32))
6877                 instance->consistent_mask_64bit = false;
6878         else
6879                 instance->consistent_mask_64bit = true;
6880
6881         dev_info(&pdev->dev, "%s bit DMA mask and %s bit consistent mask\n",
6882                  ((*pdev->dev.dma_mask == DMA_BIT_MASK(63)) ? "63" : "32"),
6883                  (instance->consistent_mask_64bit ? "63" : "32"));
6884
6885         return 0;
6886
6887 fail_set_dma_mask:
6888         dev_err(&pdev->dev, "Failed to set DMA mask\n");
6889         return -1;
6890
6891 }
6892
6893 /*
6894  * megasas_set_adapter_type -   Set adapter type.
6895  *                              Supported controllers can be divided in
6896  *                              different categories-
6897  *                                      enum MR_ADAPTER_TYPE {
6898  *                                              MFI_SERIES = 1,
6899  *                                              THUNDERBOLT_SERIES = 2,
6900  *                                              INVADER_SERIES = 3,
6901  *                                              VENTURA_SERIES = 4,
6902  *                                              AERO_SERIES = 5,
6903  *                                      };
6904  * @instance:                   Adapter soft state
6905  * return:                      void
6906  */
6907 static inline void megasas_set_adapter_type(struct megasas_instance *instance)
6908 {
6909         if ((instance->pdev->vendor == PCI_VENDOR_ID_DELL) &&
6910             (instance->pdev->device == PCI_DEVICE_ID_DELL_PERC5)) {
6911                 instance->adapter_type = MFI_SERIES;
6912         } else {
6913                 switch (instance->pdev->device) {
6914                 case PCI_DEVICE_ID_LSI_AERO_10E1:
6915                 case PCI_DEVICE_ID_LSI_AERO_10E2:
6916                 case PCI_DEVICE_ID_LSI_AERO_10E5:
6917                 case PCI_DEVICE_ID_LSI_AERO_10E6:
6918                         instance->adapter_type = AERO_SERIES;
6919                         break;
6920                 case PCI_DEVICE_ID_LSI_VENTURA:
6921                 case PCI_DEVICE_ID_LSI_CRUSADER:
6922                 case PCI_DEVICE_ID_LSI_HARPOON:
6923                 case PCI_DEVICE_ID_LSI_TOMCAT:
6924                 case PCI_DEVICE_ID_LSI_VENTURA_4PORT:
6925                 case PCI_DEVICE_ID_LSI_CRUSADER_4PORT:
6926                         instance->adapter_type = VENTURA_SERIES;
6927                         break;
6928                 case PCI_DEVICE_ID_LSI_FUSION:
6929                 case PCI_DEVICE_ID_LSI_PLASMA:
6930                         instance->adapter_type = THUNDERBOLT_SERIES;
6931                         break;
6932                 case PCI_DEVICE_ID_LSI_INVADER:
6933                 case PCI_DEVICE_ID_LSI_INTRUDER:
6934                 case PCI_DEVICE_ID_LSI_INTRUDER_24:
6935                 case PCI_DEVICE_ID_LSI_CUTLASS_52:
6936                 case PCI_DEVICE_ID_LSI_CUTLASS_53:
6937                 case PCI_DEVICE_ID_LSI_FURY:
6938                         instance->adapter_type = INVADER_SERIES;
6939                         break;
6940                 default: /* For all other supported controllers */
6941                         instance->adapter_type = MFI_SERIES;
6942                         break;
6943                 }
6944         }
6945 }
6946
6947 static inline int megasas_alloc_mfi_ctrl_mem(struct megasas_instance *instance)
6948 {
6949         instance->producer = dma_alloc_coherent(&instance->pdev->dev,
6950                         sizeof(u32), &instance->producer_h, GFP_KERNEL);
6951         instance->consumer = dma_alloc_coherent(&instance->pdev->dev,
6952                         sizeof(u32), &instance->consumer_h, GFP_KERNEL);
6953
6954         if (!instance->producer || !instance->consumer) {
6955                 dev_err(&instance->pdev->dev,
6956                         "Failed to allocate memory for producer, consumer\n");
6957                 return -1;
6958         }
6959
6960         *instance->producer = 0;
6961         *instance->consumer = 0;
6962         return 0;
6963 }
6964
6965 /**
6966  * megasas_alloc_ctrl_mem -     Allocate per controller memory for core data
6967  *                              structures which are not common across MFI
6968  *                              adapters and fusion adapters.
6969  *                              For MFI based adapters, allocate producer and
6970  *                              consumer buffers. For fusion adapters, allocate
6971  *                              memory for fusion context.
6972  * @instance:                   Adapter soft state
6973  * return:                      0 for SUCCESS
6974  */
6975 static int megasas_alloc_ctrl_mem(struct megasas_instance *instance)
6976 {
6977         instance->reply_map = kcalloc(nr_cpu_ids, sizeof(unsigned int),
6978                                       GFP_KERNEL);
6979         if (!instance->reply_map)
6980                 return -ENOMEM;
6981
6982         switch (instance->adapter_type) {
6983         case MFI_SERIES:
6984                 if (megasas_alloc_mfi_ctrl_mem(instance))
6985                         goto fail;
6986                 break;
6987         case AERO_SERIES:
6988         case VENTURA_SERIES:
6989         case THUNDERBOLT_SERIES:
6990         case INVADER_SERIES:
6991                 if (megasas_alloc_fusion_context(instance))
6992                         goto fail;
6993                 break;
6994         }
6995
6996         return 0;
6997  fail:
6998         kfree(instance->reply_map);
6999         instance->reply_map = NULL;
7000         return -ENOMEM;
7001 }
7002
7003 /*
7004  * megasas_free_ctrl_mem -      Free fusion context for fusion adapters and
7005  *                              producer, consumer buffers for MFI adapters
7006  *
7007  * @instance -                  Adapter soft instance
7008  *
7009  */
7010 static inline void megasas_free_ctrl_mem(struct megasas_instance *instance)
7011 {
7012         kfree(instance->reply_map);
7013         if (instance->adapter_type == MFI_SERIES) {
7014                 if (instance->producer)
7015                         dma_free_coherent(&instance->pdev->dev, sizeof(u32),
7016                                             instance->producer,
7017                                             instance->producer_h);
7018                 if (instance->consumer)
7019                         dma_free_coherent(&instance->pdev->dev, sizeof(u32),
7020                                             instance->consumer,
7021                                             instance->consumer_h);
7022         } else {
7023                 megasas_free_fusion_context(instance);
7024         }
7025 }
7026
7027 /**
7028  * megasas_alloc_ctrl_dma_buffers -     Allocate consistent DMA buffers during
7029  *                                      driver load time
7030  *
7031  * @instance:                           Adapter soft instance
7032  *
7033  * @return:                             O for SUCCESS
7034  */
7035 static inline
7036 int megasas_alloc_ctrl_dma_buffers(struct megasas_instance *instance)
7037 {
7038         struct pci_dev *pdev = instance->pdev;
7039         struct fusion_context *fusion = instance->ctrl_context;
7040
7041         instance->evt_detail = dma_alloc_coherent(&pdev->dev,
7042                         sizeof(struct megasas_evt_detail),
7043                         &instance->evt_detail_h, GFP_KERNEL);
7044
7045         if (!instance->evt_detail) {
7046                 dev_err(&instance->pdev->dev,
7047                         "Failed to allocate event detail buffer\n");
7048                 return -ENOMEM;
7049         }
7050
7051         if (fusion) {
7052                 fusion->ioc_init_request =
7053                         dma_alloc_coherent(&pdev->dev,
7054                                            sizeof(struct MPI2_IOC_INIT_REQUEST),
7055                                            &fusion->ioc_init_request_phys,
7056                                            GFP_KERNEL);
7057
7058                 if (!fusion->ioc_init_request) {
7059                         dev_err(&pdev->dev,
7060                                 "Failed to allocate PD list buffer\n");
7061                         return -ENOMEM;
7062                 }
7063
7064                 instance->snapdump_prop = dma_alloc_coherent(&pdev->dev,
7065                                 sizeof(struct MR_SNAPDUMP_PROPERTIES),
7066                                 &instance->snapdump_prop_h, GFP_KERNEL);
7067
7068                 if (!instance->snapdump_prop)
7069                         dev_err(&pdev->dev,
7070                                 "Failed to allocate snapdump properties buffer\n");
7071
7072                 instance->host_device_list_buf = dma_alloc_coherent(&pdev->dev,
7073                                                         HOST_DEVICE_LIST_SZ,
7074                                                         &instance->host_device_list_buf_h,
7075                                                         GFP_KERNEL);
7076
7077                 if (!instance->host_device_list_buf) {
7078                         dev_err(&pdev->dev,
7079                                 "Failed to allocate targetid list buffer\n");
7080                         return -ENOMEM;
7081                 }
7082
7083         }
7084
7085         instance->pd_list_buf =
7086                 dma_alloc_coherent(&pdev->dev,
7087                                      MEGASAS_MAX_PD * sizeof(struct MR_PD_LIST),
7088                                      &instance->pd_list_buf_h, GFP_KERNEL);
7089
7090         if (!instance->pd_list_buf) {
7091                 dev_err(&pdev->dev, "Failed to allocate PD list buffer\n");
7092                 return -ENOMEM;
7093         }
7094
7095         instance->ctrl_info_buf =
7096                 dma_alloc_coherent(&pdev->dev,
7097                                      sizeof(struct megasas_ctrl_info),
7098                                      &instance->ctrl_info_buf_h, GFP_KERNEL);
7099
7100         if (!instance->ctrl_info_buf) {
7101                 dev_err(&pdev->dev,
7102                         "Failed to allocate controller info buffer\n");
7103                 return -ENOMEM;
7104         }
7105
7106         instance->ld_list_buf =
7107                 dma_alloc_coherent(&pdev->dev,
7108                                      sizeof(struct MR_LD_LIST),
7109                                      &instance->ld_list_buf_h, GFP_KERNEL);
7110
7111         if (!instance->ld_list_buf) {
7112                 dev_err(&pdev->dev, "Failed to allocate LD list buffer\n");
7113                 return -ENOMEM;
7114         }
7115
7116         instance->ld_targetid_list_buf =
7117                 dma_alloc_coherent(&pdev->dev,
7118                                 sizeof(struct MR_LD_TARGETID_LIST),
7119                                 &instance->ld_targetid_list_buf_h, GFP_KERNEL);
7120
7121         if (!instance->ld_targetid_list_buf) {
7122                 dev_err(&pdev->dev,
7123                         "Failed to allocate LD targetid list buffer\n");
7124                 return -ENOMEM;
7125         }
7126
7127         if (!reset_devices) {
7128                 instance->system_info_buf =
7129                         dma_alloc_coherent(&pdev->dev,
7130                                         sizeof(struct MR_DRV_SYSTEM_INFO),
7131                                         &instance->system_info_h, GFP_KERNEL);
7132                 instance->pd_info =
7133                         dma_alloc_coherent(&pdev->dev,
7134                                         sizeof(struct MR_PD_INFO),
7135                                         &instance->pd_info_h, GFP_KERNEL);
7136                 instance->tgt_prop =
7137                         dma_alloc_coherent(&pdev->dev,
7138                                         sizeof(struct MR_TARGET_PROPERTIES),
7139                                         &instance->tgt_prop_h, GFP_KERNEL);
7140                 instance->crash_dump_buf =
7141                         dma_alloc_coherent(&pdev->dev, CRASH_DMA_BUF_SIZE,
7142                                         &instance->crash_dump_h, GFP_KERNEL);
7143
7144                 if (!instance->system_info_buf)
7145                         dev_err(&instance->pdev->dev,
7146                                 "Failed to allocate system info buffer\n");
7147
7148                 if (!instance->pd_info)
7149                         dev_err(&instance->pdev->dev,
7150                                 "Failed to allocate pd_info buffer\n");
7151
7152                 if (!instance->tgt_prop)
7153                         dev_err(&instance->pdev->dev,
7154                                 "Failed to allocate tgt_prop buffer\n");
7155
7156                 if (!instance->crash_dump_buf)
7157                         dev_err(&instance->pdev->dev,
7158                                 "Failed to allocate crash dump buffer\n");
7159         }
7160
7161         return 0;
7162 }
7163
7164 /*
7165  * megasas_free_ctrl_dma_buffers -      Free consistent DMA buffers allocated
7166  *                                      during driver load time
7167  *
7168  * @instance-                           Adapter soft instance
7169  *
7170  */
7171 static inline
7172 void megasas_free_ctrl_dma_buffers(struct megasas_instance *instance)
7173 {
7174         struct pci_dev *pdev = instance->pdev;
7175         struct fusion_context *fusion = instance->ctrl_context;
7176
7177         if (instance->evt_detail)
7178                 dma_free_coherent(&pdev->dev, sizeof(struct megasas_evt_detail),
7179                                     instance->evt_detail,
7180                                     instance->evt_detail_h);
7181
7182         if (fusion && fusion->ioc_init_request)
7183                 dma_free_coherent(&pdev->dev,
7184                                   sizeof(struct MPI2_IOC_INIT_REQUEST),
7185                                   fusion->ioc_init_request,
7186                                   fusion->ioc_init_request_phys);
7187
7188         if (instance->pd_list_buf)
7189                 dma_free_coherent(&pdev->dev,
7190                                     MEGASAS_MAX_PD * sizeof(struct MR_PD_LIST),
7191                                     instance->pd_list_buf,
7192                                     instance->pd_list_buf_h);
7193
7194         if (instance->ld_list_buf)
7195                 dma_free_coherent(&pdev->dev, sizeof(struct MR_LD_LIST),
7196                                     instance->ld_list_buf,
7197                                     instance->ld_list_buf_h);
7198
7199         if (instance->ld_targetid_list_buf)
7200                 dma_free_coherent(&pdev->dev, sizeof(struct MR_LD_TARGETID_LIST),
7201                                     instance->ld_targetid_list_buf,
7202                                     instance->ld_targetid_list_buf_h);
7203
7204         if (instance->ctrl_info_buf)
7205                 dma_free_coherent(&pdev->dev, sizeof(struct megasas_ctrl_info),
7206                                     instance->ctrl_info_buf,
7207                                     instance->ctrl_info_buf_h);
7208
7209         if (instance->system_info_buf)
7210                 dma_free_coherent(&pdev->dev, sizeof(struct MR_DRV_SYSTEM_INFO),
7211                                     instance->system_info_buf,
7212                                     instance->system_info_h);
7213
7214         if (instance->pd_info)
7215                 dma_free_coherent(&pdev->dev, sizeof(struct MR_PD_INFO),
7216                                     instance->pd_info, instance->pd_info_h);
7217
7218         if (instance->tgt_prop)
7219                 dma_free_coherent(&pdev->dev, sizeof(struct MR_TARGET_PROPERTIES),
7220                                     instance->tgt_prop, instance->tgt_prop_h);
7221
7222         if (instance->crash_dump_buf)
7223                 dma_free_coherent(&pdev->dev, CRASH_DMA_BUF_SIZE,
7224                                     instance->crash_dump_buf,
7225                                     instance->crash_dump_h);
7226
7227         if (instance->snapdump_prop)
7228                 dma_free_coherent(&pdev->dev,
7229                                   sizeof(struct MR_SNAPDUMP_PROPERTIES),
7230                                   instance->snapdump_prop,
7231                                   instance->snapdump_prop_h);
7232
7233         if (instance->host_device_list_buf)
7234                 dma_free_coherent(&pdev->dev,
7235                                   HOST_DEVICE_LIST_SZ,
7236                                   instance->host_device_list_buf,
7237                                   instance->host_device_list_buf_h);
7238
7239 }
7240
7241 /*
7242  * megasas_init_ctrl_params -           Initialize controller's instance
7243  *                                      parameters before FW init
7244  * @instance -                          Adapter soft instance
7245  * @return -                            void
7246  */
7247 static inline void megasas_init_ctrl_params(struct megasas_instance *instance)
7248 {
7249         instance->fw_crash_state = UNAVAILABLE;
7250
7251         megasas_poll_wait_aen = 0;
7252         instance->issuepend_done = 1;
7253         atomic_set(&instance->adprecovery, MEGASAS_HBA_OPERATIONAL);
7254
7255         /*
7256          * Initialize locks and queues
7257          */
7258         INIT_LIST_HEAD(&instance->cmd_pool);
7259         INIT_LIST_HEAD(&instance->internal_reset_pending_q);
7260
7261         atomic_set(&instance->fw_outstanding, 0);
7262         atomic64_set(&instance->total_io_count, 0);
7263
7264         init_waitqueue_head(&instance->int_cmd_wait_q);
7265         init_waitqueue_head(&instance->abort_cmd_wait_q);
7266
7267         spin_lock_init(&instance->crashdump_lock);
7268         spin_lock_init(&instance->mfi_pool_lock);
7269         spin_lock_init(&instance->hba_lock);
7270         spin_lock_init(&instance->stream_lock);
7271         spin_lock_init(&instance->completion_lock);
7272
7273         mutex_init(&instance->reset_mutex);
7274
7275         if ((instance->pdev->device == PCI_DEVICE_ID_LSI_SAS0073SKINNY) ||
7276             (instance->pdev->device == PCI_DEVICE_ID_LSI_SAS0071SKINNY))
7277                 instance->flag_ieee = 1;
7278
7279         megasas_dbg_lvl = 0;
7280         instance->flag = 0;
7281         instance->unload = 1;
7282         instance->last_time = 0;
7283         instance->disableOnlineCtrlReset = 1;
7284         instance->UnevenSpanSupport = 0;
7285         instance->smp_affinity_enable = smp_affinity_enable ? true : false;
7286         instance->msix_load_balance = false;
7287
7288         if (instance->adapter_type != MFI_SERIES)
7289                 INIT_WORK(&instance->work_init, megasas_fusion_ocr_wq);
7290         else
7291                 INIT_WORK(&instance->work_init, process_fw_state_change_wq);
7292 }
7293
7294 /**
7295  * megasas_probe_one -  PCI hotplug entry point
7296  * @pdev:               PCI device structure
7297  * @id:                 PCI ids of supported hotplugged adapter
7298  */
7299 static int megasas_probe_one(struct pci_dev *pdev,
7300                              const struct pci_device_id *id)
7301 {
7302         int rval, pos;
7303         struct Scsi_Host *host;
7304         struct megasas_instance *instance;
7305         u16 control = 0;
7306
7307         switch (pdev->device) {
7308         case PCI_DEVICE_ID_LSI_AERO_10E0:
7309         case PCI_DEVICE_ID_LSI_AERO_10E3:
7310         case PCI_DEVICE_ID_LSI_AERO_10E4:
7311         case PCI_DEVICE_ID_LSI_AERO_10E7:
7312                 dev_err(&pdev->dev, "Adapter is in non secure mode\n");
7313                 return 1;
7314         case PCI_DEVICE_ID_LSI_AERO_10E1:
7315         case PCI_DEVICE_ID_LSI_AERO_10E5:
7316                 dev_info(&pdev->dev, "Adapter is in configurable secure mode\n");
7317                 break;
7318         }
7319
7320         /* Reset MSI-X in the kdump kernel */
7321         if (reset_devices) {
7322                 pos = pci_find_capability(pdev, PCI_CAP_ID_MSIX);
7323                 if (pos) {
7324                         pci_read_config_word(pdev, pos + PCI_MSIX_FLAGS,
7325                                              &control);
7326                         if (control & PCI_MSIX_FLAGS_ENABLE) {
7327                                 dev_info(&pdev->dev, "resetting MSI-X\n");
7328                                 pci_write_config_word(pdev,
7329                                                       pos + PCI_MSIX_FLAGS,
7330                                                       control &
7331                                                       ~PCI_MSIX_FLAGS_ENABLE);
7332                         }
7333                 }
7334         }
7335
7336         /*
7337          * PCI prepping: enable device set bus mastering and dma mask
7338          */
7339         rval = pci_enable_device_mem(pdev);
7340
7341         if (rval) {
7342                 return rval;
7343         }
7344
7345         pci_set_master(pdev);
7346
7347         host = scsi_host_alloc(&megasas_template,
7348                                sizeof(struct megasas_instance));
7349
7350         if (!host) {
7351                 dev_printk(KERN_DEBUG, &pdev->dev, "scsi_host_alloc failed\n");
7352                 goto fail_alloc_instance;
7353         }
7354
7355         instance = (struct megasas_instance *)host->hostdata;
7356         memset(instance, 0, sizeof(*instance));
7357         atomic_set(&instance->fw_reset_no_pci_access, 0);
7358
7359         /*
7360          * Initialize PCI related and misc parameters
7361          */
7362         instance->pdev = pdev;
7363         instance->host = host;
7364         instance->unique_id = pdev->bus->number << 8 | pdev->devfn;
7365         instance->init_id = MEGASAS_DEFAULT_INIT_ID;
7366
7367         megasas_set_adapter_type(instance);
7368
7369         /*
7370          * Initialize MFI Firmware
7371          */
7372         if (megasas_init_fw(instance))
7373                 goto fail_init_mfi;
7374
7375         if (instance->requestorId) {
7376                 if (instance->PlasmaFW111) {
7377                         instance->vf_affiliation_111 =
7378                                 dma_alloc_coherent(&pdev->dev,
7379                                         sizeof(struct MR_LD_VF_AFFILIATION_111),
7380                                         &instance->vf_affiliation_111_h,
7381                                         GFP_KERNEL);
7382                         if (!instance->vf_affiliation_111)
7383                                 dev_warn(&pdev->dev, "Can't allocate "
7384                                        "memory for VF affiliation buffer\n");
7385                 } else {
7386                         instance->vf_affiliation =
7387                                 dma_alloc_coherent(&pdev->dev,
7388                                         (MAX_LOGICAL_DRIVES + 1) *
7389                                         sizeof(struct MR_LD_VF_AFFILIATION),
7390                                         &instance->vf_affiliation_h,
7391                                         GFP_KERNEL);
7392                         if (!instance->vf_affiliation)
7393                                 dev_warn(&pdev->dev, "Can't allocate "
7394                                        "memory for VF affiliation buffer\n");
7395                 }
7396         }
7397
7398         /*
7399          * Store instance in PCI softstate
7400          */
7401         pci_set_drvdata(pdev, instance);
7402
7403         /*
7404          * Add this controller to megasas_mgmt_info structure so that it
7405          * can be exported to management applications
7406          */
7407         megasas_mgmt_info.count++;
7408         megasas_mgmt_info.instance[megasas_mgmt_info.max_index] = instance;
7409         megasas_mgmt_info.max_index++;
7410
7411         /*
7412          * Register with SCSI mid-layer
7413          */
7414         if (megasas_io_attach(instance))
7415                 goto fail_io_attach;
7416
7417         instance->unload = 0;
7418         /*
7419          * Trigger SCSI to scan our drives
7420          */
7421         if (!instance->enable_fw_dev_list ||
7422             (instance->host_device_list_buf->count > 0))
7423                 scsi_scan_host(host);
7424
7425         /*
7426          * Initiate AEN (Asynchronous Event Notification)
7427          */
7428         if (megasas_start_aen(instance)) {
7429                 dev_printk(KERN_DEBUG, &pdev->dev, "start aen failed\n");
7430                 goto fail_start_aen;
7431         }
7432
7433         megasas_setup_debugfs(instance);
7434
7435         /* Get current SR-IOV LD/VF affiliation */
7436         if (instance->requestorId)
7437                 megasas_get_ld_vf_affiliation(instance, 1);
7438
7439         return 0;
7440
7441 fail_start_aen:
7442 fail_io_attach:
7443         megasas_mgmt_info.count--;
7444         megasas_mgmt_info.max_index--;
7445         megasas_mgmt_info.instance[megasas_mgmt_info.max_index] = NULL;
7446
7447         instance->instancet->disable_intr(instance);
7448         megasas_destroy_irqs(instance);
7449
7450         if (instance->adapter_type != MFI_SERIES)
7451                 megasas_release_fusion(instance);
7452         else
7453                 megasas_release_mfi(instance);
7454         if (instance->msix_vectors)
7455                 pci_free_irq_vectors(instance->pdev);
7456 fail_init_mfi:
7457         scsi_host_put(host);
7458 fail_alloc_instance:
7459         pci_disable_device(pdev);
7460
7461         return -ENODEV;
7462 }
7463
7464 /**
7465  * megasas_flush_cache -        Requests FW to flush all its caches
7466  * @instance:                   Adapter soft state
7467  */
7468 static void megasas_flush_cache(struct megasas_instance *instance)
7469 {
7470         struct megasas_cmd *cmd;
7471         struct megasas_dcmd_frame *dcmd;
7472
7473         if (atomic_read(&instance->adprecovery) == MEGASAS_HW_CRITICAL_ERROR)
7474                 return;
7475
7476         cmd = megasas_get_cmd(instance);
7477
7478         if (!cmd)
7479                 return;
7480
7481         dcmd = &cmd->frame->dcmd;
7482
7483         memset(dcmd->mbox.b, 0, MFI_MBOX_SIZE);
7484
7485         dcmd->cmd = MFI_CMD_DCMD;
7486         dcmd->cmd_status = 0x0;
7487         dcmd->sge_count = 0;
7488         dcmd->flags = cpu_to_le16(MFI_FRAME_DIR_NONE);
7489         dcmd->timeout = 0;
7490         dcmd->pad_0 = 0;
7491         dcmd->data_xfer_len = 0;
7492         dcmd->opcode = cpu_to_le32(MR_DCMD_CTRL_CACHE_FLUSH);
7493         dcmd->mbox.b[0] = MR_FLUSH_CTRL_CACHE | MR_FLUSH_DISK_CACHE;
7494
7495         if (megasas_issue_blocked_cmd(instance, cmd, MFI_IO_TIMEOUT_SECS)
7496                         != DCMD_SUCCESS) {
7497                 dev_err(&instance->pdev->dev,
7498                         "return from %s %d\n", __func__, __LINE__);
7499                 return;
7500         }
7501
7502         megasas_return_cmd(instance, cmd);
7503 }
7504
7505 /**
7506  * megasas_shutdown_controller -        Instructs FW to shutdown the controller
7507  * @instance:                           Adapter soft state
7508  * @opcode:                             Shutdown/Hibernate
7509  */
7510 static void megasas_shutdown_controller(struct megasas_instance *instance,
7511                                         u32 opcode)
7512 {
7513         struct megasas_cmd *cmd;
7514         struct megasas_dcmd_frame *dcmd;
7515
7516         if (atomic_read(&instance->adprecovery) == MEGASAS_HW_CRITICAL_ERROR)
7517                 return;
7518
7519         cmd = megasas_get_cmd(instance);
7520
7521         if (!cmd)
7522                 return;
7523
7524         if (instance->aen_cmd)
7525                 megasas_issue_blocked_abort_cmd(instance,
7526                         instance->aen_cmd, MFI_IO_TIMEOUT_SECS);
7527         if (instance->map_update_cmd)
7528                 megasas_issue_blocked_abort_cmd(instance,
7529                         instance->map_update_cmd, MFI_IO_TIMEOUT_SECS);
7530         if (instance->jbod_seq_cmd)
7531                 megasas_issue_blocked_abort_cmd(instance,
7532                         instance->jbod_seq_cmd, MFI_IO_TIMEOUT_SECS);
7533
7534         dcmd = &cmd->frame->dcmd;
7535
7536         memset(dcmd->mbox.b, 0, MFI_MBOX_SIZE);
7537
7538         dcmd->cmd = MFI_CMD_DCMD;
7539         dcmd->cmd_status = 0x0;
7540         dcmd->sge_count = 0;
7541         dcmd->flags = cpu_to_le16(MFI_FRAME_DIR_NONE);
7542         dcmd->timeout = 0;
7543         dcmd->pad_0 = 0;
7544         dcmd->data_xfer_len = 0;
7545         dcmd->opcode = cpu_to_le32(opcode);
7546
7547         if (megasas_issue_blocked_cmd(instance, cmd, MFI_IO_TIMEOUT_SECS)
7548                         != DCMD_SUCCESS) {
7549                 dev_err(&instance->pdev->dev,
7550                         "return from %s %d\n", __func__, __LINE__);
7551                 return;
7552         }
7553
7554         megasas_return_cmd(instance, cmd);
7555 }
7556
7557 #ifdef CONFIG_PM
7558 /**
7559  * megasas_suspend -    driver suspend entry point
7560  * @pdev:               PCI device structure
7561  * @state:              PCI power state to suspend routine
7562  */
7563 static int
7564 megasas_suspend(struct pci_dev *pdev, pm_message_t state)
7565 {
7566         struct megasas_instance *instance;
7567
7568         instance = pci_get_drvdata(pdev);
7569
7570         if (!instance)
7571                 return 0;
7572
7573         instance->unload = 1;
7574
7575         dev_info(&pdev->dev, "%s is called\n", __func__);
7576
7577         /* Shutdown SR-IOV heartbeat timer */
7578         if (instance->requestorId && !instance->skip_heartbeat_timer_del)
7579                 del_timer_sync(&instance->sriov_heartbeat_timer);
7580
7581         /* Stop the FW fault detection watchdog */
7582         if (instance->adapter_type != MFI_SERIES)
7583                 megasas_fusion_stop_watchdog(instance);
7584
7585         megasas_flush_cache(instance);
7586         megasas_shutdown_controller(instance, MR_DCMD_HIBERNATE_SHUTDOWN);
7587
7588         /* cancel the delayed work if this work still in queue */
7589         if (instance->ev != NULL) {
7590                 struct megasas_aen_event *ev = instance->ev;
7591                 cancel_delayed_work_sync(&ev->hotplug_work);
7592                 instance->ev = NULL;
7593         }
7594
7595         tasklet_kill(&instance->isr_tasklet);
7596
7597         pci_set_drvdata(instance->pdev, instance);
7598         instance->instancet->disable_intr(instance);
7599
7600         megasas_destroy_irqs(instance);
7601
7602         if (instance->msix_vectors)
7603                 pci_free_irq_vectors(instance->pdev);
7604
7605         pci_save_state(pdev);
7606         pci_disable_device(pdev);
7607
7608         pci_set_power_state(pdev, pci_choose_state(pdev, state));
7609
7610         return 0;
7611 }
7612
7613 /**
7614  * megasas_resume-      driver resume entry point
7615  * @pdev:               PCI device structure
7616  */
7617 static int
7618 megasas_resume(struct pci_dev *pdev)
7619 {
7620         int rval;
7621         struct Scsi_Host *host;
7622         struct megasas_instance *instance;
7623         u32 status_reg;
7624
7625         instance = pci_get_drvdata(pdev);
7626
7627         if (!instance)
7628                 return 0;
7629
7630         host = instance->host;
7631         pci_set_power_state(pdev, PCI_D0);
7632         pci_enable_wake(pdev, PCI_D0, 0);
7633         pci_restore_state(pdev);
7634
7635         dev_info(&pdev->dev, "%s is called\n", __func__);
7636         /*
7637          * PCI prepping: enable device set bus mastering and dma mask
7638          */
7639         rval = pci_enable_device_mem(pdev);
7640
7641         if (rval) {
7642                 dev_err(&pdev->dev, "Enable device failed\n");
7643                 return rval;
7644         }
7645
7646         pci_set_master(pdev);
7647
7648         /*
7649          * We expect the FW state to be READY
7650          */
7651
7652         if (megasas_transition_to_ready(instance, 0)) {
7653                 dev_info(&instance->pdev->dev,
7654                          "Failed to transition controller to ready from %s!\n",
7655                          __func__);
7656                 if (instance->adapter_type != MFI_SERIES) {
7657                         status_reg =
7658                                 instance->instancet->read_fw_status_reg(instance);
7659                         if (!(status_reg & MFI_RESET_ADAPTER) ||
7660                                 ((megasas_adp_reset_wait_for_ready
7661                                 (instance, true, 0)) == FAILED))
7662                                 goto fail_ready_state;
7663                 } else {
7664                         atomic_set(&instance->fw_reset_no_pci_access, 1);
7665                         instance->instancet->adp_reset
7666                                 (instance, instance->reg_set);
7667                         atomic_set(&instance->fw_reset_no_pci_access, 0);
7668
7669                         /* waiting for about 30 seconds before retry */
7670                         ssleep(30);
7671
7672                         if (megasas_transition_to_ready(instance, 0))
7673                                 goto fail_ready_state;
7674                 }
7675
7676                 dev_info(&instance->pdev->dev,
7677                          "FW restarted successfully from %s!\n",
7678                          __func__);
7679         }
7680         if (megasas_set_dma_mask(instance))
7681                 goto fail_set_dma_mask;
7682
7683         /*
7684          * Initialize MFI Firmware
7685          */
7686
7687         atomic_set(&instance->fw_outstanding, 0);
7688         atomic_set(&instance->ldio_outstanding, 0);
7689
7690         /* Now re-enable MSI-X */
7691         if (instance->msix_vectors)
7692                 megasas_alloc_irq_vectors(instance);
7693
7694         if (!instance->msix_vectors) {
7695                 rval = pci_alloc_irq_vectors(instance->pdev, 1, 1,
7696                                              PCI_IRQ_LEGACY);
7697                 if (rval < 0)
7698                         goto fail_reenable_msix;
7699         }
7700
7701         megasas_setup_reply_map(instance);
7702
7703         if (instance->adapter_type != MFI_SERIES) {
7704                 megasas_reset_reply_desc(instance);
7705                 if (megasas_ioc_init_fusion(instance)) {
7706                         megasas_free_cmds(instance);
7707                         megasas_free_cmds_fusion(instance);
7708                         goto fail_init_mfi;
7709                 }
7710                 if (!megasas_get_map_info(instance))
7711                         megasas_sync_map_info(instance);
7712         } else {
7713                 *instance->producer = 0;
7714                 *instance->consumer = 0;
7715                 if (megasas_issue_init_mfi(instance))
7716                         goto fail_init_mfi;
7717         }
7718
7719         if (megasas_get_ctrl_info(instance) != DCMD_SUCCESS)
7720                 goto fail_init_mfi;
7721
7722         tasklet_init(&instance->isr_tasklet, instance->instancet->tasklet,
7723                      (unsigned long)instance);
7724
7725         if (instance->msix_vectors ?
7726                         megasas_setup_irqs_msix(instance, 0) :
7727                         megasas_setup_irqs_ioapic(instance))
7728                 goto fail_init_mfi;
7729
7730         if (instance->adapter_type != MFI_SERIES)
7731                 megasas_setup_irq_poll(instance);
7732
7733         /* Re-launch SR-IOV heartbeat timer */
7734         if (instance->requestorId) {
7735                 if (!megasas_sriov_start_heartbeat(instance, 0))
7736                         megasas_start_timer(instance);
7737                 else {
7738                         instance->skip_heartbeat_timer_del = 1;
7739                         goto fail_init_mfi;
7740                 }
7741         }
7742
7743         instance->instancet->enable_intr(instance);
7744         megasas_setup_jbod_map(instance);
7745         instance->unload = 0;
7746
7747         /*
7748          * Initiate AEN (Asynchronous Event Notification)
7749          */
7750         if (megasas_start_aen(instance))
7751                 dev_err(&instance->pdev->dev, "Start AEN failed\n");
7752
7753         /* Re-launch FW fault watchdog */
7754         if (instance->adapter_type != MFI_SERIES)
7755                 if (megasas_fusion_start_watchdog(instance) != SUCCESS)
7756                         goto fail_start_watchdog;
7757
7758         return 0;
7759
7760 fail_start_watchdog:
7761         if (instance->requestorId && !instance->skip_heartbeat_timer_del)
7762                 del_timer_sync(&instance->sriov_heartbeat_timer);
7763 fail_init_mfi:
7764         megasas_free_ctrl_dma_buffers(instance);
7765         megasas_free_ctrl_mem(instance);
7766         scsi_host_put(host);
7767
7768 fail_reenable_msix:
7769 fail_set_dma_mask:
7770 fail_ready_state:
7771
7772         pci_disable_device(pdev);
7773
7774         return -ENODEV;
7775 }
7776 #else
7777 #define megasas_suspend NULL
7778 #define megasas_resume  NULL
7779 #endif
7780
7781 static inline int
7782 megasas_wait_for_adapter_operational(struct megasas_instance *instance)
7783 {
7784         int wait_time = MEGASAS_RESET_WAIT_TIME * 2;
7785         int i;
7786         u8 adp_state;
7787
7788         for (i = 0; i < wait_time; i++) {
7789                 adp_state = atomic_read(&instance->adprecovery);
7790                 if ((adp_state == MEGASAS_HBA_OPERATIONAL) ||
7791                     (adp_state == MEGASAS_HW_CRITICAL_ERROR))
7792                         break;
7793
7794                 if (!(i % MEGASAS_RESET_NOTICE_INTERVAL))
7795                         dev_notice(&instance->pdev->dev, "waiting for controller reset to finish\n");
7796
7797                 msleep(1000);
7798         }
7799
7800         if (adp_state != MEGASAS_HBA_OPERATIONAL) {
7801                 dev_info(&instance->pdev->dev,
7802                          "%s HBA failed to become operational, adp_state %d\n",
7803                          __func__, adp_state);
7804                 return 1;
7805         }
7806
7807         return 0;
7808 }
7809
7810 /**
7811  * megasas_detach_one - PCI hot"un"plug entry point
7812  * @pdev:               PCI device structure
7813  */
7814 static void megasas_detach_one(struct pci_dev *pdev)
7815 {
7816         int i;
7817         struct Scsi_Host *host;
7818         struct megasas_instance *instance;
7819         struct fusion_context *fusion;
7820         u32 pd_seq_map_sz;
7821
7822         instance = pci_get_drvdata(pdev);
7823
7824         if (!instance)
7825                 return;
7826
7827         host = instance->host;
7828         fusion = instance->ctrl_context;
7829
7830         /* Shutdown SR-IOV heartbeat timer */
7831         if (instance->requestorId && !instance->skip_heartbeat_timer_del)
7832                 del_timer_sync(&instance->sriov_heartbeat_timer);
7833
7834         /* Stop the FW fault detection watchdog */
7835         if (instance->adapter_type != MFI_SERIES)
7836                 megasas_fusion_stop_watchdog(instance);
7837
7838         if (instance->fw_crash_state != UNAVAILABLE)
7839                 megasas_free_host_crash_buffer(instance);
7840         scsi_remove_host(instance->host);
7841         instance->unload = 1;
7842
7843         if (megasas_wait_for_adapter_operational(instance))
7844                 goto skip_firing_dcmds;
7845
7846         megasas_flush_cache(instance);
7847         megasas_shutdown_controller(instance, MR_DCMD_CTRL_SHUTDOWN);
7848
7849 skip_firing_dcmds:
7850         /* cancel the delayed work if this work still in queue*/
7851         if (instance->ev != NULL) {
7852                 struct megasas_aen_event *ev = instance->ev;
7853                 cancel_delayed_work_sync(&ev->hotplug_work);
7854                 instance->ev = NULL;
7855         }
7856
7857         /* cancel all wait events */
7858         wake_up_all(&instance->int_cmd_wait_q);
7859
7860         tasklet_kill(&instance->isr_tasklet);
7861
7862         /*
7863          * Take the instance off the instance array. Note that we will not
7864          * decrement the max_index. We let this array be sparse array
7865          */
7866         for (i = 0; i < megasas_mgmt_info.max_index; i++) {
7867                 if (megasas_mgmt_info.instance[i] == instance) {
7868                         megasas_mgmt_info.count--;
7869                         megasas_mgmt_info.instance[i] = NULL;
7870
7871                         break;
7872                 }
7873         }
7874
7875         instance->instancet->disable_intr(instance);
7876
7877         megasas_destroy_irqs(instance);
7878
7879         if (instance->msix_vectors)
7880                 pci_free_irq_vectors(instance->pdev);
7881
7882         if (instance->adapter_type >= VENTURA_SERIES) {
7883                 for (i = 0; i < MAX_LOGICAL_DRIVES_EXT; ++i)
7884                         kfree(fusion->stream_detect_by_ld[i]);
7885                 kfree(fusion->stream_detect_by_ld);
7886                 fusion->stream_detect_by_ld = NULL;
7887         }
7888
7889
7890         if (instance->adapter_type != MFI_SERIES) {
7891                 megasas_release_fusion(instance);
7892                         pd_seq_map_sz = sizeof(struct MR_PD_CFG_SEQ_NUM_SYNC) +
7893                                 (sizeof(struct MR_PD_CFG_SEQ) *
7894                                         (MAX_PHYSICAL_DEVICES - 1));
7895                 for (i = 0; i < 2 ; i++) {
7896                         if (fusion->ld_map[i])
7897                                 dma_free_coherent(&instance->pdev->dev,
7898                                                   fusion->max_map_sz,
7899                                                   fusion->ld_map[i],
7900                                                   fusion->ld_map_phys[i]);
7901                         if (fusion->ld_drv_map[i]) {
7902                                 if (is_vmalloc_addr(fusion->ld_drv_map[i]))
7903                                         vfree(fusion->ld_drv_map[i]);
7904                                 else
7905                                         free_pages((ulong)fusion->ld_drv_map[i],
7906                                                    fusion->drv_map_pages);
7907                         }
7908
7909                         if (fusion->pd_seq_sync[i])
7910                                 dma_free_coherent(&instance->pdev->dev,
7911                                         pd_seq_map_sz,
7912                                         fusion->pd_seq_sync[i],
7913                                         fusion->pd_seq_phys[i]);
7914                 }
7915         } else {
7916                 megasas_release_mfi(instance);
7917         }
7918
7919         if (instance->vf_affiliation)
7920                 dma_free_coherent(&pdev->dev, (MAX_LOGICAL_DRIVES + 1) *
7921                                     sizeof(struct MR_LD_VF_AFFILIATION),
7922                                     instance->vf_affiliation,
7923                                     instance->vf_affiliation_h);
7924
7925         if (instance->vf_affiliation_111)
7926                 dma_free_coherent(&pdev->dev,
7927                                     sizeof(struct MR_LD_VF_AFFILIATION_111),
7928                                     instance->vf_affiliation_111,
7929                                     instance->vf_affiliation_111_h);
7930
7931         if (instance->hb_host_mem)
7932                 dma_free_coherent(&pdev->dev, sizeof(struct MR_CTRL_HB_HOST_MEM),
7933                                     instance->hb_host_mem,
7934                                     instance->hb_host_mem_h);
7935
7936         megasas_free_ctrl_dma_buffers(instance);
7937
7938         megasas_free_ctrl_mem(instance);
7939
7940         megasas_destroy_debugfs(instance);
7941
7942         scsi_host_put(host);
7943
7944         pci_disable_device(pdev);
7945 }
7946
7947 /**
7948  * megasas_shutdown -   Shutdown entry point
7949  * @pdev:               Generic device structure
7950  */
7951 static void megasas_shutdown(struct pci_dev *pdev)
7952 {
7953         struct megasas_instance *instance = pci_get_drvdata(pdev);
7954
7955         if (!instance)
7956                 return;
7957
7958         instance->unload = 1;
7959
7960         if (megasas_wait_for_adapter_operational(instance))
7961                 goto skip_firing_dcmds;
7962
7963         megasas_flush_cache(instance);
7964         megasas_shutdown_controller(instance, MR_DCMD_CTRL_SHUTDOWN);
7965
7966 skip_firing_dcmds:
7967         instance->instancet->disable_intr(instance);
7968         megasas_destroy_irqs(instance);
7969
7970         if (instance->msix_vectors)
7971                 pci_free_irq_vectors(instance->pdev);
7972 }
7973
7974 /*
7975  * megasas_mgmt_open -  char node "open" entry point
7976  * @inode:      char node inode
7977  * @filep:      char node file
7978  */
7979 static int megasas_mgmt_open(struct inode *inode, struct file *filep)
7980 {
7981         /*
7982          * Allow only those users with admin rights
7983          */
7984         if (!capable(CAP_SYS_ADMIN))
7985                 return -EACCES;
7986
7987         return 0;
7988 }
7989
7990 /*
7991  * megasas_mgmt_fasync -        Async notifier registration from applications
7992  * @fd:         char node file descriptor number
7993  * @filep:      char node file
7994  * @mode:       notifier on/off
7995  *
7996  * This function adds the calling process to a driver global queue. When an
7997  * event occurs, SIGIO will be sent to all processes in this queue.
7998  */
7999 static int megasas_mgmt_fasync(int fd, struct file *filep, int mode)
8000 {
8001         int rc;
8002
8003         mutex_lock(&megasas_async_queue_mutex);
8004
8005         rc = fasync_helper(fd, filep, mode, &megasas_async_queue);
8006
8007         mutex_unlock(&megasas_async_queue_mutex);
8008
8009         if (rc >= 0) {
8010                 /* For sanity check when we get ioctl */
8011                 filep->private_data = filep;
8012                 return 0;
8013         }
8014
8015         printk(KERN_DEBUG "megasas: fasync_helper failed [%d]\n", rc);
8016
8017         return rc;
8018 }
8019
8020 /*
8021  * megasas_mgmt_poll -  char node "poll" entry point
8022  * @filep:      char node file
8023  * @wait:       Events to poll for
8024  */
8025 static __poll_t megasas_mgmt_poll(struct file *file, poll_table *wait)
8026 {
8027         __poll_t mask;
8028         unsigned long flags;
8029
8030         poll_wait(file, &megasas_poll_wait, wait);
8031         spin_lock_irqsave(&poll_aen_lock, flags);
8032         if (megasas_poll_wait_aen)
8033                 mask = (EPOLLIN | EPOLLRDNORM);
8034         else
8035                 mask = 0;
8036         megasas_poll_wait_aen = 0;
8037         spin_unlock_irqrestore(&poll_aen_lock, flags);
8038         return mask;
8039 }
8040
8041 /*
8042  * megasas_set_crash_dump_params_ioctl:
8043  *              Send CRASH_DUMP_MODE DCMD to all controllers
8044  * @cmd:        MFI command frame
8045  */
8046
8047 static int megasas_set_crash_dump_params_ioctl(struct megasas_cmd *cmd)
8048 {
8049         struct megasas_instance *local_instance;
8050         int i, error = 0;
8051         int crash_support;
8052
8053         crash_support = cmd->frame->dcmd.mbox.w[0];
8054
8055         for (i = 0; i < megasas_mgmt_info.max_index; i++) {
8056                 local_instance = megasas_mgmt_info.instance[i];
8057                 if (local_instance && local_instance->crash_dump_drv_support) {
8058                         if ((atomic_read(&local_instance->adprecovery) ==
8059                                 MEGASAS_HBA_OPERATIONAL) &&
8060                                 !megasas_set_crash_dump_params(local_instance,
8061                                         crash_support)) {
8062                                 local_instance->crash_dump_app_support =
8063                                         crash_support;
8064                                 dev_info(&local_instance->pdev->dev,
8065                                         "Application firmware crash "
8066                                         "dump mode set success\n");
8067                                 error = 0;
8068                         } else {
8069                                 dev_info(&local_instance->pdev->dev,
8070                                         "Application firmware crash "
8071                                         "dump mode set failed\n");
8072                                 error = -1;
8073                         }
8074                 }
8075         }
8076         return error;
8077 }
8078
8079 /**
8080  * megasas_mgmt_fw_ioctl -      Issues management ioctls to FW
8081  * @instance:                   Adapter soft state
8082  * @user_ioc:                   User's ioctl packet
8083  * @ioc:                        ioctl packet
8084  */
8085 static int
8086 megasas_mgmt_fw_ioctl(struct megasas_instance *instance,
8087                       struct megasas_iocpacket __user * user_ioc,
8088                       struct megasas_iocpacket *ioc)
8089 {
8090         struct megasas_sge64 *kern_sge64 = NULL;
8091         struct megasas_sge32 *kern_sge32 = NULL;
8092         struct megasas_cmd *cmd;
8093         void *kbuff_arr[MAX_IOCTL_SGE];
8094         dma_addr_t buf_handle = 0;
8095         int error = 0, i;
8096         void *sense = NULL;
8097         dma_addr_t sense_handle;
8098         unsigned long *sense_ptr;
8099         u32 opcode = 0;
8100         int ret = DCMD_SUCCESS;
8101
8102         memset(kbuff_arr, 0, sizeof(kbuff_arr));
8103
8104         if (ioc->sge_count > MAX_IOCTL_SGE) {
8105                 dev_printk(KERN_DEBUG, &instance->pdev->dev, "SGE count [%d] >  max limit [%d]\n",
8106                        ioc->sge_count, MAX_IOCTL_SGE);
8107                 return -EINVAL;
8108         }
8109
8110         if ((ioc->frame.hdr.cmd >= MFI_CMD_OP_COUNT) ||
8111             ((ioc->frame.hdr.cmd == MFI_CMD_NVME) &&
8112             !instance->support_nvme_passthru) ||
8113             ((ioc->frame.hdr.cmd == MFI_CMD_TOOLBOX) &&
8114             !instance->support_pci_lane_margining)) {
8115                 dev_err(&instance->pdev->dev,
8116                         "Received invalid ioctl command 0x%x\n",
8117                         ioc->frame.hdr.cmd);
8118                 return -ENOTSUPP;
8119         }
8120
8121         cmd = megasas_get_cmd(instance);
8122         if (!cmd) {
8123                 dev_printk(KERN_DEBUG, &instance->pdev->dev, "Failed to get a cmd packet\n");
8124                 return -ENOMEM;
8125         }
8126
8127         /*
8128          * User's IOCTL packet has 2 frames (maximum). Copy those two
8129          * frames into our cmd's frames. cmd->frame's context will get
8130          * overwritten when we copy from user's frames. So set that value
8131          * alone separately
8132          */
8133         memcpy(cmd->frame, ioc->frame.raw, 2 * MEGAMFI_FRAME_SIZE);
8134         cmd->frame->hdr.context = cpu_to_le32(cmd->index);
8135         cmd->frame->hdr.pad_0 = 0;
8136
8137         cmd->frame->hdr.flags &= (~MFI_FRAME_IEEE);
8138
8139         if (instance->consistent_mask_64bit)
8140                 cmd->frame->hdr.flags |= cpu_to_le16((MFI_FRAME_SGL64 |
8141                                        MFI_FRAME_SENSE64));
8142         else
8143                 cmd->frame->hdr.flags &= cpu_to_le16(~(MFI_FRAME_SGL64 |
8144                                                MFI_FRAME_SENSE64));
8145
8146         if (cmd->frame->hdr.cmd == MFI_CMD_DCMD)
8147                 opcode = le32_to_cpu(cmd->frame->dcmd.opcode);
8148
8149         if (opcode == MR_DCMD_CTRL_SHUTDOWN) {
8150                 mutex_lock(&instance->reset_mutex);
8151                 if (megasas_get_ctrl_info(instance) != DCMD_SUCCESS) {
8152                         megasas_return_cmd(instance, cmd);
8153                         mutex_unlock(&instance->reset_mutex);
8154                         return -1;
8155                 }
8156                 mutex_unlock(&instance->reset_mutex);
8157         }
8158
8159         if (opcode == MR_DRIVER_SET_APP_CRASHDUMP_MODE) {
8160                 error = megasas_set_crash_dump_params_ioctl(cmd);
8161                 megasas_return_cmd(instance, cmd);
8162                 return error;
8163         }
8164
8165         /*
8166          * The management interface between applications and the fw uses
8167          * MFI frames. E.g, RAID configuration changes, LD property changes
8168          * etc are accomplishes through different kinds of MFI frames. The
8169          * driver needs to care only about substituting user buffers with
8170          * kernel buffers in SGLs. The location of SGL is embedded in the
8171          * struct iocpacket itself.
8172          */
8173         if (instance->consistent_mask_64bit)
8174                 kern_sge64 = (struct megasas_sge64 *)
8175                         ((unsigned long)cmd->frame + ioc->sgl_off);
8176         else
8177                 kern_sge32 = (struct megasas_sge32 *)
8178                         ((unsigned long)cmd->frame + ioc->sgl_off);
8179
8180         /*
8181          * For each user buffer, create a mirror buffer and copy in
8182          */
8183         for (i = 0; i < ioc->sge_count; i++) {
8184                 if (!ioc->sgl[i].iov_len)
8185                         continue;
8186
8187                 kbuff_arr[i] = dma_alloc_coherent(&instance->pdev->dev,
8188                                                     ioc->sgl[i].iov_len,
8189                                                     &buf_handle, GFP_KERNEL);
8190                 if (!kbuff_arr[i]) {
8191                         dev_printk(KERN_DEBUG, &instance->pdev->dev, "Failed to alloc "
8192                                "kernel SGL buffer for IOCTL\n");
8193                         error = -ENOMEM;
8194                         goto out;
8195                 }
8196
8197                 /*
8198                  * We don't change the dma_coherent_mask, so
8199                  * dma_alloc_coherent only returns 32bit addresses
8200                  */
8201                 if (instance->consistent_mask_64bit) {
8202                         kern_sge64[i].phys_addr = cpu_to_le64(buf_handle);
8203                         kern_sge64[i].length = cpu_to_le32(ioc->sgl[i].iov_len);
8204                 } else {
8205                         kern_sge32[i].phys_addr = cpu_to_le32(buf_handle);
8206                         kern_sge32[i].length = cpu_to_le32(ioc->sgl[i].iov_len);
8207                 }
8208
8209                 /*
8210                  * We created a kernel buffer corresponding to the
8211                  * user buffer. Now copy in from the user buffer
8212                  */
8213                 if (copy_from_user(kbuff_arr[i], ioc->sgl[i].iov_base,
8214                                    (u32) (ioc->sgl[i].iov_len))) {
8215                         error = -EFAULT;
8216                         goto out;
8217                 }
8218         }
8219
8220         if (ioc->sense_len) {
8221                 sense = dma_alloc_coherent(&instance->pdev->dev, ioc->sense_len,
8222                                              &sense_handle, GFP_KERNEL);
8223                 if (!sense) {
8224                         error = -ENOMEM;
8225                         goto out;
8226                 }
8227
8228                 sense_ptr =
8229                 (unsigned long *) ((unsigned long)cmd->frame + ioc->sense_off);
8230                 if (instance->consistent_mask_64bit)
8231                         *sense_ptr = cpu_to_le64(sense_handle);
8232                 else
8233                         *sense_ptr = cpu_to_le32(sense_handle);
8234         }
8235
8236         /*
8237          * Set the sync_cmd flag so that the ISR knows not to complete this
8238          * cmd to the SCSI mid-layer
8239          */
8240         cmd->sync_cmd = 1;
8241
8242         ret = megasas_issue_blocked_cmd(instance, cmd, 0);
8243         switch (ret) {
8244         case DCMD_INIT:
8245         case DCMD_BUSY:
8246                 cmd->sync_cmd = 0;
8247                 dev_err(&instance->pdev->dev,
8248                         "return -EBUSY from %s %d cmd 0x%x opcode 0x%x cmd->cmd_status_drv 0x%x\n",
8249                          __func__, __LINE__, cmd->frame->hdr.cmd, opcode,
8250                          cmd->cmd_status_drv);
8251                 error = -EBUSY;
8252                 goto out;
8253         }
8254
8255         cmd->sync_cmd = 0;
8256
8257         if (instance->unload == 1) {
8258                 dev_info(&instance->pdev->dev, "Driver unload is in progress "
8259                         "don't submit data to application\n");
8260                 goto out;
8261         }
8262         /*
8263          * copy out the kernel buffers to user buffers
8264          */
8265         for (i = 0; i < ioc->sge_count; i++) {
8266                 if (copy_to_user(ioc->sgl[i].iov_base, kbuff_arr[i],
8267                                  ioc->sgl[i].iov_len)) {
8268                         error = -EFAULT;
8269                         goto out;
8270                 }
8271         }
8272
8273         /*
8274          * copy out the sense
8275          */
8276         if (ioc->sense_len) {
8277                 /*
8278                  * sense_ptr points to the location that has the user
8279                  * sense buffer address
8280                  */
8281                 sense_ptr = (unsigned long *) ((unsigned long)ioc->frame.raw +
8282                                 ioc->sense_off);
8283
8284                 if (copy_to_user((void __user *)((unsigned long)
8285                                  get_unaligned((unsigned long *)sense_ptr)),
8286                                  sense, ioc->sense_len)) {
8287                         dev_err(&instance->pdev->dev, "Failed to copy out to user "
8288                                         "sense data\n");
8289                         error = -EFAULT;
8290                         goto out;
8291                 }
8292         }
8293
8294         /*
8295          * copy the status codes returned by the fw
8296          */
8297         if (copy_to_user(&user_ioc->frame.hdr.cmd_status,
8298                          &cmd->frame->hdr.cmd_status, sizeof(u8))) {
8299                 dev_printk(KERN_DEBUG, &instance->pdev->dev, "Error copying out cmd_status\n");
8300                 error = -EFAULT;
8301         }
8302
8303 out:
8304         if (sense) {
8305                 dma_free_coherent(&instance->pdev->dev, ioc->sense_len,
8306                                     sense, sense_handle);
8307         }
8308
8309         for (i = 0; i < ioc->sge_count; i++) {
8310                 if (kbuff_arr[i]) {
8311                         if (instance->consistent_mask_64bit)
8312                                 dma_free_coherent(&instance->pdev->dev,
8313                                         le32_to_cpu(kern_sge64[i].length),
8314                                         kbuff_arr[i],
8315                                         le64_to_cpu(kern_sge64[i].phys_addr));
8316                         else
8317                                 dma_free_coherent(&instance->pdev->dev,
8318                                         le32_to_cpu(kern_sge32[i].length),
8319                                         kbuff_arr[i],
8320                                         le32_to_cpu(kern_sge32[i].phys_addr));
8321                         kbuff_arr[i] = NULL;
8322                 }
8323         }
8324
8325         megasas_return_cmd(instance, cmd);
8326         return error;
8327 }
8328
8329 static int megasas_mgmt_ioctl_fw(struct file *file, unsigned long arg)
8330 {
8331         struct megasas_iocpacket __user *user_ioc =
8332             (struct megasas_iocpacket __user *)arg;
8333         struct megasas_iocpacket *ioc;
8334         struct megasas_instance *instance;
8335         int error;
8336
8337         ioc = memdup_user(user_ioc, sizeof(*ioc));
8338         if (IS_ERR(ioc))
8339                 return PTR_ERR(ioc);
8340
8341         instance = megasas_lookup_instance(ioc->host_no);
8342         if (!instance) {
8343                 error = -ENODEV;
8344                 goto out_kfree_ioc;
8345         }
8346
8347         /* Block ioctls in VF mode */
8348         if (instance->requestorId && !allow_vf_ioctls) {
8349                 error = -ENODEV;
8350                 goto out_kfree_ioc;
8351         }
8352
8353         if (atomic_read(&instance->adprecovery) == MEGASAS_HW_CRITICAL_ERROR) {
8354                 dev_err(&instance->pdev->dev, "Controller in crit error\n");
8355                 error = -ENODEV;
8356                 goto out_kfree_ioc;
8357         }
8358
8359         if (instance->unload == 1) {
8360                 error = -ENODEV;
8361                 goto out_kfree_ioc;
8362         }
8363
8364         if (down_interruptible(&instance->ioctl_sem)) {
8365                 error = -ERESTARTSYS;
8366                 goto out_kfree_ioc;
8367         }
8368
8369         if  (megasas_wait_for_adapter_operational(instance)) {
8370                 error = -ENODEV;
8371                 goto out_up;
8372         }
8373
8374         error = megasas_mgmt_fw_ioctl(instance, user_ioc, ioc);
8375 out_up:
8376         up(&instance->ioctl_sem);
8377
8378 out_kfree_ioc:
8379         kfree(ioc);
8380         return error;
8381 }
8382
8383 static int megasas_mgmt_ioctl_aen(struct file *file, unsigned long arg)
8384 {
8385         struct megasas_instance *instance;
8386         struct megasas_aen aen;
8387         int error;
8388
8389         if (file->private_data != file) {
8390                 printk(KERN_DEBUG "megasas: fasync_helper was not "
8391                        "called first\n");
8392                 return -EINVAL;
8393         }
8394
8395         if (copy_from_user(&aen, (void __user *)arg, sizeof(aen)))
8396                 return -EFAULT;
8397
8398         instance = megasas_lookup_instance(aen.host_no);
8399
8400         if (!instance)
8401                 return -ENODEV;
8402
8403         if (atomic_read(&instance->adprecovery) == MEGASAS_HW_CRITICAL_ERROR) {
8404                 return -ENODEV;
8405         }
8406
8407         if (instance->unload == 1) {
8408                 return -ENODEV;
8409         }
8410
8411         if  (megasas_wait_for_adapter_operational(instance))
8412                 return -ENODEV;
8413
8414         mutex_lock(&instance->reset_mutex);
8415         error = megasas_register_aen(instance, aen.seq_num,
8416                                      aen.class_locale_word);
8417         mutex_unlock(&instance->reset_mutex);
8418         return error;
8419 }
8420
8421 /**
8422  * megasas_mgmt_ioctl - char node ioctl entry point
8423  * @file:       char device file pointer
8424  * @cmd:        ioctl command
8425  * @arg:        ioctl command arguments address
8426  */
8427 static long
8428 megasas_mgmt_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
8429 {
8430         switch (cmd) {
8431         case MEGASAS_IOC_FIRMWARE:
8432                 return megasas_mgmt_ioctl_fw(file, arg);
8433
8434         case MEGASAS_IOC_GET_AEN:
8435                 return megasas_mgmt_ioctl_aen(file, arg);
8436         }
8437
8438         return -ENOTTY;
8439 }
8440
8441 #ifdef CONFIG_COMPAT
8442 static int megasas_mgmt_compat_ioctl_fw(struct file *file, unsigned long arg)
8443 {
8444         struct compat_megasas_iocpacket __user *cioc =
8445             (struct compat_megasas_iocpacket __user *)arg;
8446         struct megasas_iocpacket __user *ioc =
8447             compat_alloc_user_space(sizeof(struct megasas_iocpacket));
8448         int i;
8449         int error = 0;
8450         compat_uptr_t ptr;
8451         u32 local_sense_off;
8452         u32 local_sense_len;
8453         u32 user_sense_off;
8454
8455         if (clear_user(ioc, sizeof(*ioc)))
8456                 return -EFAULT;
8457
8458         if (copy_in_user(&ioc->host_no, &cioc->host_no, sizeof(u16)) ||
8459             copy_in_user(&ioc->sgl_off, &cioc->sgl_off, sizeof(u32)) ||
8460             copy_in_user(&ioc->sense_off, &cioc->sense_off, sizeof(u32)) ||
8461             copy_in_user(&ioc->sense_len, &cioc->sense_len, sizeof(u32)) ||
8462             copy_in_user(ioc->frame.raw, cioc->frame.raw, 128) ||
8463             copy_in_user(&ioc->sge_count, &cioc->sge_count, sizeof(u32)))
8464                 return -EFAULT;
8465
8466         /*
8467          * The sense_ptr is used in megasas_mgmt_fw_ioctl only when
8468          * sense_len is not null, so prepare the 64bit value under
8469          * the same condition.
8470          */
8471         if (get_user(local_sense_off, &ioc->sense_off) ||
8472                 get_user(local_sense_len, &ioc->sense_len) ||
8473                 get_user(user_sense_off, &cioc->sense_off))
8474                 return -EFAULT;
8475
8476         if (local_sense_off != user_sense_off)
8477                 return -EINVAL;
8478
8479         if (local_sense_len) {
8480                 void __user **sense_ioc_ptr =
8481                         (void __user **)((u8 *)((unsigned long)&ioc->frame.raw) + local_sense_off);
8482                 compat_uptr_t *sense_cioc_ptr =
8483                         (compat_uptr_t *)(((unsigned long)&cioc->frame.raw) + user_sense_off);
8484                 if (get_user(ptr, sense_cioc_ptr) ||
8485                     put_user(compat_ptr(ptr), sense_ioc_ptr))
8486                         return -EFAULT;
8487         }
8488
8489         for (i = 0; i < MAX_IOCTL_SGE; i++) {
8490                 if (get_user(ptr, &cioc->sgl[i].iov_base) ||
8491                     put_user(compat_ptr(ptr), &ioc->sgl[i].iov_base) ||
8492                     copy_in_user(&ioc->sgl[i].iov_len,
8493                                  &cioc->sgl[i].iov_len, sizeof(compat_size_t)))
8494                         return -EFAULT;
8495         }
8496
8497         error = megasas_mgmt_ioctl_fw(file, (unsigned long)ioc);
8498
8499         if (copy_in_user(&cioc->frame.hdr.cmd_status,
8500                          &ioc->frame.hdr.cmd_status, sizeof(u8))) {
8501                 printk(KERN_DEBUG "megasas: error copy_in_user cmd_status\n");
8502                 return -EFAULT;
8503         }
8504         return error;
8505 }
8506
8507 static long
8508 megasas_mgmt_compat_ioctl(struct file *file, unsigned int cmd,
8509                           unsigned long arg)
8510 {
8511         switch (cmd) {
8512         case MEGASAS_IOC_FIRMWARE32:
8513                 return megasas_mgmt_compat_ioctl_fw(file, arg);
8514         case MEGASAS_IOC_GET_AEN:
8515                 return megasas_mgmt_ioctl_aen(file, arg);
8516         }
8517
8518         return -ENOTTY;
8519 }
8520 #endif
8521
8522 /*
8523  * File operations structure for management interface
8524  */
8525 static const struct file_operations megasas_mgmt_fops = {
8526         .owner = THIS_MODULE,
8527         .open = megasas_mgmt_open,
8528         .fasync = megasas_mgmt_fasync,
8529         .unlocked_ioctl = megasas_mgmt_ioctl,
8530         .poll = megasas_mgmt_poll,
8531 #ifdef CONFIG_COMPAT
8532         .compat_ioctl = megasas_mgmt_compat_ioctl,
8533 #endif
8534         .llseek = noop_llseek,
8535 };
8536
8537 /*
8538  * PCI hotplug support registration structure
8539  */
8540 static struct pci_driver megasas_pci_driver = {
8541
8542         .name = "megaraid_sas",
8543         .id_table = megasas_pci_table,
8544         .probe = megasas_probe_one,
8545         .remove = megasas_detach_one,
8546         .suspend = megasas_suspend,
8547         .resume = megasas_resume,
8548         .shutdown = megasas_shutdown,
8549 };
8550
8551 /*
8552  * Sysfs driver attributes
8553  */
8554 static ssize_t version_show(struct device_driver *dd, char *buf)
8555 {
8556         return snprintf(buf, strlen(MEGASAS_VERSION) + 2, "%s\n",
8557                         MEGASAS_VERSION);
8558 }
8559 static DRIVER_ATTR_RO(version);
8560
8561 static ssize_t release_date_show(struct device_driver *dd, char *buf)
8562 {
8563         return snprintf(buf, strlen(MEGASAS_RELDATE) + 2, "%s\n",
8564                 MEGASAS_RELDATE);
8565 }
8566 static DRIVER_ATTR_RO(release_date);
8567
8568 static ssize_t support_poll_for_event_show(struct device_driver *dd, char *buf)
8569 {
8570         return sprintf(buf, "%u\n", support_poll_for_event);
8571 }
8572 static DRIVER_ATTR_RO(support_poll_for_event);
8573
8574 static ssize_t support_device_change_show(struct device_driver *dd, char *buf)
8575 {
8576         return sprintf(buf, "%u\n", support_device_change);
8577 }
8578 static DRIVER_ATTR_RO(support_device_change);
8579
8580 static ssize_t dbg_lvl_show(struct device_driver *dd, char *buf)
8581 {
8582         return sprintf(buf, "%u\n", megasas_dbg_lvl);
8583 }
8584
8585 static ssize_t dbg_lvl_store(struct device_driver *dd, const char *buf,
8586                              size_t count)
8587 {
8588         int retval = count;
8589
8590         if (sscanf(buf, "%u", &megasas_dbg_lvl) < 1) {
8591                 printk(KERN_ERR "megasas: could not set dbg_lvl\n");
8592                 retval = -EINVAL;
8593         }
8594         return retval;
8595 }
8596 static DRIVER_ATTR_RW(dbg_lvl);
8597
8598 static ssize_t
8599 support_nvme_encapsulation_show(struct device_driver *dd, char *buf)
8600 {
8601         return sprintf(buf, "%u\n", support_nvme_encapsulation);
8602 }
8603
8604 static DRIVER_ATTR_RO(support_nvme_encapsulation);
8605
8606 static ssize_t
8607 support_pci_lane_margining_show(struct device_driver *dd, char *buf)
8608 {
8609         return sprintf(buf, "%u\n", support_pci_lane_margining);
8610 }
8611
8612 static DRIVER_ATTR_RO(support_pci_lane_margining);
8613
8614 static inline void megasas_remove_scsi_device(struct scsi_device *sdev)
8615 {
8616         sdev_printk(KERN_INFO, sdev, "SCSI device is removed\n");
8617         scsi_remove_device(sdev);
8618         scsi_device_put(sdev);
8619 }
8620
8621 /**
8622  * megasas_update_device_list - Update the PD and LD device list from FW
8623  *                              after an AEN event notification
8624  * @instance:                   Adapter soft state
8625  * @event_type:                 Indicates type of event (PD or LD event)
8626  *
8627  * @return:                     Success or failure
8628  *
8629  * Issue DCMDs to Firmware to update the internal device list in driver.
8630  * Based on the FW support, driver sends the HOST_DEVICE_LIST or combination
8631  * of PD_LIST/LD_LIST_QUERY DCMDs to get the device list.
8632  */
8633 static
8634 int megasas_update_device_list(struct megasas_instance *instance,
8635                                int event_type)
8636 {
8637         int dcmd_ret = DCMD_SUCCESS;
8638
8639         if (instance->enable_fw_dev_list) {
8640                 dcmd_ret = megasas_host_device_list_query(instance, false);
8641                 if (dcmd_ret != DCMD_SUCCESS)
8642                         goto out;
8643         } else {
8644                 if (event_type & SCAN_PD_CHANNEL) {
8645                         dcmd_ret = megasas_get_pd_list(instance);
8646
8647                         if (dcmd_ret != DCMD_SUCCESS)
8648                                 goto out;
8649                 }
8650
8651                 if (event_type & SCAN_VD_CHANNEL) {
8652                         if (!instance->requestorId ||
8653                             (instance->requestorId &&
8654                              megasas_get_ld_vf_affiliation(instance, 0))) {
8655                                 dcmd_ret = megasas_ld_list_query(instance,
8656                                                 MR_LD_QUERY_TYPE_EXPOSED_TO_HOST);
8657                                 if (dcmd_ret != DCMD_SUCCESS)
8658                                         goto out;
8659                         }
8660                 }
8661         }
8662
8663 out:
8664         return dcmd_ret;
8665 }
8666
8667 /**
8668  * megasas_add_remove_devices - Add/remove devices to SCSI mid-layer
8669  *                              after an AEN event notification
8670  * @instance:                   Adapter soft state
8671  * @scan_type:                  Indicates type of devices (PD/LD) to add
8672  * @return                      void
8673  */
8674 static
8675 void megasas_add_remove_devices(struct megasas_instance *instance,
8676                                 int scan_type)
8677 {
8678         int i, j;
8679         u16 pd_index = 0;
8680         u16 ld_index = 0;
8681         u16 channel = 0, id = 0;
8682         struct Scsi_Host *host;
8683         struct scsi_device *sdev1;
8684         struct MR_HOST_DEVICE_LIST *targetid_list = NULL;
8685         struct MR_HOST_DEVICE_LIST_ENTRY *targetid_entry = NULL;
8686
8687         host = instance->host;
8688
8689         if (instance->enable_fw_dev_list) {
8690                 targetid_list = instance->host_device_list_buf;
8691                 for (i = 0; i < targetid_list->count; i++) {
8692                         targetid_entry = &targetid_list->host_device_list[i];
8693                         if (targetid_entry->flags.u.bits.is_sys_pd) {
8694                                 channel = le16_to_cpu(targetid_entry->target_id) /
8695                                                 MEGASAS_MAX_DEV_PER_CHANNEL;
8696                                 id = le16_to_cpu(targetid_entry->target_id) %
8697                                                 MEGASAS_MAX_DEV_PER_CHANNEL;
8698                         } else {
8699                                 channel = MEGASAS_MAX_PD_CHANNELS +
8700                                           (le16_to_cpu(targetid_entry->target_id) /
8701                                            MEGASAS_MAX_DEV_PER_CHANNEL);
8702                                 id = le16_to_cpu(targetid_entry->target_id) %
8703                                                 MEGASAS_MAX_DEV_PER_CHANNEL;
8704                         }
8705                         sdev1 = scsi_device_lookup(host, channel, id, 0);
8706                         if (!sdev1) {
8707                                 scsi_add_device(host, channel, id, 0);
8708                         } else {
8709                                 scsi_device_put(sdev1);
8710                         }
8711                 }
8712         }
8713
8714         if (scan_type & SCAN_PD_CHANNEL) {
8715                 for (i = 0; i < MEGASAS_MAX_PD_CHANNELS; i++) {
8716                         for (j = 0; j < MEGASAS_MAX_DEV_PER_CHANNEL; j++) {
8717                                 pd_index = i * MEGASAS_MAX_DEV_PER_CHANNEL + j;
8718                                 sdev1 = scsi_device_lookup(host, i, j, 0);
8719                                 if (instance->pd_list[pd_index].driveState ==
8720                                                         MR_PD_STATE_SYSTEM) {
8721                                         if (!sdev1)
8722                                                 scsi_add_device(host, i, j, 0);
8723                                         else
8724                                                 scsi_device_put(sdev1);
8725                                 } else {
8726                                         if (sdev1)
8727                                                 megasas_remove_scsi_device(sdev1);
8728                                 }
8729                         }
8730                 }
8731         }
8732
8733         if (scan_type & SCAN_VD_CHANNEL) {
8734                 for (i = 0; i < MEGASAS_MAX_LD_CHANNELS; i++) {
8735                         for (j = 0; j < MEGASAS_MAX_DEV_PER_CHANNEL; j++) {
8736                                 ld_index = (i * MEGASAS_MAX_DEV_PER_CHANNEL) + j;
8737                                 sdev1 = scsi_device_lookup(host,
8738                                                 MEGASAS_MAX_PD_CHANNELS + i, j, 0);
8739                                 if (instance->ld_ids[ld_index] != 0xff) {
8740                                         if (!sdev1)
8741                                                 scsi_add_device(host, MEGASAS_MAX_PD_CHANNELS + i, j, 0);
8742                                         else
8743                                                 scsi_device_put(sdev1);
8744                                 } else {
8745                                         if (sdev1)
8746                                                 megasas_remove_scsi_device(sdev1);
8747                                 }
8748                         }
8749                 }
8750         }
8751
8752 }
8753
8754 static void
8755 megasas_aen_polling(struct work_struct *work)
8756 {
8757         struct megasas_aen_event *ev =
8758                 container_of(work, struct megasas_aen_event, hotplug_work.work);
8759         struct megasas_instance *instance = ev->instance;
8760         union megasas_evt_class_locale class_locale;
8761         int event_type = 0;
8762         u32 seq_num;
8763         int error;
8764         u8  dcmd_ret = DCMD_SUCCESS;
8765
8766         if (!instance) {
8767                 printk(KERN_ERR "invalid instance!\n");
8768                 kfree(ev);
8769                 return;
8770         }
8771
8772         /* Don't run the event workqueue thread if OCR is running */
8773         mutex_lock(&instance->reset_mutex);
8774
8775         instance->ev = NULL;
8776         if (instance->evt_detail) {
8777                 megasas_decode_evt(instance);
8778
8779                 switch (le32_to_cpu(instance->evt_detail->code)) {
8780
8781                 case MR_EVT_PD_INSERTED:
8782                 case MR_EVT_PD_REMOVED:
8783                         event_type = SCAN_PD_CHANNEL;
8784                         break;
8785
8786                 case MR_EVT_LD_OFFLINE:
8787                 case MR_EVT_CFG_CLEARED:
8788                 case MR_EVT_LD_DELETED:
8789                 case MR_EVT_LD_CREATED:
8790                         event_type = SCAN_VD_CHANNEL;
8791                         break;
8792
8793                 case MR_EVT_CTRL_HOST_BUS_SCAN_REQUESTED:
8794                 case MR_EVT_FOREIGN_CFG_IMPORTED:
8795                 case MR_EVT_LD_STATE_CHANGE:
8796                         event_type = SCAN_PD_CHANNEL | SCAN_VD_CHANNEL;
8797                         dev_info(&instance->pdev->dev, "scanning for scsi%d...\n",
8798                                 instance->host->host_no);
8799                         break;
8800
8801                 case MR_EVT_CTRL_PROP_CHANGED:
8802                         dcmd_ret = megasas_get_ctrl_info(instance);
8803                         if (dcmd_ret == DCMD_SUCCESS &&
8804                             instance->snapdump_wait_time) {
8805                                 megasas_get_snapdump_properties(instance);
8806                                 dev_info(&instance->pdev->dev,
8807                                          "Snap dump wait time\t: %d\n",
8808                                          instance->snapdump_wait_time);
8809                         }
8810                         break;
8811                 default:
8812                         event_type = 0;
8813                         break;
8814                 }
8815         } else {
8816                 dev_err(&instance->pdev->dev, "invalid evt_detail!\n");
8817                 mutex_unlock(&instance->reset_mutex);
8818                 kfree(ev);
8819                 return;
8820         }
8821
8822         if (event_type)
8823                 dcmd_ret = megasas_update_device_list(instance, event_type);
8824
8825         mutex_unlock(&instance->reset_mutex);
8826
8827         if (event_type && dcmd_ret == DCMD_SUCCESS)
8828                 megasas_add_remove_devices(instance, event_type);
8829
8830         if (dcmd_ret == DCMD_SUCCESS)
8831                 seq_num = le32_to_cpu(instance->evt_detail->seq_num) + 1;
8832         else
8833                 seq_num = instance->last_seq_num;
8834
8835         /* Register AEN with FW for latest sequence number plus 1 */
8836         class_locale.members.reserved = 0;
8837         class_locale.members.locale = MR_EVT_LOCALE_ALL;
8838         class_locale.members.class = MR_EVT_CLASS_DEBUG;
8839
8840         if (instance->aen_cmd != NULL) {
8841                 kfree(ev);
8842                 return;
8843         }
8844
8845         mutex_lock(&instance->reset_mutex);
8846         error = megasas_register_aen(instance, seq_num,
8847                                         class_locale.word);
8848         if (error)
8849                 dev_err(&instance->pdev->dev,
8850                         "register aen failed error %x\n", error);
8851
8852         mutex_unlock(&instance->reset_mutex);
8853         kfree(ev);
8854 }
8855
8856 /**
8857  * megasas_init - Driver load entry point
8858  */
8859 static int __init megasas_init(void)
8860 {
8861         int rval;
8862
8863         /*
8864          * Booted in kdump kernel, minimize memory footprints by
8865          * disabling few features
8866          */
8867         if (reset_devices) {
8868                 msix_vectors = 1;
8869                 rdpq_enable = 0;
8870                 dual_qdepth_disable = 1;
8871         }
8872
8873         /*
8874          * Announce driver version and other information
8875          */
8876         pr_info("megasas: %s\n", MEGASAS_VERSION);
8877
8878         spin_lock_init(&poll_aen_lock);
8879
8880         support_poll_for_event = 2;
8881         support_device_change = 1;
8882         support_nvme_encapsulation = true;
8883         support_pci_lane_margining = true;
8884
8885         memset(&megasas_mgmt_info, 0, sizeof(megasas_mgmt_info));
8886
8887         /*
8888          * Register character device node
8889          */
8890         rval = register_chrdev(0, "megaraid_sas_ioctl", &megasas_mgmt_fops);
8891
8892         if (rval < 0) {
8893                 printk(KERN_DEBUG "megasas: failed to open device node\n");
8894                 return rval;
8895         }
8896
8897         megasas_mgmt_majorno = rval;
8898
8899         megasas_init_debugfs();
8900
8901         /*
8902          * Register ourselves as PCI hotplug module
8903          */
8904         rval = pci_register_driver(&megasas_pci_driver);
8905
8906         if (rval) {
8907                 printk(KERN_DEBUG "megasas: PCI hotplug registration failed \n");
8908                 goto err_pcidrv;
8909         }
8910
8911         if ((event_log_level < MFI_EVT_CLASS_DEBUG) ||
8912             (event_log_level > MFI_EVT_CLASS_DEAD)) {
8913                 pr_warn("megaraid_sas: provided event log level is out of range, setting it to default 2(CLASS_CRITICAL), permissible range is: -2 to 4\n");
8914                 event_log_level = MFI_EVT_CLASS_CRITICAL;
8915         }
8916
8917         rval = driver_create_file(&megasas_pci_driver.driver,
8918                                   &driver_attr_version);
8919         if (rval)
8920                 goto err_dcf_attr_ver;
8921
8922         rval = driver_create_file(&megasas_pci_driver.driver,
8923                                   &driver_attr_release_date);
8924         if (rval)
8925                 goto err_dcf_rel_date;
8926
8927         rval = driver_create_file(&megasas_pci_driver.driver,
8928                                 &driver_attr_support_poll_for_event);
8929         if (rval)
8930                 goto err_dcf_support_poll_for_event;
8931
8932         rval = driver_create_file(&megasas_pci_driver.driver,
8933                                   &driver_attr_dbg_lvl);
8934         if (rval)
8935                 goto err_dcf_dbg_lvl;
8936         rval = driver_create_file(&megasas_pci_driver.driver,
8937                                 &driver_attr_support_device_change);
8938         if (rval)
8939                 goto err_dcf_support_device_change;
8940
8941         rval = driver_create_file(&megasas_pci_driver.driver,
8942                                   &driver_attr_support_nvme_encapsulation);
8943         if (rval)
8944                 goto err_dcf_support_nvme_encapsulation;
8945
8946         rval = driver_create_file(&megasas_pci_driver.driver,
8947                                   &driver_attr_support_pci_lane_margining);
8948         if (rval)
8949                 goto err_dcf_support_pci_lane_margining;
8950
8951         return rval;
8952
8953 err_dcf_support_pci_lane_margining:
8954         driver_remove_file(&megasas_pci_driver.driver,
8955                            &driver_attr_support_nvme_encapsulation);
8956
8957 err_dcf_support_nvme_encapsulation:
8958         driver_remove_file(&megasas_pci_driver.driver,
8959                            &driver_attr_support_device_change);
8960
8961 err_dcf_support_device_change:
8962         driver_remove_file(&megasas_pci_driver.driver,
8963                            &driver_attr_dbg_lvl);
8964 err_dcf_dbg_lvl:
8965         driver_remove_file(&megasas_pci_driver.driver,
8966                         &driver_attr_support_poll_for_event);
8967 err_dcf_support_poll_for_event:
8968         driver_remove_file(&megasas_pci_driver.driver,
8969                            &driver_attr_release_date);
8970 err_dcf_rel_date:
8971         driver_remove_file(&megasas_pci_driver.driver, &driver_attr_version);
8972 err_dcf_attr_ver:
8973         pci_unregister_driver(&megasas_pci_driver);
8974 err_pcidrv:
8975         megasas_exit_debugfs();
8976         unregister_chrdev(megasas_mgmt_majorno, "megaraid_sas_ioctl");
8977         return rval;
8978 }
8979
8980 /**
8981  * megasas_exit - Driver unload entry point
8982  */
8983 static void __exit megasas_exit(void)
8984 {
8985         driver_remove_file(&megasas_pci_driver.driver,
8986                            &driver_attr_dbg_lvl);
8987         driver_remove_file(&megasas_pci_driver.driver,
8988                         &driver_attr_support_poll_for_event);
8989         driver_remove_file(&megasas_pci_driver.driver,
8990                         &driver_attr_support_device_change);
8991         driver_remove_file(&megasas_pci_driver.driver,
8992                            &driver_attr_release_date);
8993         driver_remove_file(&megasas_pci_driver.driver, &driver_attr_version);
8994         driver_remove_file(&megasas_pci_driver.driver,
8995                            &driver_attr_support_nvme_encapsulation);
8996         driver_remove_file(&megasas_pci_driver.driver,
8997                            &driver_attr_support_pci_lane_margining);
8998
8999         pci_unregister_driver(&megasas_pci_driver);
9000         megasas_exit_debugfs();
9001         unregister_chrdev(megasas_mgmt_majorno, "megaraid_sas_ioctl");
9002 }
9003
9004 module_init(megasas_init);
9005 module_exit(megasas_exit);