drivers/scsi/mpi3mr/mpi3mr_os.c

   1 // SPDX-License-Identifier: GPL-2.0-or-later
   2 /*
   3  * Driver for Broadcom MPI3 Storage Controllers
   4  *
   5  * Copyright (C) 2017-2021 Broadcom Inc.
   6  *  (mailto: mpi3mr-linuxdrv.pdl@broadcom.com)
   7  *
   8  */
   9
  10 #include "mpi3mr.h"
  11
  12 /* global driver scop variables */
  13 LIST_HEAD(mrioc_list);
  14 DEFINE_SPINLOCK(mrioc_list_lock);
  15 static int mrioc_ids;
  16 static int warn_non_secure_ctlr;
  17
  18 MODULE_AUTHOR(MPI3MR_DRIVER_AUTHOR);
  19 MODULE_DESCRIPTION(MPI3MR_DRIVER_DESC);
  20 MODULE_LICENSE(MPI3MR_DRIVER_LICENSE);
  21 MODULE_VERSION(MPI3MR_DRIVER_VERSION);
  22
  23 /* Module parameters*/
  24 int prot_mask = -1;
  25 module_param(prot_mask, int, 0);
  26 MODULE_PARM_DESC(prot_mask, "Host protection capabilities mask, def=0x07");
  27
  28 static int prot_guard_mask = 3;
  29 module_param(prot_guard_mask, int, 0);
  30 MODULE_PARM_DESC(prot_guard_mask, " Host protection guard mask, def=3");
  31 static int logging_level;
  32 module_param(logging_level, int, 0);
  33 MODULE_PARM_DESC(logging_level,
  34         " bits for enabling additional logging info (default=0)");
  35
  36 /* Forward declarations*/
  37 /**
  38  * mpi3mr_host_tag_for_scmd - Get host tag for a scmd
  39  * @mrioc: Adapter instance reference
  40  * @scmd: SCSI command reference
  41  *
  42  * Calculate the host tag based on block tag for a given scmd.
  43  *
  44  * Return: Valid host tag or MPI3MR_HOSTTAG_INVALID.
  45  */
  46 static u16 mpi3mr_host_tag_for_scmd(struct mpi3mr_ioc *mrioc,
  47         struct scsi_cmnd *scmd)
  48 {
  49         struct scmd_priv *priv = NULL;
  50         u32 unique_tag;
  51         u16 host_tag, hw_queue;
  52
  53         unique_tag = blk_mq_unique_tag(scsi_cmd_to_rq(scmd));
  54
  55         hw_queue = blk_mq_unique_tag_to_hwq(unique_tag);
  56         if (hw_queue >= mrioc->num_op_reply_q)
  57                 return MPI3MR_HOSTTAG_INVALID;
  58         host_tag = blk_mq_unique_tag_to_tag(unique_tag);
  59
  60         if (WARN_ON(host_tag >= mrioc->max_host_ios))
  61                 return MPI3MR_HOSTTAG_INVALID;
  62
  63         priv = scsi_cmd_priv(scmd);
  64         /*host_tag 0 is invalid hence incrementing by 1*/
  65         priv->host_tag = host_tag + 1;
  66         priv->scmd = scmd;
  67         priv->in_lld_scope = 1;
  68         priv->req_q_idx = hw_queue;
  69         priv->meta_chain_idx = -1;
  70         priv->chain_idx = -1;
  71         priv->meta_sg_valid = 0;
  72         return priv->host_tag;
  73 }
  74
  75 /**
  76  * mpi3mr_scmd_from_host_tag - Get SCSI command from host tag
  77  * @mrioc: Adapter instance reference
  78  * @host_tag: Host tag
  79  * @qidx: Operational queue index
  80  *
  81  * Identify the block tag from the host tag and queue index and
  82  * retrieve associated scsi command using scsi_host_find_tag().
  83  *
  84  * Return: SCSI command reference or NULL.
  85  */
  86 static struct scsi_cmnd *mpi3mr_scmd_from_host_tag(
  87         struct mpi3mr_ioc *mrioc, u16 host_tag, u16 qidx)
  88 {
  89         struct scsi_cmnd *scmd = NULL;
  90         struct scmd_priv *priv = NULL;
  91         u32 unique_tag = host_tag - 1;
  92
  93         if (WARN_ON(host_tag > mrioc->max_host_ios))
  94                 goto out;
  95
  96         unique_tag |= (qidx << BLK_MQ_UNIQUE_TAG_BITS);
  97
  98         scmd = scsi_host_find_tag(mrioc->shost, unique_tag);
  99         if (scmd) {
 100                 priv = scsi_cmd_priv(scmd);
 101                 if (!priv->in_lld_scope)
 102                         scmd = NULL;
 103         }
 104 out:
 105         return scmd;
 106 }
 107
 108 /**
 109  * mpi3mr_clear_scmd_priv - Cleanup SCSI command private date
 110  * @mrioc: Adapter instance reference
 111  * @scmd: SCSI command reference
 112  *
 113  * Invalidate the SCSI command private data to mark the command
 114  * is not in LLD scope anymore.
 115  *
 116  * Return: Nothing.
 117  */
 118 static void mpi3mr_clear_scmd_priv(struct mpi3mr_ioc *mrioc,
 119         struct scsi_cmnd *scmd)
 120 {
 121         struct scmd_priv *priv = NULL;
 122
 123         priv = scsi_cmd_priv(scmd);
 124
 125         if (WARN_ON(priv->in_lld_scope == 0))
 126                 return;
 127         priv->host_tag = MPI3MR_HOSTTAG_INVALID;
 128         priv->req_q_idx = 0xFFFF;
 129         priv->scmd = NULL;
 130         priv->in_lld_scope = 0;
 131         priv->meta_sg_valid = 0;
 132         if (priv->chain_idx >= 0) {
 133                 clear_bit(priv->chain_idx, mrioc->chain_bitmap);
 134                 priv->chain_idx = -1;
 135         }
 136         if (priv->meta_chain_idx >= 0) {
 137                 clear_bit(priv->meta_chain_idx, mrioc->chain_bitmap);
 138                 priv->meta_chain_idx = -1;
 139         }
 140 }
 141
 142 static void mpi3mr_dev_rmhs_send_tm(struct mpi3mr_ioc *mrioc, u16 handle,
 143         struct mpi3mr_drv_cmd *cmdparam, u8 iou_rc);
 144 static void mpi3mr_fwevt_worker(struct work_struct *work);
 145
 146 /**
 147  * mpi3mr_fwevt_free - firmware event memory dealloctor
 148  * @r: k reference pointer of the firmware event
 149  *
 150  * Free firmware event memory when no reference.
 151  */
 152 static void mpi3mr_fwevt_free(struct kref *r)
 153 {
 154         kfree(container_of(r, struct mpi3mr_fwevt, ref_count));
 155 }
 156
 157 /**
 158  * mpi3mr_fwevt_get - k reference incrementor
 159  * @fwevt: Firmware event reference
 160  *
 161  * Increment firmware event reference count.
 162  */
 163 static void mpi3mr_fwevt_get(struct mpi3mr_fwevt *fwevt)
 164 {
 165         kref_get(&fwevt->ref_count);
 166 }
 167
 168 /**
 169  * mpi3mr_fwevt_put - k reference decrementor
 170  * @fwevt: Firmware event reference
 171  *
 172  * decrement firmware event reference count.
 173  */
 174 static void mpi3mr_fwevt_put(struct mpi3mr_fwevt *fwevt)
 175 {
 176         kref_put(&fwevt->ref_count, mpi3mr_fwevt_free);
 177 }
 178
 179 /**
 180  * mpi3mr_alloc_fwevt - Allocate firmware event
 181  * @len: length of firmware event data to allocate
 182  *
 183  * Allocate firmware event with required length and initialize
 184  * the reference counter.
 185  *
 186  * Return: firmware event reference.
 187  */
 188 static struct mpi3mr_fwevt *mpi3mr_alloc_fwevt(int len)
 189 {
 190         struct mpi3mr_fwevt *fwevt;
 191
 192         fwevt = kzalloc(sizeof(*fwevt) + len, GFP_ATOMIC);
 193         if (!fwevt)
 194                 return NULL;
 195
 196         kref_init(&fwevt->ref_count);
 197         return fwevt;
 198 }
 199
 200 /**
 201  * mpi3mr_fwevt_add_to_list - Add firmware event to the list
 202  * @mrioc: Adapter instance reference
 203  * @fwevt: Firmware event reference
 204  *
 205  * Add the given firmware event to the firmware event list.
 206  *
 207  * Return: Nothing.
 208  */
 209 static void mpi3mr_fwevt_add_to_list(struct mpi3mr_ioc *mrioc,
 210         struct mpi3mr_fwevt *fwevt)
 211 {
 212         unsigned long flags;
 213
 214         if (!mrioc->fwevt_worker_thread)
 215                 return;
 216
 217         spin_lock_irqsave(&mrioc->fwevt_lock, flags);
 218         /* get fwevt reference count while adding it to fwevt_list */
 219         mpi3mr_fwevt_get(fwevt);
 220         INIT_LIST_HEAD(&fwevt->list);
 221         list_add_tail(&fwevt->list, &mrioc->fwevt_list);
 222         INIT_WORK(&fwevt->work, mpi3mr_fwevt_worker);
 223         /* get fwevt reference count while enqueueing it to worker queue */
 224         mpi3mr_fwevt_get(fwevt);
 225         queue_work(mrioc->fwevt_worker_thread, &fwevt->work);
 226         spin_unlock_irqrestore(&mrioc->fwevt_lock, flags);
 227 }
 228
 229 /**
 230  * mpi3mr_fwevt_del_from_list - Delete firmware event from list
 231  * @mrioc: Adapter instance reference
 232  * @fwevt: Firmware event reference
 233  *
 234  * Delete the given firmware event from the firmware event list.
 235  *
 236  * Return: Nothing.
 237  */
 238 static void mpi3mr_fwevt_del_from_list(struct mpi3mr_ioc *mrioc,
 239         struct mpi3mr_fwevt *fwevt)
 240 {
 241         unsigned long flags;
 242
 243         spin_lock_irqsave(&mrioc->fwevt_lock, flags);
 244         if (!list_empty(&fwevt->list)) {
 245                 list_del_init(&fwevt->list);
 246                 /*
 247                  * Put fwevt reference count after
 248                  * removing it from fwevt_list
 249                  */
 250                 mpi3mr_fwevt_put(fwevt);
 251         }
 252         spin_unlock_irqrestore(&mrioc->fwevt_lock, flags);
 253 }
 254
 255 /**
 256  * mpi3mr_dequeue_fwevt - Dequeue firmware event from the list
 257  * @mrioc: Adapter instance reference
 258  *
 259  * Dequeue a firmware event from the firmware event list.
 260  *
 261  * Return: firmware event.
 262  */
 263 static struct mpi3mr_fwevt *mpi3mr_dequeue_fwevt(
 264         struct mpi3mr_ioc *mrioc)
 265 {
 266         unsigned long flags;
 267         struct mpi3mr_fwevt *fwevt = NULL;
 268
 269         spin_lock_irqsave(&mrioc->fwevt_lock, flags);
 270         if (!list_empty(&mrioc->fwevt_list)) {
 271                 fwevt = list_first_entry(&mrioc->fwevt_list,
 272                     struct mpi3mr_fwevt, list);
 273                 list_del_init(&fwevt->list);
 274                 /*
 275                  * Put fwevt reference count after
 276                  * removing it from fwevt_list
 277                  */
 278                 mpi3mr_fwevt_put(fwevt);
 279         }
 280         spin_unlock_irqrestore(&mrioc->fwevt_lock, flags);
 281
 282         return fwevt;
 283 }
 284
 285 /**
 286  * mpi3mr_cleanup_fwevt_list - Cleanup firmware event list
 287  * @mrioc: Adapter instance reference
 288  *
 289  * Flush all pending firmware events from the firmware event
 290  * list.
 291  *
 292  * Return: Nothing.
 293  */
 294 void mpi3mr_cleanup_fwevt_list(struct mpi3mr_ioc *mrioc)
 295 {
 296         struct mpi3mr_fwevt *fwevt = NULL;
 297
 298         if ((list_empty(&mrioc->fwevt_list) && !mrioc->current_event) ||
 299             !mrioc->fwevt_worker_thread)
 300                 return;
 301
 302         while ((fwevt = mpi3mr_dequeue_fwevt(mrioc)) ||
 303             (fwevt = mrioc->current_event)) {
 304                 /*
 305                  * Wait on the fwevt to complete. If this returns 1, then
 306                  * the event was never executed, and we need a put for the
 307                  * reference the work had on the fwevt.
 308                  *
 309                  * If it did execute, we wait for it to finish, and the put will
 310                  * happen from mpi3mr_process_fwevt()
 311                  */
 312                 if (cancel_work_sync(&fwevt->work)) {
 313                         /*
 314                          * Put fwevt reference count after
 315                          * dequeuing it from worker queue
 316                          */
 317                         mpi3mr_fwevt_put(fwevt);
 318                         /*
 319                          * Put fwevt reference count to neutralize
 320                          * kref_init increment
 321                          */
 322                         mpi3mr_fwevt_put(fwevt);
 323                 }
 324         }
 325 }
 326
 327 /**
 328  * mpi3mr_invalidate_devhandles -Invalidate device handles
 329  * @mrioc: Adapter instance reference
 330  *
 331  * Invalidate the device handles in the target device structures
 332  * . Called post reset prior to reinitializing the controller.
 333  *
 334  * Return: Nothing.
 335  */
 336 void mpi3mr_invalidate_devhandles(struct mpi3mr_ioc *mrioc)
 337 {
 338         struct mpi3mr_tgt_dev *tgtdev;
 339         struct mpi3mr_stgt_priv_data *tgt_priv;
 340
 341         list_for_each_entry(tgtdev, &mrioc->tgtdev_list, list) {
 342                 tgtdev->dev_handle = MPI3MR_INVALID_DEV_HANDLE;
 343                 if (tgtdev->starget && tgtdev->starget->hostdata) {
 344                         tgt_priv = tgtdev->starget->hostdata;
 345                         tgt_priv->dev_handle = MPI3MR_INVALID_DEV_HANDLE;
 346                 }
 347         }
 348 }
 349
 350 /**
 351  * mpi3mr_print_scmd - print individual SCSI command
 352  * @rq: Block request
 353  * @data: Adapter instance reference
 354  * @reserved: N/A. Currently not used
 355  *
 356  * Print the SCSI command details if it is in LLD scope.
 357  *
 358  * Return: true always.
 359  */
 360 static bool mpi3mr_print_scmd(struct request *rq,
 361         void *data, bool reserved)
 362 {
 363         struct mpi3mr_ioc *mrioc = (struct mpi3mr_ioc *)data;
 364         struct scsi_cmnd *scmd = blk_mq_rq_to_pdu(rq);
 365         struct scmd_priv *priv = NULL;
 366
 367         if (scmd) {
 368                 priv = scsi_cmd_priv(scmd);
 369                 if (!priv->in_lld_scope)
 370                         goto out;
 371
 372                 ioc_info(mrioc, "%s :Host Tag = %d, qid = %d\n",
 373                     __func__, priv->host_tag, priv->req_q_idx + 1);
 374                 scsi_print_command(scmd);
 375         }
 376
 377 out:
 378         return(true);
 379 }
 380
 381 /**
 382  * mpi3mr_flush_scmd - Flush individual SCSI command
 383  * @rq: Block request
 384  * @data: Adapter instance reference
 385  * @reserved: N/A. Currently not used
 386  *
 387  * Return the SCSI command to the upper layers if it is in LLD
 388  * scope.
 389  *
 390  * Return: true always.
 391  */
 392
 393 static bool mpi3mr_flush_scmd(struct request *rq,
 394         void *data, bool reserved)
 395 {
 396         struct mpi3mr_ioc *mrioc = (struct mpi3mr_ioc *)data;
 397         struct scsi_cmnd *scmd = blk_mq_rq_to_pdu(rq);
 398         struct scmd_priv *priv = NULL;
 399
 400         if (scmd) {
 401                 priv = scsi_cmd_priv(scmd);
 402                 if (!priv->in_lld_scope)
 403                         goto out;
 404
 405                 if (priv->meta_sg_valid)
 406                         dma_unmap_sg(&mrioc->pdev->dev, scsi_prot_sglist(scmd),
 407                             scsi_prot_sg_count(scmd), scmd->sc_data_direction);
 408                 mpi3mr_clear_scmd_priv(mrioc, scmd);
 409                 scsi_dma_unmap(scmd);
 410                 scmd->result = DID_RESET << 16;
 411                 scsi_print_command(scmd);
 412                 scsi_done(scmd);
 413                 mrioc->flush_io_count++;
 414         }
 415
 416 out:
 417         return(true);
 418 }
 419
 420 /**
 421  * mpi3mr_flush_host_io -  Flush host I/Os
 422  * @mrioc: Adapter instance reference
 423  *
 424  * Flush all of the pending I/Os by calling
 425  * blk_mq_tagset_busy_iter() for each possible tag. This is
 426  * executed post controller reset
 427  *
 428  * Return: Nothing.
 429  */
 430 void mpi3mr_flush_host_io(struct mpi3mr_ioc *mrioc)
 431 {
 432         struct Scsi_Host *shost = mrioc->shost;
 433
 434         mrioc->flush_io_count = 0;
 435         ioc_info(mrioc, "%s :Flushing Host I/O cmds post reset\n", __func__);
 436         blk_mq_tagset_busy_iter(&shost->tag_set,
 437             mpi3mr_flush_scmd, (void *)mrioc);
 438         ioc_info(mrioc, "%s :Flushed %d Host I/O cmds\n", __func__,
 439             mrioc->flush_io_count);
 440 }
 441
 442 /**
 443  * mpi3mr_alloc_tgtdev - target device allocator
 444  *
 445  * Allocate target device instance and initialize the reference
 446  * count
 447  *
 448  * Return: target device instance.
 449  */
 450 static struct mpi3mr_tgt_dev *mpi3mr_alloc_tgtdev(void)
 451 {
 452         struct mpi3mr_tgt_dev *tgtdev;
 453
 454         tgtdev = kzalloc(sizeof(*tgtdev), GFP_ATOMIC);
 455         if (!tgtdev)
 456                 return NULL;
 457         kref_init(&tgtdev->ref_count);
 458         return tgtdev;
 459 }
 460
 461 /**
 462  * mpi3mr_tgtdev_add_to_list -Add tgtdevice to the list
 463  * @mrioc: Adapter instance reference
 464  * @tgtdev: Target device
 465  *
 466  * Add the target device to the target device list
 467  *
 468  * Return: Nothing.
 469  */
 470 static void mpi3mr_tgtdev_add_to_list(struct mpi3mr_ioc *mrioc,
 471         struct mpi3mr_tgt_dev *tgtdev)
 472 {
 473         unsigned long flags;
 474
 475         spin_lock_irqsave(&mrioc->tgtdev_lock, flags);
 476         mpi3mr_tgtdev_get(tgtdev);
 477         INIT_LIST_HEAD(&tgtdev->list);
 478         list_add_tail(&tgtdev->list, &mrioc->tgtdev_list);
 479         spin_unlock_irqrestore(&mrioc->tgtdev_lock, flags);
 480 }
 481
 482 /**
 483  * mpi3mr_tgtdev_del_from_list -Delete tgtdevice from the list
 484  * @mrioc: Adapter instance reference
 485  * @tgtdev: Target device
 486  *
 487  * Remove the target device from the target device list
 488  *
 489  * Return: Nothing.
 490  */
 491 static void mpi3mr_tgtdev_del_from_list(struct mpi3mr_ioc *mrioc,
 492         struct mpi3mr_tgt_dev *tgtdev)
 493 {
 494         unsigned long flags;
 495
 496         spin_lock_irqsave(&mrioc->tgtdev_lock, flags);
 497         if (!list_empty(&tgtdev->list)) {
 498                 list_del_init(&tgtdev->list);
 499                 mpi3mr_tgtdev_put(tgtdev);
 500         }
 501         spin_unlock_irqrestore(&mrioc->tgtdev_lock, flags);
 502 }
 503
 504 /**
 505  * __mpi3mr_get_tgtdev_by_handle -Get tgtdev from device handle
 506  * @mrioc: Adapter instance reference
 507  * @handle: Device handle
 508  *
 509  * Accessor to retrieve target device from the device handle.
 510  * Non Lock version
 511  *
 512  * Return: Target device reference.
 513  */
 514 static struct mpi3mr_tgt_dev  *__mpi3mr_get_tgtdev_by_handle(
 515         struct mpi3mr_ioc *mrioc, u16 handle)
 516 {
 517         struct mpi3mr_tgt_dev *tgtdev;
 518
 519         assert_spin_locked(&mrioc->tgtdev_lock);
 520         list_for_each_entry(tgtdev, &mrioc->tgtdev_list, list)
 521                 if (tgtdev->dev_handle == handle)
 522                         goto found_tgtdev;
 523         return NULL;
 524
 525 found_tgtdev:
 526         mpi3mr_tgtdev_get(tgtdev);
 527         return tgtdev;
 528 }
 529
 530 /**
 531  * mpi3mr_get_tgtdev_by_handle -Get tgtdev from device handle
 532  * @mrioc: Adapter instance reference
 533  * @handle: Device handle
 534  *
 535  * Accessor to retrieve target device from the device handle.
 536  * Lock version
 537  *
 538  * Return: Target device reference.
 539  */
 540 static struct mpi3mr_tgt_dev *mpi3mr_get_tgtdev_by_handle(
 541         struct mpi3mr_ioc *mrioc, u16 handle)
 542 {
 543         struct mpi3mr_tgt_dev *tgtdev;
 544         unsigned long flags;
 545
 546         spin_lock_irqsave(&mrioc->tgtdev_lock, flags);
 547         tgtdev = __mpi3mr_get_tgtdev_by_handle(mrioc, handle);
 548         spin_unlock_irqrestore(&mrioc->tgtdev_lock, flags);
 549         return tgtdev;
 550 }
 551
 552 /**
 553  * __mpi3mr_get_tgtdev_by_perst_id -Get tgtdev from persist ID
 554  * @mrioc: Adapter instance reference
 555  * @persist_id: Persistent ID
 556  *
 557  * Accessor to retrieve target device from the Persistent ID.
 558  * Non Lock version
 559  *
 560  * Return: Target device reference.
 561  */
 562 static struct mpi3mr_tgt_dev  *__mpi3mr_get_tgtdev_by_perst_id(
 563         struct mpi3mr_ioc *mrioc, u16 persist_id)
 564 {
 565         struct mpi3mr_tgt_dev *tgtdev;
 566
 567         assert_spin_locked(&mrioc->tgtdev_lock);
 568         list_for_each_entry(tgtdev, &mrioc->tgtdev_list, list)
 569                 if (tgtdev->perst_id == persist_id)
 570                         goto found_tgtdev;
 571         return NULL;
 572
 573 found_tgtdev:
 574         mpi3mr_tgtdev_get(tgtdev);
 575         return tgtdev;
 576 }
 577
 578 /**
 579  * mpi3mr_get_tgtdev_by_perst_id -Get tgtdev from persistent ID
 580  * @mrioc: Adapter instance reference
 581  * @persist_id: Persistent ID
 582  *
 583  * Accessor to retrieve target device from the Persistent ID.
 584  * Lock version
 585  *
 586  * Return: Target device reference.
 587  */
 588 static struct mpi3mr_tgt_dev *mpi3mr_get_tgtdev_by_perst_id(
 589         struct mpi3mr_ioc *mrioc, u16 persist_id)
 590 {
 591         struct mpi3mr_tgt_dev *tgtdev;
 592         unsigned long flags;
 593
 594         spin_lock_irqsave(&mrioc->tgtdev_lock, flags);
 595         tgtdev = __mpi3mr_get_tgtdev_by_perst_id(mrioc, persist_id);
 596         spin_unlock_irqrestore(&mrioc->tgtdev_lock, flags);
 597         return tgtdev;
 598 }
 599
 600 /**
 601  * __mpi3mr_get_tgtdev_from_tgtpriv -Get tgtdev from tgt private
 602  * @mrioc: Adapter instance reference
 603  * @tgt_priv: Target private data
 604  *
 605  * Accessor to return target device from the target private
 606  * data. Non Lock version
 607  *
 608  * Return: Target device reference.
 609  */
 610 static struct mpi3mr_tgt_dev  *__mpi3mr_get_tgtdev_from_tgtpriv(
 611         struct mpi3mr_ioc *mrioc, struct mpi3mr_stgt_priv_data *tgt_priv)
 612 {
 613         struct mpi3mr_tgt_dev *tgtdev;
 614
 615         assert_spin_locked(&mrioc->tgtdev_lock);
 616         tgtdev = tgt_priv->tgt_dev;
 617         if (tgtdev)
 618                 mpi3mr_tgtdev_get(tgtdev);
 619         return tgtdev;
 620 }
 621
 622 /**
 623  * mpi3mr_remove_tgtdev_from_host - Remove dev from upper layers
 624  * @mrioc: Adapter instance reference
 625  * @tgtdev: Target device structure
 626  *
 627  * Checks whether the device is exposed to upper layers and if it
 628  * is then remove the device from upper layers by calling
 629  * scsi_remove_target().
 630  *
 631  * Return: 0 on success, non zero on failure.
 632  */
 633 static void mpi3mr_remove_tgtdev_from_host(struct mpi3mr_ioc *mrioc,
 634         struct mpi3mr_tgt_dev *tgtdev)
 635 {
 636         struct mpi3mr_stgt_priv_data *tgt_priv;
 637
 638         ioc_info(mrioc, "%s :Removing handle(0x%04x), wwid(0x%016llx)\n",
 639             __func__, tgtdev->dev_handle, (unsigned long long)tgtdev->wwid);
 640         if (tgtdev->starget && tgtdev->starget->hostdata) {
 641                 tgt_priv = tgtdev->starget->hostdata;
 642                 tgt_priv->dev_handle = MPI3MR_INVALID_DEV_HANDLE;
 643         }
 644
 645         if (tgtdev->starget) {
 646                 scsi_remove_target(&tgtdev->starget->dev);
 647                 tgtdev->host_exposed = 0;
 648         }
 649         ioc_info(mrioc, "%s :Removed handle(0x%04x), wwid(0x%016llx)\n",
 650             __func__, tgtdev->dev_handle, (unsigned long long)tgtdev->wwid);
 651 }
 652
 653 /**
 654  * mpi3mr_report_tgtdev_to_host - Expose device to upper layers
 655  * @mrioc: Adapter instance reference
 656  * @perst_id: Persistent ID of the device
 657  *
 658  * Checks whether the device can be exposed to upper layers and
 659  * if it is not then expose the device to upper layers by
 660  * calling scsi_scan_target().
 661  *
 662  * Return: 0 on success, non zero on failure.
 663  */
 664 static int mpi3mr_report_tgtdev_to_host(struct mpi3mr_ioc *mrioc,
 665         u16 perst_id)
 666 {
 667         int retval = 0;
 668         struct mpi3mr_tgt_dev *tgtdev;
 669
 670         tgtdev = mpi3mr_get_tgtdev_by_perst_id(mrioc, perst_id);
 671         if (!tgtdev) {
 672                 retval = -1;
 673                 goto out;
 674         }
 675         if (tgtdev->is_hidden) {
 676                 retval = -1;
 677                 goto out;
 678         }
 679         if (!tgtdev->host_exposed && !mrioc->reset_in_progress) {
 680                 tgtdev->host_exposed = 1;
 681                 scsi_scan_target(&mrioc->shost->shost_gendev, 0,
 682                     tgtdev->perst_id,
 683                     SCAN_WILD_CARD, SCSI_SCAN_INITIAL);
 684                 if (!tgtdev->starget)
 685                         tgtdev->host_exposed = 0;
 686         }
 687 out:
 688         if (tgtdev)
 689                 mpi3mr_tgtdev_put(tgtdev);
 690
 691         return retval;
 692 }
 693
 694 /**
 695  * mpi3mr_change_queue_depth- Change QD callback handler
 696  * @sdev: SCSI device reference
 697  * @q_depth: Queue depth
 698  *
 699  * Validate and limit QD and call scsi_change_queue_depth.
 700  *
 701  * Return: return value of scsi_change_queue_depth
 702  */
 703 static int mpi3mr_change_queue_depth(struct scsi_device *sdev,
 704         int q_depth)
 705 {
 706         struct scsi_target *starget = scsi_target(sdev);
 707         struct Scsi_Host *shost = dev_to_shost(&starget->dev);
 708         int retval = 0;
 709
 710         if (!sdev->tagged_supported)
 711                 q_depth = 1;
 712         if (q_depth > shost->can_queue)
 713                 q_depth = shost->can_queue;
 714         else if (!q_depth)
 715                 q_depth = MPI3MR_DEFAULT_SDEV_QD;
 716         retval = scsi_change_queue_depth(sdev, q_depth);
 717
 718         return retval;
 719 }
 720
 721 /**
 722  * mpi3mr_update_sdev - Update SCSI device information
 723  * @sdev: SCSI device reference
 724  * @data: target device reference
 725  *
 726  * This is an iterator function called for each SCSI device in a
 727  * target to update the target specific information into each
 728  * SCSI device.
 729  *
 730  * Return: Nothing.
 731  */
 732 static void
 733 mpi3mr_update_sdev(struct scsi_device *sdev, void *data)
 734 {
 735         struct mpi3mr_tgt_dev *tgtdev;
 736
 737         tgtdev = (struct mpi3mr_tgt_dev *)data;
 738         if (!tgtdev)
 739                 return;
 740
 741         mpi3mr_change_queue_depth(sdev, tgtdev->q_depth);
 742         switch (tgtdev->dev_type) {
 743         case MPI3_DEVICE_DEVFORM_PCIE:
 744                 /*The block layer hw sector size = 512*/
 745                 blk_queue_max_hw_sectors(sdev->request_queue,
 746                     tgtdev->dev_spec.pcie_inf.mdts / 512);
 747                 blk_queue_virt_boundary(sdev->request_queue,
 748                     ((1 << tgtdev->dev_spec.pcie_inf.pgsz) - 1));
 749
 750                 break;
 751         default:
 752                 break;
 753         }
 754 }
 755
 756 /**
 757  * mpi3mr_rfresh_tgtdevs - Refresh target device exposure
 758  * @mrioc: Adapter instance reference
 759  *
 760  * This is executed post controller reset to identify any
 761  * missing devices during reset and remove from the upper layers
 762  * or expose any newly detected device to the upper layers.
 763  *
 764  * Return: Nothing.
 765  */
 766
 767 void mpi3mr_rfresh_tgtdevs(struct mpi3mr_ioc *mrioc)
 768 {
 769         struct mpi3mr_tgt_dev *tgtdev, *tgtdev_next;
 770
 771         list_for_each_entry_safe(tgtdev, tgtdev_next, &mrioc->tgtdev_list,
 772             list) {
 773                 if ((tgtdev->dev_handle == MPI3MR_INVALID_DEV_HANDLE) &&
 774                     tgtdev->host_exposed) {
 775                         mpi3mr_remove_tgtdev_from_host(mrioc, tgtdev);
 776                         mpi3mr_tgtdev_del_from_list(mrioc, tgtdev);
 777                         mpi3mr_tgtdev_put(tgtdev);
 778                 }
 779         }
 780
 781         tgtdev = NULL;
 782         list_for_each_entry(tgtdev, &mrioc->tgtdev_list, list) {
 783                 if ((tgtdev->dev_handle != MPI3MR_INVALID_DEV_HANDLE) &&
 784                     !tgtdev->is_hidden && !tgtdev->host_exposed)
 785                         mpi3mr_report_tgtdev_to_host(mrioc, tgtdev->perst_id);
 786         }
 787 }
 788
 789 /**
 790  * mpi3mr_update_tgtdev - DevStatusChange evt bottomhalf
 791  * @mrioc: Adapter instance reference
 792  * @tgtdev: Target device internal structure
 793  * @dev_pg0: New device page0
 794  *
 795  * Update the information from the device page0 into the driver
 796  * cached target device structure.
 797  *
 798  * Return: Nothing.
 799  */
 800 static void mpi3mr_update_tgtdev(struct mpi3mr_ioc *mrioc,
 801         struct mpi3mr_tgt_dev *tgtdev, struct mpi3_device_page0 *dev_pg0)
 802 {
 803         u16 flags = 0;
 804         struct mpi3mr_stgt_priv_data *scsi_tgt_priv_data;
 805         u8 prot_mask = 0;
 806
 807         tgtdev->perst_id = le16_to_cpu(dev_pg0->persistent_id);
 808         tgtdev->dev_handle = le16_to_cpu(dev_pg0->dev_handle);
 809         tgtdev->dev_type = dev_pg0->device_form;
 810         tgtdev->encl_handle = le16_to_cpu(dev_pg0->enclosure_handle);
 811         tgtdev->parent_handle = le16_to_cpu(dev_pg0->parent_dev_handle);
 812         tgtdev->slot = le16_to_cpu(dev_pg0->slot);
 813         tgtdev->q_depth = le16_to_cpu(dev_pg0->queue_depth);
 814         tgtdev->wwid = le64_to_cpu(dev_pg0->wwid);
 815
 816         flags = le16_to_cpu(dev_pg0->flags);
 817         tgtdev->is_hidden = (flags & MPI3_DEVICE0_FLAGS_HIDDEN);
 818
 819         if (tgtdev->starget && tgtdev->starget->hostdata) {
 820                 scsi_tgt_priv_data = (struct mpi3mr_stgt_priv_data *)
 821                     tgtdev->starget->hostdata;
 822                 scsi_tgt_priv_data->perst_id = tgtdev->perst_id;
 823                 scsi_tgt_priv_data->dev_handle = tgtdev->dev_handle;
 824                 scsi_tgt_priv_data->dev_type = tgtdev->dev_type;
 825         }
 826
 827         switch (tgtdev->dev_type) {
 828         case MPI3_DEVICE_DEVFORM_SAS_SATA:
 829         {
 830                 struct mpi3_device0_sas_sata_format *sasinf =
 831                     &dev_pg0->device_specific.sas_sata_format;
 832                 u16 dev_info = le16_to_cpu(sasinf->device_info);
 833
 834                 tgtdev->dev_spec.sas_sata_inf.dev_info = dev_info;
 835                 tgtdev->dev_spec.sas_sata_inf.sas_address =
 836                     le64_to_cpu(sasinf->sas_address);
 837                 if ((dev_info & MPI3_SAS_DEVICE_INFO_DEVICE_TYPE_MASK) !=
 838                     MPI3_SAS_DEVICE_INFO_DEVICE_TYPE_END_DEVICE)
 839                         tgtdev->is_hidden = 1;
 840                 else if (!(dev_info & (MPI3_SAS_DEVICE_INFO_STP_SATA_TARGET |
 841                     MPI3_SAS_DEVICE_INFO_SSP_TARGET)))
 842                         tgtdev->is_hidden = 1;
 843                 break;
 844         }
 845         case MPI3_DEVICE_DEVFORM_PCIE:
 846         {
 847                 struct mpi3_device0_pcie_format *pcieinf =
 848                     &dev_pg0->device_specific.pcie_format;
 849                 u16 dev_info = le16_to_cpu(pcieinf->device_info);
 850
 851                 tgtdev->dev_spec.pcie_inf.capb =
 852                     le32_to_cpu(pcieinf->capabilities);
 853                 tgtdev->dev_spec.pcie_inf.mdts = MPI3MR_DEFAULT_MDTS;
 854                 /* 2^12 = 4096 */
 855                 tgtdev->dev_spec.pcie_inf.pgsz = 12;
 856                 if (dev_pg0->access_status == MPI3_DEVICE0_ASTATUS_NO_ERRORS) {
 857                         tgtdev->dev_spec.pcie_inf.mdts =
 858                             le32_to_cpu(pcieinf->maximum_data_transfer_size);
 859                         tgtdev->dev_spec.pcie_inf.pgsz = pcieinf->page_size;
 860                         tgtdev->dev_spec.pcie_inf.reset_to =
 861                             pcieinf->controller_reset_to;
 862                         tgtdev->dev_spec.pcie_inf.abort_to =
 863                             pcieinf->nv_me_abort_to;
 864                 }
 865                 if (tgtdev->dev_spec.pcie_inf.mdts > (1024 * 1024))
 866                         tgtdev->dev_spec.pcie_inf.mdts = (1024 * 1024);
 867                 if ((dev_info & MPI3_DEVICE0_PCIE_DEVICE_INFO_TYPE_MASK) !=
 868                     MPI3_DEVICE0_PCIE_DEVICE_INFO_TYPE_NVME_DEVICE)
 869                         tgtdev->is_hidden = 1;
 870                 if (!mrioc->shost)
 871                         break;
 872                 prot_mask = scsi_host_get_prot(mrioc->shost);
 873                 if (prot_mask & SHOST_DIX_TYPE0_PROTECTION) {
 874                         scsi_host_set_prot(mrioc->shost, prot_mask & 0x77);
 875                         ioc_info(mrioc,
 876                             "%s : Disabling DIX0 prot capability\n", __func__);
 877                         ioc_info(mrioc,
 878                             "because HBA does not support DIX0 operation on NVME drives\n");
 879                 }
 880                 break;
 881         }
 882         case MPI3_DEVICE_DEVFORM_VD:
 883         {
 884                 struct mpi3_device0_vd_format *vdinf =
 885                     &dev_pg0->device_specific.vd_format;
 886
 887                 tgtdev->dev_spec.vol_inf.state = vdinf->vd_state;
 888                 if (vdinf->vd_state == MPI3_DEVICE0_VD_STATE_OFFLINE)
 889                         tgtdev->is_hidden = 1;
 890                 break;
 891         }
 892         default:
 893                 break;
 894         }
 895 }
 896
 897 /**
 898  * mpi3mr_devstatuschg_evt_bh - DevStatusChange evt bottomhalf
 899  * @mrioc: Adapter instance reference
 900  * @fwevt: Firmware event information.
 901  *
 902  * Process Device status Change event and based on device's new
 903  * information, either expose the device to the upper layers, or
 904  * remove the device from upper layers.
 905  *
 906  * Return: Nothing.
 907  */
 908 static void mpi3mr_devstatuschg_evt_bh(struct mpi3mr_ioc *mrioc,
 909         struct mpi3mr_fwevt *fwevt)
 910 {
 911         u16 dev_handle = 0;
 912         u8 uhide = 0, delete = 0, cleanup = 0;
 913         struct mpi3mr_tgt_dev *tgtdev = NULL;
 914         struct mpi3_event_data_device_status_change *evtdata =
 915             (struct mpi3_event_data_device_status_change *)fwevt->event_data;
 916
 917         dev_handle = le16_to_cpu(evtdata->dev_handle);
 918         ioc_info(mrioc,
 919             "%s :device status change: handle(0x%04x): reason code(0x%x)\n",
 920             __func__, dev_handle, evtdata->reason_code);
 921         switch (evtdata->reason_code) {
 922         case MPI3_EVENT_DEV_STAT_RC_HIDDEN:
 923                 delete = 1;
 924                 break;
 925         case MPI3_EVENT_DEV_STAT_RC_NOT_HIDDEN:
 926                 uhide = 1;
 927                 break;
 928         case MPI3_EVENT_DEV_STAT_RC_VD_NOT_RESPONDING:
 929                 delete = 1;
 930                 cleanup = 1;
 931                 break;
 932         default:
 933                 ioc_info(mrioc, "%s :Unhandled reason code(0x%x)\n", __func__,
 934                     evtdata->reason_code);
 935                 break;
 936         }
 937
 938         tgtdev = mpi3mr_get_tgtdev_by_handle(mrioc, dev_handle);
 939         if (!tgtdev)
 940                 goto out;
 941         if (uhide) {
 942                 tgtdev->is_hidden = 0;
 943                 if (!tgtdev->host_exposed)
 944                         mpi3mr_report_tgtdev_to_host(mrioc, tgtdev->perst_id);
 945         }
 946         if (tgtdev->starget && tgtdev->starget->hostdata) {
 947                 if (delete)
 948                         mpi3mr_remove_tgtdev_from_host(mrioc, tgtdev);
 949         }
 950         if (cleanup) {
 951                 mpi3mr_tgtdev_del_from_list(mrioc, tgtdev);
 952                 mpi3mr_tgtdev_put(tgtdev);
 953         }
 954
 955 out:
 956         if (tgtdev)
 957                 mpi3mr_tgtdev_put(tgtdev);
 958 }
 959
 960 /**
 961  * mpi3mr_devinfochg_evt_bh - DeviceInfoChange evt bottomhalf
 962  * @mrioc: Adapter instance reference
 963  * @dev_pg0: New device page0
 964  *
 965  * Process Device Info Change event and based on device's new
 966  * information, either expose the device to the upper layers, or
 967  * remove the device from upper layers or update the details of
 968  * the device.
 969  *
 970  * Return: Nothing.
 971  */
 972 static void mpi3mr_devinfochg_evt_bh(struct mpi3mr_ioc *mrioc,
 973         struct mpi3_device_page0 *dev_pg0)
 974 {
 975         struct mpi3mr_tgt_dev *tgtdev = NULL;
 976         u16 dev_handle = 0, perst_id = 0;
 977
 978         perst_id = le16_to_cpu(dev_pg0->persistent_id);
 979         dev_handle = le16_to_cpu(dev_pg0->dev_handle);
 980         ioc_info(mrioc,
 981             "%s :Device info change: handle(0x%04x): persist_id(0x%x)\n",
 982             __func__, dev_handle, perst_id);
 983         tgtdev = mpi3mr_get_tgtdev_by_handle(mrioc, dev_handle);
 984         if (!tgtdev)
 985                 goto out;
 986         mpi3mr_update_tgtdev(mrioc, tgtdev, dev_pg0);
 987         if (!tgtdev->is_hidden && !tgtdev->host_exposed)
 988                 mpi3mr_report_tgtdev_to_host(mrioc, perst_id);
 989         if (tgtdev->is_hidden && tgtdev->host_exposed)
 990                 mpi3mr_remove_tgtdev_from_host(mrioc, tgtdev);
 991         if (!tgtdev->is_hidden && tgtdev->host_exposed && tgtdev->starget)
 992                 starget_for_each_device(tgtdev->starget, (void *)tgtdev,
 993                     mpi3mr_update_sdev);
 994 out:
 995         if (tgtdev)
 996                 mpi3mr_tgtdev_put(tgtdev);
 997 }
 998
 999 /**
1000  * mpi3mr_sastopochg_evt_debug - SASTopoChange details
1001  * @mrioc: Adapter instance reference
1002  * @event_data: SAS topology change list event data
1003  *
1004  * Prints information about the SAS topology change event.
1005  *
1006  * Return: Nothing.
1007  */
1008 static void
1009 mpi3mr_sastopochg_evt_debug(struct mpi3mr_ioc *mrioc,
1010         struct mpi3_event_data_sas_topology_change_list *event_data)
1011 {
1012         int i;
1013         u16 handle;
1014         u8 reason_code, phy_number;
1015         char *status_str = NULL;
1016         u8 link_rate, prev_link_rate;
1017
1018         switch (event_data->exp_status) {
1019         case MPI3_EVENT_SAS_TOPO_ES_NOT_RESPONDING:
1020                 status_str = "remove";
1021                 break;
1022         case MPI3_EVENT_SAS_TOPO_ES_RESPONDING:
1023                 status_str =  "responding";
1024                 break;
1025         case MPI3_EVENT_SAS_TOPO_ES_DELAY_NOT_RESPONDING:
1026                 status_str = "remove delay";
1027                 break;
1028         case MPI3_EVENT_SAS_TOPO_ES_NO_EXPANDER:
1029                 status_str = "direct attached";
1030                 break;
1031         default:
1032                 status_str = "unknown status";
1033                 break;
1034         }
1035         ioc_info(mrioc, "%s :sas topology change: (%s)\n",
1036             __func__, status_str);
1037         ioc_info(mrioc,
1038             "%s :\texpander_handle(0x%04x), enclosure_handle(0x%04x) start_phy(%02d), num_entries(%d)\n",
1039             __func__, le16_to_cpu(event_data->expander_dev_handle),
1040             le16_to_cpu(event_data->enclosure_handle),
1041             event_data->start_phy_num, event_data->num_entries);
1042         for (i = 0; i < event_data->num_entries; i++) {
1043                 handle = le16_to_cpu(event_data->phy_entry[i].attached_dev_handle);
1044                 if (!handle)
1045                         continue;
1046                 phy_number = event_data->start_phy_num + i;
1047                 reason_code = event_data->phy_entry[i].status &
1048                     MPI3_EVENT_SAS_TOPO_PHY_RC_MASK;
1049                 switch (reason_code) {
1050                 case MPI3_EVENT_SAS_TOPO_PHY_RC_TARG_NOT_RESPONDING:
1051                         status_str = "target remove";
1052                         break;
1053                 case MPI3_EVENT_SAS_TOPO_PHY_RC_DELAY_NOT_RESPONDING:
1054                         status_str = "delay target remove";
1055                         break;
1056                 case MPI3_EVENT_SAS_TOPO_PHY_RC_PHY_CHANGED:
1057                         status_str = "link status change";
1058                         break;
1059                 case MPI3_EVENT_SAS_TOPO_PHY_RC_NO_CHANGE:
1060                         status_str = "link status no change";
1061                         break;
1062                 case MPI3_EVENT_SAS_TOPO_PHY_RC_RESPONDING:
1063                         status_str = "target responding";
1064                         break;
1065                 default:
1066                         status_str = "unknown";
1067                         break;
1068                 }
1069                 link_rate = event_data->phy_entry[i].link_rate >> 4;
1070                 prev_link_rate = event_data->phy_entry[i].link_rate & 0xF;
1071                 ioc_info(mrioc,
1072                     "%s :\tphy(%02d), attached_handle(0x%04x): %s: link rate: new(0x%02x), old(0x%02x)\n",
1073                     __func__, phy_number, handle, status_str, link_rate,
1074                     prev_link_rate);
1075         }
1076 }
1077
1078 /**
1079  * mpi3mr_sastopochg_evt_bh - SASTopologyChange evt bottomhalf
1080  * @mrioc: Adapter instance reference
1081  * @fwevt: Firmware event reference
1082  *
1083  * Prints information about the SAS topology change event and
1084  * for "not responding" event code, removes the device from the
1085  * upper layers.
1086  *
1087  * Return: Nothing.
1088  */
1089 static void mpi3mr_sastopochg_evt_bh(struct mpi3mr_ioc *mrioc,
1090         struct mpi3mr_fwevt *fwevt)
1091 {
1092         struct mpi3_event_data_sas_topology_change_list *event_data =
1093             (struct mpi3_event_data_sas_topology_change_list *)fwevt->event_data;
1094         int i;
1095         u16 handle;
1096         u8 reason_code;
1097         struct mpi3mr_tgt_dev *tgtdev = NULL;
1098
1099         mpi3mr_sastopochg_evt_debug(mrioc, event_data);
1100
1101         for (i = 0; i < event_data->num_entries; i++) {
1102                 handle = le16_to_cpu(event_data->phy_entry[i].attached_dev_handle);
1103                 if (!handle)
1104                         continue;
1105                 tgtdev = mpi3mr_get_tgtdev_by_handle(mrioc, handle);
1106                 if (!tgtdev)
1107                         continue;
1108
1109                 reason_code = event_data->phy_entry[i].status &
1110                     MPI3_EVENT_SAS_TOPO_PHY_RC_MASK;
1111
1112                 switch (reason_code) {
1113                 case MPI3_EVENT_SAS_TOPO_PHY_RC_TARG_NOT_RESPONDING:
1114                         if (tgtdev->host_exposed)
1115                                 mpi3mr_remove_tgtdev_from_host(mrioc, tgtdev);
1116                         mpi3mr_tgtdev_del_from_list(mrioc, tgtdev);
1117                         mpi3mr_tgtdev_put(tgtdev);
1118                         break;
1119                 default:
1120                         break;
1121                 }
1122                 if (tgtdev)
1123                         mpi3mr_tgtdev_put(tgtdev);
1124         }
1125 }
1126
1127 /**
1128  * mpi3mr_pcietopochg_evt_debug - PCIeTopoChange details
1129  * @mrioc: Adapter instance reference
1130  * @event_data: PCIe topology change list event data
1131  *
1132  * Prints information about the PCIe topology change event.
1133  *
1134  * Return: Nothing.
1135  */
1136 static void
1137 mpi3mr_pcietopochg_evt_debug(struct mpi3mr_ioc *mrioc,
1138         struct mpi3_event_data_pcie_topology_change_list *event_data)
1139 {
1140         int i;
1141         u16 handle;
1142         u16 reason_code;
1143         u8 port_number;
1144         char *status_str = NULL;
1145         u8 link_rate, prev_link_rate;
1146
1147         switch (event_data->switch_status) {
1148         case MPI3_EVENT_PCIE_TOPO_SS_NOT_RESPONDING:
1149                 status_str = "remove";
1150                 break;
1151         case MPI3_EVENT_PCIE_TOPO_SS_RESPONDING:
1152                 status_str =  "responding";
1153                 break;
1154         case MPI3_EVENT_PCIE_TOPO_SS_DELAY_NOT_RESPONDING:
1155                 status_str = "remove delay";
1156                 break;
1157         case MPI3_EVENT_PCIE_TOPO_SS_NO_PCIE_SWITCH:
1158                 status_str = "direct attached";
1159                 break;
1160         default:
1161                 status_str = "unknown status";
1162                 break;
1163         }
1164         ioc_info(mrioc, "%s :pcie topology change: (%s)\n",
1165             __func__, status_str);
1166         ioc_info(mrioc,
1167             "%s :\tswitch_handle(0x%04x), enclosure_handle(0x%04x) start_port(%02d), num_entries(%d)\n",
1168             __func__, le16_to_cpu(event_data->switch_dev_handle),
1169             le16_to_cpu(event_data->enclosure_handle),
1170             event_data->start_port_num, event_data->num_entries);
1171         for (i = 0; i < event_data->num_entries; i++) {
1172                 handle =
1173                     le16_to_cpu(event_data->port_entry[i].attached_dev_handle);
1174                 if (!handle)
1175                         continue;
1176                 port_number = event_data->start_port_num + i;
1177                 reason_code = event_data->port_entry[i].port_status;
1178                 switch (reason_code) {
1179                 case MPI3_EVENT_PCIE_TOPO_PS_NOT_RESPONDING:
1180                         status_str = "target remove";
1181                         break;
1182                 case MPI3_EVENT_PCIE_TOPO_PS_DELAY_NOT_RESPONDING:
1183                         status_str = "delay target remove";
1184                         break;
1185                 case MPI3_EVENT_PCIE_TOPO_PS_PORT_CHANGED:
1186                         status_str = "link status change";
1187                         break;
1188                 case MPI3_EVENT_PCIE_TOPO_PS_NO_CHANGE:
1189                         status_str = "link status no change";
1190                         break;
1191                 case MPI3_EVENT_PCIE_TOPO_PS_RESPONDING:
1192                         status_str = "target responding";
1193                         break;
1194                 default:
1195                         status_str = "unknown";
1196                         break;
1197                 }
1198                 link_rate = event_data->port_entry[i].current_port_info &
1199                     MPI3_EVENT_PCIE_TOPO_PI_RATE_MASK;
1200                 prev_link_rate = event_data->port_entry[i].previous_port_info &
1201                     MPI3_EVENT_PCIE_TOPO_PI_RATE_MASK;
1202                 ioc_info(mrioc,
1203                     "%s :\tport(%02d), attached_handle(0x%04x): %s: link rate: new(0x%02x), old(0x%02x)\n",
1204                     __func__, port_number, handle, status_str, link_rate,
1205                     prev_link_rate);
1206         }
1207 }
1208
1209 /**
1210  * mpi3mr_pcietopochg_evt_bh - PCIeTopologyChange evt bottomhalf
1211  * @mrioc: Adapter instance reference
1212  * @fwevt: Firmware event reference
1213  *
1214  * Prints information about the PCIe topology change event and
1215  * for "not responding" event code, removes the device from the
1216  * upper layers.
1217  *
1218  * Return: Nothing.
1219  */
1220 static void mpi3mr_pcietopochg_evt_bh(struct mpi3mr_ioc *mrioc,
1221         struct mpi3mr_fwevt *fwevt)
1222 {
1223         struct mpi3_event_data_pcie_topology_change_list *event_data =
1224             (struct mpi3_event_data_pcie_topology_change_list *)fwevt->event_data;
1225         int i;
1226         u16 handle;
1227         u8 reason_code;
1228         struct mpi3mr_tgt_dev *tgtdev = NULL;
1229
1230         mpi3mr_pcietopochg_evt_debug(mrioc, event_data);
1231
1232         for (i = 0; i < event_data->num_entries; i++) {
1233                 handle =
1234                     le16_to_cpu(event_data->port_entry[i].attached_dev_handle);
1235                 if (!handle)
1236                         continue;
1237                 tgtdev = mpi3mr_get_tgtdev_by_handle(mrioc, handle);
1238                 if (!tgtdev)
1239                         continue;
1240
1241                 reason_code = event_data->port_entry[i].port_status;
1242
1243                 switch (reason_code) {
1244                 case MPI3_EVENT_PCIE_TOPO_PS_NOT_RESPONDING:
1245                         if (tgtdev->host_exposed)
1246                                 mpi3mr_remove_tgtdev_from_host(mrioc, tgtdev);
1247                         mpi3mr_tgtdev_del_from_list(mrioc, tgtdev);
1248                         mpi3mr_tgtdev_put(tgtdev);
1249                         break;
1250                 default:
1251                         break;
1252                 }
1253                 if (tgtdev)
1254                         mpi3mr_tgtdev_put(tgtdev);
1255         }
1256 }
1257
1258 /**
1259  * mpi3mr_fwevt_bh - Firmware event bottomhalf handler
1260  * @mrioc: Adapter instance reference
1261  * @fwevt: Firmware event reference
1262  *
1263  * Identifies the firmware event and calls corresponding bottomg
1264  * half handler and sends event acknowledgment if required.
1265  *
1266  * Return: Nothing.
1267  */
1268 static void mpi3mr_fwevt_bh(struct mpi3mr_ioc *mrioc,
1269         struct mpi3mr_fwevt *fwevt)
1270 {
1271         mrioc->current_event = fwevt;
1272         mpi3mr_fwevt_del_from_list(mrioc, fwevt);
1273
1274         if (mrioc->stop_drv_processing)
1275                 goto out;
1276
1277         if (!fwevt->process_evt)
1278                 goto evt_ack;
1279
1280         switch (fwevt->event_id) {
1281         case MPI3_EVENT_DEVICE_ADDED:
1282         {
1283                 struct mpi3_device_page0 *dev_pg0 =
1284                     (struct mpi3_device_page0 *)fwevt->event_data;
1285                 mpi3mr_report_tgtdev_to_host(mrioc,
1286                     le16_to_cpu(dev_pg0->persistent_id));
1287                 break;
1288         }
1289         case MPI3_EVENT_DEVICE_INFO_CHANGED:
1290         {
1291                 mpi3mr_devinfochg_evt_bh(mrioc,
1292                     (struct mpi3_device_page0 *)fwevt->event_data);
1293                 break;
1294         }
1295         case MPI3_EVENT_DEVICE_STATUS_CHANGE:
1296         {
1297                 mpi3mr_devstatuschg_evt_bh(mrioc, fwevt);
1298                 break;
1299         }
1300         case MPI3_EVENT_SAS_TOPOLOGY_CHANGE_LIST:
1301         {
1302                 mpi3mr_sastopochg_evt_bh(mrioc, fwevt);
1303                 break;
1304         }
1305         case MPI3_EVENT_PCIE_TOPOLOGY_CHANGE_LIST:
1306         {
1307                 mpi3mr_pcietopochg_evt_bh(mrioc, fwevt);
1308                 break;
1309         }
1310         default:
1311                 break;
1312         }
1313
1314 evt_ack:
1315         if (fwevt->send_ack)
1316                 mpi3mr_send_event_ack(mrioc, fwevt->event_id,
1317                     fwevt->evt_ctx);
1318 out:
1319         /* Put fwevt reference count to neutralize kref_init increment */
1320         mpi3mr_fwevt_put(fwevt);
1321         mrioc->current_event = NULL;
1322 }
1323
1324 /**
1325  * mpi3mr_fwevt_worker - Firmware event worker
1326  * @work: Work struct containing firmware event
1327  *
1328  * Extracts the firmware event and calls mpi3mr_fwevt_bh.
1329  *
1330  * Return: Nothing.
1331  */
1332 static void mpi3mr_fwevt_worker(struct work_struct *work)
1333 {
1334         struct mpi3mr_fwevt *fwevt = container_of(work, struct mpi3mr_fwevt,
1335             work);
1336         mpi3mr_fwevt_bh(fwevt->mrioc, fwevt);
1337         /*
1338          * Put fwevt reference count after
1339          * dequeuing it from worker queue
1340          */
1341         mpi3mr_fwevt_put(fwevt);
1342 }
1343
1344 /**
1345  * mpi3mr_create_tgtdev - Create and add a target device
1346  * @mrioc: Adapter instance reference
1347  * @dev_pg0: Device Page 0 data
1348  *
1349  * If the device specified by the device page 0 data is not
1350  * present in the driver's internal list, allocate the memory
1351  * for the device, populate the data and add to the list, else
1352  * update the device data.  The key is persistent ID.
1353  *
1354  * Return: 0 on success, -ENOMEM on memory allocation failure
1355  */
1356 static int mpi3mr_create_tgtdev(struct mpi3mr_ioc *mrioc,
1357         struct mpi3_device_page0 *dev_pg0)
1358 {
1359         int retval = 0;
1360         struct mpi3mr_tgt_dev *tgtdev = NULL;
1361         u16 perst_id = 0;
1362
1363         perst_id = le16_to_cpu(dev_pg0->persistent_id);
1364         tgtdev = mpi3mr_get_tgtdev_by_perst_id(mrioc, perst_id);
1365         if (tgtdev) {
1366                 mpi3mr_update_tgtdev(mrioc, tgtdev, dev_pg0);
1367                 mpi3mr_tgtdev_put(tgtdev);
1368         } else {
1369                 tgtdev = mpi3mr_alloc_tgtdev();
1370                 if (!tgtdev)
1371                         return -ENOMEM;
1372                 mpi3mr_update_tgtdev(mrioc, tgtdev, dev_pg0);
1373                 mpi3mr_tgtdev_add_to_list(mrioc, tgtdev);
1374         }
1375
1376         return retval;
1377 }
1378
1379 /**
1380  * mpi3mr_flush_delayed_rmhs_list - Flush pending commands
1381  * @mrioc: Adapter instance reference
1382  *
1383  * Flush pending commands in the delayed removal handshake list
1384  * due to a controller reset or driver removal as a cleanup.
1385  *
1386  * Return: Nothing
1387  */
1388 void mpi3mr_flush_delayed_rmhs_list(struct mpi3mr_ioc *mrioc)
1389 {
1390         struct delayed_dev_rmhs_node *_rmhs_node;
1391
1392         while (!list_empty(&mrioc->delayed_rmhs_list)) {
1393                 _rmhs_node = list_entry(mrioc->delayed_rmhs_list.next,
1394                     struct delayed_dev_rmhs_node, list);
1395                 list_del(&_rmhs_node->list);
1396                 kfree(_rmhs_node);
1397         }
1398 }
1399
1400 /**
1401  * mpi3mr_dev_rmhs_complete_iou - Device removal IOUC completion
1402  * @mrioc: Adapter instance reference
1403  * @drv_cmd: Internal command tracker
1404  *
1405  * Issues a target reset TM to the firmware from the device
1406  * removal TM pend list or retry the removal handshake sequence
1407  * based on the IOU control request IOC status.
1408  *
1409  * Return: Nothing
1410  */
1411 static void mpi3mr_dev_rmhs_complete_iou(struct mpi3mr_ioc *mrioc,
1412         struct mpi3mr_drv_cmd *drv_cmd)
1413 {
1414         u16 cmd_idx = drv_cmd->host_tag - MPI3MR_HOSTTAG_DEVRMCMD_MIN;
1415         struct delayed_dev_rmhs_node *delayed_dev_rmhs = NULL;
1416
1417         ioc_info(mrioc,
1418             "%s :dev_rmhs_iouctrl_complete:handle(0x%04x), ioc_status(0x%04x), loginfo(0x%08x)\n",
1419             __func__, drv_cmd->dev_handle, drv_cmd->ioc_status,
1420             drv_cmd->ioc_loginfo);
1421         if (drv_cmd->ioc_status != MPI3_IOCSTATUS_SUCCESS) {
1422                 if (drv_cmd->retry_count < MPI3MR_DEV_RMHS_RETRY_COUNT) {
1423                         drv_cmd->retry_count++;
1424                         ioc_info(mrioc,
1425                             "%s :dev_rmhs_iouctrl_complete: handle(0x%04x)retrying handshake retry=%d\n",
1426                             __func__, drv_cmd->dev_handle,
1427                             drv_cmd->retry_count);
1428                         mpi3mr_dev_rmhs_send_tm(mrioc, drv_cmd->dev_handle,
1429                             drv_cmd, drv_cmd->iou_rc);
1430                         return;
1431                 }
1432                 ioc_err(mrioc,
1433                     "%s :dev removal handshake failed after all retries: handle(0x%04x)\n",
1434                     __func__, drv_cmd->dev_handle);
1435         } else {
1436                 ioc_info(mrioc,
1437                     "%s :dev removal handshake completed successfully: handle(0x%04x)\n",
1438                     __func__, drv_cmd->dev_handle);
1439                 clear_bit(drv_cmd->dev_handle, mrioc->removepend_bitmap);
1440         }
1441
1442         if (!list_empty(&mrioc->delayed_rmhs_list)) {
1443                 delayed_dev_rmhs = list_entry(mrioc->delayed_rmhs_list.next,
1444                     struct delayed_dev_rmhs_node, list);
1445                 drv_cmd->dev_handle = delayed_dev_rmhs->handle;
1446                 drv_cmd->retry_count = 0;
1447                 drv_cmd->iou_rc = delayed_dev_rmhs->iou_rc;
1448                 ioc_info(mrioc,
1449                     "%s :dev_rmhs_iouctrl_complete: processing delayed TM: handle(0x%04x)\n",
1450                     __func__, drv_cmd->dev_handle);
1451                 mpi3mr_dev_rmhs_send_tm(mrioc, drv_cmd->dev_handle, drv_cmd,
1452                     drv_cmd->iou_rc);
1453                 list_del(&delayed_dev_rmhs->list);
1454                 kfree(delayed_dev_rmhs);
1455                 return;
1456         }
1457         drv_cmd->state = MPI3MR_CMD_NOTUSED;
1458         drv_cmd->callback = NULL;
1459         drv_cmd->retry_count = 0;
1460         drv_cmd->dev_handle = MPI3MR_INVALID_DEV_HANDLE;
1461         clear_bit(cmd_idx, mrioc->devrem_bitmap);
1462 }
1463
1464 /**
1465  * mpi3mr_dev_rmhs_complete_tm - Device removal TM completion
1466  * @mrioc: Adapter instance reference
1467  * @drv_cmd: Internal command tracker
1468  *
1469  * Issues a target reset TM to the firmware from the device
1470  * removal TM pend list or issue IO unit control request as
1471  * part of device removal or hidden acknowledgment handshake.
1472  *
1473  * Return: Nothing
1474  */
1475 static void mpi3mr_dev_rmhs_complete_tm(struct mpi3mr_ioc *mrioc,
1476         struct mpi3mr_drv_cmd *drv_cmd)
1477 {
1478         struct mpi3_iounit_control_request iou_ctrl;
1479         u16 cmd_idx = drv_cmd->host_tag - MPI3MR_HOSTTAG_DEVRMCMD_MIN;
1480         struct mpi3_scsi_task_mgmt_reply *tm_reply = NULL;
1481         int retval;
1482
1483         if (drv_cmd->state & MPI3MR_CMD_REPLY_VALID)
1484                 tm_reply = (struct mpi3_scsi_task_mgmt_reply *)drv_cmd->reply;
1485
1486         if (tm_reply)
1487                 pr_info(IOCNAME
1488                     "dev_rmhs_tr_complete:handle(0x%04x), ioc_status(0x%04x), loginfo(0x%08x), term_count(%d)\n",
1489                     mrioc->name, drv_cmd->dev_handle, drv_cmd->ioc_status,
1490                     drv_cmd->ioc_loginfo,
1491                     le32_to_cpu(tm_reply->termination_count));
1492
1493         pr_info(IOCNAME "Issuing IOU CTL: handle(0x%04x) dev_rmhs idx(%d)\n",
1494             mrioc->name, drv_cmd->dev_handle, cmd_idx);
1495
1496         memset(&iou_ctrl, 0, sizeof(iou_ctrl));
1497
1498         drv_cmd->state = MPI3MR_CMD_PENDING;
1499         drv_cmd->is_waiting = 0;
1500         drv_cmd->callback = mpi3mr_dev_rmhs_complete_iou;
1501         iou_ctrl.operation = drv_cmd->iou_rc;
1502         iou_ctrl.param16[0] = cpu_to_le16(drv_cmd->dev_handle);
1503         iou_ctrl.host_tag = cpu_to_le16(drv_cmd->host_tag);
1504         iou_ctrl.function = MPI3_FUNCTION_IO_UNIT_CONTROL;
1505
1506         retval = mpi3mr_admin_request_post(mrioc, &iou_ctrl, sizeof(iou_ctrl),
1507             1);
1508         if (retval) {
1509                 pr_err(IOCNAME "Issue DevRmHsTMIOUCTL: Admin post failed\n",
1510                     mrioc->name);
1511                 goto out_failed;
1512         }
1513
1514         return;
1515 out_failed:
1516         drv_cmd->state = MPI3MR_CMD_NOTUSED;
1517         drv_cmd->callback = NULL;
1518         drv_cmd->dev_handle = MPI3MR_INVALID_DEV_HANDLE;
1519         drv_cmd->retry_count = 0;
1520         clear_bit(cmd_idx, mrioc->devrem_bitmap);
1521 }
1522
1523 /**
1524  * mpi3mr_dev_rmhs_send_tm - Issue TM for device removal
1525  * @mrioc: Adapter instance reference
1526  * @handle: Device handle
1527  * @cmdparam: Internal command tracker
1528  * @iou_rc: IO unit reason code
1529  *
1530  * Issues a target reset TM to the firmware or add it to a pend
1531  * list as part of device removal or hidden acknowledgment
1532  * handshake.
1533  *
1534  * Return: Nothing
1535  */
1536 static void mpi3mr_dev_rmhs_send_tm(struct mpi3mr_ioc *mrioc, u16 handle,
1537         struct mpi3mr_drv_cmd *cmdparam, u8 iou_rc)
1538 {
1539         struct mpi3_scsi_task_mgmt_request tm_req;
1540         int retval = 0;
1541         u16 cmd_idx = MPI3MR_NUM_DEVRMCMD;
1542         u8 retrycount = 5;
1543         struct mpi3mr_drv_cmd *drv_cmd = cmdparam;
1544         struct delayed_dev_rmhs_node *delayed_dev_rmhs = NULL;
1545
1546         if (drv_cmd)
1547                 goto issue_cmd;
1548         do {
1549                 cmd_idx = find_first_zero_bit(mrioc->devrem_bitmap,
1550                     MPI3MR_NUM_DEVRMCMD);
1551                 if (cmd_idx < MPI3MR_NUM_DEVRMCMD) {
1552                         if (!test_and_set_bit(cmd_idx, mrioc->devrem_bitmap))
1553                                 break;
1554                         cmd_idx = MPI3MR_NUM_DEVRMCMD;
1555                 }
1556         } while (retrycount--);
1557
1558         if (cmd_idx >= MPI3MR_NUM_DEVRMCMD) {
1559                 delayed_dev_rmhs = kzalloc(sizeof(*delayed_dev_rmhs),
1560                     GFP_ATOMIC);
1561                 if (!delayed_dev_rmhs)
1562                         return;
1563                 INIT_LIST_HEAD(&delayed_dev_rmhs->list);
1564                 delayed_dev_rmhs->handle = handle;
1565                 delayed_dev_rmhs->iou_rc = iou_rc;
1566                 list_add_tail(&delayed_dev_rmhs->list,
1567                     &mrioc->delayed_rmhs_list);
1568                 ioc_info(mrioc, "%s :DevRmHs: tr:handle(0x%04x) is postponed\n",
1569                     __func__, handle);
1570                 return;
1571         }
1572         drv_cmd = &mrioc->dev_rmhs_cmds[cmd_idx];
1573
1574 issue_cmd:
1575         cmd_idx = drv_cmd->host_tag - MPI3MR_HOSTTAG_DEVRMCMD_MIN;
1576         ioc_info(mrioc,
1577             "%s :Issuing TR TM: for devhandle 0x%04x with dev_rmhs %d\n",
1578             __func__, handle, cmd_idx);
1579
1580         memset(&tm_req, 0, sizeof(tm_req));
1581         if (drv_cmd->state & MPI3MR_CMD_PENDING) {
1582                 ioc_err(mrioc, "%s :Issue TM: Command is in use\n", __func__);
1583                 goto out;
1584         }
1585         drv_cmd->state = MPI3MR_CMD_PENDING;
1586         drv_cmd->is_waiting = 0;
1587         drv_cmd->callback = mpi3mr_dev_rmhs_complete_tm;
1588         drv_cmd->dev_handle = handle;
1589         drv_cmd->iou_rc = iou_rc;
1590         tm_req.dev_handle = cpu_to_le16(handle);
1591         tm_req.task_type = MPI3_SCSITASKMGMT_TASKTYPE_TARGET_RESET;
1592         tm_req.host_tag = cpu_to_le16(drv_cmd->host_tag);
1593         tm_req.task_host_tag = cpu_to_le16(MPI3MR_HOSTTAG_INVALID);
1594         tm_req.function = MPI3_FUNCTION_SCSI_TASK_MGMT;
1595
1596         set_bit(handle, mrioc->removepend_bitmap);
1597         retval = mpi3mr_admin_request_post(mrioc, &tm_req, sizeof(tm_req), 1);
1598         if (retval) {
1599                 ioc_err(mrioc, "%s :Issue DevRmHsTM: Admin Post failed\n",
1600                     __func__);
1601                 goto out_failed;
1602         }
1603 out:
1604         return;
1605 out_failed:
1606         drv_cmd->state = MPI3MR_CMD_NOTUSED;
1607         drv_cmd->callback = NULL;
1608         drv_cmd->dev_handle = MPI3MR_INVALID_DEV_HANDLE;
1609         drv_cmd->retry_count = 0;
1610         clear_bit(cmd_idx, mrioc->devrem_bitmap);
1611 }
1612
1613 /**
1614  * mpi3mr_pcietopochg_evt_th - PCIETopologyChange evt tophalf
1615  * @mrioc: Adapter instance reference
1616  * @event_reply: event data
1617  *
1618  * Checks for the reason code and based on that either block I/O
1619  * to device, or unblock I/O to the device, or start the device
1620  * removal handshake with reason as remove with the firmware for
1621  * PCIe devices.
1622  *
1623  * Return: Nothing
1624  */
1625 static void mpi3mr_pcietopochg_evt_th(struct mpi3mr_ioc *mrioc,
1626         struct mpi3_event_notification_reply *event_reply)
1627 {
1628         struct mpi3_event_data_pcie_topology_change_list *topo_evt =
1629             (struct mpi3_event_data_pcie_topology_change_list *)event_reply->event_data;
1630         int i;
1631         u16 handle;
1632         u8 reason_code;
1633         struct mpi3mr_tgt_dev *tgtdev = NULL;
1634         struct mpi3mr_stgt_priv_data *scsi_tgt_priv_data = NULL;
1635
1636         for (i = 0; i < topo_evt->num_entries; i++) {
1637                 handle = le16_to_cpu(topo_evt->port_entry[i].attached_dev_handle);
1638                 if (!handle)
1639                         continue;
1640                 reason_code = topo_evt->port_entry[i].port_status;
1641                 scsi_tgt_priv_data =  NULL;
1642                 tgtdev = mpi3mr_get_tgtdev_by_handle(mrioc, handle);
1643                 if (tgtdev && tgtdev->starget && tgtdev->starget->hostdata)
1644                         scsi_tgt_priv_data = (struct mpi3mr_stgt_priv_data *)
1645                             tgtdev->starget->hostdata;
1646                 switch (reason_code) {
1647                 case MPI3_EVENT_PCIE_TOPO_PS_NOT_RESPONDING:
1648                         if (scsi_tgt_priv_data) {
1649                                 scsi_tgt_priv_data->dev_removed = 1;
1650                                 scsi_tgt_priv_data->dev_removedelay = 0;
1651                                 atomic_set(&scsi_tgt_priv_data->block_io, 0);
1652                         }
1653                         mpi3mr_dev_rmhs_send_tm(mrioc, handle, NULL,
1654                             MPI3_CTRL_OP_REMOVE_DEVICE);
1655                         break;
1656                 case MPI3_EVENT_PCIE_TOPO_PS_DELAY_NOT_RESPONDING:
1657                         if (scsi_tgt_priv_data) {
1658                                 scsi_tgt_priv_data->dev_removedelay = 1;
1659                                 atomic_inc(&scsi_tgt_priv_data->block_io);
1660                         }
1661                         break;
1662                 case MPI3_EVENT_PCIE_TOPO_PS_RESPONDING:
1663                         if (scsi_tgt_priv_data &&
1664                             scsi_tgt_priv_data->dev_removedelay) {
1665                                 scsi_tgt_priv_data->dev_removedelay = 0;
1666                                 atomic_dec_if_positive
1667                                     (&scsi_tgt_priv_data->block_io);
1668                         }
1669                         break;
1670                 case MPI3_EVENT_PCIE_TOPO_PS_PORT_CHANGED:
1671                 default:
1672                         break;
1673                 }
1674                 if (tgtdev)
1675                         mpi3mr_tgtdev_put(tgtdev);
1676         }
1677 }
1678
1679 /**
1680  * mpi3mr_sastopochg_evt_th - SASTopologyChange evt tophalf
1681  * @mrioc: Adapter instance reference
1682  * @event_reply: event data
1683  *
1684  * Checks for the reason code and based on that either block I/O
1685  * to device, or unblock I/O to the device, or start the device
1686  * removal handshake with reason as remove with the firmware for
1687  * SAS/SATA devices.
1688  *
1689  * Return: Nothing
1690  */
1691 static void mpi3mr_sastopochg_evt_th(struct mpi3mr_ioc *mrioc,
1692         struct mpi3_event_notification_reply *event_reply)
1693 {
1694         struct mpi3_event_data_sas_topology_change_list *topo_evt =
1695             (struct mpi3_event_data_sas_topology_change_list *)event_reply->event_data;
1696         int i;
1697         u16 handle;
1698         u8 reason_code;
1699         struct mpi3mr_tgt_dev *tgtdev = NULL;
1700         struct mpi3mr_stgt_priv_data *scsi_tgt_priv_data = NULL;
1701
1702         for (i = 0; i < topo_evt->num_entries; i++) {
1703                 handle = le16_to_cpu(topo_evt->phy_entry[i].attached_dev_handle);
1704                 if (!handle)
1705                         continue;
1706                 reason_code = topo_evt->phy_entry[i].status &
1707                     MPI3_EVENT_SAS_TOPO_PHY_RC_MASK;
1708                 scsi_tgt_priv_data =  NULL;
1709                 tgtdev = mpi3mr_get_tgtdev_by_handle(mrioc, handle);
1710                 if (tgtdev && tgtdev->starget && tgtdev->starget->hostdata)
1711                         scsi_tgt_priv_data = (struct mpi3mr_stgt_priv_data *)
1712                             tgtdev->starget->hostdata;
1713                 switch (reason_code) {
1714                 case MPI3_EVENT_SAS_TOPO_PHY_RC_TARG_NOT_RESPONDING:
1715                         if (scsi_tgt_priv_data) {
1716                                 scsi_tgt_priv_data->dev_removed = 1;
1717                                 scsi_tgt_priv_data->dev_removedelay = 0;
1718                                 atomic_set(&scsi_tgt_priv_data->block_io, 0);
1719                         }
1720                         mpi3mr_dev_rmhs_send_tm(mrioc, handle, NULL,
1721                             MPI3_CTRL_OP_REMOVE_DEVICE);
1722                         break;
1723                 case MPI3_EVENT_SAS_TOPO_PHY_RC_DELAY_NOT_RESPONDING:
1724                         if (scsi_tgt_priv_data) {
1725                                 scsi_tgt_priv_data->dev_removedelay = 1;
1726                                 atomic_inc(&scsi_tgt_priv_data->block_io);
1727                         }
1728                         break;
1729                 case MPI3_EVENT_SAS_TOPO_PHY_RC_RESPONDING:
1730                         if (scsi_tgt_priv_data &&
1731                             scsi_tgt_priv_data->dev_removedelay) {
1732                                 scsi_tgt_priv_data->dev_removedelay = 0;
1733                                 atomic_dec_if_positive
1734                                     (&scsi_tgt_priv_data->block_io);
1735                         }
1736                         break;
1737                 case MPI3_EVENT_SAS_TOPO_PHY_RC_PHY_CHANGED:
1738                 default:
1739                         break;
1740                 }
1741                 if (tgtdev)
1742                         mpi3mr_tgtdev_put(tgtdev);
1743         }
1744 }
1745
1746 /**
1747  * mpi3mr_devstatuschg_evt_th - DeviceStatusChange evt tophalf
1748  * @mrioc: Adapter instance reference
1749  * @event_reply: event data
1750  *
1751  * Checks for the reason code and based on that either block I/O
1752  * to device, or unblock I/O to the device, or start the device
1753  * removal handshake with reason as remove/hide acknowledgment
1754  * with the firmware.
1755  *
1756  * Return: Nothing
1757  */
1758 static void mpi3mr_devstatuschg_evt_th(struct mpi3mr_ioc *mrioc,
1759         struct mpi3_event_notification_reply *event_reply)
1760 {
1761         u16 dev_handle = 0;
1762         u8 ublock = 0, block = 0, hide = 0, delete = 0, remove = 0;
1763         struct mpi3mr_tgt_dev *tgtdev = NULL;
1764         struct mpi3mr_stgt_priv_data *scsi_tgt_priv_data = NULL;
1765         struct mpi3_event_data_device_status_change *evtdata =
1766             (struct mpi3_event_data_device_status_change *)event_reply->event_data;
1767
1768         if (mrioc->stop_drv_processing)
1769                 goto out;
1770
1771         dev_handle = le16_to_cpu(evtdata->dev_handle);
1772
1773         switch (evtdata->reason_code) {
1774         case MPI3_EVENT_DEV_STAT_RC_INT_DEVICE_RESET_STRT:
1775         case MPI3_EVENT_DEV_STAT_RC_INT_IT_NEXUS_RESET_STRT:
1776                 block = 1;
1777                 break;
1778         case MPI3_EVENT_DEV_STAT_RC_HIDDEN:
1779                 delete = 1;
1780                 hide = 1;
1781                 break;
1782         case MPI3_EVENT_DEV_STAT_RC_VD_NOT_RESPONDING:
1783                 delete = 1;
1784                 remove = 1;
1785                 break;
1786         case MPI3_EVENT_DEV_STAT_RC_INT_DEVICE_RESET_CMP:
1787         case MPI3_EVENT_DEV_STAT_RC_INT_IT_NEXUS_RESET_CMP:
1788                 ublock = 1;
1789                 break;
1790         default:
1791                 break;
1792         }
1793
1794         tgtdev = mpi3mr_get_tgtdev_by_handle(mrioc, dev_handle);
1795         if (!tgtdev)
1796                 goto out;
1797         if (hide)
1798                 tgtdev->is_hidden = hide;
1799         if (tgtdev->starget && tgtdev->starget->hostdata) {
1800                 scsi_tgt_priv_data = (struct mpi3mr_stgt_priv_data *)
1801                     tgtdev->starget->hostdata;
1802                 if (block)
1803                         atomic_inc(&scsi_tgt_priv_data->block_io);
1804                 if (delete)
1805                         scsi_tgt_priv_data->dev_removed = 1;
1806                 if (ublock)
1807                         atomic_dec_if_positive(&scsi_tgt_priv_data->block_io);
1808         }
1809         if (remove)
1810                 mpi3mr_dev_rmhs_send_tm(mrioc, dev_handle, NULL,
1811                     MPI3_CTRL_OP_REMOVE_DEVICE);
1812         if (hide)
1813                 mpi3mr_dev_rmhs_send_tm(mrioc, dev_handle, NULL,
1814                     MPI3_CTRL_OP_HIDDEN_ACK);
1815
1816 out:
1817         if (tgtdev)
1818                 mpi3mr_tgtdev_put(tgtdev);
1819 }
1820
1821 /**
1822  * mpi3mr_energypackchg_evt_th - Energy pack change evt tophalf
1823  * @mrioc: Adapter instance reference
1824  * @event_reply: event data
1825  *
1826  * Identifies the new shutdown timeout value and update.
1827  *
1828  * Return: Nothing
1829  */
1830 static void mpi3mr_energypackchg_evt_th(struct mpi3mr_ioc *mrioc,
1831         struct mpi3_event_notification_reply *event_reply)
1832 {
1833         struct mpi3_event_data_energy_pack_change *evtdata =
1834             (struct mpi3_event_data_energy_pack_change *)event_reply->event_data;
1835         u16 shutdown_timeout = le16_to_cpu(evtdata->shutdown_timeout);
1836
1837         if (shutdown_timeout <= 0) {
1838                 ioc_warn(mrioc,
1839                     "%s :Invalid Shutdown Timeout received = %d\n",
1840                     __func__, shutdown_timeout);
1841                 return;
1842         }
1843
1844         ioc_info(mrioc,
1845             "%s :Previous Shutdown Timeout Value = %d New Shutdown Timeout Value = %d\n",
1846             __func__, mrioc->facts.shutdown_timeout, shutdown_timeout);
1847         mrioc->facts.shutdown_timeout = shutdown_timeout;
1848 }
1849
1850 /**
1851  * mpi3mr_os_handle_events - Firmware event handler
1852  * @mrioc: Adapter instance reference
1853  * @event_reply: event data
1854  *
1855  * Identify whteher the event has to handled and acknowledged
1856  * and either process the event in the tophalf and/or schedule a
1857  * bottom half through mpi3mr_fwevt_worker.
1858  *
1859  * Return: Nothing
1860  */
1861 void mpi3mr_os_handle_events(struct mpi3mr_ioc *mrioc,
1862         struct mpi3_event_notification_reply *event_reply)
1863 {
1864         u16 evt_type, sz;
1865         struct mpi3mr_fwevt *fwevt = NULL;
1866         bool ack_req = 0, process_evt_bh = 0;
1867
1868         if (mrioc->stop_drv_processing)
1869                 return;
1870
1871         if ((event_reply->msg_flags & MPI3_EVENT_NOTIFY_MSGFLAGS_ACK_MASK)
1872             == MPI3_EVENT_NOTIFY_MSGFLAGS_ACK_REQUIRED)
1873                 ack_req = 1;
1874
1875         evt_type = event_reply->event;
1876
1877         switch (evt_type) {
1878         case MPI3_EVENT_DEVICE_ADDED:
1879         {
1880                 struct mpi3_device_page0 *dev_pg0 =
1881                     (struct mpi3_device_page0 *)event_reply->event_data;
1882                 if (mpi3mr_create_tgtdev(mrioc, dev_pg0))
1883                         ioc_err(mrioc,
1884                             "%s :Failed to add device in the device add event\n",
1885                             __func__);
1886                 else
1887                         process_evt_bh = 1;
1888                 break;
1889         }
1890         case MPI3_EVENT_DEVICE_STATUS_CHANGE:
1891         {
1892                 process_evt_bh = 1;
1893                 mpi3mr_devstatuschg_evt_th(mrioc, event_reply);
1894                 break;
1895         }
1896         case MPI3_EVENT_SAS_TOPOLOGY_CHANGE_LIST:
1897         {
1898                 process_evt_bh = 1;
1899                 mpi3mr_sastopochg_evt_th(mrioc, event_reply);
1900                 break;
1901         }
1902         case MPI3_EVENT_PCIE_TOPOLOGY_CHANGE_LIST:
1903         {
1904                 process_evt_bh = 1;
1905                 mpi3mr_pcietopochg_evt_th(mrioc, event_reply);
1906                 break;
1907         }
1908         case MPI3_EVENT_DEVICE_INFO_CHANGED:
1909         {
1910                 process_evt_bh = 1;
1911                 break;
1912         }
1913         case MPI3_EVENT_ENERGY_PACK_CHANGE:
1914         {
1915                 mpi3mr_energypackchg_evt_th(mrioc, event_reply);
1916                 break;
1917         }
1918         case MPI3_EVENT_ENCL_DEVICE_STATUS_CHANGE:
1919         case MPI3_EVENT_SAS_DISCOVERY:
1920         case MPI3_EVENT_CABLE_MGMT:
1921         case MPI3_EVENT_SAS_DEVICE_DISCOVERY_ERROR:
1922         case MPI3_EVENT_SAS_BROADCAST_PRIMITIVE:
1923         case MPI3_EVENT_PCIE_ENUMERATION:
1924                 break;
1925         default:
1926                 ioc_info(mrioc, "%s :event 0x%02x is not handled\n",
1927                     __func__, evt_type);
1928                 break;
1929         }
1930         if (process_evt_bh || ack_req) {
1931                 sz = event_reply->event_data_length * 4;
1932                 fwevt = mpi3mr_alloc_fwevt(sz);
1933                 if (!fwevt) {
1934                         ioc_info(mrioc, "%s :failure at %s:%d/%s()!\n",
1935                             __func__, __FILE__, __LINE__, __func__);
1936                         return;
1937                 }
1938
1939                 memcpy(fwevt->event_data, event_reply->event_data, sz);
1940                 fwevt->mrioc = mrioc;
1941                 fwevt->event_id = evt_type;
1942                 fwevt->send_ack = ack_req;
1943                 fwevt->process_evt = process_evt_bh;
1944                 fwevt->evt_ctx = le32_to_cpu(event_reply->event_context);
1945                 mpi3mr_fwevt_add_to_list(mrioc, fwevt);
1946         }
1947 }
1948
1949 /**
1950  * mpi3mr_setup_eedp - Setup EEDP information in MPI3 SCSI IO
1951  * @mrioc: Adapter instance reference
1952  * @scmd: SCSI command reference
1953  * @scsiio_req: MPI3 SCSI IO request
1954  *
1955  * Identifies the protection information flags from the SCSI
1956  * command and set appropriate flags in the MPI3 SCSI IO
1957  * request.
1958  *
1959  * Return: Nothing
1960  */
1961 static void mpi3mr_setup_eedp(struct mpi3mr_ioc *mrioc,
1962         struct scsi_cmnd *scmd, struct mpi3_scsi_io_request *scsiio_req)
1963 {
1964         u16 eedp_flags = 0;
1965         unsigned char prot_op = scsi_get_prot_op(scmd);
1966
1967         switch (prot_op) {
1968         case SCSI_PROT_NORMAL:
1969                 return;
1970         case SCSI_PROT_READ_STRIP:
1971                 eedp_flags = MPI3_EEDPFLAGS_EEDP_OP_CHECK_REMOVE;
1972                 break;
1973         case SCSI_PROT_WRITE_INSERT:
1974                 eedp_flags = MPI3_EEDPFLAGS_EEDP_OP_INSERT;
1975                 break;
1976         case SCSI_PROT_READ_INSERT:
1977                 eedp_flags = MPI3_EEDPFLAGS_EEDP_OP_INSERT;
1978                 scsiio_req->msg_flags |= MPI3_SCSIIO_MSGFLAGS_METASGL_VALID;
1979                 break;
1980         case SCSI_PROT_WRITE_STRIP:
1981                 eedp_flags = MPI3_EEDPFLAGS_EEDP_OP_CHECK_REMOVE;
1982                 scsiio_req->msg_flags |= MPI3_SCSIIO_MSGFLAGS_METASGL_VALID;
1983                 break;
1984         case SCSI_PROT_READ_PASS:
1985                 eedp_flags = MPI3_EEDPFLAGS_EEDP_OP_CHECK;
1986                 scsiio_req->msg_flags |= MPI3_SCSIIO_MSGFLAGS_METASGL_VALID;
1987                 break;
1988         case SCSI_PROT_WRITE_PASS:
1989                 if (scmd->prot_flags & SCSI_PROT_IP_CHECKSUM) {
1990                         eedp_flags = MPI3_EEDPFLAGS_EEDP_OP_CHECK_REGEN;
1991                         scsiio_req->sgl[0].eedp.application_tag_translation_mask =
1992                             0xffff;
1993                 } else
1994                         eedp_flags = MPI3_EEDPFLAGS_EEDP_OP_CHECK;
1995
1996                 scsiio_req->msg_flags |= MPI3_SCSIIO_MSGFLAGS_METASGL_VALID;
1997                 break;
1998         default:
1999                 return;
2000         }
2001
2002         if (scmd->prot_flags & SCSI_PROT_GUARD_CHECK)
2003                 eedp_flags |= MPI3_EEDPFLAGS_CHK_GUARD;
2004
2005         if (scmd->prot_flags & SCSI_PROT_IP_CHECKSUM)
2006                 eedp_flags |= MPI3_EEDPFLAGS_HOST_GUARD_IP_CHKSUM;
2007
2008         if (scmd->prot_flags & SCSI_PROT_REF_CHECK) {
2009                 eedp_flags |= MPI3_EEDPFLAGS_CHK_REF_TAG |
2010                         MPI3_EEDPFLAGS_INCR_PRI_REF_TAG;
2011                 scsiio_req->cdb.eedp32.primary_reference_tag =
2012                         cpu_to_be32(scsi_prot_ref_tag(scmd));
2013         }
2014
2015         if (scmd->prot_flags & SCSI_PROT_REF_INCREMENT)
2016                 eedp_flags |= MPI3_EEDPFLAGS_INCR_PRI_REF_TAG;
2017
2018         eedp_flags |= MPI3_EEDPFLAGS_ESC_MODE_APPTAG_DISABLE;
2019
2020         switch (scsi_prot_interval(scmd)) {
2021         case 512:
2022                 scsiio_req->sgl[0].eedp.user_data_size = MPI3_EEDP_UDS_512;
2023                 break;
2024         case 520:
2025                 scsiio_req->sgl[0].eedp.user_data_size = MPI3_EEDP_UDS_520;
2026                 break;
2027         case 4080:
2028                 scsiio_req->sgl[0].eedp.user_data_size = MPI3_EEDP_UDS_4080;
2029                 break;
2030         case 4088:
2031                 scsiio_req->sgl[0].eedp.user_data_size = MPI3_EEDP_UDS_4088;
2032                 break;
2033         case 4096:
2034                 scsiio_req->sgl[0].eedp.user_data_size = MPI3_EEDP_UDS_4096;
2035                 break;
2036         case 4104:
2037                 scsiio_req->sgl[0].eedp.user_data_size = MPI3_EEDP_UDS_4104;
2038                 break;
2039         case 4160:
2040                 scsiio_req->sgl[0].eedp.user_data_size = MPI3_EEDP_UDS_4160;
2041                 break;
2042         default:
2043                 break;
2044         }
2045
2046         scsiio_req->sgl[0].eedp.eedp_flags = cpu_to_le16(eedp_flags);
2047         scsiio_req->sgl[0].eedp.flags = MPI3_SGE_FLAGS_ELEMENT_TYPE_EXTENDED;
2048 }
2049
2050 /**
2051  * mpi3mr_build_sense_buffer - Map sense information
2052  * @desc: Sense type
2053  * @buf: Sense buffer to populate
2054  * @key: Sense key
2055  * @asc: Additional sense code
2056  * @ascq: Additional sense code qualifier
2057  *
2058  * Maps the given sense information into either descriptor or
2059  * fixed format sense data.
2060  *
2061  * Return: Nothing
2062  */
2063 static inline void mpi3mr_build_sense_buffer(int desc, u8 *buf, u8 key,
2064         u8 asc, u8 ascq)
2065 {
2066         if (desc) {
2067                 buf[0] = 0x72;  /* descriptor, current */
2068                 buf[1] = key;
2069                 buf[2] = asc;
2070                 buf[3] = ascq;
2071                 buf[7] = 0;
2072         } else {
2073                 buf[0] = 0x70;  /* fixed, current */
2074                 buf[2] = key;
2075                 buf[7] = 0xa;
2076                 buf[12] = asc;
2077                 buf[13] = ascq;
2078         }
2079 }
2080
2081 /**
2082  * mpi3mr_map_eedp_error - Map EEDP errors from IOC status
2083  * @scmd: SCSI command reference
2084  * @ioc_status: status of MPI3 request
2085  *
2086  * Maps the EEDP error status of the SCSI IO request to sense
2087  * data.
2088  *
2089  * Return: Nothing
2090  */
2091 static void mpi3mr_map_eedp_error(struct scsi_cmnd *scmd,
2092         u16 ioc_status)
2093 {
2094         u8 ascq = 0;
2095
2096         switch (ioc_status) {
2097         case MPI3_IOCSTATUS_EEDP_GUARD_ERROR:
2098                 ascq = 0x01;
2099                 break;
2100         case MPI3_IOCSTATUS_EEDP_APP_TAG_ERROR:
2101                 ascq = 0x02;
2102                 break;
2103         case MPI3_IOCSTATUS_EEDP_REF_TAG_ERROR:
2104                 ascq = 0x03;
2105                 break;
2106         default:
2107                 ascq = 0x00;
2108                 break;
2109         }
2110
2111         mpi3mr_build_sense_buffer(0, scmd->sense_buffer, ILLEGAL_REQUEST,
2112             0x10, ascq);
2113         scmd->result = (DID_ABORT << 16) | SAM_STAT_CHECK_CONDITION;
2114 }
2115
2116 /**
2117  * mpi3mr_process_op_reply_desc - reply descriptor handler
2118  * @mrioc: Adapter instance reference
2119  * @reply_desc: Operational reply descriptor
2120  * @reply_dma: place holder for reply DMA address
2121  * @qidx: Operational queue index
2122  *
2123  * Process the operational reply descriptor and identifies the
2124  * descriptor type. Based on the descriptor map the MPI3 request
2125  * status to a SCSI command status and calls scsi_done call
2126  * back.
2127  *
2128  * Return: Nothing
2129  */
2130 void mpi3mr_process_op_reply_desc(struct mpi3mr_ioc *mrioc,
2131         struct mpi3_default_reply_descriptor *reply_desc, u64 *reply_dma, u16 qidx)
2132 {
2133         u16 reply_desc_type, host_tag = 0;
2134         u16 ioc_status = MPI3_IOCSTATUS_SUCCESS;
2135         u32 ioc_loginfo = 0;
2136         struct mpi3_status_reply_descriptor *status_desc = NULL;
2137         struct mpi3_address_reply_descriptor *addr_desc = NULL;
2138         struct mpi3_success_reply_descriptor *success_desc = NULL;
2139         struct mpi3_scsi_io_reply *scsi_reply = NULL;
2140         struct scsi_cmnd *scmd = NULL;
2141         struct scmd_priv *priv = NULL;
2142         u8 *sense_buf = NULL;
2143         u8 scsi_state = 0, scsi_status = 0, sense_state = 0;
2144         u32 xfer_count = 0, sense_count = 0, resp_data = 0;
2145         u16 dev_handle = 0xFFFF;
2146         struct scsi_sense_hdr sshdr;
2147
2148         *reply_dma = 0;
2149         reply_desc_type = le16_to_cpu(reply_desc->reply_flags) &
2150             MPI3_REPLY_DESCRIPT_FLAGS_TYPE_MASK;
2151         switch (reply_desc_type) {
2152         case MPI3_REPLY_DESCRIPT_FLAGS_TYPE_STATUS:
2153                 status_desc = (struct mpi3_status_reply_descriptor *)reply_desc;
2154                 host_tag = le16_to_cpu(status_desc->host_tag);
2155                 ioc_status = le16_to_cpu(status_desc->ioc_status);
2156                 if (ioc_status &
2157                     MPI3_REPLY_DESCRIPT_STATUS_IOCSTATUS_LOGINFOAVAIL)
2158                         ioc_loginfo = le32_to_cpu(status_desc->ioc_log_info);
2159                 ioc_status &= MPI3_REPLY_DESCRIPT_STATUS_IOCSTATUS_STATUS_MASK;
2160                 break;
2161         case MPI3_REPLY_DESCRIPT_FLAGS_TYPE_ADDRESS_REPLY:
2162                 addr_desc = (struct mpi3_address_reply_descriptor *)reply_desc;
2163                 *reply_dma = le64_to_cpu(addr_desc->reply_frame_address);
2164                 scsi_reply = mpi3mr_get_reply_virt_addr(mrioc,
2165                     *reply_dma);
2166                 if (!scsi_reply) {
2167                         panic("%s: scsi_reply is NULL, this shouldn't happen\n",
2168                             mrioc->name);
2169                         goto out;
2170                 }
2171                 host_tag = le16_to_cpu(scsi_reply->host_tag);
2172                 ioc_status = le16_to_cpu(scsi_reply->ioc_status);
2173                 scsi_status = scsi_reply->scsi_status;
2174                 scsi_state = scsi_reply->scsi_state;
2175                 dev_handle = le16_to_cpu(scsi_reply->dev_handle);
2176                 sense_state = (scsi_state & MPI3_SCSI_STATE_SENSE_MASK);
2177                 xfer_count = le32_to_cpu(scsi_reply->transfer_count);
2178                 sense_count = le32_to_cpu(scsi_reply->sense_count);
2179                 resp_data = le32_to_cpu(scsi_reply->response_data);
2180                 sense_buf = mpi3mr_get_sensebuf_virt_addr(mrioc,
2181                     le64_to_cpu(scsi_reply->sense_data_buffer_address));
2182                 if (ioc_status &
2183                     MPI3_REPLY_DESCRIPT_STATUS_IOCSTATUS_LOGINFOAVAIL)
2184                         ioc_loginfo = le32_to_cpu(scsi_reply->ioc_log_info);
2185                 ioc_status &= MPI3_REPLY_DESCRIPT_STATUS_IOCSTATUS_STATUS_MASK;
2186                 if (sense_state == MPI3_SCSI_STATE_SENSE_BUFF_Q_EMPTY)
2187                         panic("%s: Ran out of sense buffers\n", mrioc->name);
2188                 break;
2189         case MPI3_REPLY_DESCRIPT_FLAGS_TYPE_SUCCESS:
2190                 success_desc = (struct mpi3_success_reply_descriptor *)reply_desc;
2191                 host_tag = le16_to_cpu(success_desc->host_tag);
2192                 break;
2193         default:
2194                 break;
2195         }
2196         scmd = mpi3mr_scmd_from_host_tag(mrioc, host_tag, qidx);
2197         if (!scmd) {
2198                 panic("%s: Cannot Identify scmd for host_tag 0x%x\n",
2199                     mrioc->name, host_tag);
2200                 goto out;
2201         }
2202         priv = scsi_cmd_priv(scmd);
2203         if (success_desc) {
2204                 scmd->result = DID_OK << 16;
2205                 goto out_success;
2206         }
2207         if (ioc_status == MPI3_IOCSTATUS_SCSI_DATA_UNDERRUN &&
2208             xfer_count == 0 && (scsi_status == MPI3_SCSI_STATUS_BUSY ||
2209             scsi_status == MPI3_SCSI_STATUS_RESERVATION_CONFLICT ||
2210             scsi_status == MPI3_SCSI_STATUS_TASK_SET_FULL))
2211                 ioc_status = MPI3_IOCSTATUS_SUCCESS;
2212
2213         if ((sense_state == MPI3_SCSI_STATE_SENSE_VALID) && sense_count &&
2214             sense_buf) {
2215                 u32 sz = min_t(u32, SCSI_SENSE_BUFFERSIZE, sense_count);
2216
2217                 memcpy(scmd->sense_buffer, sense_buf, sz);
2218         }
2219
2220         switch (ioc_status) {
2221         case MPI3_IOCSTATUS_BUSY:
2222         case MPI3_IOCSTATUS_INSUFFICIENT_RESOURCES:
2223                 scmd->result = SAM_STAT_BUSY;
2224                 break;
2225         case MPI3_IOCSTATUS_SCSI_DEVICE_NOT_THERE:
2226                 scmd->result = DID_NO_CONNECT << 16;
2227                 break;
2228         case MPI3_IOCSTATUS_SCSI_IOC_TERMINATED:
2229                 scmd->result = DID_SOFT_ERROR << 16;
2230                 break;
2231         case MPI3_IOCSTATUS_SCSI_TASK_TERMINATED:
2232         case MPI3_IOCSTATUS_SCSI_EXT_TERMINATED:
2233                 scmd->result = DID_RESET << 16;
2234                 break;
2235         case MPI3_IOCSTATUS_SCSI_RESIDUAL_MISMATCH:
2236                 if ((xfer_count == 0) || (scmd->underflow > xfer_count))
2237                         scmd->result = DID_SOFT_ERROR << 16;
2238                 else
2239                         scmd->result = (DID_OK << 16) | scsi_status;
2240                 break;
2241         case MPI3_IOCSTATUS_SCSI_DATA_UNDERRUN:
2242                 scmd->result = (DID_OK << 16) | scsi_status;
2243                 if (sense_state == MPI3_SCSI_STATE_SENSE_VALID)
2244                         break;
2245                 if (xfer_count < scmd->underflow) {
2246                         if (scsi_status == SAM_STAT_BUSY)
2247                                 scmd->result = SAM_STAT_BUSY;
2248                         else
2249                                 scmd->result = DID_SOFT_ERROR << 16;
2250                 } else if ((scsi_state & (MPI3_SCSI_STATE_NO_SCSI_STATUS)) ||
2251                     (sense_state != MPI3_SCSI_STATE_SENSE_NOT_AVAILABLE))
2252                         scmd->result = DID_SOFT_ERROR << 16;
2253                 else if (scsi_state & MPI3_SCSI_STATE_TERMINATED)
2254                         scmd->result = DID_RESET << 16;
2255                 break;
2256         case MPI3_IOCSTATUS_SCSI_DATA_OVERRUN:
2257                 scsi_set_resid(scmd, 0);
2258                 fallthrough;
2259         case MPI3_IOCSTATUS_SCSI_RECOVERED_ERROR:
2260         case MPI3_IOCSTATUS_SUCCESS:
2261                 scmd->result = (DID_OK << 16) | scsi_status;
2262                 if ((scsi_state & (MPI3_SCSI_STATE_NO_SCSI_STATUS)) ||
2263                     (sense_state == MPI3_SCSI_STATE_SENSE_FAILED) ||
2264                         (sense_state == MPI3_SCSI_STATE_SENSE_BUFF_Q_EMPTY))
2265                         scmd->result = DID_SOFT_ERROR << 16;
2266                 else if (scsi_state & MPI3_SCSI_STATE_TERMINATED)
2267                         scmd->result = DID_RESET << 16;
2268                 break;
2269         case MPI3_IOCSTATUS_EEDP_GUARD_ERROR:
2270         case MPI3_IOCSTATUS_EEDP_REF_TAG_ERROR:
2271         case MPI3_IOCSTATUS_EEDP_APP_TAG_ERROR:
2272                 mpi3mr_map_eedp_error(scmd, ioc_status);
2273                 break;
2274         case MPI3_IOCSTATUS_SCSI_PROTOCOL_ERROR:
2275         case MPI3_IOCSTATUS_INVALID_FUNCTION:
2276         case MPI3_IOCSTATUS_INVALID_SGL:
2277         case MPI3_IOCSTATUS_INTERNAL_ERROR:
2278         case MPI3_IOCSTATUS_INVALID_FIELD:
2279         case MPI3_IOCSTATUS_INVALID_STATE:
2280         case MPI3_IOCSTATUS_SCSI_IO_DATA_ERROR:
2281         case MPI3_IOCSTATUS_SCSI_TASK_MGMT_FAILED:
2282         case MPI3_IOCSTATUS_INSUFFICIENT_POWER:
2283         default:
2284                 scmd->result = DID_SOFT_ERROR << 16;
2285                 break;
2286         }
2287
2288         if (scmd->result != (DID_OK << 16) && (scmd->cmnd[0] != ATA_12) &&
2289             (scmd->cmnd[0] != ATA_16)) {
2290                 ioc_info(mrioc, "%s :scmd->result 0x%x\n", __func__,
2291                     scmd->result);
2292                 scsi_print_command(scmd);
2293                 ioc_info(mrioc,
2294                     "%s :Command issued to handle 0x%02x returned with error 0x%04x loginfo 0x%08x, qid %d\n",
2295                     __func__, dev_handle, ioc_status, ioc_loginfo,
2296                     priv->req_q_idx + 1);
2297                 ioc_info(mrioc,
2298                     " host_tag %d scsi_state 0x%02x scsi_status 0x%02x, xfer_cnt %d resp_data 0x%x\n",
2299                     host_tag, scsi_state, scsi_status, xfer_count, resp_data);
2300                 if (sense_buf) {
2301                         scsi_normalize_sense(sense_buf, sense_count, &sshdr);
2302                         ioc_info(mrioc,
2303                             "%s :sense_count 0x%x, sense_key 0x%x ASC 0x%x, ASCQ 0x%x\n",
2304                             __func__, sense_count, sshdr.sense_key,
2305                             sshdr.asc, sshdr.ascq);
2306                 }
2307         }
2308 out_success:
2309         if (priv->meta_sg_valid) {
2310                 dma_unmap_sg(&mrioc->pdev->dev, scsi_prot_sglist(scmd),
2311                     scsi_prot_sg_count(scmd), scmd->sc_data_direction);
2312         }
2313         mpi3mr_clear_scmd_priv(mrioc, scmd);
2314         scsi_dma_unmap(scmd);
2315         scsi_done(scmd);
2316 out:
2317         if (sense_buf)
2318                 mpi3mr_repost_sense_buf(mrioc,
2319                     le64_to_cpu(scsi_reply->sense_data_buffer_address));
2320 }
2321
2322 /**
2323  * mpi3mr_get_chain_idx - get free chain buffer index
2324  * @mrioc: Adapter instance reference
2325  *
2326  * Try to get a free chain buffer index from the free pool.
2327  *
2328  * Return: -1 on failure or the free chain buffer index
2329  */
2330 static int mpi3mr_get_chain_idx(struct mpi3mr_ioc *mrioc)
2331 {
2332         u8 retry_count = 5;
2333         int cmd_idx = -1;
2334
2335         do {
2336                 spin_lock(&mrioc->chain_buf_lock);
2337                 cmd_idx = find_first_zero_bit(mrioc->chain_bitmap,
2338                     mrioc->chain_buf_count);
2339                 if (cmd_idx < mrioc->chain_buf_count) {
2340                         set_bit(cmd_idx, mrioc->chain_bitmap);
2341                         spin_unlock(&mrioc->chain_buf_lock);
2342                         break;
2343                 }
2344                 spin_unlock(&mrioc->chain_buf_lock);
2345                 cmd_idx = -1;
2346         } while (retry_count--);
2347         return cmd_idx;
2348 }
2349
2350 /**
2351  * mpi3mr_prepare_sg_scmd - build scatter gather list
2352  * @mrioc: Adapter instance reference
2353  * @scmd: SCSI command reference
2354  * @scsiio_req: MPI3 SCSI IO request
2355  *
2356  * This function maps SCSI command's data and protection SGEs to
2357  * MPI request SGEs. If required additional 4K chain buffer is
2358  * used to send the SGEs.
2359  *
2360  * Return: 0 on success, -ENOMEM on dma_map_sg failure
2361  */
2362 static int mpi3mr_prepare_sg_scmd(struct mpi3mr_ioc *mrioc,
2363         struct scsi_cmnd *scmd, struct mpi3_scsi_io_request *scsiio_req)
2364 {
2365         dma_addr_t chain_dma;
2366         struct scatterlist *sg_scmd;
2367         void *sg_local, *chain;
2368         u32 chain_length;
2369         int sges_left, chain_idx;
2370         u32 sges_in_segment;
2371         u8 simple_sgl_flags;
2372         u8 simple_sgl_flags_last;
2373         u8 last_chain_sgl_flags;
2374         struct chain_element *chain_req;
2375         struct scmd_priv *priv = NULL;
2376         u32 meta_sg = le32_to_cpu(scsiio_req->flags) &
2377             MPI3_SCSIIO_FLAGS_DMAOPERATION_HOST_PI;
2378
2379         priv = scsi_cmd_priv(scmd);
2380
2381         simple_sgl_flags = MPI3_SGE_FLAGS_ELEMENT_TYPE_SIMPLE |
2382             MPI3_SGE_FLAGS_DLAS_SYSTEM;
2383         simple_sgl_flags_last = simple_sgl_flags |
2384             MPI3_SGE_FLAGS_END_OF_LIST;
2385         last_chain_sgl_flags = MPI3_SGE_FLAGS_ELEMENT_TYPE_LAST_CHAIN |
2386             MPI3_SGE_FLAGS_DLAS_SYSTEM;
2387
2388         if (meta_sg)
2389                 sg_local = &scsiio_req->sgl[MPI3_SCSIIO_METASGL_INDEX];
2390         else
2391                 sg_local = &scsiio_req->sgl;
2392
2393         if (!scsiio_req->data_length && !meta_sg) {
2394                 mpi3mr_build_zero_len_sge(sg_local);
2395                 return 0;
2396         }
2397
2398         if (meta_sg) {
2399                 sg_scmd = scsi_prot_sglist(scmd);
2400                 sges_left = dma_map_sg(&mrioc->pdev->dev,
2401                     scsi_prot_sglist(scmd),
2402                     scsi_prot_sg_count(scmd),
2403                     scmd->sc_data_direction);
2404                 priv->meta_sg_valid = 1; /* To unmap meta sg DMA */
2405         } else {
2406                 sg_scmd = scsi_sglist(scmd);
2407                 sges_left = scsi_dma_map(scmd);
2408         }
2409
2410         if (sges_left < 0) {
2411                 sdev_printk(KERN_ERR, scmd->device,
2412                     "scsi_dma_map failed: request for %d bytes!\n",
2413                     scsi_bufflen(scmd));
2414                 return -ENOMEM;
2415         }
2416         if (sges_left > MPI3MR_SG_DEPTH) {
2417                 sdev_printk(KERN_ERR, scmd->device,
2418                     "scsi_dma_map returned unsupported sge count %d!\n",
2419                     sges_left);
2420                 return -ENOMEM;
2421         }
2422
2423         sges_in_segment = (mrioc->facts.op_req_sz -
2424             offsetof(struct mpi3_scsi_io_request, sgl)) / sizeof(struct mpi3_sge_common);
2425
2426         if (scsiio_req->sgl[0].eedp.flags ==
2427             MPI3_SGE_FLAGS_ELEMENT_TYPE_EXTENDED && !meta_sg) {
2428                 sg_local += sizeof(struct mpi3_sge_common);
2429                 sges_in_segment--;
2430                 /* Reserve 1st segment (scsiio_req->sgl[0]) for eedp */
2431         }
2432
2433         if (scsiio_req->msg_flags ==
2434             MPI3_SCSIIO_MSGFLAGS_METASGL_VALID && !meta_sg) {
2435                 sges_in_segment--;
2436                 /* Reserve last segment (scsiio_req->sgl[3]) for meta sg */
2437         }
2438
2439         if (meta_sg)
2440                 sges_in_segment = 1;
2441
2442         if (sges_left <= sges_in_segment)
2443                 goto fill_in_last_segment;
2444
2445         /* fill in main message segment when there is a chain following */
2446         while (sges_in_segment > 1) {
2447                 mpi3mr_add_sg_single(sg_local, simple_sgl_flags,
2448                     sg_dma_len(sg_scmd), sg_dma_address(sg_scmd));
2449                 sg_scmd = sg_next(sg_scmd);
2450                 sg_local += sizeof(struct mpi3_sge_common);
2451                 sges_left--;
2452                 sges_in_segment--;
2453         }
2454
2455         chain_idx = mpi3mr_get_chain_idx(mrioc);
2456         if (chain_idx < 0)
2457                 return -1;
2458         chain_req = &mrioc->chain_sgl_list[chain_idx];
2459         if (meta_sg)
2460                 priv->meta_chain_idx = chain_idx;
2461         else
2462                 priv->chain_idx = chain_idx;
2463
2464         chain = chain_req->addr;
2465         chain_dma = chain_req->dma_addr;
2466         sges_in_segment = sges_left;
2467         chain_length = sges_in_segment * sizeof(struct mpi3_sge_common);
2468
2469         mpi3mr_add_sg_single(sg_local, last_chain_sgl_flags,
2470             chain_length, chain_dma);
2471
2472         sg_local = chain;
2473
2474 fill_in_last_segment:
2475         while (sges_left > 0) {
2476                 if (sges_left == 1)
2477                         mpi3mr_add_sg_single(sg_local,
2478                             simple_sgl_flags_last, sg_dma_len(sg_scmd),
2479                             sg_dma_address(sg_scmd));
2480                 else
2481                         mpi3mr_add_sg_single(sg_local, simple_sgl_flags,
2482                             sg_dma_len(sg_scmd), sg_dma_address(sg_scmd));
2483                 sg_scmd = sg_next(sg_scmd);
2484                 sg_local += sizeof(struct mpi3_sge_common);
2485                 sges_left--;
2486         }
2487
2488         return 0;
2489 }
2490
2491 /**
2492  * mpi3mr_build_sg_scmd - build scatter gather list for SCSI IO
2493  * @mrioc: Adapter instance reference
2494  * @scmd: SCSI command reference
2495  * @scsiio_req: MPI3 SCSI IO request
2496  *
2497  * This function calls mpi3mr_prepare_sg_scmd for constructing
2498  * both data SGEs and protection information SGEs in the MPI
2499  * format from the SCSI Command as appropriate .
2500  *
2501  * Return: return value of mpi3mr_prepare_sg_scmd.
2502  */
2503 static int mpi3mr_build_sg_scmd(struct mpi3mr_ioc *mrioc,
2504         struct scsi_cmnd *scmd, struct mpi3_scsi_io_request *scsiio_req)
2505 {
2506         int ret;
2507
2508         ret = mpi3mr_prepare_sg_scmd(mrioc, scmd, scsiio_req);
2509         if (ret)
2510                 return ret;
2511
2512         if (scsiio_req->msg_flags == MPI3_SCSIIO_MSGFLAGS_METASGL_VALID) {
2513                 /* There is a valid meta sg */
2514                 scsiio_req->flags |=
2515                     cpu_to_le32(MPI3_SCSIIO_FLAGS_DMAOPERATION_HOST_PI);
2516                 ret = mpi3mr_prepare_sg_scmd(mrioc, scmd, scsiio_req);
2517         }
2518
2519         return ret;
2520 }
2521
2522 /**
2523  * mpi3mr_print_response_code - print TM response as a string
2524  * @mrioc: Adapter instance reference
2525  * @resp_code: TM response code
2526  *
2527  * Print TM response code as a readable string.
2528  *
2529  * Return: Nothing.
2530  */
2531 static void mpi3mr_print_response_code(struct mpi3mr_ioc *mrioc, u8 resp_code)
2532 {
2533         char *desc;
2534
2535         switch (resp_code) {
2536         case MPI3MR_RSP_TM_COMPLETE:
2537                 desc = "task management request completed";
2538                 break;
2539         case MPI3MR_RSP_INVALID_FRAME:
2540                 desc = "invalid frame";
2541                 break;
2542         case MPI3MR_RSP_TM_NOT_SUPPORTED:
2543                 desc = "task management request not supported";
2544                 break;
2545         case MPI3MR_RSP_TM_FAILED:
2546                 desc = "task management request failed";
2547                 break;
2548         case MPI3MR_RSP_TM_SUCCEEDED:
2549                 desc = "task management request succeeded";
2550                 break;
2551         case MPI3MR_RSP_TM_INVALID_LUN:
2552                 desc = "invalid lun";
2553                 break;
2554         case MPI3MR_RSP_TM_OVERLAPPED_TAG:
2555                 desc = "overlapped tag attempted";
2556                 break;
2557         case MPI3MR_RSP_IO_QUEUED_ON_IOC:
2558                 desc = "task queued, however not sent to target";
2559                 break;
2560         default:
2561                 desc = "unknown";
2562                 break;
2563         }
2564         ioc_info(mrioc, "%s :response_code(0x%01x): %s\n", __func__,
2565             resp_code, desc);
2566 }
2567
2568 /**
2569  * mpi3mr_issue_tm - Issue Task Management request
2570  * @mrioc: Adapter instance reference
2571  * @tm_type: Task Management type
2572  * @handle: Device handle
2573  * @lun: lun ID
2574  * @htag: Host tag of the TM request
2575  * @drv_cmd: Internal command tracker
2576  * @resp_code: Response code place holder
2577  * @cmd_priv: SCSI command private data
2578  *
2579  * Issues a Task Management Request to the controller for a
2580  * specified target, lun and command and wait for its completion
2581  * and check TM response. Recover the TM if it timed out by
2582  * issuing controller reset.
2583  *
2584  * Return: 0 on success, non-zero on errors
2585  */
2586 static int mpi3mr_issue_tm(struct mpi3mr_ioc *mrioc, u8 tm_type,
2587         u16 handle, uint lun, u16 htag, ulong timeout,
2588         struct mpi3mr_drv_cmd *drv_cmd,
2589         u8 *resp_code, struct scmd_priv *cmd_priv)
2590 {
2591         struct mpi3_scsi_task_mgmt_request tm_req;
2592         struct mpi3_scsi_task_mgmt_reply *tm_reply = NULL;
2593         int retval = 0;
2594         struct mpi3mr_tgt_dev *tgtdev = NULL;
2595         struct mpi3mr_stgt_priv_data *scsi_tgt_priv_data = NULL;
2596         struct op_req_qinfo *op_req_q = NULL;
2597
2598         ioc_info(mrioc, "%s :Issue TM: TM type (0x%x) for devhandle 0x%04x\n",
2599              __func__, tm_type, handle);
2600         if (mrioc->unrecoverable) {
2601                 retval = -1;
2602                 ioc_err(mrioc, "%s :Issue TM: Unrecoverable controller\n",
2603                     __func__);
2604                 goto out;
2605         }
2606
2607         memset(&tm_req, 0, sizeof(tm_req));
2608         mutex_lock(&drv_cmd->mutex);
2609         if (drv_cmd->state & MPI3MR_CMD_PENDING) {
2610                 retval = -1;
2611                 ioc_err(mrioc, "%s :Issue TM: Command is in use\n", __func__);
2612                 mutex_unlock(&drv_cmd->mutex);
2613                 goto out;
2614         }
2615         if (mrioc->reset_in_progress) {
2616                 retval = -1;
2617                 ioc_err(mrioc, "%s :Issue TM: Reset in progress\n", __func__);
2618                 mutex_unlock(&drv_cmd->mutex);
2619                 goto out;
2620         }
2621
2622         drv_cmd->state = MPI3MR_CMD_PENDING;
2623         drv_cmd->is_waiting = 1;
2624         drv_cmd->callback = NULL;
2625         tm_req.dev_handle = cpu_to_le16(handle);
2626         tm_req.task_type = tm_type;
2627         tm_req.host_tag = cpu_to_le16(htag);
2628
2629         int_to_scsilun(lun, (struct scsi_lun *)tm_req.lun);
2630         tm_req.function = MPI3_FUNCTION_SCSI_TASK_MGMT;
2631
2632         tgtdev = mpi3mr_get_tgtdev_by_handle(mrioc, handle);
2633         if (tgtdev && tgtdev->starget && tgtdev->starget->hostdata) {
2634                 scsi_tgt_priv_data = (struct mpi3mr_stgt_priv_data *)
2635                     tgtdev->starget->hostdata;
2636                 atomic_inc(&scsi_tgt_priv_data->block_io);
2637         }
2638         if (cmd_priv) {
2639                 op_req_q = &mrioc->req_qinfo[cmd_priv->req_q_idx];
2640                 tm_req.task_host_tag = cpu_to_le16(cmd_priv->host_tag);
2641                 tm_req.task_request_queue_id = cpu_to_le16(op_req_q->qid);
2642         }
2643         if (tgtdev && (tgtdev->dev_type == MPI3_DEVICE_DEVFORM_PCIE)) {
2644                 if (cmd_priv && tgtdev->dev_spec.pcie_inf.abort_to)
2645                         timeout = tgtdev->dev_spec.pcie_inf.abort_to;
2646                 else if (!cmd_priv && tgtdev->dev_spec.pcie_inf.reset_to)
2647                         timeout = tgtdev->dev_spec.pcie_inf.reset_to;
2648         }
2649
2650         init_completion(&drv_cmd->done);
2651         retval = mpi3mr_admin_request_post(mrioc, &tm_req, sizeof(tm_req), 1);
2652         if (retval) {
2653                 ioc_err(mrioc, "%s :Issue TM: Admin Post failed\n", __func__);
2654                 goto out_unlock;
2655         }
2656         wait_for_completion_timeout(&drv_cmd->done, (timeout * HZ));
2657
2658         if (!(drv_cmd->state & MPI3MR_CMD_COMPLETE)) {
2659                 ioc_err(mrioc, "%s :Issue TM: command timed out\n", __func__);
2660                 drv_cmd->is_waiting = 0;
2661                 retval = -1;
2662                 if (!(drv_cmd->state & MPI3MR_CMD_RESET))
2663                         mpi3mr_soft_reset_handler(mrioc,
2664                             MPI3MR_RESET_FROM_TM_TIMEOUT, 1);
2665                 goto out_unlock;
2666         }
2667
2668         if (drv_cmd->state & MPI3MR_CMD_REPLY_VALID)
2669                 tm_reply = (struct mpi3_scsi_task_mgmt_reply *)drv_cmd->reply;
2670
2671         if (drv_cmd->ioc_status != MPI3_IOCSTATUS_SUCCESS) {
2672                 ioc_err(mrioc,
2673                     "%s :Issue TM: handle(0x%04x) Failed ioc_status(0x%04x) Loginfo(0x%08x)\n",
2674                     __func__, handle, drv_cmd->ioc_status,
2675                     drv_cmd->ioc_loginfo);
2676                 retval = -1;
2677                 goto out_unlock;
2678         }
2679
2680         if (!tm_reply) {
2681                 ioc_err(mrioc, "%s :Issue TM: No TM Reply message\n", __func__);
2682                 retval = -1;
2683                 goto out_unlock;
2684         }
2685
2686         *resp_code = le32_to_cpu(tm_reply->response_data) &
2687             MPI3MR_RI_MASK_RESPCODE;
2688         switch (*resp_code) {
2689         case MPI3MR_RSP_TM_SUCCEEDED:
2690         case MPI3MR_RSP_TM_COMPLETE:
2691                 break;
2692         case MPI3MR_RSP_IO_QUEUED_ON_IOC:
2693                 if (tm_type != MPI3_SCSITASKMGMT_TASKTYPE_QUERY_TASK)
2694                         retval = -1;
2695                 break;
2696         default:
2697                 retval = -1;
2698                 break;
2699         }
2700
2701         ioc_info(mrioc,
2702             "%s :Issue TM: Completed TM type (0x%x) handle(0x%04x) ",
2703             __func__, tm_type, handle);
2704         ioc_info(mrioc,
2705             "with ioc_status(0x%04x), loginfo(0x%08x), term_count(0x%08x)\n",
2706             drv_cmd->ioc_status, drv_cmd->ioc_loginfo,
2707             le32_to_cpu(tm_reply->termination_count));
2708         mpi3mr_print_response_code(mrioc, *resp_code);
2709
2710 out_unlock:
2711         drv_cmd->state = MPI3MR_CMD_NOTUSED;
2712         mutex_unlock(&drv_cmd->mutex);
2713         if (scsi_tgt_priv_data)
2714                 atomic_dec_if_positive(&scsi_tgt_priv_data->block_io);
2715         if (tgtdev)
2716                 mpi3mr_tgtdev_put(tgtdev);
2717         if (!retval) {
2718                 /*
2719                  * Flush all IRQ handlers by calling synchronize_irq().
2720                  * mpi3mr_ioc_disable_intr() takes care of it.
2721                  */
2722                 mpi3mr_ioc_disable_intr(mrioc);
2723                 mpi3mr_ioc_enable_intr(mrioc);
2724         }
2725 out:
2726         return retval;
2727 }
2728
2729 /**
2730  * mpi3mr_bios_param - BIOS param callback
2731  * @sdev: SCSI device reference
2732  * @bdev: Block device reference
2733  * @capacity: Capacity in logical sectors
2734  * @params: Parameter array
2735  *
2736  * Just the parameters with heads/secots/cylinders.
2737  *
2738  * Return: 0 always
2739  */
2740 static int mpi3mr_bios_param(struct scsi_device *sdev,
2741         struct block_device *bdev, sector_t capacity, int params[])
2742 {
2743         int heads;
2744         int sectors;
2745         sector_t cylinders;
2746         ulong dummy;
2747
2748         heads = 64;
2749         sectors = 32;
2750
2751         dummy = heads * sectors;
2752         cylinders = capacity;
2753         sector_div(cylinders, dummy);
2754
2755         if ((ulong)capacity >= 0x200000) {
2756                 heads = 255;
2757                 sectors = 63;
2758                 dummy = heads * sectors;
2759                 cylinders = capacity;
2760                 sector_div(cylinders, dummy);
2761         }
2762
2763         params[0] = heads;
2764         params[1] = sectors;
2765         params[2] = cylinders;
2766         return 0;
2767 }
2768
2769 /**
2770  * mpi3mr_map_queues - Map queues callback handler
2771  * @shost: SCSI host reference
2772  *
2773  * Call the blk_mq_pci_map_queues with from which operational
2774  * queue the mapping has to be done
2775  *
2776  * Return: return of blk_mq_pci_map_queues
2777  */
2778 static int mpi3mr_map_queues(struct Scsi_Host *shost)
2779 {
2780         struct mpi3mr_ioc *mrioc = shost_priv(shost);
2781
2782         return blk_mq_pci_map_queues(&shost->tag_set.map[HCTX_TYPE_DEFAULT],
2783             mrioc->pdev, mrioc->op_reply_q_offset);
2784 }
2785
2786 /**
2787  * mpi3mr_get_fw_pending_ios - Calculate pending I/O count
2788  * @mrioc: Adapter instance reference
2789  *
2790  * Calculate the pending I/Os for the controller and return.
2791  *
2792  * Return: Number of pending I/Os
2793  */
2794 static inline int mpi3mr_get_fw_pending_ios(struct mpi3mr_ioc *mrioc)
2795 {
2796         u16 i;
2797         uint pend_ios = 0;
2798
2799         for (i = 0; i < mrioc->num_op_reply_q; i++)
2800                 pend_ios += atomic_read(&mrioc->op_reply_qinfo[i].pend_ios);
2801         return pend_ios;
2802 }
2803
2804 /**
2805  * mpi3mr_print_pending_host_io - print pending I/Os
2806  * @mrioc: Adapter instance reference
2807  *
2808  * Print number of pending I/Os and each I/O details prior to
2809  * reset for debug purpose.
2810  *
2811  * Return: Nothing
2812  */
2813 static void mpi3mr_print_pending_host_io(struct mpi3mr_ioc *mrioc)
2814 {
2815         struct Scsi_Host *shost = mrioc->shost;
2816
2817         ioc_info(mrioc, "%s :Pending commands prior to reset: %d\n",
2818             __func__, mpi3mr_get_fw_pending_ios(mrioc));
2819         blk_mq_tagset_busy_iter(&shost->tag_set,
2820             mpi3mr_print_scmd, (void *)mrioc);
2821 }
2822
2823 /**
2824  * mpi3mr_wait_for_host_io - block for I/Os to complete
2825  * @mrioc: Adapter instance reference
2826  * @timeout: time out in seconds
2827  * Waits for pending I/Os for the given adapter to complete or
2828  * to hit the timeout.
2829  *
2830  * Return: Nothing
2831  */
2832 void mpi3mr_wait_for_host_io(struct mpi3mr_ioc *mrioc, u32 timeout)
2833 {
2834         enum mpi3mr_iocstate iocstate;
2835         int i = 0;
2836
2837         iocstate = mpi3mr_get_iocstate(mrioc);
2838         if (iocstate != MRIOC_STATE_READY)
2839                 return;
2840
2841         if (!mpi3mr_get_fw_pending_ios(mrioc))
2842                 return;
2843         ioc_info(mrioc,
2844             "%s :Waiting for %d seconds prior to reset for %d I/O\n",
2845             __func__, timeout, mpi3mr_get_fw_pending_ios(mrioc));
2846
2847         for (i = 0; i < timeout; i++) {
2848                 if (!mpi3mr_get_fw_pending_ios(mrioc))
2849                         break;
2850                 iocstate = mpi3mr_get_iocstate(mrioc);
2851                 if (iocstate != MRIOC_STATE_READY)
2852                         break;
2853                 msleep(1000);
2854         }
2855
2856         ioc_info(mrioc, "%s :Pending I/Os after wait is: %d\n", __func__,
2857             mpi3mr_get_fw_pending_ios(mrioc));
2858 }
2859
2860 /**
2861  * mpi3mr_eh_host_reset - Host reset error handling callback
2862  * @scmd: SCSI command reference
2863  *
2864  * Issue controller reset if the scmd is for a Physical Device,
2865  * if the scmd is for RAID volume, then wait for
2866  * MPI3MR_RAID_ERRREC_RESET_TIMEOUT and checke whether any
2867  * pending I/Os prior to issuing reset to the controller.
2868  *
2869  * Return: SUCCESS of successful reset else FAILED
2870  */
2871 static int mpi3mr_eh_host_reset(struct scsi_cmnd *scmd)
2872 {
2873         struct mpi3mr_ioc *mrioc = shost_priv(scmd->device->host);
2874         struct mpi3mr_stgt_priv_data *stgt_priv_data;
2875         struct mpi3mr_sdev_priv_data *sdev_priv_data;
2876         u8 dev_type = MPI3_DEVICE_DEVFORM_VD;
2877         int retval = FAILED, ret;
2878
2879         sdev_priv_data = scmd->device->hostdata;
2880         if (sdev_priv_data && sdev_priv_data->tgt_priv_data) {
2881                 stgt_priv_data = sdev_priv_data->tgt_priv_data;
2882                 dev_type = stgt_priv_data->dev_type;
2883         }
2884
2885         if (dev_type == MPI3_DEVICE_DEVFORM_VD) {
2886                 mpi3mr_wait_for_host_io(mrioc,
2887                     MPI3MR_RAID_ERRREC_RESET_TIMEOUT);
2888                 if (!mpi3mr_get_fw_pending_ios(mrioc)) {
2889                         retval = SUCCESS;
2890                         goto out;
2891                 }
2892         }
2893
2894         mpi3mr_print_pending_host_io(mrioc);
2895         ret = mpi3mr_soft_reset_handler(mrioc,
2896             MPI3MR_RESET_FROM_EH_HOS, 1);
2897         if (ret)
2898                 goto out;
2899
2900         retval = SUCCESS;
2901 out:
2902         sdev_printk(KERN_INFO, scmd->device,
2903             "Host reset is %s for scmd(%p)\n",
2904             ((retval == SUCCESS) ? "SUCCESS" : "FAILED"), scmd);
2905
2906         return retval;
2907 }
2908
2909 /**
2910  * mpi3mr_eh_target_reset - Target reset error handling callback
2911  * @scmd: SCSI command reference
2912  *
2913  * Issue Target reset Task Management and verify the scmd is
2914  * terminated successfully and return status accordingly.
2915  *
2916  * Return: SUCCESS of successful termination of the scmd else
2917  *         FAILED
2918  */
2919 static int mpi3mr_eh_target_reset(struct scsi_cmnd *scmd)
2920 {
2921         struct mpi3mr_ioc *mrioc = shost_priv(scmd->device->host);
2922         struct mpi3mr_stgt_priv_data *stgt_priv_data;
2923         struct mpi3mr_sdev_priv_data *sdev_priv_data;
2924         u16 dev_handle;
2925         u8 resp_code = 0;
2926         int retval = FAILED, ret = 0;
2927
2928         sdev_printk(KERN_INFO, scmd->device,
2929             "Attempting Target Reset! scmd(%p)\n", scmd);
2930         scsi_print_command(scmd);
2931
2932         sdev_priv_data = scmd->device->hostdata;
2933         if (!sdev_priv_data || !sdev_priv_data->tgt_priv_data) {
2934                 sdev_printk(KERN_INFO, scmd->device,
2935                     "SCSI device is not available\n");
2936                 retval = SUCCESS;
2937                 goto out;
2938         }
2939
2940         stgt_priv_data = sdev_priv_data->tgt_priv_data;
2941         dev_handle = stgt_priv_data->dev_handle;
2942         sdev_printk(KERN_INFO, scmd->device,
2943             "Target Reset is issued to handle(0x%04x)\n",
2944             dev_handle);
2945
2946         ret = mpi3mr_issue_tm(mrioc,
2947             MPI3_SCSITASKMGMT_TASKTYPE_TARGET_RESET, dev_handle,
2948             sdev_priv_data->lun_id, MPI3MR_HOSTTAG_BLK_TMS,
2949             MPI3MR_RESETTM_TIMEOUT, &mrioc->host_tm_cmds, &resp_code, NULL);
2950
2951         if (ret)
2952                 goto out;
2953
2954         retval = SUCCESS;
2955 out:
2956         sdev_printk(KERN_INFO, scmd->device,
2957             "Target reset is %s for scmd(%p)\n",
2958             ((retval == SUCCESS) ? "SUCCESS" : "FAILED"), scmd);
2959
2960         return retval;
2961 }
2962
2963 /**
2964  * mpi3mr_eh_dev_reset- Device reset error handling callback
2965  * @scmd: SCSI command reference
2966  *
2967  * Issue lun reset Task Management and verify the scmd is
2968  * terminated successfully and return status accordingly.
2969  *
2970  * Return: SUCCESS of successful termination of the scmd else
2971  *         FAILED
2972  */
2973 static int mpi3mr_eh_dev_reset(struct scsi_cmnd *scmd)
2974 {
2975         struct mpi3mr_ioc *mrioc = shost_priv(scmd->device->host);
2976         struct mpi3mr_stgt_priv_data *stgt_priv_data;
2977         struct mpi3mr_sdev_priv_data *sdev_priv_data;
2978         u16 dev_handle;
2979         u8 resp_code = 0;
2980         int retval = FAILED, ret = 0;
2981
2982         sdev_printk(KERN_INFO, scmd->device,
2983             "Attempting Device(lun) Reset! scmd(%p)\n", scmd);
2984         scsi_print_command(scmd);
2985
2986         sdev_priv_data = scmd->device->hostdata;
2987         if (!sdev_priv_data || !sdev_priv_data->tgt_priv_data) {
2988                 sdev_printk(KERN_INFO, scmd->device,
2989                     "SCSI device is not available\n");
2990                 retval = SUCCESS;
2991                 goto out;
2992         }
2993
2994         stgt_priv_data = sdev_priv_data->tgt_priv_data;
2995         dev_handle = stgt_priv_data->dev_handle;
2996         sdev_printk(KERN_INFO, scmd->device,
2997             "Device(lun) Reset is issued to handle(0x%04x)\n", dev_handle);
2998
2999         ret = mpi3mr_issue_tm(mrioc,
3000             MPI3_SCSITASKMGMT_TASKTYPE_LOGICAL_UNIT_RESET, dev_handle,
3001             sdev_priv_data->lun_id, MPI3MR_HOSTTAG_BLK_TMS,
3002             MPI3MR_RESETTM_TIMEOUT, &mrioc->host_tm_cmds, &resp_code, NULL);
3003
3004         if (ret)
3005                 goto out;
3006
3007         retval = SUCCESS;
3008 out:
3009         sdev_printk(KERN_INFO, scmd->device,
3010             "Device(lun) reset is %s for scmd(%p)\n",
3011             ((retval == SUCCESS) ? "SUCCESS" : "FAILED"), scmd);
3012
3013         return retval;
3014 }
3015
3016 /**
3017  * mpi3mr_scan_start - Scan start callback handler
3018  * @shost: SCSI host reference
3019  *
3020  * Issue port enable request asynchronously.
3021  *
3022  * Return: Nothing
3023  */
3024 static void mpi3mr_scan_start(struct Scsi_Host *shost)
3025 {
3026         struct mpi3mr_ioc *mrioc = shost_priv(shost);
3027
3028         mrioc->scan_started = 1;
3029         ioc_info(mrioc, "%s :Issuing Port Enable\n", __func__);
3030         if (mpi3mr_issue_port_enable(mrioc, 1)) {
3031                 ioc_err(mrioc, "%s :Issuing port enable failed\n", __func__);
3032                 mrioc->scan_started = 0;
3033                 mrioc->scan_failed = MPI3_IOCSTATUS_INTERNAL_ERROR;
3034         }
3035 }
3036
3037 /**
3038  * mpi3mr_scan_finished - Scan finished callback handler
3039  * @shost: SCSI host reference
3040  * @time: Jiffies from the scan start
3041  *
3042  * Checks whether the port enable is completed or timedout or
3043  * failed and set the scan status accordingly after taking any
3044  * recovery if required.
3045  *
3046  * Return: 1 on scan finished or timed out, 0 for in progress
3047  */
3048 static int mpi3mr_scan_finished(struct Scsi_Host *shost,
3049         unsigned long time)
3050 {
3051         struct mpi3mr_ioc *mrioc = shost_priv(shost);
3052         u32 pe_timeout = MPI3MR_PORTENABLE_TIMEOUT;
3053
3054         if (time >= (pe_timeout * HZ)) {
3055                 mrioc->init_cmds.is_waiting = 0;
3056                 mrioc->init_cmds.callback = NULL;
3057                 mrioc->init_cmds.state = MPI3MR_CMD_NOTUSED;
3058                 ioc_err(mrioc, "%s :port enable request timed out\n", __func__);
3059                 mrioc->is_driver_loading = 0;
3060                 mpi3mr_soft_reset_handler(mrioc,
3061                     MPI3MR_RESET_FROM_PE_TIMEOUT, 1);
3062         }
3063
3064         if (mrioc->scan_failed) {
3065                 ioc_err(mrioc,
3066                     "%s :port enable failed with (ioc_status=0x%08x)\n",
3067                     __func__, mrioc->scan_failed);
3068                 mrioc->is_driver_loading = 0;
3069                 mrioc->stop_drv_processing = 1;
3070                 return 1;
3071         }
3072
3073         if (mrioc->scan_started)
3074                 return 0;
3075         ioc_info(mrioc, "%s :port enable: SUCCESS\n", __func__);
3076         mpi3mr_start_watchdog(mrioc);
3077         mrioc->is_driver_loading = 0;
3078
3079         return 1;
3080 }
3081
3082 /**
3083  * mpi3mr_slave_destroy - Slave destroy callback handler
3084  * @sdev: SCSI device reference
3085  *
3086  * Cleanup and free per device(lun) private data.
3087  *
3088  * Return: Nothing.
3089  */
3090 static void mpi3mr_slave_destroy(struct scsi_device *sdev)
3091 {
3092         struct Scsi_Host *shost;
3093         struct mpi3mr_ioc *mrioc;
3094         struct mpi3mr_stgt_priv_data *scsi_tgt_priv_data;
3095         struct mpi3mr_tgt_dev *tgt_dev;
3096         unsigned long flags;
3097         struct scsi_target *starget;
3098
3099         if (!sdev->hostdata)
3100                 return;
3101
3102         starget = scsi_target(sdev);
3103         shost = dev_to_shost(&starget->dev);
3104         mrioc = shost_priv(shost);
3105         scsi_tgt_priv_data = starget->hostdata;
3106
3107         scsi_tgt_priv_data->num_luns--;
3108
3109         spin_lock_irqsave(&mrioc->tgtdev_lock, flags);
3110         tgt_dev = __mpi3mr_get_tgtdev_by_perst_id(mrioc, starget->id);
3111         if (tgt_dev && (!scsi_tgt_priv_data->num_luns))
3112                 tgt_dev->starget = NULL;
3113         if (tgt_dev)
3114                 mpi3mr_tgtdev_put(tgt_dev);
3115         spin_unlock_irqrestore(&mrioc->tgtdev_lock, flags);
3116
3117         kfree(sdev->hostdata);
3118         sdev->hostdata = NULL;
3119 }
3120
3121 /**
3122  * mpi3mr_target_destroy - Target destroy callback handler
3123  * @starget: SCSI target reference
3124  *
3125  * Cleanup and free per target private data.
3126  *
3127  * Return: Nothing.
3128  */
3129 static void mpi3mr_target_destroy(struct scsi_target *starget)
3130 {
3131         struct Scsi_Host *shost;
3132         struct mpi3mr_ioc *mrioc;
3133         struct mpi3mr_stgt_priv_data *scsi_tgt_priv_data;
3134         struct mpi3mr_tgt_dev *tgt_dev;
3135         unsigned long flags;
3136
3137         if (!starget->hostdata)
3138                 return;
3139
3140         shost = dev_to_shost(&starget->dev);
3141         mrioc = shost_priv(shost);
3142         scsi_tgt_priv_data = starget->hostdata;
3143
3144         spin_lock_irqsave(&mrioc->tgtdev_lock, flags);
3145         tgt_dev = __mpi3mr_get_tgtdev_from_tgtpriv(mrioc, scsi_tgt_priv_data);
3146         if (tgt_dev && (tgt_dev->starget == starget) &&
3147             (tgt_dev->perst_id == starget->id))
3148                 tgt_dev->starget = NULL;
3149         if (tgt_dev) {
3150                 scsi_tgt_priv_data->tgt_dev = NULL;
3151                 scsi_tgt_priv_data->perst_id = 0;
3152                 mpi3mr_tgtdev_put(tgt_dev);
3153                 mpi3mr_tgtdev_put(tgt_dev);
3154         }
3155         spin_unlock_irqrestore(&mrioc->tgtdev_lock, flags);
3156
3157         kfree(starget->hostdata);
3158         starget->hostdata = NULL;
3159 }
3160
3161 /**
3162  * mpi3mr_slave_configure - Slave configure callback handler
3163  * @sdev: SCSI device reference
3164  *
3165  * Configure queue depth, max hardware sectors and virt boundary
3166  * as required
3167  *
3168  * Return: 0 always.
3169  */
3170 static int mpi3mr_slave_configure(struct scsi_device *sdev)
3171 {
3172         struct scsi_target *starget;
3173         struct Scsi_Host *shost;
3174         struct mpi3mr_ioc *mrioc;
3175         struct mpi3mr_tgt_dev *tgt_dev;
3176         unsigned long flags;
3177         int retval = 0;
3178
3179         starget = scsi_target(sdev);
3180         shost = dev_to_shost(&starget->dev);
3181         mrioc = shost_priv(shost);
3182
3183         spin_lock_irqsave(&mrioc->tgtdev_lock, flags);
3184         tgt_dev = __mpi3mr_get_tgtdev_by_perst_id(mrioc, starget->id);
3185         spin_unlock_irqrestore(&mrioc->tgtdev_lock, flags);
3186         if (!tgt_dev)
3187                 return -ENXIO;
3188
3189         mpi3mr_change_queue_depth(sdev, tgt_dev->q_depth);
3190         switch (tgt_dev->dev_type) {
3191         case MPI3_DEVICE_DEVFORM_PCIE:
3192                 /*The block layer hw sector size = 512*/
3193                 blk_queue_max_hw_sectors(sdev->request_queue,
3194                     tgt_dev->dev_spec.pcie_inf.mdts / 512);
3195                 blk_queue_virt_boundary(sdev->request_queue,
3196                     ((1 << tgt_dev->dev_spec.pcie_inf.pgsz) - 1));
3197                 break;
3198         default:
3199                 break;
3200         }
3201
3202         mpi3mr_tgtdev_put(tgt_dev);
3203
3204         return retval;
3205 }
3206
3207 /**
3208  * mpi3mr_slave_alloc -Slave alloc callback handler
3209  * @sdev: SCSI device reference
3210  *
3211  * Allocate per device(lun) private data and initialize it.
3212  *
3213  * Return: 0 on success -ENOMEM on memory allocation failure.
3214  */
3215 static int mpi3mr_slave_alloc(struct scsi_device *sdev)
3216 {
3217         struct Scsi_Host *shost;
3218         struct mpi3mr_ioc *mrioc;
3219         struct mpi3mr_stgt_priv_data *scsi_tgt_priv_data;
3220         struct mpi3mr_tgt_dev *tgt_dev;
3221         struct mpi3mr_sdev_priv_data *scsi_dev_priv_data;
3222         unsigned long flags;
3223         struct scsi_target *starget;
3224         int retval = 0;
3225
3226         starget = scsi_target(sdev);
3227         shost = dev_to_shost(&starget->dev);
3228         mrioc = shost_priv(shost);
3229         scsi_tgt_priv_data = starget->hostdata;
3230
3231         spin_lock_irqsave(&mrioc->tgtdev_lock, flags);
3232         tgt_dev = __mpi3mr_get_tgtdev_by_perst_id(mrioc, starget->id);
3233
3234         if (tgt_dev) {
3235                 if (tgt_dev->starget == NULL)
3236                         tgt_dev->starget = starget;
3237                 mpi3mr_tgtdev_put(tgt_dev);
3238                 retval = 0;
3239         } else {
3240                 spin_unlock_irqrestore(&mrioc->tgtdev_lock, flags);
3241                 return -ENXIO;
3242         }
3243
3244         spin_unlock_irqrestore(&mrioc->tgtdev_lock, flags);
3245
3246         scsi_dev_priv_data = kzalloc(sizeof(*scsi_dev_priv_data), GFP_KERNEL);
3247         if (!scsi_dev_priv_data)
3248                 return -ENOMEM;
3249
3250         scsi_dev_priv_data->lun_id = sdev->lun;
3251         scsi_dev_priv_data->tgt_priv_data = scsi_tgt_priv_data;
3252         sdev->hostdata = scsi_dev_priv_data;
3253
3254         scsi_tgt_priv_data->num_luns++;
3255
3256         return retval;
3257 }
3258
3259 /**
3260  * mpi3mr_target_alloc - Target alloc callback handler
3261  * @starget: SCSI target reference
3262  *
3263  * Allocate per target private data and initialize it.
3264  *
3265  * Return: 0 on success -ENOMEM on memory allocation failure.
3266  */
3267 static int mpi3mr_target_alloc(struct scsi_target *starget)
3268 {
3269         struct Scsi_Host *shost = dev_to_shost(&starget->dev);
3270         struct mpi3mr_ioc *mrioc = shost_priv(shost);
3271         struct mpi3mr_stgt_priv_data *scsi_tgt_priv_data;
3272         struct mpi3mr_tgt_dev *tgt_dev;
3273         unsigned long flags;
3274         int retval = 0;
3275
3276         scsi_tgt_priv_data = kzalloc(sizeof(*scsi_tgt_priv_data), GFP_KERNEL);
3277         if (!scsi_tgt_priv_data)
3278                 return -ENOMEM;
3279
3280         starget->hostdata = scsi_tgt_priv_data;
3281
3282         spin_lock_irqsave(&mrioc->tgtdev_lock, flags);
3283         tgt_dev = __mpi3mr_get_tgtdev_by_perst_id(mrioc, starget->id);
3284         if (tgt_dev && !tgt_dev->is_hidden) {
3285                 scsi_tgt_priv_data->starget = starget;
3286                 scsi_tgt_priv_data->dev_handle = tgt_dev->dev_handle;
3287                 scsi_tgt_priv_data->perst_id = tgt_dev->perst_id;
3288                 scsi_tgt_priv_data->dev_type = tgt_dev->dev_type;
3289                 scsi_tgt_priv_data->tgt_dev = tgt_dev;
3290                 tgt_dev->starget = starget;
3291                 atomic_set(&scsi_tgt_priv_data->block_io, 0);
3292                 retval = 0;
3293         } else
3294                 retval = -ENXIO;
3295         spin_unlock_irqrestore(&mrioc->tgtdev_lock, flags);
3296
3297         return retval;
3298 }
3299
3300 /**
3301  * mpi3mr_check_return_unmap - Whether an unmap is allowed
3302  * @mrioc: Adapter instance reference
3303  * @scmd: SCSI Command reference
3304  *
3305  * The controller hardware cannot handle certain unmap commands
3306  * for NVMe drives, this routine checks those and return true
3307  * and completes the SCSI command with proper status and sense
3308  * data.
3309  *
3310  * Return: TRUE for not  allowed unmap, FALSE otherwise.
3311  */
3312 static bool mpi3mr_check_return_unmap(struct mpi3mr_ioc *mrioc,
3313         struct scsi_cmnd *scmd)
3314 {
3315         unsigned char *buf;
3316         u16 param_len, desc_len;
3317
3318         param_len = get_unaligned_be16(scmd->cmnd + 7);
3319
3320         if (!param_len) {
3321                 ioc_warn(mrioc,
3322                     "%s: cdb received with zero parameter length\n",
3323                     __func__);
3324                 scsi_print_command(scmd);
3325                 scmd->result = DID_OK << 16;
3326                 scsi_done(scmd);
3327                 return true;
3328         }
3329
3330         if (param_len < 24) {
3331                 ioc_warn(mrioc,
3332                     "%s: cdb received with invalid param_len: %d\n",
3333                     __func__, param_len);
3334                 scsi_print_command(scmd);
3335                 scmd->result = SAM_STAT_CHECK_CONDITION;
3336                 scsi_build_sense_buffer(0, scmd->sense_buffer, ILLEGAL_REQUEST,
3337                     0x1A, 0);
3338                 scsi_done(scmd);
3339                 return true;
3340         }
3341         if (param_len != scsi_bufflen(scmd)) {
3342                 ioc_warn(mrioc,
3343                     "%s: cdb received with param_len: %d bufflen: %d\n",
3344                     __func__, param_len, scsi_bufflen(scmd));
3345                 scsi_print_command(scmd);
3346                 scmd->result = SAM_STAT_CHECK_CONDITION;
3347                 scsi_build_sense_buffer(0, scmd->sense_buffer, ILLEGAL_REQUEST,
3348                     0x1A, 0);
3349                 scsi_done(scmd);
3350                 return true;
3351         }
3352         buf = kzalloc(scsi_bufflen(scmd), GFP_ATOMIC);
3353         if (!buf) {
3354                 scsi_print_command(scmd);
3355                 scmd->result = SAM_STAT_CHECK_CONDITION;
3356                 scsi_build_sense_buffer(0, scmd->sense_buffer, ILLEGAL_REQUEST,
3357                     0x55, 0x03);
3358                 scsi_done(scmd);
3359                 return true;
3360         }
3361         scsi_sg_copy_to_buffer(scmd, buf, scsi_bufflen(scmd));
3362         desc_len = get_unaligned_be16(&buf[2]);
3363
3364         if (desc_len < 16) {
3365                 ioc_warn(mrioc,
3366                     "%s: Invalid descriptor length in param list: %d\n",
3367                     __func__, desc_len);
3368                 scsi_print_command(scmd);
3369                 scmd->result = SAM_STAT_CHECK_CONDITION;
3370                 scsi_build_sense_buffer(0, scmd->sense_buffer, ILLEGAL_REQUEST,
3371                     0x26, 0);
3372                 scsi_done(scmd);
3373                 kfree(buf);
3374                 return true;
3375         }
3376
3377         if (param_len > (desc_len + 8)) {
3378                 scsi_print_command(scmd);
3379                 ioc_warn(mrioc,
3380                     "%s: Truncating param_len(%d) to desc_len+8(%d)\n",
3381                     __func__, param_len, (desc_len + 8));
3382                 param_len = desc_len + 8;
3383                 put_unaligned_be16(param_len, scmd->cmnd + 7);
3384                 scsi_print_command(scmd);
3385         }
3386
3387         kfree(buf);
3388         return false;
3389 }
3390
3391 /**
3392  * mpi3mr_allow_scmd_to_fw - Command is allowed during shutdown
3393  * @scmd: SCSI Command reference
3394  *
3395  * Checks whether a cdb is allowed during shutdown or not.
3396  *
3397  * Return: TRUE for allowed commands, FALSE otherwise.
3398  */
3399
3400 inline bool mpi3mr_allow_scmd_to_fw(struct scsi_cmnd *scmd)
3401 {
3402         switch (scmd->cmnd[0]) {
3403         case SYNCHRONIZE_CACHE:
3404         case START_STOP:
3405                 return true;
3406         default:
3407                 return false;
3408         }
3409 }
3410
3411 /**
3412  * mpi3mr_qcmd - I/O request despatcher
3413  * @shost: SCSI Host reference
3414  * @scmd: SCSI Command reference
3415  *
3416  * Issues the SCSI Command as an MPI3 request.
3417  *
3418  * Return: 0 on successful queueing of the request or if the
3419  *         request is completed with failure.
3420  *         SCSI_MLQUEUE_DEVICE_BUSY when the device is busy.
3421  *         SCSI_MLQUEUE_HOST_BUSY when the host queue is full.
3422  */
3423 static int mpi3mr_qcmd(struct Scsi_Host *shost,
3424         struct scsi_cmnd *scmd)
3425 {
3426         struct mpi3mr_ioc *mrioc = shost_priv(shost);
3427         struct mpi3mr_stgt_priv_data *stgt_priv_data;
3428         struct mpi3mr_sdev_priv_data *sdev_priv_data;
3429         struct scmd_priv *scmd_priv_data = NULL;
3430         struct mpi3_scsi_io_request *scsiio_req = NULL;
3431         struct op_req_qinfo *op_req_q = NULL;
3432         int retval = 0;
3433         u16 dev_handle;
3434         u16 host_tag;
3435         u32 scsiio_flags = 0;
3436         struct request *rq = scsi_cmd_to_rq(scmd);
3437         int iprio_class;
3438
3439         sdev_priv_data = scmd->device->hostdata;
3440         if (!sdev_priv_data || !sdev_priv_data->tgt_priv_data) {
3441                 scmd->result = DID_NO_CONNECT << 16;
3442                 scsi_done(scmd);
3443                 goto out;
3444         }
3445
3446         if (mrioc->stop_drv_processing &&
3447             !(mpi3mr_allow_scmd_to_fw(scmd))) {
3448                 scmd->result = DID_NO_CONNECT << 16;
3449                 scsi_done(scmd);
3450                 goto out;
3451         }
3452
3453         if (mrioc->reset_in_progress) {
3454                 retval = SCSI_MLQUEUE_HOST_BUSY;
3455                 goto out;
3456         }
3457
3458         stgt_priv_data = sdev_priv_data->tgt_priv_data;
3459
3460         dev_handle = stgt_priv_data->dev_handle;
3461         if (dev_handle == MPI3MR_INVALID_DEV_HANDLE) {
3462                 scmd->result = DID_NO_CONNECT << 16;
3463                 scsi_done(scmd);
3464                 goto out;
3465         }
3466         if (stgt_priv_data->dev_removed) {
3467                 scmd->result = DID_NO_CONNECT << 16;
3468                 scsi_done(scmd);
3469                 goto out;
3470         }
3471
3472         if (atomic_read(&stgt_priv_data->block_io)) {
3473                 if (mrioc->stop_drv_processing) {
3474                         scmd->result = DID_NO_CONNECT << 16;
3475                         scsi_done(scmd);
3476                         goto out;
3477                 }
3478                 retval = SCSI_MLQUEUE_DEVICE_BUSY;
3479                 goto out;
3480         }
3481
3482         if ((scmd->cmnd[0] == UNMAP) &&
3483             (stgt_priv_data->dev_type == MPI3_DEVICE_DEVFORM_PCIE) &&
3484             mpi3mr_check_return_unmap(mrioc, scmd))
3485                 goto out;
3486
3487         host_tag = mpi3mr_host_tag_for_scmd(mrioc, scmd);
3488         if (host_tag == MPI3MR_HOSTTAG_INVALID) {
3489                 scmd->result = DID_ERROR << 16;
3490                 scsi_done(scmd);
3491                 goto out;
3492         }
3493
3494         if (scmd->sc_data_direction == DMA_FROM_DEVICE)
3495                 scsiio_flags = MPI3_SCSIIO_FLAGS_DATADIRECTION_READ;
3496         else if (scmd->sc_data_direction == DMA_TO_DEVICE)
3497                 scsiio_flags = MPI3_SCSIIO_FLAGS_DATADIRECTION_WRITE;
3498         else
3499                 scsiio_flags = MPI3_SCSIIO_FLAGS_DATADIRECTION_NO_DATA_TRANSFER;
3500
3501         scsiio_flags |= MPI3_SCSIIO_FLAGS_TASKATTRIBUTE_SIMPLEQ;
3502
3503         if (sdev_priv_data->ncq_prio_enable) {
3504                 iprio_class = IOPRIO_PRIO_CLASS(req_get_ioprio(rq));
3505                 if (iprio_class == IOPRIO_CLASS_RT)
3506                         scsiio_flags |= 1 << MPI3_SCSIIO_FLAGS_CMDPRI_SHIFT;
3507         }
3508
3509         if (scmd->cmd_len > 16)
3510                 scsiio_flags |= MPI3_SCSIIO_FLAGS_CDB_GREATER_THAN_16;
3511
3512         scmd_priv_data = scsi_cmd_priv(scmd);
3513         memset(scmd_priv_data->mpi3mr_scsiio_req, 0, MPI3MR_ADMIN_REQ_FRAME_SZ);
3514         scsiio_req = (struct mpi3_scsi_io_request *)scmd_priv_data->mpi3mr_scsiio_req;
3515         scsiio_req->function = MPI3_FUNCTION_SCSI_IO;
3516         scsiio_req->host_tag = cpu_to_le16(host_tag);
3517
3518         mpi3mr_setup_eedp(mrioc, scmd, scsiio_req);
3519
3520         memcpy(scsiio_req->cdb.cdb32, scmd->cmnd, scmd->cmd_len);
3521         scsiio_req->data_length = cpu_to_le32(scsi_bufflen(scmd));
3522         scsiio_req->dev_handle = cpu_to_le16(dev_handle);
3523         scsiio_req->flags = cpu_to_le32(scsiio_flags);
3524         int_to_scsilun(sdev_priv_data->lun_id,
3525             (struct scsi_lun *)scsiio_req->lun);
3526
3527         if (mpi3mr_build_sg_scmd(mrioc, scmd, scsiio_req)) {
3528                 mpi3mr_clear_scmd_priv(mrioc, scmd);
3529                 retval = SCSI_MLQUEUE_HOST_BUSY;
3530                 goto out;
3531         }
3532         op_req_q = &mrioc->req_qinfo[scmd_priv_data->req_q_idx];
3533
3534         if (mpi3mr_op_request_post(mrioc, op_req_q,
3535             scmd_priv_data->mpi3mr_scsiio_req)) {
3536                 mpi3mr_clear_scmd_priv(mrioc, scmd);
3537                 retval = SCSI_MLQUEUE_HOST_BUSY;
3538                 goto out;
3539         }
3540
3541 out:
3542         return retval;
3543 }
3544
3545 static struct scsi_host_template mpi3mr_driver_template = {
3546         .module                         = THIS_MODULE,
3547         .name                           = "MPI3 Storage Controller",
3548         .proc_name                      = MPI3MR_DRIVER_NAME,
3549         .queuecommand                   = mpi3mr_qcmd,
3550         .target_alloc                   = mpi3mr_target_alloc,
3551         .slave_alloc                    = mpi3mr_slave_alloc,
3552         .slave_configure                = mpi3mr_slave_configure,
3553         .target_destroy                 = mpi3mr_target_destroy,
3554         .slave_destroy                  = mpi3mr_slave_destroy,
3555         .scan_finished                  = mpi3mr_scan_finished,
3556         .scan_start                     = mpi3mr_scan_start,
3557         .change_queue_depth             = mpi3mr_change_queue_depth,
3558         .eh_device_reset_handler        = mpi3mr_eh_dev_reset,
3559         .eh_target_reset_handler        = mpi3mr_eh_target_reset,
3560         .eh_host_reset_handler          = mpi3mr_eh_host_reset,
3561         .bios_param                     = mpi3mr_bios_param,
3562         .map_queues                     = mpi3mr_map_queues,
3563         .no_write_same                  = 1,
3564         .can_queue                      = 1,
3565         .this_id                        = -1,
3566         .sg_tablesize                   = MPI3MR_SG_DEPTH,
3567         /* max xfer supported is 1M (2K in 512 byte sized sectors)
3568          */
3569         .max_sectors                    = 2048,
3570         .cmd_per_lun                    = MPI3MR_MAX_CMDS_LUN,
3571         .track_queue_depth              = 1,
3572         .cmd_size                       = sizeof(struct scmd_priv),
3573 };
3574
3575 /**
3576  * mpi3mr_init_drv_cmd - Initialize internal command tracker
3577  * @cmdptr: Internal command tracker
3578  * @host_tag: Host tag used for the specific command
3579  *
3580  * Initialize the internal command tracker structure with
3581  * specified host tag.
3582  *
3583  * Return: Nothing.
3584  */
3585 static inline void mpi3mr_init_drv_cmd(struct mpi3mr_drv_cmd *cmdptr,
3586         u16 host_tag)
3587 {
3588         mutex_init(&cmdptr->mutex);
3589         cmdptr->reply = NULL;
3590         cmdptr->state = MPI3MR_CMD_NOTUSED;
3591         cmdptr->dev_handle = MPI3MR_INVALID_DEV_HANDLE;
3592         cmdptr->host_tag = host_tag;
3593 }
3594
3595 /**
3596  * osintfc_mrioc_security_status -Check controller secure status
3597  * @pdev: PCI device instance
3598  *
3599  * Read the Device Serial Number capability from PCI config
3600  * space and decide whether the controller is secure or not.
3601  *
3602  * Return: 0 on success, non-zero on failure.
3603  */
3604 static int
3605 osintfc_mrioc_security_status(struct pci_dev *pdev)
3606 {
3607         u32 cap_data;
3608         int base;
3609         u32 ctlr_status;
3610         u32 debug_status;
3611         int retval = 0;
3612
3613         base = pci_find_ext_capability(pdev, PCI_EXT_CAP_ID_DSN);
3614         if (!base) {
3615                 dev_err(&pdev->dev,
3616                     "%s: PCI_EXT_CAP_ID_DSN is not supported\n", __func__);
3617                 return -1;
3618         }
3619
3620         pci_read_config_dword(pdev, base + 4, &cap_data);
3621
3622         debug_status = cap_data & MPI3MR_CTLR_SECURE_DBG_STATUS_MASK;
3623         ctlr_status = cap_data & MPI3MR_CTLR_SECURITY_STATUS_MASK;
3624
3625         switch (ctlr_status) {
3626         case MPI3MR_INVALID_DEVICE:
3627                 dev_err(&pdev->dev,
3628                     "%s: Non secure ctlr (Invalid) is detected: DID: 0x%x: SVID: 0x%x: SDID: 0x%x\n",
3629                     __func__, pdev->device, pdev->subsystem_vendor,
3630                     pdev->subsystem_device);
3631                 retval = -1;
3632                 break;
3633         case MPI3MR_CONFIG_SECURE_DEVICE:
3634                 if (!debug_status)
3635                         dev_info(&pdev->dev,
3636                             "%s: Config secure ctlr is detected\n",
3637                             __func__);
3638                 break;
3639         case MPI3MR_HARD_SECURE_DEVICE:
3640                 break;
3641         case MPI3MR_TAMPERED_DEVICE:
3642                 dev_err(&pdev->dev,
3643                     "%s: Non secure ctlr (Tampered) is detected: DID: 0x%x: SVID: 0x%x: SDID: 0x%x\n",
3644                     __func__, pdev->device, pdev->subsystem_vendor,
3645                     pdev->subsystem_device);
3646                 retval = -1;
3647                 break;
3648         default:
3649                 retval = -1;
3650                         break;
3651         }
3652
3653         if (!retval && debug_status) {
3654                 dev_err(&pdev->dev,
3655                     "%s: Non secure ctlr (Secure Dbg) is detected: DID: 0x%x: SVID: 0x%x: SDID: 0x%x\n",
3656                     __func__, pdev->device, pdev->subsystem_vendor,
3657                     pdev->subsystem_device);
3658                 retval = -1;
3659         }
3660
3661         return retval;
3662 }
3663
3664 /**
3665  * mpi3mr_probe - PCI probe callback
3666  * @pdev: PCI device instance
3667  * @id: PCI device ID details
3668  *
3669  * controller initialization routine. Checks the security status
3670  * of the controller and if it is invalid or tampered return the
3671  * probe without initializing the controller. Otherwise,
3672  * allocate per adapter instance through shost_priv and
3673  * initialize controller specific data structures, initializae
3674  * the controller hardware, add shost to the SCSI subsystem.
3675  *
3676  * Return: 0 on success, non-zero on failure.
3677  */
3678
3679 static int
3680 mpi3mr_probe(struct pci_dev *pdev, const struct pci_device_id *id)
3681 {
3682         struct mpi3mr_ioc *mrioc = NULL;
3683         struct Scsi_Host *shost = NULL;
3684         int retval = 0, i;
3685
3686         if (osintfc_mrioc_security_status(pdev)) {
3687                 warn_non_secure_ctlr = 1;
3688                 return 1; /* For Invalid and Tampered device */
3689         }
3690
3691         shost = scsi_host_alloc(&mpi3mr_driver_template,
3692             sizeof(struct mpi3mr_ioc));
3693         if (!shost) {
3694                 retval = -ENODEV;
3695                 goto shost_failed;
3696         }
3697
3698         mrioc = shost_priv(shost);
3699         mrioc->id = mrioc_ids++;
3700         sprintf(mrioc->driver_name, "%s", MPI3MR_DRIVER_NAME);
3701         sprintf(mrioc->name, "%s%d", mrioc->driver_name, mrioc->id);
3702         INIT_LIST_HEAD(&mrioc->list);
3703         spin_lock(&mrioc_list_lock);
3704         list_add_tail(&mrioc->list, &mrioc_list);
3705         spin_unlock(&mrioc_list_lock);
3706
3707         spin_lock_init(&mrioc->admin_req_lock);
3708         spin_lock_init(&mrioc->reply_free_queue_lock);
3709         spin_lock_init(&mrioc->sbq_lock);
3710         spin_lock_init(&mrioc->fwevt_lock);
3711         spin_lock_init(&mrioc->tgtdev_lock);
3712         spin_lock_init(&mrioc->watchdog_lock);
3713         spin_lock_init(&mrioc->chain_buf_lock);
3714
3715         INIT_LIST_HEAD(&mrioc->fwevt_list);
3716         INIT_LIST_HEAD(&mrioc->tgtdev_list);
3717         INIT_LIST_HEAD(&mrioc->delayed_rmhs_list);
3718
3719         mutex_init(&mrioc->reset_mutex);
3720         mpi3mr_init_drv_cmd(&mrioc->init_cmds, MPI3MR_HOSTTAG_INITCMDS);
3721         mpi3mr_init_drv_cmd(&mrioc->host_tm_cmds, MPI3MR_HOSTTAG_BLK_TMS);
3722
3723         for (i = 0; i < MPI3MR_NUM_DEVRMCMD; i++)
3724                 mpi3mr_init_drv_cmd(&mrioc->dev_rmhs_cmds[i],
3725                     MPI3MR_HOSTTAG_DEVRMCMD_MIN + i);
3726
3727         if (pdev->revision)
3728                 mrioc->enable_segqueue = true;
3729
3730         init_waitqueue_head(&mrioc->reset_waitq);
3731         mrioc->logging_level = logging_level;
3732         mrioc->shost = shost;
3733         mrioc->pdev = pdev;
3734
3735         /* init shost parameters */
3736         shost->max_cmd_len = MPI3MR_MAX_CDB_LENGTH;
3737         shost->max_lun = -1;
3738         shost->unique_id = mrioc->id;
3739
3740         shost->max_channel = 0;
3741         shost->max_id = 0xFFFFFFFF;
3742
3743         if (prot_mask >= 0)
3744                 scsi_host_set_prot(shost, prot_mask);
3745         else {
3746                 prot_mask = SHOST_DIF_TYPE1_PROTECTION
3747                     | SHOST_DIF_TYPE2_PROTECTION
3748                     | SHOST_DIF_TYPE3_PROTECTION;
3749                 scsi_host_set_prot(shost, prot_mask);
3750         }
3751
3752         ioc_info(mrioc,
3753             "%s :host protection capabilities enabled %s%s%s%s%s%s%s\n",
3754             __func__,
3755             (prot_mask & SHOST_DIF_TYPE1_PROTECTION) ? " DIF1" : "",
3756             (prot_mask & SHOST_DIF_TYPE2_PROTECTION) ? " DIF2" : "",
3757             (prot_mask & SHOST_DIF_TYPE3_PROTECTION) ? " DIF3" : "",
3758             (prot_mask & SHOST_DIX_TYPE0_PROTECTION) ? " DIX0" : "",
3759             (prot_mask & SHOST_DIX_TYPE1_PROTECTION) ? " DIX1" : "",
3760             (prot_mask & SHOST_DIX_TYPE2_PROTECTION) ? " DIX2" : "",
3761             (prot_mask & SHOST_DIX_TYPE3_PROTECTION) ? " DIX3" : "");
3762
3763         if (prot_guard_mask)
3764                 scsi_host_set_guard(shost, (prot_guard_mask & 3));
3765         else
3766                 scsi_host_set_guard(shost, SHOST_DIX_GUARD_CRC);
3767
3768         snprintf(mrioc->fwevt_worker_name, sizeof(mrioc->fwevt_worker_name),
3769             "%s%d_fwevt_wrkr", mrioc->driver_name, mrioc->id);
3770         mrioc->fwevt_worker_thread = alloc_ordered_workqueue(
3771             mrioc->fwevt_worker_name, WQ_MEM_RECLAIM);
3772         if (!mrioc->fwevt_worker_thread) {
3773                 ioc_err(mrioc, "failure at %s:%d/%s()!\n",
3774                     __FILE__, __LINE__, __func__);
3775                 retval = -ENODEV;
3776                 goto out_fwevtthread_failed;
3777         }
3778
3779         mrioc->is_driver_loading = 1;
3780         if (mpi3mr_init_ioc(mrioc, MPI3MR_IT_INIT)) {
3781                 ioc_err(mrioc, "failure at %s:%d/%s()!\n",
3782                     __FILE__, __LINE__, __func__);
3783                 retval = -ENODEV;
3784                 goto out_iocinit_failed;
3785         }
3786
3787         shost->nr_hw_queues = mrioc->num_op_reply_q;
3788         shost->can_queue = mrioc->max_host_ios;
3789         shost->sg_tablesize = MPI3MR_SG_DEPTH;
3790         shost->max_id = mrioc->facts.max_perids;
3791
3792         retval = scsi_add_host(shost, &pdev->dev);
3793         if (retval) {
3794                 ioc_err(mrioc, "failure at %s:%d/%s()!\n",
3795                     __FILE__, __LINE__, __func__);
3796                 goto addhost_failed;
3797         }
3798
3799         scsi_scan_host(shost);
3800         return retval;
3801
3802 addhost_failed:
3803         mpi3mr_cleanup_ioc(mrioc, MPI3MR_COMPLETE_CLEANUP);
3804 out_iocinit_failed:
3805         destroy_workqueue(mrioc->fwevt_worker_thread);
3806 out_fwevtthread_failed:
3807         spin_lock(&mrioc_list_lock);
3808         list_del(&mrioc->list);
3809         spin_unlock(&mrioc_list_lock);
3810         scsi_host_put(shost);
3811 shost_failed:
3812         return retval;
3813 }
3814
3815 /**
3816  * mpi3mr_remove - PCI remove callback
3817  * @pdev: PCI device instance
3818  *
3819  * Free up all memory and resources associated with the
3820  * controllerand target devices, unregister the shost.
3821  *
3822  * Return: Nothing.
3823  */
3824 static void mpi3mr_remove(struct pci_dev *pdev)
3825 {
3826         struct Scsi_Host *shost = pci_get_drvdata(pdev);
3827         struct mpi3mr_ioc *mrioc;
3828         struct workqueue_struct *wq;
3829         unsigned long flags;
3830         struct mpi3mr_tgt_dev *tgtdev, *tgtdev_next;
3831
3832         if (!shost)
3833                 return;
3834
3835         mrioc = shost_priv(shost);
3836         while (mrioc->reset_in_progress || mrioc->is_driver_loading)
3837                 ssleep(1);
3838
3839         mrioc->stop_drv_processing = 1;
3840         mpi3mr_cleanup_fwevt_list(mrioc);
3841         spin_lock_irqsave(&mrioc->fwevt_lock, flags);
3842         wq = mrioc->fwevt_worker_thread;
3843         mrioc->fwevt_worker_thread = NULL;
3844         spin_unlock_irqrestore(&mrioc->fwevt_lock, flags);
3845         if (wq)
3846                 destroy_workqueue(wq);
3847         scsi_remove_host(shost);
3848
3849         list_for_each_entry_safe(tgtdev, tgtdev_next, &mrioc->tgtdev_list,
3850             list) {
3851                 mpi3mr_remove_tgtdev_from_host(mrioc, tgtdev);
3852                 mpi3mr_tgtdev_del_from_list(mrioc, tgtdev);
3853                 mpi3mr_tgtdev_put(tgtdev);
3854         }
3855         mpi3mr_cleanup_ioc(mrioc, MPI3MR_COMPLETE_CLEANUP);
3856
3857         spin_lock(&mrioc_list_lock);
3858         list_del(&mrioc->list);
3859         spin_unlock(&mrioc_list_lock);
3860
3861         scsi_host_put(shost);
3862 }
3863
3864 /**
3865  * mpi3mr_shutdown - PCI shutdown callback
3866  * @pdev: PCI device instance
3867  *
3868  * Free up all memory and resources associated with the
3869  * controller
3870  *
3871  * Return: Nothing.
3872  */
3873 static void mpi3mr_shutdown(struct pci_dev *pdev)
3874 {
3875         struct Scsi_Host *shost = pci_get_drvdata(pdev);
3876         struct mpi3mr_ioc *mrioc;
3877         struct workqueue_struct *wq;
3878         unsigned long flags;
3879
3880         if (!shost)
3881                 return;
3882
3883         mrioc = shost_priv(shost);
3884         while (mrioc->reset_in_progress || mrioc->is_driver_loading)
3885                 ssleep(1);
3886
3887         mrioc->stop_drv_processing = 1;
3888         mpi3mr_cleanup_fwevt_list(mrioc);
3889         spin_lock_irqsave(&mrioc->fwevt_lock, flags);
3890         wq = mrioc->fwevt_worker_thread;
3891         mrioc->fwevt_worker_thread = NULL;
3892         spin_unlock_irqrestore(&mrioc->fwevt_lock, flags);
3893         if (wq)
3894                 destroy_workqueue(wq);
3895         mpi3mr_cleanup_ioc(mrioc, MPI3MR_COMPLETE_CLEANUP);
3896 }
3897
3898 #ifdef CONFIG_PM
3899 /**
3900  * mpi3mr_suspend - PCI power management suspend callback
3901  * @pdev: PCI device instance
3902  * @state: New power state
3903  *
3904  * Change the power state to the given value and cleanup the IOC
3905  * by issuing MUR and shutdown notification
3906  *
3907  * Return: 0 always.
3908  */
3909 static int mpi3mr_suspend(struct pci_dev *pdev, pm_message_t state)
3910 {
3911         struct Scsi_Host *shost = pci_get_drvdata(pdev);
3912         struct mpi3mr_ioc *mrioc;
3913         pci_power_t device_state;
3914
3915         if (!shost)
3916                 return 0;
3917
3918         mrioc = shost_priv(shost);
3919         while (mrioc->reset_in_progress || mrioc->is_driver_loading)
3920                 ssleep(1);
3921         mrioc->stop_drv_processing = 1;
3922         mpi3mr_cleanup_fwevt_list(mrioc);
3923         scsi_block_requests(shost);
3924         mpi3mr_stop_watchdog(mrioc);
3925         mpi3mr_cleanup_ioc(mrioc, MPI3MR_SUSPEND);
3926
3927         device_state = pci_choose_state(pdev, state);
3928         ioc_info(mrioc, "pdev=0x%p, slot=%s, entering operating state [D%d]\n",
3929             pdev, pci_name(pdev), device_state);
3930         pci_save_state(pdev);
3931         pci_set_power_state(pdev, device_state);
3932         mpi3mr_cleanup_resources(mrioc);
3933
3934         return 0;
3935 }
3936
3937 /**
3938  * mpi3mr_resume - PCI power management resume callback
3939  * @pdev: PCI device instance
3940  *
3941  * Restore the power state to D0 and reinitialize the controller
3942  * and resume I/O operations to the target devices
3943  *
3944  * Return: 0 on success, non-zero on failure
3945  */
3946 static int mpi3mr_resume(struct pci_dev *pdev)
3947 {
3948         struct Scsi_Host *shost = pci_get_drvdata(pdev);
3949         struct mpi3mr_ioc *mrioc;
3950         pci_power_t device_state = pdev->current_state;
3951         int r;
3952
3953         if (!shost)
3954                 return 0;
3955
3956         mrioc = shost_priv(shost);
3957
3958         ioc_info(mrioc, "pdev=0x%p, slot=%s, previous operating state [D%d]\n",
3959             pdev, pci_name(pdev), device_state);
3960         pci_set_power_state(pdev, PCI_D0);
3961         pci_enable_wake(pdev, PCI_D0, 0);
3962         pci_restore_state(pdev);
3963         mrioc->pdev = pdev;
3964         mrioc->cpu_count = num_online_cpus();
3965         r = mpi3mr_setup_resources(mrioc);
3966         if (r) {
3967                 ioc_info(mrioc, "%s: Setup resources failed[%d]\n",
3968                     __func__, r);
3969                 return r;
3970         }
3971
3972         mrioc->stop_drv_processing = 0;
3973         mpi3mr_memset_buffers(mrioc);
3974         mpi3mr_init_ioc(mrioc, MPI3MR_IT_RESUME);
3975         scsi_unblock_requests(shost);
3976         mpi3mr_start_watchdog(mrioc);
3977
3978         return 0;
3979 }
3980 #endif
3981
3982 static const struct pci_device_id mpi3mr_pci_id_table[] = {
3983         {
3984                 PCI_DEVICE_SUB(PCI_VENDOR_ID_LSI_LOGIC, 0x00A5,
3985                     PCI_ANY_ID, PCI_ANY_ID)
3986         },
3987         { 0 }
3988 };
3989 MODULE_DEVICE_TABLE(pci, mpi3mr_pci_id_table);
3990
3991 static struct pci_driver mpi3mr_pci_driver = {
3992         .name = MPI3MR_DRIVER_NAME,
3993         .id_table = mpi3mr_pci_id_table,
3994         .probe = mpi3mr_probe,
3995         .remove = mpi3mr_remove,
3996         .shutdown = mpi3mr_shutdown,
3997 #ifdef CONFIG_PM
3998         .suspend = mpi3mr_suspend,
3999         .resume = mpi3mr_resume,
4000 #endif
4001 };
4002
4003 static int __init mpi3mr_init(void)
4004 {
4005         int ret_val;
4006
4007         pr_info("Loading %s version %s\n", MPI3MR_DRIVER_NAME,
4008             MPI3MR_DRIVER_VERSION);
4009
4010         ret_val = pci_register_driver(&mpi3mr_pci_driver);
4011
4012         return ret_val;
4013 }
4014
4015 static void __exit mpi3mr_exit(void)
4016 {
4017         if (warn_non_secure_ctlr)
4018                 pr_warn(
4019                     "Unloading %s version %s while managing a non secure controller\n",
4020                     MPI3MR_DRIVER_NAME, MPI3MR_DRIVER_VERSION);
4021         else
4022                 pr_info("Unloading %s version %s\n", MPI3MR_DRIVER_NAME,
4023                     MPI3MR_DRIVER_VERSION);
4024
4025         pci_unregister_driver(&mpi3mr_pci_driver);
4026 }
4027
4028 module_init(mpi3mr_init);
4029 module_exit(mpi3mr_exit);