drivers/scsi/megaraid/megaraid_sas_base.c

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