]> rtime.felk.cvut.cz Git - linux-imx.git/blob - drivers/net/ethernet/qlogic/qlcnic/qlcnic_83xx_init.c
Merge tag 'for-linus' of git://git.kernel.org/pub/scm/virt/kvm/kvm
[linux-imx.git] / drivers / net / ethernet / qlogic / qlcnic / qlcnic_83xx_init.c
1 /*
2  * QLogic qlcnic NIC Driver
3  * Copyright (c) 2009-2013 QLogic Corporation
4  *
5  * See LICENSE.qlcnic for copyright and licensing details.
6  */
7
8 #include "qlcnic_sriov.h"
9 #include "qlcnic.h"
10 #include "qlcnic_hw.h"
11
12 /* Reset template definitions */
13 #define QLC_83XX_RESTART_TEMPLATE_SIZE          0x2000
14 #define QLC_83XX_RESET_TEMPLATE_ADDR            0x4F0000
15 #define QLC_83XX_RESET_SEQ_VERSION              0x0101
16
17 #define QLC_83XX_OPCODE_NOP                     0x0000
18 #define QLC_83XX_OPCODE_WRITE_LIST              0x0001
19 #define QLC_83XX_OPCODE_READ_WRITE_LIST         0x0002
20 #define QLC_83XX_OPCODE_POLL_LIST               0x0004
21 #define QLC_83XX_OPCODE_POLL_WRITE_LIST         0x0008
22 #define QLC_83XX_OPCODE_READ_MODIFY_WRITE       0x0010
23 #define QLC_83XX_OPCODE_SEQ_PAUSE               0x0020
24 #define QLC_83XX_OPCODE_SEQ_END                 0x0040
25 #define QLC_83XX_OPCODE_TMPL_END                0x0080
26 #define QLC_83XX_OPCODE_POLL_READ_LIST          0x0100
27
28 /* EPORT control registers */
29 #define QLC_83XX_RESET_CONTROL                  0x28084E50
30 #define QLC_83XX_RESET_REG                      0x28084E60
31 #define QLC_83XX_RESET_PORT0                    0x28084E70
32 #define QLC_83XX_RESET_PORT1                    0x28084E80
33 #define QLC_83XX_RESET_PORT2                    0x28084E90
34 #define QLC_83XX_RESET_PORT3                    0x28084EA0
35 #define QLC_83XX_RESET_SRESHIM                  0x28084EB0
36 #define QLC_83XX_RESET_EPGSHIM                  0x28084EC0
37 #define QLC_83XX_RESET_ETHERPCS                 0x28084ED0
38
39 static int qlcnic_83xx_init_default_driver(struct qlcnic_adapter *adapter);
40 static int qlcnic_83xx_check_heartbeat(struct qlcnic_adapter *p_dev);
41 static int qlcnic_83xx_restart_hw(struct qlcnic_adapter *adapter);
42
43 /* Template header */
44 struct qlc_83xx_reset_hdr {
45 #if defined(__LITTLE_ENDIAN)
46         u16     version;
47         u16     signature;
48         u16     size;
49         u16     entries;
50         u16     hdr_size;
51         u16     checksum;
52         u16     init_offset;
53         u16     start_offset;
54 #elif defined(__BIG_ENDIAN)
55         u16     signature;
56         u16     version;
57         u16     entries;
58         u16     size;
59         u16     checksum;
60         u16     hdr_size;
61         u16     start_offset;
62         u16     init_offset;
63 #endif
64 } __packed;
65
66 /* Command entry header. */
67 struct qlc_83xx_entry_hdr {
68 #if defined(__LITTLE_ENDIAN)
69         u16     cmd;
70         u16     size;
71         u16     count;
72         u16     delay;
73 #elif defined(__BIG_ENDIAN)
74         u16     size;
75         u16     cmd;
76         u16     delay;
77         u16     count;
78 #endif
79 } __packed;
80
81 /* Generic poll command */
82 struct qlc_83xx_poll {
83         u32     mask;
84         u32     status;
85 } __packed;
86
87 /* Read modify write command */
88 struct qlc_83xx_rmw {
89         u32     mask;
90         u32     xor_value;
91         u32     or_value;
92 #if defined(__LITTLE_ENDIAN)
93         u8      shl;
94         u8      shr;
95         u8      index_a;
96         u8      rsvd;
97 #elif defined(__BIG_ENDIAN)
98         u8      rsvd;
99         u8      index_a;
100         u8      shr;
101         u8      shl;
102 #endif
103 } __packed;
104
105 /* Generic command with 2 DWORD */
106 struct qlc_83xx_entry {
107         u32 arg1;
108         u32 arg2;
109 } __packed;
110
111 /* Generic command with 4 DWORD */
112 struct qlc_83xx_quad_entry {
113         u32 dr_addr;
114         u32 dr_value;
115         u32 ar_addr;
116         u32 ar_value;
117 } __packed;
118 static const char *const qlc_83xx_idc_states[] = {
119         "Unknown",
120         "Cold",
121         "Init",
122         "Ready",
123         "Need Reset",
124         "Need Quiesce",
125         "Failed",
126         "Quiesce"
127 };
128
129 static int
130 qlcnic_83xx_idc_check_driver_presence_reg(struct qlcnic_adapter *adapter)
131 {
132         u32 val;
133
134         val = QLCRDX(adapter->ahw, QLC_83XX_IDC_DRV_PRESENCE);
135         if ((val & 0xFFFF))
136                 return 1;
137         else
138                 return 0;
139 }
140
141 static void qlcnic_83xx_idc_log_state_history(struct qlcnic_adapter *adapter)
142 {
143         u32 cur, prev;
144         cur = adapter->ahw->idc.curr_state;
145         prev = adapter->ahw->idc.prev_state;
146
147         dev_info(&adapter->pdev->dev,
148                  "current state  = %s,  prev state = %s\n",
149                  adapter->ahw->idc.name[cur],
150                  adapter->ahw->idc.name[prev]);
151 }
152
153 static int qlcnic_83xx_idc_update_audit_reg(struct qlcnic_adapter *adapter,
154                                             u8 mode, int lock)
155 {
156         u32 val;
157         int seconds;
158
159         if (lock) {
160                 if (qlcnic_83xx_lock_driver(adapter))
161                         return -EBUSY;
162         }
163
164         val = QLCRDX(adapter->ahw, QLC_83XX_IDC_DRV_AUDIT);
165         val |= (adapter->portnum & 0xf);
166         val |= mode << 7;
167         if (mode)
168                 seconds = jiffies / HZ - adapter->ahw->idc.sec_counter;
169         else
170                 seconds = jiffies / HZ;
171
172         val |= seconds << 8;
173         QLCWRX(adapter->ahw, QLC_83XX_IDC_DRV_AUDIT, val);
174         adapter->ahw->idc.sec_counter = jiffies / HZ;
175
176         if (lock)
177                 qlcnic_83xx_unlock_driver(adapter);
178
179         return 0;
180 }
181
182 static void qlcnic_83xx_idc_update_minor_version(struct qlcnic_adapter *adapter)
183 {
184         u32 val;
185
186         val = QLCRDX(adapter->ahw, QLC_83XX_IDC_MIN_VERSION);
187         val = val & ~(0x3 << (adapter->portnum * 2));
188         val = val | (QLC_83XX_IDC_MINOR_VERSION << (adapter->portnum * 2));
189         QLCWRX(adapter->ahw, QLC_83XX_IDC_MIN_VERSION, val);
190 }
191
192 static int qlcnic_83xx_idc_update_major_version(struct qlcnic_adapter *adapter,
193                                                 int lock)
194 {
195         u32 val;
196
197         if (lock) {
198                 if (qlcnic_83xx_lock_driver(adapter))
199                         return -EBUSY;
200         }
201
202         val = QLCRDX(adapter->ahw, QLC_83XX_IDC_MAJ_VERSION);
203         val = val & ~0xFF;
204         val = val | QLC_83XX_IDC_MAJOR_VERSION;
205         QLCWRX(adapter->ahw, QLC_83XX_IDC_MAJ_VERSION, val);
206
207         if (lock)
208                 qlcnic_83xx_unlock_driver(adapter);
209
210         return 0;
211 }
212
213 static int
214 qlcnic_83xx_idc_update_drv_presence_reg(struct qlcnic_adapter *adapter,
215                                         int status, int lock)
216 {
217         u32 val;
218
219         if (lock) {
220                 if (qlcnic_83xx_lock_driver(adapter))
221                         return -EBUSY;
222         }
223
224         val = QLCRDX(adapter->ahw, QLC_83XX_IDC_DRV_PRESENCE);
225
226         if (status)
227                 val = val | (1 << adapter->portnum);
228         else
229                 val = val & ~(1 << adapter->portnum);
230
231         QLCWRX(adapter->ahw, QLC_83XX_IDC_DRV_PRESENCE, val);
232         qlcnic_83xx_idc_update_minor_version(adapter);
233
234         if (lock)
235                 qlcnic_83xx_unlock_driver(adapter);
236
237         return 0;
238 }
239
240 static int qlcnic_83xx_idc_check_major_version(struct qlcnic_adapter *adapter)
241 {
242         u32 val;
243         u8 version;
244
245         val = QLCRDX(adapter->ahw, QLC_83XX_IDC_MAJ_VERSION);
246         version = val & 0xFF;
247
248         if (version != QLC_83XX_IDC_MAJOR_VERSION) {
249                 dev_info(&adapter->pdev->dev,
250                          "%s:mismatch. version 0x%x, expected version 0x%x\n",
251                          __func__, version, QLC_83XX_IDC_MAJOR_VERSION);
252                 return -EIO;
253         }
254
255         return 0;
256 }
257
258 static int qlcnic_83xx_idc_clear_registers(struct qlcnic_adapter *adapter,
259                                            int lock)
260 {
261         u32 val;
262
263         if (lock) {
264                 if (qlcnic_83xx_lock_driver(adapter))
265                         return -EBUSY;
266         }
267
268         QLCWRX(adapter->ahw, QLC_83XX_IDC_DRV_ACK, 0);
269         /* Clear gracefull reset bit */
270         val = QLCRDX(adapter->ahw, QLC_83XX_IDC_CTRL);
271         val &= ~QLC_83XX_IDC_GRACEFULL_RESET;
272         QLCWRX(adapter->ahw, QLC_83XX_IDC_CTRL, val);
273
274         if (lock)
275                 qlcnic_83xx_unlock_driver(adapter);
276
277         return 0;
278 }
279
280 static int qlcnic_83xx_idc_update_drv_ack_reg(struct qlcnic_adapter *adapter,
281                                               int flag, int lock)
282 {
283         u32 val;
284
285         if (lock) {
286                 if (qlcnic_83xx_lock_driver(adapter))
287                         return -EBUSY;
288         }
289
290         val = QLCRDX(adapter->ahw, QLC_83XX_IDC_DRV_ACK);
291         if (flag)
292                 val = val | (1 << adapter->portnum);
293         else
294                 val = val & ~(1 << adapter->portnum);
295         QLCWRX(adapter->ahw, QLC_83XX_IDC_DRV_ACK, val);
296
297         if (lock)
298                 qlcnic_83xx_unlock_driver(adapter);
299
300         return 0;
301 }
302
303 static int qlcnic_83xx_idc_check_timeout(struct qlcnic_adapter *adapter,
304                                          int time_limit)
305 {
306         u64 seconds;
307
308         seconds = jiffies / HZ - adapter->ahw->idc.sec_counter;
309         if (seconds <= time_limit)
310                 return 0;
311         else
312                 return -EBUSY;
313 }
314
315 /**
316  * qlcnic_83xx_idc_check_reset_ack_reg
317  *
318  * @adapter: adapter structure
319  *
320  * Check ACK wait limit and clear the functions which failed to ACK
321  *
322  * Return 0 if all functions have acknowledged the reset request.
323  **/
324 static int qlcnic_83xx_idc_check_reset_ack_reg(struct qlcnic_adapter *adapter)
325 {
326         int timeout;
327         u32 ack, presence, val;
328
329         timeout = QLC_83XX_IDC_RESET_TIMEOUT_SECS;
330         ack = QLCRDX(adapter->ahw, QLC_83XX_IDC_DRV_ACK);
331         presence = QLCRDX(adapter->ahw, QLC_83XX_IDC_DRV_PRESENCE);
332         dev_info(&adapter->pdev->dev,
333                  "%s: ack = 0x%x, presence = 0x%x\n", __func__, ack, presence);
334         if (!((ack & presence) == presence)) {
335                 if (qlcnic_83xx_idc_check_timeout(adapter, timeout)) {
336                         /* Clear functions which failed to ACK */
337                         dev_info(&adapter->pdev->dev,
338                                  "%s: ACK wait exceeds time limit\n", __func__);
339                         val = QLCRDX(adapter->ahw, QLC_83XX_IDC_DRV_PRESENCE);
340                         val = val & ~(ack ^ presence);
341                         if (qlcnic_83xx_lock_driver(adapter))
342                                 return -EBUSY;
343                         QLCWRX(adapter->ahw, QLC_83XX_IDC_DRV_PRESENCE, val);
344                         dev_info(&adapter->pdev->dev,
345                                  "%s: updated drv presence reg = 0x%x\n",
346                                  __func__, val);
347                         qlcnic_83xx_unlock_driver(adapter);
348                         return 0;
349
350                 } else {
351                         return 1;
352                 }
353         } else {
354                 dev_info(&adapter->pdev->dev,
355                          "%s: Reset ACK received from all functions\n",
356                          __func__);
357                 return 0;
358         }
359 }
360
361 /**
362  * qlcnic_83xx_idc_tx_soft_reset
363  *
364  * @adapter: adapter structure
365  *
366  * Handle context deletion and recreation request from transmit routine
367  *
368  * Returns -EBUSY  or Success (0)
369  *
370  **/
371 static int qlcnic_83xx_idc_tx_soft_reset(struct qlcnic_adapter *adapter)
372 {
373         struct net_device *netdev = adapter->netdev;
374
375         if (test_and_set_bit(__QLCNIC_RESETTING, &adapter->state))
376                 return -EBUSY;
377
378         netif_device_detach(netdev);
379         qlcnic_down(adapter, netdev);
380         qlcnic_up(adapter, netdev);
381         netif_device_attach(netdev);
382         clear_bit(__QLCNIC_RESETTING, &adapter->state);
383         dev_err(&adapter->pdev->dev, "%s:\n", __func__);
384
385         return 0;
386 }
387
388 /**
389  * qlcnic_83xx_idc_detach_driver
390  *
391  * @adapter: adapter structure
392  * Detach net interface, stop TX and cleanup resources before the HW reset.
393  * Returns: None
394  *
395  **/
396 static void qlcnic_83xx_idc_detach_driver(struct qlcnic_adapter *adapter)
397 {
398         int i;
399         struct net_device *netdev = adapter->netdev;
400
401         netif_device_detach(netdev);
402
403         /* Disable mailbox interrupt */
404         qlcnic_83xx_disable_mbx_intr(adapter);
405         qlcnic_down(adapter, netdev);
406         for (i = 0; i < adapter->ahw->num_msix; i++) {
407                 adapter->ahw->intr_tbl[i].id = i;
408                 adapter->ahw->intr_tbl[i].enabled = 0;
409                 adapter->ahw->intr_tbl[i].src = 0;
410         }
411
412         if (qlcnic_sriov_pf_check(adapter))
413                 qlcnic_sriov_pf_reset(adapter);
414 }
415
416 /**
417  * qlcnic_83xx_idc_attach_driver
418  *
419  * @adapter: adapter structure
420  *
421  * Re-attach and re-enable net interface
422  * Returns: None
423  *
424  **/
425 static void qlcnic_83xx_idc_attach_driver(struct qlcnic_adapter *adapter)
426 {
427         struct net_device *netdev = adapter->netdev;
428
429         if (netif_running(netdev)) {
430                 if (qlcnic_up(adapter, netdev))
431                         goto done;
432                 qlcnic_restore_indev_addr(netdev, NETDEV_UP);
433         }
434 done:
435         netif_device_attach(netdev);
436 }
437
438 static int qlcnic_83xx_idc_enter_failed_state(struct qlcnic_adapter *adapter,
439                                               int lock)
440 {
441         if (lock) {
442                 if (qlcnic_83xx_lock_driver(adapter))
443                         return -EBUSY;
444         }
445
446         qlcnic_83xx_idc_clear_registers(adapter, 0);
447         QLCWRX(adapter->ahw, QLC_83XX_IDC_DEV_STATE, QLC_83XX_IDC_DEV_FAILED);
448         if (lock)
449                 qlcnic_83xx_unlock_driver(adapter);
450
451         qlcnic_83xx_idc_log_state_history(adapter);
452         dev_info(&adapter->pdev->dev, "Device will enter failed state\n");
453
454         return 0;
455 }
456
457 static int qlcnic_83xx_idc_enter_init_state(struct qlcnic_adapter *adapter,
458                                             int lock)
459 {
460         if (lock) {
461                 if (qlcnic_83xx_lock_driver(adapter))
462                         return -EBUSY;
463         }
464
465         QLCWRX(adapter->ahw, QLC_83XX_IDC_DEV_STATE, QLC_83XX_IDC_DEV_INIT);
466
467         if (lock)
468                 qlcnic_83xx_unlock_driver(adapter);
469
470         return 0;
471 }
472
473 static int qlcnic_83xx_idc_enter_need_quiesce(struct qlcnic_adapter *adapter,
474                                               int lock)
475 {
476         if (lock) {
477                 if (qlcnic_83xx_lock_driver(adapter))
478                         return -EBUSY;
479         }
480
481         QLCWRX(adapter->ahw, QLC_83XX_IDC_DEV_STATE,
482                QLC_83XX_IDC_DEV_NEED_QUISCENT);
483
484         if (lock)
485                 qlcnic_83xx_unlock_driver(adapter);
486
487         return 0;
488 }
489
490 static int
491 qlcnic_83xx_idc_enter_need_reset_state(struct qlcnic_adapter *adapter, int lock)
492 {
493         if (lock) {
494                 if (qlcnic_83xx_lock_driver(adapter))
495                         return -EBUSY;
496         }
497
498         QLCWRX(adapter->ahw, QLC_83XX_IDC_DEV_STATE,
499                QLC_83XX_IDC_DEV_NEED_RESET);
500
501         if (lock)
502                 qlcnic_83xx_unlock_driver(adapter);
503
504         return 0;
505 }
506
507 static int qlcnic_83xx_idc_enter_ready_state(struct qlcnic_adapter *adapter,
508                                              int lock)
509 {
510         if (lock) {
511                 if (qlcnic_83xx_lock_driver(adapter))
512                         return -EBUSY;
513         }
514
515         QLCWRX(adapter->ahw, QLC_83XX_IDC_DEV_STATE, QLC_83XX_IDC_DEV_READY);
516         if (lock)
517                 qlcnic_83xx_unlock_driver(adapter);
518
519         return 0;
520 }
521
522 /**
523  * qlcnic_83xx_idc_find_reset_owner_id
524  *
525  * @adapter: adapter structure
526  *
527  * NIC gets precedence over ISCSI and ISCSI has precedence over FCOE.
528  * Within the same class, function with lowest PCI ID assumes ownership
529  *
530  * Returns: reset owner id or failure indication (-EIO)
531  *
532  **/
533 static int qlcnic_83xx_idc_find_reset_owner_id(struct qlcnic_adapter *adapter)
534 {
535         u32 reg, reg1, reg2, i, j, owner, class;
536
537         reg1 = QLCRDX(adapter->ahw, QLC_83XX_IDC_DEV_PARTITION_INFO_1);
538         reg2 = QLCRDX(adapter->ahw, QLC_83XX_IDC_DEV_PARTITION_INFO_2);
539         owner = QLCNIC_TYPE_NIC;
540         i = 0;
541         j = 0;
542         reg = reg1;
543
544         do {
545                 class = (((reg & (0xF << j * 4)) >> j * 4) & 0x3);
546                 if (class == owner)
547                         break;
548                 if (i == (QLC_83XX_IDC_MAX_FUNC_PER_PARTITION_INFO - 1)) {
549                         reg = reg2;
550                         j = 0;
551                 } else {
552                         j++;
553                 }
554
555                 if (i == (QLC_83XX_IDC_MAX_CNA_FUNCTIONS - 1)) {
556                         if (owner == QLCNIC_TYPE_NIC)
557                                 owner = QLCNIC_TYPE_ISCSI;
558                         else if (owner == QLCNIC_TYPE_ISCSI)
559                                 owner = QLCNIC_TYPE_FCOE;
560                         else if (owner == QLCNIC_TYPE_FCOE)
561                                 return -EIO;
562                         reg = reg1;
563                         j = 0;
564                         i = 0;
565                 }
566         } while (i++ < QLC_83XX_IDC_MAX_CNA_FUNCTIONS);
567
568         return i;
569 }
570
571 static int qlcnic_83xx_idc_restart_hw(struct qlcnic_adapter *adapter, int lock)
572 {
573         int ret = 0;
574
575         ret = qlcnic_83xx_restart_hw(adapter);
576
577         if (ret) {
578                 qlcnic_83xx_idc_enter_failed_state(adapter, lock);
579         } else {
580                 qlcnic_83xx_idc_clear_registers(adapter, lock);
581                 ret = qlcnic_83xx_idc_enter_ready_state(adapter, lock);
582         }
583
584         return ret;
585 }
586
587 static int qlcnic_83xx_idc_check_fan_failure(struct qlcnic_adapter *adapter)
588 {
589         u32 status;
590
591         status = QLC_SHARED_REG_RD32(adapter, QLCNIC_PEG_HALT_STATUS1);
592
593         if (status & QLCNIC_RCODE_FATAL_ERROR) {
594                 dev_err(&adapter->pdev->dev,
595                         "peg halt status1=0x%x\n", status);
596                 if (QLCNIC_FWERROR_CODE(status) == QLCNIC_FWERROR_FAN_FAILURE) {
597                         dev_err(&adapter->pdev->dev,
598                                 "On board active cooling fan failed. "
599                                 "Device has been halted.\n");
600                         dev_err(&adapter->pdev->dev,
601                                 "Replace the adapter.\n");
602                         return -EIO;
603                 }
604         }
605
606         return 0;
607 }
608
609 int qlcnic_83xx_idc_reattach_driver(struct qlcnic_adapter *adapter)
610 {
611         int err;
612
613         /* register for NIC IDC AEN Events */
614         qlcnic_83xx_register_nic_idc_func(adapter, 1);
615
616         err = qlcnic_sriov_pf_reinit(adapter);
617         if (err)
618                 return err;
619
620         qlcnic_83xx_enable_mbx_intrpt(adapter);
621
622         if (qlcnic_83xx_configure_opmode(adapter)) {
623                 qlcnic_83xx_idc_enter_failed_state(adapter, 1);
624                 return -EIO;
625         }
626
627         if (adapter->nic_ops->init_driver(adapter)) {
628                 qlcnic_83xx_idc_enter_failed_state(adapter, 1);
629                 return -EIO;
630         }
631
632         qlcnic_set_drv_version(adapter);
633         qlcnic_83xx_idc_attach_driver(adapter);
634
635         return 0;
636 }
637
638 static void qlcnic_83xx_idc_update_idc_params(struct qlcnic_adapter *adapter)
639 {
640         struct qlcnic_hardware_context *ahw = adapter->ahw;
641
642         qlcnic_83xx_idc_update_drv_presence_reg(adapter, 1, 1);
643         set_bit(QLC_83XX_MBX_READY, &adapter->ahw->idc.status);
644         qlcnic_83xx_idc_update_audit_reg(adapter, 0, 1);
645         set_bit(QLC_83XX_MODULE_LOADED, &adapter->ahw->idc.status);
646
647         ahw->idc.quiesce_req = 0;
648         ahw->idc.delay = QLC_83XX_IDC_FW_POLL_DELAY;
649         ahw->idc.err_code = 0;
650         ahw->idc.collect_dump = 0;
651         ahw->reset_context = 0;
652         adapter->tx_timeo_cnt = 0;
653         ahw->idc.delay_reset = 0;
654
655         clear_bit(__QLCNIC_RESETTING, &adapter->state);
656 }
657
658 /**
659  * qlcnic_83xx_idc_ready_state_entry
660  *
661  * @adapter: adapter structure
662  *
663  * Perform ready state initialization, this routine will get invoked only
664  * once from READY state.
665  *
666  * Returns: Error code or Success(0)
667  *
668  **/
669 int qlcnic_83xx_idc_ready_state_entry(struct qlcnic_adapter *adapter)
670 {
671         struct qlcnic_hardware_context *ahw = adapter->ahw;
672
673         if (ahw->idc.prev_state != QLC_83XX_IDC_DEV_READY) {
674                 qlcnic_83xx_idc_update_idc_params(adapter);
675                 /* Re-attach the device if required */
676                 if ((ahw->idc.prev_state == QLC_83XX_IDC_DEV_NEED_RESET) ||
677                     (ahw->idc.prev_state == QLC_83XX_IDC_DEV_INIT)) {
678                         if (qlcnic_83xx_idc_reattach_driver(adapter))
679                                 return -EIO;
680                 }
681         }
682
683         return 0;
684 }
685
686 /**
687  * qlcnic_83xx_idc_vnic_pf_entry
688  *
689  * @adapter: adapter structure
690  *
691  * Ensure vNIC mode privileged function starts only after vNIC mode is
692  * enabled by management function.
693  * If vNIC mode is ready, start initialization.
694  *
695  * Returns: -EIO or 0
696  *
697  **/
698 int qlcnic_83xx_idc_vnic_pf_entry(struct qlcnic_adapter *adapter)
699 {
700         u32 state;
701         struct qlcnic_hardware_context *ahw = adapter->ahw;
702
703         /* Privileged function waits till mgmt function enables VNIC mode */
704         state = QLCRDX(adapter->ahw, QLC_83XX_VNIC_STATE);
705         if (state != QLCNIC_DEV_NPAR_OPER) {
706                 if (!ahw->idc.vnic_wait_limit--) {
707                         qlcnic_83xx_idc_enter_failed_state(adapter, 1);
708                         return -EIO;
709                 }
710                 dev_info(&adapter->pdev->dev, "vNIC mode disabled\n");
711                 return -EIO;
712
713         } else {
714                 /* Perform one time initialization from ready state */
715                 if (ahw->idc.vnic_state != QLCNIC_DEV_NPAR_OPER) {
716                         qlcnic_83xx_idc_update_idc_params(adapter);
717
718                         /* If the previous state is UNKNOWN, device will be
719                            already attached properly by Init routine*/
720                         if (ahw->idc.prev_state != QLC_83XX_IDC_DEV_UNKNOWN) {
721                                 if (qlcnic_83xx_idc_reattach_driver(adapter))
722                                         return -EIO;
723                         }
724                         adapter->ahw->idc.vnic_state =  QLCNIC_DEV_NPAR_OPER;
725                         dev_info(&adapter->pdev->dev, "vNIC mode enabled\n");
726                 }
727         }
728
729         return 0;
730 }
731
732 static int qlcnic_83xx_idc_unknown_state(struct qlcnic_adapter *adapter)
733 {
734         adapter->ahw->idc.err_code = -EIO;
735         dev_err(&adapter->pdev->dev,
736                 "%s: Device in unknown state\n", __func__);
737         return 0;
738 }
739
740 /**
741  * qlcnic_83xx_idc_cold_state
742  *
743  * @adapter: adapter structure
744  *
745  * If HW is up and running device will enter READY state.
746  * If firmware image from host needs to be loaded, device is
747  * forced to start with the file firmware image.
748  *
749  * Returns: Error code or Success(0)
750  *
751  **/
752 static int qlcnic_83xx_idc_cold_state_handler(struct qlcnic_adapter *adapter)
753 {
754         qlcnic_83xx_idc_update_drv_presence_reg(adapter, 1, 0);
755         qlcnic_83xx_idc_update_audit_reg(adapter, 1, 0);
756
757         if (qlcnic_load_fw_file) {
758                 qlcnic_83xx_idc_restart_hw(adapter, 0);
759         } else {
760                 if (qlcnic_83xx_check_hw_status(adapter)) {
761                         qlcnic_83xx_idc_enter_failed_state(adapter, 0);
762                         return -EIO;
763                 } else {
764                         qlcnic_83xx_idc_enter_ready_state(adapter, 0);
765                 }
766         }
767         return 0;
768 }
769
770 /**
771  * qlcnic_83xx_idc_init_state
772  *
773  * @adapter: adapter structure
774  *
775  * Reset owner will restart the device from this state.
776  * Device will enter failed state if it remains
777  * in this state for more than DEV_INIT time limit.
778  *
779  * Returns: Error code or Success(0)
780  *
781  **/
782 static int qlcnic_83xx_idc_init_state(struct qlcnic_adapter *adapter)
783 {
784         int timeout, ret = 0;
785         u32 owner;
786
787         timeout = QLC_83XX_IDC_INIT_TIMEOUT_SECS;
788         if (adapter->ahw->idc.prev_state == QLC_83XX_IDC_DEV_NEED_RESET) {
789                 owner = qlcnic_83xx_idc_find_reset_owner_id(adapter);
790                 if (adapter->ahw->pci_func == owner)
791                         ret = qlcnic_83xx_idc_restart_hw(adapter, 1);
792         } else {
793                 ret = qlcnic_83xx_idc_check_timeout(adapter, timeout);
794                 return ret;
795         }
796
797         return ret;
798 }
799
800 /**
801  * qlcnic_83xx_idc_ready_state
802  *
803  * @adapter: adapter structure
804  *
805  * Perform IDC protocol specicifed actions after monitoring device state and
806  * events.
807  *
808  * Returns: Error code or Success(0)
809  *
810  **/
811 static int qlcnic_83xx_idc_ready_state(struct qlcnic_adapter *adapter)
812 {
813         u32 val;
814         struct qlcnic_hardware_context *ahw = adapter->ahw;
815         int ret = 0;
816
817         /* Perform NIC configuration based ready state entry actions */
818         if (ahw->idc.state_entry(adapter))
819                 return -EIO;
820
821         if (qlcnic_check_temp(adapter)) {
822                 if (ahw->temp == QLCNIC_TEMP_PANIC) {
823                         qlcnic_83xx_idc_check_fan_failure(adapter);
824                         dev_err(&adapter->pdev->dev,
825                                 "Error: device temperature %d above limits\n",
826                                 adapter->ahw->temp);
827                         clear_bit(QLC_83XX_MBX_READY, &ahw->idc.status);
828                         set_bit(__QLCNIC_RESETTING, &adapter->state);
829                         qlcnic_83xx_idc_detach_driver(adapter);
830                         qlcnic_83xx_idc_enter_failed_state(adapter, 1);
831                         return -EIO;
832                 }
833         }
834
835         val = QLCRDX(adapter->ahw, QLC_83XX_IDC_CTRL);
836         ret = qlcnic_83xx_check_heartbeat(adapter);
837         if (ret) {
838                 adapter->flags |= QLCNIC_FW_HANG;
839                 if (!(val & QLC_83XX_IDC_DISABLE_FW_RESET_RECOVERY)) {
840                         clear_bit(QLC_83XX_MBX_READY, &ahw->idc.status);
841                         set_bit(__QLCNIC_RESETTING, &adapter->state);
842                         qlcnic_83xx_idc_enter_need_reset_state(adapter, 1);
843                 }
844                 return -EIO;
845         }
846
847         if ((val & QLC_83XX_IDC_GRACEFULL_RESET) || ahw->idc.collect_dump) {
848                 /* Move to need reset state and prepare for reset */
849                 qlcnic_83xx_idc_enter_need_reset_state(adapter, 1);
850                 return ret;
851         }
852
853         /* Check for soft reset request */
854         if (ahw->reset_context &&
855             !(val & QLC_83XX_IDC_DISABLE_FW_RESET_RECOVERY)) {
856                 adapter->ahw->reset_context = 0;
857                 qlcnic_83xx_idc_tx_soft_reset(adapter);
858                 return ret;
859         }
860
861         /* Move to need quiesce state if requested */
862         if (adapter->ahw->idc.quiesce_req) {
863                 qlcnic_83xx_idc_enter_need_quiesce(adapter, 1);
864                 qlcnic_83xx_idc_update_audit_reg(adapter, 0, 1);
865                 return ret;
866         }
867
868         return ret;
869 }
870
871 /**
872  * qlcnic_83xx_idc_need_reset_state
873  *
874  * @adapter: adapter structure
875  *
876  * Device will remain in this state until:
877  *      Reset request ACK's are recieved from all the functions
878  *      Wait time exceeds max time limit
879  *
880  * Returns: Error code or Success(0)
881  *
882  **/
883 static int qlcnic_83xx_idc_need_reset_state(struct qlcnic_adapter *adapter)
884 {
885         int ret = 0;
886
887         if (adapter->ahw->idc.prev_state != QLC_83XX_IDC_DEV_NEED_RESET) {
888                 qlcnic_83xx_idc_update_audit_reg(adapter, 0, 1);
889                 set_bit(__QLCNIC_RESETTING, &adapter->state);
890                 clear_bit(QLC_83XX_MBX_READY, &adapter->ahw->idc.status);
891                 if (adapter->ahw->nic_mode == QLC_83XX_VIRTUAL_NIC_MODE)
892                         qlcnic_83xx_disable_vnic_mode(adapter, 1);
893
894                 if (qlcnic_check_diag_status(adapter)) {
895                         dev_info(&adapter->pdev->dev,
896                                  "%s: Wait for diag completion\n", __func__);
897                         adapter->ahw->idc.delay_reset = 1;
898                         return 0;
899                 } else {
900                         qlcnic_83xx_idc_update_drv_ack_reg(adapter, 1, 1);
901                         qlcnic_83xx_idc_detach_driver(adapter);
902                 }
903         }
904
905         if (qlcnic_check_diag_status(adapter)) {
906                 dev_info(&adapter->pdev->dev,
907                          "%s: Wait for diag completion\n", __func__);
908                 return  -1;
909         } else {
910                 if (adapter->ahw->idc.delay_reset) {
911                         qlcnic_83xx_idc_update_drv_ack_reg(adapter, 1, 1);
912                         qlcnic_83xx_idc_detach_driver(adapter);
913                         adapter->ahw->idc.delay_reset = 0;
914                 }
915
916                 /* Check for ACK from other functions */
917                 ret = qlcnic_83xx_idc_check_reset_ack_reg(adapter);
918                 if (ret) {
919                         dev_info(&adapter->pdev->dev,
920                                  "%s: Waiting for reset ACK\n", __func__);
921                         return -1;
922                 }
923         }
924
925         /* Transit to INIT state and restart the HW */
926         qlcnic_83xx_idc_enter_init_state(adapter, 1);
927
928         return ret;
929 }
930
931 static int qlcnic_83xx_idc_need_quiesce_state(struct qlcnic_adapter *adapter)
932 {
933         dev_err(&adapter->pdev->dev, "%s: TBD\n", __func__);
934         return 0;
935 }
936
937 static int qlcnic_83xx_idc_failed_state(struct qlcnic_adapter *adapter)
938 {
939         dev_err(&adapter->pdev->dev, "%s: please restart!!\n", __func__);
940         clear_bit(__QLCNIC_RESETTING, &adapter->state);
941         adapter->ahw->idc.err_code = -EIO;
942
943         return 0;
944 }
945
946 static int qlcnic_83xx_idc_quiesce_state(struct qlcnic_adapter *adapter)
947 {
948         dev_info(&adapter->pdev->dev, "%s: TBD\n", __func__);
949         return 0;
950 }
951
952 static int qlcnic_83xx_idc_check_state_validity(struct qlcnic_adapter *adapter,
953                                                 u32 state)
954 {
955         u32 cur, prev, next;
956
957         cur = adapter->ahw->idc.curr_state;
958         prev = adapter->ahw->idc.prev_state;
959         next = state;
960
961         if ((next < QLC_83XX_IDC_DEV_COLD) ||
962             (next > QLC_83XX_IDC_DEV_QUISCENT)) {
963                 dev_err(&adapter->pdev->dev,
964                         "%s: curr %d, prev %d, next state %d is  invalid\n",
965                         __func__, cur, prev, state);
966                 return 1;
967         }
968
969         if ((cur == QLC_83XX_IDC_DEV_UNKNOWN) &&
970             (prev == QLC_83XX_IDC_DEV_UNKNOWN)) {
971                 if ((next != QLC_83XX_IDC_DEV_COLD) &&
972                     (next != QLC_83XX_IDC_DEV_READY)) {
973                         dev_err(&adapter->pdev->dev,
974                                 "%s: failed, cur %d prev %d next %d\n",
975                                 __func__, cur, prev, next);
976                         return 1;
977                 }
978         }
979
980         if (next == QLC_83XX_IDC_DEV_INIT) {
981                 if ((prev != QLC_83XX_IDC_DEV_INIT) &&
982                     (prev != QLC_83XX_IDC_DEV_COLD) &&
983                     (prev != QLC_83XX_IDC_DEV_NEED_RESET)) {
984                         dev_err(&adapter->pdev->dev,
985                                 "%s: failed, cur %d prev %d next %d\n",
986                                 __func__, cur, prev, next);
987                         return 1;
988                 }
989         }
990
991         return 0;
992 }
993
994 static void qlcnic_83xx_periodic_tasks(struct qlcnic_adapter *adapter)
995 {
996         if (adapter->fhash.fnum)
997                 qlcnic_prune_lb_filters(adapter);
998 }
999
1000 /**
1001  * qlcnic_83xx_idc_poll_dev_state
1002  *
1003  * @work: kernel work queue structure used to schedule the function
1004  *
1005  * Poll device state periodically and perform state specific
1006  * actions defined by Inter Driver Communication (IDC) protocol.
1007  *
1008  * Returns: None
1009  *
1010  **/
1011 void qlcnic_83xx_idc_poll_dev_state(struct work_struct *work)
1012 {
1013         struct qlcnic_adapter *adapter;
1014         u32 state;
1015
1016         adapter = container_of(work, struct qlcnic_adapter, fw_work.work);
1017         state = QLCRDX(adapter->ahw, QLC_83XX_IDC_DEV_STATE);
1018
1019         if (qlcnic_83xx_idc_check_state_validity(adapter, state)) {
1020                 qlcnic_83xx_idc_log_state_history(adapter);
1021                 adapter->ahw->idc.curr_state = QLC_83XX_IDC_DEV_UNKNOWN;
1022         } else {
1023                 adapter->ahw->idc.curr_state = state;
1024         }
1025
1026         switch (adapter->ahw->idc.curr_state) {
1027         case QLC_83XX_IDC_DEV_READY:
1028                 qlcnic_83xx_idc_ready_state(adapter);
1029                 break;
1030         case QLC_83XX_IDC_DEV_NEED_RESET:
1031                 qlcnic_83xx_idc_need_reset_state(adapter);
1032                 break;
1033         case QLC_83XX_IDC_DEV_NEED_QUISCENT:
1034                 qlcnic_83xx_idc_need_quiesce_state(adapter);
1035                 break;
1036         case QLC_83XX_IDC_DEV_FAILED:
1037                 qlcnic_83xx_idc_failed_state(adapter);
1038                 return;
1039         case QLC_83XX_IDC_DEV_INIT:
1040                 qlcnic_83xx_idc_init_state(adapter);
1041                 break;
1042         case QLC_83XX_IDC_DEV_QUISCENT:
1043                 qlcnic_83xx_idc_quiesce_state(adapter);
1044                 break;
1045         default:
1046                 qlcnic_83xx_idc_unknown_state(adapter);
1047                 return;
1048         }
1049         adapter->ahw->idc.prev_state = adapter->ahw->idc.curr_state;
1050         qlcnic_83xx_periodic_tasks(adapter);
1051
1052         /* Re-schedule the function */
1053         if (test_bit(QLC_83XX_MODULE_LOADED, &adapter->ahw->idc.status))
1054                 qlcnic_schedule_work(adapter, qlcnic_83xx_idc_poll_dev_state,
1055                                      adapter->ahw->idc.delay);
1056 }
1057
1058 static void qlcnic_83xx_setup_idc_parameters(struct qlcnic_adapter *adapter)
1059 {
1060         u32 idc_params, val;
1061
1062         if (qlcnic_83xx_lockless_flash_read32(adapter,
1063                                               QLC_83XX_IDC_FLASH_PARAM_ADDR,
1064                                               (u8 *)&idc_params, 1)) {
1065                 dev_info(&adapter->pdev->dev,
1066                          "%s:failed to get IDC params from flash\n", __func__);
1067                 adapter->dev_init_timeo = QLC_83XX_IDC_INIT_TIMEOUT_SECS;
1068                 adapter->reset_ack_timeo = QLC_83XX_IDC_RESET_TIMEOUT_SECS;
1069         } else {
1070                 adapter->dev_init_timeo = idc_params & 0xFFFF;
1071                 adapter->reset_ack_timeo = ((idc_params >> 16) & 0xFFFF);
1072         }
1073
1074         adapter->ahw->idc.curr_state = QLC_83XX_IDC_DEV_UNKNOWN;
1075         adapter->ahw->idc.prev_state = QLC_83XX_IDC_DEV_UNKNOWN;
1076         adapter->ahw->idc.delay = QLC_83XX_IDC_FW_POLL_DELAY;
1077         adapter->ahw->idc.err_code = 0;
1078         adapter->ahw->idc.collect_dump = 0;
1079         adapter->ahw->idc.name = (char **)qlc_83xx_idc_states;
1080
1081         clear_bit(__QLCNIC_RESETTING, &adapter->state);
1082         set_bit(QLC_83XX_MBX_READY, &adapter->ahw->idc.status);
1083         set_bit(QLC_83XX_MODULE_LOADED, &adapter->ahw->idc.status);
1084
1085         /* Check if reset recovery is disabled */
1086         if (!qlcnic_auto_fw_reset) {
1087                 /* Propagate do not reset request to other functions */
1088                 val = QLCRDX(adapter->ahw, QLC_83XX_IDC_CTRL);
1089                 val = val | QLC_83XX_IDC_DISABLE_FW_RESET_RECOVERY;
1090                 QLCWRX(adapter->ahw, QLC_83XX_IDC_CTRL, val);
1091         }
1092 }
1093
1094 static int
1095 qlcnic_83xx_idc_first_to_load_function_handler(struct qlcnic_adapter *adapter)
1096 {
1097         u32 state, val;
1098
1099         if (qlcnic_83xx_lock_driver(adapter))
1100                 return -EIO;
1101
1102         /* Clear driver lock register */
1103         QLCWRX(adapter->ahw, QLC_83XX_RECOVER_DRV_LOCK, 0);
1104         if (qlcnic_83xx_idc_update_major_version(adapter, 0)) {
1105                 qlcnic_83xx_unlock_driver(adapter);
1106                 return -EIO;
1107         }
1108
1109         state = QLCRDX(adapter->ahw, QLC_83XX_IDC_DEV_STATE);
1110         if (qlcnic_83xx_idc_check_state_validity(adapter, state)) {
1111                 qlcnic_83xx_unlock_driver(adapter);
1112                 return -EIO;
1113         }
1114
1115         if (state != QLC_83XX_IDC_DEV_COLD && qlcnic_load_fw_file) {
1116                 QLCWRX(adapter->ahw, QLC_83XX_IDC_DEV_STATE,
1117                        QLC_83XX_IDC_DEV_COLD);
1118                 state = QLC_83XX_IDC_DEV_COLD;
1119         }
1120
1121         adapter->ahw->idc.curr_state = state;
1122         /* First to load function should cold boot the device */
1123         if (state == QLC_83XX_IDC_DEV_COLD)
1124                 qlcnic_83xx_idc_cold_state_handler(adapter);
1125
1126         /* Check if reset recovery is enabled */
1127         if (qlcnic_auto_fw_reset) {
1128                 val = QLCRDX(adapter->ahw, QLC_83XX_IDC_CTRL);
1129                 val = val & ~QLC_83XX_IDC_DISABLE_FW_RESET_RECOVERY;
1130                 QLCWRX(adapter->ahw, QLC_83XX_IDC_CTRL, val);
1131         }
1132
1133         qlcnic_83xx_unlock_driver(adapter);
1134
1135         return 0;
1136 }
1137
1138 int qlcnic_83xx_idc_init(struct qlcnic_adapter *adapter)
1139 {
1140         int ret = -EIO;
1141
1142         qlcnic_83xx_setup_idc_parameters(adapter);
1143
1144         if (qlcnic_83xx_get_reset_instruction_template(adapter))
1145                 return ret;
1146
1147         if (!qlcnic_83xx_idc_check_driver_presence_reg(adapter)) {
1148                 if (qlcnic_83xx_idc_first_to_load_function_handler(adapter))
1149                         return -EIO;
1150         } else {
1151                 if (qlcnic_83xx_idc_check_major_version(adapter))
1152                         return -EIO;
1153         }
1154
1155         qlcnic_83xx_idc_update_audit_reg(adapter, 0, 1);
1156
1157         return 0;
1158 }
1159
1160 void qlcnic_83xx_idc_exit(struct qlcnic_adapter *adapter)
1161 {
1162         int id;
1163         u32 val;
1164
1165         while (test_and_set_bit(__QLCNIC_RESETTING, &adapter->state))
1166                 usleep_range(10000, 11000);
1167
1168         id = QLCRDX(adapter->ahw, QLC_83XX_DRV_LOCK_ID);
1169         id = id & 0xFF;
1170
1171         if (id == adapter->portnum) {
1172                 dev_err(&adapter->pdev->dev,
1173                         "%s: wait for lock recovery.. %d\n", __func__, id);
1174                 msleep(20);
1175                 id = QLCRDX(adapter->ahw, QLC_83XX_DRV_LOCK_ID);
1176                 id = id & 0xFF;
1177         }
1178
1179         /* Clear driver presence bit */
1180         val = QLCRDX(adapter->ahw, QLC_83XX_IDC_DRV_PRESENCE);
1181         val = val & ~(1 << adapter->portnum);
1182         QLCWRX(adapter->ahw, QLC_83XX_IDC_DRV_PRESENCE, val);
1183         clear_bit(QLC_83XX_MODULE_LOADED, &adapter->ahw->idc.status);
1184         clear_bit(__QLCNIC_RESETTING, &adapter->state);
1185
1186         cancel_delayed_work_sync(&adapter->fw_work);
1187 }
1188
1189 void qlcnic_83xx_idc_request_reset(struct qlcnic_adapter *adapter, u32 key)
1190 {
1191         u32 val;
1192
1193         if (qlcnic_83xx_lock_driver(adapter)) {
1194                 dev_err(&adapter->pdev->dev,
1195                         "%s:failed, please retry\n", __func__);
1196                 return;
1197         }
1198
1199         val = QLCRDX(adapter->ahw, QLC_83XX_IDC_CTRL);
1200         if ((val & QLC_83XX_IDC_DISABLE_FW_RESET_RECOVERY) ||
1201             !qlcnic_auto_fw_reset) {
1202                 dev_err(&adapter->pdev->dev,
1203                         "%s:failed, device in non reset mode\n", __func__);
1204                 qlcnic_83xx_unlock_driver(adapter);
1205                 return;
1206         }
1207
1208         if (key == QLCNIC_FORCE_FW_RESET) {
1209                 val = QLCRDX(adapter->ahw, QLC_83XX_IDC_CTRL);
1210                 val = val | QLC_83XX_IDC_GRACEFULL_RESET;
1211                 QLCWRX(adapter->ahw, QLC_83XX_IDC_CTRL, val);
1212         } else if (key == QLCNIC_FORCE_FW_DUMP_KEY) {
1213                 adapter->ahw->idc.collect_dump = 1;
1214         }
1215
1216         qlcnic_83xx_unlock_driver(adapter);
1217         return;
1218 }
1219
1220 static int qlcnic_83xx_copy_bootloader(struct qlcnic_adapter *adapter)
1221 {
1222         u8 *p_cache;
1223         u32 src, size;
1224         u64 dest;
1225         int ret = -EIO;
1226
1227         src = QLC_83XX_BOOTLOADER_FLASH_ADDR;
1228         dest = QLCRDX(adapter->ahw, QLCNIC_BOOTLOADER_ADDR);
1229         size = QLCRDX(adapter->ahw, QLCNIC_BOOTLOADER_SIZE);
1230
1231         /* alignment check */
1232         if (size & 0xF)
1233                 size = (size + 16) & ~0xF;
1234
1235         p_cache = kzalloc(size, GFP_KERNEL);
1236         if (p_cache == NULL)
1237                 return -ENOMEM;
1238
1239         ret = qlcnic_83xx_lockless_flash_read32(adapter, src, p_cache,
1240                                                 size / sizeof(u32));
1241         if (ret) {
1242                 kfree(p_cache);
1243                 return ret;
1244         }
1245         /* 16 byte write to MS memory */
1246         ret = qlcnic_83xx_ms_mem_write128(adapter, dest, (u32 *)p_cache,
1247                                           size / 16);
1248         if (ret) {
1249                 kfree(p_cache);
1250                 return ret;
1251         }
1252         kfree(p_cache);
1253
1254         return ret;
1255 }
1256
1257 static int qlcnic_83xx_copy_fw_file(struct qlcnic_adapter *adapter)
1258 {
1259         u32 dest, *p_cache;
1260         u64 addr;
1261         u8 data[16];
1262         size_t size;
1263         int i, ret = -EIO;
1264
1265         dest = QLCRDX(adapter->ahw, QLCNIC_FW_IMAGE_ADDR);
1266         size = (adapter->ahw->fw_info.fw->size & ~0xF);
1267         p_cache = (u32 *)adapter->ahw->fw_info.fw->data;
1268         addr = (u64)dest;
1269
1270         ret = qlcnic_83xx_ms_mem_write128(adapter, addr,
1271                                           (u32 *)p_cache, size / 16);
1272         if (ret) {
1273                 dev_err(&adapter->pdev->dev, "MS memory write failed\n");
1274                 release_firmware(adapter->ahw->fw_info.fw);
1275                 adapter->ahw->fw_info.fw = NULL;
1276                 return -EIO;
1277         }
1278
1279         /* alignment check */
1280         if (adapter->ahw->fw_info.fw->size & 0xF) {
1281                 addr = dest + size;
1282                 for (i = 0; i < (adapter->ahw->fw_info.fw->size & 0xF); i++)
1283                         data[i] = adapter->ahw->fw_info.fw->data[size + i];
1284                 for (; i < 16; i++)
1285                         data[i] = 0;
1286                 ret = qlcnic_83xx_ms_mem_write128(adapter, addr,
1287                                                   (u32 *)data, 1);
1288                 if (ret) {
1289                         dev_err(&adapter->pdev->dev,
1290                                 "MS memory write failed\n");
1291                         release_firmware(adapter->ahw->fw_info.fw);
1292                         adapter->ahw->fw_info.fw = NULL;
1293                         return -EIO;
1294                 }
1295         }
1296         release_firmware(adapter->ahw->fw_info.fw);
1297         adapter->ahw->fw_info.fw = NULL;
1298
1299         return 0;
1300 }
1301
1302 static void qlcnic_83xx_dump_pause_control_regs(struct qlcnic_adapter *adapter)
1303 {
1304         int i, j;
1305         u32 val = 0, val1 = 0, reg = 0;
1306         int err = 0;
1307
1308         val = QLCRD32(adapter, QLC_83XX_SRE_SHIM_REG, &err);
1309         if (err == -EIO)
1310                 return;
1311         dev_info(&adapter->pdev->dev, "SRE-Shim Ctrl:0x%x\n", val);
1312
1313         for (j = 0; j < 2; j++) {
1314                 if (j == 0) {
1315                         dev_info(&adapter->pdev->dev,
1316                                  "Port 0 RxB Pause Threshold Regs[TC7..TC0]:");
1317                         reg = QLC_83XX_PORT0_THRESHOLD;
1318                 } else if (j == 1) {
1319                         dev_info(&adapter->pdev->dev,
1320                                  "Port 1 RxB Pause Threshold Regs[TC7..TC0]:");
1321                         reg = QLC_83XX_PORT1_THRESHOLD;
1322                 }
1323                 for (i = 0; i < 8; i++) {
1324                         val = QLCRD32(adapter, reg + (i * 0x4), &err);
1325                         if (err == -EIO)
1326                                 return;
1327                         dev_info(&adapter->pdev->dev, "0x%x  ", val);
1328                 }
1329                 dev_info(&adapter->pdev->dev, "\n");
1330         }
1331
1332         for (j = 0; j < 2; j++) {
1333                 if (j == 0) {
1334                         dev_info(&adapter->pdev->dev,
1335                                  "Port 0 RxB TC Max Cell Registers[4..1]:");
1336                         reg = QLC_83XX_PORT0_TC_MC_REG;
1337                 } else if (j == 1) {
1338                         dev_info(&adapter->pdev->dev,
1339                                  "Port 1 RxB TC Max Cell Registers[4..1]:");
1340                         reg = QLC_83XX_PORT1_TC_MC_REG;
1341                 }
1342                 for (i = 0; i < 4; i++) {
1343                         val = QLCRD32(adapter, reg + (i * 0x4), &err);
1344                         if (err == -EIO)
1345                                 return;
1346                         dev_info(&adapter->pdev->dev, "0x%x  ", val);
1347                 }
1348                 dev_info(&adapter->pdev->dev, "\n");
1349         }
1350
1351         for (j = 0; j < 2; j++) {
1352                 if (j == 0) {
1353                         dev_info(&adapter->pdev->dev,
1354                                  "Port 0 RxB Rx TC Stats[TC7..TC0]:");
1355                         reg = QLC_83XX_PORT0_TC_STATS;
1356                 } else if (j == 1) {
1357                         dev_info(&adapter->pdev->dev,
1358                                  "Port 1 RxB Rx TC Stats[TC7..TC0]:");
1359                         reg = QLC_83XX_PORT1_TC_STATS;
1360                 }
1361                 for (i = 7; i >= 0; i--) {
1362                         val = QLCRD32(adapter, reg, &err);
1363                         if (err == -EIO)
1364                                 return;
1365                         val &= ~(0x7 << 29);    /* Reset bits 29 to 31 */
1366                         QLCWR32(adapter, reg, (val | (i << 29)));
1367                         val = QLCRD32(adapter, reg, &err);
1368                         if (err == -EIO)
1369                                 return;
1370                         dev_info(&adapter->pdev->dev, "0x%x  ", val);
1371                 }
1372                 dev_info(&adapter->pdev->dev, "\n");
1373         }
1374
1375         val = QLCRD32(adapter, QLC_83XX_PORT2_IFB_THRESHOLD, &err);
1376         if (err == -EIO)
1377                 return;
1378         val1 = QLCRD32(adapter, QLC_83XX_PORT3_IFB_THRESHOLD, &err);
1379         if (err == -EIO)
1380                 return;
1381         dev_info(&adapter->pdev->dev,
1382                  "IFB-Pause Thresholds: Port 2:0x%x, Port 3:0x%x\n",
1383                  val, val1);
1384 }
1385
1386
1387 static void qlcnic_83xx_disable_pause_frames(struct qlcnic_adapter *adapter)
1388 {
1389         u32 reg = 0, i, j;
1390
1391         if (qlcnic_83xx_lock_driver(adapter)) {
1392                 dev_err(&adapter->pdev->dev,
1393                         "%s:failed to acquire driver lock\n", __func__);
1394                 return;
1395         }
1396
1397         qlcnic_83xx_dump_pause_control_regs(adapter);
1398         QLCWR32(adapter, QLC_83XX_SRE_SHIM_REG, 0x0);
1399
1400         for (j = 0; j < 2; j++) {
1401                 if (j == 0)
1402                         reg = QLC_83XX_PORT0_THRESHOLD;
1403                 else if (j == 1)
1404                         reg = QLC_83XX_PORT1_THRESHOLD;
1405
1406                 for (i = 0; i < 8; i++)
1407                         QLCWR32(adapter, reg + (i * 0x4), 0x0);
1408         }
1409
1410         for (j = 0; j < 2; j++) {
1411                 if (j == 0)
1412                         reg = QLC_83XX_PORT0_TC_MC_REG;
1413                 else if (j == 1)
1414                         reg = QLC_83XX_PORT1_TC_MC_REG;
1415
1416                 for (i = 0; i < 4; i++)
1417                         QLCWR32(adapter, reg + (i * 0x4), 0x03FF03FF);
1418         }
1419
1420         QLCWR32(adapter, QLC_83XX_PORT2_IFB_THRESHOLD, 0);
1421         QLCWR32(adapter, QLC_83XX_PORT3_IFB_THRESHOLD, 0);
1422         dev_info(&adapter->pdev->dev,
1423                  "Disabled pause frames successfully on all ports\n");
1424         qlcnic_83xx_unlock_driver(adapter);
1425 }
1426
1427 static void qlcnic_83xx_take_eport_out_of_reset(struct qlcnic_adapter *adapter)
1428 {
1429         QLCWR32(adapter, QLC_83XX_RESET_REG, 0);
1430         QLCWR32(adapter, QLC_83XX_RESET_PORT0, 0);
1431         QLCWR32(adapter, QLC_83XX_RESET_PORT1, 0);
1432         QLCWR32(adapter, QLC_83XX_RESET_PORT2, 0);
1433         QLCWR32(adapter, QLC_83XX_RESET_PORT3, 0);
1434         QLCWR32(adapter, QLC_83XX_RESET_SRESHIM, 0);
1435         QLCWR32(adapter, QLC_83XX_RESET_EPGSHIM, 0);
1436         QLCWR32(adapter, QLC_83XX_RESET_ETHERPCS, 0);
1437         QLCWR32(adapter, QLC_83XX_RESET_CONTROL, 1);
1438 }
1439
1440 static int qlcnic_83xx_check_heartbeat(struct qlcnic_adapter *p_dev)
1441 {
1442         u32 heartbeat, peg_status;
1443         int retries, ret = -EIO, err = 0;
1444
1445         retries = QLCNIC_HEARTBEAT_CHECK_RETRY_COUNT;
1446         p_dev->heartbeat = QLC_SHARED_REG_RD32(p_dev,
1447                                                QLCNIC_PEG_ALIVE_COUNTER);
1448
1449         do {
1450                 msleep(QLCNIC_HEARTBEAT_PERIOD_MSECS);
1451                 heartbeat = QLC_SHARED_REG_RD32(p_dev,
1452                                                 QLCNIC_PEG_ALIVE_COUNTER);
1453                 if (heartbeat != p_dev->heartbeat) {
1454                         ret = QLCNIC_RCODE_SUCCESS;
1455                         break;
1456                 }
1457         } while (--retries);
1458
1459         if (ret) {
1460                 dev_err(&p_dev->pdev->dev, "firmware hang detected\n");
1461                 qlcnic_83xx_take_eport_out_of_reset(p_dev);
1462                 qlcnic_83xx_disable_pause_frames(p_dev);
1463                 peg_status = QLC_SHARED_REG_RD32(p_dev,
1464                                                  QLCNIC_PEG_HALT_STATUS1);
1465                 dev_info(&p_dev->pdev->dev, "Dumping HW/FW registers\n"
1466                          "PEG_HALT_STATUS1: 0x%x, PEG_HALT_STATUS2: 0x%x,\n"
1467                          "PEG_NET_0_PC: 0x%x, PEG_NET_1_PC: 0x%x,\n"
1468                          "PEG_NET_2_PC: 0x%x, PEG_NET_3_PC: 0x%x,\n"
1469                          "PEG_NET_4_PC: 0x%x\n", peg_status,
1470                          QLC_SHARED_REG_RD32(p_dev, QLCNIC_PEG_HALT_STATUS2),
1471                          QLCRD32(p_dev, QLC_83XX_CRB_PEG_NET_0, &err),
1472                          QLCRD32(p_dev, QLC_83XX_CRB_PEG_NET_1, &err),
1473                          QLCRD32(p_dev, QLC_83XX_CRB_PEG_NET_2, &err),
1474                          QLCRD32(p_dev, QLC_83XX_CRB_PEG_NET_3, &err),
1475                          QLCRD32(p_dev, QLC_83XX_CRB_PEG_NET_4, &err));
1476
1477                 if (QLCNIC_FWERROR_CODE(peg_status) == 0x67)
1478                         dev_err(&p_dev->pdev->dev,
1479                                 "Device is being reset err code 0x00006700.\n");
1480         }
1481
1482         return ret;
1483 }
1484
1485 static int qlcnic_83xx_check_cmd_peg_status(struct qlcnic_adapter *p_dev)
1486 {
1487         int retries = QLCNIC_CMDPEG_CHECK_RETRY_COUNT;
1488         u32 val;
1489
1490         do {
1491                 val = QLC_SHARED_REG_RD32(p_dev, QLCNIC_CMDPEG_STATE);
1492                 if (val == QLC_83XX_CMDPEG_COMPLETE)
1493                         return 0;
1494                 msleep(QLCNIC_CMDPEG_CHECK_DELAY);
1495         } while (--retries);
1496
1497         dev_err(&p_dev->pdev->dev, "%s: failed, state = 0x%x\n", __func__, val);
1498         return -EIO;
1499 }
1500
1501 int qlcnic_83xx_check_hw_status(struct qlcnic_adapter *p_dev)
1502 {
1503         int err;
1504
1505         err = qlcnic_83xx_check_cmd_peg_status(p_dev);
1506         if (err)
1507                 return err;
1508
1509         err = qlcnic_83xx_check_heartbeat(p_dev);
1510         if (err)
1511                 return err;
1512
1513         return err;
1514 }
1515
1516 static int qlcnic_83xx_poll_reg(struct qlcnic_adapter *p_dev, u32 addr,
1517                                 int duration, u32 mask, u32 status)
1518 {
1519         int timeout_error, err = 0;
1520         u32 value;
1521         u8 retries;
1522
1523         value = QLCRD32(p_dev, addr, &err);
1524         if (err == -EIO)
1525                 return err;
1526         retries = duration / 10;
1527
1528         do {
1529                 if ((value & mask) != status) {
1530                         timeout_error = 1;
1531                         msleep(duration / 10);
1532                         value = QLCRD32(p_dev, addr, &err);
1533                         if (err == -EIO)
1534                                 return err;
1535                 } else {
1536                         timeout_error = 0;
1537                         break;
1538                 }
1539         } while (retries--);
1540
1541         if (timeout_error) {
1542                 p_dev->ahw->reset.seq_error++;
1543                 dev_err(&p_dev->pdev->dev,
1544                         "%s: Timeout Err, entry_num = %d\n",
1545                         __func__, p_dev->ahw->reset.seq_index);
1546                 dev_err(&p_dev->pdev->dev,
1547                         "0x%08x 0x%08x 0x%08x\n",
1548                         value, mask, status);
1549         }
1550
1551         return timeout_error;
1552 }
1553
1554 static int qlcnic_83xx_reset_template_checksum(struct qlcnic_adapter *p_dev)
1555 {
1556         u32 sum = 0;
1557         u16 *buff = (u16 *)p_dev->ahw->reset.buff;
1558         int count = p_dev->ahw->reset.hdr->size / sizeof(u16);
1559
1560         while (count-- > 0)
1561                 sum += *buff++;
1562
1563         while (sum >> 16)
1564                 sum = (sum & 0xFFFF) + (sum >> 16);
1565
1566         if (~sum) {
1567                 return 0;
1568         } else {
1569                 dev_err(&p_dev->pdev->dev, "%s: failed\n", __func__);
1570                 return -1;
1571         }
1572 }
1573
1574 int qlcnic_83xx_get_reset_instruction_template(struct qlcnic_adapter *p_dev)
1575 {
1576         struct qlcnic_hardware_context *ahw = p_dev->ahw;
1577         u32 addr, count, prev_ver, curr_ver;
1578         u8 *p_buff;
1579
1580         if (ahw->reset.buff != NULL) {
1581                 prev_ver = p_dev->fw_version;
1582                 curr_ver = qlcnic_83xx_get_fw_version(p_dev);
1583                 if (curr_ver > prev_ver)
1584                         kfree(ahw->reset.buff);
1585                 else
1586                         return 0;
1587         }
1588
1589         ahw->reset.seq_error = 0;
1590         ahw->reset.buff = kzalloc(QLC_83XX_RESTART_TEMPLATE_SIZE, GFP_KERNEL);
1591         if (p_dev->ahw->reset.buff == NULL)
1592                 return -ENOMEM;
1593
1594         p_buff = p_dev->ahw->reset.buff;
1595         addr = QLC_83XX_RESET_TEMPLATE_ADDR;
1596         count = sizeof(struct qlc_83xx_reset_hdr) / sizeof(u32);
1597
1598         /* Copy template header from flash */
1599         if (qlcnic_83xx_flash_read32(p_dev, addr, p_buff, count)) {
1600                 dev_err(&p_dev->pdev->dev, "%s: flash read failed\n", __func__);
1601                 return -EIO;
1602         }
1603         ahw->reset.hdr = (struct qlc_83xx_reset_hdr *)ahw->reset.buff;
1604         addr = QLC_83XX_RESET_TEMPLATE_ADDR + ahw->reset.hdr->hdr_size;
1605         p_buff = ahw->reset.buff + ahw->reset.hdr->hdr_size;
1606         count = (ahw->reset.hdr->size - ahw->reset.hdr->hdr_size) / sizeof(u32);
1607
1608         /* Copy rest of the template */
1609         if (qlcnic_83xx_flash_read32(p_dev, addr, p_buff, count)) {
1610                 dev_err(&p_dev->pdev->dev, "%s: flash read failed\n", __func__);
1611                 return -EIO;
1612         }
1613
1614         if (qlcnic_83xx_reset_template_checksum(p_dev))
1615                 return -EIO;
1616         /* Get Stop, Start and Init command offsets */
1617         ahw->reset.init_offset = ahw->reset.buff + ahw->reset.hdr->init_offset;
1618         ahw->reset.start_offset = ahw->reset.buff +
1619                                   ahw->reset.hdr->start_offset;
1620         ahw->reset.stop_offset = ahw->reset.buff + ahw->reset.hdr->hdr_size;
1621         return 0;
1622 }
1623
1624 /* Read Write HW register command */
1625 static void qlcnic_83xx_read_write_crb_reg(struct qlcnic_adapter *p_dev,
1626                                            u32 raddr, u32 waddr)
1627 {
1628         int err = 0;
1629         u32 value;
1630
1631         value = QLCRD32(p_dev, raddr, &err);
1632         if (err == -EIO)
1633                 return;
1634         qlcnic_83xx_wrt_reg_indirect(p_dev, waddr, value);
1635 }
1636
1637 /* Read Modify Write HW register command */
1638 static void qlcnic_83xx_rmw_crb_reg(struct qlcnic_adapter *p_dev,
1639                                     u32 raddr, u32 waddr,
1640                                     struct qlc_83xx_rmw *p_rmw_hdr)
1641 {
1642         int err = 0;
1643         u32 value;
1644
1645         if (p_rmw_hdr->index_a) {
1646                 value = p_dev->ahw->reset.array[p_rmw_hdr->index_a];
1647         } else {
1648                 value = QLCRD32(p_dev, raddr, &err);
1649                 if (err == -EIO)
1650                         return;
1651         }
1652
1653         value &= p_rmw_hdr->mask;
1654         value <<= p_rmw_hdr->shl;
1655         value >>= p_rmw_hdr->shr;
1656         value |= p_rmw_hdr->or_value;
1657         value ^= p_rmw_hdr->xor_value;
1658         qlcnic_83xx_wrt_reg_indirect(p_dev, waddr, value);
1659 }
1660
1661 /* Write HW register command */
1662 static void qlcnic_83xx_write_list(struct qlcnic_adapter *p_dev,
1663                                    struct qlc_83xx_entry_hdr *p_hdr)
1664 {
1665         int i;
1666         struct qlc_83xx_entry *entry;
1667
1668         entry = (struct qlc_83xx_entry *)((char *)p_hdr +
1669                                           sizeof(struct qlc_83xx_entry_hdr));
1670
1671         for (i = 0; i < p_hdr->count; i++, entry++) {
1672                 qlcnic_83xx_wrt_reg_indirect(p_dev, entry->arg1,
1673                                              entry->arg2);
1674                 if (p_hdr->delay)
1675                         udelay((u32)(p_hdr->delay));
1676         }
1677 }
1678
1679 /* Read and Write instruction */
1680 static void qlcnic_83xx_read_write_list(struct qlcnic_adapter *p_dev,
1681                                         struct qlc_83xx_entry_hdr *p_hdr)
1682 {
1683         int i;
1684         struct qlc_83xx_entry *entry;
1685
1686         entry = (struct qlc_83xx_entry *)((char *)p_hdr +
1687                                           sizeof(struct qlc_83xx_entry_hdr));
1688
1689         for (i = 0; i < p_hdr->count; i++, entry++) {
1690                 qlcnic_83xx_read_write_crb_reg(p_dev, entry->arg1,
1691                                                entry->arg2);
1692                 if (p_hdr->delay)
1693                         udelay((u32)(p_hdr->delay));
1694         }
1695 }
1696
1697 /* Poll HW register command */
1698 static void qlcnic_83xx_poll_list(struct qlcnic_adapter *p_dev,
1699                                   struct qlc_83xx_entry_hdr *p_hdr)
1700 {
1701         long delay;
1702         struct qlc_83xx_entry *entry;
1703         struct qlc_83xx_poll *poll;
1704         int i, err = 0;
1705         unsigned long arg1, arg2;
1706
1707         poll = (struct qlc_83xx_poll *)((char *)p_hdr +
1708                                         sizeof(struct qlc_83xx_entry_hdr));
1709
1710         entry = (struct qlc_83xx_entry *)((char *)poll +
1711                                           sizeof(struct qlc_83xx_poll));
1712         delay = (long)p_hdr->delay;
1713
1714         if (!delay) {
1715                 for (i = 0; i < p_hdr->count; i++, entry++)
1716                         qlcnic_83xx_poll_reg(p_dev, entry->arg1,
1717                                              delay, poll->mask,
1718                                              poll->status);
1719         } else {
1720                 for (i = 0; i < p_hdr->count; i++, entry++) {
1721                         arg1 = entry->arg1;
1722                         arg2 = entry->arg2;
1723                         if (delay) {
1724                                 if (qlcnic_83xx_poll_reg(p_dev,
1725                                                          arg1, delay,
1726                                                          poll->mask,
1727                                                          poll->status)){
1728                                         QLCRD32(p_dev, arg1, &err);
1729                                         if (err == -EIO)
1730                                                 return;
1731                                         QLCRD32(p_dev, arg2, &err);
1732                                         if (err == -EIO)
1733                                                 return;
1734                                 }
1735                         }
1736                 }
1737         }
1738 }
1739
1740 /* Poll and write HW register command */
1741 static void qlcnic_83xx_poll_write_list(struct qlcnic_adapter *p_dev,
1742                                         struct qlc_83xx_entry_hdr *p_hdr)
1743 {
1744         int i;
1745         long delay;
1746         struct qlc_83xx_quad_entry *entry;
1747         struct qlc_83xx_poll *poll;
1748
1749         poll = (struct qlc_83xx_poll *)((char *)p_hdr +
1750                                         sizeof(struct qlc_83xx_entry_hdr));
1751         entry = (struct qlc_83xx_quad_entry *)((char *)poll +
1752                                                sizeof(struct qlc_83xx_poll));
1753         delay = (long)p_hdr->delay;
1754
1755         for (i = 0; i < p_hdr->count; i++, entry++) {
1756                 qlcnic_83xx_wrt_reg_indirect(p_dev, entry->dr_addr,
1757                                              entry->dr_value);
1758                 qlcnic_83xx_wrt_reg_indirect(p_dev, entry->ar_addr,
1759                                              entry->ar_value);
1760                 if (delay)
1761                         qlcnic_83xx_poll_reg(p_dev, entry->ar_addr, delay,
1762                                              poll->mask, poll->status);
1763         }
1764 }
1765
1766 /* Read Modify Write register command */
1767 static void qlcnic_83xx_read_modify_write(struct qlcnic_adapter *p_dev,
1768                                           struct qlc_83xx_entry_hdr *p_hdr)
1769 {
1770         int i;
1771         struct qlc_83xx_entry *entry;
1772         struct qlc_83xx_rmw *rmw_hdr;
1773
1774         rmw_hdr = (struct qlc_83xx_rmw *)((char *)p_hdr +
1775                                           sizeof(struct qlc_83xx_entry_hdr));
1776
1777         entry = (struct qlc_83xx_entry *)((char *)rmw_hdr +
1778                                           sizeof(struct qlc_83xx_rmw));
1779
1780         for (i = 0; i < p_hdr->count; i++, entry++) {
1781                 qlcnic_83xx_rmw_crb_reg(p_dev, entry->arg1,
1782                                         entry->arg2, rmw_hdr);
1783                 if (p_hdr->delay)
1784                         udelay((u32)(p_hdr->delay));
1785         }
1786 }
1787
1788 static void qlcnic_83xx_pause(struct qlc_83xx_entry_hdr *p_hdr)
1789 {
1790         if (p_hdr->delay)
1791                 mdelay((u32)((long)p_hdr->delay));
1792 }
1793
1794 /* Read and poll register command */
1795 static void qlcnic_83xx_poll_read_list(struct qlcnic_adapter *p_dev,
1796                                        struct qlc_83xx_entry_hdr *p_hdr)
1797 {
1798         long delay;
1799         int index, i, j, err;
1800         struct qlc_83xx_quad_entry *entry;
1801         struct qlc_83xx_poll *poll;
1802         unsigned long addr;
1803
1804         poll = (struct qlc_83xx_poll *)((char *)p_hdr +
1805                                         sizeof(struct qlc_83xx_entry_hdr));
1806
1807         entry = (struct qlc_83xx_quad_entry *)((char *)poll +
1808                                                sizeof(struct qlc_83xx_poll));
1809         delay = (long)p_hdr->delay;
1810
1811         for (i = 0; i < p_hdr->count; i++, entry++) {
1812                 qlcnic_83xx_wrt_reg_indirect(p_dev, entry->ar_addr,
1813                                              entry->ar_value);
1814                 if (delay) {
1815                         if (!qlcnic_83xx_poll_reg(p_dev, entry->ar_addr, delay,
1816                                                   poll->mask, poll->status)){
1817                                 index = p_dev->ahw->reset.array_index;
1818                                 addr = entry->dr_addr;
1819                                 j = QLCRD32(p_dev, addr, &err);
1820                                 if (err == -EIO)
1821                                         return;
1822
1823                                 p_dev->ahw->reset.array[index++] = j;
1824
1825                                 if (index == QLC_83XX_MAX_RESET_SEQ_ENTRIES)
1826                                         p_dev->ahw->reset.array_index = 1;
1827                         }
1828                 }
1829         }
1830 }
1831
1832 static inline void qlcnic_83xx_seq_end(struct qlcnic_adapter *p_dev)
1833 {
1834         p_dev->ahw->reset.seq_end = 1;
1835 }
1836
1837 static void qlcnic_83xx_template_end(struct qlcnic_adapter *p_dev)
1838 {
1839         p_dev->ahw->reset.template_end = 1;
1840         if (p_dev->ahw->reset.seq_error == 0)
1841                 dev_err(&p_dev->pdev->dev,
1842                         "HW restart process completed successfully.\n");
1843         else
1844                 dev_err(&p_dev->pdev->dev,
1845                         "HW restart completed with timeout errors.\n");
1846 }
1847
1848 /**
1849 * qlcnic_83xx_exec_template_cmd
1850 *
1851 * @p_dev: adapter structure
1852 * @p_buff: Poiter to instruction template
1853 *
1854 * Template provides instructions to stop, restart and initalize firmware.
1855 * These instructions are abstracted as a series of read, write and
1856 * poll operations on hardware registers. Register information and operation
1857 * specifics are not exposed to the driver. Driver reads the template from
1858 * flash and executes the instructions located at pre-defined offsets.
1859 *
1860 * Returns: None
1861 * */
1862 static void qlcnic_83xx_exec_template_cmd(struct qlcnic_adapter *p_dev,
1863                                           char *p_buff)
1864 {
1865         int index, entries;
1866         struct qlc_83xx_entry_hdr *p_hdr;
1867         char *entry = p_buff;
1868
1869         p_dev->ahw->reset.seq_end = 0;
1870         p_dev->ahw->reset.template_end = 0;
1871         entries = p_dev->ahw->reset.hdr->entries;
1872         index = p_dev->ahw->reset.seq_index;
1873
1874         for (; (!p_dev->ahw->reset.seq_end) && (index < entries); index++) {
1875                 p_hdr = (struct qlc_83xx_entry_hdr *)entry;
1876
1877                 switch (p_hdr->cmd) {
1878                 case QLC_83XX_OPCODE_NOP:
1879                         break;
1880                 case QLC_83XX_OPCODE_WRITE_LIST:
1881                         qlcnic_83xx_write_list(p_dev, p_hdr);
1882                         break;
1883                 case QLC_83XX_OPCODE_READ_WRITE_LIST:
1884                         qlcnic_83xx_read_write_list(p_dev, p_hdr);
1885                         break;
1886                 case QLC_83XX_OPCODE_POLL_LIST:
1887                         qlcnic_83xx_poll_list(p_dev, p_hdr);
1888                         break;
1889                 case QLC_83XX_OPCODE_POLL_WRITE_LIST:
1890                         qlcnic_83xx_poll_write_list(p_dev, p_hdr);
1891                         break;
1892                 case QLC_83XX_OPCODE_READ_MODIFY_WRITE:
1893                         qlcnic_83xx_read_modify_write(p_dev, p_hdr);
1894                         break;
1895                 case QLC_83XX_OPCODE_SEQ_PAUSE:
1896                         qlcnic_83xx_pause(p_hdr);
1897                         break;
1898                 case QLC_83XX_OPCODE_SEQ_END:
1899                         qlcnic_83xx_seq_end(p_dev);
1900                         break;
1901                 case QLC_83XX_OPCODE_TMPL_END:
1902                         qlcnic_83xx_template_end(p_dev);
1903                         break;
1904                 case QLC_83XX_OPCODE_POLL_READ_LIST:
1905                         qlcnic_83xx_poll_read_list(p_dev, p_hdr);
1906                         break;
1907                 default:
1908                         dev_err(&p_dev->pdev->dev,
1909                                 "%s: Unknown opcode 0x%04x in template %d\n",
1910                                 __func__, p_hdr->cmd, index);
1911                         break;
1912                 }
1913                 entry += p_hdr->size;
1914         }
1915         p_dev->ahw->reset.seq_index = index;
1916 }
1917
1918 static void qlcnic_83xx_stop_hw(struct qlcnic_adapter *p_dev)
1919 {
1920         p_dev->ahw->reset.seq_index = 0;
1921
1922         qlcnic_83xx_exec_template_cmd(p_dev, p_dev->ahw->reset.stop_offset);
1923         if (p_dev->ahw->reset.seq_end != 1)
1924                 dev_err(&p_dev->pdev->dev, "%s: failed\n", __func__);
1925 }
1926
1927 static void qlcnic_83xx_start_hw(struct qlcnic_adapter *p_dev)
1928 {
1929         qlcnic_83xx_exec_template_cmd(p_dev, p_dev->ahw->reset.start_offset);
1930         if (p_dev->ahw->reset.template_end != 1)
1931                 dev_err(&p_dev->pdev->dev, "%s: failed\n", __func__);
1932 }
1933
1934 static void qlcnic_83xx_init_hw(struct qlcnic_adapter *p_dev)
1935 {
1936         qlcnic_83xx_exec_template_cmd(p_dev, p_dev->ahw->reset.init_offset);
1937         if (p_dev->ahw->reset.seq_end != 1)
1938                 dev_err(&p_dev->pdev->dev, "%s: failed\n", __func__);
1939 }
1940
1941 static int qlcnic_83xx_load_fw_image_from_host(struct qlcnic_adapter *adapter)
1942 {
1943         int err = -EIO;
1944
1945         if (request_firmware(&adapter->ahw->fw_info.fw,
1946                              QLC_83XX_FW_FILE_NAME, &(adapter->pdev->dev))) {
1947                 dev_err(&adapter->pdev->dev,
1948                         "No file FW image, loading flash FW image.\n");
1949                 QLC_SHARED_REG_WR32(adapter, QLCNIC_FW_IMG_VALID,
1950                                     QLC_83XX_BOOT_FROM_FLASH);
1951         } else {
1952                 if (qlcnic_83xx_copy_fw_file(adapter))
1953                         return err;
1954                 QLC_SHARED_REG_WR32(adapter, QLCNIC_FW_IMG_VALID,
1955                                     QLC_83XX_BOOT_FROM_FILE);
1956         }
1957
1958         return 0;
1959 }
1960
1961 static int qlcnic_83xx_restart_hw(struct qlcnic_adapter *adapter)
1962 {
1963         u32 val;
1964         int err = -EIO;
1965
1966         qlcnic_83xx_stop_hw(adapter);
1967
1968         /* Collect FW register dump if required */
1969         val = QLCRDX(adapter->ahw, QLC_83XX_IDC_CTRL);
1970         if (!(val & QLC_83XX_IDC_GRACEFULL_RESET))
1971                 qlcnic_dump_fw(adapter);
1972         qlcnic_83xx_init_hw(adapter);
1973
1974         if (qlcnic_83xx_copy_bootloader(adapter))
1975                 return err;
1976         /* Boot either flash image or firmware image from host file system */
1977         if (qlcnic_load_fw_file) {
1978                 if (qlcnic_83xx_load_fw_image_from_host(adapter))
1979                         return err;
1980         } else {
1981                 QLC_SHARED_REG_WR32(adapter, QLCNIC_FW_IMG_VALID,
1982                                     QLC_83XX_BOOT_FROM_FLASH);
1983         }
1984
1985         qlcnic_83xx_start_hw(adapter);
1986         if (qlcnic_83xx_check_hw_status(adapter))
1987                 return -EIO;
1988
1989         return 0;
1990 }
1991
1992 /**
1993 * qlcnic_83xx_config_default_opmode
1994 *
1995 * @adapter: adapter structure
1996 *
1997 * Configure default driver operating mode
1998 *
1999 * Returns: Error code or Success(0)
2000 * */
2001 int qlcnic_83xx_config_default_opmode(struct qlcnic_adapter *adapter)
2002 {
2003         u32 op_mode;
2004         struct qlcnic_hardware_context *ahw = adapter->ahw;
2005
2006         qlcnic_get_func_no(adapter);
2007         op_mode = QLCRDX(ahw, QLC_83XX_DRV_OP_MODE);
2008
2009         if (test_bit(__QLCNIC_SRIOV_CAPABLE, &adapter->state))
2010                 op_mode = QLC_83XX_DEFAULT_OPMODE;
2011
2012         if (op_mode == QLC_83XX_DEFAULT_OPMODE) {
2013                 adapter->nic_ops->init_driver = qlcnic_83xx_init_default_driver;
2014                 ahw->idc.state_entry = qlcnic_83xx_idc_ready_state_entry;
2015         } else {
2016                 return -EIO;
2017         }
2018
2019         return 0;
2020 }
2021
2022 int qlcnic_83xx_get_nic_configuration(struct qlcnic_adapter *adapter)
2023 {
2024         int err;
2025         struct qlcnic_info nic_info;
2026         struct qlcnic_hardware_context *ahw = adapter->ahw;
2027
2028         memset(&nic_info, 0, sizeof(struct qlcnic_info));
2029         err = qlcnic_get_nic_info(adapter, &nic_info, ahw->pci_func);
2030         if (err)
2031                 return -EIO;
2032
2033         ahw->physical_port = (u8) nic_info.phys_port;
2034         ahw->switch_mode = nic_info.switch_mode;
2035         ahw->max_tx_ques = nic_info.max_tx_ques;
2036         ahw->max_rx_ques = nic_info.max_rx_ques;
2037         ahw->capabilities = nic_info.capabilities;
2038         ahw->max_mac_filters = nic_info.max_mac_filters;
2039         ahw->max_mtu = nic_info.max_mtu;
2040
2041         /* VNIC mode is detected by BIT_23 in capabilities. This bit is also
2042          * set in case device is SRIOV capable. VNIC and SRIOV are mutually
2043          * exclusive. So in case of sriov capable device load driver in
2044          * default mode
2045          */
2046         if (test_bit(__QLCNIC_SRIOV_CAPABLE, &adapter->state)) {
2047                 ahw->nic_mode = QLC_83XX_DEFAULT_MODE;
2048                 return ahw->nic_mode;
2049         }
2050
2051         if (ahw->capabilities & BIT_23)
2052                 ahw->nic_mode = QLC_83XX_VIRTUAL_NIC_MODE;
2053         else
2054                 ahw->nic_mode = QLC_83XX_DEFAULT_MODE;
2055
2056         return ahw->nic_mode;
2057 }
2058
2059 int qlcnic_83xx_configure_opmode(struct qlcnic_adapter *adapter)
2060 {
2061         int ret;
2062
2063         ret = qlcnic_83xx_get_nic_configuration(adapter);
2064         if (ret == -EIO)
2065                 return -EIO;
2066
2067         if (ret == QLC_83XX_VIRTUAL_NIC_MODE) {
2068                 if (qlcnic_83xx_config_vnic_opmode(adapter))
2069                         return -EIO;
2070         } else if (ret == QLC_83XX_DEFAULT_MODE) {
2071                 if (qlcnic_83xx_config_default_opmode(adapter))
2072                         return -EIO;
2073         }
2074
2075         return 0;
2076 }
2077
2078 static void qlcnic_83xx_config_buff_descriptors(struct qlcnic_adapter *adapter)
2079 {
2080         struct qlcnic_hardware_context *ahw = adapter->ahw;
2081
2082         if (ahw->port_type == QLCNIC_XGBE) {
2083                 adapter->num_rxd = DEFAULT_RCV_DESCRIPTORS_10G;
2084                 adapter->max_rxd = MAX_RCV_DESCRIPTORS_10G;
2085                 adapter->num_jumbo_rxd = MAX_JUMBO_RCV_DESCRIPTORS_10G;
2086                 adapter->max_jumbo_rxd = MAX_JUMBO_RCV_DESCRIPTORS_10G;
2087
2088         } else if (ahw->port_type == QLCNIC_GBE) {
2089                 adapter->num_rxd = DEFAULT_RCV_DESCRIPTORS_1G;
2090                 adapter->num_jumbo_rxd = MAX_JUMBO_RCV_DESCRIPTORS_1G;
2091                 adapter->max_jumbo_rxd = MAX_JUMBO_RCV_DESCRIPTORS_1G;
2092                 adapter->max_rxd = MAX_RCV_DESCRIPTORS_1G;
2093         }
2094         adapter->num_txd = MAX_CMD_DESCRIPTORS;
2095         adapter->max_rds_rings = MAX_RDS_RINGS;
2096 }
2097
2098 static int qlcnic_83xx_init_default_driver(struct qlcnic_adapter *adapter)
2099 {
2100         int err = -EIO;
2101
2102         qlcnic_83xx_get_minidump_template(adapter);
2103         if (qlcnic_83xx_get_port_info(adapter))
2104                 return err;
2105
2106         qlcnic_83xx_config_buff_descriptors(adapter);
2107         adapter->ahw->msix_supported = !!qlcnic_use_msi_x;
2108         adapter->flags |= QLCNIC_ADAPTER_INITIALIZED;
2109
2110         dev_info(&adapter->pdev->dev, "HAL Version: %d\n",
2111                  adapter->ahw->fw_hal_version);
2112
2113         return 0;
2114 }
2115
2116 #define IS_QLC_83XX_USED(a, b, c) (((1 << a->portnum) & b) || ((c >> 6) & 0x1))
2117 static void qlcnic_83xx_clear_function_resources(struct qlcnic_adapter *adapter)
2118 {
2119         struct qlcnic_cmd_args cmd;
2120         u32 presence_mask, audit_mask;
2121         int status;
2122
2123         presence_mask = QLCRDX(adapter->ahw, QLC_83XX_IDC_DRV_PRESENCE);
2124         audit_mask = QLCRDX(adapter->ahw, QLC_83XX_IDC_DRV_AUDIT);
2125
2126         if (IS_QLC_83XX_USED(adapter, presence_mask, audit_mask)) {
2127                 status = qlcnic_alloc_mbx_args(&cmd, adapter,
2128                                                QLCNIC_CMD_STOP_NIC_FUNC);
2129                 if (status)
2130                         return;
2131
2132                 cmd.req.arg[1] = BIT_31;
2133                 status = qlcnic_issue_cmd(adapter, &cmd);
2134                 if (status)
2135                         dev_err(&adapter->pdev->dev,
2136                                 "Failed to clean up the function resources\n");
2137                 qlcnic_free_mbx_args(&cmd);
2138         }
2139 }
2140
2141 int qlcnic_83xx_init(struct qlcnic_adapter *adapter, int pci_using_dac)
2142 {
2143         struct qlcnic_hardware_context *ahw = adapter->ahw;
2144
2145         if (qlcnic_sriov_vf_check(adapter))
2146                 return qlcnic_sriov_vf_init(adapter, pci_using_dac);
2147
2148         if (qlcnic_83xx_check_hw_status(adapter))
2149                 return -EIO;
2150
2151         /* Initilaize 83xx mailbox spinlock */
2152         spin_lock_init(&ahw->mbx_lock);
2153
2154         set_bit(QLC_83XX_MBX_READY, &adapter->ahw->idc.status);
2155         qlcnic_83xx_clear_function_resources(adapter);
2156
2157         INIT_DELAYED_WORK(&adapter->idc_aen_work, qlcnic_83xx_idc_aen_work);
2158
2159         /* register for NIC IDC AEN Events */
2160         qlcnic_83xx_register_nic_idc_func(adapter, 1);
2161
2162         if (!qlcnic_83xx_read_flash_descriptor_table(adapter))
2163                 qlcnic_83xx_read_flash_mfg_id(adapter);
2164
2165         if (qlcnic_83xx_idc_init(adapter))
2166                 return -EIO;
2167
2168         /* Configure default, SR-IOV or Virtual NIC mode of operation */
2169         if (qlcnic_83xx_configure_opmode(adapter))
2170                 return -EIO;
2171
2172         /* Perform operating mode specific initialization */
2173         if (adapter->nic_ops->init_driver(adapter))
2174                 return -EIO;
2175
2176         /* Periodically monitor device status */
2177         qlcnic_83xx_idc_poll_dev_state(&adapter->fw_work.work);
2178
2179         return adapter->ahw->idc.err_code;
2180 }