1
2
3
4
5
6
7
8
9
10#include "mpi3mr.h"
11#include <linux/io-64-nonatomic-lo-hi.h>
12
13#if defined(writeq) && defined(CONFIG_64BIT)
14static inline void mpi3mr_writeq(__u64 b, volatile void __iomem *addr)
15{
16 writeq(b, addr);
17}
18#else
19static inline void mpi3mr_writeq(__u64 b, volatile void __iomem *addr)
20{
21 __u64 data_out = b;
22
23 writel((u32)(data_out), addr);
24 writel((u32)(data_out >> 32), (addr + 4));
25}
26#endif
27
28static inline bool
29mpi3mr_check_req_qfull(struct op_req_qinfo *op_req_q)
30{
31 u16 pi, ci, max_entries;
32 bool is_qfull = false;
33
34 pi = op_req_q->pi;
35 ci = READ_ONCE(op_req_q->ci);
36 max_entries = op_req_q->num_requests;
37
38 if ((ci == (pi + 1)) || ((!ci) && (pi == (max_entries - 1))))
39 is_qfull = true;
40
41 return is_qfull;
42}
43
44static void mpi3mr_sync_irqs(struct mpi3mr_ioc *mrioc)
45{
46 u16 i, max_vectors;
47
48 max_vectors = mrioc->intr_info_count;
49
50 for (i = 0; i < max_vectors; i++)
51 synchronize_irq(pci_irq_vector(mrioc->pdev, i));
52}
53
54void mpi3mr_ioc_disable_intr(struct mpi3mr_ioc *mrioc)
55{
56 mrioc->intr_enabled = 0;
57 mpi3mr_sync_irqs(mrioc);
58}
59
60void mpi3mr_ioc_enable_intr(struct mpi3mr_ioc *mrioc)
61{
62 mrioc->intr_enabled = 1;
63}
64
65static void mpi3mr_cleanup_isr(struct mpi3mr_ioc *mrioc)
66{
67 u16 i;
68
69 mpi3mr_ioc_disable_intr(mrioc);
70
71 if (!mrioc->intr_info)
72 return;
73
74 for (i = 0; i < mrioc->intr_info_count; i++)
75 free_irq(pci_irq_vector(mrioc->pdev, i),
76 (mrioc->intr_info + i));
77
78 kfree(mrioc->intr_info);
79 mrioc->intr_info = NULL;
80 mrioc->intr_info_count = 0;
81 pci_free_irq_vectors(mrioc->pdev);
82}
83
84void mpi3mr_add_sg_single(void *paddr, u8 flags, u32 length,
85 dma_addr_t dma_addr)
86{
87 struct mpi3_sge_common *sgel = paddr;
88
89 sgel->flags = flags;
90 sgel->length = cpu_to_le32(length);
91 sgel->address = cpu_to_le64(dma_addr);
92}
93
94void mpi3mr_build_zero_len_sge(void *paddr)
95{
96 u8 sgl_flags = MPI3MR_SGEFLAGS_SYSTEM_SIMPLE_END_OF_LIST;
97
98 mpi3mr_add_sg_single(paddr, sgl_flags, 0, -1);
99}
100
101void *mpi3mr_get_reply_virt_addr(struct mpi3mr_ioc *mrioc,
102 dma_addr_t phys_addr)
103{
104 if (!phys_addr)
105 return NULL;
106
107 if ((phys_addr < mrioc->reply_buf_dma) ||
108 (phys_addr > mrioc->reply_buf_dma_max_address))
109 return NULL;
110
111 return mrioc->reply_buf + (phys_addr - mrioc->reply_buf_dma);
112}
113
114void *mpi3mr_get_sensebuf_virt_addr(struct mpi3mr_ioc *mrioc,
115 dma_addr_t phys_addr)
116{
117 if (!phys_addr)
118 return NULL;
119
120 return mrioc->sense_buf + (phys_addr - mrioc->sense_buf_dma);
121}
122
123static void mpi3mr_repost_reply_buf(struct mpi3mr_ioc *mrioc,
124 u64 reply_dma)
125{
126 u32 old_idx = 0;
127
128 spin_lock(&mrioc->reply_free_queue_lock);
129 old_idx = mrioc->reply_free_queue_host_index;
130 mrioc->reply_free_queue_host_index = (
131 (mrioc->reply_free_queue_host_index ==
132 (mrioc->reply_free_qsz - 1)) ? 0 :
133 (mrioc->reply_free_queue_host_index + 1));
134 mrioc->reply_free_q[old_idx] = cpu_to_le64(reply_dma);
135 writel(mrioc->reply_free_queue_host_index,
136 &mrioc->sysif_regs->reply_free_host_index);
137 spin_unlock(&mrioc->reply_free_queue_lock);
138}
139
140void mpi3mr_repost_sense_buf(struct mpi3mr_ioc *mrioc,
141 u64 sense_buf_dma)
142{
143 u32 old_idx = 0;
144
145 spin_lock(&mrioc->sbq_lock);
146 old_idx = mrioc->sbq_host_index;
147 mrioc->sbq_host_index = ((mrioc->sbq_host_index ==
148 (mrioc->sense_buf_q_sz - 1)) ? 0 :
149 (mrioc->sbq_host_index + 1));
150 mrioc->sense_buf_q[old_idx] = cpu_to_le64(sense_buf_dma);
151 writel(mrioc->sbq_host_index,
152 &mrioc->sysif_regs->sense_buffer_free_host_index);
153 spin_unlock(&mrioc->sbq_lock);
154}
155
156static void mpi3mr_print_event_data(struct mpi3mr_ioc *mrioc,
157 struct mpi3_event_notification_reply *event_reply)
158{
159 char *desc = NULL;
160 u16 event;
161
162 event = event_reply->event;
163
164 switch (event) {
165 case MPI3_EVENT_LOG_DATA:
166 desc = "Log Data";
167 break;
168 case MPI3_EVENT_CHANGE:
169 desc = "Event Change";
170 break;
171 case MPI3_EVENT_GPIO_INTERRUPT:
172 desc = "GPIO Interrupt";
173 break;
174 case MPI3_EVENT_TEMP_THRESHOLD:
175 desc = "Temperature Threshold";
176 break;
177 case MPI3_EVENT_CABLE_MGMT:
178 desc = "Cable Management";
179 break;
180 case MPI3_EVENT_ENERGY_PACK_CHANGE:
181 desc = "Energy Pack Change";
182 break;
183 case MPI3_EVENT_DEVICE_ADDED:
184 {
185 struct mpi3_device_page0 *event_data =
186 (struct mpi3_device_page0 *)event_reply->event_data;
187 ioc_info(mrioc, "Device Added: dev=0x%04x Form=0x%x\n",
188 event_data->dev_handle, event_data->device_form);
189 return;
190 }
191 case MPI3_EVENT_DEVICE_INFO_CHANGED:
192 {
193 struct mpi3_device_page0 *event_data =
194 (struct mpi3_device_page0 *)event_reply->event_data;
195 ioc_info(mrioc, "Device Info Changed: dev=0x%04x Form=0x%x\n",
196 event_data->dev_handle, event_data->device_form);
197 return;
198 }
199 case MPI3_EVENT_DEVICE_STATUS_CHANGE:
200 {
201 struct mpi3_event_data_device_status_change *event_data =
202 (struct mpi3_event_data_device_status_change *)event_reply->event_data;
203 ioc_info(mrioc, "Device status Change: dev=0x%04x RC=0x%x\n",
204 event_data->dev_handle, event_data->reason_code);
205 return;
206 }
207 case MPI3_EVENT_SAS_DISCOVERY:
208 {
209 struct mpi3_event_data_sas_discovery *event_data =
210 (struct mpi3_event_data_sas_discovery *)event_reply->event_data;
211 ioc_info(mrioc, "SAS Discovery: (%s) status (0x%08x)\n",
212 (event_data->reason_code == MPI3_EVENT_SAS_DISC_RC_STARTED) ?
213 "start" : "stop",
214 le32_to_cpu(event_data->discovery_status));
215 return;
216 }
217 case MPI3_EVENT_SAS_BROADCAST_PRIMITIVE:
218 desc = "SAS Broadcast Primitive";
219 break;
220 case MPI3_EVENT_SAS_NOTIFY_PRIMITIVE:
221 desc = "SAS Notify Primitive";
222 break;
223 case MPI3_EVENT_SAS_INIT_DEVICE_STATUS_CHANGE:
224 desc = "SAS Init Device Status Change";
225 break;
226 case MPI3_EVENT_SAS_INIT_TABLE_OVERFLOW:
227 desc = "SAS Init Table Overflow";
228 break;
229 case MPI3_EVENT_SAS_TOPOLOGY_CHANGE_LIST:
230 desc = "SAS Topology Change List";
231 break;
232 case MPI3_EVENT_ENCL_DEVICE_STATUS_CHANGE:
233 desc = "Enclosure Device Status Change";
234 break;
235 case MPI3_EVENT_HARD_RESET_RECEIVED:
236 desc = "Hard Reset Received";
237 break;
238 case MPI3_EVENT_SAS_PHY_COUNTER:
239 desc = "SAS PHY Counter";
240 break;
241 case MPI3_EVENT_SAS_DEVICE_DISCOVERY_ERROR:
242 desc = "SAS Device Discovery Error";
243 break;
244 case MPI3_EVENT_PCIE_TOPOLOGY_CHANGE_LIST:
245 desc = "PCIE Topology Change List";
246 break;
247 case MPI3_EVENT_PCIE_ENUMERATION:
248 {
249 struct mpi3_event_data_pcie_enumeration *event_data =
250 (struct mpi3_event_data_pcie_enumeration *)event_reply->event_data;
251 ioc_info(mrioc, "PCIE Enumeration: (%s)",
252 (event_data->reason_code ==
253 MPI3_EVENT_PCIE_ENUM_RC_STARTED) ? "start" : "stop");
254 if (event_data->enumeration_status)
255 ioc_info(mrioc, "enumeration_status(0x%08x)\n",
256 le32_to_cpu(event_data->enumeration_status));
257 return;
258 }
259 case MPI3_EVENT_PREPARE_FOR_RESET:
260 desc = "Prepare For Reset";
261 break;
262 }
263
264 if (!desc)
265 return;
266
267 ioc_info(mrioc, "%s\n", desc);
268}
269
270static void mpi3mr_handle_events(struct mpi3mr_ioc *mrioc,
271 struct mpi3_default_reply *def_reply)
272{
273 struct mpi3_event_notification_reply *event_reply =
274 (struct mpi3_event_notification_reply *)def_reply;
275
276 mrioc->change_count = le16_to_cpu(event_reply->ioc_change_count);
277 mpi3mr_print_event_data(mrioc, event_reply);
278 mpi3mr_os_handle_events(mrioc, event_reply);
279}
280
281static struct mpi3mr_drv_cmd *
282mpi3mr_get_drv_cmd(struct mpi3mr_ioc *mrioc, u16 host_tag,
283 struct mpi3_default_reply *def_reply)
284{
285 u16 idx;
286
287 switch (host_tag) {
288 case MPI3MR_HOSTTAG_INITCMDS:
289 return &mrioc->init_cmds;
290 case MPI3MR_HOSTTAG_BLK_TMS:
291 return &mrioc->host_tm_cmds;
292 case MPI3MR_HOSTTAG_INVALID:
293 if (def_reply && def_reply->function ==
294 MPI3_FUNCTION_EVENT_NOTIFICATION)
295 mpi3mr_handle_events(mrioc, def_reply);
296 return NULL;
297 default:
298 break;
299 }
300 if (host_tag >= MPI3MR_HOSTTAG_DEVRMCMD_MIN &&
301 host_tag <= MPI3MR_HOSTTAG_DEVRMCMD_MAX) {
302 idx = host_tag - MPI3MR_HOSTTAG_DEVRMCMD_MIN;
303 return &mrioc->dev_rmhs_cmds[idx];
304 }
305
306 return NULL;
307}
308
309static void mpi3mr_process_admin_reply_desc(struct mpi3mr_ioc *mrioc,
310 struct mpi3_default_reply_descriptor *reply_desc, u64 *reply_dma)
311{
312 u16 reply_desc_type, host_tag = 0;
313 u16 ioc_status = MPI3_IOCSTATUS_SUCCESS;
314 u32 ioc_loginfo = 0;
315 struct mpi3_status_reply_descriptor *status_desc;
316 struct mpi3_address_reply_descriptor *addr_desc;
317 struct mpi3_success_reply_descriptor *success_desc;
318 struct mpi3_default_reply *def_reply = NULL;
319 struct mpi3mr_drv_cmd *cmdptr = NULL;
320 struct mpi3_scsi_io_reply *scsi_reply;
321 u8 *sense_buf = NULL;
322
323 *reply_dma = 0;
324 reply_desc_type = le16_to_cpu(reply_desc->reply_flags) &
325 MPI3_REPLY_DESCRIPT_FLAGS_TYPE_MASK;
326 switch (reply_desc_type) {
327 case MPI3_REPLY_DESCRIPT_FLAGS_TYPE_STATUS:
328 status_desc = (struct mpi3_status_reply_descriptor *)reply_desc;
329 host_tag = le16_to_cpu(status_desc->host_tag);
330 ioc_status = le16_to_cpu(status_desc->ioc_status);
331 if (ioc_status &
332 MPI3_REPLY_DESCRIPT_STATUS_IOCSTATUS_LOGINFOAVAIL)
333 ioc_loginfo = le32_to_cpu(status_desc->ioc_log_info);
334 ioc_status &= MPI3_REPLY_DESCRIPT_STATUS_IOCSTATUS_STATUS_MASK;
335 break;
336 case MPI3_REPLY_DESCRIPT_FLAGS_TYPE_ADDRESS_REPLY:
337 addr_desc = (struct mpi3_address_reply_descriptor *)reply_desc;
338 *reply_dma = le64_to_cpu(addr_desc->reply_frame_address);
339 def_reply = mpi3mr_get_reply_virt_addr(mrioc, *reply_dma);
340 if (!def_reply)
341 goto out;
342 host_tag = le16_to_cpu(def_reply->host_tag);
343 ioc_status = le16_to_cpu(def_reply->ioc_status);
344 if (ioc_status &
345 MPI3_REPLY_DESCRIPT_STATUS_IOCSTATUS_LOGINFOAVAIL)
346 ioc_loginfo = le32_to_cpu(def_reply->ioc_log_info);
347 ioc_status &= MPI3_REPLY_DESCRIPT_STATUS_IOCSTATUS_STATUS_MASK;
348 if (def_reply->function == MPI3_FUNCTION_SCSI_IO) {
349 scsi_reply = (struct mpi3_scsi_io_reply *)def_reply;
350 sense_buf = mpi3mr_get_sensebuf_virt_addr(mrioc,
351 le64_to_cpu(scsi_reply->sense_data_buffer_address));
352 }
353 break;
354 case MPI3_REPLY_DESCRIPT_FLAGS_TYPE_SUCCESS:
355 success_desc = (struct mpi3_success_reply_descriptor *)reply_desc;
356 host_tag = le16_to_cpu(success_desc->host_tag);
357 break;
358 default:
359 break;
360 }
361
362 cmdptr = mpi3mr_get_drv_cmd(mrioc, host_tag, def_reply);
363 if (cmdptr) {
364 if (cmdptr->state & MPI3MR_CMD_PENDING) {
365 cmdptr->state |= MPI3MR_CMD_COMPLETE;
366 cmdptr->ioc_loginfo = ioc_loginfo;
367 cmdptr->ioc_status = ioc_status;
368 cmdptr->state &= ~MPI3MR_CMD_PENDING;
369 if (def_reply) {
370 cmdptr->state |= MPI3MR_CMD_REPLY_VALID;
371 memcpy((u8 *)cmdptr->reply, (u8 *)def_reply,
372 mrioc->facts.reply_sz);
373 }
374 if (cmdptr->is_waiting) {
375 complete(&cmdptr->done);
376 cmdptr->is_waiting = 0;
377 } else if (cmdptr->callback)
378 cmdptr->callback(mrioc, cmdptr);
379 }
380 }
381out:
382 if (sense_buf)
383 mpi3mr_repost_sense_buf(mrioc,
384 le64_to_cpu(scsi_reply->sense_data_buffer_address));
385}
386
387static int mpi3mr_process_admin_reply_q(struct mpi3mr_ioc *mrioc)
388{
389 u32 exp_phase = mrioc->admin_reply_ephase;
390 u32 admin_reply_ci = mrioc->admin_reply_ci;
391 u32 num_admin_replies = 0;
392 u64 reply_dma = 0;
393 struct mpi3_default_reply_descriptor *reply_desc;
394
395 reply_desc = (struct mpi3_default_reply_descriptor *)mrioc->admin_reply_base +
396 admin_reply_ci;
397
398 if ((le16_to_cpu(reply_desc->reply_flags) &
399 MPI3_REPLY_DESCRIPT_FLAGS_PHASE_MASK) != exp_phase)
400 return 0;
401
402 do {
403 mrioc->admin_req_ci = le16_to_cpu(reply_desc->request_queue_ci);
404 mpi3mr_process_admin_reply_desc(mrioc, reply_desc, &reply_dma);
405 if (reply_dma)
406 mpi3mr_repost_reply_buf(mrioc, reply_dma);
407 num_admin_replies++;
408 if (++admin_reply_ci == mrioc->num_admin_replies) {
409 admin_reply_ci = 0;
410 exp_phase ^= 1;
411 }
412 reply_desc =
413 (struct mpi3_default_reply_descriptor *)mrioc->admin_reply_base +
414 admin_reply_ci;
415 if ((le16_to_cpu(reply_desc->reply_flags) &
416 MPI3_REPLY_DESCRIPT_FLAGS_PHASE_MASK) != exp_phase)
417 break;
418 } while (1);
419
420 writel(admin_reply_ci, &mrioc->sysif_regs->admin_reply_queue_ci);
421 mrioc->admin_reply_ci = admin_reply_ci;
422 mrioc->admin_reply_ephase = exp_phase;
423
424 return num_admin_replies;
425}
426
427
428
429
430
431
432
433
434
435static inline struct mpi3_default_reply_descriptor *
436mpi3mr_get_reply_desc(struct op_reply_qinfo *op_reply_q, u32 reply_ci)
437{
438 void *segment_base_addr;
439 struct segments *segments = op_reply_q->q_segments;
440 struct mpi3_default_reply_descriptor *reply_desc = NULL;
441
442 segment_base_addr =
443 segments[reply_ci / op_reply_q->segment_qd].segment;
444 reply_desc = (struct mpi3_default_reply_descriptor *)segment_base_addr +
445 (reply_ci % op_reply_q->segment_qd);
446 return reply_desc;
447}
448
449static int mpi3mr_process_op_reply_q(struct mpi3mr_ioc *mrioc,
450 struct mpi3mr_intr_info *intr_info)
451{
452 struct op_reply_qinfo *op_reply_q = intr_info->op_reply_q;
453 struct op_req_qinfo *op_req_q;
454 u32 exp_phase;
455 u32 reply_ci;
456 u32 num_op_reply = 0;
457 u64 reply_dma = 0;
458 struct mpi3_default_reply_descriptor *reply_desc;
459 u16 req_q_idx = 0, reply_qidx;
460
461 reply_qidx = op_reply_q->qid - 1;
462
463 if (!atomic_add_unless(&op_reply_q->in_use, 1, 1))
464 return 0;
465
466 exp_phase = op_reply_q->ephase;
467 reply_ci = op_reply_q->ci;
468
469 reply_desc = mpi3mr_get_reply_desc(op_reply_q, reply_ci);
470 if ((le16_to_cpu(reply_desc->reply_flags) &
471 MPI3_REPLY_DESCRIPT_FLAGS_PHASE_MASK) != exp_phase) {
472 atomic_dec(&op_reply_q->in_use);
473 return 0;
474 }
475
476 do {
477 req_q_idx = le16_to_cpu(reply_desc->request_queue_id) - 1;
478 op_req_q = &mrioc->req_qinfo[req_q_idx];
479
480 WRITE_ONCE(op_req_q->ci, le16_to_cpu(reply_desc->request_queue_ci));
481 mpi3mr_process_op_reply_desc(mrioc, reply_desc, &reply_dma,
482 reply_qidx);
483 atomic_dec(&op_reply_q->pend_ios);
484 if (reply_dma)
485 mpi3mr_repost_reply_buf(mrioc, reply_dma);
486 num_op_reply++;
487
488 if (++reply_ci == op_reply_q->num_replies) {
489 reply_ci = 0;
490 exp_phase ^= 1;
491 }
492
493 reply_desc = mpi3mr_get_reply_desc(op_reply_q, reply_ci);
494
495 if ((le16_to_cpu(reply_desc->reply_flags) &
496 MPI3_REPLY_DESCRIPT_FLAGS_PHASE_MASK) != exp_phase)
497 break;
498
499
500
501
502 if (num_op_reply > mrioc->max_host_ios) {
503 intr_info->op_reply_q->enable_irq_poll = true;
504 break;
505 }
506
507 } while (1);
508
509 writel(reply_ci,
510 &mrioc->sysif_regs->oper_queue_indexes[reply_qidx].consumer_index);
511 op_reply_q->ci = reply_ci;
512 op_reply_q->ephase = exp_phase;
513
514 atomic_dec(&op_reply_q->in_use);
515 return num_op_reply;
516}
517
518static irqreturn_t mpi3mr_isr_primary(int irq, void *privdata)
519{
520 struct mpi3mr_intr_info *intr_info = privdata;
521 struct mpi3mr_ioc *mrioc;
522 u16 midx;
523 u32 num_admin_replies = 0, num_op_reply = 0;
524
525 if (!intr_info)
526 return IRQ_NONE;
527
528 mrioc = intr_info->mrioc;
529
530 if (!mrioc->intr_enabled)
531 return IRQ_NONE;
532
533 midx = intr_info->msix_index;
534
535 if (!midx)
536 num_admin_replies = mpi3mr_process_admin_reply_q(mrioc);
537 if (intr_info->op_reply_q)
538 num_op_reply = mpi3mr_process_op_reply_q(mrioc, intr_info);
539
540 if (num_admin_replies || num_op_reply)
541 return IRQ_HANDLED;
542 else
543 return IRQ_NONE;
544}
545
546static irqreturn_t mpi3mr_isr(int irq, void *privdata)
547{
548 struct mpi3mr_intr_info *intr_info = privdata;
549 struct mpi3mr_ioc *mrioc;
550 u16 midx;
551 int ret;
552
553 if (!intr_info)
554 return IRQ_NONE;
555
556 mrioc = intr_info->mrioc;
557 midx = intr_info->msix_index;
558
559 ret = mpi3mr_isr_primary(irq, privdata);
560
561
562
563
564
565 if (!intr_info->op_reply_q)
566 return ret;
567
568 if (!intr_info->op_reply_q->enable_irq_poll ||
569 !atomic_read(&intr_info->op_reply_q->pend_ios))
570 return ret;
571
572 disable_irq_nosync(pci_irq_vector(mrioc->pdev, midx));
573
574 return IRQ_WAKE_THREAD;
575}
576
577
578
579
580
581
582
583
584
585
586
587static irqreturn_t mpi3mr_isr_poll(int irq, void *privdata)
588{
589 struct mpi3mr_intr_info *intr_info = privdata;
590 struct mpi3mr_ioc *mrioc;
591 u16 midx;
592 u32 num_op_reply = 0;
593
594 if (!intr_info || !intr_info->op_reply_q)
595 return IRQ_NONE;
596
597 mrioc = intr_info->mrioc;
598 midx = intr_info->msix_index;
599
600
601 do {
602 if (!mrioc->intr_enabled)
603 break;
604
605 if (!midx)
606 mpi3mr_process_admin_reply_q(mrioc);
607 if (intr_info->op_reply_q)
608 num_op_reply +=
609 mpi3mr_process_op_reply_q(mrioc, intr_info);
610
611 usleep_range(mrioc->irqpoll_sleep, 10 * mrioc->irqpoll_sleep);
612
613 } while (atomic_read(&intr_info->op_reply_q->pend_ios) &&
614 (num_op_reply < mrioc->max_host_ios));
615
616 intr_info->op_reply_q->enable_irq_poll = false;
617 enable_irq(pci_irq_vector(mrioc->pdev, midx));
618
619 return IRQ_HANDLED;
620}
621
622
623
624
625
626
627
628
629
630
631static inline int mpi3mr_request_irq(struct mpi3mr_ioc *mrioc, u16 index)
632{
633 struct pci_dev *pdev = mrioc->pdev;
634 struct mpi3mr_intr_info *intr_info = mrioc->intr_info + index;
635 int retval = 0;
636
637 intr_info->mrioc = mrioc;
638 intr_info->msix_index = index;
639 intr_info->op_reply_q = NULL;
640
641 snprintf(intr_info->name, MPI3MR_NAME_LENGTH, "%s%d-msix%d",
642 mrioc->driver_name, mrioc->id, index);
643
644 retval = request_threaded_irq(pci_irq_vector(pdev, index), mpi3mr_isr,
645 mpi3mr_isr_poll, IRQF_SHARED, intr_info->name, intr_info);
646 if (retval) {
647 ioc_err(mrioc, "%s: Unable to allocate interrupt %d!\n",
648 intr_info->name, pci_irq_vector(pdev, index));
649 return retval;
650 }
651
652 return retval;
653}
654
655
656
657
658
659
660
661
662
663
664static int mpi3mr_setup_isr(struct mpi3mr_ioc *mrioc, u8 setup_one)
665{
666 unsigned int irq_flags = PCI_IRQ_MSIX;
667 int max_vectors;
668 int retval;
669 int i;
670 struct irq_affinity desc = { .pre_vectors = 1};
671
672 mpi3mr_cleanup_isr(mrioc);
673
674 if (setup_one || reset_devices)
675 max_vectors = 1;
676 else {
677 max_vectors =
678 min_t(int, mrioc->cpu_count + 1, mrioc->msix_count);
679
680 ioc_info(mrioc,
681 "MSI-X vectors supported: %d, no of cores: %d,",
682 mrioc->msix_count, mrioc->cpu_count);
683 ioc_info(mrioc,
684 "MSI-x vectors requested: %d\n", max_vectors);
685 }
686
687 irq_flags |= PCI_IRQ_AFFINITY | PCI_IRQ_ALL_TYPES;
688
689 mrioc->op_reply_q_offset = (max_vectors > 1) ? 1 : 0;
690 retval = pci_alloc_irq_vectors_affinity(mrioc->pdev,
691 1, max_vectors, irq_flags, &desc);
692 if (retval < 0) {
693 ioc_err(mrioc, "Cannot alloc irq vectors\n");
694 goto out_failed;
695 }
696 if (retval != max_vectors) {
697 ioc_info(mrioc,
698 "allocated vectors (%d) are less than configured (%d)\n",
699 retval, max_vectors);
700
701
702
703
704 if (retval == 1)
705 mrioc->op_reply_q_offset = 0;
706
707 max_vectors = retval;
708 }
709 mrioc->intr_info = kzalloc(sizeof(struct mpi3mr_intr_info) * max_vectors,
710 GFP_KERNEL);
711 if (!mrioc->intr_info) {
712 retval = -ENOMEM;
713 pci_free_irq_vectors(mrioc->pdev);
714 goto out_failed;
715 }
716 for (i = 0; i < max_vectors; i++) {
717 retval = mpi3mr_request_irq(mrioc, i);
718 if (retval) {
719 mrioc->intr_info_count = i;
720 goto out_failed;
721 }
722 }
723 mrioc->intr_info_count = max_vectors;
724 mpi3mr_ioc_enable_intr(mrioc);
725 return 0;
726
727out_failed:
728 mpi3mr_cleanup_isr(mrioc);
729
730 return retval;
731}
732
733static const struct {
734 enum mpi3mr_iocstate value;
735 char *name;
736} mrioc_states[] = {
737 { MRIOC_STATE_READY, "ready" },
738 { MRIOC_STATE_FAULT, "fault" },
739 { MRIOC_STATE_RESET, "reset" },
740 { MRIOC_STATE_BECOMING_READY, "becoming ready" },
741 { MRIOC_STATE_RESET_REQUESTED, "reset requested" },
742 { MRIOC_STATE_UNRECOVERABLE, "unrecoverable error" },
743};
744
745static const char *mpi3mr_iocstate_name(enum mpi3mr_iocstate mrioc_state)
746{
747 int i;
748 char *name = NULL;
749
750 for (i = 0; i < ARRAY_SIZE(mrioc_states); i++) {
751 if (mrioc_states[i].value == mrioc_state) {
752 name = mrioc_states[i].name;
753 break;
754 }
755 }
756 return name;
757}
758
759
760static const struct {
761 enum mpi3mr_reset_reason value;
762 char *name;
763} mpi3mr_reset_reason_codes[] = {
764 { MPI3MR_RESET_FROM_BRINGUP, "timeout in bringup" },
765 { MPI3MR_RESET_FROM_FAULT_WATCH, "fault" },
766 { MPI3MR_RESET_FROM_IOCTL, "application invocation" },
767 { MPI3MR_RESET_FROM_EH_HOS, "error handling" },
768 { MPI3MR_RESET_FROM_TM_TIMEOUT, "TM timeout" },
769 { MPI3MR_RESET_FROM_IOCTL_TIMEOUT, "IOCTL timeout" },
770 { MPI3MR_RESET_FROM_MUR_FAILURE, "MUR failure" },
771 { MPI3MR_RESET_FROM_CTLR_CLEANUP, "timeout in controller cleanup" },
772 { MPI3MR_RESET_FROM_CIACTIV_FAULT, "component image activation fault" },
773 { MPI3MR_RESET_FROM_PE_TIMEOUT, "port enable timeout" },
774 { MPI3MR_RESET_FROM_TSU_TIMEOUT, "time stamp update timeout" },
775 { MPI3MR_RESET_FROM_DELREQQ_TIMEOUT, "delete request queue timeout" },
776 { MPI3MR_RESET_FROM_DELREPQ_TIMEOUT, "delete reply queue timeout" },
777 {
778 MPI3MR_RESET_FROM_CREATEREPQ_TIMEOUT,
779 "create request queue timeout"
780 },
781 {
782 MPI3MR_RESET_FROM_CREATEREQQ_TIMEOUT,
783 "create reply queue timeout"
784 },
785 { MPI3MR_RESET_FROM_IOCFACTS_TIMEOUT, "IOC facts timeout" },
786 { MPI3MR_RESET_FROM_IOCINIT_TIMEOUT, "IOC init timeout" },
787 { MPI3MR_RESET_FROM_EVTNOTIFY_TIMEOUT, "event notify timeout" },
788 { MPI3MR_RESET_FROM_EVTACK_TIMEOUT, "event acknowledgment timeout" },
789 {
790 MPI3MR_RESET_FROM_CIACTVRST_TIMER,
791 "component image activation timeout"
792 },
793 {
794 MPI3MR_RESET_FROM_GETPKGVER_TIMEOUT,
795 "get package version timeout"
796 },
797 { MPI3MR_RESET_FROM_SYSFS, "sysfs invocation" },
798 { MPI3MR_RESET_FROM_SYSFS_TIMEOUT, "sysfs TM timeout" },
799};
800
801
802
803
804
805
806
807
808
809static const char *mpi3mr_reset_rc_name(enum mpi3mr_reset_reason reason_code)
810{
811 int i;
812 char *name = NULL;
813
814 for (i = 0; i < ARRAY_SIZE(mpi3mr_reset_reason_codes); i++) {
815 if (mpi3mr_reset_reason_codes[i].value == reason_code) {
816 name = mpi3mr_reset_reason_codes[i].name;
817 break;
818 }
819 }
820 return name;
821}
822
823
824static const struct {
825 u16 reset_type;
826 char *name;
827} mpi3mr_reset_types[] = {
828 { MPI3_SYSIF_HOST_DIAG_RESET_ACTION_SOFT_RESET, "soft" },
829 { MPI3_SYSIF_HOST_DIAG_RESET_ACTION_DIAG_FAULT, "diag fault" },
830};
831
832
833
834
835
836
837
838
839
840static const char *mpi3mr_reset_type_name(u16 reset_type)
841{
842 int i;
843 char *name = NULL;
844
845 for (i = 0; i < ARRAY_SIZE(mpi3mr_reset_types); i++) {
846 if (mpi3mr_reset_types[i].reset_type == reset_type) {
847 name = mpi3mr_reset_types[i].name;
848 break;
849 }
850 }
851 return name;
852}
853
854
855
856
857
858
859
860
861
862
863static void mpi3mr_print_fault_info(struct mpi3mr_ioc *mrioc)
864{
865 u32 ioc_status, code, code1, code2, code3;
866
867 ioc_status = readl(&mrioc->sysif_regs->ioc_status);
868
869 if (ioc_status & MPI3_SYSIF_IOC_STATUS_FAULT) {
870 code = readl(&mrioc->sysif_regs->fault);
871 code1 = readl(&mrioc->sysif_regs->fault_info[0]);
872 code2 = readl(&mrioc->sysif_regs->fault_info[1]);
873 code3 = readl(&mrioc->sysif_regs->fault_info[2]);
874
875 ioc_info(mrioc,
876 "fault code(0x%08X): Additional code: (0x%08X:0x%08X:0x%08X)\n",
877 code, code1, code2, code3);
878 }
879}
880
881
882
883
884
885
886
887
888
889
890enum mpi3mr_iocstate mpi3mr_get_iocstate(struct mpi3mr_ioc *mrioc)
891{
892 u32 ioc_status, ioc_config;
893 u8 ready, enabled;
894
895 ioc_status = readl(&mrioc->sysif_regs->ioc_status);
896 ioc_config = readl(&mrioc->sysif_regs->ioc_configuration);
897
898 if (mrioc->unrecoverable)
899 return MRIOC_STATE_UNRECOVERABLE;
900 if (ioc_status & MPI3_SYSIF_IOC_STATUS_FAULT)
901 return MRIOC_STATE_FAULT;
902
903 ready = (ioc_status & MPI3_SYSIF_IOC_STATUS_READY);
904 enabled = (ioc_config & MPI3_SYSIF_IOC_CONFIG_ENABLE_IOC);
905
906 if (ready && enabled)
907 return MRIOC_STATE_READY;
908 if ((!ready) && (!enabled))
909 return MRIOC_STATE_RESET;
910 if ((!ready) && (enabled))
911 return MRIOC_STATE_BECOMING_READY;
912
913 return MRIOC_STATE_RESET_REQUESTED;
914}
915
916
917
918
919
920
921
922
923
924
925static inline void mpi3mr_clear_reset_history(struct mpi3mr_ioc *mrioc)
926{
927 u32 ioc_status;
928
929 ioc_status = readl(&mrioc->sysif_regs->ioc_status);
930 if (ioc_status & MPI3_SYSIF_IOC_STATUS_RESET_HISTORY)
931 writel(ioc_status, &mrioc->sysif_regs->ioc_status);
932}
933
934
935
936
937
938
939
940
941
942
943
944static int mpi3mr_issue_and_process_mur(struct mpi3mr_ioc *mrioc,
945 u32 reset_reason)
946{
947 u32 ioc_config, timeout, ioc_status;
948 int retval = -1;
949
950 ioc_info(mrioc, "Issuing Message unit Reset(MUR)\n");
951 if (mrioc->unrecoverable) {
952 ioc_info(mrioc, "IOC is unrecoverable MUR not issued\n");
953 return retval;
954 }
955 mpi3mr_clear_reset_history(mrioc);
956 writel(reset_reason, &mrioc->sysif_regs->scratchpad[0]);
957 ioc_config = readl(&mrioc->sysif_regs->ioc_configuration);
958 ioc_config &= ~MPI3_SYSIF_IOC_CONFIG_ENABLE_IOC;
959 writel(ioc_config, &mrioc->sysif_regs->ioc_configuration);
960
961 timeout = mrioc->ready_timeout * 10;
962 do {
963 ioc_status = readl(&mrioc->sysif_regs->ioc_status);
964 if ((ioc_status & MPI3_SYSIF_IOC_STATUS_RESET_HISTORY)) {
965 mpi3mr_clear_reset_history(mrioc);
966 ioc_config =
967 readl(&mrioc->sysif_regs->ioc_configuration);
968 if (!((ioc_status & MPI3_SYSIF_IOC_STATUS_READY) ||
969 (ioc_status & MPI3_SYSIF_IOC_STATUS_FAULT) ||
970 (ioc_config & MPI3_SYSIF_IOC_CONFIG_ENABLE_IOC))) {
971 retval = 0;
972 break;
973 }
974 }
975 msleep(100);
976 } while (--timeout);
977
978 ioc_status = readl(&mrioc->sysif_regs->ioc_status);
979 ioc_config = readl(&mrioc->sysif_regs->ioc_configuration);
980
981 ioc_info(mrioc, "Base IOC Sts/Config after %s MUR is (0x%x)/(0x%x)\n",
982 (!retval) ? "successful" : "failed", ioc_status, ioc_config);
983 return retval;
984}
985
986
987
988
989
990
991
992
993
994
995static int mpi3mr_bring_ioc_ready(struct mpi3mr_ioc *mrioc)
996{
997 u32 ioc_config, timeout;
998 enum mpi3mr_iocstate current_state;
999
1000 ioc_config = readl(&mrioc->sysif_regs->ioc_configuration);
1001 ioc_config |= MPI3_SYSIF_IOC_CONFIG_ENABLE_IOC;
1002 writel(ioc_config, &mrioc->sysif_regs->ioc_configuration);
1003
1004 timeout = mrioc->ready_timeout * 10;
1005 do {
1006 current_state = mpi3mr_get_iocstate(mrioc);
1007 if (current_state == MRIOC_STATE_READY)
1008 return 0;
1009 msleep(100);
1010 } while (--timeout);
1011
1012 return -1;
1013}
1014
1015
1016
1017
1018
1019
1020
1021
1022
1023
1024
1025static inline bool
1026mpi3mr_soft_reset_success(u32 ioc_status, u32 ioc_config)
1027{
1028 if (!((ioc_status & MPI3_SYSIF_IOC_STATUS_READY) ||
1029 (ioc_status & MPI3_SYSIF_IOC_STATUS_FAULT) ||
1030 (ioc_config & MPI3_SYSIF_IOC_CONFIG_ENABLE_IOC)))
1031 return true;
1032 return false;
1033}
1034
1035
1036
1037
1038
1039
1040
1041
1042
1043
1044static inline bool mpi3mr_diagfault_success(struct mpi3mr_ioc *mrioc,
1045 u32 ioc_status)
1046{
1047 u32 fault;
1048
1049 if (!(ioc_status & MPI3_SYSIF_IOC_STATUS_FAULT))
1050 return false;
1051 fault = readl(&mrioc->sysif_regs->fault) & MPI3_SYSIF_FAULT_CODE_MASK;
1052 if (fault == MPI3_SYSIF_FAULT_CODE_DIAG_FAULT_RESET)
1053 return true;
1054 return false;
1055}
1056
1057
1058
1059
1060
1061
1062
1063
1064
1065
1066static inline void mpi3mr_set_diagsave(struct mpi3mr_ioc *mrioc)
1067{
1068 u32 ioc_config;
1069
1070 ioc_config = readl(&mrioc->sysif_regs->ioc_configuration);
1071 ioc_config |= MPI3_SYSIF_IOC_CONFIG_DIAG_SAVE;
1072 writel(ioc_config, &mrioc->sysif_regs->ioc_configuration);
1073}
1074
1075
1076
1077
1078
1079
1080
1081
1082
1083
1084
1085
1086
1087
1088static int mpi3mr_issue_reset(struct mpi3mr_ioc *mrioc, u16 reset_type,
1089 u32 reset_reason)
1090{
1091 int retval = -1;
1092 u8 unlock_retry_count, reset_retry_count = 0;
1093 u32 host_diagnostic, timeout, ioc_status, ioc_config;
1094
1095 pci_cfg_access_lock(mrioc->pdev);
1096 if ((reset_type != MPI3_SYSIF_HOST_DIAG_RESET_ACTION_SOFT_RESET) &&
1097 (reset_type != MPI3_SYSIF_HOST_DIAG_RESET_ACTION_DIAG_FAULT))
1098 goto out;
1099 if (mrioc->unrecoverable)
1100 goto out;
1101retry_reset:
1102 unlock_retry_count = 0;
1103 mpi3mr_clear_reset_history(mrioc);
1104 do {
1105 ioc_info(mrioc,
1106 "Write magic sequence to unlock host diag register (retry=%d)\n",
1107 ++unlock_retry_count);
1108 if (unlock_retry_count >= MPI3MR_HOSTDIAG_UNLOCK_RETRY_COUNT) {
1109 writel(reset_reason, &mrioc->sysif_regs->scratchpad[0]);
1110 mrioc->unrecoverable = 1;
1111 goto out;
1112 }
1113
1114 writel(MPI3_SYSIF_WRITE_SEQUENCE_KEY_VALUE_FLUSH,
1115 &mrioc->sysif_regs->write_sequence);
1116 writel(MPI3_SYSIF_WRITE_SEQUENCE_KEY_VALUE_1ST,
1117 &mrioc->sysif_regs->write_sequence);
1118 writel(MPI3_SYSIF_WRITE_SEQUENCE_KEY_VALUE_2ND,
1119 &mrioc->sysif_regs->write_sequence);
1120 writel(MPI3_SYSIF_WRITE_SEQUENCE_KEY_VALUE_3RD,
1121 &mrioc->sysif_regs->write_sequence);
1122 writel(MPI3_SYSIF_WRITE_SEQUENCE_KEY_VALUE_4TH,
1123 &mrioc->sysif_regs->write_sequence);
1124 writel(MPI3_SYSIF_WRITE_SEQUENCE_KEY_VALUE_5TH,
1125 &mrioc->sysif_regs->write_sequence);
1126 writel(MPI3_SYSIF_WRITE_SEQUENCE_KEY_VALUE_6TH,
1127 &mrioc->sysif_regs->write_sequence);
1128 usleep_range(1000, 1100);
1129 host_diagnostic = readl(&mrioc->sysif_regs->host_diagnostic);
1130 ioc_info(mrioc,
1131 "wrote magic sequence: retry_count(%d), host_diagnostic(0x%08x)\n",
1132 unlock_retry_count, host_diagnostic);
1133 } while (!(host_diagnostic & MPI3_SYSIF_HOST_DIAG_DIAG_WRITE_ENABLE));
1134
1135 writel(reset_reason, &mrioc->sysif_regs->scratchpad[0]);
1136 ioc_info(mrioc, "%s reset due to %s(0x%x)\n",
1137 mpi3mr_reset_type_name(reset_type),
1138 mpi3mr_reset_rc_name(reset_reason), reset_reason);
1139 writel(host_diagnostic | reset_type,
1140 &mrioc->sysif_regs->host_diagnostic);
1141 timeout = mrioc->ready_timeout * 10;
1142 if (reset_type == MPI3_SYSIF_HOST_DIAG_RESET_ACTION_SOFT_RESET) {
1143 do {
1144 ioc_status = readl(&mrioc->sysif_regs->ioc_status);
1145 if (ioc_status &
1146 MPI3_SYSIF_IOC_STATUS_RESET_HISTORY) {
1147 mpi3mr_clear_reset_history(mrioc);
1148 ioc_config =
1149 readl(&mrioc->sysif_regs->ioc_configuration);
1150 if (mpi3mr_soft_reset_success(ioc_status,
1151 ioc_config)) {
1152 retval = 0;
1153 break;
1154 }
1155 }
1156 msleep(100);
1157 } while (--timeout);
1158 writel(MPI3_SYSIF_WRITE_SEQUENCE_KEY_VALUE_2ND,
1159 &mrioc->sysif_regs->write_sequence);
1160 } else if (reset_type == MPI3_SYSIF_HOST_DIAG_RESET_ACTION_DIAG_FAULT) {
1161 do {
1162 ioc_status = readl(&mrioc->sysif_regs->ioc_status);
1163 if (mpi3mr_diagfault_success(mrioc, ioc_status)) {
1164 retval = 0;
1165 break;
1166 }
1167 msleep(100);
1168 } while (--timeout);
1169 mpi3mr_clear_reset_history(mrioc);
1170 writel(MPI3_SYSIF_WRITE_SEQUENCE_KEY_VALUE_2ND,
1171 &mrioc->sysif_regs->write_sequence);
1172 }
1173 if (retval && ((++reset_retry_count) < MPI3MR_MAX_RESET_RETRY_COUNT)) {
1174 ioc_status = readl(&mrioc->sysif_regs->ioc_status);
1175 ioc_config = readl(&mrioc->sysif_regs->ioc_configuration);
1176 ioc_info(mrioc,
1177 "Base IOC Sts/Config after reset try %d is (0x%x)/(0x%x)\n",
1178 reset_retry_count, ioc_status, ioc_config);
1179 goto retry_reset;
1180 }
1181
1182out:
1183 pci_cfg_access_unlock(mrioc->pdev);
1184 ioc_status = readl(&mrioc->sysif_regs->ioc_status);
1185 ioc_config = readl(&mrioc->sysif_regs->ioc_configuration);
1186
1187 ioc_info(mrioc,
1188 "Base IOC Sts/Config after %s reset is (0x%x)/(0x%x)\n",
1189 (!retval) ? "successful" : "failed", ioc_status,
1190 ioc_config);
1191 return retval;
1192}
1193
1194
1195
1196
1197
1198
1199
1200
1201
1202
1203
1204
1205
1206
1207int mpi3mr_admin_request_post(struct mpi3mr_ioc *mrioc, void *admin_req,
1208 u16 admin_req_sz, u8 ignore_reset)
1209{
1210 u16 areq_pi = 0, areq_ci = 0, max_entries = 0;
1211 int retval = 0;
1212 unsigned long flags;
1213 u8 *areq_entry;
1214
1215 if (mrioc->unrecoverable) {
1216 ioc_err(mrioc, "%s : Unrecoverable controller\n", __func__);
1217 return -EFAULT;
1218 }
1219
1220 spin_lock_irqsave(&mrioc->admin_req_lock, flags);
1221 areq_pi = mrioc->admin_req_pi;
1222 areq_ci = mrioc->admin_req_ci;
1223 max_entries = mrioc->num_admin_req;
1224 if ((areq_ci == (areq_pi + 1)) || ((!areq_ci) &&
1225 (areq_pi == (max_entries - 1)))) {
1226 ioc_err(mrioc, "AdminReqQ full condition detected\n");
1227 retval = -EAGAIN;
1228 goto out;
1229 }
1230 if (!ignore_reset && mrioc->reset_in_progress) {
1231 ioc_err(mrioc, "AdminReqQ submit reset in progress\n");
1232 retval = -EAGAIN;
1233 goto out;
1234 }
1235 areq_entry = (u8 *)mrioc->admin_req_base +
1236 (areq_pi * MPI3MR_ADMIN_REQ_FRAME_SZ);
1237 memset(areq_entry, 0, MPI3MR_ADMIN_REQ_FRAME_SZ);
1238 memcpy(areq_entry, (u8 *)admin_req, admin_req_sz);
1239
1240 if (++areq_pi == max_entries)
1241 areq_pi = 0;
1242 mrioc->admin_req_pi = areq_pi;
1243
1244 writel(mrioc->admin_req_pi, &mrioc->sysif_regs->admin_request_queue_pi);
1245
1246out:
1247 spin_unlock_irqrestore(&mrioc->admin_req_lock, flags);
1248
1249 return retval;
1250}
1251
1252
1253
1254
1255
1256
1257
1258
1259
1260
1261static void mpi3mr_free_op_req_q_segments(struct mpi3mr_ioc *mrioc, u16 q_idx)
1262{
1263 u16 j;
1264 int size;
1265 struct segments *segments;
1266
1267 segments = mrioc->req_qinfo[q_idx].q_segments;
1268 if (!segments)
1269 return;
1270
1271 if (mrioc->enable_segqueue) {
1272 size = MPI3MR_OP_REQ_Q_SEG_SIZE;
1273 if (mrioc->req_qinfo[q_idx].q_segment_list) {
1274 dma_free_coherent(&mrioc->pdev->dev,
1275 MPI3MR_MAX_SEG_LIST_SIZE,
1276 mrioc->req_qinfo[q_idx].q_segment_list,
1277 mrioc->req_qinfo[q_idx].q_segment_list_dma);
1278 mrioc->op_reply_qinfo[q_idx].q_segment_list = NULL;
1279 }
1280 } else
1281 size = mrioc->req_qinfo[q_idx].num_requests *
1282 mrioc->facts.op_req_sz;
1283
1284 for (j = 0; j < mrioc->req_qinfo[q_idx].num_segments; j++) {
1285 if (!segments[j].segment)
1286 continue;
1287 dma_free_coherent(&mrioc->pdev->dev,
1288 size, segments[j].segment, segments[j].segment_dma);
1289 segments[j].segment = NULL;
1290 }
1291 kfree(mrioc->req_qinfo[q_idx].q_segments);
1292 mrioc->req_qinfo[q_idx].q_segments = NULL;
1293 mrioc->req_qinfo[q_idx].qid = 0;
1294}
1295
1296
1297
1298
1299
1300
1301
1302
1303
1304
1305static void mpi3mr_free_op_reply_q_segments(struct mpi3mr_ioc *mrioc, u16 q_idx)
1306{
1307 u16 j;
1308 int size;
1309 struct segments *segments;
1310
1311 segments = mrioc->op_reply_qinfo[q_idx].q_segments;
1312 if (!segments)
1313 return;
1314
1315 if (mrioc->enable_segqueue) {
1316 size = MPI3MR_OP_REP_Q_SEG_SIZE;
1317 if (mrioc->op_reply_qinfo[q_idx].q_segment_list) {
1318 dma_free_coherent(&mrioc->pdev->dev,
1319 MPI3MR_MAX_SEG_LIST_SIZE,
1320 mrioc->op_reply_qinfo[q_idx].q_segment_list,
1321 mrioc->op_reply_qinfo[q_idx].q_segment_list_dma);
1322 mrioc->op_reply_qinfo[q_idx].q_segment_list = NULL;
1323 }
1324 } else
1325 size = mrioc->op_reply_qinfo[q_idx].segment_qd *
1326 mrioc->op_reply_desc_sz;
1327
1328 for (j = 0; j < mrioc->op_reply_qinfo[q_idx].num_segments; j++) {
1329 if (!segments[j].segment)
1330 continue;
1331 dma_free_coherent(&mrioc->pdev->dev,
1332 size, segments[j].segment, segments[j].segment_dma);
1333 segments[j].segment = NULL;
1334 }
1335
1336 kfree(mrioc->op_reply_qinfo[q_idx].q_segments);
1337 mrioc->op_reply_qinfo[q_idx].q_segments = NULL;
1338 mrioc->op_reply_qinfo[q_idx].qid = 0;
1339}
1340
1341
1342
1343
1344
1345
1346
1347
1348
1349
1350
1351static int mpi3mr_delete_op_reply_q(struct mpi3mr_ioc *mrioc, u16 qidx)
1352{
1353 struct mpi3_delete_reply_queue_request delq_req;
1354 int retval = 0;
1355 u16 reply_qid = 0, midx;
1356
1357 reply_qid = mrioc->op_reply_qinfo[qidx].qid;
1358
1359 midx = REPLY_QUEUE_IDX_TO_MSIX_IDX(qidx, mrioc->op_reply_q_offset);
1360
1361 if (!reply_qid) {
1362 retval = -1;
1363 ioc_err(mrioc, "Issue DelRepQ: called with invalid ReqQID\n");
1364 goto out;
1365 }
1366
1367 memset(&delq_req, 0, sizeof(delq_req));
1368 mutex_lock(&mrioc->init_cmds.mutex);
1369 if (mrioc->init_cmds.state & MPI3MR_CMD_PENDING) {
1370 retval = -1;
1371 ioc_err(mrioc, "Issue DelRepQ: Init command is in use\n");
1372 mutex_unlock(&mrioc->init_cmds.mutex);
1373 goto out;
1374 }
1375 mrioc->init_cmds.state = MPI3MR_CMD_PENDING;
1376 mrioc->init_cmds.is_waiting = 1;
1377 mrioc->init_cmds.callback = NULL;
1378 delq_req.host_tag = cpu_to_le16(MPI3MR_HOSTTAG_INITCMDS);
1379 delq_req.function = MPI3_FUNCTION_DELETE_REPLY_QUEUE;
1380 delq_req.queue_id = cpu_to_le16(reply_qid);
1381
1382 init_completion(&mrioc->init_cmds.done);
1383 retval = mpi3mr_admin_request_post(mrioc, &delq_req, sizeof(delq_req),
1384 1);
1385 if (retval) {
1386 ioc_err(mrioc, "Issue DelRepQ: Admin Post failed\n");
1387 goto out_unlock;
1388 }
1389 wait_for_completion_timeout(&mrioc->init_cmds.done,
1390 (MPI3MR_INTADMCMD_TIMEOUT * HZ));
1391 if (!(mrioc->init_cmds.state & MPI3MR_CMD_COMPLETE)) {
1392 ioc_err(mrioc, "Issue DelRepQ: command timed out\n");
1393 mpi3mr_set_diagsave(mrioc);
1394 mpi3mr_issue_reset(mrioc,
1395 MPI3_SYSIF_HOST_DIAG_RESET_ACTION_DIAG_FAULT,
1396 MPI3MR_RESET_FROM_DELREPQ_TIMEOUT);
1397 mrioc->unrecoverable = 1;
1398
1399 retval = -1;
1400 goto out_unlock;
1401 }
1402 if ((mrioc->init_cmds.ioc_status & MPI3_IOCSTATUS_STATUS_MASK)
1403 != MPI3_IOCSTATUS_SUCCESS) {
1404 ioc_err(mrioc,
1405 "Issue DelRepQ: Failed ioc_status(0x%04x) Loginfo(0x%08x)\n",
1406 (mrioc->init_cmds.ioc_status & MPI3_IOCSTATUS_STATUS_MASK),
1407 mrioc->init_cmds.ioc_loginfo);
1408 retval = -1;
1409 goto out_unlock;
1410 }
1411 mrioc->intr_info[midx].op_reply_q = NULL;
1412
1413 mpi3mr_free_op_reply_q_segments(mrioc, qidx);
1414out_unlock:
1415 mrioc->init_cmds.state = MPI3MR_CMD_NOTUSED;
1416 mutex_unlock(&mrioc->init_cmds.mutex);
1417out:
1418
1419 return retval;
1420}
1421
1422
1423
1424
1425
1426
1427
1428
1429
1430
1431
1432static int mpi3mr_alloc_op_reply_q_segments(struct mpi3mr_ioc *mrioc, u16 qidx)
1433{
1434 struct op_reply_qinfo *op_reply_q = mrioc->op_reply_qinfo + qidx;
1435 int i, size;
1436 u64 *q_segment_list_entry = NULL;
1437 struct segments *segments;
1438
1439 if (mrioc->enable_segqueue) {
1440 op_reply_q->segment_qd =
1441 MPI3MR_OP_REP_Q_SEG_SIZE / mrioc->op_reply_desc_sz;
1442
1443 size = MPI3MR_OP_REP_Q_SEG_SIZE;
1444
1445 op_reply_q->q_segment_list = dma_alloc_coherent(&mrioc->pdev->dev,
1446 MPI3MR_MAX_SEG_LIST_SIZE, &op_reply_q->q_segment_list_dma,
1447 GFP_KERNEL);
1448 if (!op_reply_q->q_segment_list)
1449 return -ENOMEM;
1450 q_segment_list_entry = (u64 *)op_reply_q->q_segment_list;
1451 } else {
1452 op_reply_q->segment_qd = op_reply_q->num_replies;
1453 size = op_reply_q->num_replies * mrioc->op_reply_desc_sz;
1454 }
1455
1456 op_reply_q->num_segments = DIV_ROUND_UP(op_reply_q->num_replies,
1457 op_reply_q->segment_qd);
1458
1459 op_reply_q->q_segments = kcalloc(op_reply_q->num_segments,
1460 sizeof(struct segments), GFP_KERNEL);
1461 if (!op_reply_q->q_segments)
1462 return -ENOMEM;
1463
1464 segments = op_reply_q->q_segments;
1465 for (i = 0; i < op_reply_q->num_segments; i++) {
1466 segments[i].segment =
1467 dma_alloc_coherent(&mrioc->pdev->dev,
1468 size, &segments[i].segment_dma, GFP_KERNEL);
1469 if (!segments[i].segment)
1470 return -ENOMEM;
1471 if (mrioc->enable_segqueue)
1472 q_segment_list_entry[i] =
1473 (unsigned long)segments[i].segment_dma;
1474 }
1475
1476 return 0;
1477}
1478
1479
1480
1481
1482
1483
1484
1485
1486
1487
1488
1489static int mpi3mr_alloc_op_req_q_segments(struct mpi3mr_ioc *mrioc, u16 qidx)
1490{
1491 struct op_req_qinfo *op_req_q = mrioc->req_qinfo + qidx;
1492 int i, size;
1493 u64 *q_segment_list_entry = NULL;
1494 struct segments *segments;
1495
1496 if (mrioc->enable_segqueue) {
1497 op_req_q->segment_qd =
1498 MPI3MR_OP_REQ_Q_SEG_SIZE / mrioc->facts.op_req_sz;
1499
1500 size = MPI3MR_OP_REQ_Q_SEG_SIZE;
1501
1502 op_req_q->q_segment_list = dma_alloc_coherent(&mrioc->pdev->dev,
1503 MPI3MR_MAX_SEG_LIST_SIZE, &op_req_q->q_segment_list_dma,
1504 GFP_KERNEL);
1505 if (!op_req_q->q_segment_list)
1506 return -ENOMEM;
1507 q_segment_list_entry = (u64 *)op_req_q->q_segment_list;
1508
1509 } else {
1510 op_req_q->segment_qd = op_req_q->num_requests;
1511 size = op_req_q->num_requests * mrioc->facts.op_req_sz;
1512 }
1513
1514 op_req_q->num_segments = DIV_ROUND_UP(op_req_q->num_requests,
1515 op_req_q->segment_qd);
1516
1517 op_req_q->q_segments = kcalloc(op_req_q->num_segments,
1518 sizeof(struct segments), GFP_KERNEL);
1519 if (!op_req_q->q_segments)
1520 return -ENOMEM;
1521
1522 segments = op_req_q->q_segments;
1523 for (i = 0; i < op_req_q->num_segments; i++) {
1524 segments[i].segment =
1525 dma_alloc_coherent(&mrioc->pdev->dev,
1526 size, &segments[i].segment_dma, GFP_KERNEL);
1527 if (!segments[i].segment)
1528 return -ENOMEM;
1529 if (mrioc->enable_segqueue)
1530 q_segment_list_entry[i] =
1531 (unsigned long)segments[i].segment_dma;
1532 }
1533
1534 return 0;
1535}
1536
1537
1538
1539
1540
1541
1542
1543
1544
1545
1546
1547static int mpi3mr_create_op_reply_q(struct mpi3mr_ioc *mrioc, u16 qidx)
1548{
1549 struct mpi3_create_reply_queue_request create_req;
1550 struct op_reply_qinfo *op_reply_q = mrioc->op_reply_qinfo + qidx;
1551 int retval = 0;
1552 u16 reply_qid = 0, midx;
1553
1554 reply_qid = op_reply_q->qid;
1555
1556 midx = REPLY_QUEUE_IDX_TO_MSIX_IDX(qidx, mrioc->op_reply_q_offset);
1557
1558 if (reply_qid) {
1559 retval = -1;
1560 ioc_err(mrioc, "CreateRepQ: called for duplicate qid %d\n",
1561 reply_qid);
1562
1563 return retval;
1564 }
1565
1566 reply_qid = qidx + 1;
1567 op_reply_q->num_replies = MPI3MR_OP_REP_Q_QD;
1568 op_reply_q->ci = 0;
1569 op_reply_q->ephase = 1;
1570 atomic_set(&op_reply_q->pend_ios, 0);
1571 atomic_set(&op_reply_q->in_use, 0);
1572 op_reply_q->enable_irq_poll = false;
1573
1574 if (!op_reply_q->q_segments) {
1575 retval = mpi3mr_alloc_op_reply_q_segments(mrioc, qidx);
1576 if (retval) {
1577 mpi3mr_free_op_reply_q_segments(mrioc, qidx);
1578 goto out;
1579 }
1580 }
1581
1582 memset(&create_req, 0, sizeof(create_req));
1583 mutex_lock(&mrioc->init_cmds.mutex);
1584 if (mrioc->init_cmds.state & MPI3MR_CMD_PENDING) {
1585 retval = -1;
1586 ioc_err(mrioc, "CreateRepQ: Init command is in use\n");
1587 goto out_unlock;
1588 }
1589 mrioc->init_cmds.state = MPI3MR_CMD_PENDING;
1590 mrioc->init_cmds.is_waiting = 1;
1591 mrioc->init_cmds.callback = NULL;
1592 create_req.host_tag = cpu_to_le16(MPI3MR_HOSTTAG_INITCMDS);
1593 create_req.function = MPI3_FUNCTION_CREATE_REPLY_QUEUE;
1594 create_req.queue_id = cpu_to_le16(reply_qid);
1595 create_req.flags = MPI3_CREATE_REPLY_QUEUE_FLAGS_INT_ENABLE_ENABLE;
1596 create_req.msix_index = cpu_to_le16(mrioc->intr_info[midx].msix_index);
1597 if (mrioc->enable_segqueue) {
1598 create_req.flags |=
1599 MPI3_CREATE_REQUEST_QUEUE_FLAGS_SEGMENTED_SEGMENTED;
1600 create_req.base_address = cpu_to_le64(
1601 op_reply_q->q_segment_list_dma);
1602 } else
1603 create_req.base_address = cpu_to_le64(
1604 op_reply_q->q_segments[0].segment_dma);
1605
1606 create_req.size = cpu_to_le16(op_reply_q->num_replies);
1607
1608 init_completion(&mrioc->init_cmds.done);
1609 retval = mpi3mr_admin_request_post(mrioc, &create_req,
1610 sizeof(create_req), 1);
1611 if (retval) {
1612 ioc_err(mrioc, "CreateRepQ: Admin Post failed\n");
1613 goto out_unlock;
1614 }
1615 wait_for_completion_timeout(&mrioc->init_cmds.done,
1616 (MPI3MR_INTADMCMD_TIMEOUT * HZ));
1617 if (!(mrioc->init_cmds.state & MPI3MR_CMD_COMPLETE)) {
1618 ioc_err(mrioc, "CreateRepQ: command timed out\n");
1619 mpi3mr_set_diagsave(mrioc);
1620 mpi3mr_issue_reset(mrioc,
1621 MPI3_SYSIF_HOST_DIAG_RESET_ACTION_DIAG_FAULT,
1622 MPI3MR_RESET_FROM_CREATEREPQ_TIMEOUT);
1623 mrioc->unrecoverable = 1;
1624 retval = -1;
1625 goto out_unlock;
1626 }
1627 if ((mrioc->init_cmds.ioc_status & MPI3_IOCSTATUS_STATUS_MASK)
1628 != MPI3_IOCSTATUS_SUCCESS) {
1629 ioc_err(mrioc,
1630 "CreateRepQ: Failed ioc_status(0x%04x) Loginfo(0x%08x)\n",
1631 (mrioc->init_cmds.ioc_status & MPI3_IOCSTATUS_STATUS_MASK),
1632 mrioc->init_cmds.ioc_loginfo);
1633 retval = -1;
1634 goto out_unlock;
1635 }
1636 op_reply_q->qid = reply_qid;
1637 mrioc->intr_info[midx].op_reply_q = op_reply_q;
1638
1639out_unlock:
1640 mrioc->init_cmds.state = MPI3MR_CMD_NOTUSED;
1641 mutex_unlock(&mrioc->init_cmds.mutex);
1642out:
1643
1644 return retval;
1645}
1646
1647
1648
1649
1650
1651
1652
1653
1654
1655
1656
1657
1658static int mpi3mr_create_op_req_q(struct mpi3mr_ioc *mrioc, u16 idx,
1659 u16 reply_qid)
1660{
1661 struct mpi3_create_request_queue_request create_req;
1662 struct op_req_qinfo *op_req_q = mrioc->req_qinfo + idx;
1663 int retval = 0;
1664 u16 req_qid = 0;
1665
1666 req_qid = op_req_q->qid;
1667
1668 if (req_qid) {
1669 retval = -1;
1670 ioc_err(mrioc, "CreateReqQ: called for duplicate qid %d\n",
1671 req_qid);
1672
1673 return retval;
1674 }
1675 req_qid = idx + 1;
1676
1677 op_req_q->num_requests = MPI3MR_OP_REQ_Q_QD;
1678 op_req_q->ci = 0;
1679 op_req_q->pi = 0;
1680 op_req_q->reply_qid = reply_qid;
1681 spin_lock_init(&op_req_q->q_lock);
1682
1683 if (!op_req_q->q_segments) {
1684 retval = mpi3mr_alloc_op_req_q_segments(mrioc, idx);
1685 if (retval) {
1686 mpi3mr_free_op_req_q_segments(mrioc, idx);
1687 goto out;
1688 }
1689 }
1690
1691 memset(&create_req, 0, sizeof(create_req));
1692 mutex_lock(&mrioc->init_cmds.mutex);
1693 if (mrioc->init_cmds.state & MPI3MR_CMD_PENDING) {
1694 retval = -1;
1695 ioc_err(mrioc, "CreateReqQ: Init command is in use\n");
1696 goto out_unlock;
1697 }
1698 mrioc->init_cmds.state = MPI3MR_CMD_PENDING;
1699 mrioc->init_cmds.is_waiting = 1;
1700 mrioc->init_cmds.callback = NULL;
1701 create_req.host_tag = cpu_to_le16(MPI3MR_HOSTTAG_INITCMDS);
1702 create_req.function = MPI3_FUNCTION_CREATE_REQUEST_QUEUE;
1703 create_req.queue_id = cpu_to_le16(req_qid);
1704 if (mrioc->enable_segqueue) {
1705 create_req.flags =
1706 MPI3_CREATE_REQUEST_QUEUE_FLAGS_SEGMENTED_SEGMENTED;
1707 create_req.base_address = cpu_to_le64(
1708 op_req_q->q_segment_list_dma);
1709 } else
1710 create_req.base_address = cpu_to_le64(
1711 op_req_q->q_segments[0].segment_dma);
1712 create_req.reply_queue_id = cpu_to_le16(reply_qid);
1713 create_req.size = cpu_to_le16(op_req_q->num_requests);
1714
1715 init_completion(&mrioc->init_cmds.done);
1716 retval = mpi3mr_admin_request_post(mrioc, &create_req,
1717 sizeof(create_req), 1);
1718 if (retval) {
1719 ioc_err(mrioc, "CreateReqQ: Admin Post failed\n");
1720 goto out_unlock;
1721 }
1722 wait_for_completion_timeout(&mrioc->init_cmds.done,
1723 (MPI3MR_INTADMCMD_TIMEOUT * HZ));
1724 if (!(mrioc->init_cmds.state & MPI3MR_CMD_COMPLETE)) {
1725 ioc_err(mrioc, "CreateReqQ: command timed out\n");
1726 mpi3mr_set_diagsave(mrioc);
1727 if (mpi3mr_issue_reset(mrioc,
1728 MPI3_SYSIF_HOST_DIAG_RESET_ACTION_DIAG_FAULT,
1729 MPI3MR_RESET_FROM_CREATEREQQ_TIMEOUT))
1730 mrioc->unrecoverable = 1;
1731 retval = -1;
1732 goto out_unlock;
1733 }
1734 if ((mrioc->init_cmds.ioc_status & MPI3_IOCSTATUS_STATUS_MASK)
1735 != MPI3_IOCSTATUS_SUCCESS) {
1736 ioc_err(mrioc,
1737 "CreateReqQ: Failed ioc_status(0x%04x) Loginfo(0x%08x)\n",
1738 (mrioc->init_cmds.ioc_status & MPI3_IOCSTATUS_STATUS_MASK),
1739 mrioc->init_cmds.ioc_loginfo);
1740 retval = -1;
1741 goto out_unlock;
1742 }
1743 op_req_q->qid = req_qid;
1744
1745out_unlock:
1746 mrioc->init_cmds.state = MPI3MR_CMD_NOTUSED;
1747 mutex_unlock(&mrioc->init_cmds.mutex);
1748out:
1749
1750 return retval;
1751}
1752
1753
1754
1755
1756
1757
1758
1759
1760
1761
1762static int mpi3mr_create_op_queues(struct mpi3mr_ioc *mrioc)
1763{
1764 int retval = 0;
1765 u16 num_queues = 0, i = 0, msix_count_op_q = 1;
1766
1767 num_queues = min_t(int, mrioc->facts.max_op_reply_q,
1768 mrioc->facts.max_op_req_q);
1769
1770 msix_count_op_q =
1771 mrioc->intr_info_count - mrioc->op_reply_q_offset;
1772 if (!mrioc->num_queues)
1773 mrioc->num_queues = min_t(int, num_queues, msix_count_op_q);
1774 num_queues = mrioc->num_queues;
1775 ioc_info(mrioc, "Trying to create %d Operational Q pairs\n",
1776 num_queues);
1777
1778 if (!mrioc->req_qinfo) {
1779 mrioc->req_qinfo = kcalloc(num_queues,
1780 sizeof(struct op_req_qinfo), GFP_KERNEL);
1781 if (!mrioc->req_qinfo) {
1782 retval = -1;
1783 goto out_failed;
1784 }
1785
1786 mrioc->op_reply_qinfo = kzalloc(sizeof(struct op_reply_qinfo) *
1787 num_queues, GFP_KERNEL);
1788 if (!mrioc->op_reply_qinfo) {
1789 retval = -1;
1790 goto out_failed;
1791 }
1792 }
1793
1794 if (mrioc->enable_segqueue)
1795 ioc_info(mrioc,
1796 "allocating operational queues through segmented queues\n");
1797
1798 for (i = 0; i < num_queues; i++) {
1799 if (mpi3mr_create_op_reply_q(mrioc, i)) {
1800 ioc_err(mrioc, "Cannot create OP RepQ %d\n", i);
1801 break;
1802 }
1803 if (mpi3mr_create_op_req_q(mrioc, i,
1804 mrioc->op_reply_qinfo[i].qid)) {
1805 ioc_err(mrioc, "Cannot create OP ReqQ %d\n", i);
1806 mpi3mr_delete_op_reply_q(mrioc, i);
1807 break;
1808 }
1809 }
1810
1811 if (i == 0) {
1812
1813 retval = -1;
1814 goto out_failed;
1815 }
1816 mrioc->num_op_reply_q = mrioc->num_op_req_q = i;
1817 ioc_info(mrioc, "Successfully created %d Operational Q pairs\n",
1818 mrioc->num_op_reply_q);
1819
1820 return retval;
1821out_failed:
1822 kfree(mrioc->req_qinfo);
1823 mrioc->req_qinfo = NULL;
1824
1825 kfree(mrioc->op_reply_qinfo);
1826 mrioc->op_reply_qinfo = NULL;
1827
1828 return retval;
1829}
1830
1831
1832
1833
1834
1835
1836
1837
1838
1839
1840
1841
1842
1843int mpi3mr_op_request_post(struct mpi3mr_ioc *mrioc,
1844 struct op_req_qinfo *op_req_q, u8 *req)
1845{
1846 u16 pi = 0, max_entries, reply_qidx = 0, midx;
1847 int retval = 0;
1848 unsigned long flags;
1849 u8 *req_entry;
1850 void *segment_base_addr;
1851 u16 req_sz = mrioc->facts.op_req_sz;
1852 struct segments *segments = op_req_q->q_segments;
1853
1854 reply_qidx = op_req_q->reply_qid - 1;
1855
1856 if (mrioc->unrecoverable)
1857 return -EFAULT;
1858
1859 spin_lock_irqsave(&op_req_q->q_lock, flags);
1860 pi = op_req_q->pi;
1861 max_entries = op_req_q->num_requests;
1862
1863 if (mpi3mr_check_req_qfull(op_req_q)) {
1864 midx = REPLY_QUEUE_IDX_TO_MSIX_IDX(
1865 reply_qidx, mrioc->op_reply_q_offset);
1866 mpi3mr_process_op_reply_q(mrioc, &mrioc->intr_info[midx]);
1867
1868 if (mpi3mr_check_req_qfull(op_req_q)) {
1869 retval = -EAGAIN;
1870 goto out;
1871 }
1872 }
1873
1874 if (mrioc->reset_in_progress) {
1875 ioc_err(mrioc, "OpReqQ submit reset in progress\n");
1876 retval = -EAGAIN;
1877 goto out;
1878 }
1879
1880 segment_base_addr = segments[pi / op_req_q->segment_qd].segment;
1881 req_entry = (u8 *)segment_base_addr +
1882 ((pi % op_req_q->segment_qd) * req_sz);
1883
1884 memset(req_entry, 0, req_sz);
1885 memcpy(req_entry, req, MPI3MR_ADMIN_REQ_FRAME_SZ);
1886
1887 if (++pi == max_entries)
1888 pi = 0;
1889 op_req_q->pi = pi;
1890
1891 if (atomic_inc_return(&mrioc->op_reply_qinfo[reply_qidx].pend_ios)
1892 > MPI3MR_IRQ_POLL_TRIGGER_IOCOUNT)
1893 mrioc->op_reply_qinfo[reply_qidx].enable_irq_poll = true;
1894
1895 writel(op_req_q->pi,
1896 &mrioc->sysif_regs->oper_queue_indexes[reply_qidx].producer_index);
1897
1898out:
1899 spin_unlock_irqrestore(&op_req_q->q_lock, flags);
1900 return retval;
1901}
1902
1903
1904
1905
1906
1907
1908
1909
1910
1911
1912static int mpi3mr_sync_timestamp(struct mpi3mr_ioc *mrioc)
1913{
1914 ktime_t current_time;
1915 struct mpi3_iounit_control_request iou_ctrl;
1916 int retval = 0;
1917
1918 memset(&iou_ctrl, 0, sizeof(iou_ctrl));
1919 mutex_lock(&mrioc->init_cmds.mutex);
1920 if (mrioc->init_cmds.state & MPI3MR_CMD_PENDING) {
1921 retval = -1;
1922 ioc_err(mrioc, "Issue IOUCTL time_stamp: command is in use\n");
1923 mutex_unlock(&mrioc->init_cmds.mutex);
1924 goto out;
1925 }
1926 mrioc->init_cmds.state = MPI3MR_CMD_PENDING;
1927 mrioc->init_cmds.is_waiting = 1;
1928 mrioc->init_cmds.callback = NULL;
1929 iou_ctrl.host_tag = cpu_to_le16(MPI3MR_HOSTTAG_INITCMDS);
1930 iou_ctrl.function = MPI3_FUNCTION_IO_UNIT_CONTROL;
1931 iou_ctrl.operation = MPI3_CTRL_OP_UPDATE_TIMESTAMP;
1932 current_time = ktime_get_real();
1933 iou_ctrl.param64[0] = cpu_to_le64(ktime_to_ms(current_time));
1934
1935 init_completion(&mrioc->init_cmds.done);
1936 retval = mpi3mr_admin_request_post(mrioc, &iou_ctrl,
1937 sizeof(iou_ctrl), 0);
1938 if (retval) {
1939 ioc_err(mrioc, "Issue IOUCTL time_stamp: Admin Post failed\n");
1940 goto out_unlock;
1941 }
1942
1943 wait_for_completion_timeout(&mrioc->init_cmds.done,
1944 (MPI3MR_INTADMCMD_TIMEOUT * HZ));
1945 if (!(mrioc->init_cmds.state & MPI3MR_CMD_COMPLETE)) {
1946 ioc_err(mrioc, "Issue IOUCTL time_stamp: command timed out\n");
1947 mrioc->init_cmds.is_waiting = 0;
1948 mpi3mr_soft_reset_handler(mrioc,
1949 MPI3MR_RESET_FROM_TSU_TIMEOUT, 1);
1950 retval = -1;
1951 goto out_unlock;
1952 }
1953 if ((mrioc->init_cmds.ioc_status & MPI3_IOCSTATUS_STATUS_MASK)
1954 != MPI3_IOCSTATUS_SUCCESS) {
1955 ioc_err(mrioc,
1956 "Issue IOUCTL time_stamp: Failed ioc_status(0x%04x) Loginfo(0x%08x)\n",
1957 (mrioc->init_cmds.ioc_status & MPI3_IOCSTATUS_STATUS_MASK),
1958 mrioc->init_cmds.ioc_loginfo);
1959 retval = -1;
1960 goto out_unlock;
1961 }
1962
1963out_unlock:
1964 mrioc->init_cmds.state = MPI3MR_CMD_NOTUSED;
1965 mutex_unlock(&mrioc->init_cmds.mutex);
1966
1967out:
1968 return retval;
1969}
1970
1971
1972
1973
1974
1975
1976
1977
1978
1979
1980
1981static void mpi3mr_watchdog_work(struct work_struct *work)
1982{
1983 struct mpi3mr_ioc *mrioc =
1984 container_of(work, struct mpi3mr_ioc, watchdog_work.work);
1985 unsigned long flags;
1986 enum mpi3mr_iocstate ioc_state;
1987 u32 fault, host_diagnostic;
1988
1989 if (mrioc->ts_update_counter++ >= MPI3MR_TSUPDATE_INTERVAL) {
1990 mrioc->ts_update_counter = 0;
1991 mpi3mr_sync_timestamp(mrioc);
1992 }
1993
1994
1995 ioc_state = mpi3mr_get_iocstate(mrioc);
1996 if (ioc_state == MRIOC_STATE_FAULT) {
1997 fault = readl(&mrioc->sysif_regs->fault) &
1998 MPI3_SYSIF_FAULT_CODE_MASK;
1999 host_diagnostic = readl(&mrioc->sysif_regs->host_diagnostic);
2000 if (host_diagnostic & MPI3_SYSIF_HOST_DIAG_SAVE_IN_PROGRESS) {
2001 if (!mrioc->diagsave_timeout) {
2002 mpi3mr_print_fault_info(mrioc);
2003 ioc_warn(mrioc, "Diag save in progress\n");
2004 }
2005 if ((mrioc->diagsave_timeout++) <=
2006 MPI3_SYSIF_DIAG_SAVE_TIMEOUT)
2007 goto schedule_work;
2008 } else
2009 mpi3mr_print_fault_info(mrioc);
2010 mrioc->diagsave_timeout = 0;
2011
2012 if (fault == MPI3_SYSIF_FAULT_CODE_FACTORY_RESET) {
2013 ioc_info(mrioc,
2014 "Factory Reset fault occurred marking controller as unrecoverable"
2015 );
2016 mrioc->unrecoverable = 1;
2017 goto out;
2018 }
2019
2020 if ((fault == MPI3_SYSIF_FAULT_CODE_DIAG_FAULT_RESET) ||
2021 (fault == MPI3_SYSIF_FAULT_CODE_SOFT_RESET_IN_PROGRESS) ||
2022 (mrioc->reset_in_progress))
2023 goto out;
2024 if (fault == MPI3_SYSIF_FAULT_CODE_CI_ACTIVATION_RESET)
2025 mpi3mr_soft_reset_handler(mrioc,
2026 MPI3MR_RESET_FROM_CIACTIV_FAULT, 0);
2027 else
2028 mpi3mr_soft_reset_handler(mrioc,
2029 MPI3MR_RESET_FROM_FAULT_WATCH, 0);
2030 }
2031
2032schedule_work:
2033 spin_lock_irqsave(&mrioc->watchdog_lock, flags);
2034 if (mrioc->watchdog_work_q)
2035 queue_delayed_work(mrioc->watchdog_work_q,
2036 &mrioc->watchdog_work,
2037 msecs_to_jiffies(MPI3MR_WATCHDOG_INTERVAL));
2038 spin_unlock_irqrestore(&mrioc->watchdog_lock, flags);
2039out:
2040 return;
2041}
2042
2043
2044
2045
2046
2047
2048
2049
2050
2051
2052void mpi3mr_start_watchdog(struct mpi3mr_ioc *mrioc)
2053{
2054 if (mrioc->watchdog_work_q)
2055 return;
2056
2057 INIT_DELAYED_WORK(&mrioc->watchdog_work, mpi3mr_watchdog_work);
2058 snprintf(mrioc->watchdog_work_q_name,
2059 sizeof(mrioc->watchdog_work_q_name), "watchdog_%s%d", mrioc->name,
2060 mrioc->id);
2061 mrioc->watchdog_work_q =
2062 create_singlethread_workqueue(mrioc->watchdog_work_q_name);
2063 if (!mrioc->watchdog_work_q) {
2064 ioc_err(mrioc, "%s: failed (line=%d)\n", __func__, __LINE__);
2065 return;
2066 }
2067
2068 if (mrioc->watchdog_work_q)
2069 queue_delayed_work(mrioc->watchdog_work_q,
2070 &mrioc->watchdog_work,
2071 msecs_to_jiffies(MPI3MR_WATCHDOG_INTERVAL));
2072}
2073
2074
2075
2076
2077
2078
2079
2080
2081
2082
2083void mpi3mr_stop_watchdog(struct mpi3mr_ioc *mrioc)
2084{
2085 unsigned long flags;
2086 struct workqueue_struct *wq;
2087
2088 spin_lock_irqsave(&mrioc->watchdog_lock, flags);
2089 wq = mrioc->watchdog_work_q;
2090 mrioc->watchdog_work_q = NULL;
2091 spin_unlock_irqrestore(&mrioc->watchdog_lock, flags);
2092 if (wq) {
2093 if (!cancel_delayed_work_sync(&mrioc->watchdog_work))
2094 flush_workqueue(wq);
2095 destroy_workqueue(wq);
2096 }
2097}
2098
2099
2100
2101
2102
2103
2104
2105
2106
2107
2108
2109
2110static void mpi3mr_kill_ioc(struct mpi3mr_ioc *mrioc, u32 reason)
2111{
2112 enum mpi3mr_iocstate ioc_state;
2113
2114 if (!mrioc->fault_dbg)
2115 return;
2116
2117 dump_stack();
2118
2119 ioc_state = mpi3mr_get_iocstate(mrioc);
2120 if (ioc_state == MRIOC_STATE_FAULT)
2121 mpi3mr_print_fault_info(mrioc);
2122 else {
2123 ioc_err(mrioc, "Firmware is halted due to the reason %d\n",
2124 reason);
2125 mpi3mr_diagfault_reset_handler(mrioc, reason);
2126 }
2127 if (mrioc->fault_dbg == 2)
2128 for (;;)
2129 ;
2130 else
2131 panic("panic in %s\n", __func__);
2132}
2133
2134
2135
2136
2137
2138
2139
2140
2141
2142
2143static int mpi3mr_setup_admin_qpair(struct mpi3mr_ioc *mrioc)
2144{
2145 int retval = 0;
2146 u32 num_admin_entries = 0;
2147
2148 mrioc->admin_req_q_sz = MPI3MR_ADMIN_REQ_Q_SIZE;
2149 mrioc->num_admin_req = mrioc->admin_req_q_sz /
2150 MPI3MR_ADMIN_REQ_FRAME_SZ;
2151 mrioc->admin_req_ci = mrioc->admin_req_pi = 0;
2152 mrioc->admin_req_base = NULL;
2153
2154 mrioc->admin_reply_q_sz = MPI3MR_ADMIN_REPLY_Q_SIZE;
2155 mrioc->num_admin_replies = mrioc->admin_reply_q_sz /
2156 MPI3MR_ADMIN_REPLY_FRAME_SZ;
2157 mrioc->admin_reply_ci = 0;
2158 mrioc->admin_reply_ephase = 1;
2159 mrioc->admin_reply_base = NULL;
2160
2161 if (!mrioc->admin_req_base) {
2162 mrioc->admin_req_base = dma_alloc_coherent(&mrioc->pdev->dev,
2163 mrioc->admin_req_q_sz, &mrioc->admin_req_dma, GFP_KERNEL);
2164
2165 if (!mrioc->admin_req_base) {
2166 retval = -1;
2167 goto out_failed;
2168 }
2169
2170 mrioc->admin_reply_base = dma_alloc_coherent(&mrioc->pdev->dev,
2171 mrioc->admin_reply_q_sz, &mrioc->admin_reply_dma,
2172 GFP_KERNEL);
2173
2174 if (!mrioc->admin_reply_base) {
2175 retval = -1;
2176 goto out_failed;
2177 }
2178 }
2179
2180 num_admin_entries = (mrioc->num_admin_replies << 16) |
2181 (mrioc->num_admin_req);
2182 writel(num_admin_entries, &mrioc->sysif_regs->admin_queue_num_entries);
2183 mpi3mr_writeq(mrioc->admin_req_dma,
2184 &mrioc->sysif_regs->admin_request_queue_address);
2185 mpi3mr_writeq(mrioc->admin_reply_dma,
2186 &mrioc->sysif_regs->admin_reply_queue_address);
2187 writel(mrioc->admin_req_pi, &mrioc->sysif_regs->admin_request_queue_pi);
2188 writel(mrioc->admin_reply_ci, &mrioc->sysif_regs->admin_reply_queue_ci);
2189 return retval;
2190
2191out_failed:
2192
2193 if (mrioc->admin_reply_base) {
2194 dma_free_coherent(&mrioc->pdev->dev, mrioc->admin_reply_q_sz,
2195 mrioc->admin_reply_base, mrioc->admin_reply_dma);
2196 mrioc->admin_reply_base = NULL;
2197 }
2198 if (mrioc->admin_req_base) {
2199 dma_free_coherent(&mrioc->pdev->dev, mrioc->admin_req_q_sz,
2200 mrioc->admin_req_base, mrioc->admin_req_dma);
2201 mrioc->admin_req_base = NULL;
2202 }
2203 return retval;
2204}
2205
2206
2207
2208
2209
2210
2211
2212
2213
2214
2215
2216static int mpi3mr_issue_iocfacts(struct mpi3mr_ioc *mrioc,
2217 struct mpi3_ioc_facts_data *facts_data)
2218{
2219 struct mpi3_ioc_facts_request iocfacts_req;
2220 void *data = NULL;
2221 dma_addr_t data_dma;
2222 u32 data_len = sizeof(*facts_data);
2223 int retval = 0;
2224 u8 sgl_flags = MPI3MR_SGEFLAGS_SYSTEM_SIMPLE_END_OF_LIST;
2225
2226 data = dma_alloc_coherent(&mrioc->pdev->dev, data_len, &data_dma,
2227 GFP_KERNEL);
2228
2229 if (!data) {
2230 retval = -1;
2231 goto out;
2232 }
2233
2234 memset(&iocfacts_req, 0, sizeof(iocfacts_req));
2235 mutex_lock(&mrioc->init_cmds.mutex);
2236 if (mrioc->init_cmds.state & MPI3MR_CMD_PENDING) {
2237 retval = -1;
2238 ioc_err(mrioc, "Issue IOCFacts: Init command is in use\n");
2239 mutex_unlock(&mrioc->init_cmds.mutex);
2240 goto out;
2241 }
2242 mrioc->init_cmds.state = MPI3MR_CMD_PENDING;
2243 mrioc->init_cmds.is_waiting = 1;
2244 mrioc->init_cmds.callback = NULL;
2245 iocfacts_req.host_tag = cpu_to_le16(MPI3MR_HOSTTAG_INITCMDS);
2246 iocfacts_req.function = MPI3_FUNCTION_IOC_FACTS;
2247
2248 mpi3mr_add_sg_single(&iocfacts_req.sgl, sgl_flags, data_len,
2249 data_dma);
2250
2251 init_completion(&mrioc->init_cmds.done);
2252 retval = mpi3mr_admin_request_post(mrioc, &iocfacts_req,
2253 sizeof(iocfacts_req), 1);
2254 if (retval) {
2255 ioc_err(mrioc, "Issue IOCFacts: Admin Post failed\n");
2256 goto out_unlock;
2257 }
2258 wait_for_completion_timeout(&mrioc->init_cmds.done,
2259 (MPI3MR_INTADMCMD_TIMEOUT * HZ));
2260 if (!(mrioc->init_cmds.state & MPI3MR_CMD_COMPLETE)) {
2261 ioc_err(mrioc, "Issue IOCFacts: command timed out\n");
2262 mpi3mr_set_diagsave(mrioc);
2263 mpi3mr_issue_reset(mrioc,
2264 MPI3_SYSIF_HOST_DIAG_RESET_ACTION_DIAG_FAULT,
2265 MPI3MR_RESET_FROM_IOCFACTS_TIMEOUT);
2266 mrioc->unrecoverable = 1;
2267 retval = -1;
2268 goto out_unlock;
2269 }
2270 if ((mrioc->init_cmds.ioc_status & MPI3_IOCSTATUS_STATUS_MASK)
2271 != MPI3_IOCSTATUS_SUCCESS) {
2272 ioc_err(mrioc,
2273 "Issue IOCFacts: Failed ioc_status(0x%04x) Loginfo(0x%08x)\n",
2274 (mrioc->init_cmds.ioc_status & MPI3_IOCSTATUS_STATUS_MASK),
2275 mrioc->init_cmds.ioc_loginfo);
2276 retval = -1;
2277 goto out_unlock;
2278 }
2279 memcpy(facts_data, (u8 *)data, data_len);
2280out_unlock:
2281 mrioc->init_cmds.state = MPI3MR_CMD_NOTUSED;
2282 mutex_unlock(&mrioc->init_cmds.mutex);
2283
2284out:
2285 if (data)
2286 dma_free_coherent(&mrioc->pdev->dev, data_len, data, data_dma);
2287
2288 return retval;
2289}
2290
2291
2292
2293
2294
2295
2296
2297
2298
2299
2300static inline int mpi3mr_check_reset_dma_mask(struct mpi3mr_ioc *mrioc)
2301{
2302 struct pci_dev *pdev = mrioc->pdev;
2303 int r;
2304 u64 facts_dma_mask = DMA_BIT_MASK(mrioc->facts.dma_mask);
2305
2306 if (!mrioc->facts.dma_mask || (mrioc->dma_mask <= facts_dma_mask))
2307 return 0;
2308
2309 ioc_info(mrioc, "Changing DMA mask from 0x%016llx to 0x%016llx\n",
2310 mrioc->dma_mask, facts_dma_mask);
2311
2312 r = dma_set_mask_and_coherent(&pdev->dev, facts_dma_mask);
2313 if (r) {
2314 ioc_err(mrioc, "Setting DMA mask to 0x%016llx failed: %d\n",
2315 facts_dma_mask, r);
2316 return r;
2317 }
2318 mrioc->dma_mask = facts_dma_mask;
2319 return r;
2320}
2321
2322
2323
2324
2325
2326
2327
2328
2329
2330
2331
2332static void mpi3mr_process_factsdata(struct mpi3mr_ioc *mrioc,
2333 struct mpi3_ioc_facts_data *facts_data)
2334{
2335 u32 ioc_config, req_sz, facts_flags;
2336
2337 if ((le16_to_cpu(facts_data->ioc_facts_data_length)) !=
2338 (sizeof(*facts_data) / 4)) {
2339 ioc_warn(mrioc,
2340 "IOCFactsdata length mismatch driver_sz(%zu) firmware_sz(%d)\n",
2341 sizeof(*facts_data),
2342 le16_to_cpu(facts_data->ioc_facts_data_length) * 4);
2343 }
2344
2345 ioc_config = readl(&mrioc->sysif_regs->ioc_configuration);
2346 req_sz = 1 << ((ioc_config & MPI3_SYSIF_IOC_CONFIG_OPER_REQ_ENT_SZ) >>
2347 MPI3_SYSIF_IOC_CONFIG_OPER_REQ_ENT_SZ_SHIFT);
2348 if (le16_to_cpu(facts_data->ioc_request_frame_size) != (req_sz / 4)) {
2349 ioc_err(mrioc,
2350 "IOCFacts data reqFrameSize mismatch hw_size(%d) firmware_sz(%d)\n",
2351 req_sz / 4, le16_to_cpu(facts_data->ioc_request_frame_size));
2352 }
2353
2354 memset(&mrioc->facts, 0, sizeof(mrioc->facts));
2355
2356 facts_flags = le32_to_cpu(facts_data->flags);
2357 mrioc->facts.op_req_sz = req_sz;
2358 mrioc->op_reply_desc_sz = 1 << ((ioc_config &
2359 MPI3_SYSIF_IOC_CONFIG_OPER_RPY_ENT_SZ) >>
2360 MPI3_SYSIF_IOC_CONFIG_OPER_RPY_ENT_SZ_SHIFT);
2361
2362 mrioc->facts.ioc_num = facts_data->ioc_number;
2363 mrioc->facts.who_init = facts_data->who_init;
2364 mrioc->facts.max_msix_vectors = le16_to_cpu(facts_data->max_msix_vectors);
2365 mrioc->facts.personality = (facts_flags &
2366 MPI3_IOCFACTS_FLAGS_PERSONALITY_MASK);
2367 mrioc->facts.dma_mask = (facts_flags &
2368 MPI3_IOCFACTS_FLAGS_DMA_ADDRESS_WIDTH_MASK) >>
2369 MPI3_IOCFACTS_FLAGS_DMA_ADDRESS_WIDTH_SHIFT;
2370 mrioc->facts.protocol_flags = facts_data->protocol_flags;
2371 mrioc->facts.mpi_version = le32_to_cpu(facts_data->mpi_version.word);
2372 mrioc->facts.max_reqs = le16_to_cpu(facts_data->max_outstanding_request);
2373 mrioc->facts.product_id = le16_to_cpu(facts_data->product_id);
2374 mrioc->facts.reply_sz = le16_to_cpu(facts_data->reply_frame_size) * 4;
2375 mrioc->facts.exceptions = le16_to_cpu(facts_data->ioc_exceptions);
2376 mrioc->facts.max_perids = le16_to_cpu(facts_data->max_persistent_id);
2377 mrioc->facts.max_pds = le16_to_cpu(facts_data->max_pds);
2378 mrioc->facts.max_vds = le16_to_cpu(facts_data->max_vds);
2379 mrioc->facts.max_hpds = le16_to_cpu(facts_data->max_host_pds);
2380 mrioc->facts.max_advhpds = le16_to_cpu(facts_data->max_advanced_host_pds);
2381 mrioc->facts.max_raidpds = le16_to_cpu(facts_data->max_raid_pds);
2382 mrioc->facts.max_nvme = le16_to_cpu(facts_data->max_nvme);
2383 mrioc->facts.max_pcie_switches =
2384 le16_to_cpu(facts_data->max_pc_ie_switches);
2385 mrioc->facts.max_sasexpanders =
2386 le16_to_cpu(facts_data->max_sas_expanders);
2387 mrioc->facts.max_sasinitiators =
2388 le16_to_cpu(facts_data->max_sas_initiators);
2389 mrioc->facts.max_enclosures = le16_to_cpu(facts_data->max_enclosures);
2390 mrioc->facts.min_devhandle = le16_to_cpu(facts_data->min_dev_handle);
2391 mrioc->facts.max_devhandle = le16_to_cpu(facts_data->max_dev_handle);
2392 mrioc->facts.max_op_req_q =
2393 le16_to_cpu(facts_data->max_operational_request_queues);
2394 mrioc->facts.max_op_reply_q =
2395 le16_to_cpu(facts_data->max_operational_reply_queues);
2396 mrioc->facts.ioc_capabilities =
2397 le32_to_cpu(facts_data->ioc_capabilities);
2398 mrioc->facts.fw_ver.build_num =
2399 le16_to_cpu(facts_data->fw_version.build_num);
2400 mrioc->facts.fw_ver.cust_id =
2401 le16_to_cpu(facts_data->fw_version.customer_id);
2402 mrioc->facts.fw_ver.ph_minor = facts_data->fw_version.phase_minor;
2403 mrioc->facts.fw_ver.ph_major = facts_data->fw_version.phase_major;
2404 mrioc->facts.fw_ver.gen_minor = facts_data->fw_version.gen_minor;
2405 mrioc->facts.fw_ver.gen_major = facts_data->fw_version.gen_major;
2406 mrioc->msix_count = min_t(int, mrioc->msix_count,
2407 mrioc->facts.max_msix_vectors);
2408 mrioc->facts.sge_mod_mask = facts_data->sge_modifier_mask;
2409 mrioc->facts.sge_mod_value = facts_data->sge_modifier_value;
2410 mrioc->facts.sge_mod_shift = facts_data->sge_modifier_shift;
2411 mrioc->facts.shutdown_timeout =
2412 le16_to_cpu(facts_data->shutdown_timeout);
2413
2414 ioc_info(mrioc, "ioc_num(%d), maxopQ(%d), maxopRepQ(%d), maxdh(%d),",
2415 mrioc->facts.ioc_num, mrioc->facts.max_op_req_q,
2416 mrioc->facts.max_op_reply_q, mrioc->facts.max_devhandle);
2417 ioc_info(mrioc,
2418 "maxreqs(%d), mindh(%d) maxPDs(%d) maxvectors(%d) maxperids(%d)\n",
2419 mrioc->facts.max_reqs, mrioc->facts.min_devhandle,
2420 mrioc->facts.max_pds, mrioc->facts.max_msix_vectors,
2421 mrioc->facts.max_perids);
2422 ioc_info(mrioc, "SGEModMask 0x%x SGEModVal 0x%x SGEModShift 0x%x ",
2423 mrioc->facts.sge_mod_mask, mrioc->facts.sge_mod_value,
2424 mrioc->facts.sge_mod_shift);
2425 ioc_info(mrioc, "DMA mask %d InitialPE status 0x%x\n",
2426 mrioc->facts.dma_mask, (facts_flags &
2427 MPI3_IOCFACTS_FLAGS_INITIAL_PORT_ENABLE_MASK));
2428
2429 mrioc->max_host_ios = mrioc->facts.max_reqs - MPI3MR_INTERNAL_CMDS_RESVD;
2430
2431 if (reset_devices)
2432 mrioc->max_host_ios = min_t(int, mrioc->max_host_ios,
2433 MPI3MR_HOST_IOS_KDUMP);
2434}
2435
2436
2437
2438
2439
2440
2441
2442
2443
2444
2445static int mpi3mr_alloc_reply_sense_bufs(struct mpi3mr_ioc *mrioc)
2446{
2447 int retval = 0;
2448 u32 sz, i;
2449 dma_addr_t phy_addr;
2450
2451 if (mrioc->init_cmds.reply)
2452 goto post_reply_sbuf;
2453
2454 mrioc->init_cmds.reply = kzalloc(mrioc->facts.reply_sz, GFP_KERNEL);
2455 if (!mrioc->init_cmds.reply)
2456 goto out_failed;
2457
2458 for (i = 0; i < MPI3MR_NUM_DEVRMCMD; i++) {
2459 mrioc->dev_rmhs_cmds[i].reply = kzalloc(mrioc->facts.reply_sz,
2460 GFP_KERNEL);
2461 if (!mrioc->dev_rmhs_cmds[i].reply)
2462 goto out_failed;
2463 }
2464
2465 mrioc->host_tm_cmds.reply = kzalloc(mrioc->facts.reply_sz, GFP_KERNEL);
2466 if (!mrioc->host_tm_cmds.reply)
2467 goto out_failed;
2468
2469 mrioc->dev_handle_bitmap_sz = mrioc->facts.max_devhandle / 8;
2470 if (mrioc->facts.max_devhandle % 8)
2471 mrioc->dev_handle_bitmap_sz++;
2472 mrioc->removepend_bitmap = kzalloc(mrioc->dev_handle_bitmap_sz,
2473 GFP_KERNEL);
2474 if (!mrioc->removepend_bitmap)
2475 goto out_failed;
2476
2477 mrioc->devrem_bitmap_sz = MPI3MR_NUM_DEVRMCMD / 8;
2478 if (MPI3MR_NUM_DEVRMCMD % 8)
2479 mrioc->devrem_bitmap_sz++;
2480 mrioc->devrem_bitmap = kzalloc(mrioc->devrem_bitmap_sz,
2481 GFP_KERNEL);
2482 if (!mrioc->devrem_bitmap)
2483 goto out_failed;
2484
2485 mrioc->num_reply_bufs = mrioc->facts.max_reqs + MPI3MR_NUM_EVT_REPLIES;
2486 mrioc->reply_free_qsz = mrioc->num_reply_bufs + 1;
2487 mrioc->num_sense_bufs = mrioc->facts.max_reqs / MPI3MR_SENSEBUF_FACTOR;
2488 mrioc->sense_buf_q_sz = mrioc->num_sense_bufs + 1;
2489
2490
2491 sz = mrioc->num_reply_bufs * mrioc->facts.reply_sz;
2492 mrioc->reply_buf_pool = dma_pool_create("reply_buf pool",
2493 &mrioc->pdev->dev, sz, 16, 0);
2494 if (!mrioc->reply_buf_pool) {
2495 ioc_err(mrioc, "reply buf pool: dma_pool_create failed\n");
2496 goto out_failed;
2497 }
2498
2499 mrioc->reply_buf = dma_pool_zalloc(mrioc->reply_buf_pool, GFP_KERNEL,
2500 &mrioc->reply_buf_dma);
2501 if (!mrioc->reply_buf)
2502 goto out_failed;
2503
2504 mrioc->reply_buf_dma_max_address = mrioc->reply_buf_dma + sz;
2505
2506
2507 sz = mrioc->reply_free_qsz * 8;
2508 mrioc->reply_free_q_pool = dma_pool_create("reply_free_q pool",
2509 &mrioc->pdev->dev, sz, 8, 0);
2510 if (!mrioc->reply_free_q_pool) {
2511 ioc_err(mrioc, "reply_free_q pool: dma_pool_create failed\n");
2512 goto out_failed;
2513 }
2514 mrioc->reply_free_q = dma_pool_zalloc(mrioc->reply_free_q_pool,
2515 GFP_KERNEL, &mrioc->reply_free_q_dma);
2516 if (!mrioc->reply_free_q)
2517 goto out_failed;
2518
2519
2520 sz = mrioc->num_sense_bufs * MPI3MR_SENSEBUF_SZ;
2521 mrioc->sense_buf_pool = dma_pool_create("sense_buf pool",
2522 &mrioc->pdev->dev, sz, 4, 0);
2523 if (!mrioc->sense_buf_pool) {
2524 ioc_err(mrioc, "sense_buf pool: dma_pool_create failed\n");
2525 goto out_failed;
2526 }
2527 mrioc->sense_buf = dma_pool_zalloc(mrioc->sense_buf_pool, GFP_KERNEL,
2528 &mrioc->sense_buf_dma);
2529 if (!mrioc->sense_buf)
2530 goto out_failed;
2531
2532
2533 sz = mrioc->sense_buf_q_sz * 8;
2534 mrioc->sense_buf_q_pool = dma_pool_create("sense_buf_q pool",
2535 &mrioc->pdev->dev, sz, 8, 0);
2536 if (!mrioc->sense_buf_q_pool) {
2537 ioc_err(mrioc, "sense_buf_q pool: dma_pool_create failed\n");
2538 goto out_failed;
2539 }
2540 mrioc->sense_buf_q = dma_pool_zalloc(mrioc->sense_buf_q_pool,
2541 GFP_KERNEL, &mrioc->sense_buf_q_dma);
2542 if (!mrioc->sense_buf_q)
2543 goto out_failed;
2544
2545post_reply_sbuf:
2546 sz = mrioc->num_reply_bufs * mrioc->facts.reply_sz;
2547 ioc_info(mrioc,
2548 "reply buf pool(0x%p): depth(%d), frame_size(%d), pool_size(%d kB), reply_dma(0x%llx)\n",
2549 mrioc->reply_buf, mrioc->num_reply_bufs, mrioc->facts.reply_sz,
2550 (sz / 1024), (unsigned long long)mrioc->reply_buf_dma);
2551 sz = mrioc->reply_free_qsz * 8;
2552 ioc_info(mrioc,
2553 "reply_free_q pool(0x%p): depth(%d), frame_size(%d), pool_size(%d kB), reply_dma(0x%llx)\n",
2554 mrioc->reply_free_q, mrioc->reply_free_qsz, 8, (sz / 1024),
2555 (unsigned long long)mrioc->reply_free_q_dma);
2556 sz = mrioc->num_sense_bufs * MPI3MR_SENSEBUF_SZ;
2557 ioc_info(mrioc,
2558 "sense_buf pool(0x%p): depth(%d), frame_size(%d), pool_size(%d kB), sense_dma(0x%llx)\n",
2559 mrioc->sense_buf, mrioc->num_sense_bufs, MPI3MR_SENSEBUF_SZ,
2560 (sz / 1024), (unsigned long long)mrioc->sense_buf_dma);
2561 sz = mrioc->sense_buf_q_sz * 8;
2562 ioc_info(mrioc,
2563 "sense_buf_q pool(0x%p): depth(%d), frame_size(%d), pool_size(%d kB), sense_dma(0x%llx)\n",
2564 mrioc->sense_buf_q, mrioc->sense_buf_q_sz, 8, (sz / 1024),
2565 (unsigned long long)mrioc->sense_buf_q_dma);
2566
2567
2568 for (i = 0, phy_addr = mrioc->reply_buf_dma;
2569 i < mrioc->num_reply_bufs; i++, phy_addr += mrioc->facts.reply_sz)
2570 mrioc->reply_free_q[i] = cpu_to_le64(phy_addr);
2571 mrioc->reply_free_q[i] = cpu_to_le64(0);
2572
2573
2574 for (i = 0, phy_addr = mrioc->sense_buf_dma;
2575 i < mrioc->num_sense_bufs; i++, phy_addr += MPI3MR_SENSEBUF_SZ)
2576 mrioc->sense_buf_q[i] = cpu_to_le64(phy_addr);
2577 mrioc->sense_buf_q[i] = cpu_to_le64(0);
2578 return retval;
2579
2580out_failed:
2581 retval = -1;
2582 return retval;
2583}
2584
2585
2586
2587
2588
2589
2590
2591
2592
2593
2594static int mpi3mr_issue_iocinit(struct mpi3mr_ioc *mrioc)
2595{
2596 struct mpi3_ioc_init_request iocinit_req;
2597 struct mpi3_driver_info_layout *drv_info;
2598 dma_addr_t data_dma;
2599 u32 data_len = sizeof(*drv_info);
2600 int retval = 0;
2601 ktime_t current_time;
2602
2603 drv_info = dma_alloc_coherent(&mrioc->pdev->dev, data_len, &data_dma,
2604 GFP_KERNEL);
2605 if (!drv_info) {
2606 retval = -1;
2607 goto out;
2608 }
2609 drv_info->information_length = cpu_to_le32(data_len);
2610 strscpy(drv_info->driver_signature, "Broadcom", sizeof(drv_info->driver_signature));
2611 strscpy(drv_info->os_name, utsname()->sysname, sizeof(drv_info->os_name));
2612 strscpy(drv_info->os_version, utsname()->release, sizeof(drv_info->os_version));
2613 strscpy(drv_info->driver_name, MPI3MR_DRIVER_NAME, sizeof(drv_info->driver_name));
2614 strscpy(drv_info->driver_version, MPI3MR_DRIVER_VERSION, sizeof(drv_info->driver_version));
2615 strscpy(drv_info->driver_release_date, MPI3MR_DRIVER_RELDATE,
2616 sizeof(drv_info->driver_release_date));
2617 drv_info->driver_capabilities = 0;
2618 memcpy((u8 *)&mrioc->driver_info, (u8 *)drv_info,
2619 sizeof(mrioc->driver_info));
2620
2621 memset(&iocinit_req, 0, sizeof(iocinit_req));
2622 mutex_lock(&mrioc->init_cmds.mutex);
2623 if (mrioc->init_cmds.state & MPI3MR_CMD_PENDING) {
2624 retval = -1;
2625 ioc_err(mrioc, "Issue IOCInit: Init command is in use\n");
2626 mutex_unlock(&mrioc->init_cmds.mutex);
2627 goto out;
2628 }
2629 mrioc->init_cmds.state = MPI3MR_CMD_PENDING;
2630 mrioc->init_cmds.is_waiting = 1;
2631 mrioc->init_cmds.callback = NULL;
2632 iocinit_req.host_tag = cpu_to_le16(MPI3MR_HOSTTAG_INITCMDS);
2633 iocinit_req.function = MPI3_FUNCTION_IOC_INIT;
2634 iocinit_req.mpi_version.mpi3_version.dev = MPI3_VERSION_DEV;
2635 iocinit_req.mpi_version.mpi3_version.unit = MPI3_VERSION_UNIT;
2636 iocinit_req.mpi_version.mpi3_version.major = MPI3_VERSION_MAJOR;
2637 iocinit_req.mpi_version.mpi3_version.minor = MPI3_VERSION_MINOR;
2638 iocinit_req.who_init = MPI3_WHOINIT_HOST_DRIVER;
2639 iocinit_req.reply_free_queue_depth = cpu_to_le16(mrioc->reply_free_qsz);
2640 iocinit_req.reply_free_queue_address =
2641 cpu_to_le64(mrioc->reply_free_q_dma);
2642 iocinit_req.sense_buffer_length = cpu_to_le16(MPI3MR_SENSEBUF_SZ);
2643 iocinit_req.sense_buffer_free_queue_depth =
2644 cpu_to_le16(mrioc->sense_buf_q_sz);
2645 iocinit_req.sense_buffer_free_queue_address =
2646 cpu_to_le64(mrioc->sense_buf_q_dma);
2647 iocinit_req.driver_information_address = cpu_to_le64(data_dma);
2648
2649 current_time = ktime_get_real();
2650 iocinit_req.time_stamp = cpu_to_le64(ktime_to_ms(current_time));
2651
2652 init_completion(&mrioc->init_cmds.done);
2653 retval = mpi3mr_admin_request_post(mrioc, &iocinit_req,
2654 sizeof(iocinit_req), 1);
2655 if (retval) {
2656 ioc_err(mrioc, "Issue IOCInit: Admin Post failed\n");
2657 goto out_unlock;
2658 }
2659 wait_for_completion_timeout(&mrioc->init_cmds.done,
2660 (MPI3MR_INTADMCMD_TIMEOUT * HZ));
2661 if (!(mrioc->init_cmds.state & MPI3MR_CMD_COMPLETE)) {
2662 mpi3mr_set_diagsave(mrioc);
2663 mpi3mr_issue_reset(mrioc,
2664 MPI3_SYSIF_HOST_DIAG_RESET_ACTION_DIAG_FAULT,
2665 MPI3MR_RESET_FROM_IOCINIT_TIMEOUT);
2666 mrioc->unrecoverable = 1;
2667 ioc_err(mrioc, "Issue IOCInit: command timed out\n");
2668 retval = -1;
2669 goto out_unlock;
2670 }
2671 if ((mrioc->init_cmds.ioc_status & MPI3_IOCSTATUS_STATUS_MASK)
2672 != MPI3_IOCSTATUS_SUCCESS) {
2673 ioc_err(mrioc,
2674 "Issue IOCInit: Failed ioc_status(0x%04x) Loginfo(0x%08x)\n",
2675 (mrioc->init_cmds.ioc_status & MPI3_IOCSTATUS_STATUS_MASK),
2676 mrioc->init_cmds.ioc_loginfo);
2677 retval = -1;
2678 goto out_unlock;
2679 }
2680
2681out_unlock:
2682 mrioc->init_cmds.state = MPI3MR_CMD_NOTUSED;
2683 mutex_unlock(&mrioc->init_cmds.mutex);
2684
2685out:
2686 if (drv_info)
2687 dma_free_coherent(&mrioc->pdev->dev, data_len, drv_info,
2688 data_dma);
2689
2690 return retval;
2691}
2692
2693
2694
2695
2696
2697
2698
2699
2700
2701
2702
2703static void mpi3mr_unmask_events(struct mpi3mr_ioc *mrioc, u16 event)
2704{
2705 u32 desired_event;
2706 u8 word;
2707
2708 if (event >= 128)
2709 return;
2710
2711 desired_event = (1 << (event % 32));
2712 word = event / 32;
2713
2714 mrioc->event_masks[word] &= ~desired_event;
2715}
2716
2717
2718
2719
2720
2721
2722
2723
2724
2725
2726static int mpi3mr_issue_event_notification(struct mpi3mr_ioc *mrioc)
2727{
2728 struct mpi3_event_notification_request evtnotify_req;
2729 int retval = 0;
2730 u8 i;
2731
2732 memset(&evtnotify_req, 0, sizeof(evtnotify_req));
2733 mutex_lock(&mrioc->init_cmds.mutex);
2734 if (mrioc->init_cmds.state & MPI3MR_CMD_PENDING) {
2735 retval = -1;
2736 ioc_err(mrioc, "Issue EvtNotify: Init command is in use\n");
2737 mutex_unlock(&mrioc->init_cmds.mutex);
2738 goto out;
2739 }
2740 mrioc->init_cmds.state = MPI3MR_CMD_PENDING;
2741 mrioc->init_cmds.is_waiting = 1;
2742 mrioc->init_cmds.callback = NULL;
2743 evtnotify_req.host_tag = cpu_to_le16(MPI3MR_HOSTTAG_INITCMDS);
2744 evtnotify_req.function = MPI3_FUNCTION_EVENT_NOTIFICATION;
2745 for (i = 0; i < MPI3_EVENT_NOTIFY_EVENTMASK_WORDS; i++)
2746 evtnotify_req.event_masks[i] =
2747 cpu_to_le32(mrioc->event_masks[i]);
2748 init_completion(&mrioc->init_cmds.done);
2749 retval = mpi3mr_admin_request_post(mrioc, &evtnotify_req,
2750 sizeof(evtnotify_req), 1);
2751 if (retval) {
2752 ioc_err(mrioc, "Issue EvtNotify: Admin Post failed\n");
2753 goto out_unlock;
2754 }
2755 wait_for_completion_timeout(&mrioc->init_cmds.done,
2756 (MPI3MR_INTADMCMD_TIMEOUT * HZ));
2757 if (!(mrioc->init_cmds.state & MPI3MR_CMD_COMPLETE)) {
2758 ioc_err(mrioc, "Issue EvtNotify: command timed out\n");
2759 mpi3mr_set_diagsave(mrioc);
2760 mpi3mr_issue_reset(mrioc,
2761 MPI3_SYSIF_HOST_DIAG_RESET_ACTION_DIAG_FAULT,
2762 MPI3MR_RESET_FROM_EVTNOTIFY_TIMEOUT);
2763 mrioc->unrecoverable = 1;
2764 retval = -1;
2765 goto out_unlock;
2766 }
2767 if ((mrioc->init_cmds.ioc_status & MPI3_IOCSTATUS_STATUS_MASK)
2768 != MPI3_IOCSTATUS_SUCCESS) {
2769 ioc_err(mrioc,
2770 "Issue EvtNotify: Failed ioc_status(0x%04x) Loginfo(0x%08x)\n",
2771 (mrioc->init_cmds.ioc_status & MPI3_IOCSTATUS_STATUS_MASK),
2772 mrioc->init_cmds.ioc_loginfo);
2773 retval = -1;
2774 goto out_unlock;
2775 }
2776
2777out_unlock:
2778 mrioc->init_cmds.state = MPI3MR_CMD_NOTUSED;
2779 mutex_unlock(&mrioc->init_cmds.mutex);
2780out:
2781 return retval;
2782}
2783
2784
2785
2786
2787
2788
2789
2790
2791
2792
2793
2794
2795int mpi3mr_send_event_ack(struct mpi3mr_ioc *mrioc, u8 event,
2796 u32 event_ctx)
2797{
2798 struct mpi3_event_ack_request evtack_req;
2799 int retval = 0;
2800
2801 memset(&evtack_req, 0, sizeof(evtack_req));
2802 mutex_lock(&mrioc->init_cmds.mutex);
2803 if (mrioc->init_cmds.state & MPI3MR_CMD_PENDING) {
2804 retval = -1;
2805 ioc_err(mrioc, "Send EvtAck: Init command is in use\n");
2806 mutex_unlock(&mrioc->init_cmds.mutex);
2807 goto out;
2808 }
2809 mrioc->init_cmds.state = MPI3MR_CMD_PENDING;
2810 mrioc->init_cmds.is_waiting = 1;
2811 mrioc->init_cmds.callback = NULL;
2812 evtack_req.host_tag = cpu_to_le16(MPI3MR_HOSTTAG_INITCMDS);
2813 evtack_req.function = MPI3_FUNCTION_EVENT_ACK;
2814 evtack_req.event = event;
2815 evtack_req.event_context = cpu_to_le32(event_ctx);
2816
2817 init_completion(&mrioc->init_cmds.done);
2818 retval = mpi3mr_admin_request_post(mrioc, &evtack_req,
2819 sizeof(evtack_req), 1);
2820 if (retval) {
2821 ioc_err(mrioc, "Send EvtAck: Admin Post failed\n");
2822 goto out_unlock;
2823 }
2824 wait_for_completion_timeout(&mrioc->init_cmds.done,
2825 (MPI3MR_INTADMCMD_TIMEOUT * HZ));
2826 if (!(mrioc->init_cmds.state & MPI3MR_CMD_COMPLETE)) {
2827 ioc_err(mrioc, "Issue EvtNotify: command timed out\n");
2828 mpi3mr_soft_reset_handler(mrioc,
2829 MPI3MR_RESET_FROM_EVTACK_TIMEOUT, 1);
2830 retval = -1;
2831 goto out_unlock;
2832 }
2833 if ((mrioc->init_cmds.ioc_status & MPI3_IOCSTATUS_STATUS_MASK)
2834 != MPI3_IOCSTATUS_SUCCESS) {
2835 ioc_err(mrioc,
2836 "Send EvtAck: Failed ioc_status(0x%04x) Loginfo(0x%08x)\n",
2837 (mrioc->init_cmds.ioc_status & MPI3_IOCSTATUS_STATUS_MASK),
2838 mrioc->init_cmds.ioc_loginfo);
2839 retval = -1;
2840 goto out_unlock;
2841 }
2842
2843out_unlock:
2844 mrioc->init_cmds.state = MPI3MR_CMD_NOTUSED;
2845 mutex_unlock(&mrioc->init_cmds.mutex);
2846out:
2847 return retval;
2848}
2849
2850
2851
2852
2853
2854
2855
2856
2857
2858
2859
2860static int mpi3mr_alloc_chain_bufs(struct mpi3mr_ioc *mrioc)
2861{
2862 int retval = 0;
2863 u32 sz, i;
2864 u16 num_chains;
2865
2866 num_chains = mrioc->max_host_ios / MPI3MR_CHAINBUF_FACTOR;
2867
2868 if (prot_mask & (SHOST_DIX_TYPE0_PROTECTION
2869 | SHOST_DIX_TYPE1_PROTECTION
2870 | SHOST_DIX_TYPE2_PROTECTION
2871 | SHOST_DIX_TYPE3_PROTECTION))
2872 num_chains += (num_chains / MPI3MR_CHAINBUFDIX_FACTOR);
2873
2874 mrioc->chain_buf_count = num_chains;
2875 sz = sizeof(struct chain_element) * num_chains;
2876 mrioc->chain_sgl_list = kzalloc(sz, GFP_KERNEL);
2877 if (!mrioc->chain_sgl_list)
2878 goto out_failed;
2879
2880 sz = MPI3MR_PAGE_SIZE_4K;
2881 mrioc->chain_buf_pool = dma_pool_create("chain_buf pool",
2882 &mrioc->pdev->dev, sz, 16, 0);
2883 if (!mrioc->chain_buf_pool) {
2884 ioc_err(mrioc, "chain buf pool: dma_pool_create failed\n");
2885 goto out_failed;
2886 }
2887
2888 for (i = 0; i < num_chains; i++) {
2889 mrioc->chain_sgl_list[i].addr =
2890 dma_pool_zalloc(mrioc->chain_buf_pool, GFP_KERNEL,
2891 &mrioc->chain_sgl_list[i].dma_addr);
2892
2893 if (!mrioc->chain_sgl_list[i].addr)
2894 goto out_failed;
2895 }
2896 mrioc->chain_bitmap_sz = num_chains / 8;
2897 if (num_chains % 8)
2898 mrioc->chain_bitmap_sz++;
2899 mrioc->chain_bitmap = kzalloc(mrioc->chain_bitmap_sz, GFP_KERNEL);
2900 if (!mrioc->chain_bitmap)
2901 goto out_failed;
2902 return retval;
2903out_failed:
2904 retval = -1;
2905 return retval;
2906}
2907
2908
2909
2910
2911
2912
2913
2914
2915
2916
2917
2918static void mpi3mr_port_enable_complete(struct mpi3mr_ioc *mrioc,
2919 struct mpi3mr_drv_cmd *drv_cmd)
2920{
2921 drv_cmd->state = MPI3MR_CMD_NOTUSED;
2922 drv_cmd->callback = NULL;
2923 mrioc->scan_failed = drv_cmd->ioc_status;
2924 mrioc->scan_started = 0;
2925}
2926
2927
2928
2929
2930
2931
2932
2933
2934
2935
2936
2937
2938int mpi3mr_issue_port_enable(struct mpi3mr_ioc *mrioc, u8 async)
2939{
2940 struct mpi3_port_enable_request pe_req;
2941 int retval = 0;
2942 u32 pe_timeout = MPI3MR_PORTENABLE_TIMEOUT;
2943
2944 memset(&pe_req, 0, sizeof(pe_req));
2945 mutex_lock(&mrioc->init_cmds.mutex);
2946 if (mrioc->init_cmds.state & MPI3MR_CMD_PENDING) {
2947 retval = -1;
2948 ioc_err(mrioc, "Issue PortEnable: Init command is in use\n");
2949 mutex_unlock(&mrioc->init_cmds.mutex);
2950 goto out;
2951 }
2952 mrioc->init_cmds.state = MPI3MR_CMD_PENDING;
2953 if (async) {
2954 mrioc->init_cmds.is_waiting = 0;
2955 mrioc->init_cmds.callback = mpi3mr_port_enable_complete;
2956 } else {
2957 mrioc->init_cmds.is_waiting = 1;
2958 mrioc->init_cmds.callback = NULL;
2959 init_completion(&mrioc->init_cmds.done);
2960 }
2961 pe_req.host_tag = cpu_to_le16(MPI3MR_HOSTTAG_INITCMDS);
2962 pe_req.function = MPI3_FUNCTION_PORT_ENABLE;
2963
2964 retval = mpi3mr_admin_request_post(mrioc, &pe_req, sizeof(pe_req), 1);
2965 if (retval) {
2966 ioc_err(mrioc, "Issue PortEnable: Admin Post failed\n");
2967 goto out_unlock;
2968 }
2969 if (!async) {
2970 wait_for_completion_timeout(&mrioc->init_cmds.done,
2971 (pe_timeout * HZ));
2972 if (!(mrioc->init_cmds.state & MPI3MR_CMD_COMPLETE)) {
2973 ioc_err(mrioc, "Issue PortEnable: command timed out\n");
2974 retval = -1;
2975 mrioc->scan_failed = MPI3_IOCSTATUS_INTERNAL_ERROR;
2976 mpi3mr_set_diagsave(mrioc);
2977 mpi3mr_issue_reset(mrioc,
2978 MPI3_SYSIF_HOST_DIAG_RESET_ACTION_DIAG_FAULT,
2979 MPI3MR_RESET_FROM_PE_TIMEOUT);
2980 mrioc->unrecoverable = 1;
2981 goto out_unlock;
2982 }
2983 mpi3mr_port_enable_complete(mrioc, &mrioc->init_cmds);
2984 }
2985out_unlock:
2986 mutex_unlock(&mrioc->init_cmds.mutex);
2987out:
2988 return retval;
2989}
2990
2991
2992static const struct {
2993 u8 protocol;
2994 char *name;
2995} mpi3mr_protocols[] = {
2996 { MPI3_IOCFACTS_PROTOCOL_SCSI_INITIATOR, "Initiator" },
2997 { MPI3_IOCFACTS_PROTOCOL_SCSI_TARGET, "Target" },
2998 { MPI3_IOCFACTS_PROTOCOL_NVME, "NVMe attachment" },
2999};
3000
3001
3002static const struct {
3003 u32 capability;
3004 char *name;
3005} mpi3mr_capabilities[] = {
3006 { MPI3_IOCFACTS_CAPABILITY_RAID_CAPABLE, "RAID" },
3007};
3008
3009
3010
3011
3012
3013
3014
3015
3016
3017
3018static void
3019mpi3mr_print_ioc_info(struct mpi3mr_ioc *mrioc)
3020{
3021 int i = 0, bytes_wrote = 0;
3022 char personality[16];
3023 char protocol[50] = {0};
3024 char capabilities[100] = {0};
3025 bool is_string_nonempty = false;
3026 struct mpi3mr_compimg_ver *fwver = &mrioc->facts.fw_ver;
3027
3028 switch (mrioc->facts.personality) {
3029 case MPI3_IOCFACTS_FLAGS_PERSONALITY_EHBA:
3030 strncpy(personality, "Enhanced HBA", sizeof(personality));
3031 break;
3032 case MPI3_IOCFACTS_FLAGS_PERSONALITY_RAID_DDR:
3033 strncpy(personality, "RAID", sizeof(personality));
3034 break;
3035 default:
3036 strncpy(personality, "Unknown", sizeof(personality));
3037 break;
3038 }
3039
3040 ioc_info(mrioc, "Running in %s Personality", personality);
3041
3042 ioc_info(mrioc, "FW version(%d.%d.%d.%d.%d.%d)\n",
3043 fwver->gen_major, fwver->gen_minor, fwver->ph_major,
3044 fwver->ph_minor, fwver->cust_id, fwver->build_num);
3045
3046 for (i = 0; i < ARRAY_SIZE(mpi3mr_protocols); i++) {
3047 if (mrioc->facts.protocol_flags &
3048 mpi3mr_protocols[i].protocol) {
3049 if (is_string_nonempty &&
3050 (bytes_wrote < sizeof(protocol)))
3051 bytes_wrote += snprintf(protocol + bytes_wrote,
3052 (sizeof(protocol) - bytes_wrote), ",");
3053
3054 if (bytes_wrote < sizeof(protocol))
3055 bytes_wrote += snprintf(protocol + bytes_wrote,
3056 (sizeof(protocol) - bytes_wrote), "%s",
3057 mpi3mr_protocols[i].name);
3058 is_string_nonempty = true;
3059 }
3060 }
3061
3062 bytes_wrote = 0;
3063 is_string_nonempty = false;
3064 for (i = 0; i < ARRAY_SIZE(mpi3mr_capabilities); i++) {
3065 if (mrioc->facts.protocol_flags &
3066 mpi3mr_capabilities[i].capability) {
3067 if (is_string_nonempty &&
3068 (bytes_wrote < sizeof(capabilities)))
3069 bytes_wrote += snprintf(capabilities + bytes_wrote,
3070 (sizeof(capabilities) - bytes_wrote), ",");
3071
3072 if (bytes_wrote < sizeof(capabilities))
3073 bytes_wrote += snprintf(capabilities + bytes_wrote,
3074 (sizeof(capabilities) - bytes_wrote), "%s",
3075 mpi3mr_capabilities[i].name);
3076 is_string_nonempty = true;
3077 }
3078 }
3079
3080 ioc_info(mrioc, "Protocol=(%s), Capabilities=(%s)\n",
3081 protocol, capabilities);
3082}
3083
3084
3085
3086
3087
3088
3089
3090
3091
3092void mpi3mr_cleanup_resources(struct mpi3mr_ioc *mrioc)
3093{
3094 struct pci_dev *pdev = mrioc->pdev;
3095
3096 mpi3mr_cleanup_isr(mrioc);
3097
3098 if (mrioc->sysif_regs) {
3099 iounmap((void __iomem *)mrioc->sysif_regs);
3100 mrioc->sysif_regs = NULL;
3101 }
3102
3103 if (pci_is_enabled(pdev)) {
3104 if (mrioc->bars)
3105 pci_release_selected_regions(pdev, mrioc->bars);
3106 pci_disable_device(pdev);
3107 }
3108}
3109
3110
3111
3112
3113
3114
3115
3116
3117
3118int mpi3mr_setup_resources(struct mpi3mr_ioc *mrioc)
3119{
3120 struct pci_dev *pdev = mrioc->pdev;
3121 u32 memap_sz = 0;
3122 int i, retval = 0, capb = 0;
3123 u16 message_control;
3124 u64 dma_mask = mrioc->dma_mask ? mrioc->dma_mask :
3125 (((dma_get_required_mask(&pdev->dev) > DMA_BIT_MASK(32)) &&
3126 (sizeof(dma_addr_t) > 4)) ? DMA_BIT_MASK(64) : DMA_BIT_MASK(32));
3127
3128 if (pci_enable_device_mem(pdev)) {
3129 ioc_err(mrioc, "pci_enable_device_mem: failed\n");
3130 retval = -ENODEV;
3131 goto out_failed;
3132 }
3133
3134 capb = pci_find_capability(pdev, PCI_CAP_ID_MSIX);
3135 if (!capb) {
3136 ioc_err(mrioc, "Unable to find MSI-X Capabilities\n");
3137 retval = -ENODEV;
3138 goto out_failed;
3139 }
3140 mrioc->bars = pci_select_bars(pdev, IORESOURCE_MEM);
3141
3142 if (pci_request_selected_regions(pdev, mrioc->bars,
3143 mrioc->driver_name)) {
3144 ioc_err(mrioc, "pci_request_selected_regions: failed\n");
3145 retval = -ENODEV;
3146 goto out_failed;
3147 }
3148
3149 for (i = 0; (i < DEVICE_COUNT_RESOURCE); i++) {
3150 if (pci_resource_flags(pdev, i) & IORESOURCE_MEM) {
3151 mrioc->sysif_regs_phys = pci_resource_start(pdev, i);
3152 memap_sz = pci_resource_len(pdev, i);
3153 mrioc->sysif_regs =
3154 ioremap(mrioc->sysif_regs_phys, memap_sz);
3155 break;
3156 }
3157 }
3158
3159 pci_set_master(pdev);
3160
3161 retval = dma_set_mask_and_coherent(&pdev->dev, dma_mask);
3162 if (retval) {
3163 if (dma_mask != DMA_BIT_MASK(32)) {
3164 ioc_warn(mrioc, "Setting 64 bit DMA mask failed\n");
3165 dma_mask = DMA_BIT_MASK(32);
3166 retval = dma_set_mask_and_coherent(&pdev->dev,
3167 dma_mask);
3168 }
3169 if (retval) {
3170 mrioc->dma_mask = 0;
3171 ioc_err(mrioc, "Setting 32 bit DMA mask also failed\n");
3172 goto out_failed;
3173 }
3174 }
3175 mrioc->dma_mask = dma_mask;
3176
3177 if (!mrioc->sysif_regs) {
3178 ioc_err(mrioc,
3179 "Unable to map adapter memory or resource not found\n");
3180 retval = -EINVAL;
3181 goto out_failed;
3182 }
3183
3184 pci_read_config_word(pdev, capb + 2, &message_control);
3185 mrioc->msix_count = (message_control & 0x3FF) + 1;
3186
3187 pci_save_state(pdev);
3188
3189 pci_set_drvdata(pdev, mrioc->shost);
3190
3191 mpi3mr_ioc_disable_intr(mrioc);
3192
3193 ioc_info(mrioc, "iomem(0x%016llx), mapped(0x%p), size(%d)\n",
3194 (unsigned long long)mrioc->sysif_regs_phys,
3195 mrioc->sysif_regs, memap_sz);
3196 ioc_info(mrioc, "Number of MSI-X vectors found in capabilities: (%d)\n",
3197 mrioc->msix_count);
3198 return retval;
3199
3200out_failed:
3201 mpi3mr_cleanup_resources(mrioc);
3202 return retval;
3203}
3204
3205
3206
3207
3208
3209
3210
3211
3212
3213
3214
3215
3216
3217
3218
3219
3220
3221int mpi3mr_init_ioc(struct mpi3mr_ioc *mrioc, u8 init_type)
3222{
3223 int retval = 0;
3224 enum mpi3mr_iocstate ioc_state;
3225 u64 base_info;
3226 u32 timeout;
3227 u32 ioc_status, ioc_config, i;
3228 struct mpi3_ioc_facts_data facts_data;
3229
3230 mrioc->irqpoll_sleep = MPI3MR_IRQ_POLL_SLEEP;
3231 mrioc->change_count = 0;
3232 if (init_type == MPI3MR_IT_INIT) {
3233 mrioc->cpu_count = num_online_cpus();
3234 retval = mpi3mr_setup_resources(mrioc);
3235 if (retval) {
3236 ioc_err(mrioc, "Failed to setup resources:error %d\n",
3237 retval);
3238 goto out_nocleanup;
3239 }
3240 }
3241
3242 ioc_status = readl(&mrioc->sysif_regs->ioc_status);
3243 ioc_config = readl(&mrioc->sysif_regs->ioc_configuration);
3244
3245 ioc_info(mrioc, "SOD status %x configuration %x\n",
3246 ioc_status, ioc_config);
3247
3248 base_info = lo_hi_readq(&mrioc->sysif_regs->ioc_information);
3249 ioc_info(mrioc, "SOD base_info %llx\n", base_info);
3250
3251
3252 mrioc->ready_timeout =
3253 ((base_info & MPI3_SYSIF_IOC_INFO_LOW_TIMEOUT_MASK) >>
3254 MPI3_SYSIF_IOC_INFO_LOW_TIMEOUT_SHIFT) * 2;
3255
3256 ioc_info(mrioc, "IOC ready timeout %d\n", mrioc->ready_timeout);
3257
3258 ioc_state = mpi3mr_get_iocstate(mrioc);
3259 ioc_info(mrioc, "IOC in %s state during detection\n",
3260 mpi3mr_iocstate_name(ioc_state));
3261
3262 if (ioc_state == MRIOC_STATE_BECOMING_READY ||
3263 ioc_state == MRIOC_STATE_RESET_REQUESTED) {
3264 timeout = mrioc->ready_timeout * 10;
3265 do {
3266 msleep(100);
3267 } while (--timeout);
3268
3269 ioc_state = mpi3mr_get_iocstate(mrioc);
3270 ioc_info(mrioc,
3271 "IOC in %s state after waiting for reset time\n",
3272 mpi3mr_iocstate_name(ioc_state));
3273 }
3274
3275 if (ioc_state == MRIOC_STATE_READY) {
3276 retval = mpi3mr_issue_and_process_mur(mrioc,
3277 MPI3MR_RESET_FROM_BRINGUP);
3278 if (retval) {
3279 ioc_err(mrioc, "Failed to MU reset IOC error %d\n",
3280 retval);
3281 }
3282 ioc_state = mpi3mr_get_iocstate(mrioc);
3283 }
3284 if (ioc_state != MRIOC_STATE_RESET) {
3285 mpi3mr_print_fault_info(mrioc);
3286 retval = mpi3mr_issue_reset(mrioc,
3287 MPI3_SYSIF_HOST_DIAG_RESET_ACTION_SOFT_RESET,
3288 MPI3MR_RESET_FROM_BRINGUP);
3289 if (retval) {
3290 ioc_err(mrioc,
3291 "%s :Failed to soft reset IOC error %d\n",
3292 __func__, retval);
3293 goto out_failed;
3294 }
3295 }
3296 ioc_state = mpi3mr_get_iocstate(mrioc);
3297 if (ioc_state != MRIOC_STATE_RESET) {
3298 retval = -1;
3299 ioc_err(mrioc, "Cannot bring IOC to reset state\n");
3300 goto out_failed;
3301 }
3302
3303 retval = mpi3mr_setup_admin_qpair(mrioc);
3304 if (retval) {
3305 ioc_err(mrioc, "Failed to setup admin Qs: error %d\n",
3306 retval);
3307 goto out_failed;
3308 }
3309
3310 retval = mpi3mr_bring_ioc_ready(mrioc);
3311 if (retval) {
3312 ioc_err(mrioc, "Failed to bring ioc ready: error %d\n",
3313 retval);
3314 goto out_failed;
3315 }
3316
3317 if (init_type != MPI3MR_IT_RESET) {
3318 retval = mpi3mr_setup_isr(mrioc, 1);
3319 if (retval) {
3320 ioc_err(mrioc, "Failed to setup ISR error %d\n",
3321 retval);
3322 goto out_failed;
3323 }
3324 } else
3325 mpi3mr_ioc_enable_intr(mrioc);
3326
3327 retval = mpi3mr_issue_iocfacts(mrioc, &facts_data);
3328 if (retval) {
3329 ioc_err(mrioc, "Failed to Issue IOC Facts %d\n",
3330 retval);
3331 goto out_failed;
3332 }
3333
3334 mpi3mr_process_factsdata(mrioc, &facts_data);
3335 if (init_type == MPI3MR_IT_INIT) {
3336 retval = mpi3mr_check_reset_dma_mask(mrioc);
3337 if (retval) {
3338 ioc_err(mrioc, "Resetting dma mask failed %d\n",
3339 retval);
3340 goto out_failed;
3341 }
3342 }
3343
3344 mpi3mr_print_ioc_info(mrioc);
3345
3346 retval = mpi3mr_alloc_reply_sense_bufs(mrioc);
3347 if (retval) {
3348 ioc_err(mrioc,
3349 "%s :Failed to allocated reply sense buffers %d\n",
3350 __func__, retval);
3351 goto out_failed;
3352 }
3353
3354 if (init_type == MPI3MR_IT_INIT) {
3355 retval = mpi3mr_alloc_chain_bufs(mrioc);
3356 if (retval) {
3357 ioc_err(mrioc, "Failed to allocated chain buffers %d\n",
3358 retval);
3359 goto out_failed;
3360 }
3361 }
3362
3363 retval = mpi3mr_issue_iocinit(mrioc);
3364 if (retval) {
3365 ioc_err(mrioc, "Failed to Issue IOC Init %d\n",
3366 retval);
3367 goto out_failed;
3368 }
3369 mrioc->reply_free_queue_host_index = mrioc->num_reply_bufs;
3370 writel(mrioc->reply_free_queue_host_index,
3371 &mrioc->sysif_regs->reply_free_host_index);
3372
3373 mrioc->sbq_host_index = mrioc->num_sense_bufs;
3374 writel(mrioc->sbq_host_index,
3375 &mrioc->sysif_regs->sense_buffer_free_host_index);
3376
3377 if (init_type != MPI3MR_IT_RESET) {
3378 retval = mpi3mr_setup_isr(mrioc, 0);
3379 if (retval) {
3380 ioc_err(mrioc, "Failed to re-setup ISR, error %d\n",
3381 retval);
3382 goto out_failed;
3383 }
3384 }
3385
3386 retval = mpi3mr_create_op_queues(mrioc);
3387 if (retval) {
3388 ioc_err(mrioc, "Failed to create OpQueues error %d\n",
3389 retval);
3390 goto out_failed;
3391 }
3392
3393 if ((init_type != MPI3MR_IT_INIT) &&
3394 (mrioc->shost->nr_hw_queues > mrioc->num_op_reply_q)) {
3395 retval = -1;
3396 ioc_err(mrioc,
3397 "Cannot create minimum number of OpQueues expected:%d created:%d\n",
3398 mrioc->shost->nr_hw_queues, mrioc->num_op_reply_q);
3399 goto out_failed;
3400 }
3401
3402 for (i = 0; i < MPI3_EVENT_NOTIFY_EVENTMASK_WORDS; i++)
3403 mrioc->event_masks[i] = -1;
3404
3405 mpi3mr_unmask_events(mrioc, MPI3_EVENT_DEVICE_ADDED);
3406 mpi3mr_unmask_events(mrioc, MPI3_EVENT_DEVICE_INFO_CHANGED);
3407 mpi3mr_unmask_events(mrioc, MPI3_EVENT_DEVICE_STATUS_CHANGE);
3408 mpi3mr_unmask_events(mrioc, MPI3_EVENT_ENCL_DEVICE_STATUS_CHANGE);
3409 mpi3mr_unmask_events(mrioc, MPI3_EVENT_SAS_TOPOLOGY_CHANGE_LIST);
3410 mpi3mr_unmask_events(mrioc, MPI3_EVENT_SAS_DISCOVERY);
3411 mpi3mr_unmask_events(mrioc, MPI3_EVENT_SAS_DEVICE_DISCOVERY_ERROR);
3412 mpi3mr_unmask_events(mrioc, MPI3_EVENT_SAS_BROADCAST_PRIMITIVE);
3413 mpi3mr_unmask_events(mrioc, MPI3_EVENT_PCIE_TOPOLOGY_CHANGE_LIST);
3414 mpi3mr_unmask_events(mrioc, MPI3_EVENT_PCIE_ENUMERATION);
3415 mpi3mr_unmask_events(mrioc, MPI3_EVENT_CABLE_MGMT);
3416 mpi3mr_unmask_events(mrioc, MPI3_EVENT_ENERGY_PACK_CHANGE);
3417
3418 retval = mpi3mr_issue_event_notification(mrioc);
3419 if (retval) {
3420 ioc_err(mrioc, "Failed to issue event notification %d\n",
3421 retval);
3422 goto out_failed;
3423 }
3424
3425 if (init_type != MPI3MR_IT_INIT) {
3426 ioc_info(mrioc, "Issuing Port Enable\n");
3427 retval = mpi3mr_issue_port_enable(mrioc, 0);
3428 if (retval) {
3429 ioc_err(mrioc, "Failed to issue port enable %d\n",
3430 retval);
3431 goto out_failed;
3432 }
3433 }
3434 return retval;
3435
3436out_failed:
3437 if (init_type == MPI3MR_IT_INIT)
3438 mpi3mr_cleanup_ioc(mrioc, MPI3MR_COMPLETE_CLEANUP);
3439 else
3440 mpi3mr_cleanup_ioc(mrioc, MPI3MR_REINIT_FAILURE);
3441out_nocleanup:
3442 return retval;
3443}
3444
3445
3446
3447
3448
3449
3450
3451
3452
3453static void mpi3mr_memset_op_reply_q_buffers(struct mpi3mr_ioc *mrioc, u16 qidx)
3454{
3455 struct op_reply_qinfo *op_reply_q = mrioc->op_reply_qinfo + qidx;
3456 struct segments *segments;
3457 int i, size;
3458
3459 if (!op_reply_q->q_segments)
3460 return;
3461
3462 size = op_reply_q->segment_qd * mrioc->op_reply_desc_sz;
3463 segments = op_reply_q->q_segments;
3464 for (i = 0; i < op_reply_q->num_segments; i++)
3465 memset(segments[i].segment, 0, size);
3466}
3467
3468
3469
3470
3471
3472
3473
3474
3475
3476static void mpi3mr_memset_op_req_q_buffers(struct mpi3mr_ioc *mrioc, u16 qidx)
3477{
3478 struct op_req_qinfo *op_req_q = mrioc->req_qinfo + qidx;
3479 struct segments *segments;
3480 int i, size;
3481
3482 if (!op_req_q->q_segments)
3483 return;
3484
3485 size = op_req_q->segment_qd * mrioc->facts.op_req_sz;
3486 segments = op_req_q->q_segments;
3487 for (i = 0; i < op_req_q->num_segments; i++)
3488 memset(segments[i].segment, 0, size);
3489}
3490
3491
3492
3493
3494
3495
3496
3497
3498
3499
3500
3501void mpi3mr_memset_buffers(struct mpi3mr_ioc *mrioc)
3502{
3503 u16 i;
3504
3505 memset(mrioc->admin_req_base, 0, mrioc->admin_req_q_sz);
3506 memset(mrioc->admin_reply_base, 0, mrioc->admin_reply_q_sz);
3507
3508 memset(mrioc->init_cmds.reply, 0, sizeof(*mrioc->init_cmds.reply));
3509 memset(mrioc->host_tm_cmds.reply, 0,
3510 sizeof(*mrioc->host_tm_cmds.reply));
3511 for (i = 0; i < MPI3MR_NUM_DEVRMCMD; i++)
3512 memset(mrioc->dev_rmhs_cmds[i].reply, 0,
3513 sizeof(*mrioc->dev_rmhs_cmds[i].reply));
3514 memset(mrioc->removepend_bitmap, 0, mrioc->dev_handle_bitmap_sz);
3515 memset(mrioc->devrem_bitmap, 0, mrioc->devrem_bitmap_sz);
3516
3517 for (i = 0; i < mrioc->num_queues; i++) {
3518 mrioc->op_reply_qinfo[i].qid = 0;
3519 mrioc->op_reply_qinfo[i].ci = 0;
3520 mrioc->op_reply_qinfo[i].num_replies = 0;
3521 mrioc->op_reply_qinfo[i].ephase = 0;
3522 atomic_set(&mrioc->op_reply_qinfo[i].pend_ios, 0);
3523 atomic_set(&mrioc->op_reply_qinfo[i].in_use, 0);
3524 mpi3mr_memset_op_reply_q_buffers(mrioc, i);
3525
3526 mrioc->req_qinfo[i].ci = 0;
3527 mrioc->req_qinfo[i].pi = 0;
3528 mrioc->req_qinfo[i].num_requests = 0;
3529 mrioc->req_qinfo[i].qid = 0;
3530 mrioc->req_qinfo[i].reply_qid = 0;
3531 spin_lock_init(&mrioc->req_qinfo[i].q_lock);
3532 mpi3mr_memset_op_req_q_buffers(mrioc, i);
3533 }
3534}
3535
3536
3537
3538
3539
3540
3541
3542
3543
3544static void mpi3mr_free_mem(struct mpi3mr_ioc *mrioc)
3545{
3546 u16 i;
3547 struct mpi3mr_intr_info *intr_info;
3548
3549 if (mrioc->sense_buf_pool) {
3550 if (mrioc->sense_buf)
3551 dma_pool_free(mrioc->sense_buf_pool, mrioc->sense_buf,
3552 mrioc->sense_buf_dma);
3553 dma_pool_destroy(mrioc->sense_buf_pool);
3554 mrioc->sense_buf = NULL;
3555 mrioc->sense_buf_pool = NULL;
3556 }
3557 if (mrioc->sense_buf_q_pool) {
3558 if (mrioc->sense_buf_q)
3559 dma_pool_free(mrioc->sense_buf_q_pool,
3560 mrioc->sense_buf_q, mrioc->sense_buf_q_dma);
3561 dma_pool_destroy(mrioc->sense_buf_q_pool);
3562 mrioc->sense_buf_q = NULL;
3563 mrioc->sense_buf_q_pool = NULL;
3564 }
3565
3566 if (mrioc->reply_buf_pool) {
3567 if (mrioc->reply_buf)
3568 dma_pool_free(mrioc->reply_buf_pool, mrioc->reply_buf,
3569 mrioc->reply_buf_dma);
3570 dma_pool_destroy(mrioc->reply_buf_pool);
3571 mrioc->reply_buf = NULL;
3572 mrioc->reply_buf_pool = NULL;
3573 }
3574 if (mrioc->reply_free_q_pool) {
3575 if (mrioc->reply_free_q)
3576 dma_pool_free(mrioc->reply_free_q_pool,
3577 mrioc->reply_free_q, mrioc->reply_free_q_dma);
3578 dma_pool_destroy(mrioc->reply_free_q_pool);
3579 mrioc->reply_free_q = NULL;
3580 mrioc->reply_free_q_pool = NULL;
3581 }
3582
3583 for (i = 0; i < mrioc->num_op_req_q; i++)
3584 mpi3mr_free_op_req_q_segments(mrioc, i);
3585
3586 for (i = 0; i < mrioc->num_op_reply_q; i++)
3587 mpi3mr_free_op_reply_q_segments(mrioc, i);
3588
3589 for (i = 0; i < mrioc->intr_info_count; i++) {
3590 intr_info = mrioc->intr_info + i;
3591 intr_info->op_reply_q = NULL;
3592 }
3593
3594 kfree(mrioc->req_qinfo);
3595 mrioc->req_qinfo = NULL;
3596 mrioc->num_op_req_q = 0;
3597
3598 kfree(mrioc->op_reply_qinfo);
3599 mrioc->op_reply_qinfo = NULL;
3600 mrioc->num_op_reply_q = 0;
3601
3602 kfree(mrioc->init_cmds.reply);
3603 mrioc->init_cmds.reply = NULL;
3604
3605 kfree(mrioc->host_tm_cmds.reply);
3606 mrioc->host_tm_cmds.reply = NULL;
3607
3608 kfree(mrioc->removepend_bitmap);
3609 mrioc->removepend_bitmap = NULL;
3610
3611 kfree(mrioc->devrem_bitmap);
3612 mrioc->devrem_bitmap = NULL;
3613
3614 kfree(mrioc->chain_bitmap);
3615 mrioc->chain_bitmap = NULL;
3616
3617 for (i = 0; i < MPI3MR_NUM_DEVRMCMD; i++) {
3618 kfree(mrioc->dev_rmhs_cmds[i].reply);
3619 mrioc->dev_rmhs_cmds[i].reply = NULL;
3620 }
3621
3622 if (mrioc->chain_buf_pool) {
3623 for (i = 0; i < mrioc->chain_buf_count; i++) {
3624 if (mrioc->chain_sgl_list[i].addr) {
3625 dma_pool_free(mrioc->chain_buf_pool,
3626 mrioc->chain_sgl_list[i].addr,
3627 mrioc->chain_sgl_list[i].dma_addr);
3628 mrioc->chain_sgl_list[i].addr = NULL;
3629 }
3630 }
3631 dma_pool_destroy(mrioc->chain_buf_pool);
3632 mrioc->chain_buf_pool = NULL;
3633 }
3634
3635 kfree(mrioc->chain_sgl_list);
3636 mrioc->chain_sgl_list = NULL;
3637
3638 if (mrioc->admin_reply_base) {
3639 dma_free_coherent(&mrioc->pdev->dev, mrioc->admin_reply_q_sz,
3640 mrioc->admin_reply_base, mrioc->admin_reply_dma);
3641 mrioc->admin_reply_base = NULL;
3642 }
3643 if (mrioc->admin_req_base) {
3644 dma_free_coherent(&mrioc->pdev->dev, mrioc->admin_req_q_sz,
3645 mrioc->admin_req_base, mrioc->admin_req_dma);
3646 mrioc->admin_req_base = NULL;
3647 }
3648}
3649
3650
3651
3652
3653
3654
3655
3656
3657
3658
3659static void mpi3mr_issue_ioc_shutdown(struct mpi3mr_ioc *mrioc)
3660{
3661 u32 ioc_config, ioc_status;
3662 u8 retval = 1;
3663 u32 timeout = MPI3MR_DEFAULT_SHUTDOWN_TIME * 10;
3664
3665 ioc_info(mrioc, "Issuing shutdown Notification\n");
3666 if (mrioc->unrecoverable) {
3667 ioc_warn(mrioc,
3668 "IOC is unrecoverable shutdown is not issued\n");
3669 return;
3670 }
3671 ioc_status = readl(&mrioc->sysif_regs->ioc_status);
3672 if ((ioc_status & MPI3_SYSIF_IOC_STATUS_SHUTDOWN_MASK)
3673 == MPI3_SYSIF_IOC_STATUS_SHUTDOWN_IN_PROGRESS) {
3674 ioc_info(mrioc, "shutdown already in progress\n");
3675 return;
3676 }
3677
3678 ioc_config = readl(&mrioc->sysif_regs->ioc_configuration);
3679 ioc_config |= MPI3_SYSIF_IOC_CONFIG_SHUTDOWN_NORMAL;
3680 ioc_config |= MPI3_SYSIF_IOC_CONFIG_DEVICE_SHUTDOWN;
3681
3682 writel(ioc_config, &mrioc->sysif_regs->ioc_configuration);
3683
3684 if (mrioc->facts.shutdown_timeout)
3685 timeout = mrioc->facts.shutdown_timeout * 10;
3686
3687 do {
3688 ioc_status = readl(&mrioc->sysif_regs->ioc_status);
3689 if ((ioc_status & MPI3_SYSIF_IOC_STATUS_SHUTDOWN_MASK)
3690 == MPI3_SYSIF_IOC_STATUS_SHUTDOWN_COMPLETE) {
3691 retval = 0;
3692 break;
3693 }
3694 msleep(100);
3695 } while (--timeout);
3696
3697 ioc_status = readl(&mrioc->sysif_regs->ioc_status);
3698 ioc_config = readl(&mrioc->sysif_regs->ioc_configuration);
3699
3700 if (retval) {
3701 if ((ioc_status & MPI3_SYSIF_IOC_STATUS_SHUTDOWN_MASK)
3702 == MPI3_SYSIF_IOC_STATUS_SHUTDOWN_IN_PROGRESS)
3703 ioc_warn(mrioc,
3704 "shutdown still in progress after timeout\n");
3705 }
3706
3707 ioc_info(mrioc,
3708 "Base IOC Sts/Config after %s shutdown is (0x%x)/(0x%x)\n",
3709 (!retval) ? "successful" : "failed", ioc_status,
3710 ioc_config);
3711}
3712
3713
3714
3715
3716
3717
3718
3719
3720
3721
3722
3723
3724void mpi3mr_cleanup_ioc(struct mpi3mr_ioc *mrioc, u8 reason)
3725{
3726 enum mpi3mr_iocstate ioc_state;
3727
3728 if (reason == MPI3MR_COMPLETE_CLEANUP)
3729 mpi3mr_stop_watchdog(mrioc);
3730
3731 mpi3mr_ioc_disable_intr(mrioc);
3732
3733 ioc_state = mpi3mr_get_iocstate(mrioc);
3734
3735 if ((!mrioc->unrecoverable) && (!mrioc->reset_in_progress) &&
3736 (ioc_state == MRIOC_STATE_READY)) {
3737 if (mpi3mr_issue_and_process_mur(mrioc,
3738 MPI3MR_RESET_FROM_CTLR_CLEANUP))
3739 mpi3mr_issue_reset(mrioc,
3740 MPI3_SYSIF_HOST_DIAG_RESET_ACTION_SOFT_RESET,
3741 MPI3MR_RESET_FROM_MUR_FAILURE);
3742
3743 if (reason != MPI3MR_REINIT_FAILURE)
3744 mpi3mr_issue_ioc_shutdown(mrioc);
3745 }
3746
3747 if (reason == MPI3MR_COMPLETE_CLEANUP) {
3748 mpi3mr_free_mem(mrioc);
3749 mpi3mr_cleanup_resources(mrioc);
3750 }
3751}
3752
3753
3754
3755
3756
3757
3758
3759
3760
3761
3762
3763static inline void mpi3mr_drv_cmd_comp_reset(struct mpi3mr_ioc *mrioc,
3764 struct mpi3mr_drv_cmd *cmdptr)
3765{
3766 if (cmdptr->state & MPI3MR_CMD_PENDING) {
3767 cmdptr->state |= MPI3MR_CMD_RESET;
3768 cmdptr->state &= ~MPI3MR_CMD_PENDING;
3769 if (cmdptr->is_waiting) {
3770 complete(&cmdptr->done);
3771 cmdptr->is_waiting = 0;
3772 } else if (cmdptr->callback)
3773 cmdptr->callback(mrioc, cmdptr);
3774 }
3775}
3776
3777
3778
3779
3780
3781
3782
3783
3784
3785static void mpi3mr_flush_drv_cmds(struct mpi3mr_ioc *mrioc)
3786{
3787 struct mpi3mr_drv_cmd *cmdptr;
3788 u8 i;
3789
3790 cmdptr = &mrioc->init_cmds;
3791 mpi3mr_drv_cmd_comp_reset(mrioc, cmdptr);
3792 cmdptr = &mrioc->host_tm_cmds;
3793 mpi3mr_drv_cmd_comp_reset(mrioc, cmdptr);
3794
3795 for (i = 0; i < MPI3MR_NUM_DEVRMCMD; i++) {
3796 cmdptr = &mrioc->dev_rmhs_cmds[i];
3797 mpi3mr_drv_cmd_comp_reset(mrioc, cmdptr);
3798 }
3799}
3800
3801
3802
3803
3804
3805
3806
3807
3808
3809
3810
3811
3812int mpi3mr_diagfault_reset_handler(struct mpi3mr_ioc *mrioc,
3813 u32 reset_reason)
3814{
3815 int retval = 0;
3816
3817 ioc_info(mrioc, "Entry: reason code: %s\n",
3818 mpi3mr_reset_rc_name(reset_reason));
3819 mrioc->reset_in_progress = 1;
3820
3821 mpi3mr_ioc_disable_intr(mrioc);
3822
3823 retval = mpi3mr_issue_reset(mrioc,
3824 MPI3_SYSIF_HOST_DIAG_RESET_ACTION_DIAG_FAULT, reset_reason);
3825
3826 if (retval) {
3827 ioc_err(mrioc, "The diag fault reset failed: reason %d\n",
3828 reset_reason);
3829 mpi3mr_ioc_enable_intr(mrioc);
3830 }
3831 ioc_info(mrioc, "%s\n", ((retval == 0) ? "SUCCESS" : "FAILED"));
3832 mrioc->reset_in_progress = 0;
3833 return retval;
3834}
3835
3836
3837
3838
3839
3840
3841
3842
3843
3844
3845
3846
3847
3848
3849
3850
3851
3852
3853
3854
3855
3856
3857int mpi3mr_soft_reset_handler(struct mpi3mr_ioc *mrioc,
3858 u32 reset_reason, u8 snapdump)
3859{
3860 int retval = 0, i;
3861 unsigned long flags;
3862 u32 host_diagnostic, timeout = MPI3_SYSIF_DIAG_SAVE_TIMEOUT * 10;
3863
3864 if (mrioc->fault_dbg) {
3865 if (snapdump)
3866 mpi3mr_set_diagsave(mrioc);
3867 mpi3mr_kill_ioc(mrioc, reset_reason);
3868 }
3869
3870
3871
3872
3873
3874 if (!mutex_trylock(&mrioc->reset_mutex)) {
3875 ioc_info(mrioc, "Another reset in progress\n");
3876 return -1;
3877 }
3878 mrioc->reset_in_progress = 1;
3879
3880 if ((!snapdump) && (reset_reason != MPI3MR_RESET_FROM_FAULT_WATCH) &&
3881 (reset_reason != MPI3MR_RESET_FROM_CIACTIV_FAULT)) {
3882 for (i = 0; i < MPI3_EVENT_NOTIFY_EVENTMASK_WORDS; i++)
3883 mrioc->event_masks[i] = -1;
3884
3885 retval = mpi3mr_issue_event_notification(mrioc);
3886
3887 if (retval) {
3888 ioc_err(mrioc,
3889 "Failed to turn off events prior to reset %d\n",
3890 retval);
3891 }
3892 }
3893
3894 mpi3mr_wait_for_host_io(mrioc, MPI3MR_RESET_HOST_IOWAIT_TIMEOUT);
3895
3896 mpi3mr_ioc_disable_intr(mrioc);
3897
3898 if (snapdump) {
3899 mpi3mr_set_diagsave(mrioc);
3900 retval = mpi3mr_issue_reset(mrioc,
3901 MPI3_SYSIF_HOST_DIAG_RESET_ACTION_DIAG_FAULT, reset_reason);
3902 if (!retval) {
3903 do {
3904 host_diagnostic =
3905 readl(&mrioc->sysif_regs->host_diagnostic);
3906 if (!(host_diagnostic &
3907 MPI3_SYSIF_HOST_DIAG_SAVE_IN_PROGRESS))
3908 break;
3909 msleep(100);
3910 } while (--timeout);
3911 }
3912 }
3913
3914 retval = mpi3mr_issue_reset(mrioc,
3915 MPI3_SYSIF_HOST_DIAG_RESET_ACTION_SOFT_RESET, reset_reason);
3916 if (retval) {
3917 ioc_err(mrioc, "Failed to issue soft reset to the ioc\n");
3918 goto out;
3919 }
3920
3921 mpi3mr_flush_delayed_rmhs_list(mrioc);
3922 mpi3mr_flush_drv_cmds(mrioc);
3923 memset(mrioc->devrem_bitmap, 0, mrioc->devrem_bitmap_sz);
3924 memset(mrioc->removepend_bitmap, 0, mrioc->dev_handle_bitmap_sz);
3925 mpi3mr_cleanup_fwevt_list(mrioc);
3926 mpi3mr_flush_host_io(mrioc);
3927 mpi3mr_invalidate_devhandles(mrioc);
3928 mpi3mr_memset_buffers(mrioc);
3929 retval = mpi3mr_init_ioc(mrioc, MPI3MR_IT_RESET);
3930 if (retval) {
3931 pr_err(IOCNAME "reinit after soft reset failed: reason %d\n",
3932 mrioc->name, reset_reason);
3933 goto out;
3934 }
3935 ssleep(10);
3936
3937out:
3938 if (!retval) {
3939 mrioc->reset_in_progress = 0;
3940 scsi_unblock_requests(mrioc->shost);
3941 mpi3mr_rfresh_tgtdevs(mrioc);
3942 mrioc->ts_update_counter = 0;
3943 spin_lock_irqsave(&mrioc->watchdog_lock, flags);
3944 if (mrioc->watchdog_work_q)
3945 queue_delayed_work(mrioc->watchdog_work_q,
3946 &mrioc->watchdog_work,
3947 msecs_to_jiffies(MPI3MR_WATCHDOG_INTERVAL));
3948 spin_unlock_irqrestore(&mrioc->watchdog_lock, flags);
3949 } else {
3950 mpi3mr_issue_reset(mrioc,
3951 MPI3_SYSIF_HOST_DIAG_RESET_ACTION_DIAG_FAULT, reset_reason);
3952 mrioc->unrecoverable = 1;
3953 mrioc->reset_in_progress = 0;
3954 retval = -1;
3955 }
3956
3957 mutex_unlock(&mrioc->reset_mutex);
3958 ioc_info(mrioc, "%s\n", ((retval == 0) ? "SUCCESS" : "FAILED"));
3959 return retval;
3960}
3961