GNU Linux-libre 5.15.54-gnu
[releases.git] / 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                 scmd->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
2208         scsi_set_resid(scmd, scsi_bufflen(scmd) - xfer_count);
2209         if (ioc_status == MPI3_IOCSTATUS_SCSI_DATA_UNDERRUN &&
2210             xfer_count == 0 && (scsi_status == MPI3_SCSI_STATUS_BUSY ||
2211             scsi_status == MPI3_SCSI_STATUS_RESERVATION_CONFLICT ||
2212             scsi_status == MPI3_SCSI_STATUS_TASK_SET_FULL))
2213                 ioc_status = MPI3_IOCSTATUS_SUCCESS;
2214
2215         if ((sense_state == MPI3_SCSI_STATE_SENSE_VALID) && sense_count &&
2216             sense_buf) {
2217                 u32 sz = min_t(u32, SCSI_SENSE_BUFFERSIZE, sense_count);
2218
2219                 memcpy(scmd->sense_buffer, sense_buf, sz);
2220         }
2221
2222         switch (ioc_status) {
2223         case MPI3_IOCSTATUS_BUSY:
2224         case MPI3_IOCSTATUS_INSUFFICIENT_RESOURCES:
2225                 scmd->result = SAM_STAT_BUSY;
2226                 break;
2227         case MPI3_IOCSTATUS_SCSI_DEVICE_NOT_THERE:
2228                 scmd->result = DID_NO_CONNECT << 16;
2229                 break;
2230         case MPI3_IOCSTATUS_SCSI_IOC_TERMINATED:
2231                 scmd->result = DID_SOFT_ERROR << 16;
2232                 break;
2233         case MPI3_IOCSTATUS_SCSI_TASK_TERMINATED:
2234         case MPI3_IOCSTATUS_SCSI_EXT_TERMINATED:
2235                 scmd->result = DID_RESET << 16;
2236                 break;
2237         case MPI3_IOCSTATUS_SCSI_RESIDUAL_MISMATCH:
2238                 if ((xfer_count == 0) || (scmd->underflow > xfer_count))
2239                         scmd->result = DID_SOFT_ERROR << 16;
2240                 else
2241                         scmd->result = (DID_OK << 16) | scsi_status;
2242                 break;
2243         case MPI3_IOCSTATUS_SCSI_DATA_UNDERRUN:
2244                 scmd->result = (DID_OK << 16) | scsi_status;
2245                 if (sense_state == MPI3_SCSI_STATE_SENSE_VALID)
2246                         break;
2247                 if (xfer_count < scmd->underflow) {
2248                         if (scsi_status == SAM_STAT_BUSY)
2249                                 scmd->result = SAM_STAT_BUSY;
2250                         else
2251                                 scmd->result = DID_SOFT_ERROR << 16;
2252                 } else if ((scsi_state & (MPI3_SCSI_STATE_NO_SCSI_STATUS)) ||
2253                     (sense_state != MPI3_SCSI_STATE_SENSE_NOT_AVAILABLE))
2254                         scmd->result = DID_SOFT_ERROR << 16;
2255                 else if (scsi_state & MPI3_SCSI_STATE_TERMINATED)
2256                         scmd->result = DID_RESET << 16;
2257                 break;
2258         case MPI3_IOCSTATUS_SCSI_DATA_OVERRUN:
2259                 scsi_set_resid(scmd, 0);
2260                 fallthrough;
2261         case MPI3_IOCSTATUS_SCSI_RECOVERED_ERROR:
2262         case MPI3_IOCSTATUS_SUCCESS:
2263                 scmd->result = (DID_OK << 16) | scsi_status;
2264                 if ((scsi_state & (MPI3_SCSI_STATE_NO_SCSI_STATUS)) ||
2265                     (sense_state == MPI3_SCSI_STATE_SENSE_FAILED) ||
2266                         (sense_state == MPI3_SCSI_STATE_SENSE_BUFF_Q_EMPTY))
2267                         scmd->result = DID_SOFT_ERROR << 16;
2268                 else if (scsi_state & MPI3_SCSI_STATE_TERMINATED)
2269                         scmd->result = DID_RESET << 16;
2270                 break;
2271         case MPI3_IOCSTATUS_EEDP_GUARD_ERROR:
2272         case MPI3_IOCSTATUS_EEDP_REF_TAG_ERROR:
2273         case MPI3_IOCSTATUS_EEDP_APP_TAG_ERROR:
2274                 mpi3mr_map_eedp_error(scmd, ioc_status);
2275                 break;
2276         case MPI3_IOCSTATUS_SCSI_PROTOCOL_ERROR:
2277         case MPI3_IOCSTATUS_INVALID_FUNCTION:
2278         case MPI3_IOCSTATUS_INVALID_SGL:
2279         case MPI3_IOCSTATUS_INTERNAL_ERROR:
2280         case MPI3_IOCSTATUS_INVALID_FIELD:
2281         case MPI3_IOCSTATUS_INVALID_STATE:
2282         case MPI3_IOCSTATUS_SCSI_IO_DATA_ERROR:
2283         case MPI3_IOCSTATUS_SCSI_TASK_MGMT_FAILED:
2284         case MPI3_IOCSTATUS_INSUFFICIENT_POWER:
2285         default:
2286                 scmd->result = DID_SOFT_ERROR << 16;
2287                 break;
2288         }
2289
2290         if (scmd->result != (DID_OK << 16) && (scmd->cmnd[0] != ATA_12) &&
2291             (scmd->cmnd[0] != ATA_16)) {
2292                 ioc_info(mrioc, "%s :scmd->result 0x%x\n", __func__,
2293                     scmd->result);
2294                 scsi_print_command(scmd);
2295                 ioc_info(mrioc,
2296                     "%s :Command issued to handle 0x%02x returned with error 0x%04x loginfo 0x%08x, qid %d\n",
2297                     __func__, dev_handle, ioc_status, ioc_loginfo,
2298                     priv->req_q_idx + 1);
2299                 ioc_info(mrioc,
2300                     " host_tag %d scsi_state 0x%02x scsi_status 0x%02x, xfer_cnt %d resp_data 0x%x\n",
2301                     host_tag, scsi_state, scsi_status, xfer_count, resp_data);
2302                 if (sense_buf) {
2303                         scsi_normalize_sense(sense_buf, sense_count, &sshdr);
2304                         ioc_info(mrioc,
2305                             "%s :sense_count 0x%x, sense_key 0x%x ASC 0x%x, ASCQ 0x%x\n",
2306                             __func__, sense_count, sshdr.sense_key,
2307                             sshdr.asc, sshdr.ascq);
2308                 }
2309         }
2310 out_success:
2311         if (priv->meta_sg_valid) {
2312                 dma_unmap_sg(&mrioc->pdev->dev, scsi_prot_sglist(scmd),
2313                     scsi_prot_sg_count(scmd), scmd->sc_data_direction);
2314         }
2315         mpi3mr_clear_scmd_priv(mrioc, scmd);
2316         scsi_dma_unmap(scmd);
2317         scmd->scsi_done(scmd);
2318 out:
2319         if (sense_buf)
2320                 mpi3mr_repost_sense_buf(mrioc,
2321                     le64_to_cpu(scsi_reply->sense_data_buffer_address));
2322 }
2323
2324 /**
2325  * mpi3mr_get_chain_idx - get free chain buffer index
2326  * @mrioc: Adapter instance reference
2327  *
2328  * Try to get a free chain buffer index from the free pool.
2329  *
2330  * Return: -1 on failure or the free chain buffer index
2331  */
2332 static int mpi3mr_get_chain_idx(struct mpi3mr_ioc *mrioc)
2333 {
2334         u8 retry_count = 5;
2335         int cmd_idx = -1;
2336
2337         do {
2338                 spin_lock(&mrioc->chain_buf_lock);
2339                 cmd_idx = find_first_zero_bit(mrioc->chain_bitmap,
2340                     mrioc->chain_buf_count);
2341                 if (cmd_idx < mrioc->chain_buf_count) {
2342                         set_bit(cmd_idx, mrioc->chain_bitmap);
2343                         spin_unlock(&mrioc->chain_buf_lock);
2344                         break;
2345                 }
2346                 spin_unlock(&mrioc->chain_buf_lock);
2347                 cmd_idx = -1;
2348         } while (retry_count--);
2349         return cmd_idx;
2350 }
2351
2352 /**
2353  * mpi3mr_prepare_sg_scmd - build scatter gather list
2354  * @mrioc: Adapter instance reference
2355  * @scmd: SCSI command reference
2356  * @scsiio_req: MPI3 SCSI IO request
2357  *
2358  * This function maps SCSI command's data and protection SGEs to
2359  * MPI request SGEs. If required additional 4K chain buffer is
2360  * used to send the SGEs.
2361  *
2362  * Return: 0 on success, -ENOMEM on dma_map_sg failure
2363  */
2364 static int mpi3mr_prepare_sg_scmd(struct mpi3mr_ioc *mrioc,
2365         struct scsi_cmnd *scmd, struct mpi3_scsi_io_request *scsiio_req)
2366 {
2367         dma_addr_t chain_dma;
2368         struct scatterlist *sg_scmd;
2369         void *sg_local, *chain;
2370         u32 chain_length;
2371         int sges_left, chain_idx;
2372         u32 sges_in_segment;
2373         u8 simple_sgl_flags;
2374         u8 simple_sgl_flags_last;
2375         u8 last_chain_sgl_flags;
2376         struct chain_element *chain_req;
2377         struct scmd_priv *priv = NULL;
2378         u32 meta_sg = le32_to_cpu(scsiio_req->flags) &
2379             MPI3_SCSIIO_FLAGS_DMAOPERATION_HOST_PI;
2380
2381         priv = scsi_cmd_priv(scmd);
2382
2383         simple_sgl_flags = MPI3_SGE_FLAGS_ELEMENT_TYPE_SIMPLE |
2384             MPI3_SGE_FLAGS_DLAS_SYSTEM;
2385         simple_sgl_flags_last = simple_sgl_flags |
2386             MPI3_SGE_FLAGS_END_OF_LIST;
2387         last_chain_sgl_flags = MPI3_SGE_FLAGS_ELEMENT_TYPE_LAST_CHAIN |
2388             MPI3_SGE_FLAGS_DLAS_SYSTEM;
2389
2390         if (meta_sg)
2391                 sg_local = &scsiio_req->sgl[MPI3_SCSIIO_METASGL_INDEX];
2392         else
2393                 sg_local = &scsiio_req->sgl;
2394
2395         if (!scsiio_req->data_length && !meta_sg) {
2396                 mpi3mr_build_zero_len_sge(sg_local);
2397                 return 0;
2398         }
2399
2400         if (meta_sg) {
2401                 sg_scmd = scsi_prot_sglist(scmd);
2402                 sges_left = dma_map_sg(&mrioc->pdev->dev,
2403                     scsi_prot_sglist(scmd),
2404                     scsi_prot_sg_count(scmd),
2405                     scmd->sc_data_direction);
2406                 priv->meta_sg_valid = 1; /* To unmap meta sg DMA */
2407         } else {
2408                 sg_scmd = scsi_sglist(scmd);
2409                 sges_left = scsi_dma_map(scmd);
2410         }
2411
2412         if (sges_left < 0) {
2413                 sdev_printk(KERN_ERR, scmd->device,
2414                     "scsi_dma_map failed: request for %d bytes!\n",
2415                     scsi_bufflen(scmd));
2416                 return -ENOMEM;
2417         }
2418         if (sges_left > MPI3MR_SG_DEPTH) {
2419                 sdev_printk(KERN_ERR, scmd->device,
2420                     "scsi_dma_map returned unsupported sge count %d!\n",
2421                     sges_left);
2422                 return -ENOMEM;
2423         }
2424
2425         sges_in_segment = (mrioc->facts.op_req_sz -
2426             offsetof(struct mpi3_scsi_io_request, sgl)) / sizeof(struct mpi3_sge_common);
2427
2428         if (scsiio_req->sgl[0].eedp.flags ==
2429             MPI3_SGE_FLAGS_ELEMENT_TYPE_EXTENDED && !meta_sg) {
2430                 sg_local += sizeof(struct mpi3_sge_common);
2431                 sges_in_segment--;
2432                 /* Reserve 1st segment (scsiio_req->sgl[0]) for eedp */
2433         }
2434
2435         if (scsiio_req->msg_flags ==
2436             MPI3_SCSIIO_MSGFLAGS_METASGL_VALID && !meta_sg) {
2437                 sges_in_segment--;
2438                 /* Reserve last segment (scsiio_req->sgl[3]) for meta sg */
2439         }
2440
2441         if (meta_sg)
2442                 sges_in_segment = 1;
2443
2444         if (sges_left <= sges_in_segment)
2445                 goto fill_in_last_segment;
2446
2447         /* fill in main message segment when there is a chain following */
2448         while (sges_in_segment > 1) {
2449                 mpi3mr_add_sg_single(sg_local, simple_sgl_flags,
2450                     sg_dma_len(sg_scmd), sg_dma_address(sg_scmd));
2451                 sg_scmd = sg_next(sg_scmd);
2452                 sg_local += sizeof(struct mpi3_sge_common);
2453                 sges_left--;
2454                 sges_in_segment--;
2455         }
2456
2457         chain_idx = mpi3mr_get_chain_idx(mrioc);
2458         if (chain_idx < 0)
2459                 return -1;
2460         chain_req = &mrioc->chain_sgl_list[chain_idx];
2461         if (meta_sg)
2462                 priv->meta_chain_idx = chain_idx;
2463         else
2464                 priv->chain_idx = chain_idx;
2465
2466         chain = chain_req->addr;
2467         chain_dma = chain_req->dma_addr;
2468         sges_in_segment = sges_left;
2469         chain_length = sges_in_segment * sizeof(struct mpi3_sge_common);
2470
2471         mpi3mr_add_sg_single(sg_local, last_chain_sgl_flags,
2472             chain_length, chain_dma);
2473
2474         sg_local = chain;
2475
2476 fill_in_last_segment:
2477         while (sges_left > 0) {
2478                 if (sges_left == 1)
2479                         mpi3mr_add_sg_single(sg_local,
2480                             simple_sgl_flags_last, sg_dma_len(sg_scmd),
2481                             sg_dma_address(sg_scmd));
2482                 else
2483                         mpi3mr_add_sg_single(sg_local, simple_sgl_flags,
2484                             sg_dma_len(sg_scmd), sg_dma_address(sg_scmd));
2485                 sg_scmd = sg_next(sg_scmd);
2486                 sg_local += sizeof(struct mpi3_sge_common);
2487                 sges_left--;
2488         }
2489
2490         return 0;
2491 }
2492
2493 /**
2494  * mpi3mr_build_sg_scmd - build scatter gather list for SCSI IO
2495  * @mrioc: Adapter instance reference
2496  * @scmd: SCSI command reference
2497  * @scsiio_req: MPI3 SCSI IO request
2498  *
2499  * This function calls mpi3mr_prepare_sg_scmd for constructing
2500  * both data SGEs and protection information SGEs in the MPI
2501  * format from the SCSI Command as appropriate .
2502  *
2503  * Return: return value of mpi3mr_prepare_sg_scmd.
2504  */
2505 static int mpi3mr_build_sg_scmd(struct mpi3mr_ioc *mrioc,
2506         struct scsi_cmnd *scmd, struct mpi3_scsi_io_request *scsiio_req)
2507 {
2508         int ret;
2509
2510         ret = mpi3mr_prepare_sg_scmd(mrioc, scmd, scsiio_req);
2511         if (ret)
2512                 return ret;
2513
2514         if (scsiio_req->msg_flags == MPI3_SCSIIO_MSGFLAGS_METASGL_VALID) {
2515                 /* There is a valid meta sg */
2516                 scsiio_req->flags |=
2517                     cpu_to_le32(MPI3_SCSIIO_FLAGS_DMAOPERATION_HOST_PI);
2518                 ret = mpi3mr_prepare_sg_scmd(mrioc, scmd, scsiio_req);
2519         }
2520
2521         return ret;
2522 }
2523
2524 /**
2525  * mpi3mr_print_response_code - print TM response as a string
2526  * @mrioc: Adapter instance reference
2527  * @resp_code: TM response code
2528  *
2529  * Print TM response code as a readable string.
2530  *
2531  * Return: Nothing.
2532  */
2533 static void mpi3mr_print_response_code(struct mpi3mr_ioc *mrioc, u8 resp_code)
2534 {
2535         char *desc;
2536
2537         switch (resp_code) {
2538         case MPI3MR_RSP_TM_COMPLETE:
2539                 desc = "task management request completed";
2540                 break;
2541         case MPI3MR_RSP_INVALID_FRAME:
2542                 desc = "invalid frame";
2543                 break;
2544         case MPI3MR_RSP_TM_NOT_SUPPORTED:
2545                 desc = "task management request not supported";
2546                 break;
2547         case MPI3MR_RSP_TM_FAILED:
2548                 desc = "task management request failed";
2549                 break;
2550         case MPI3MR_RSP_TM_SUCCEEDED:
2551                 desc = "task management request succeeded";
2552                 break;
2553         case MPI3MR_RSP_TM_INVALID_LUN:
2554                 desc = "invalid lun";
2555                 break;
2556         case MPI3MR_RSP_TM_OVERLAPPED_TAG:
2557                 desc = "overlapped tag attempted";
2558                 break;
2559         case MPI3MR_RSP_IO_QUEUED_ON_IOC:
2560                 desc = "task queued, however not sent to target";
2561                 break;
2562         default:
2563                 desc = "unknown";
2564                 break;
2565         }
2566         ioc_info(mrioc, "%s :response_code(0x%01x): %s\n", __func__,
2567             resp_code, desc);
2568 }
2569
2570 /**
2571  * mpi3mr_issue_tm - Issue Task Management request
2572  * @mrioc: Adapter instance reference
2573  * @tm_type: Task Management type
2574  * @handle: Device handle
2575  * @lun: lun ID
2576  * @htag: Host tag of the TM request
2577  * @drv_cmd: Internal command tracker
2578  * @resp_code: Response code place holder
2579  * @cmd_priv: SCSI command private data
2580  *
2581  * Issues a Task Management Request to the controller for a
2582  * specified target, lun and command and wait for its completion
2583  * and check TM response. Recover the TM if it timed out by
2584  * issuing controller reset.
2585  *
2586  * Return: 0 on success, non-zero on errors
2587  */
2588 static int mpi3mr_issue_tm(struct mpi3mr_ioc *mrioc, u8 tm_type,
2589         u16 handle, uint lun, u16 htag, ulong timeout,
2590         struct mpi3mr_drv_cmd *drv_cmd,
2591         u8 *resp_code, struct scmd_priv *cmd_priv)
2592 {
2593         struct mpi3_scsi_task_mgmt_request tm_req;
2594         struct mpi3_scsi_task_mgmt_reply *tm_reply = NULL;
2595         int retval = 0;
2596         struct mpi3mr_tgt_dev *tgtdev = NULL;
2597         struct mpi3mr_stgt_priv_data *scsi_tgt_priv_data = NULL;
2598         struct op_req_qinfo *op_req_q = NULL;
2599
2600         ioc_info(mrioc, "%s :Issue TM: TM type (0x%x) for devhandle 0x%04x\n",
2601              __func__, tm_type, handle);
2602         if (mrioc->unrecoverable) {
2603                 retval = -1;
2604                 ioc_err(mrioc, "%s :Issue TM: Unrecoverable controller\n",
2605                     __func__);
2606                 goto out;
2607         }
2608
2609         memset(&tm_req, 0, sizeof(tm_req));
2610         mutex_lock(&drv_cmd->mutex);
2611         if (drv_cmd->state & MPI3MR_CMD_PENDING) {
2612                 retval = -1;
2613                 ioc_err(mrioc, "%s :Issue TM: Command is in use\n", __func__);
2614                 mutex_unlock(&drv_cmd->mutex);
2615                 goto out;
2616         }
2617         if (mrioc->reset_in_progress) {
2618                 retval = -1;
2619                 ioc_err(mrioc, "%s :Issue TM: Reset in progress\n", __func__);
2620                 mutex_unlock(&drv_cmd->mutex);
2621                 goto out;
2622         }
2623
2624         drv_cmd->state = MPI3MR_CMD_PENDING;
2625         drv_cmd->is_waiting = 1;
2626         drv_cmd->callback = NULL;
2627         tm_req.dev_handle = cpu_to_le16(handle);
2628         tm_req.task_type = tm_type;
2629         tm_req.host_tag = cpu_to_le16(htag);
2630
2631         int_to_scsilun(lun, (struct scsi_lun *)tm_req.lun);
2632         tm_req.function = MPI3_FUNCTION_SCSI_TASK_MGMT;
2633
2634         tgtdev = mpi3mr_get_tgtdev_by_handle(mrioc, handle);
2635         if (tgtdev && tgtdev->starget && tgtdev->starget->hostdata) {
2636                 scsi_tgt_priv_data = (struct mpi3mr_stgt_priv_data *)
2637                     tgtdev->starget->hostdata;
2638                 atomic_inc(&scsi_tgt_priv_data->block_io);
2639         }
2640         if (cmd_priv) {
2641                 op_req_q = &mrioc->req_qinfo[cmd_priv->req_q_idx];
2642                 tm_req.task_host_tag = cpu_to_le16(cmd_priv->host_tag);
2643                 tm_req.task_request_queue_id = cpu_to_le16(op_req_q->qid);
2644         }
2645         if (tgtdev && (tgtdev->dev_type == MPI3_DEVICE_DEVFORM_PCIE)) {
2646                 if (cmd_priv && tgtdev->dev_spec.pcie_inf.abort_to)
2647                         timeout = tgtdev->dev_spec.pcie_inf.abort_to;
2648                 else if (!cmd_priv && tgtdev->dev_spec.pcie_inf.reset_to)
2649                         timeout = tgtdev->dev_spec.pcie_inf.reset_to;
2650         }
2651
2652         init_completion(&drv_cmd->done);
2653         retval = mpi3mr_admin_request_post(mrioc, &tm_req, sizeof(tm_req), 1);
2654         if (retval) {
2655                 ioc_err(mrioc, "%s :Issue TM: Admin Post failed\n", __func__);
2656                 goto out_unlock;
2657         }
2658         wait_for_completion_timeout(&drv_cmd->done, (timeout * HZ));
2659
2660         if (!(drv_cmd->state & MPI3MR_CMD_COMPLETE)) {
2661                 ioc_err(mrioc, "%s :Issue TM: command timed out\n", __func__);
2662                 drv_cmd->is_waiting = 0;
2663                 retval = -1;
2664                 mpi3mr_soft_reset_handler(mrioc,
2665                     MPI3MR_RESET_FROM_TM_TIMEOUT, 1);
2666                 goto out_unlock;
2667         }
2668
2669         if (drv_cmd->state & MPI3MR_CMD_REPLY_VALID)
2670                 tm_reply = (struct mpi3_scsi_task_mgmt_reply *)drv_cmd->reply;
2671
2672         if (drv_cmd->ioc_status != MPI3_IOCSTATUS_SUCCESS) {
2673                 ioc_err(mrioc,
2674                     "%s :Issue TM: handle(0x%04x) Failed ioc_status(0x%04x) Loginfo(0x%08x)\n",
2675                     __func__, handle, drv_cmd->ioc_status,
2676                     drv_cmd->ioc_loginfo);
2677                 retval = -1;
2678                 goto out_unlock;
2679         }
2680
2681         if (!tm_reply) {
2682                 ioc_err(mrioc, "%s :Issue TM: No TM Reply message\n", __func__);
2683                 retval = -1;
2684                 goto out_unlock;
2685         }
2686
2687         *resp_code = le32_to_cpu(tm_reply->response_data) &
2688             MPI3MR_RI_MASK_RESPCODE;
2689         switch (*resp_code) {
2690         case MPI3MR_RSP_TM_SUCCEEDED:
2691         case MPI3MR_RSP_TM_COMPLETE:
2692                 break;
2693         case MPI3MR_RSP_IO_QUEUED_ON_IOC:
2694                 if (tm_type != MPI3_SCSITASKMGMT_TASKTYPE_QUERY_TASK)
2695                         retval = -1;
2696                 break;
2697         default:
2698                 retval = -1;
2699                 break;
2700         }
2701
2702         ioc_info(mrioc,
2703             "%s :Issue TM: Completed TM type (0x%x) handle(0x%04x) ",
2704             __func__, tm_type, handle);
2705         ioc_info(mrioc,
2706             "with ioc_status(0x%04x), loginfo(0x%08x), term_count(0x%08x)\n",
2707             drv_cmd->ioc_status, drv_cmd->ioc_loginfo,
2708             le32_to_cpu(tm_reply->termination_count));
2709         mpi3mr_print_response_code(mrioc, *resp_code);
2710
2711 out_unlock:
2712         drv_cmd->state = MPI3MR_CMD_NOTUSED;
2713         mutex_unlock(&drv_cmd->mutex);
2714         if (scsi_tgt_priv_data)
2715                 atomic_dec_if_positive(&scsi_tgt_priv_data->block_io);
2716         if (tgtdev)
2717                 mpi3mr_tgtdev_put(tgtdev);
2718         if (!retval) {
2719                 /*
2720                  * Flush all IRQ handlers by calling synchronize_irq().
2721                  * mpi3mr_ioc_disable_intr() takes care of it.
2722                  */
2723                 mpi3mr_ioc_disable_intr(mrioc);
2724                 mpi3mr_ioc_enable_intr(mrioc);
2725         }
2726 out:
2727         return retval;
2728 }
2729
2730 /**
2731  * mpi3mr_bios_param - BIOS param callback
2732  * @sdev: SCSI device reference
2733  * @bdev: Block device reference
2734  * @capacity: Capacity in logical sectors
2735  * @params: Parameter array
2736  *
2737  * Just the parameters with heads/secots/cylinders.
2738  *
2739  * Return: 0 always
2740  */
2741 static int mpi3mr_bios_param(struct scsi_device *sdev,
2742         struct block_device *bdev, sector_t capacity, int params[])
2743 {
2744         int heads;
2745         int sectors;
2746         sector_t cylinders;
2747         ulong dummy;
2748
2749         heads = 64;
2750         sectors = 32;
2751
2752         dummy = heads * sectors;
2753         cylinders = capacity;
2754         sector_div(cylinders, dummy);
2755
2756         if ((ulong)capacity >= 0x200000) {
2757                 heads = 255;
2758                 sectors = 63;
2759                 dummy = heads * sectors;
2760                 cylinders = capacity;
2761                 sector_div(cylinders, dummy);
2762         }
2763
2764         params[0] = heads;
2765         params[1] = sectors;
2766         params[2] = cylinders;
2767         return 0;
2768 }
2769
2770 /**
2771  * mpi3mr_map_queues - Map queues callback handler
2772  * @shost: SCSI host reference
2773  *
2774  * Call the blk_mq_pci_map_queues with from which operational
2775  * queue the mapping has to be done
2776  *
2777  * Return: return of blk_mq_pci_map_queues
2778  */
2779 static int mpi3mr_map_queues(struct Scsi_Host *shost)
2780 {
2781         struct mpi3mr_ioc *mrioc = shost_priv(shost);
2782
2783         return blk_mq_pci_map_queues(&shost->tag_set.map[HCTX_TYPE_DEFAULT],
2784             mrioc->pdev, mrioc->op_reply_q_offset);
2785 }
2786
2787 /**
2788  * mpi3mr_get_fw_pending_ios - Calculate pending I/O count
2789  * @mrioc: Adapter instance reference
2790  *
2791  * Calculate the pending I/Os for the controller and return.
2792  *
2793  * Return: Number of pending I/Os
2794  */
2795 static inline int mpi3mr_get_fw_pending_ios(struct mpi3mr_ioc *mrioc)
2796 {
2797         u16 i;
2798         uint pend_ios = 0;
2799
2800         for (i = 0; i < mrioc->num_op_reply_q; i++)
2801                 pend_ios += atomic_read(&mrioc->op_reply_qinfo[i].pend_ios);
2802         return pend_ios;
2803 }
2804
2805 /**
2806  * mpi3mr_print_pending_host_io - print pending I/Os
2807  * @mrioc: Adapter instance reference
2808  *
2809  * Print number of pending I/Os and each I/O details prior to
2810  * reset for debug purpose.
2811  *
2812  * Return: Nothing
2813  */
2814 static void mpi3mr_print_pending_host_io(struct mpi3mr_ioc *mrioc)
2815 {
2816         struct Scsi_Host *shost = mrioc->shost;
2817
2818         ioc_info(mrioc, "%s :Pending commands prior to reset: %d\n",
2819             __func__, mpi3mr_get_fw_pending_ios(mrioc));
2820         blk_mq_tagset_busy_iter(&shost->tag_set,
2821             mpi3mr_print_scmd, (void *)mrioc);
2822 }
2823
2824 /**
2825  * mpi3mr_wait_for_host_io - block for I/Os to complete
2826  * @mrioc: Adapter instance reference
2827  * @timeout: time out in seconds
2828  * Waits for pending I/Os for the given adapter to complete or
2829  * to hit the timeout.
2830  *
2831  * Return: Nothing
2832  */
2833 void mpi3mr_wait_for_host_io(struct mpi3mr_ioc *mrioc, u32 timeout)
2834 {
2835         enum mpi3mr_iocstate iocstate;
2836         int i = 0;
2837
2838         iocstate = mpi3mr_get_iocstate(mrioc);
2839         if (iocstate != MRIOC_STATE_READY)
2840                 return;
2841
2842         if (!mpi3mr_get_fw_pending_ios(mrioc))
2843                 return;
2844         ioc_info(mrioc,
2845             "%s :Waiting for %d seconds prior to reset for %d I/O\n",
2846             __func__, timeout, mpi3mr_get_fw_pending_ios(mrioc));
2847
2848         for (i = 0; i < timeout; i++) {
2849                 if (!mpi3mr_get_fw_pending_ios(mrioc))
2850                         break;
2851                 iocstate = mpi3mr_get_iocstate(mrioc);
2852                 if (iocstate != MRIOC_STATE_READY)
2853                         break;
2854                 msleep(1000);
2855         }
2856
2857         ioc_info(mrioc, "%s :Pending I/Os after wait is: %d\n", __func__,
2858             mpi3mr_get_fw_pending_ios(mrioc));
2859 }
2860
2861 /**
2862  * mpi3mr_eh_host_reset - Host reset error handling callback
2863  * @scmd: SCSI command reference
2864  *
2865  * Issue controller reset if the scmd is for a Physical Device,
2866  * if the scmd is for RAID volume, then wait for
2867  * MPI3MR_RAID_ERRREC_RESET_TIMEOUT and checke whether any
2868  * pending I/Os prior to issuing reset to the controller.
2869  *
2870  * Return: SUCCESS of successful reset else FAILED
2871  */
2872 static int mpi3mr_eh_host_reset(struct scsi_cmnd *scmd)
2873 {
2874         struct mpi3mr_ioc *mrioc = shost_priv(scmd->device->host);
2875         struct mpi3mr_stgt_priv_data *stgt_priv_data;
2876         struct mpi3mr_sdev_priv_data *sdev_priv_data;
2877         u8 dev_type = MPI3_DEVICE_DEVFORM_VD;
2878         int retval = FAILED, ret;
2879
2880         sdev_priv_data = scmd->device->hostdata;
2881         if (sdev_priv_data && sdev_priv_data->tgt_priv_data) {
2882                 stgt_priv_data = sdev_priv_data->tgt_priv_data;
2883                 dev_type = stgt_priv_data->dev_type;
2884         }
2885
2886         if (dev_type == MPI3_DEVICE_DEVFORM_VD) {
2887                 mpi3mr_wait_for_host_io(mrioc,
2888                     MPI3MR_RAID_ERRREC_RESET_TIMEOUT);
2889                 if (!mpi3mr_get_fw_pending_ios(mrioc)) {
2890                         retval = SUCCESS;
2891                         goto out;
2892                 }
2893         }
2894
2895         mpi3mr_print_pending_host_io(mrioc);
2896         ret = mpi3mr_soft_reset_handler(mrioc,
2897             MPI3MR_RESET_FROM_EH_HOS, 1);
2898         if (ret)
2899                 goto out;
2900
2901         retval = SUCCESS;
2902 out:
2903         sdev_printk(KERN_INFO, scmd->device,
2904             "Host reset is %s for scmd(%p)\n",
2905             ((retval == SUCCESS) ? "SUCCESS" : "FAILED"), scmd);
2906
2907         return retval;
2908 }
2909
2910 /**
2911  * mpi3mr_eh_target_reset - Target reset error handling callback
2912  * @scmd: SCSI command reference
2913  *
2914  * Issue Target reset Task Management and verify the scmd is
2915  * terminated successfully and return status accordingly.
2916  *
2917  * Return: SUCCESS of successful termination of the scmd else
2918  *         FAILED
2919  */
2920 static int mpi3mr_eh_target_reset(struct scsi_cmnd *scmd)
2921 {
2922         struct mpi3mr_ioc *mrioc = shost_priv(scmd->device->host);
2923         struct mpi3mr_stgt_priv_data *stgt_priv_data;
2924         struct mpi3mr_sdev_priv_data *sdev_priv_data;
2925         u16 dev_handle;
2926         u8 resp_code = 0;
2927         int retval = FAILED, ret = 0;
2928
2929         sdev_printk(KERN_INFO, scmd->device,
2930             "Attempting Target Reset! scmd(%p)\n", scmd);
2931         scsi_print_command(scmd);
2932
2933         sdev_priv_data = scmd->device->hostdata;
2934         if (!sdev_priv_data || !sdev_priv_data->tgt_priv_data) {
2935                 sdev_printk(KERN_INFO, scmd->device,
2936                     "SCSI device is not available\n");
2937                 retval = SUCCESS;
2938                 goto out;
2939         }
2940
2941         stgt_priv_data = sdev_priv_data->tgt_priv_data;
2942         dev_handle = stgt_priv_data->dev_handle;
2943         sdev_printk(KERN_INFO, scmd->device,
2944             "Target Reset is issued to handle(0x%04x)\n",
2945             dev_handle);
2946
2947         ret = mpi3mr_issue_tm(mrioc,
2948             MPI3_SCSITASKMGMT_TASKTYPE_TARGET_RESET, dev_handle,
2949             sdev_priv_data->lun_id, MPI3MR_HOSTTAG_BLK_TMS,
2950             MPI3MR_RESETTM_TIMEOUT, &mrioc->host_tm_cmds, &resp_code, NULL);
2951
2952         if (ret)
2953                 goto out;
2954
2955         retval = SUCCESS;
2956 out:
2957         sdev_printk(KERN_INFO, scmd->device,
2958             "Target reset is %s for scmd(%p)\n",
2959             ((retval == SUCCESS) ? "SUCCESS" : "FAILED"), scmd);
2960
2961         return retval;
2962 }
2963
2964 /**
2965  * mpi3mr_eh_dev_reset- Device reset error handling callback
2966  * @scmd: SCSI command reference
2967  *
2968  * Issue lun reset Task Management and verify the scmd is
2969  * terminated successfully and return status accordingly.
2970  *
2971  * Return: SUCCESS of successful termination of the scmd else
2972  *         FAILED
2973  */
2974 static int mpi3mr_eh_dev_reset(struct scsi_cmnd *scmd)
2975 {
2976         struct mpi3mr_ioc *mrioc = shost_priv(scmd->device->host);
2977         struct mpi3mr_stgt_priv_data *stgt_priv_data;
2978         struct mpi3mr_sdev_priv_data *sdev_priv_data;
2979         u16 dev_handle;
2980         u8 resp_code = 0;
2981         int retval = FAILED, ret = 0;
2982
2983         sdev_printk(KERN_INFO, scmd->device,
2984             "Attempting Device(lun) Reset! scmd(%p)\n", scmd);
2985         scsi_print_command(scmd);
2986
2987         sdev_priv_data = scmd->device->hostdata;
2988         if (!sdev_priv_data || !sdev_priv_data->tgt_priv_data) {
2989                 sdev_printk(KERN_INFO, scmd->device,
2990                     "SCSI device is not available\n");
2991                 retval = SUCCESS;
2992                 goto out;
2993         }
2994
2995         stgt_priv_data = sdev_priv_data->tgt_priv_data;
2996         dev_handle = stgt_priv_data->dev_handle;
2997         sdev_printk(KERN_INFO, scmd->device,
2998             "Device(lun) Reset is issued to handle(0x%04x)\n", dev_handle);
2999
3000         ret = mpi3mr_issue_tm(mrioc,
3001             MPI3_SCSITASKMGMT_TASKTYPE_LOGICAL_UNIT_RESET, dev_handle,
3002             sdev_priv_data->lun_id, MPI3MR_HOSTTAG_BLK_TMS,
3003             MPI3MR_RESETTM_TIMEOUT, &mrioc->host_tm_cmds, &resp_code, NULL);
3004
3005         if (ret)
3006                 goto out;
3007
3008         retval = SUCCESS;
3009 out:
3010         sdev_printk(KERN_INFO, scmd->device,
3011             "Device(lun) reset is %s for scmd(%p)\n",
3012             ((retval == SUCCESS) ? "SUCCESS" : "FAILED"), scmd);
3013
3014         return retval;
3015 }
3016
3017 /**
3018  * mpi3mr_scan_start - Scan start callback handler
3019  * @shost: SCSI host reference
3020  *
3021  * Issue port enable request asynchronously.
3022  *
3023  * Return: Nothing
3024  */
3025 static void mpi3mr_scan_start(struct Scsi_Host *shost)
3026 {
3027         struct mpi3mr_ioc *mrioc = shost_priv(shost);
3028
3029         mrioc->scan_started = 1;
3030         ioc_info(mrioc, "%s :Issuing Port Enable\n", __func__);
3031         if (mpi3mr_issue_port_enable(mrioc, 1)) {
3032                 ioc_err(mrioc, "%s :Issuing port enable failed\n", __func__);
3033                 mrioc->scan_started = 0;
3034                 mrioc->scan_failed = MPI3_IOCSTATUS_INTERNAL_ERROR;
3035         }
3036 }
3037
3038 /**
3039  * mpi3mr_scan_finished - Scan finished callback handler
3040  * @shost: SCSI host reference
3041  * @time: Jiffies from the scan start
3042  *
3043  * Checks whether the port enable is completed or timedout or
3044  * failed and set the scan status accordingly after taking any
3045  * recovery if required.
3046  *
3047  * Return: 1 on scan finished or timed out, 0 for in progress
3048  */
3049 static int mpi3mr_scan_finished(struct Scsi_Host *shost,
3050         unsigned long time)
3051 {
3052         struct mpi3mr_ioc *mrioc = shost_priv(shost);
3053         u32 pe_timeout = MPI3MR_PORTENABLE_TIMEOUT;
3054
3055         if (time >= (pe_timeout * HZ)) {
3056                 mrioc->init_cmds.is_waiting = 0;
3057                 mrioc->init_cmds.callback = NULL;
3058                 mrioc->init_cmds.state = MPI3MR_CMD_NOTUSED;
3059                 ioc_err(mrioc, "%s :port enable request timed out\n", __func__);
3060                 mrioc->is_driver_loading = 0;
3061                 mpi3mr_soft_reset_handler(mrioc,
3062                     MPI3MR_RESET_FROM_PE_TIMEOUT, 1);
3063         }
3064
3065         if (mrioc->scan_failed) {
3066                 ioc_err(mrioc,
3067                     "%s :port enable failed with (ioc_status=0x%08x)\n",
3068                     __func__, mrioc->scan_failed);
3069                 mrioc->is_driver_loading = 0;
3070                 mrioc->stop_drv_processing = 1;
3071                 return 1;
3072         }
3073
3074         if (mrioc->scan_started)
3075                 return 0;
3076         ioc_info(mrioc, "%s :port enable: SUCCESS\n", __func__);
3077         mpi3mr_start_watchdog(mrioc);
3078         mrioc->is_driver_loading = 0;
3079
3080         return 1;
3081 }
3082
3083 /**
3084  * mpi3mr_slave_destroy - Slave destroy callback handler
3085  * @sdev: SCSI device reference
3086  *
3087  * Cleanup and free per device(lun) private data.
3088  *
3089  * Return: Nothing.
3090  */
3091 static void mpi3mr_slave_destroy(struct scsi_device *sdev)
3092 {
3093         struct Scsi_Host *shost;
3094         struct mpi3mr_ioc *mrioc;
3095         struct mpi3mr_stgt_priv_data *scsi_tgt_priv_data;
3096         struct mpi3mr_tgt_dev *tgt_dev;
3097         unsigned long flags;
3098         struct scsi_target *starget;
3099
3100         if (!sdev->hostdata)
3101                 return;
3102
3103         starget = scsi_target(sdev);
3104         shost = dev_to_shost(&starget->dev);
3105         mrioc = shost_priv(shost);
3106         scsi_tgt_priv_data = starget->hostdata;
3107
3108         scsi_tgt_priv_data->num_luns--;
3109
3110         spin_lock_irqsave(&mrioc->tgtdev_lock, flags);
3111         tgt_dev = __mpi3mr_get_tgtdev_by_perst_id(mrioc, starget->id);
3112         if (tgt_dev && (!scsi_tgt_priv_data->num_luns))
3113                 tgt_dev->starget = NULL;
3114         if (tgt_dev)
3115                 mpi3mr_tgtdev_put(tgt_dev);
3116         spin_unlock_irqrestore(&mrioc->tgtdev_lock, flags);
3117
3118         kfree(sdev->hostdata);
3119         sdev->hostdata = NULL;
3120 }
3121
3122 /**
3123  * mpi3mr_target_destroy - Target destroy callback handler
3124  * @starget: SCSI target reference
3125  *
3126  * Cleanup and free per target private data.
3127  *
3128  * Return: Nothing.
3129  */
3130 static void mpi3mr_target_destroy(struct scsi_target *starget)
3131 {
3132         struct Scsi_Host *shost;
3133         struct mpi3mr_ioc *mrioc;
3134         struct mpi3mr_stgt_priv_data *scsi_tgt_priv_data;
3135         struct mpi3mr_tgt_dev *tgt_dev;
3136         unsigned long flags;
3137
3138         if (!starget->hostdata)
3139                 return;
3140
3141         shost = dev_to_shost(&starget->dev);
3142         mrioc = shost_priv(shost);
3143         scsi_tgt_priv_data = starget->hostdata;
3144
3145         spin_lock_irqsave(&mrioc->tgtdev_lock, flags);
3146         tgt_dev = __mpi3mr_get_tgtdev_from_tgtpriv(mrioc, scsi_tgt_priv_data);
3147         if (tgt_dev && (tgt_dev->starget == starget) &&
3148             (tgt_dev->perst_id == starget->id))
3149                 tgt_dev->starget = NULL;
3150         if (tgt_dev) {
3151                 scsi_tgt_priv_data->tgt_dev = NULL;
3152                 scsi_tgt_priv_data->perst_id = 0;
3153                 mpi3mr_tgtdev_put(tgt_dev);
3154                 mpi3mr_tgtdev_put(tgt_dev);
3155         }
3156         spin_unlock_irqrestore(&mrioc->tgtdev_lock, flags);
3157
3158         kfree(starget->hostdata);
3159         starget->hostdata = NULL;
3160 }
3161
3162 /**
3163  * mpi3mr_slave_configure - Slave configure callback handler
3164  * @sdev: SCSI device reference
3165  *
3166  * Configure queue depth, max hardware sectors and virt boundary
3167  * as required
3168  *
3169  * Return: 0 always.
3170  */
3171 static int mpi3mr_slave_configure(struct scsi_device *sdev)
3172 {
3173         struct scsi_target *starget;
3174         struct Scsi_Host *shost;
3175         struct mpi3mr_ioc *mrioc;
3176         struct mpi3mr_tgt_dev *tgt_dev;
3177         unsigned long flags;
3178         int retval = 0;
3179
3180         starget = scsi_target(sdev);
3181         shost = dev_to_shost(&starget->dev);
3182         mrioc = shost_priv(shost);
3183
3184         spin_lock_irqsave(&mrioc->tgtdev_lock, flags);
3185         tgt_dev = __mpi3mr_get_tgtdev_by_perst_id(mrioc, starget->id);
3186         spin_unlock_irqrestore(&mrioc->tgtdev_lock, flags);
3187         if (!tgt_dev)
3188                 return -ENXIO;
3189
3190         mpi3mr_change_queue_depth(sdev, tgt_dev->q_depth);
3191         switch (tgt_dev->dev_type) {
3192         case MPI3_DEVICE_DEVFORM_PCIE:
3193                 /*The block layer hw sector size = 512*/
3194                 blk_queue_max_hw_sectors(sdev->request_queue,
3195                     tgt_dev->dev_spec.pcie_inf.mdts / 512);
3196                 blk_queue_virt_boundary(sdev->request_queue,
3197                     ((1 << tgt_dev->dev_spec.pcie_inf.pgsz) - 1));
3198                 break;
3199         default:
3200                 break;
3201         }
3202
3203         mpi3mr_tgtdev_put(tgt_dev);
3204
3205         return retval;
3206 }
3207
3208 /**
3209  * mpi3mr_slave_alloc -Slave alloc callback handler
3210  * @sdev: SCSI device reference
3211  *
3212  * Allocate per device(lun) private data and initialize it.
3213  *
3214  * Return: 0 on success -ENOMEM on memory allocation failure.
3215  */
3216 static int mpi3mr_slave_alloc(struct scsi_device *sdev)
3217 {
3218         struct Scsi_Host *shost;
3219         struct mpi3mr_ioc *mrioc;
3220         struct mpi3mr_stgt_priv_data *scsi_tgt_priv_data;
3221         struct mpi3mr_tgt_dev *tgt_dev;
3222         struct mpi3mr_sdev_priv_data *scsi_dev_priv_data;
3223         unsigned long flags;
3224         struct scsi_target *starget;
3225         int retval = 0;
3226
3227         starget = scsi_target(sdev);
3228         shost = dev_to_shost(&starget->dev);
3229         mrioc = shost_priv(shost);
3230         scsi_tgt_priv_data = starget->hostdata;
3231
3232         spin_lock_irqsave(&mrioc->tgtdev_lock, flags);
3233         tgt_dev = __mpi3mr_get_tgtdev_by_perst_id(mrioc, starget->id);
3234
3235         if (tgt_dev) {
3236                 if (tgt_dev->starget == NULL)
3237                         tgt_dev->starget = starget;
3238                 mpi3mr_tgtdev_put(tgt_dev);
3239                 retval = 0;
3240         } else {
3241                 spin_unlock_irqrestore(&mrioc->tgtdev_lock, flags);
3242                 return -ENXIO;
3243         }
3244
3245         spin_unlock_irqrestore(&mrioc->tgtdev_lock, flags);
3246
3247         scsi_dev_priv_data = kzalloc(sizeof(*scsi_dev_priv_data), GFP_KERNEL);
3248         if (!scsi_dev_priv_data)
3249                 return -ENOMEM;
3250
3251         scsi_dev_priv_data->lun_id = sdev->lun;
3252         scsi_dev_priv_data->tgt_priv_data = scsi_tgt_priv_data;
3253         sdev->hostdata = scsi_dev_priv_data;
3254
3255         scsi_tgt_priv_data->num_luns++;
3256
3257         return retval;
3258 }
3259
3260 /**
3261  * mpi3mr_target_alloc - Target alloc callback handler
3262  * @starget: SCSI target reference
3263  *
3264  * Allocate per target private data and initialize it.
3265  *
3266  * Return: 0 on success -ENOMEM on memory allocation failure.
3267  */
3268 static int mpi3mr_target_alloc(struct scsi_target *starget)
3269 {
3270         struct Scsi_Host *shost = dev_to_shost(&starget->dev);
3271         struct mpi3mr_ioc *mrioc = shost_priv(shost);
3272         struct mpi3mr_stgt_priv_data *scsi_tgt_priv_data;
3273         struct mpi3mr_tgt_dev *tgt_dev;
3274         unsigned long flags;
3275         int retval = 0;
3276
3277         scsi_tgt_priv_data = kzalloc(sizeof(*scsi_tgt_priv_data), GFP_KERNEL);
3278         if (!scsi_tgt_priv_data)
3279                 return -ENOMEM;
3280
3281         starget->hostdata = scsi_tgt_priv_data;
3282
3283         spin_lock_irqsave(&mrioc->tgtdev_lock, flags);
3284         tgt_dev = __mpi3mr_get_tgtdev_by_perst_id(mrioc, starget->id);
3285         if (tgt_dev && !tgt_dev->is_hidden) {
3286                 scsi_tgt_priv_data->starget = starget;
3287                 scsi_tgt_priv_data->dev_handle = tgt_dev->dev_handle;
3288                 scsi_tgt_priv_data->perst_id = tgt_dev->perst_id;
3289                 scsi_tgt_priv_data->dev_type = tgt_dev->dev_type;
3290                 scsi_tgt_priv_data->tgt_dev = tgt_dev;
3291                 tgt_dev->starget = starget;
3292                 atomic_set(&scsi_tgt_priv_data->block_io, 0);
3293                 retval = 0;
3294         } else
3295                 retval = -ENXIO;
3296         spin_unlock_irqrestore(&mrioc->tgtdev_lock, flags);
3297
3298         return retval;
3299 }
3300
3301 /**
3302  * mpi3mr_check_return_unmap - Whether an unmap is allowed
3303  * @mrioc: Adapter instance reference
3304  * @scmd: SCSI Command reference
3305  *
3306  * The controller hardware cannot handle certain unmap commands
3307  * for NVMe drives, this routine checks those and return true
3308  * and completes the SCSI command with proper status and sense
3309  * data.
3310  *
3311  * Return: TRUE for not  allowed unmap, FALSE otherwise.
3312  */
3313 static bool mpi3mr_check_return_unmap(struct mpi3mr_ioc *mrioc,
3314         struct scsi_cmnd *scmd)
3315 {
3316         unsigned char *buf;
3317         u16 param_len, desc_len;
3318
3319         param_len = get_unaligned_be16(scmd->cmnd + 7);
3320
3321         if (!param_len) {
3322                 ioc_warn(mrioc,
3323                     "%s: cdb received with zero parameter length\n",
3324                     __func__);
3325                 scsi_print_command(scmd);
3326                 scmd->result = DID_OK << 16;
3327                 scmd->scsi_done(scmd);
3328                 return true;
3329         }
3330
3331         if (param_len < 24) {
3332                 ioc_warn(mrioc,
3333                     "%s: cdb received with invalid param_len: %d\n",
3334                     __func__, param_len);
3335                 scsi_print_command(scmd);
3336                 scmd->result = SAM_STAT_CHECK_CONDITION;
3337                 scsi_build_sense_buffer(0, scmd->sense_buffer, ILLEGAL_REQUEST,
3338                     0x1A, 0);
3339                 scmd->scsi_done(scmd);
3340                 return true;
3341         }
3342         if (param_len != scsi_bufflen(scmd)) {
3343                 ioc_warn(mrioc,
3344                     "%s: cdb received with param_len: %d bufflen: %d\n",
3345                     __func__, param_len, scsi_bufflen(scmd));
3346                 scsi_print_command(scmd);
3347                 scmd->result = SAM_STAT_CHECK_CONDITION;
3348                 scsi_build_sense_buffer(0, scmd->sense_buffer, ILLEGAL_REQUEST,
3349                     0x1A, 0);
3350                 scmd->scsi_done(scmd);
3351                 return true;
3352         }
3353         buf = kzalloc(scsi_bufflen(scmd), GFP_ATOMIC);
3354         if (!buf) {
3355                 scsi_print_command(scmd);
3356                 scmd->result = SAM_STAT_CHECK_CONDITION;
3357                 scsi_build_sense_buffer(0, scmd->sense_buffer, ILLEGAL_REQUEST,
3358                     0x55, 0x03);
3359                 scmd->scsi_done(scmd);
3360                 return true;
3361         }
3362         scsi_sg_copy_to_buffer(scmd, buf, scsi_bufflen(scmd));
3363         desc_len = get_unaligned_be16(&buf[2]);
3364
3365         if (desc_len < 16) {
3366                 ioc_warn(mrioc,
3367                     "%s: Invalid descriptor length in param list: %d\n",
3368                     __func__, desc_len);
3369                 scsi_print_command(scmd);
3370                 scmd->result = SAM_STAT_CHECK_CONDITION;
3371                 scsi_build_sense_buffer(0, scmd->sense_buffer, ILLEGAL_REQUEST,
3372                     0x26, 0);
3373                 scmd->scsi_done(scmd);
3374                 kfree(buf);
3375                 return true;
3376         }
3377
3378         if (param_len > (desc_len + 8)) {
3379                 scsi_print_command(scmd);
3380                 ioc_warn(mrioc,
3381                     "%s: Truncating param_len(%d) to desc_len+8(%d)\n",
3382                     __func__, param_len, (desc_len + 8));
3383                 param_len = desc_len + 8;
3384                 put_unaligned_be16(param_len, scmd->cmnd + 7);
3385                 scsi_print_command(scmd);
3386         }
3387
3388         kfree(buf);
3389         return false;
3390 }
3391
3392 /**
3393  * mpi3mr_allow_scmd_to_fw - Command is allowed during shutdown
3394  * @scmd: SCSI Command reference
3395  *
3396  * Checks whether a cdb is allowed during shutdown or not.
3397  *
3398  * Return: TRUE for allowed commands, FALSE otherwise.
3399  */
3400
3401 inline bool mpi3mr_allow_scmd_to_fw(struct scsi_cmnd *scmd)
3402 {
3403         switch (scmd->cmnd[0]) {
3404         case SYNCHRONIZE_CACHE:
3405         case START_STOP:
3406                 return true;
3407         default:
3408                 return false;
3409         }
3410 }
3411
3412 /**
3413  * mpi3mr_qcmd - I/O request despatcher
3414  * @shost: SCSI Host reference
3415  * @scmd: SCSI Command reference
3416  *
3417  * Issues the SCSI Command as an MPI3 request.
3418  *
3419  * Return: 0 on successful queueing of the request or if the
3420  *         request is completed with failure.
3421  *         SCSI_MLQUEUE_DEVICE_BUSY when the device is busy.
3422  *         SCSI_MLQUEUE_HOST_BUSY when the host queue is full.
3423  */
3424 static int mpi3mr_qcmd(struct Scsi_Host *shost,
3425         struct scsi_cmnd *scmd)
3426 {
3427         struct mpi3mr_ioc *mrioc = shost_priv(shost);
3428         struct mpi3mr_stgt_priv_data *stgt_priv_data;
3429         struct mpi3mr_sdev_priv_data *sdev_priv_data;
3430         struct scmd_priv *scmd_priv_data = NULL;
3431         struct mpi3_scsi_io_request *scsiio_req = NULL;
3432         struct op_req_qinfo *op_req_q = NULL;
3433         int retval = 0;
3434         u16 dev_handle;
3435         u16 host_tag;
3436         u32 scsiio_flags = 0;
3437         struct request *rq = scsi_cmd_to_rq(scmd);
3438         int iprio_class;
3439
3440         sdev_priv_data = scmd->device->hostdata;
3441         if (!sdev_priv_data || !sdev_priv_data->tgt_priv_data) {
3442                 scmd->result = DID_NO_CONNECT << 16;
3443                 scmd->scsi_done(scmd);
3444                 goto out;
3445         }
3446
3447         if (mrioc->stop_drv_processing &&
3448             !(mpi3mr_allow_scmd_to_fw(scmd))) {
3449                 scmd->result = DID_NO_CONNECT << 16;
3450                 scmd->scsi_done(scmd);
3451                 goto out;
3452         }
3453
3454         if (mrioc->reset_in_progress) {
3455                 retval = SCSI_MLQUEUE_HOST_BUSY;
3456                 goto out;
3457         }
3458
3459         stgt_priv_data = sdev_priv_data->tgt_priv_data;
3460
3461         dev_handle = stgt_priv_data->dev_handle;
3462         if (dev_handle == MPI3MR_INVALID_DEV_HANDLE) {
3463                 scmd->result = DID_NO_CONNECT << 16;
3464                 scmd->scsi_done(scmd);
3465                 goto out;
3466         }
3467         if (stgt_priv_data->dev_removed) {
3468                 scmd->result = DID_NO_CONNECT << 16;
3469                 scmd->scsi_done(scmd);
3470                 goto out;
3471         }
3472
3473         if (atomic_read(&stgt_priv_data->block_io)) {
3474                 if (mrioc->stop_drv_processing) {
3475                         scmd->result = DID_NO_CONNECT << 16;
3476                         scmd->scsi_done(scmd);
3477                         goto out;
3478                 }
3479                 retval = SCSI_MLQUEUE_DEVICE_BUSY;
3480                 goto out;
3481         }
3482
3483         if ((scmd->cmnd[0] == UNMAP) &&
3484             (stgt_priv_data->dev_type == MPI3_DEVICE_DEVFORM_PCIE) &&
3485             mpi3mr_check_return_unmap(mrioc, scmd))
3486                 goto out;
3487
3488         host_tag = mpi3mr_host_tag_for_scmd(mrioc, scmd);
3489         if (host_tag == MPI3MR_HOSTTAG_INVALID) {
3490                 scmd->result = DID_ERROR << 16;
3491                 scmd->scsi_done(scmd);
3492                 goto out;
3493         }
3494
3495         if (scmd->sc_data_direction == DMA_FROM_DEVICE)
3496                 scsiio_flags = MPI3_SCSIIO_FLAGS_DATADIRECTION_READ;
3497         else if (scmd->sc_data_direction == DMA_TO_DEVICE)
3498                 scsiio_flags = MPI3_SCSIIO_FLAGS_DATADIRECTION_WRITE;
3499         else
3500                 scsiio_flags = MPI3_SCSIIO_FLAGS_DATADIRECTION_NO_DATA_TRANSFER;
3501
3502         scsiio_flags |= MPI3_SCSIIO_FLAGS_TASKATTRIBUTE_SIMPLEQ;
3503
3504         if (sdev_priv_data->ncq_prio_enable) {
3505                 iprio_class = IOPRIO_PRIO_CLASS(req_get_ioprio(rq));
3506                 if (iprio_class == IOPRIO_CLASS_RT)
3507                         scsiio_flags |= 1 << MPI3_SCSIIO_FLAGS_CMDPRI_SHIFT;
3508         }
3509
3510         if (scmd->cmd_len > 16)
3511                 scsiio_flags |= MPI3_SCSIIO_FLAGS_CDB_GREATER_THAN_16;
3512
3513         scmd_priv_data = scsi_cmd_priv(scmd);
3514         memset(scmd_priv_data->mpi3mr_scsiio_req, 0, MPI3MR_ADMIN_REQ_FRAME_SZ);
3515         scsiio_req = (struct mpi3_scsi_io_request *)scmd_priv_data->mpi3mr_scsiio_req;
3516         scsiio_req->function = MPI3_FUNCTION_SCSI_IO;
3517         scsiio_req->host_tag = cpu_to_le16(host_tag);
3518
3519         mpi3mr_setup_eedp(mrioc, scmd, scsiio_req);
3520
3521         memcpy(scsiio_req->cdb.cdb32, scmd->cmnd, scmd->cmd_len);
3522         scsiio_req->data_length = cpu_to_le32(scsi_bufflen(scmd));
3523         scsiio_req->dev_handle = cpu_to_le16(dev_handle);
3524         scsiio_req->flags = cpu_to_le32(scsiio_flags);
3525         int_to_scsilun(sdev_priv_data->lun_id,
3526             (struct scsi_lun *)scsiio_req->lun);
3527
3528         if (mpi3mr_build_sg_scmd(mrioc, scmd, scsiio_req)) {
3529                 mpi3mr_clear_scmd_priv(mrioc, scmd);
3530                 retval = SCSI_MLQUEUE_HOST_BUSY;
3531                 goto out;
3532         }
3533         op_req_q = &mrioc->req_qinfo[scmd_priv_data->req_q_idx];
3534
3535         if (mpi3mr_op_request_post(mrioc, op_req_q,
3536             scmd_priv_data->mpi3mr_scsiio_req)) {
3537                 mpi3mr_clear_scmd_priv(mrioc, scmd);
3538                 retval = SCSI_MLQUEUE_HOST_BUSY;
3539                 goto out;
3540         }
3541
3542 out:
3543         return retval;
3544 }
3545
3546 static struct scsi_host_template mpi3mr_driver_template = {
3547         .module                         = THIS_MODULE,
3548         .name                           = "MPI3 Storage Controller",
3549         .proc_name                      = MPI3MR_DRIVER_NAME,
3550         .queuecommand                   = mpi3mr_qcmd,
3551         .target_alloc                   = mpi3mr_target_alloc,
3552         .slave_alloc                    = mpi3mr_slave_alloc,
3553         .slave_configure                = mpi3mr_slave_configure,
3554         .target_destroy                 = mpi3mr_target_destroy,
3555         .slave_destroy                  = mpi3mr_slave_destroy,
3556         .scan_finished                  = mpi3mr_scan_finished,
3557         .scan_start                     = mpi3mr_scan_start,
3558         .change_queue_depth             = mpi3mr_change_queue_depth,
3559         .eh_device_reset_handler        = mpi3mr_eh_dev_reset,
3560         .eh_target_reset_handler        = mpi3mr_eh_target_reset,
3561         .eh_host_reset_handler          = mpi3mr_eh_host_reset,
3562         .bios_param                     = mpi3mr_bios_param,
3563         .map_queues                     = mpi3mr_map_queues,
3564         .no_write_same                  = 1,
3565         .can_queue                      = 1,
3566         .this_id                        = -1,
3567         .sg_tablesize                   = MPI3MR_SG_DEPTH,
3568         /* max xfer supported is 1M (2K in 512 byte sized sectors)
3569          */
3570         .max_sectors                    = 2048,
3571         .cmd_per_lun                    = MPI3MR_MAX_CMDS_LUN,
3572         .track_queue_depth              = 1,
3573         .cmd_size                       = sizeof(struct scmd_priv),
3574 };
3575
3576 /**
3577  * mpi3mr_init_drv_cmd - Initialize internal command tracker
3578  * @cmdptr: Internal command tracker
3579  * @host_tag: Host tag used for the specific command
3580  *
3581  * Initialize the internal command tracker structure with
3582  * specified host tag.
3583  *
3584  * Return: Nothing.
3585  */
3586 static inline void mpi3mr_init_drv_cmd(struct mpi3mr_drv_cmd *cmdptr,
3587         u16 host_tag)
3588 {
3589         mutex_init(&cmdptr->mutex);
3590         cmdptr->reply = NULL;
3591         cmdptr->state = MPI3MR_CMD_NOTUSED;
3592         cmdptr->dev_handle = MPI3MR_INVALID_DEV_HANDLE;
3593         cmdptr->host_tag = host_tag;
3594 }
3595
3596 /**
3597  * osintfc_mrioc_security_status -Check controller secure status
3598  * @pdev: PCI device instance
3599  *
3600  * Read the Device Serial Number capability from PCI config
3601  * space and decide whether the controller is secure or not.
3602  *
3603  * Return: 0 on success, non-zero on failure.
3604  */
3605 static int
3606 osintfc_mrioc_security_status(struct pci_dev *pdev)
3607 {
3608         u32 cap_data;
3609         int base;
3610         u32 ctlr_status;
3611         u32 debug_status;
3612         int retval = 0;
3613
3614         base = pci_find_ext_capability(pdev, PCI_EXT_CAP_ID_DSN);
3615         if (!base) {
3616                 dev_err(&pdev->dev,
3617                     "%s: PCI_EXT_CAP_ID_DSN is not supported\n", __func__);
3618                 return -1;
3619         }
3620
3621         pci_read_config_dword(pdev, base + 4, &cap_data);
3622
3623         debug_status = cap_data & MPI3MR_CTLR_SECURE_DBG_STATUS_MASK;
3624         ctlr_status = cap_data & MPI3MR_CTLR_SECURITY_STATUS_MASK;
3625
3626         switch (ctlr_status) {
3627         case MPI3MR_INVALID_DEVICE:
3628                 dev_err(&pdev->dev,
3629                     "%s: Non secure ctlr (Invalid) is detected: DID: 0x%x: SVID: 0x%x: SDID: 0x%x\n",
3630                     __func__, pdev->device, pdev->subsystem_vendor,
3631                     pdev->subsystem_device);
3632                 retval = -1;
3633                 break;
3634         case MPI3MR_CONFIG_SECURE_DEVICE:
3635                 if (!debug_status)
3636                         dev_info(&pdev->dev,
3637                             "%s: Config secure ctlr is detected\n",
3638                             __func__);
3639                 break;
3640         case MPI3MR_HARD_SECURE_DEVICE:
3641                 break;
3642         case MPI3MR_TAMPERED_DEVICE:
3643                 dev_err(&pdev->dev,
3644                     "%s: Non secure ctlr (Tampered) is detected: DID: 0x%x: SVID: 0x%x: SDID: 0x%x\n",
3645                     __func__, pdev->device, pdev->subsystem_vendor,
3646                     pdev->subsystem_device);
3647                 retval = -1;
3648                 break;
3649         default:
3650                 retval = -1;
3651                         break;
3652         }
3653
3654         if (!retval && debug_status) {
3655                 dev_err(&pdev->dev,
3656                     "%s: Non secure ctlr (Secure Dbg) is detected: DID: 0x%x: SVID: 0x%x: SDID: 0x%x\n",
3657                     __func__, pdev->device, pdev->subsystem_vendor,
3658                     pdev->subsystem_device);
3659                 retval = -1;
3660         }
3661
3662         return retval;
3663 }
3664
3665 /**
3666  * mpi3mr_probe - PCI probe callback
3667  * @pdev: PCI device instance
3668  * @id: PCI device ID details
3669  *
3670  * controller initialization routine. Checks the security status
3671  * of the controller and if it is invalid or tampered return the
3672  * probe without initializing the controller. Otherwise,
3673  * allocate per adapter instance through shost_priv and
3674  * initialize controller specific data structures, initializae
3675  * the controller hardware, add shost to the SCSI subsystem.
3676  *
3677  * Return: 0 on success, non-zero on failure.
3678  */
3679
3680 static int
3681 mpi3mr_probe(struct pci_dev *pdev, const struct pci_device_id *id)
3682 {
3683         struct mpi3mr_ioc *mrioc = NULL;
3684         struct Scsi_Host *shost = NULL;
3685         int retval = 0, i;
3686
3687         if (osintfc_mrioc_security_status(pdev)) {
3688                 warn_non_secure_ctlr = 1;
3689                 return 1; /* For Invalid and Tampered device */
3690         }
3691
3692         shost = scsi_host_alloc(&mpi3mr_driver_template,
3693             sizeof(struct mpi3mr_ioc));
3694         if (!shost) {
3695                 retval = -ENODEV;
3696                 goto shost_failed;
3697         }
3698
3699         mrioc = shost_priv(shost);
3700         mrioc->id = mrioc_ids++;
3701         sprintf(mrioc->driver_name, "%s", MPI3MR_DRIVER_NAME);
3702         sprintf(mrioc->name, "%s%d", mrioc->driver_name, mrioc->id);
3703         INIT_LIST_HEAD(&mrioc->list);
3704         spin_lock(&mrioc_list_lock);
3705         list_add_tail(&mrioc->list, &mrioc_list);
3706         spin_unlock(&mrioc_list_lock);
3707
3708         spin_lock_init(&mrioc->admin_req_lock);
3709         spin_lock_init(&mrioc->reply_free_queue_lock);
3710         spin_lock_init(&mrioc->sbq_lock);
3711         spin_lock_init(&mrioc->fwevt_lock);
3712         spin_lock_init(&mrioc->tgtdev_lock);
3713         spin_lock_init(&mrioc->watchdog_lock);
3714         spin_lock_init(&mrioc->chain_buf_lock);
3715
3716         INIT_LIST_HEAD(&mrioc->fwevt_list);
3717         INIT_LIST_HEAD(&mrioc->tgtdev_list);
3718         INIT_LIST_HEAD(&mrioc->delayed_rmhs_list);
3719
3720         mutex_init(&mrioc->reset_mutex);
3721         mpi3mr_init_drv_cmd(&mrioc->init_cmds, MPI3MR_HOSTTAG_INITCMDS);
3722         mpi3mr_init_drv_cmd(&mrioc->host_tm_cmds, MPI3MR_HOSTTAG_BLK_TMS);
3723
3724         for (i = 0; i < MPI3MR_NUM_DEVRMCMD; i++)
3725                 mpi3mr_init_drv_cmd(&mrioc->dev_rmhs_cmds[i],
3726                     MPI3MR_HOSTTAG_DEVRMCMD_MIN + i);
3727
3728         if (pdev->revision)
3729                 mrioc->enable_segqueue = true;
3730
3731         init_waitqueue_head(&mrioc->reset_waitq);
3732         mrioc->logging_level = logging_level;
3733         mrioc->shost = shost;
3734         mrioc->pdev = pdev;
3735
3736         /* init shost parameters */
3737         shost->max_cmd_len = MPI3MR_MAX_CDB_LENGTH;
3738         shost->max_lun = -1;
3739         shost->unique_id = mrioc->id;
3740
3741         shost->max_channel = 0;
3742         shost->max_id = 0xFFFFFFFF;
3743
3744         if (prot_mask >= 0)
3745                 scsi_host_set_prot(shost, prot_mask);
3746         else {
3747                 prot_mask = SHOST_DIF_TYPE1_PROTECTION
3748                     | SHOST_DIF_TYPE2_PROTECTION
3749                     | SHOST_DIF_TYPE3_PROTECTION;
3750                 scsi_host_set_prot(shost, prot_mask);
3751         }
3752
3753         ioc_info(mrioc,
3754             "%s :host protection capabilities enabled %s%s%s%s%s%s%s\n",
3755             __func__,
3756             (prot_mask & SHOST_DIF_TYPE1_PROTECTION) ? " DIF1" : "",
3757             (prot_mask & SHOST_DIF_TYPE2_PROTECTION) ? " DIF2" : "",
3758             (prot_mask & SHOST_DIF_TYPE3_PROTECTION) ? " DIF3" : "",
3759             (prot_mask & SHOST_DIX_TYPE0_PROTECTION) ? " DIX0" : "",
3760             (prot_mask & SHOST_DIX_TYPE1_PROTECTION) ? " DIX1" : "",
3761             (prot_mask & SHOST_DIX_TYPE2_PROTECTION) ? " DIX2" : "",
3762             (prot_mask & SHOST_DIX_TYPE3_PROTECTION) ? " DIX3" : "");
3763
3764         if (prot_guard_mask)
3765                 scsi_host_set_guard(shost, (prot_guard_mask & 3));
3766         else
3767                 scsi_host_set_guard(shost, SHOST_DIX_GUARD_CRC);
3768
3769         snprintf(mrioc->fwevt_worker_name, sizeof(mrioc->fwevt_worker_name),
3770             "%s%d_fwevt_wrkr", mrioc->driver_name, mrioc->id);
3771         mrioc->fwevt_worker_thread = alloc_ordered_workqueue(
3772             mrioc->fwevt_worker_name, WQ_MEM_RECLAIM);
3773         if (!mrioc->fwevt_worker_thread) {
3774                 ioc_err(mrioc, "failure at %s:%d/%s()!\n",
3775                     __FILE__, __LINE__, __func__);
3776                 retval = -ENODEV;
3777                 goto out_fwevtthread_failed;
3778         }
3779
3780         mrioc->is_driver_loading = 1;
3781         if (mpi3mr_init_ioc(mrioc, MPI3MR_IT_INIT)) {
3782                 ioc_err(mrioc, "failure at %s:%d/%s()!\n",
3783                     __FILE__, __LINE__, __func__);
3784                 retval = -ENODEV;
3785                 goto out_iocinit_failed;
3786         }
3787
3788         shost->nr_hw_queues = mrioc->num_op_reply_q;
3789         shost->can_queue = mrioc->max_host_ios;
3790         shost->sg_tablesize = MPI3MR_SG_DEPTH;
3791         shost->max_id = mrioc->facts.max_perids;
3792
3793         retval = scsi_add_host(shost, &pdev->dev);
3794         if (retval) {
3795                 ioc_err(mrioc, "failure at %s:%d/%s()!\n",
3796                     __FILE__, __LINE__, __func__);
3797                 goto addhost_failed;
3798         }
3799
3800         scsi_scan_host(shost);
3801         return retval;
3802
3803 addhost_failed:
3804         mpi3mr_cleanup_ioc(mrioc, MPI3MR_COMPLETE_CLEANUP);
3805 out_iocinit_failed:
3806         destroy_workqueue(mrioc->fwevt_worker_thread);
3807 out_fwevtthread_failed:
3808         spin_lock(&mrioc_list_lock);
3809         list_del(&mrioc->list);
3810         spin_unlock(&mrioc_list_lock);
3811         scsi_host_put(shost);
3812 shost_failed:
3813         return retval;
3814 }
3815
3816 /**
3817  * mpi3mr_remove - PCI remove callback
3818  * @pdev: PCI device instance
3819  *
3820  * Free up all memory and resources associated with the
3821  * controllerand target devices, unregister the shost.
3822  *
3823  * Return: Nothing.
3824  */
3825 static void mpi3mr_remove(struct pci_dev *pdev)
3826 {
3827         struct Scsi_Host *shost = pci_get_drvdata(pdev);
3828         struct mpi3mr_ioc *mrioc;
3829         struct workqueue_struct *wq;
3830         unsigned long flags;
3831         struct mpi3mr_tgt_dev *tgtdev, *tgtdev_next;
3832
3833         if (!shost)
3834                 return;
3835
3836         mrioc = shost_priv(shost);
3837         while (mrioc->reset_in_progress || mrioc->is_driver_loading)
3838                 ssleep(1);
3839
3840         mrioc->stop_drv_processing = 1;
3841         mpi3mr_cleanup_fwevt_list(mrioc);
3842         spin_lock_irqsave(&mrioc->fwevt_lock, flags);
3843         wq = mrioc->fwevt_worker_thread;
3844         mrioc->fwevt_worker_thread = NULL;
3845         spin_unlock_irqrestore(&mrioc->fwevt_lock, flags);
3846         if (wq)
3847                 destroy_workqueue(wq);
3848         scsi_remove_host(shost);
3849
3850         list_for_each_entry_safe(tgtdev, tgtdev_next, &mrioc->tgtdev_list,
3851             list) {
3852                 mpi3mr_remove_tgtdev_from_host(mrioc, tgtdev);
3853                 mpi3mr_tgtdev_del_from_list(mrioc, tgtdev);
3854                 mpi3mr_tgtdev_put(tgtdev);
3855         }
3856         mpi3mr_cleanup_ioc(mrioc, MPI3MR_COMPLETE_CLEANUP);
3857
3858         spin_lock(&mrioc_list_lock);
3859         list_del(&mrioc->list);
3860         spin_unlock(&mrioc_list_lock);
3861
3862         scsi_host_put(shost);
3863 }
3864
3865 /**
3866  * mpi3mr_shutdown - PCI shutdown callback
3867  * @pdev: PCI device instance
3868  *
3869  * Free up all memory and resources associated with the
3870  * controller
3871  *
3872  * Return: Nothing.
3873  */
3874 static void mpi3mr_shutdown(struct pci_dev *pdev)
3875 {
3876         struct Scsi_Host *shost = pci_get_drvdata(pdev);
3877         struct mpi3mr_ioc *mrioc;
3878         struct workqueue_struct *wq;
3879         unsigned long flags;
3880
3881         if (!shost)
3882                 return;
3883
3884         mrioc = shost_priv(shost);
3885         while (mrioc->reset_in_progress || mrioc->is_driver_loading)
3886                 ssleep(1);
3887
3888         mrioc->stop_drv_processing = 1;
3889         mpi3mr_cleanup_fwevt_list(mrioc);
3890         spin_lock_irqsave(&mrioc->fwevt_lock, flags);
3891         wq = mrioc->fwevt_worker_thread;
3892         mrioc->fwevt_worker_thread = NULL;
3893         spin_unlock_irqrestore(&mrioc->fwevt_lock, flags);
3894         if (wq)
3895                 destroy_workqueue(wq);
3896         mpi3mr_cleanup_ioc(mrioc, MPI3MR_COMPLETE_CLEANUP);
3897 }
3898
3899 #ifdef CONFIG_PM
3900 /**
3901  * mpi3mr_suspend - PCI power management suspend callback
3902  * @pdev: PCI device instance
3903  * @state: New power state
3904  *
3905  * Change the power state to the given value and cleanup the IOC
3906  * by issuing MUR and shutdown notification
3907  *
3908  * Return: 0 always.
3909  */
3910 static int mpi3mr_suspend(struct pci_dev *pdev, pm_message_t state)
3911 {
3912         struct Scsi_Host *shost = pci_get_drvdata(pdev);
3913         struct mpi3mr_ioc *mrioc;
3914         pci_power_t device_state;
3915
3916         if (!shost)
3917                 return 0;
3918
3919         mrioc = shost_priv(shost);
3920         while (mrioc->reset_in_progress || mrioc->is_driver_loading)
3921                 ssleep(1);
3922         mrioc->stop_drv_processing = 1;
3923         mpi3mr_cleanup_fwevt_list(mrioc);
3924         scsi_block_requests(shost);
3925         mpi3mr_stop_watchdog(mrioc);
3926         mpi3mr_cleanup_ioc(mrioc, MPI3MR_SUSPEND);
3927
3928         device_state = pci_choose_state(pdev, state);
3929         ioc_info(mrioc, "pdev=0x%p, slot=%s, entering operating state [D%d]\n",
3930             pdev, pci_name(pdev), device_state);
3931         pci_save_state(pdev);
3932         pci_set_power_state(pdev, device_state);
3933         mpi3mr_cleanup_resources(mrioc);
3934
3935         return 0;
3936 }
3937
3938 /**
3939  * mpi3mr_resume - PCI power management resume callback
3940  * @pdev: PCI device instance
3941  *
3942  * Restore the power state to D0 and reinitialize the controller
3943  * and resume I/O operations to the target devices
3944  *
3945  * Return: 0 on success, non-zero on failure
3946  */
3947 static int mpi3mr_resume(struct pci_dev *pdev)
3948 {
3949         struct Scsi_Host *shost = pci_get_drvdata(pdev);
3950         struct mpi3mr_ioc *mrioc;
3951         pci_power_t device_state = pdev->current_state;
3952         int r;
3953
3954         if (!shost)
3955                 return 0;
3956
3957         mrioc = shost_priv(shost);
3958
3959         ioc_info(mrioc, "pdev=0x%p, slot=%s, previous operating state [D%d]\n",
3960             pdev, pci_name(pdev), device_state);
3961         pci_set_power_state(pdev, PCI_D0);
3962         pci_enable_wake(pdev, PCI_D0, 0);
3963         pci_restore_state(pdev);
3964         mrioc->pdev = pdev;
3965         mrioc->cpu_count = num_online_cpus();
3966         r = mpi3mr_setup_resources(mrioc);
3967         if (r) {
3968                 ioc_info(mrioc, "%s: Setup resources failed[%d]\n",
3969                     __func__, r);
3970                 return r;
3971         }
3972
3973         mrioc->stop_drv_processing = 0;
3974         mpi3mr_memset_buffers(mrioc);
3975         mpi3mr_init_ioc(mrioc, MPI3MR_IT_RESUME);
3976         scsi_unblock_requests(shost);
3977         mpi3mr_start_watchdog(mrioc);
3978
3979         return 0;
3980 }
3981 #endif
3982
3983 static const struct pci_device_id mpi3mr_pci_id_table[] = {
3984         {
3985                 PCI_DEVICE_SUB(PCI_VENDOR_ID_LSI_LOGIC, 0x00A5,
3986                     PCI_ANY_ID, PCI_ANY_ID)
3987         },
3988         { 0 }
3989 };
3990 MODULE_DEVICE_TABLE(pci, mpi3mr_pci_id_table);
3991
3992 static struct pci_driver mpi3mr_pci_driver = {
3993         .name = MPI3MR_DRIVER_NAME,
3994         .id_table = mpi3mr_pci_id_table,
3995         .probe = mpi3mr_probe,
3996         .remove = mpi3mr_remove,
3997         .shutdown = mpi3mr_shutdown,
3998 #ifdef CONFIG_PM
3999         .suspend = mpi3mr_suspend,
4000         .resume = mpi3mr_resume,
4001 #endif
4002 };
4003
4004 static int __init mpi3mr_init(void)
4005 {
4006         int ret_val;
4007
4008         pr_info("Loading %s version %s\n", MPI3MR_DRIVER_NAME,
4009             MPI3MR_DRIVER_VERSION);
4010
4011         ret_val = pci_register_driver(&mpi3mr_pci_driver);
4012
4013         return ret_val;
4014 }
4015
4016 static void __exit mpi3mr_exit(void)
4017 {
4018         if (warn_non_secure_ctlr)
4019                 pr_warn(
4020                     "Unloading %s version %s while managing a non secure controller\n",
4021                     MPI3MR_DRIVER_NAME, MPI3MR_DRIVER_VERSION);
4022         else
4023                 pr_info("Unloading %s version %s\n", MPI3MR_DRIVER_NAME,
4024                     MPI3MR_DRIVER_VERSION);
4025
4026         pci_unregister_driver(&mpi3mr_pci_driver);
4027 }
4028
4029 module_init(mpi3mr_init);
4030 module_exit(mpi3mr_exit);