scsi: qla2xxx: Fix a Coverity complaint in qla2100_fw_dump()
[platform/kernel/linux-rpi.git] / drivers / scsi / qla2xxx / qla_dbg.c
1 /*
2  * QLogic Fibre Channel HBA Driver
3  * Copyright (c)  2003-2014 QLogic Corporation
4  *
5  * See LICENSE.qla2xxx for copyright and licensing details.
6  */
7
8 /*
9  * Table for showing the current message id in use for particular level
10  * Change this table for addition of log/debug messages.
11  * ----------------------------------------------------------------------
12  * |             Level            |   Last Value Used  |     Holes      |
13  * ----------------------------------------------------------------------
14  * | Module Init and Probe        |       0x0193       | 0x0146         |
15  * |                              |                    | 0x015b-0x0160  |
16  * |                              |                    | 0x016e         |
17  * | Mailbox commands             |       0x1206       | 0x11a2-0x11ff  |
18  * | Device Discovery             |       0x2134       | 0x210e-0x2116  |
19  * |                              |                    | 0x211a         |
20  * |                              |                    | 0x211c-0x2128  |
21  * |                              |                    | 0x212a-0x2134  |
22  * | Queue Command and IO tracing |       0x3074       | 0x300b         |
23  * |                              |                    | 0x3027-0x3028  |
24  * |                              |                    | 0x303d-0x3041  |
25  * |                              |                    | 0x302d,0x3033  |
26  * |                              |                    | 0x3036,0x3038  |
27  * |                              |                    | 0x303a         |
28  * | DPC Thread                   |       0x4023       | 0x4002,0x4013  |
29  * | Async Events                 |       0x5090       | 0x502b-0x502f  |
30  * |                              |                    | 0x5047         |
31  * |                              |                    | 0x5084,0x5075  |
32  * |                              |                    | 0x503d,0x5044  |
33  * |                              |                    | 0x505f         |
34  * | Timer Routines               |       0x6012       |                |
35  * | User Space Interactions      |       0x70e3       | 0x7018,0x702e  |
36  * |                              |                    | 0x7020,0x7024  |
37  * |                              |                    | 0x7039,0x7045  |
38  * |                              |                    | 0x7073-0x7075  |
39  * |                              |                    | 0x70a5-0x70a6  |
40  * |                              |                    | 0x70a8,0x70ab  |
41  * |                              |                    | 0x70ad-0x70ae  |
42  * |                              |                    | 0x70d0-0x70d6  |
43  * |                              |                    | 0x70d7-0x70db  |
44  * | Task Management              |       0x8042       | 0x8000         |
45  * |                              |                    | 0x8019         |
46  * |                              |                    | 0x8025,0x8026  |
47  * |                              |                    | 0x8031,0x8032  |
48  * |                              |                    | 0x8039,0x803c  |
49  * | AER/EEH                      |       0x9011       |                |
50  * | Virtual Port                 |       0xa007       |                |
51  * | ISP82XX Specific             |       0xb157       | 0xb002,0xb024  |
52  * |                              |                    | 0xb09e,0xb0ae  |
53  * |                              |                    | 0xb0c3,0xb0c6  |
54  * |                              |                    | 0xb0e0-0xb0ef  |
55  * |                              |                    | 0xb085,0xb0dc  |
56  * |                              |                    | 0xb107,0xb108  |
57  * |                              |                    | 0xb111,0xb11e  |
58  * |                              |                    | 0xb12c,0xb12d  |
59  * |                              |                    | 0xb13a,0xb142  |
60  * |                              |                    | 0xb13c-0xb140  |
61  * |                              |                    | 0xb149         |
62  * | MultiQ                       |       0xc010       |                |
63  * | Misc                         |       0xd303       | 0xd031-0xd0ff  |
64  * |                              |                    | 0xd101-0xd1fe  |
65  * |                              |                    | 0xd214-0xd2fe  |
66  * | Target Mode                  |       0xe081       |                |
67  * | Target Mode Management       |       0xf09b       | 0xf002         |
68  * |                              |                    | 0xf046-0xf049  |
69  * | Target Mode Task Management  |       0x1000d      |                |
70  * ----------------------------------------------------------------------
71  */
72
73 #include "qla_def.h"
74
75 #include <linux/delay.h>
76 #define CREATE_TRACE_POINTS
77 #include <trace/events/qla.h>
78
79 static uint32_t ql_dbg_offset = 0x800;
80
81 static inline void
82 qla2xxx_prep_dump(struct qla_hw_data *ha, struct qla2xxx_fw_dump *fw_dump)
83 {
84         fw_dump->fw_major_version = htonl(ha->fw_major_version);
85         fw_dump->fw_minor_version = htonl(ha->fw_minor_version);
86         fw_dump->fw_subminor_version = htonl(ha->fw_subminor_version);
87         fw_dump->fw_attributes = htonl(ha->fw_attributes);
88
89         fw_dump->vendor = htonl(ha->pdev->vendor);
90         fw_dump->device = htonl(ha->pdev->device);
91         fw_dump->subsystem_vendor = htonl(ha->pdev->subsystem_vendor);
92         fw_dump->subsystem_device = htonl(ha->pdev->subsystem_device);
93 }
94
95 static inline void *
96 qla2xxx_copy_queues(struct qla_hw_data *ha, void *ptr)
97 {
98         struct req_que *req = ha->req_q_map[0];
99         struct rsp_que *rsp = ha->rsp_q_map[0];
100         /* Request queue. */
101         memcpy(ptr, req->ring, req->length *
102             sizeof(request_t));
103
104         /* Response queue. */
105         ptr += req->length * sizeof(request_t);
106         memcpy(ptr, rsp->ring, rsp->length  *
107             sizeof(response_t));
108
109         return ptr + (rsp->length * sizeof(response_t));
110 }
111
112 int
113 qla27xx_dump_mpi_ram(struct qla_hw_data *ha, uint32_t addr, uint32_t *ram,
114         uint32_t ram_dwords, void **nxt)
115 {
116         struct device_reg_24xx __iomem *reg = &ha->iobase->isp24;
117         dma_addr_t dump_dma = ha->gid_list_dma;
118         uint32_t *chunk = (uint32_t *)ha->gid_list;
119         uint32_t dwords = qla2x00_gid_list_size(ha) / 4;
120         uint32_t stat;
121         ulong i, j, timer = 6000000;
122         int rval = QLA_FUNCTION_FAILED;
123
124         clear_bit(MBX_INTERRUPT, &ha->mbx_cmd_flags);
125         for (i = 0; i < ram_dwords; i += dwords, addr += dwords) {
126                 if (i + dwords > ram_dwords)
127                         dwords = ram_dwords - i;
128
129                 wrt_reg_word(&reg->mailbox0, MBC_LOAD_DUMP_MPI_RAM);
130                 wrt_reg_word(&reg->mailbox1, LSW(addr));
131                 wrt_reg_word(&reg->mailbox8, MSW(addr));
132
133                 wrt_reg_word(&reg->mailbox2, MSW(LSD(dump_dma)));
134                 wrt_reg_word(&reg->mailbox3, LSW(LSD(dump_dma)));
135                 wrt_reg_word(&reg->mailbox6, MSW(MSD(dump_dma)));
136                 wrt_reg_word(&reg->mailbox7, LSW(MSD(dump_dma)));
137
138                 wrt_reg_word(&reg->mailbox4, MSW(dwords));
139                 wrt_reg_word(&reg->mailbox5, LSW(dwords));
140
141                 wrt_reg_word(&reg->mailbox9, 0);
142                 wrt_reg_dword(&reg->hccr, HCCRX_SET_HOST_INT);
143
144                 ha->flags.mbox_int = 0;
145                 while (timer--) {
146                         udelay(5);
147
148                         stat = rd_reg_dword(&reg->host_status);
149                         /* Check for pending interrupts. */
150                         if (!(stat & HSRX_RISC_INT))
151                                 continue;
152
153                         stat &= 0xff;
154                         if (stat != 0x1 && stat != 0x2 &&
155                             stat != 0x10 && stat != 0x11) {
156
157                                 /* Clear this intr; it wasn't a mailbox intr */
158                                 wrt_reg_dword(&reg->hccr, HCCRX_CLR_RISC_INT);
159                                 rd_reg_dword(&reg->hccr);
160                                 continue;
161                         }
162
163                         set_bit(MBX_INTERRUPT, &ha->mbx_cmd_flags);
164                         rval = rd_reg_word(&reg->mailbox0) & MBS_MASK;
165                         wrt_reg_dword(&reg->hccr, HCCRX_CLR_RISC_INT);
166                         rd_reg_dword(&reg->hccr);
167                         break;
168                 }
169                 ha->flags.mbox_int = 1;
170                 *nxt = ram + i;
171
172                 if (!test_and_clear_bit(MBX_INTERRUPT, &ha->mbx_cmd_flags)) {
173                         /* no interrupt, timed out*/
174                         return rval;
175                 }
176                 if (rval) {
177                         /* error completion status */
178                         return rval;
179                 }
180                 for (j = 0; j < dwords; j++) {
181                         ram[i + j] =
182                             (IS_QLA27XX(ha) || IS_QLA28XX(ha)) ?
183                             chunk[j] : swab32(chunk[j]);
184                 }
185         }
186
187         *nxt = ram + i;
188         return QLA_SUCCESS;
189 }
190
191 int
192 qla24xx_dump_ram(struct qla_hw_data *ha, uint32_t addr, __be32 *ram,
193                  uint32_t ram_dwords, void **nxt)
194 {
195         int rval = QLA_FUNCTION_FAILED;
196         struct device_reg_24xx __iomem *reg = &ha->iobase->isp24;
197         dma_addr_t dump_dma = ha->gid_list_dma;
198         uint32_t *chunk = (uint32_t *)ha->gid_list;
199         uint32_t dwords = qla2x00_gid_list_size(ha) / 4;
200         uint32_t stat;
201         ulong i, j, timer = 6000000;
202
203         clear_bit(MBX_INTERRUPT, &ha->mbx_cmd_flags);
204
205         for (i = 0; i < ram_dwords; i += dwords, addr += dwords) {
206                 if (i + dwords > ram_dwords)
207                         dwords = ram_dwords - i;
208
209                 wrt_reg_word(&reg->mailbox0, MBC_DUMP_RISC_RAM_EXTENDED);
210                 wrt_reg_word(&reg->mailbox1, LSW(addr));
211                 wrt_reg_word(&reg->mailbox8, MSW(addr));
212
213                 wrt_reg_word(&reg->mailbox2, MSW(LSD(dump_dma)));
214                 wrt_reg_word(&reg->mailbox3, LSW(LSD(dump_dma)));
215                 wrt_reg_word(&reg->mailbox6, MSW(MSD(dump_dma)));
216                 wrt_reg_word(&reg->mailbox7, LSW(MSD(dump_dma)));
217
218                 wrt_reg_word(&reg->mailbox4, MSW(dwords));
219                 wrt_reg_word(&reg->mailbox5, LSW(dwords));
220                 wrt_reg_dword(&reg->hccr, HCCRX_SET_HOST_INT);
221
222                 ha->flags.mbox_int = 0;
223                 while (timer--) {
224                         udelay(5);
225                         stat = rd_reg_dword(&reg->host_status);
226
227                         /* Check for pending interrupts. */
228                         if (!(stat & HSRX_RISC_INT))
229                                 continue;
230
231                         stat &= 0xff;
232                         if (stat != 0x1 && stat != 0x2 &&
233                             stat != 0x10 && stat != 0x11) {
234                                 wrt_reg_dword(&reg->hccr, HCCRX_CLR_RISC_INT);
235                                 rd_reg_dword(&reg->hccr);
236                                 continue;
237                         }
238
239                         set_bit(MBX_INTERRUPT, &ha->mbx_cmd_flags);
240                         rval = rd_reg_word(&reg->mailbox0) & MBS_MASK;
241                         wrt_reg_dword(&reg->hccr, HCCRX_CLR_RISC_INT);
242                         rd_reg_dword(&reg->hccr);
243                         break;
244                 }
245                 ha->flags.mbox_int = 1;
246                 *nxt = ram + i;
247
248                 if (!test_and_clear_bit(MBX_INTERRUPT, &ha->mbx_cmd_flags)) {
249                         /* no interrupt, timed out*/
250                         return rval;
251                 }
252                 if (rval) {
253                         /* error completion status */
254                         return rval;
255                 }
256                 for (j = 0; j < dwords; j++) {
257                         ram[i + j] = (__force __be32)
258                                 ((IS_QLA27XX(ha) || IS_QLA28XX(ha)) ?
259                                  chunk[j] : swab32(chunk[j]));
260                 }
261         }
262
263         *nxt = ram + i;
264         return QLA_SUCCESS;
265 }
266
267 static int
268 qla24xx_dump_memory(struct qla_hw_data *ha, __be32 *code_ram,
269                     uint32_t cram_size, void **nxt)
270 {
271         int rval;
272
273         /* Code RAM. */
274         rval = qla24xx_dump_ram(ha, 0x20000, code_ram, cram_size / 4, nxt);
275         if (rval != QLA_SUCCESS)
276                 return rval;
277
278         set_bit(RISC_SRAM_DUMP_CMPL, &ha->fw_dump_cap_flags);
279
280         /* External Memory. */
281         rval = qla24xx_dump_ram(ha, 0x100000, *nxt,
282             ha->fw_memory_size - 0x100000 + 1, nxt);
283         if (rval == QLA_SUCCESS)
284                 set_bit(RISC_EXT_MEM_DUMP_CMPL, &ha->fw_dump_cap_flags);
285
286         return rval;
287 }
288
289 static __be32 *
290 qla24xx_read_window(struct device_reg_24xx __iomem *reg, uint32_t iobase,
291                     uint32_t count, __be32 *buf)
292 {
293         __le32 __iomem *dmp_reg;
294
295         wrt_reg_dword(&reg->iobase_addr, iobase);
296         dmp_reg = &reg->iobase_window;
297         for ( ; count--; dmp_reg++)
298                 *buf++ = htonl(rd_reg_dword(dmp_reg));
299
300         return buf;
301 }
302
303 void
304 qla24xx_pause_risc(struct device_reg_24xx __iomem *reg, struct qla_hw_data *ha)
305 {
306         wrt_reg_dword(&reg->hccr, HCCRX_SET_RISC_PAUSE);
307
308         /* 100 usec delay is sufficient enough for hardware to pause RISC */
309         udelay(100);
310         if (rd_reg_dword(&reg->host_status) & HSRX_RISC_PAUSED)
311                 set_bit(RISC_PAUSE_CMPL, &ha->fw_dump_cap_flags);
312 }
313
314 int
315 qla24xx_soft_reset(struct qla_hw_data *ha)
316 {
317         int rval = QLA_SUCCESS;
318         uint32_t cnt;
319         uint16_t wd;
320         struct device_reg_24xx __iomem *reg = &ha->iobase->isp24;
321
322         /*
323          * Reset RISC. The delay is dependent on system architecture.
324          * Driver can proceed with the reset sequence after waiting
325          * for a timeout period.
326          */
327         wrt_reg_dword(&reg->ctrl_status, CSRX_DMA_SHUTDOWN|MWB_4096_BYTES);
328         for (cnt = 0; cnt < 30000; cnt++) {
329                 if ((rd_reg_dword(&reg->ctrl_status) & CSRX_DMA_ACTIVE) == 0)
330                         break;
331
332                 udelay(10);
333         }
334         if (!(rd_reg_dword(&reg->ctrl_status) & CSRX_DMA_ACTIVE))
335                 set_bit(DMA_SHUTDOWN_CMPL, &ha->fw_dump_cap_flags);
336
337         wrt_reg_dword(&reg->ctrl_status,
338             CSRX_ISP_SOFT_RESET|CSRX_DMA_SHUTDOWN|MWB_4096_BYTES);
339         pci_read_config_word(ha->pdev, PCI_COMMAND, &wd);
340
341         udelay(100);
342
343         /* Wait for soft-reset to complete. */
344         for (cnt = 0; cnt < 30000; cnt++) {
345                 if ((rd_reg_dword(&reg->ctrl_status) &
346                     CSRX_ISP_SOFT_RESET) == 0)
347                         break;
348
349                 udelay(10);
350         }
351         if (!(rd_reg_dword(&reg->ctrl_status) & CSRX_ISP_SOFT_RESET))
352                 set_bit(ISP_RESET_CMPL, &ha->fw_dump_cap_flags);
353
354         wrt_reg_dword(&reg->hccr, HCCRX_CLR_RISC_RESET);
355         rd_reg_dword(&reg->hccr);             /* PCI Posting. */
356
357         for (cnt = 10000; rd_reg_word(&reg->mailbox0) != 0 &&
358             rval == QLA_SUCCESS; cnt--) {
359                 if (cnt)
360                         udelay(10);
361                 else
362                         rval = QLA_FUNCTION_TIMEOUT;
363         }
364         if (rval == QLA_SUCCESS)
365                 set_bit(RISC_RDY_AFT_RESET, &ha->fw_dump_cap_flags);
366
367         return rval;
368 }
369
370 static int
371 qla2xxx_dump_ram(struct qla_hw_data *ha, uint32_t addr, __be16 *ram,
372     uint32_t ram_words, void **nxt)
373 {
374         int rval;
375         uint32_t cnt, stat, timer, words, idx;
376         uint16_t mb0;
377         struct device_reg_2xxx __iomem *reg = &ha->iobase->isp;
378         dma_addr_t dump_dma = ha->gid_list_dma;
379         __le16 *dump = (__force __le16 *)ha->gid_list;
380
381         rval = QLA_SUCCESS;
382         mb0 = 0;
383
384         WRT_MAILBOX_REG(ha, reg, 0, MBC_DUMP_RISC_RAM_EXTENDED);
385         clear_bit(MBX_INTERRUPT, &ha->mbx_cmd_flags);
386
387         words = qla2x00_gid_list_size(ha) / 2;
388         for (cnt = 0; cnt < ram_words && rval == QLA_SUCCESS;
389             cnt += words, addr += words) {
390                 if (cnt + words > ram_words)
391                         words = ram_words - cnt;
392
393                 WRT_MAILBOX_REG(ha, reg, 1, LSW(addr));
394                 WRT_MAILBOX_REG(ha, reg, 8, MSW(addr));
395
396                 WRT_MAILBOX_REG(ha, reg, 2, MSW(dump_dma));
397                 WRT_MAILBOX_REG(ha, reg, 3, LSW(dump_dma));
398                 WRT_MAILBOX_REG(ha, reg, 6, MSW(MSD(dump_dma)));
399                 WRT_MAILBOX_REG(ha, reg, 7, LSW(MSD(dump_dma)));
400
401                 WRT_MAILBOX_REG(ha, reg, 4, words);
402                 wrt_reg_word(&reg->hccr, HCCR_SET_HOST_INT);
403
404                 for (timer = 6000000; timer; timer--) {
405                         /* Check for pending interrupts. */
406                         stat = rd_reg_dword(&reg->u.isp2300.host_status);
407                         if (stat & HSR_RISC_INT) {
408                                 stat &= 0xff;
409
410                                 if (stat == 0x1 || stat == 0x2) {
411                                         set_bit(MBX_INTERRUPT,
412                                             &ha->mbx_cmd_flags);
413
414                                         mb0 = RD_MAILBOX_REG(ha, reg, 0);
415
416                                         /* Release mailbox registers. */
417                                         wrt_reg_word(&reg->semaphore, 0);
418                                         wrt_reg_word(&reg->hccr,
419                                             HCCR_CLR_RISC_INT);
420                                         rd_reg_word(&reg->hccr);
421                                         break;
422                                 } else if (stat == 0x10 || stat == 0x11) {
423                                         set_bit(MBX_INTERRUPT,
424                                             &ha->mbx_cmd_flags);
425
426                                         mb0 = RD_MAILBOX_REG(ha, reg, 0);
427
428                                         wrt_reg_word(&reg->hccr,
429                                             HCCR_CLR_RISC_INT);
430                                         rd_reg_word(&reg->hccr);
431                                         break;
432                                 }
433
434                                 /* clear this intr; it wasn't a mailbox intr */
435                                 wrt_reg_word(&reg->hccr, HCCR_CLR_RISC_INT);
436                                 rd_reg_word(&reg->hccr);
437                         }
438                         udelay(5);
439                 }
440
441                 if (test_and_clear_bit(MBX_INTERRUPT, &ha->mbx_cmd_flags)) {
442                         rval = mb0 & MBS_MASK;
443                         for (idx = 0; idx < words; idx++)
444                                 ram[cnt + idx] =
445                                         cpu_to_be16(le16_to_cpu(dump[idx]));
446                 } else {
447                         rval = QLA_FUNCTION_FAILED;
448                 }
449         }
450
451         *nxt = rval == QLA_SUCCESS ? &ram[cnt] : NULL;
452         return rval;
453 }
454
455 static inline void
456 qla2xxx_read_window(struct device_reg_2xxx __iomem *reg, uint32_t count,
457                     __be16 *buf)
458 {
459         __le16 __iomem *dmp_reg = &reg->u.isp2300.fb_cmd;
460
461         for ( ; count--; dmp_reg++)
462                 *buf++ = htons(rd_reg_word(dmp_reg));
463 }
464
465 static inline void *
466 qla24xx_copy_eft(struct qla_hw_data *ha, void *ptr)
467 {
468         if (!ha->eft)
469                 return ptr;
470
471         memcpy(ptr, ha->eft, ntohl(ha->fw_dump->eft_size));
472         return ptr + ntohl(ha->fw_dump->eft_size);
473 }
474
475 static inline void *
476 qla25xx_copy_fce(struct qla_hw_data *ha, void *ptr, __be32 **last_chain)
477 {
478         uint32_t cnt;
479         __be32 *iter_reg;
480         struct qla2xxx_fce_chain *fcec = ptr;
481
482         if (!ha->fce)
483                 return ptr;
484
485         *last_chain = &fcec->type;
486         fcec->type = htonl(DUMP_CHAIN_FCE);
487         fcec->chain_size = htonl(sizeof(struct qla2xxx_fce_chain) +
488             fce_calc_size(ha->fce_bufs));
489         fcec->size = htonl(fce_calc_size(ha->fce_bufs));
490         fcec->addr_l = htonl(LSD(ha->fce_dma));
491         fcec->addr_h = htonl(MSD(ha->fce_dma));
492
493         iter_reg = fcec->eregs;
494         for (cnt = 0; cnt < 8; cnt++)
495                 *iter_reg++ = htonl(ha->fce_mb[cnt]);
496
497         memcpy(iter_reg, ha->fce, ntohl(fcec->size));
498
499         return (char *)iter_reg + ntohl(fcec->size);
500 }
501
502 static inline void *
503 qla25xx_copy_exlogin(struct qla_hw_data *ha, void *ptr, __be32 **last_chain)
504 {
505         struct qla2xxx_offld_chain *c = ptr;
506
507         if (!ha->exlogin_buf)
508                 return ptr;
509
510         *last_chain = &c->type;
511
512         c->type = cpu_to_be32(DUMP_CHAIN_EXLOGIN);
513         c->chain_size = cpu_to_be32(sizeof(struct qla2xxx_offld_chain) +
514             ha->exlogin_size);
515         c->size = cpu_to_be32(ha->exlogin_size);
516         c->addr = cpu_to_be64(ha->exlogin_buf_dma);
517
518         ptr += sizeof(struct qla2xxx_offld_chain);
519         memcpy(ptr, ha->exlogin_buf, ha->exlogin_size);
520
521         return (char *)ptr + be32_to_cpu(c->size);
522 }
523
524 static inline void *
525 qla81xx_copy_exchoffld(struct qla_hw_data *ha, void *ptr, __be32 **last_chain)
526 {
527         struct qla2xxx_offld_chain *c = ptr;
528
529         if (!ha->exchoffld_buf)
530                 return ptr;
531
532         *last_chain = &c->type;
533
534         c->type = cpu_to_be32(DUMP_CHAIN_EXCHG);
535         c->chain_size = cpu_to_be32(sizeof(struct qla2xxx_offld_chain) +
536             ha->exchoffld_size);
537         c->size = cpu_to_be32(ha->exchoffld_size);
538         c->addr = cpu_to_be64(ha->exchoffld_buf_dma);
539
540         ptr += sizeof(struct qla2xxx_offld_chain);
541         memcpy(ptr, ha->exchoffld_buf, ha->exchoffld_size);
542
543         return (char *)ptr + be32_to_cpu(c->size);
544 }
545
546 static inline void *
547 qla2xxx_copy_atioqueues(struct qla_hw_data *ha, void *ptr,
548                         __be32 **last_chain)
549 {
550         struct qla2xxx_mqueue_chain *q;
551         struct qla2xxx_mqueue_header *qh;
552         uint32_t num_queues;
553         int que;
554         struct {
555                 int length;
556                 void *ring;
557         } aq, *aqp;
558
559         if (!ha->tgt.atio_ring)
560                 return ptr;
561
562         num_queues = 1;
563         aqp = &aq;
564         aqp->length = ha->tgt.atio_q_length;
565         aqp->ring = ha->tgt.atio_ring;
566
567         for (que = 0; que < num_queues; que++) {
568                 /* aqp = ha->atio_q_map[que]; */
569                 q = ptr;
570                 *last_chain = &q->type;
571                 q->type = htonl(DUMP_CHAIN_QUEUE);
572                 q->chain_size = htonl(
573                     sizeof(struct qla2xxx_mqueue_chain) +
574                     sizeof(struct qla2xxx_mqueue_header) +
575                     (aqp->length * sizeof(request_t)));
576                 ptr += sizeof(struct qla2xxx_mqueue_chain);
577
578                 /* Add header. */
579                 qh = ptr;
580                 qh->queue = htonl(TYPE_ATIO_QUEUE);
581                 qh->number = htonl(que);
582                 qh->size = htonl(aqp->length * sizeof(request_t));
583                 ptr += sizeof(struct qla2xxx_mqueue_header);
584
585                 /* Add data. */
586                 memcpy(ptr, aqp->ring, aqp->length * sizeof(request_t));
587
588                 ptr += aqp->length * sizeof(request_t);
589         }
590
591         return ptr;
592 }
593
594 static inline void *
595 qla25xx_copy_mqueues(struct qla_hw_data *ha, void *ptr, __be32 **last_chain)
596 {
597         struct qla2xxx_mqueue_chain *q;
598         struct qla2xxx_mqueue_header *qh;
599         struct req_que *req;
600         struct rsp_que *rsp;
601         int que;
602
603         if (!ha->mqenable)
604                 return ptr;
605
606         /* Request queues */
607         for (que = 1; que < ha->max_req_queues; que++) {
608                 req = ha->req_q_map[que];
609                 if (!req)
610                         break;
611
612                 /* Add chain. */
613                 q = ptr;
614                 *last_chain = &q->type;
615                 q->type = htonl(DUMP_CHAIN_QUEUE);
616                 q->chain_size = htonl(
617                     sizeof(struct qla2xxx_mqueue_chain) +
618                     sizeof(struct qla2xxx_mqueue_header) +
619                     (req->length * sizeof(request_t)));
620                 ptr += sizeof(struct qla2xxx_mqueue_chain);
621
622                 /* Add header. */
623                 qh = ptr;
624                 qh->queue = htonl(TYPE_REQUEST_QUEUE);
625                 qh->number = htonl(que);
626                 qh->size = htonl(req->length * sizeof(request_t));
627                 ptr += sizeof(struct qla2xxx_mqueue_header);
628
629                 /* Add data. */
630                 memcpy(ptr, req->ring, req->length * sizeof(request_t));
631                 ptr += req->length * sizeof(request_t);
632         }
633
634         /* Response queues */
635         for (que = 1; que < ha->max_rsp_queues; que++) {
636                 rsp = ha->rsp_q_map[que];
637                 if (!rsp)
638                         break;
639
640                 /* Add chain. */
641                 q = ptr;
642                 *last_chain = &q->type;
643                 q->type = htonl(DUMP_CHAIN_QUEUE);
644                 q->chain_size = htonl(
645                     sizeof(struct qla2xxx_mqueue_chain) +
646                     sizeof(struct qla2xxx_mqueue_header) +
647                     (rsp->length * sizeof(response_t)));
648                 ptr += sizeof(struct qla2xxx_mqueue_chain);
649
650                 /* Add header. */
651                 qh = ptr;
652                 qh->queue = htonl(TYPE_RESPONSE_QUEUE);
653                 qh->number = htonl(que);
654                 qh->size = htonl(rsp->length * sizeof(response_t));
655                 ptr += sizeof(struct qla2xxx_mqueue_header);
656
657                 /* Add data. */
658                 memcpy(ptr, rsp->ring, rsp->length * sizeof(response_t));
659                 ptr += rsp->length * sizeof(response_t);
660         }
661
662         return ptr;
663 }
664
665 static inline void *
666 qla25xx_copy_mq(struct qla_hw_data *ha, void *ptr, __be32 **last_chain)
667 {
668         uint32_t cnt, que_idx;
669         uint8_t que_cnt;
670         struct qla2xxx_mq_chain *mq = ptr;
671         device_reg_t *reg;
672
673         if (!ha->mqenable || IS_QLA83XX(ha) || IS_QLA27XX(ha) ||
674             IS_QLA28XX(ha))
675                 return ptr;
676
677         mq = ptr;
678         *last_chain = &mq->type;
679         mq->type = htonl(DUMP_CHAIN_MQ);
680         mq->chain_size = htonl(sizeof(struct qla2xxx_mq_chain));
681
682         que_cnt = ha->max_req_queues > ha->max_rsp_queues ?
683                 ha->max_req_queues : ha->max_rsp_queues;
684         mq->count = htonl(que_cnt);
685         for (cnt = 0; cnt < que_cnt; cnt++) {
686                 reg = ISP_QUE_REG(ha, cnt);
687                 que_idx = cnt * 4;
688                 mq->qregs[que_idx] =
689                     htonl(rd_reg_dword(&reg->isp25mq.req_q_in));
690                 mq->qregs[que_idx+1] =
691                     htonl(rd_reg_dword(&reg->isp25mq.req_q_out));
692                 mq->qregs[que_idx+2] =
693                     htonl(rd_reg_dword(&reg->isp25mq.rsp_q_in));
694                 mq->qregs[que_idx+3] =
695                     htonl(rd_reg_dword(&reg->isp25mq.rsp_q_out));
696         }
697
698         return ptr + sizeof(struct qla2xxx_mq_chain);
699 }
700
701 void
702 qla2xxx_dump_post_process(scsi_qla_host_t *vha, int rval)
703 {
704         struct qla_hw_data *ha = vha->hw;
705
706         if (rval != QLA_SUCCESS) {
707                 ql_log(ql_log_warn, vha, 0xd000,
708                     "Failed to dump firmware (%x), dump status flags (0x%lx).\n",
709                     rval, ha->fw_dump_cap_flags);
710                 ha->fw_dumped = false;
711         } else {
712                 ql_log(ql_log_info, vha, 0xd001,
713                     "Firmware dump saved to temp buffer (%ld/%p), dump status flags (0x%lx).\n",
714                     vha->host_no, ha->fw_dump, ha->fw_dump_cap_flags);
715                 ha->fw_dumped = true;
716                 qla2x00_post_uevent_work(vha, QLA_UEVENT_CODE_FW_DUMP);
717         }
718 }
719
720 void qla2xxx_dump_fw(scsi_qla_host_t *vha)
721 {
722         unsigned long flags;
723
724         spin_lock_irqsave(&vha->hw->hardware_lock, flags);
725         vha->hw->isp_ops->fw_dump(vha);
726         spin_unlock_irqrestore(&vha->hw->hardware_lock, flags);
727 }
728
729 /**
730  * qla2300_fw_dump() - Dumps binary data from the 2300 firmware.
731  * @vha: HA context
732  */
733 void
734 qla2300_fw_dump(scsi_qla_host_t *vha)
735 {
736         int             rval;
737         uint32_t        cnt;
738         struct qla_hw_data *ha = vha->hw;
739         struct device_reg_2xxx __iomem *reg = &ha->iobase->isp;
740         __le16 __iomem *dmp_reg;
741         struct qla2300_fw_dump  *fw;
742         void            *nxt;
743         struct scsi_qla_host *base_vha = pci_get_drvdata(ha->pdev);
744
745         lockdep_assert_held(&ha->hardware_lock);
746
747         if (!ha->fw_dump) {
748                 ql_log(ql_log_warn, vha, 0xd002,
749                     "No buffer available for dump.\n");
750                 return;
751         }
752
753         if (ha->fw_dumped) {
754                 ql_log(ql_log_warn, vha, 0xd003,
755                     "Firmware has been previously dumped (%p) "
756                     "-- ignoring request.\n",
757                     ha->fw_dump);
758                 return;
759         }
760         fw = &ha->fw_dump->isp.isp23;
761         qla2xxx_prep_dump(ha, ha->fw_dump);
762
763         rval = QLA_SUCCESS;
764         fw->hccr = htons(rd_reg_word(&reg->hccr));
765
766         /* Pause RISC. */
767         wrt_reg_word(&reg->hccr, HCCR_PAUSE_RISC);
768         if (IS_QLA2300(ha)) {
769                 for (cnt = 30000;
770                     (rd_reg_word(&reg->hccr) & HCCR_RISC_PAUSE) == 0 &&
771                         rval == QLA_SUCCESS; cnt--) {
772                         if (cnt)
773                                 udelay(100);
774                         else
775                                 rval = QLA_FUNCTION_TIMEOUT;
776                 }
777         } else {
778                 rd_reg_word(&reg->hccr);                /* PCI Posting. */
779                 udelay(10);
780         }
781
782         if (rval == QLA_SUCCESS) {
783                 dmp_reg = &reg->flash_address;
784                 for (cnt = 0; cnt < ARRAY_SIZE(fw->pbiu_reg); cnt++, dmp_reg++)
785                         fw->pbiu_reg[cnt] = htons(rd_reg_word(dmp_reg));
786
787                 dmp_reg = &reg->u.isp2300.req_q_in;
788                 for (cnt = 0; cnt < ARRAY_SIZE(fw->risc_host_reg);
789                     cnt++, dmp_reg++)
790                         fw->risc_host_reg[cnt] = htons(rd_reg_word(dmp_reg));
791
792                 dmp_reg = &reg->u.isp2300.mailbox0;
793                 for (cnt = 0; cnt < ARRAY_SIZE(fw->mailbox_reg);
794                     cnt++, dmp_reg++)
795                         fw->mailbox_reg[cnt] = htons(rd_reg_word(dmp_reg));
796
797                 wrt_reg_word(&reg->ctrl_status, 0x40);
798                 qla2xxx_read_window(reg, 32, fw->resp_dma_reg);
799
800                 wrt_reg_word(&reg->ctrl_status, 0x50);
801                 qla2xxx_read_window(reg, 48, fw->dma_reg);
802
803                 wrt_reg_word(&reg->ctrl_status, 0x00);
804                 dmp_reg = &reg->risc_hw;
805                 for (cnt = 0; cnt < ARRAY_SIZE(fw->risc_hdw_reg);
806                     cnt++, dmp_reg++)
807                         fw->risc_hdw_reg[cnt] = htons(rd_reg_word(dmp_reg));
808
809                 wrt_reg_word(&reg->pcr, 0x2000);
810                 qla2xxx_read_window(reg, 16, fw->risc_gp0_reg);
811
812                 wrt_reg_word(&reg->pcr, 0x2200);
813                 qla2xxx_read_window(reg, 16, fw->risc_gp1_reg);
814
815                 wrt_reg_word(&reg->pcr, 0x2400);
816                 qla2xxx_read_window(reg, 16, fw->risc_gp2_reg);
817
818                 wrt_reg_word(&reg->pcr, 0x2600);
819                 qla2xxx_read_window(reg, 16, fw->risc_gp3_reg);
820
821                 wrt_reg_word(&reg->pcr, 0x2800);
822                 qla2xxx_read_window(reg, 16, fw->risc_gp4_reg);
823
824                 wrt_reg_word(&reg->pcr, 0x2A00);
825                 qla2xxx_read_window(reg, 16, fw->risc_gp5_reg);
826
827                 wrt_reg_word(&reg->pcr, 0x2C00);
828                 qla2xxx_read_window(reg, 16, fw->risc_gp6_reg);
829
830                 wrt_reg_word(&reg->pcr, 0x2E00);
831                 qla2xxx_read_window(reg, 16, fw->risc_gp7_reg);
832
833                 wrt_reg_word(&reg->ctrl_status, 0x10);
834                 qla2xxx_read_window(reg, 64, fw->frame_buf_hdw_reg);
835
836                 wrt_reg_word(&reg->ctrl_status, 0x20);
837                 qla2xxx_read_window(reg, 64, fw->fpm_b0_reg);
838
839                 wrt_reg_word(&reg->ctrl_status, 0x30);
840                 qla2xxx_read_window(reg, 64, fw->fpm_b1_reg);
841
842                 /* Reset RISC. */
843                 wrt_reg_word(&reg->ctrl_status, CSR_ISP_SOFT_RESET);
844                 for (cnt = 0; cnt < 30000; cnt++) {
845                         if ((rd_reg_word(&reg->ctrl_status) &
846                             CSR_ISP_SOFT_RESET) == 0)
847                                 break;
848
849                         udelay(10);
850                 }
851         }
852
853         if (!IS_QLA2300(ha)) {
854                 for (cnt = 30000; RD_MAILBOX_REG(ha, reg, 0) != 0 &&
855                     rval == QLA_SUCCESS; cnt--) {
856                         if (cnt)
857                                 udelay(100);
858                         else
859                                 rval = QLA_FUNCTION_TIMEOUT;
860                 }
861         }
862
863         /* Get RISC SRAM. */
864         if (rval == QLA_SUCCESS)
865                 rval = qla2xxx_dump_ram(ha, 0x800, fw->risc_ram,
866                                         ARRAY_SIZE(fw->risc_ram), &nxt);
867
868         /* Get stack SRAM. */
869         if (rval == QLA_SUCCESS)
870                 rval = qla2xxx_dump_ram(ha, 0x10000, fw->stack_ram,
871                                         ARRAY_SIZE(fw->stack_ram), &nxt);
872
873         /* Get data SRAM. */
874         if (rval == QLA_SUCCESS)
875                 rval = qla2xxx_dump_ram(ha, 0x11000, fw->data_ram,
876                     ha->fw_memory_size - 0x11000 + 1, &nxt);
877
878         if (rval == QLA_SUCCESS)
879                 qla2xxx_copy_queues(ha, nxt);
880
881         qla2xxx_dump_post_process(base_vha, rval);
882 }
883
884 /**
885  * qla2100_fw_dump() - Dumps binary data from the 2100/2200 firmware.
886  * @vha: HA context
887  */
888 void
889 qla2100_fw_dump(scsi_qla_host_t *vha)
890 {
891         int             rval;
892         uint32_t        cnt, timer;
893         uint16_t        risc_address = 0;
894         uint16_t        mb0 = 0, mb2 = 0;
895         struct qla_hw_data *ha = vha->hw;
896         struct device_reg_2xxx __iomem *reg = &ha->iobase->isp;
897         __le16 __iomem *dmp_reg;
898         struct qla2100_fw_dump  *fw;
899         struct scsi_qla_host *base_vha = pci_get_drvdata(ha->pdev);
900
901         lockdep_assert_held(&ha->hardware_lock);
902
903         if (!ha->fw_dump) {
904                 ql_log(ql_log_warn, vha, 0xd004,
905                     "No buffer available for dump.\n");
906                 return;
907         }
908
909         if (ha->fw_dumped) {
910                 ql_log(ql_log_warn, vha, 0xd005,
911                     "Firmware has been previously dumped (%p) "
912                     "-- ignoring request.\n",
913                     ha->fw_dump);
914                 return;
915         }
916         fw = &ha->fw_dump->isp.isp21;
917         qla2xxx_prep_dump(ha, ha->fw_dump);
918
919         rval = QLA_SUCCESS;
920         fw->hccr = htons(rd_reg_word(&reg->hccr));
921
922         /* Pause RISC. */
923         wrt_reg_word(&reg->hccr, HCCR_PAUSE_RISC);
924         for (cnt = 30000; (rd_reg_word(&reg->hccr) & HCCR_RISC_PAUSE) == 0 &&
925             rval == QLA_SUCCESS; cnt--) {
926                 if (cnt)
927                         udelay(100);
928                 else
929                         rval = QLA_FUNCTION_TIMEOUT;
930         }
931         if (rval == QLA_SUCCESS) {
932                 dmp_reg = &reg->flash_address;
933                 for (cnt = 0; cnt < ARRAY_SIZE(fw->pbiu_reg); cnt++, dmp_reg++)
934                         fw->pbiu_reg[cnt] = htons(rd_reg_word(dmp_reg));
935
936                 dmp_reg = &reg->u.isp2100.mailbox0;
937                 for (cnt = 0; cnt < ha->mbx_count; cnt++, dmp_reg++) {
938                         if (cnt == 8)
939                                 dmp_reg = &reg->u_end.isp2200.mailbox8;
940
941                         fw->mailbox_reg[cnt] = htons(rd_reg_word(dmp_reg));
942                 }
943
944                 dmp_reg = &reg->u.isp2100.unused_2[0];
945                 for (cnt = 0; cnt < ARRAY_SIZE(fw->dma_reg); cnt++, dmp_reg++)
946                         fw->dma_reg[cnt] = htons(rd_reg_word(dmp_reg));
947
948                 wrt_reg_word(&reg->ctrl_status, 0x00);
949                 dmp_reg = &reg->risc_hw;
950                 for (cnt = 0; cnt < ARRAY_SIZE(fw->risc_hdw_reg); cnt++, dmp_reg++)
951                         fw->risc_hdw_reg[cnt] = htons(rd_reg_word(dmp_reg));
952
953                 wrt_reg_word(&reg->pcr, 0x2000);
954                 qla2xxx_read_window(reg, 16, fw->risc_gp0_reg);
955
956                 wrt_reg_word(&reg->pcr, 0x2100);
957                 qla2xxx_read_window(reg, 16, fw->risc_gp1_reg);
958
959                 wrt_reg_word(&reg->pcr, 0x2200);
960                 qla2xxx_read_window(reg, 16, fw->risc_gp2_reg);
961
962                 wrt_reg_word(&reg->pcr, 0x2300);
963                 qla2xxx_read_window(reg, 16, fw->risc_gp3_reg);
964
965                 wrt_reg_word(&reg->pcr, 0x2400);
966                 qla2xxx_read_window(reg, 16, fw->risc_gp4_reg);
967
968                 wrt_reg_word(&reg->pcr, 0x2500);
969                 qla2xxx_read_window(reg, 16, fw->risc_gp5_reg);
970
971                 wrt_reg_word(&reg->pcr, 0x2600);
972                 qla2xxx_read_window(reg, 16, fw->risc_gp6_reg);
973
974                 wrt_reg_word(&reg->pcr, 0x2700);
975                 qla2xxx_read_window(reg, 16, fw->risc_gp7_reg);
976
977                 wrt_reg_word(&reg->ctrl_status, 0x10);
978                 qla2xxx_read_window(reg, 16, fw->frame_buf_hdw_reg);
979
980                 wrt_reg_word(&reg->ctrl_status, 0x20);
981                 qla2xxx_read_window(reg, 64, fw->fpm_b0_reg);
982
983                 wrt_reg_word(&reg->ctrl_status, 0x30);
984                 qla2xxx_read_window(reg, 64, fw->fpm_b1_reg);
985
986                 /* Reset the ISP. */
987                 wrt_reg_word(&reg->ctrl_status, CSR_ISP_SOFT_RESET);
988         }
989
990         for (cnt = 30000; RD_MAILBOX_REG(ha, reg, 0) != 0 &&
991             rval == QLA_SUCCESS; cnt--) {
992                 if (cnt)
993                         udelay(100);
994                 else
995                         rval = QLA_FUNCTION_TIMEOUT;
996         }
997
998         /* Pause RISC. */
999         if (rval == QLA_SUCCESS && (IS_QLA2200(ha) || (IS_QLA2100(ha) &&
1000             (rd_reg_word(&reg->mctr) & (BIT_1 | BIT_0)) != 0))) {
1001
1002                 wrt_reg_word(&reg->hccr, HCCR_PAUSE_RISC);
1003                 for (cnt = 30000;
1004                     (rd_reg_word(&reg->hccr) & HCCR_RISC_PAUSE) == 0 &&
1005                     rval == QLA_SUCCESS; cnt--) {
1006                         if (cnt)
1007                                 udelay(100);
1008                         else
1009                                 rval = QLA_FUNCTION_TIMEOUT;
1010                 }
1011                 if (rval == QLA_SUCCESS) {
1012                         /* Set memory configuration and timing. */
1013                         if (IS_QLA2100(ha))
1014                                 wrt_reg_word(&reg->mctr, 0xf1);
1015                         else
1016                                 wrt_reg_word(&reg->mctr, 0xf2);
1017                         rd_reg_word(&reg->mctr);        /* PCI Posting. */
1018
1019                         /* Release RISC. */
1020                         wrt_reg_word(&reg->hccr, HCCR_RELEASE_RISC);
1021                 }
1022         }
1023
1024         if (rval == QLA_SUCCESS) {
1025                 /* Get RISC SRAM. */
1026                 risc_address = 0x1000;
1027                 WRT_MAILBOX_REG(ha, reg, 0, MBC_READ_RAM_WORD);
1028                 clear_bit(MBX_INTERRUPT, &ha->mbx_cmd_flags);
1029         }
1030         for (cnt = 0; cnt < ARRAY_SIZE(fw->risc_ram) && rval == QLA_SUCCESS;
1031             cnt++, risc_address++) {
1032                 WRT_MAILBOX_REG(ha, reg, 1, risc_address);
1033                 wrt_reg_word(&reg->hccr, HCCR_SET_HOST_INT);
1034
1035                 for (timer = 6000000; timer != 0; timer--) {
1036                         /* Check for pending interrupts. */
1037                         if (rd_reg_word(&reg->istatus) & ISR_RISC_INT) {
1038                                 if (rd_reg_word(&reg->semaphore) & BIT_0) {
1039                                         set_bit(MBX_INTERRUPT,
1040                                             &ha->mbx_cmd_flags);
1041
1042                                         mb0 = RD_MAILBOX_REG(ha, reg, 0);
1043                                         mb2 = RD_MAILBOX_REG(ha, reg, 2);
1044
1045                                         wrt_reg_word(&reg->semaphore, 0);
1046                                         wrt_reg_word(&reg->hccr,
1047                                             HCCR_CLR_RISC_INT);
1048                                         rd_reg_word(&reg->hccr);
1049                                         break;
1050                                 }
1051                                 wrt_reg_word(&reg->hccr, HCCR_CLR_RISC_INT);
1052                                 rd_reg_word(&reg->hccr);
1053                         }
1054                         udelay(5);
1055                 }
1056
1057                 if (test_and_clear_bit(MBX_INTERRUPT, &ha->mbx_cmd_flags)) {
1058                         rval = mb0 & MBS_MASK;
1059                         fw->risc_ram[cnt] = htons(mb2);
1060                 } else {
1061                         rval = QLA_FUNCTION_FAILED;
1062                 }
1063         }
1064
1065         if (rval == QLA_SUCCESS)
1066                 qla2xxx_copy_queues(ha, &fw->queue_dump[0]);
1067
1068         qla2xxx_dump_post_process(base_vha, rval);
1069 }
1070
1071 void
1072 qla24xx_fw_dump(scsi_qla_host_t *vha)
1073 {
1074         int             rval;
1075         uint32_t        cnt;
1076         struct qla_hw_data *ha = vha->hw;
1077         struct device_reg_24xx __iomem *reg = &ha->iobase->isp24;
1078         __le32 __iomem *dmp_reg;
1079         __be32          *iter_reg;
1080         __le16 __iomem *mbx_reg;
1081         struct qla24xx_fw_dump *fw;
1082         void            *nxt;
1083         void            *nxt_chain;
1084         __be32          *last_chain = NULL;
1085         struct scsi_qla_host *base_vha = pci_get_drvdata(ha->pdev);
1086
1087         lockdep_assert_held(&ha->hardware_lock);
1088
1089         if (IS_P3P_TYPE(ha))
1090                 return;
1091
1092         ha->fw_dump_cap_flags = 0;
1093
1094         if (!ha->fw_dump) {
1095                 ql_log(ql_log_warn, vha, 0xd006,
1096                     "No buffer available for dump.\n");
1097                 return;
1098         }
1099
1100         if (ha->fw_dumped) {
1101                 ql_log(ql_log_warn, vha, 0xd007,
1102                     "Firmware has been previously dumped (%p) "
1103                     "-- ignoring request.\n",
1104                     ha->fw_dump);
1105                 return;
1106         }
1107         QLA_FW_STOPPED(ha);
1108         fw = &ha->fw_dump->isp.isp24;
1109         qla2xxx_prep_dump(ha, ha->fw_dump);
1110
1111         fw->host_status = htonl(rd_reg_dword(&reg->host_status));
1112
1113         /*
1114          * Pause RISC. No need to track timeout, as resetting the chip
1115          * is the right approach incase of pause timeout
1116          */
1117         qla24xx_pause_risc(reg, ha);
1118
1119         /* Host interface registers. */
1120         dmp_reg = &reg->flash_addr;
1121         for (cnt = 0; cnt < ARRAY_SIZE(fw->host_reg); cnt++, dmp_reg++)
1122                 fw->host_reg[cnt] = htonl(rd_reg_dword(dmp_reg));
1123
1124         /* Disable interrupts. */
1125         wrt_reg_dword(&reg->ictrl, 0);
1126         rd_reg_dword(&reg->ictrl);
1127
1128         /* Shadow registers. */
1129         wrt_reg_dword(&reg->iobase_addr, 0x0F70);
1130         rd_reg_dword(&reg->iobase_addr);
1131         wrt_reg_dword(&reg->iobase_select, 0xB0000000);
1132         fw->shadow_reg[0] = htonl(rd_reg_dword(&reg->iobase_sdata));
1133
1134         wrt_reg_dword(&reg->iobase_select, 0xB0100000);
1135         fw->shadow_reg[1] = htonl(rd_reg_dword(&reg->iobase_sdata));
1136
1137         wrt_reg_dword(&reg->iobase_select, 0xB0200000);
1138         fw->shadow_reg[2] = htonl(rd_reg_dword(&reg->iobase_sdata));
1139
1140         wrt_reg_dword(&reg->iobase_select, 0xB0300000);
1141         fw->shadow_reg[3] = htonl(rd_reg_dword(&reg->iobase_sdata));
1142
1143         wrt_reg_dword(&reg->iobase_select, 0xB0400000);
1144         fw->shadow_reg[4] = htonl(rd_reg_dword(&reg->iobase_sdata));
1145
1146         wrt_reg_dword(&reg->iobase_select, 0xB0500000);
1147         fw->shadow_reg[5] = htonl(rd_reg_dword(&reg->iobase_sdata));
1148
1149         wrt_reg_dword(&reg->iobase_select, 0xB0600000);
1150         fw->shadow_reg[6] = htonl(rd_reg_dword(&reg->iobase_sdata));
1151
1152         /* Mailbox registers. */
1153         mbx_reg = &reg->mailbox0;
1154         for (cnt = 0; cnt < ARRAY_SIZE(fw->mailbox_reg); cnt++, mbx_reg++)
1155                 fw->mailbox_reg[cnt] = htons(rd_reg_word(mbx_reg));
1156
1157         /* Transfer sequence registers. */
1158         iter_reg = fw->xseq_gp_reg;
1159         iter_reg = qla24xx_read_window(reg, 0xBF00, 16, iter_reg);
1160         iter_reg = qla24xx_read_window(reg, 0xBF10, 16, iter_reg);
1161         iter_reg = qla24xx_read_window(reg, 0xBF20, 16, iter_reg);
1162         iter_reg = qla24xx_read_window(reg, 0xBF30, 16, iter_reg);
1163         iter_reg = qla24xx_read_window(reg, 0xBF40, 16, iter_reg);
1164         iter_reg = qla24xx_read_window(reg, 0xBF50, 16, iter_reg);
1165         iter_reg = qla24xx_read_window(reg, 0xBF60, 16, iter_reg);
1166         qla24xx_read_window(reg, 0xBF70, 16, iter_reg);
1167
1168         qla24xx_read_window(reg, 0xBFE0, 16, fw->xseq_0_reg);
1169         qla24xx_read_window(reg, 0xBFF0, 16, fw->xseq_1_reg);
1170
1171         /* Receive sequence registers. */
1172         iter_reg = fw->rseq_gp_reg;
1173         iter_reg = qla24xx_read_window(reg, 0xFF00, 16, iter_reg);
1174         iter_reg = qla24xx_read_window(reg, 0xFF10, 16, iter_reg);
1175         iter_reg = qla24xx_read_window(reg, 0xFF20, 16, iter_reg);
1176         iter_reg = qla24xx_read_window(reg, 0xFF30, 16, iter_reg);
1177         iter_reg = qla24xx_read_window(reg, 0xFF40, 16, iter_reg);
1178         iter_reg = qla24xx_read_window(reg, 0xFF50, 16, iter_reg);
1179         iter_reg = qla24xx_read_window(reg, 0xFF60, 16, iter_reg);
1180         qla24xx_read_window(reg, 0xFF70, 16, iter_reg);
1181
1182         qla24xx_read_window(reg, 0xFFD0, 16, fw->rseq_0_reg);
1183         qla24xx_read_window(reg, 0xFFE0, 16, fw->rseq_1_reg);
1184         qla24xx_read_window(reg, 0xFFF0, 16, fw->rseq_2_reg);
1185
1186         /* Command DMA registers. */
1187         qla24xx_read_window(reg, 0x7100, 16, fw->cmd_dma_reg);
1188
1189         /* Queues. */
1190         iter_reg = fw->req0_dma_reg;
1191         iter_reg = qla24xx_read_window(reg, 0x7200, 8, iter_reg);
1192         dmp_reg = &reg->iobase_q;
1193         for (cnt = 0; cnt < 7; cnt++, dmp_reg++)
1194                 *iter_reg++ = htonl(rd_reg_dword(dmp_reg));
1195
1196         iter_reg = fw->resp0_dma_reg;
1197         iter_reg = qla24xx_read_window(reg, 0x7300, 8, iter_reg);
1198         dmp_reg = &reg->iobase_q;
1199         for (cnt = 0; cnt < 7; cnt++, dmp_reg++)
1200                 *iter_reg++ = htonl(rd_reg_dword(dmp_reg));
1201
1202         iter_reg = fw->req1_dma_reg;
1203         iter_reg = qla24xx_read_window(reg, 0x7400, 8, iter_reg);
1204         dmp_reg = &reg->iobase_q;
1205         for (cnt = 0; cnt < 7; cnt++, dmp_reg++)
1206                 *iter_reg++ = htonl(rd_reg_dword(dmp_reg));
1207
1208         /* Transmit DMA registers. */
1209         iter_reg = fw->xmt0_dma_reg;
1210         iter_reg = qla24xx_read_window(reg, 0x7600, 16, iter_reg);
1211         qla24xx_read_window(reg, 0x7610, 16, iter_reg);
1212
1213         iter_reg = fw->xmt1_dma_reg;
1214         iter_reg = qla24xx_read_window(reg, 0x7620, 16, iter_reg);
1215         qla24xx_read_window(reg, 0x7630, 16, iter_reg);
1216
1217         iter_reg = fw->xmt2_dma_reg;
1218         iter_reg = qla24xx_read_window(reg, 0x7640, 16, iter_reg);
1219         qla24xx_read_window(reg, 0x7650, 16, iter_reg);
1220
1221         iter_reg = fw->xmt3_dma_reg;
1222         iter_reg = qla24xx_read_window(reg, 0x7660, 16, iter_reg);
1223         qla24xx_read_window(reg, 0x7670, 16, iter_reg);
1224
1225         iter_reg = fw->xmt4_dma_reg;
1226         iter_reg = qla24xx_read_window(reg, 0x7680, 16, iter_reg);
1227         qla24xx_read_window(reg, 0x7690, 16, iter_reg);
1228
1229         qla24xx_read_window(reg, 0x76A0, 16, fw->xmt_data_dma_reg);
1230
1231         /* Receive DMA registers. */
1232         iter_reg = fw->rcvt0_data_dma_reg;
1233         iter_reg = qla24xx_read_window(reg, 0x7700, 16, iter_reg);
1234         qla24xx_read_window(reg, 0x7710, 16, iter_reg);
1235
1236         iter_reg = fw->rcvt1_data_dma_reg;
1237         iter_reg = qla24xx_read_window(reg, 0x7720, 16, iter_reg);
1238         qla24xx_read_window(reg, 0x7730, 16, iter_reg);
1239
1240         /* RISC registers. */
1241         iter_reg = fw->risc_gp_reg;
1242         iter_reg = qla24xx_read_window(reg, 0x0F00, 16, iter_reg);
1243         iter_reg = qla24xx_read_window(reg, 0x0F10, 16, iter_reg);
1244         iter_reg = qla24xx_read_window(reg, 0x0F20, 16, iter_reg);
1245         iter_reg = qla24xx_read_window(reg, 0x0F30, 16, iter_reg);
1246         iter_reg = qla24xx_read_window(reg, 0x0F40, 16, iter_reg);
1247         iter_reg = qla24xx_read_window(reg, 0x0F50, 16, iter_reg);
1248         iter_reg = qla24xx_read_window(reg, 0x0F60, 16, iter_reg);
1249         qla24xx_read_window(reg, 0x0F70, 16, iter_reg);
1250
1251         /* Local memory controller registers. */
1252         iter_reg = fw->lmc_reg;
1253         iter_reg = qla24xx_read_window(reg, 0x3000, 16, iter_reg);
1254         iter_reg = qla24xx_read_window(reg, 0x3010, 16, iter_reg);
1255         iter_reg = qla24xx_read_window(reg, 0x3020, 16, iter_reg);
1256         iter_reg = qla24xx_read_window(reg, 0x3030, 16, iter_reg);
1257         iter_reg = qla24xx_read_window(reg, 0x3040, 16, iter_reg);
1258         iter_reg = qla24xx_read_window(reg, 0x3050, 16, iter_reg);
1259         qla24xx_read_window(reg, 0x3060, 16, iter_reg);
1260
1261         /* Fibre Protocol Module registers. */
1262         iter_reg = fw->fpm_hdw_reg;
1263         iter_reg = qla24xx_read_window(reg, 0x4000, 16, iter_reg);
1264         iter_reg = qla24xx_read_window(reg, 0x4010, 16, iter_reg);
1265         iter_reg = qla24xx_read_window(reg, 0x4020, 16, iter_reg);
1266         iter_reg = qla24xx_read_window(reg, 0x4030, 16, iter_reg);
1267         iter_reg = qla24xx_read_window(reg, 0x4040, 16, iter_reg);
1268         iter_reg = qla24xx_read_window(reg, 0x4050, 16, iter_reg);
1269         iter_reg = qla24xx_read_window(reg, 0x4060, 16, iter_reg);
1270         iter_reg = qla24xx_read_window(reg, 0x4070, 16, iter_reg);
1271         iter_reg = qla24xx_read_window(reg, 0x4080, 16, iter_reg);
1272         iter_reg = qla24xx_read_window(reg, 0x4090, 16, iter_reg);
1273         iter_reg = qla24xx_read_window(reg, 0x40A0, 16, iter_reg);
1274         qla24xx_read_window(reg, 0x40B0, 16, iter_reg);
1275
1276         /* Frame Buffer registers. */
1277         iter_reg = fw->fb_hdw_reg;
1278         iter_reg = qla24xx_read_window(reg, 0x6000, 16, iter_reg);
1279         iter_reg = qla24xx_read_window(reg, 0x6010, 16, iter_reg);
1280         iter_reg = qla24xx_read_window(reg, 0x6020, 16, iter_reg);
1281         iter_reg = qla24xx_read_window(reg, 0x6030, 16, iter_reg);
1282         iter_reg = qla24xx_read_window(reg, 0x6040, 16, iter_reg);
1283         iter_reg = qla24xx_read_window(reg, 0x6100, 16, iter_reg);
1284         iter_reg = qla24xx_read_window(reg, 0x6130, 16, iter_reg);
1285         iter_reg = qla24xx_read_window(reg, 0x6150, 16, iter_reg);
1286         iter_reg = qla24xx_read_window(reg, 0x6170, 16, iter_reg);
1287         iter_reg = qla24xx_read_window(reg, 0x6190, 16, iter_reg);
1288         qla24xx_read_window(reg, 0x61B0, 16, iter_reg);
1289
1290         rval = qla24xx_soft_reset(ha);
1291         if (rval != QLA_SUCCESS)
1292                 goto qla24xx_fw_dump_failed_0;
1293
1294         rval = qla24xx_dump_memory(ha, fw->code_ram, sizeof(fw->code_ram),
1295             &nxt);
1296         if (rval != QLA_SUCCESS)
1297                 goto qla24xx_fw_dump_failed_0;
1298
1299         nxt = qla2xxx_copy_queues(ha, nxt);
1300
1301         qla24xx_copy_eft(ha, nxt);
1302
1303         nxt_chain = (void *)ha->fw_dump + ha->chain_offset;
1304         nxt_chain = qla2xxx_copy_atioqueues(ha, nxt_chain, &last_chain);
1305         if (last_chain) {
1306                 ha->fw_dump->version |= htonl(DUMP_CHAIN_VARIANT);
1307                 *last_chain |= htonl(DUMP_CHAIN_LAST);
1308         }
1309
1310         /* Adjust valid length. */
1311         ha->fw_dump_len = (nxt_chain - (void *)ha->fw_dump);
1312
1313 qla24xx_fw_dump_failed_0:
1314         qla2xxx_dump_post_process(base_vha, rval);
1315 }
1316
1317 void
1318 qla25xx_fw_dump(scsi_qla_host_t *vha)
1319 {
1320         int             rval;
1321         uint32_t        cnt;
1322         struct qla_hw_data *ha = vha->hw;
1323         struct device_reg_24xx __iomem *reg = &ha->iobase->isp24;
1324         __le32 __iomem *dmp_reg;
1325         __be32          *iter_reg;
1326         __le16 __iomem *mbx_reg;
1327         struct qla25xx_fw_dump *fw;
1328         void            *nxt, *nxt_chain;
1329         __be32          *last_chain = NULL;
1330         struct scsi_qla_host *base_vha = pci_get_drvdata(ha->pdev);
1331
1332         lockdep_assert_held(&ha->hardware_lock);
1333
1334         ha->fw_dump_cap_flags = 0;
1335
1336         if (!ha->fw_dump) {
1337                 ql_log(ql_log_warn, vha, 0xd008,
1338                     "No buffer available for dump.\n");
1339                 return;
1340         }
1341
1342         if (ha->fw_dumped) {
1343                 ql_log(ql_log_warn, vha, 0xd009,
1344                     "Firmware has been previously dumped (%p) "
1345                     "-- ignoring request.\n",
1346                     ha->fw_dump);
1347                 return;
1348         }
1349         QLA_FW_STOPPED(ha);
1350         fw = &ha->fw_dump->isp.isp25;
1351         qla2xxx_prep_dump(ha, ha->fw_dump);
1352         ha->fw_dump->version = htonl(2);
1353
1354         fw->host_status = htonl(rd_reg_dword(&reg->host_status));
1355
1356         /*
1357          * Pause RISC. No need to track timeout, as resetting the chip
1358          * is the right approach incase of pause timeout
1359          */
1360         qla24xx_pause_risc(reg, ha);
1361
1362         /* Host/Risc registers. */
1363         iter_reg = fw->host_risc_reg;
1364         iter_reg = qla24xx_read_window(reg, 0x7000, 16, iter_reg);
1365         qla24xx_read_window(reg, 0x7010, 16, iter_reg);
1366
1367         /* PCIe registers. */
1368         wrt_reg_dword(&reg->iobase_addr, 0x7C00);
1369         rd_reg_dword(&reg->iobase_addr);
1370         wrt_reg_dword(&reg->iobase_window, 0x01);
1371         dmp_reg = &reg->iobase_c4;
1372         fw->pcie_regs[0] = htonl(rd_reg_dword(dmp_reg));
1373         dmp_reg++;
1374         fw->pcie_regs[1] = htonl(rd_reg_dword(dmp_reg));
1375         dmp_reg++;
1376         fw->pcie_regs[2] = htonl(rd_reg_dword(dmp_reg));
1377         fw->pcie_regs[3] = htonl(rd_reg_dword(&reg->iobase_window));
1378
1379         wrt_reg_dword(&reg->iobase_window, 0x00);
1380         rd_reg_dword(&reg->iobase_window);
1381
1382         /* Host interface registers. */
1383         dmp_reg = &reg->flash_addr;
1384         for (cnt = 0; cnt < ARRAY_SIZE(fw->host_reg); cnt++, dmp_reg++)
1385                 fw->host_reg[cnt] = htonl(rd_reg_dword(dmp_reg));
1386
1387         /* Disable interrupts. */
1388         wrt_reg_dword(&reg->ictrl, 0);
1389         rd_reg_dword(&reg->ictrl);
1390
1391         /* Shadow registers. */
1392         wrt_reg_dword(&reg->iobase_addr, 0x0F70);
1393         rd_reg_dword(&reg->iobase_addr);
1394         wrt_reg_dword(&reg->iobase_select, 0xB0000000);
1395         fw->shadow_reg[0] = htonl(rd_reg_dword(&reg->iobase_sdata));
1396
1397         wrt_reg_dword(&reg->iobase_select, 0xB0100000);
1398         fw->shadow_reg[1] = htonl(rd_reg_dword(&reg->iobase_sdata));
1399
1400         wrt_reg_dword(&reg->iobase_select, 0xB0200000);
1401         fw->shadow_reg[2] = htonl(rd_reg_dword(&reg->iobase_sdata));
1402
1403         wrt_reg_dword(&reg->iobase_select, 0xB0300000);
1404         fw->shadow_reg[3] = htonl(rd_reg_dword(&reg->iobase_sdata));
1405
1406         wrt_reg_dword(&reg->iobase_select, 0xB0400000);
1407         fw->shadow_reg[4] = htonl(rd_reg_dword(&reg->iobase_sdata));
1408
1409         wrt_reg_dword(&reg->iobase_select, 0xB0500000);
1410         fw->shadow_reg[5] = htonl(rd_reg_dword(&reg->iobase_sdata));
1411
1412         wrt_reg_dword(&reg->iobase_select, 0xB0600000);
1413         fw->shadow_reg[6] = htonl(rd_reg_dword(&reg->iobase_sdata));
1414
1415         wrt_reg_dword(&reg->iobase_select, 0xB0700000);
1416         fw->shadow_reg[7] = htonl(rd_reg_dword(&reg->iobase_sdata));
1417
1418         wrt_reg_dword(&reg->iobase_select, 0xB0800000);
1419         fw->shadow_reg[8] = htonl(rd_reg_dword(&reg->iobase_sdata));
1420
1421         wrt_reg_dword(&reg->iobase_select, 0xB0900000);
1422         fw->shadow_reg[9] = htonl(rd_reg_dword(&reg->iobase_sdata));
1423
1424         wrt_reg_dword(&reg->iobase_select, 0xB0A00000);
1425         fw->shadow_reg[10] = htonl(rd_reg_dword(&reg->iobase_sdata));
1426
1427         /* RISC I/O register. */
1428         wrt_reg_dword(&reg->iobase_addr, 0x0010);
1429         fw->risc_io_reg = htonl(rd_reg_dword(&reg->iobase_window));
1430
1431         /* Mailbox registers. */
1432         mbx_reg = &reg->mailbox0;
1433         for (cnt = 0; cnt < ARRAY_SIZE(fw->mailbox_reg); cnt++, mbx_reg++)
1434                 fw->mailbox_reg[cnt] = htons(rd_reg_word(mbx_reg));
1435
1436         /* Transfer sequence registers. */
1437         iter_reg = fw->xseq_gp_reg;
1438         iter_reg = qla24xx_read_window(reg, 0xBF00, 16, iter_reg);
1439         iter_reg = qla24xx_read_window(reg, 0xBF10, 16, iter_reg);
1440         iter_reg = qla24xx_read_window(reg, 0xBF20, 16, iter_reg);
1441         iter_reg = qla24xx_read_window(reg, 0xBF30, 16, iter_reg);
1442         iter_reg = qla24xx_read_window(reg, 0xBF40, 16, iter_reg);
1443         iter_reg = qla24xx_read_window(reg, 0xBF50, 16, iter_reg);
1444         iter_reg = qla24xx_read_window(reg, 0xBF60, 16, iter_reg);
1445         qla24xx_read_window(reg, 0xBF70, 16, iter_reg);
1446
1447         iter_reg = fw->xseq_0_reg;
1448         iter_reg = qla24xx_read_window(reg, 0xBFC0, 16, iter_reg);
1449         iter_reg = qla24xx_read_window(reg, 0xBFD0, 16, iter_reg);
1450         qla24xx_read_window(reg, 0xBFE0, 16, iter_reg);
1451
1452         qla24xx_read_window(reg, 0xBFF0, 16, fw->xseq_1_reg);
1453
1454         /* Receive sequence registers. */
1455         iter_reg = fw->rseq_gp_reg;
1456         iter_reg = qla24xx_read_window(reg, 0xFF00, 16, iter_reg);
1457         iter_reg = qla24xx_read_window(reg, 0xFF10, 16, iter_reg);
1458         iter_reg = qla24xx_read_window(reg, 0xFF20, 16, iter_reg);
1459         iter_reg = qla24xx_read_window(reg, 0xFF30, 16, iter_reg);
1460         iter_reg = qla24xx_read_window(reg, 0xFF40, 16, iter_reg);
1461         iter_reg = qla24xx_read_window(reg, 0xFF50, 16, iter_reg);
1462         iter_reg = qla24xx_read_window(reg, 0xFF60, 16, iter_reg);
1463         qla24xx_read_window(reg, 0xFF70, 16, iter_reg);
1464
1465         iter_reg = fw->rseq_0_reg;
1466         iter_reg = qla24xx_read_window(reg, 0xFFC0, 16, iter_reg);
1467         qla24xx_read_window(reg, 0xFFD0, 16, iter_reg);
1468
1469         qla24xx_read_window(reg, 0xFFE0, 16, fw->rseq_1_reg);
1470         qla24xx_read_window(reg, 0xFFF0, 16, fw->rseq_2_reg);
1471
1472         /* Auxiliary sequence registers. */
1473         iter_reg = fw->aseq_gp_reg;
1474         iter_reg = qla24xx_read_window(reg, 0xB000, 16, iter_reg);
1475         iter_reg = qla24xx_read_window(reg, 0xB010, 16, iter_reg);
1476         iter_reg = qla24xx_read_window(reg, 0xB020, 16, iter_reg);
1477         iter_reg = qla24xx_read_window(reg, 0xB030, 16, iter_reg);
1478         iter_reg = qla24xx_read_window(reg, 0xB040, 16, iter_reg);
1479         iter_reg = qla24xx_read_window(reg, 0xB050, 16, iter_reg);
1480         iter_reg = qla24xx_read_window(reg, 0xB060, 16, iter_reg);
1481         qla24xx_read_window(reg, 0xB070, 16, iter_reg);
1482
1483         iter_reg = fw->aseq_0_reg;
1484         iter_reg = qla24xx_read_window(reg, 0xB0C0, 16, iter_reg);
1485         qla24xx_read_window(reg, 0xB0D0, 16, iter_reg);
1486
1487         qla24xx_read_window(reg, 0xB0E0, 16, fw->aseq_1_reg);
1488         qla24xx_read_window(reg, 0xB0F0, 16, fw->aseq_2_reg);
1489
1490         /* Command DMA registers. */
1491         qla24xx_read_window(reg, 0x7100, 16, fw->cmd_dma_reg);
1492
1493         /* Queues. */
1494         iter_reg = fw->req0_dma_reg;
1495         iter_reg = qla24xx_read_window(reg, 0x7200, 8, iter_reg);
1496         dmp_reg = &reg->iobase_q;
1497         for (cnt = 0; cnt < 7; cnt++, dmp_reg++)
1498                 *iter_reg++ = htonl(rd_reg_dword(dmp_reg));
1499
1500         iter_reg = fw->resp0_dma_reg;
1501         iter_reg = qla24xx_read_window(reg, 0x7300, 8, iter_reg);
1502         dmp_reg = &reg->iobase_q;
1503         for (cnt = 0; cnt < 7; cnt++, dmp_reg++)
1504                 *iter_reg++ = htonl(rd_reg_dword(dmp_reg));
1505
1506         iter_reg = fw->req1_dma_reg;
1507         iter_reg = qla24xx_read_window(reg, 0x7400, 8, iter_reg);
1508         dmp_reg = &reg->iobase_q;
1509         for (cnt = 0; cnt < 7; cnt++, dmp_reg++)
1510                 *iter_reg++ = htonl(rd_reg_dword(dmp_reg));
1511
1512         /* Transmit DMA registers. */
1513         iter_reg = fw->xmt0_dma_reg;
1514         iter_reg = qla24xx_read_window(reg, 0x7600, 16, iter_reg);
1515         qla24xx_read_window(reg, 0x7610, 16, iter_reg);
1516
1517         iter_reg = fw->xmt1_dma_reg;
1518         iter_reg = qla24xx_read_window(reg, 0x7620, 16, iter_reg);
1519         qla24xx_read_window(reg, 0x7630, 16, iter_reg);
1520
1521         iter_reg = fw->xmt2_dma_reg;
1522         iter_reg = qla24xx_read_window(reg, 0x7640, 16, iter_reg);
1523         qla24xx_read_window(reg, 0x7650, 16, iter_reg);
1524
1525         iter_reg = fw->xmt3_dma_reg;
1526         iter_reg = qla24xx_read_window(reg, 0x7660, 16, iter_reg);
1527         qla24xx_read_window(reg, 0x7670, 16, iter_reg);
1528
1529         iter_reg = fw->xmt4_dma_reg;
1530         iter_reg = qla24xx_read_window(reg, 0x7680, 16, iter_reg);
1531         qla24xx_read_window(reg, 0x7690, 16, iter_reg);
1532
1533         qla24xx_read_window(reg, 0x76A0, 16, fw->xmt_data_dma_reg);
1534
1535         /* Receive DMA registers. */
1536         iter_reg = fw->rcvt0_data_dma_reg;
1537         iter_reg = qla24xx_read_window(reg, 0x7700, 16, iter_reg);
1538         qla24xx_read_window(reg, 0x7710, 16, iter_reg);
1539
1540         iter_reg = fw->rcvt1_data_dma_reg;
1541         iter_reg = qla24xx_read_window(reg, 0x7720, 16, iter_reg);
1542         qla24xx_read_window(reg, 0x7730, 16, iter_reg);
1543
1544         /* RISC registers. */
1545         iter_reg = fw->risc_gp_reg;
1546         iter_reg = qla24xx_read_window(reg, 0x0F00, 16, iter_reg);
1547         iter_reg = qla24xx_read_window(reg, 0x0F10, 16, iter_reg);
1548         iter_reg = qla24xx_read_window(reg, 0x0F20, 16, iter_reg);
1549         iter_reg = qla24xx_read_window(reg, 0x0F30, 16, iter_reg);
1550         iter_reg = qla24xx_read_window(reg, 0x0F40, 16, iter_reg);
1551         iter_reg = qla24xx_read_window(reg, 0x0F50, 16, iter_reg);
1552         iter_reg = qla24xx_read_window(reg, 0x0F60, 16, iter_reg);
1553         qla24xx_read_window(reg, 0x0F70, 16, iter_reg);
1554
1555         /* Local memory controller registers. */
1556         iter_reg = fw->lmc_reg;
1557         iter_reg = qla24xx_read_window(reg, 0x3000, 16, iter_reg);
1558         iter_reg = qla24xx_read_window(reg, 0x3010, 16, iter_reg);
1559         iter_reg = qla24xx_read_window(reg, 0x3020, 16, iter_reg);
1560         iter_reg = qla24xx_read_window(reg, 0x3030, 16, iter_reg);
1561         iter_reg = qla24xx_read_window(reg, 0x3040, 16, iter_reg);
1562         iter_reg = qla24xx_read_window(reg, 0x3050, 16, iter_reg);
1563         iter_reg = qla24xx_read_window(reg, 0x3060, 16, iter_reg);
1564         qla24xx_read_window(reg, 0x3070, 16, iter_reg);
1565
1566         /* Fibre Protocol Module registers. */
1567         iter_reg = fw->fpm_hdw_reg;
1568         iter_reg = qla24xx_read_window(reg, 0x4000, 16, iter_reg);
1569         iter_reg = qla24xx_read_window(reg, 0x4010, 16, iter_reg);
1570         iter_reg = qla24xx_read_window(reg, 0x4020, 16, iter_reg);
1571         iter_reg = qla24xx_read_window(reg, 0x4030, 16, iter_reg);
1572         iter_reg = qla24xx_read_window(reg, 0x4040, 16, iter_reg);
1573         iter_reg = qla24xx_read_window(reg, 0x4050, 16, iter_reg);
1574         iter_reg = qla24xx_read_window(reg, 0x4060, 16, iter_reg);
1575         iter_reg = qla24xx_read_window(reg, 0x4070, 16, iter_reg);
1576         iter_reg = qla24xx_read_window(reg, 0x4080, 16, iter_reg);
1577         iter_reg = qla24xx_read_window(reg, 0x4090, 16, iter_reg);
1578         iter_reg = qla24xx_read_window(reg, 0x40A0, 16, iter_reg);
1579         qla24xx_read_window(reg, 0x40B0, 16, iter_reg);
1580
1581         /* Frame Buffer registers. */
1582         iter_reg = fw->fb_hdw_reg;
1583         iter_reg = qla24xx_read_window(reg, 0x6000, 16, iter_reg);
1584         iter_reg = qla24xx_read_window(reg, 0x6010, 16, iter_reg);
1585         iter_reg = qla24xx_read_window(reg, 0x6020, 16, iter_reg);
1586         iter_reg = qla24xx_read_window(reg, 0x6030, 16, iter_reg);
1587         iter_reg = qla24xx_read_window(reg, 0x6040, 16, iter_reg);
1588         iter_reg = qla24xx_read_window(reg, 0x6100, 16, iter_reg);
1589         iter_reg = qla24xx_read_window(reg, 0x6130, 16, iter_reg);
1590         iter_reg = qla24xx_read_window(reg, 0x6150, 16, iter_reg);
1591         iter_reg = qla24xx_read_window(reg, 0x6170, 16, iter_reg);
1592         iter_reg = qla24xx_read_window(reg, 0x6190, 16, iter_reg);
1593         iter_reg = qla24xx_read_window(reg, 0x61B0, 16, iter_reg);
1594         qla24xx_read_window(reg, 0x6F00, 16, iter_reg);
1595
1596         /* Multi queue registers */
1597         nxt_chain = qla25xx_copy_mq(ha, (void *)ha->fw_dump + ha->chain_offset,
1598             &last_chain);
1599
1600         rval = qla24xx_soft_reset(ha);
1601         if (rval != QLA_SUCCESS)
1602                 goto qla25xx_fw_dump_failed_0;
1603
1604         rval = qla24xx_dump_memory(ha, fw->code_ram, sizeof(fw->code_ram),
1605             &nxt);
1606         if (rval != QLA_SUCCESS)
1607                 goto qla25xx_fw_dump_failed_0;
1608
1609         nxt = qla2xxx_copy_queues(ha, nxt);
1610
1611         qla24xx_copy_eft(ha, nxt);
1612
1613         /* Chain entries -- started with MQ. */
1614         nxt_chain = qla25xx_copy_fce(ha, nxt_chain, &last_chain);
1615         nxt_chain = qla25xx_copy_mqueues(ha, nxt_chain, &last_chain);
1616         nxt_chain = qla2xxx_copy_atioqueues(ha, nxt_chain, &last_chain);
1617         nxt_chain = qla25xx_copy_exlogin(ha, nxt_chain, &last_chain);
1618         if (last_chain) {
1619                 ha->fw_dump->version |= htonl(DUMP_CHAIN_VARIANT);
1620                 *last_chain |= htonl(DUMP_CHAIN_LAST);
1621         }
1622
1623         /* Adjust valid length. */
1624         ha->fw_dump_len = (nxt_chain - (void *)ha->fw_dump);
1625
1626 qla25xx_fw_dump_failed_0:
1627         qla2xxx_dump_post_process(base_vha, rval);
1628 }
1629
1630 void
1631 qla81xx_fw_dump(scsi_qla_host_t *vha)
1632 {
1633         int             rval;
1634         uint32_t        cnt;
1635         struct qla_hw_data *ha = vha->hw;
1636         struct device_reg_24xx __iomem *reg = &ha->iobase->isp24;
1637         __le32 __iomem *dmp_reg;
1638         __be32          *iter_reg;
1639         __le16 __iomem *mbx_reg;
1640         struct qla81xx_fw_dump *fw;
1641         void            *nxt, *nxt_chain;
1642         __be32          *last_chain = NULL;
1643         struct scsi_qla_host *base_vha = pci_get_drvdata(ha->pdev);
1644
1645         lockdep_assert_held(&ha->hardware_lock);
1646
1647         ha->fw_dump_cap_flags = 0;
1648
1649         if (!ha->fw_dump) {
1650                 ql_log(ql_log_warn, vha, 0xd00a,
1651                     "No buffer available for dump.\n");
1652                 return;
1653         }
1654
1655         if (ha->fw_dumped) {
1656                 ql_log(ql_log_warn, vha, 0xd00b,
1657                     "Firmware has been previously dumped (%p) "
1658                     "-- ignoring request.\n",
1659                     ha->fw_dump);
1660                 return;
1661         }
1662         fw = &ha->fw_dump->isp.isp81;
1663         qla2xxx_prep_dump(ha, ha->fw_dump);
1664
1665         fw->host_status = htonl(rd_reg_dword(&reg->host_status));
1666
1667         /*
1668          * Pause RISC. No need to track timeout, as resetting the chip
1669          * is the right approach incase of pause timeout
1670          */
1671         qla24xx_pause_risc(reg, ha);
1672
1673         /* Host/Risc registers. */
1674         iter_reg = fw->host_risc_reg;
1675         iter_reg = qla24xx_read_window(reg, 0x7000, 16, iter_reg);
1676         qla24xx_read_window(reg, 0x7010, 16, iter_reg);
1677
1678         /* PCIe registers. */
1679         wrt_reg_dword(&reg->iobase_addr, 0x7C00);
1680         rd_reg_dword(&reg->iobase_addr);
1681         wrt_reg_dword(&reg->iobase_window, 0x01);
1682         dmp_reg = &reg->iobase_c4;
1683         fw->pcie_regs[0] = htonl(rd_reg_dword(dmp_reg));
1684         dmp_reg++;
1685         fw->pcie_regs[1] = htonl(rd_reg_dword(dmp_reg));
1686         dmp_reg++;
1687         fw->pcie_regs[2] = htonl(rd_reg_dword(dmp_reg));
1688         fw->pcie_regs[3] = htonl(rd_reg_dword(&reg->iobase_window));
1689
1690         wrt_reg_dword(&reg->iobase_window, 0x00);
1691         rd_reg_dword(&reg->iobase_window);
1692
1693         /* Host interface registers. */
1694         dmp_reg = &reg->flash_addr;
1695         for (cnt = 0; cnt < ARRAY_SIZE(fw->host_reg); cnt++, dmp_reg++)
1696                 fw->host_reg[cnt] = htonl(rd_reg_dword(dmp_reg));
1697
1698         /* Disable interrupts. */
1699         wrt_reg_dword(&reg->ictrl, 0);
1700         rd_reg_dword(&reg->ictrl);
1701
1702         /* Shadow registers. */
1703         wrt_reg_dword(&reg->iobase_addr, 0x0F70);
1704         rd_reg_dword(&reg->iobase_addr);
1705         wrt_reg_dword(&reg->iobase_select, 0xB0000000);
1706         fw->shadow_reg[0] = htonl(rd_reg_dword(&reg->iobase_sdata));
1707
1708         wrt_reg_dword(&reg->iobase_select, 0xB0100000);
1709         fw->shadow_reg[1] = htonl(rd_reg_dword(&reg->iobase_sdata));
1710
1711         wrt_reg_dword(&reg->iobase_select, 0xB0200000);
1712         fw->shadow_reg[2] = htonl(rd_reg_dword(&reg->iobase_sdata));
1713
1714         wrt_reg_dword(&reg->iobase_select, 0xB0300000);
1715         fw->shadow_reg[3] = htonl(rd_reg_dword(&reg->iobase_sdata));
1716
1717         wrt_reg_dword(&reg->iobase_select, 0xB0400000);
1718         fw->shadow_reg[4] = htonl(rd_reg_dword(&reg->iobase_sdata));
1719
1720         wrt_reg_dword(&reg->iobase_select, 0xB0500000);
1721         fw->shadow_reg[5] = htonl(rd_reg_dword(&reg->iobase_sdata));
1722
1723         wrt_reg_dword(&reg->iobase_select, 0xB0600000);
1724         fw->shadow_reg[6] = htonl(rd_reg_dword(&reg->iobase_sdata));
1725
1726         wrt_reg_dword(&reg->iobase_select, 0xB0700000);
1727         fw->shadow_reg[7] = htonl(rd_reg_dword(&reg->iobase_sdata));
1728
1729         wrt_reg_dword(&reg->iobase_select, 0xB0800000);
1730         fw->shadow_reg[8] = htonl(rd_reg_dword(&reg->iobase_sdata));
1731
1732         wrt_reg_dword(&reg->iobase_select, 0xB0900000);
1733         fw->shadow_reg[9] = htonl(rd_reg_dword(&reg->iobase_sdata));
1734
1735         wrt_reg_dword(&reg->iobase_select, 0xB0A00000);
1736         fw->shadow_reg[10] = htonl(rd_reg_dword(&reg->iobase_sdata));
1737
1738         /* RISC I/O register. */
1739         wrt_reg_dword(&reg->iobase_addr, 0x0010);
1740         fw->risc_io_reg = htonl(rd_reg_dword(&reg->iobase_window));
1741
1742         /* Mailbox registers. */
1743         mbx_reg = &reg->mailbox0;
1744         for (cnt = 0; cnt < ARRAY_SIZE(fw->mailbox_reg); cnt++, mbx_reg++)
1745                 fw->mailbox_reg[cnt] = htons(rd_reg_word(mbx_reg));
1746
1747         /* Transfer sequence registers. */
1748         iter_reg = fw->xseq_gp_reg;
1749         iter_reg = qla24xx_read_window(reg, 0xBF00, 16, iter_reg);
1750         iter_reg = qla24xx_read_window(reg, 0xBF10, 16, iter_reg);
1751         iter_reg = qla24xx_read_window(reg, 0xBF20, 16, iter_reg);
1752         iter_reg = qla24xx_read_window(reg, 0xBF30, 16, iter_reg);
1753         iter_reg = qla24xx_read_window(reg, 0xBF40, 16, iter_reg);
1754         iter_reg = qla24xx_read_window(reg, 0xBF50, 16, iter_reg);
1755         iter_reg = qla24xx_read_window(reg, 0xBF60, 16, iter_reg);
1756         qla24xx_read_window(reg, 0xBF70, 16, iter_reg);
1757
1758         iter_reg = fw->xseq_0_reg;
1759         iter_reg = qla24xx_read_window(reg, 0xBFC0, 16, iter_reg);
1760         iter_reg = qla24xx_read_window(reg, 0xBFD0, 16, iter_reg);
1761         qla24xx_read_window(reg, 0xBFE0, 16, iter_reg);
1762
1763         qla24xx_read_window(reg, 0xBFF0, 16, fw->xseq_1_reg);
1764
1765         /* Receive sequence registers. */
1766         iter_reg = fw->rseq_gp_reg;
1767         iter_reg = qla24xx_read_window(reg, 0xFF00, 16, iter_reg);
1768         iter_reg = qla24xx_read_window(reg, 0xFF10, 16, iter_reg);
1769         iter_reg = qla24xx_read_window(reg, 0xFF20, 16, iter_reg);
1770         iter_reg = qla24xx_read_window(reg, 0xFF30, 16, iter_reg);
1771         iter_reg = qla24xx_read_window(reg, 0xFF40, 16, iter_reg);
1772         iter_reg = qla24xx_read_window(reg, 0xFF50, 16, iter_reg);
1773         iter_reg = qla24xx_read_window(reg, 0xFF60, 16, iter_reg);
1774         qla24xx_read_window(reg, 0xFF70, 16, iter_reg);
1775
1776         iter_reg = fw->rseq_0_reg;
1777         iter_reg = qla24xx_read_window(reg, 0xFFC0, 16, iter_reg);
1778         qla24xx_read_window(reg, 0xFFD0, 16, iter_reg);
1779
1780         qla24xx_read_window(reg, 0xFFE0, 16, fw->rseq_1_reg);
1781         qla24xx_read_window(reg, 0xFFF0, 16, fw->rseq_2_reg);
1782
1783         /* Auxiliary sequence registers. */
1784         iter_reg = fw->aseq_gp_reg;
1785         iter_reg = qla24xx_read_window(reg, 0xB000, 16, iter_reg);
1786         iter_reg = qla24xx_read_window(reg, 0xB010, 16, iter_reg);
1787         iter_reg = qla24xx_read_window(reg, 0xB020, 16, iter_reg);
1788         iter_reg = qla24xx_read_window(reg, 0xB030, 16, iter_reg);
1789         iter_reg = qla24xx_read_window(reg, 0xB040, 16, iter_reg);
1790         iter_reg = qla24xx_read_window(reg, 0xB050, 16, iter_reg);
1791         iter_reg = qla24xx_read_window(reg, 0xB060, 16, iter_reg);
1792         qla24xx_read_window(reg, 0xB070, 16, iter_reg);
1793
1794         iter_reg = fw->aseq_0_reg;
1795         iter_reg = qla24xx_read_window(reg, 0xB0C0, 16, iter_reg);
1796         qla24xx_read_window(reg, 0xB0D0, 16, iter_reg);
1797
1798         qla24xx_read_window(reg, 0xB0E0, 16, fw->aseq_1_reg);
1799         qla24xx_read_window(reg, 0xB0F0, 16, fw->aseq_2_reg);
1800
1801         /* Command DMA registers. */
1802         qla24xx_read_window(reg, 0x7100, 16, fw->cmd_dma_reg);
1803
1804         /* Queues. */
1805         iter_reg = fw->req0_dma_reg;
1806         iter_reg = qla24xx_read_window(reg, 0x7200, 8, iter_reg);
1807         dmp_reg = &reg->iobase_q;
1808         for (cnt = 0; cnt < 7; cnt++, dmp_reg++)
1809                 *iter_reg++ = htonl(rd_reg_dword(dmp_reg));
1810
1811         iter_reg = fw->resp0_dma_reg;
1812         iter_reg = qla24xx_read_window(reg, 0x7300, 8, iter_reg);
1813         dmp_reg = &reg->iobase_q;
1814         for (cnt = 0; cnt < 7; cnt++, dmp_reg++)
1815                 *iter_reg++ = htonl(rd_reg_dword(dmp_reg));
1816
1817         iter_reg = fw->req1_dma_reg;
1818         iter_reg = qla24xx_read_window(reg, 0x7400, 8, iter_reg);
1819         dmp_reg = &reg->iobase_q;
1820         for (cnt = 0; cnt < 7; cnt++, dmp_reg++)
1821                 *iter_reg++ = htonl(rd_reg_dword(dmp_reg));
1822
1823         /* Transmit DMA registers. */
1824         iter_reg = fw->xmt0_dma_reg;
1825         iter_reg = qla24xx_read_window(reg, 0x7600, 16, iter_reg);
1826         qla24xx_read_window(reg, 0x7610, 16, iter_reg);
1827
1828         iter_reg = fw->xmt1_dma_reg;
1829         iter_reg = qla24xx_read_window(reg, 0x7620, 16, iter_reg);
1830         qla24xx_read_window(reg, 0x7630, 16, iter_reg);
1831
1832         iter_reg = fw->xmt2_dma_reg;
1833         iter_reg = qla24xx_read_window(reg, 0x7640, 16, iter_reg);
1834         qla24xx_read_window(reg, 0x7650, 16, iter_reg);
1835
1836         iter_reg = fw->xmt3_dma_reg;
1837         iter_reg = qla24xx_read_window(reg, 0x7660, 16, iter_reg);
1838         qla24xx_read_window(reg, 0x7670, 16, iter_reg);
1839
1840         iter_reg = fw->xmt4_dma_reg;
1841         iter_reg = qla24xx_read_window(reg, 0x7680, 16, iter_reg);
1842         qla24xx_read_window(reg, 0x7690, 16, iter_reg);
1843
1844         qla24xx_read_window(reg, 0x76A0, 16, fw->xmt_data_dma_reg);
1845
1846         /* Receive DMA registers. */
1847         iter_reg = fw->rcvt0_data_dma_reg;
1848         iter_reg = qla24xx_read_window(reg, 0x7700, 16, iter_reg);
1849         qla24xx_read_window(reg, 0x7710, 16, iter_reg);
1850
1851         iter_reg = fw->rcvt1_data_dma_reg;
1852         iter_reg = qla24xx_read_window(reg, 0x7720, 16, iter_reg);
1853         qla24xx_read_window(reg, 0x7730, 16, iter_reg);
1854
1855         /* RISC registers. */
1856         iter_reg = fw->risc_gp_reg;
1857         iter_reg = qla24xx_read_window(reg, 0x0F00, 16, iter_reg);
1858         iter_reg = qla24xx_read_window(reg, 0x0F10, 16, iter_reg);
1859         iter_reg = qla24xx_read_window(reg, 0x0F20, 16, iter_reg);
1860         iter_reg = qla24xx_read_window(reg, 0x0F30, 16, iter_reg);
1861         iter_reg = qla24xx_read_window(reg, 0x0F40, 16, iter_reg);
1862         iter_reg = qla24xx_read_window(reg, 0x0F50, 16, iter_reg);
1863         iter_reg = qla24xx_read_window(reg, 0x0F60, 16, iter_reg);
1864         qla24xx_read_window(reg, 0x0F70, 16, iter_reg);
1865
1866         /* Local memory controller registers. */
1867         iter_reg = fw->lmc_reg;
1868         iter_reg = qla24xx_read_window(reg, 0x3000, 16, iter_reg);
1869         iter_reg = qla24xx_read_window(reg, 0x3010, 16, iter_reg);
1870         iter_reg = qla24xx_read_window(reg, 0x3020, 16, iter_reg);
1871         iter_reg = qla24xx_read_window(reg, 0x3030, 16, iter_reg);
1872         iter_reg = qla24xx_read_window(reg, 0x3040, 16, iter_reg);
1873         iter_reg = qla24xx_read_window(reg, 0x3050, 16, iter_reg);
1874         iter_reg = qla24xx_read_window(reg, 0x3060, 16, iter_reg);
1875         qla24xx_read_window(reg, 0x3070, 16, iter_reg);
1876
1877         /* Fibre Protocol Module registers. */
1878         iter_reg = fw->fpm_hdw_reg;
1879         iter_reg = qla24xx_read_window(reg, 0x4000, 16, iter_reg);
1880         iter_reg = qla24xx_read_window(reg, 0x4010, 16, iter_reg);
1881         iter_reg = qla24xx_read_window(reg, 0x4020, 16, iter_reg);
1882         iter_reg = qla24xx_read_window(reg, 0x4030, 16, iter_reg);
1883         iter_reg = qla24xx_read_window(reg, 0x4040, 16, iter_reg);
1884         iter_reg = qla24xx_read_window(reg, 0x4050, 16, iter_reg);
1885         iter_reg = qla24xx_read_window(reg, 0x4060, 16, iter_reg);
1886         iter_reg = qla24xx_read_window(reg, 0x4070, 16, iter_reg);
1887         iter_reg = qla24xx_read_window(reg, 0x4080, 16, iter_reg);
1888         iter_reg = qla24xx_read_window(reg, 0x4090, 16, iter_reg);
1889         iter_reg = qla24xx_read_window(reg, 0x40A0, 16, iter_reg);
1890         iter_reg = qla24xx_read_window(reg, 0x40B0, 16, iter_reg);
1891         iter_reg = qla24xx_read_window(reg, 0x40C0, 16, iter_reg);
1892         qla24xx_read_window(reg, 0x40D0, 16, iter_reg);
1893
1894         /* Frame Buffer registers. */
1895         iter_reg = fw->fb_hdw_reg;
1896         iter_reg = qla24xx_read_window(reg, 0x6000, 16, iter_reg);
1897         iter_reg = qla24xx_read_window(reg, 0x6010, 16, iter_reg);
1898         iter_reg = qla24xx_read_window(reg, 0x6020, 16, iter_reg);
1899         iter_reg = qla24xx_read_window(reg, 0x6030, 16, iter_reg);
1900         iter_reg = qla24xx_read_window(reg, 0x6040, 16, iter_reg);
1901         iter_reg = qla24xx_read_window(reg, 0x6100, 16, iter_reg);
1902         iter_reg = qla24xx_read_window(reg, 0x6130, 16, iter_reg);
1903         iter_reg = qla24xx_read_window(reg, 0x6150, 16, iter_reg);
1904         iter_reg = qla24xx_read_window(reg, 0x6170, 16, iter_reg);
1905         iter_reg = qla24xx_read_window(reg, 0x6190, 16, iter_reg);
1906         iter_reg = qla24xx_read_window(reg, 0x61B0, 16, iter_reg);
1907         iter_reg = qla24xx_read_window(reg, 0x61C0, 16, iter_reg);
1908         qla24xx_read_window(reg, 0x6F00, 16, iter_reg);
1909
1910         /* Multi queue registers */
1911         nxt_chain = qla25xx_copy_mq(ha, (void *)ha->fw_dump + ha->chain_offset,
1912             &last_chain);
1913
1914         rval = qla24xx_soft_reset(ha);
1915         if (rval != QLA_SUCCESS)
1916                 goto qla81xx_fw_dump_failed_0;
1917
1918         rval = qla24xx_dump_memory(ha, fw->code_ram, sizeof(fw->code_ram),
1919             &nxt);
1920         if (rval != QLA_SUCCESS)
1921                 goto qla81xx_fw_dump_failed_0;
1922
1923         nxt = qla2xxx_copy_queues(ha, nxt);
1924
1925         qla24xx_copy_eft(ha, nxt);
1926
1927         /* Chain entries -- started with MQ. */
1928         nxt_chain = qla25xx_copy_fce(ha, nxt_chain, &last_chain);
1929         nxt_chain = qla25xx_copy_mqueues(ha, nxt_chain, &last_chain);
1930         nxt_chain = qla2xxx_copy_atioqueues(ha, nxt_chain, &last_chain);
1931         nxt_chain = qla25xx_copy_exlogin(ha, nxt_chain, &last_chain);
1932         nxt_chain = qla81xx_copy_exchoffld(ha, nxt_chain, &last_chain);
1933         if (last_chain) {
1934                 ha->fw_dump->version |= htonl(DUMP_CHAIN_VARIANT);
1935                 *last_chain |= htonl(DUMP_CHAIN_LAST);
1936         }
1937
1938         /* Adjust valid length. */
1939         ha->fw_dump_len = (nxt_chain - (void *)ha->fw_dump);
1940
1941 qla81xx_fw_dump_failed_0:
1942         qla2xxx_dump_post_process(base_vha, rval);
1943 }
1944
1945 void
1946 qla83xx_fw_dump(scsi_qla_host_t *vha)
1947 {
1948         int             rval;
1949         uint32_t        cnt;
1950         struct qla_hw_data *ha = vha->hw;
1951         struct device_reg_24xx __iomem *reg = &ha->iobase->isp24;
1952         __le32 __iomem *dmp_reg;
1953         __be32          *iter_reg;
1954         __le16 __iomem *mbx_reg;
1955         struct qla83xx_fw_dump *fw;
1956         void            *nxt, *nxt_chain;
1957         __be32          *last_chain = NULL;
1958         struct scsi_qla_host *base_vha = pci_get_drvdata(ha->pdev);
1959
1960         lockdep_assert_held(&ha->hardware_lock);
1961
1962         ha->fw_dump_cap_flags = 0;
1963
1964         if (!ha->fw_dump) {
1965                 ql_log(ql_log_warn, vha, 0xd00c,
1966                     "No buffer available for dump!!!\n");
1967                 return;
1968         }
1969
1970         if (ha->fw_dumped) {
1971                 ql_log(ql_log_warn, vha, 0xd00d,
1972                     "Firmware has been previously dumped (%p) -- ignoring "
1973                     "request...\n", ha->fw_dump);
1974                 return;
1975         }
1976         QLA_FW_STOPPED(ha);
1977         fw = &ha->fw_dump->isp.isp83;
1978         qla2xxx_prep_dump(ha, ha->fw_dump);
1979
1980         fw->host_status = htonl(rd_reg_dword(&reg->host_status));
1981
1982         /*
1983          * Pause RISC. No need to track timeout, as resetting the chip
1984          * is the right approach incase of pause timeout
1985          */
1986         qla24xx_pause_risc(reg, ha);
1987
1988         wrt_reg_dword(&reg->iobase_addr, 0x6000);
1989         dmp_reg = &reg->iobase_window;
1990         rd_reg_dword(dmp_reg);
1991         wrt_reg_dword(dmp_reg, 0);
1992
1993         dmp_reg = &reg->unused_4_1[0];
1994         rd_reg_dword(dmp_reg);
1995         wrt_reg_dword(dmp_reg, 0);
1996
1997         wrt_reg_dword(&reg->iobase_addr, 0x6010);
1998         dmp_reg = &reg->unused_4_1[2];
1999         rd_reg_dword(dmp_reg);
2000         wrt_reg_dword(dmp_reg, 0);
2001
2002         /* select PCR and disable ecc checking and correction */
2003         wrt_reg_dword(&reg->iobase_addr, 0x0F70);
2004         rd_reg_dword(&reg->iobase_addr);
2005         wrt_reg_dword(&reg->iobase_select, 0x60000000); /* write to F0h = PCR */
2006
2007         /* Host/Risc registers. */
2008         iter_reg = fw->host_risc_reg;
2009         iter_reg = qla24xx_read_window(reg, 0x7000, 16, iter_reg);
2010         iter_reg = qla24xx_read_window(reg, 0x7010, 16, iter_reg);
2011         qla24xx_read_window(reg, 0x7040, 16, iter_reg);
2012
2013         /* PCIe registers. */
2014         wrt_reg_dword(&reg->iobase_addr, 0x7C00);
2015         rd_reg_dword(&reg->iobase_addr);
2016         wrt_reg_dword(&reg->iobase_window, 0x01);
2017         dmp_reg = &reg->iobase_c4;
2018         fw->pcie_regs[0] = htonl(rd_reg_dword(dmp_reg));
2019         dmp_reg++;
2020         fw->pcie_regs[1] = htonl(rd_reg_dword(dmp_reg));
2021         dmp_reg++;
2022         fw->pcie_regs[2] = htonl(rd_reg_dword(dmp_reg));
2023         fw->pcie_regs[3] = htonl(rd_reg_dword(&reg->iobase_window));
2024
2025         wrt_reg_dword(&reg->iobase_window, 0x00);
2026         rd_reg_dword(&reg->iobase_window);
2027
2028         /* Host interface registers. */
2029         dmp_reg = &reg->flash_addr;
2030         for (cnt = 0; cnt < ARRAY_SIZE(fw->host_reg); cnt++, dmp_reg++)
2031                 fw->host_reg[cnt] = htonl(rd_reg_dword(dmp_reg));
2032
2033         /* Disable interrupts. */
2034         wrt_reg_dword(&reg->ictrl, 0);
2035         rd_reg_dword(&reg->ictrl);
2036
2037         /* Shadow registers. */
2038         wrt_reg_dword(&reg->iobase_addr, 0x0F70);
2039         rd_reg_dword(&reg->iobase_addr);
2040         wrt_reg_dword(&reg->iobase_select, 0xB0000000);
2041         fw->shadow_reg[0] = htonl(rd_reg_dword(&reg->iobase_sdata));
2042
2043         wrt_reg_dword(&reg->iobase_select, 0xB0100000);
2044         fw->shadow_reg[1] = htonl(rd_reg_dword(&reg->iobase_sdata));
2045
2046         wrt_reg_dword(&reg->iobase_select, 0xB0200000);
2047         fw->shadow_reg[2] = htonl(rd_reg_dword(&reg->iobase_sdata));
2048
2049         wrt_reg_dword(&reg->iobase_select, 0xB0300000);
2050         fw->shadow_reg[3] = htonl(rd_reg_dword(&reg->iobase_sdata));
2051
2052         wrt_reg_dword(&reg->iobase_select, 0xB0400000);
2053         fw->shadow_reg[4] = htonl(rd_reg_dword(&reg->iobase_sdata));
2054
2055         wrt_reg_dword(&reg->iobase_select, 0xB0500000);
2056         fw->shadow_reg[5] = htonl(rd_reg_dword(&reg->iobase_sdata));
2057
2058         wrt_reg_dword(&reg->iobase_select, 0xB0600000);
2059         fw->shadow_reg[6] = htonl(rd_reg_dword(&reg->iobase_sdata));
2060
2061         wrt_reg_dword(&reg->iobase_select, 0xB0700000);
2062         fw->shadow_reg[7] = htonl(rd_reg_dword(&reg->iobase_sdata));
2063
2064         wrt_reg_dword(&reg->iobase_select, 0xB0800000);
2065         fw->shadow_reg[8] = htonl(rd_reg_dword(&reg->iobase_sdata));
2066
2067         wrt_reg_dword(&reg->iobase_select, 0xB0900000);
2068         fw->shadow_reg[9] = htonl(rd_reg_dword(&reg->iobase_sdata));
2069
2070         wrt_reg_dword(&reg->iobase_select, 0xB0A00000);
2071         fw->shadow_reg[10] = htonl(rd_reg_dword(&reg->iobase_sdata));
2072
2073         /* RISC I/O register. */
2074         wrt_reg_dword(&reg->iobase_addr, 0x0010);
2075         fw->risc_io_reg = htonl(rd_reg_dword(&reg->iobase_window));
2076
2077         /* Mailbox registers. */
2078         mbx_reg = &reg->mailbox0;
2079         for (cnt = 0; cnt < ARRAY_SIZE(fw->mailbox_reg); cnt++, mbx_reg++)
2080                 fw->mailbox_reg[cnt] = htons(rd_reg_word(mbx_reg));
2081
2082         /* Transfer sequence registers. */
2083         iter_reg = fw->xseq_gp_reg;
2084         iter_reg = qla24xx_read_window(reg, 0xBE00, 16, iter_reg);
2085         iter_reg = qla24xx_read_window(reg, 0xBE10, 16, iter_reg);
2086         iter_reg = qla24xx_read_window(reg, 0xBE20, 16, iter_reg);
2087         iter_reg = qla24xx_read_window(reg, 0xBE30, 16, iter_reg);
2088         iter_reg = qla24xx_read_window(reg, 0xBE40, 16, iter_reg);
2089         iter_reg = qla24xx_read_window(reg, 0xBE50, 16, iter_reg);
2090         iter_reg = qla24xx_read_window(reg, 0xBE60, 16, iter_reg);
2091         iter_reg = qla24xx_read_window(reg, 0xBE70, 16, iter_reg);
2092         iter_reg = qla24xx_read_window(reg, 0xBF00, 16, iter_reg);
2093         iter_reg = qla24xx_read_window(reg, 0xBF10, 16, iter_reg);
2094         iter_reg = qla24xx_read_window(reg, 0xBF20, 16, iter_reg);
2095         iter_reg = qla24xx_read_window(reg, 0xBF30, 16, iter_reg);
2096         iter_reg = qla24xx_read_window(reg, 0xBF40, 16, iter_reg);
2097         iter_reg = qla24xx_read_window(reg, 0xBF50, 16, iter_reg);
2098         iter_reg = qla24xx_read_window(reg, 0xBF60, 16, iter_reg);
2099         qla24xx_read_window(reg, 0xBF70, 16, iter_reg);
2100
2101         iter_reg = fw->xseq_0_reg;
2102         iter_reg = qla24xx_read_window(reg, 0xBFC0, 16, iter_reg);
2103         iter_reg = qla24xx_read_window(reg, 0xBFD0, 16, iter_reg);
2104         qla24xx_read_window(reg, 0xBFE0, 16, iter_reg);
2105
2106         qla24xx_read_window(reg, 0xBFF0, 16, fw->xseq_1_reg);
2107
2108         qla24xx_read_window(reg, 0xBEF0, 16, fw->xseq_2_reg);
2109
2110         /* Receive sequence registers. */
2111         iter_reg = fw->rseq_gp_reg;
2112         iter_reg = qla24xx_read_window(reg, 0xFE00, 16, iter_reg);
2113         iter_reg = qla24xx_read_window(reg, 0xFE10, 16, iter_reg);
2114         iter_reg = qla24xx_read_window(reg, 0xFE20, 16, iter_reg);
2115         iter_reg = qla24xx_read_window(reg, 0xFE30, 16, iter_reg);
2116         iter_reg = qla24xx_read_window(reg, 0xFE40, 16, iter_reg);
2117         iter_reg = qla24xx_read_window(reg, 0xFE50, 16, iter_reg);
2118         iter_reg = qla24xx_read_window(reg, 0xFE60, 16, iter_reg);
2119         iter_reg = qla24xx_read_window(reg, 0xFE70, 16, iter_reg);
2120         iter_reg = qla24xx_read_window(reg, 0xFF00, 16, iter_reg);
2121         iter_reg = qla24xx_read_window(reg, 0xFF10, 16, iter_reg);
2122         iter_reg = qla24xx_read_window(reg, 0xFF20, 16, iter_reg);
2123         iter_reg = qla24xx_read_window(reg, 0xFF30, 16, iter_reg);
2124         iter_reg = qla24xx_read_window(reg, 0xFF40, 16, iter_reg);
2125         iter_reg = qla24xx_read_window(reg, 0xFF50, 16, iter_reg);
2126         iter_reg = qla24xx_read_window(reg, 0xFF60, 16, iter_reg);
2127         qla24xx_read_window(reg, 0xFF70, 16, iter_reg);
2128
2129         iter_reg = fw->rseq_0_reg;
2130         iter_reg = qla24xx_read_window(reg, 0xFFC0, 16, iter_reg);
2131         qla24xx_read_window(reg, 0xFFD0, 16, iter_reg);
2132
2133         qla24xx_read_window(reg, 0xFFE0, 16, fw->rseq_1_reg);
2134         qla24xx_read_window(reg, 0xFFF0, 16, fw->rseq_2_reg);
2135         qla24xx_read_window(reg, 0xFEF0, 16, fw->rseq_3_reg);
2136
2137         /* Auxiliary sequence registers. */
2138         iter_reg = fw->aseq_gp_reg;
2139         iter_reg = qla24xx_read_window(reg, 0xB000, 16, iter_reg);
2140         iter_reg = qla24xx_read_window(reg, 0xB010, 16, iter_reg);
2141         iter_reg = qla24xx_read_window(reg, 0xB020, 16, iter_reg);
2142         iter_reg = qla24xx_read_window(reg, 0xB030, 16, iter_reg);
2143         iter_reg = qla24xx_read_window(reg, 0xB040, 16, iter_reg);
2144         iter_reg = qla24xx_read_window(reg, 0xB050, 16, iter_reg);
2145         iter_reg = qla24xx_read_window(reg, 0xB060, 16, iter_reg);
2146         iter_reg = qla24xx_read_window(reg, 0xB070, 16, iter_reg);
2147         iter_reg = qla24xx_read_window(reg, 0xB100, 16, iter_reg);
2148         iter_reg = qla24xx_read_window(reg, 0xB110, 16, iter_reg);
2149         iter_reg = qla24xx_read_window(reg, 0xB120, 16, iter_reg);
2150         iter_reg = qla24xx_read_window(reg, 0xB130, 16, iter_reg);
2151         iter_reg = qla24xx_read_window(reg, 0xB140, 16, iter_reg);
2152         iter_reg = qla24xx_read_window(reg, 0xB150, 16, iter_reg);
2153         iter_reg = qla24xx_read_window(reg, 0xB160, 16, iter_reg);
2154         qla24xx_read_window(reg, 0xB170, 16, iter_reg);
2155
2156         iter_reg = fw->aseq_0_reg;
2157         iter_reg = qla24xx_read_window(reg, 0xB0C0, 16, iter_reg);
2158         qla24xx_read_window(reg, 0xB0D0, 16, iter_reg);
2159
2160         qla24xx_read_window(reg, 0xB0E0, 16, fw->aseq_1_reg);
2161         qla24xx_read_window(reg, 0xB0F0, 16, fw->aseq_2_reg);
2162         qla24xx_read_window(reg, 0xB1F0, 16, fw->aseq_3_reg);
2163
2164         /* Command DMA registers. */
2165         iter_reg = fw->cmd_dma_reg;
2166         iter_reg = qla24xx_read_window(reg, 0x7100, 16, iter_reg);
2167         iter_reg = qla24xx_read_window(reg, 0x7120, 16, iter_reg);
2168         iter_reg = qla24xx_read_window(reg, 0x7130, 16, iter_reg);
2169         qla24xx_read_window(reg, 0x71F0, 16, iter_reg);
2170
2171         /* Queues. */
2172         iter_reg = fw->req0_dma_reg;
2173         iter_reg = qla24xx_read_window(reg, 0x7200, 8, iter_reg);
2174         dmp_reg = &reg->iobase_q;
2175         for (cnt = 0; cnt < 7; cnt++, dmp_reg++)
2176                 *iter_reg++ = htonl(rd_reg_dword(dmp_reg));
2177
2178         iter_reg = fw->resp0_dma_reg;
2179         iter_reg = qla24xx_read_window(reg, 0x7300, 8, iter_reg);
2180         dmp_reg = &reg->iobase_q;
2181         for (cnt = 0; cnt < 7; cnt++, dmp_reg++)
2182                 *iter_reg++ = htonl(rd_reg_dword(dmp_reg));
2183
2184         iter_reg = fw->req1_dma_reg;
2185         iter_reg = qla24xx_read_window(reg, 0x7400, 8, iter_reg);
2186         dmp_reg = &reg->iobase_q;
2187         for (cnt = 0; cnt < 7; cnt++, dmp_reg++)
2188                 *iter_reg++ = htonl(rd_reg_dword(dmp_reg));
2189
2190         /* Transmit DMA registers. */
2191         iter_reg = fw->xmt0_dma_reg;
2192         iter_reg = qla24xx_read_window(reg, 0x7600, 16, iter_reg);
2193         qla24xx_read_window(reg, 0x7610, 16, iter_reg);
2194
2195         iter_reg = fw->xmt1_dma_reg;
2196         iter_reg = qla24xx_read_window(reg, 0x7620, 16, iter_reg);
2197         qla24xx_read_window(reg, 0x7630, 16, iter_reg);
2198
2199         iter_reg = fw->xmt2_dma_reg;
2200         iter_reg = qla24xx_read_window(reg, 0x7640, 16, iter_reg);
2201         qla24xx_read_window(reg, 0x7650, 16, iter_reg);
2202
2203         iter_reg = fw->xmt3_dma_reg;
2204         iter_reg = qla24xx_read_window(reg, 0x7660, 16, iter_reg);
2205         qla24xx_read_window(reg, 0x7670, 16, iter_reg);
2206
2207         iter_reg = fw->xmt4_dma_reg;
2208         iter_reg = qla24xx_read_window(reg, 0x7680, 16, iter_reg);
2209         qla24xx_read_window(reg, 0x7690, 16, iter_reg);
2210
2211         qla24xx_read_window(reg, 0x76A0, 16, fw->xmt_data_dma_reg);
2212
2213         /* Receive DMA registers. */
2214         iter_reg = fw->rcvt0_data_dma_reg;
2215         iter_reg = qla24xx_read_window(reg, 0x7700, 16, iter_reg);
2216         qla24xx_read_window(reg, 0x7710, 16, iter_reg);
2217
2218         iter_reg = fw->rcvt1_data_dma_reg;
2219         iter_reg = qla24xx_read_window(reg, 0x7720, 16, iter_reg);
2220         qla24xx_read_window(reg, 0x7730, 16, iter_reg);
2221
2222         /* RISC registers. */
2223         iter_reg = fw->risc_gp_reg;
2224         iter_reg = qla24xx_read_window(reg, 0x0F00, 16, iter_reg);
2225         iter_reg = qla24xx_read_window(reg, 0x0F10, 16, iter_reg);
2226         iter_reg = qla24xx_read_window(reg, 0x0F20, 16, iter_reg);
2227         iter_reg = qla24xx_read_window(reg, 0x0F30, 16, iter_reg);
2228         iter_reg = qla24xx_read_window(reg, 0x0F40, 16, iter_reg);
2229         iter_reg = qla24xx_read_window(reg, 0x0F50, 16, iter_reg);
2230         iter_reg = qla24xx_read_window(reg, 0x0F60, 16, iter_reg);
2231         qla24xx_read_window(reg, 0x0F70, 16, iter_reg);
2232
2233         /* Local memory controller registers. */
2234         iter_reg = fw->lmc_reg;
2235         iter_reg = qla24xx_read_window(reg, 0x3000, 16, iter_reg);
2236         iter_reg = qla24xx_read_window(reg, 0x3010, 16, iter_reg);
2237         iter_reg = qla24xx_read_window(reg, 0x3020, 16, iter_reg);
2238         iter_reg = qla24xx_read_window(reg, 0x3030, 16, iter_reg);
2239         iter_reg = qla24xx_read_window(reg, 0x3040, 16, iter_reg);
2240         iter_reg = qla24xx_read_window(reg, 0x3050, 16, iter_reg);
2241         iter_reg = qla24xx_read_window(reg, 0x3060, 16, iter_reg);
2242         qla24xx_read_window(reg, 0x3070, 16, iter_reg);
2243
2244         /* Fibre Protocol Module registers. */
2245         iter_reg = fw->fpm_hdw_reg;
2246         iter_reg = qla24xx_read_window(reg, 0x4000, 16, iter_reg);
2247         iter_reg = qla24xx_read_window(reg, 0x4010, 16, iter_reg);
2248         iter_reg = qla24xx_read_window(reg, 0x4020, 16, iter_reg);
2249         iter_reg = qla24xx_read_window(reg, 0x4030, 16, iter_reg);
2250         iter_reg = qla24xx_read_window(reg, 0x4040, 16, iter_reg);
2251         iter_reg = qla24xx_read_window(reg, 0x4050, 16, iter_reg);
2252         iter_reg = qla24xx_read_window(reg, 0x4060, 16, iter_reg);
2253         iter_reg = qla24xx_read_window(reg, 0x4070, 16, iter_reg);
2254         iter_reg = qla24xx_read_window(reg, 0x4080, 16, iter_reg);
2255         iter_reg = qla24xx_read_window(reg, 0x4090, 16, iter_reg);
2256         iter_reg = qla24xx_read_window(reg, 0x40A0, 16, iter_reg);
2257         iter_reg = qla24xx_read_window(reg, 0x40B0, 16, iter_reg);
2258         iter_reg = qla24xx_read_window(reg, 0x40C0, 16, iter_reg);
2259         iter_reg = qla24xx_read_window(reg, 0x40D0, 16, iter_reg);
2260         iter_reg = qla24xx_read_window(reg, 0x40E0, 16, iter_reg);
2261         qla24xx_read_window(reg, 0x40F0, 16, iter_reg);
2262
2263         /* RQ0 Array registers. */
2264         iter_reg = fw->rq0_array_reg;
2265         iter_reg = qla24xx_read_window(reg, 0x5C00, 16, iter_reg);
2266         iter_reg = qla24xx_read_window(reg, 0x5C10, 16, iter_reg);
2267         iter_reg = qla24xx_read_window(reg, 0x5C20, 16, iter_reg);
2268         iter_reg = qla24xx_read_window(reg, 0x5C30, 16, iter_reg);
2269         iter_reg = qla24xx_read_window(reg, 0x5C40, 16, iter_reg);
2270         iter_reg = qla24xx_read_window(reg, 0x5C50, 16, iter_reg);
2271         iter_reg = qla24xx_read_window(reg, 0x5C60, 16, iter_reg);
2272         iter_reg = qla24xx_read_window(reg, 0x5C70, 16, iter_reg);
2273         iter_reg = qla24xx_read_window(reg, 0x5C80, 16, iter_reg);
2274         iter_reg = qla24xx_read_window(reg, 0x5C90, 16, iter_reg);
2275         iter_reg = qla24xx_read_window(reg, 0x5CA0, 16, iter_reg);
2276         iter_reg = qla24xx_read_window(reg, 0x5CB0, 16, iter_reg);
2277         iter_reg = qla24xx_read_window(reg, 0x5CC0, 16, iter_reg);
2278         iter_reg = qla24xx_read_window(reg, 0x5CD0, 16, iter_reg);
2279         iter_reg = qla24xx_read_window(reg, 0x5CE0, 16, iter_reg);
2280         qla24xx_read_window(reg, 0x5CF0, 16, iter_reg);
2281
2282         /* RQ1 Array registers. */
2283         iter_reg = fw->rq1_array_reg;
2284         iter_reg = qla24xx_read_window(reg, 0x5D00, 16, iter_reg);
2285         iter_reg = qla24xx_read_window(reg, 0x5D10, 16, iter_reg);
2286         iter_reg = qla24xx_read_window(reg, 0x5D20, 16, iter_reg);
2287         iter_reg = qla24xx_read_window(reg, 0x5D30, 16, iter_reg);
2288         iter_reg = qla24xx_read_window(reg, 0x5D40, 16, iter_reg);
2289         iter_reg = qla24xx_read_window(reg, 0x5D50, 16, iter_reg);
2290         iter_reg = qla24xx_read_window(reg, 0x5D60, 16, iter_reg);
2291         iter_reg = qla24xx_read_window(reg, 0x5D70, 16, iter_reg);
2292         iter_reg = qla24xx_read_window(reg, 0x5D80, 16, iter_reg);
2293         iter_reg = qla24xx_read_window(reg, 0x5D90, 16, iter_reg);
2294         iter_reg = qla24xx_read_window(reg, 0x5DA0, 16, iter_reg);
2295         iter_reg = qla24xx_read_window(reg, 0x5DB0, 16, iter_reg);
2296         iter_reg = qla24xx_read_window(reg, 0x5DC0, 16, iter_reg);
2297         iter_reg = qla24xx_read_window(reg, 0x5DD0, 16, iter_reg);
2298         iter_reg = qla24xx_read_window(reg, 0x5DE0, 16, iter_reg);
2299         qla24xx_read_window(reg, 0x5DF0, 16, iter_reg);
2300
2301         /* RP0 Array registers. */
2302         iter_reg = fw->rp0_array_reg;
2303         iter_reg = qla24xx_read_window(reg, 0x5E00, 16, iter_reg);
2304         iter_reg = qla24xx_read_window(reg, 0x5E10, 16, iter_reg);
2305         iter_reg = qla24xx_read_window(reg, 0x5E20, 16, iter_reg);
2306         iter_reg = qla24xx_read_window(reg, 0x5E30, 16, iter_reg);
2307         iter_reg = qla24xx_read_window(reg, 0x5E40, 16, iter_reg);
2308         iter_reg = qla24xx_read_window(reg, 0x5E50, 16, iter_reg);
2309         iter_reg = qla24xx_read_window(reg, 0x5E60, 16, iter_reg);
2310         iter_reg = qla24xx_read_window(reg, 0x5E70, 16, iter_reg);
2311         iter_reg = qla24xx_read_window(reg, 0x5E80, 16, iter_reg);
2312         iter_reg = qla24xx_read_window(reg, 0x5E90, 16, iter_reg);
2313         iter_reg = qla24xx_read_window(reg, 0x5EA0, 16, iter_reg);
2314         iter_reg = qla24xx_read_window(reg, 0x5EB0, 16, iter_reg);
2315         iter_reg = qla24xx_read_window(reg, 0x5EC0, 16, iter_reg);
2316         iter_reg = qla24xx_read_window(reg, 0x5ED0, 16, iter_reg);
2317         iter_reg = qla24xx_read_window(reg, 0x5EE0, 16, iter_reg);
2318         qla24xx_read_window(reg, 0x5EF0, 16, iter_reg);
2319
2320         /* RP1 Array registers. */
2321         iter_reg = fw->rp1_array_reg;
2322         iter_reg = qla24xx_read_window(reg, 0x5F00, 16, iter_reg);
2323         iter_reg = qla24xx_read_window(reg, 0x5F10, 16, iter_reg);
2324         iter_reg = qla24xx_read_window(reg, 0x5F20, 16, iter_reg);
2325         iter_reg = qla24xx_read_window(reg, 0x5F30, 16, iter_reg);
2326         iter_reg = qla24xx_read_window(reg, 0x5F40, 16, iter_reg);
2327         iter_reg = qla24xx_read_window(reg, 0x5F50, 16, iter_reg);
2328         iter_reg = qla24xx_read_window(reg, 0x5F60, 16, iter_reg);
2329         iter_reg = qla24xx_read_window(reg, 0x5F70, 16, iter_reg);
2330         iter_reg = qla24xx_read_window(reg, 0x5F80, 16, iter_reg);
2331         iter_reg = qla24xx_read_window(reg, 0x5F90, 16, iter_reg);
2332         iter_reg = qla24xx_read_window(reg, 0x5FA0, 16, iter_reg);
2333         iter_reg = qla24xx_read_window(reg, 0x5FB0, 16, iter_reg);
2334         iter_reg = qla24xx_read_window(reg, 0x5FC0, 16, iter_reg);
2335         iter_reg = qla24xx_read_window(reg, 0x5FD0, 16, iter_reg);
2336         iter_reg = qla24xx_read_window(reg, 0x5FE0, 16, iter_reg);
2337         qla24xx_read_window(reg, 0x5FF0, 16, iter_reg);
2338
2339         iter_reg = fw->at0_array_reg;
2340         iter_reg = qla24xx_read_window(reg, 0x7080, 16, iter_reg);
2341         iter_reg = qla24xx_read_window(reg, 0x7090, 16, iter_reg);
2342         iter_reg = qla24xx_read_window(reg, 0x70A0, 16, iter_reg);
2343         iter_reg = qla24xx_read_window(reg, 0x70B0, 16, iter_reg);
2344         iter_reg = qla24xx_read_window(reg, 0x70C0, 16, iter_reg);
2345         iter_reg = qla24xx_read_window(reg, 0x70D0, 16, iter_reg);
2346         iter_reg = qla24xx_read_window(reg, 0x70E0, 16, iter_reg);
2347         qla24xx_read_window(reg, 0x70F0, 16, iter_reg);
2348
2349         /* I/O Queue Control registers. */
2350         qla24xx_read_window(reg, 0x7800, 16, fw->queue_control_reg);
2351
2352         /* Frame Buffer registers. */
2353         iter_reg = fw->fb_hdw_reg;
2354         iter_reg = qla24xx_read_window(reg, 0x6000, 16, iter_reg);
2355         iter_reg = qla24xx_read_window(reg, 0x6010, 16, iter_reg);
2356         iter_reg = qla24xx_read_window(reg, 0x6020, 16, iter_reg);
2357         iter_reg = qla24xx_read_window(reg, 0x6030, 16, iter_reg);
2358         iter_reg = qla24xx_read_window(reg, 0x6040, 16, iter_reg);
2359         iter_reg = qla24xx_read_window(reg, 0x6060, 16, iter_reg);
2360         iter_reg = qla24xx_read_window(reg, 0x6070, 16, iter_reg);
2361         iter_reg = qla24xx_read_window(reg, 0x6100, 16, iter_reg);
2362         iter_reg = qla24xx_read_window(reg, 0x6130, 16, iter_reg);
2363         iter_reg = qla24xx_read_window(reg, 0x6150, 16, iter_reg);
2364         iter_reg = qla24xx_read_window(reg, 0x6170, 16, iter_reg);
2365         iter_reg = qla24xx_read_window(reg, 0x6190, 16, iter_reg);
2366         iter_reg = qla24xx_read_window(reg, 0x61B0, 16, iter_reg);
2367         iter_reg = qla24xx_read_window(reg, 0x61C0, 16, iter_reg);
2368         iter_reg = qla24xx_read_window(reg, 0x6530, 16, iter_reg);
2369         iter_reg = qla24xx_read_window(reg, 0x6540, 16, iter_reg);
2370         iter_reg = qla24xx_read_window(reg, 0x6550, 16, iter_reg);
2371         iter_reg = qla24xx_read_window(reg, 0x6560, 16, iter_reg);
2372         iter_reg = qla24xx_read_window(reg, 0x6570, 16, iter_reg);
2373         iter_reg = qla24xx_read_window(reg, 0x6580, 16, iter_reg);
2374         iter_reg = qla24xx_read_window(reg, 0x6590, 16, iter_reg);
2375         iter_reg = qla24xx_read_window(reg, 0x65A0, 16, iter_reg);
2376         iter_reg = qla24xx_read_window(reg, 0x65B0, 16, iter_reg);
2377         iter_reg = qla24xx_read_window(reg, 0x65C0, 16, iter_reg);
2378         iter_reg = qla24xx_read_window(reg, 0x65D0, 16, iter_reg);
2379         iter_reg = qla24xx_read_window(reg, 0x65E0, 16, iter_reg);
2380         qla24xx_read_window(reg, 0x6F00, 16, iter_reg);
2381
2382         /* Multi queue registers */
2383         nxt_chain = qla25xx_copy_mq(ha, (void *)ha->fw_dump + ha->chain_offset,
2384             &last_chain);
2385
2386         rval = qla24xx_soft_reset(ha);
2387         if (rval != QLA_SUCCESS) {
2388                 ql_log(ql_log_warn, vha, 0xd00e,
2389                     "SOFT RESET FAILED, forcing continuation of dump!!!\n");
2390                 rval = QLA_SUCCESS;
2391
2392                 ql_log(ql_log_warn, vha, 0xd00f, "try a bigger hammer!!!\n");
2393
2394                 wrt_reg_dword(&reg->hccr, HCCRX_SET_RISC_RESET);
2395                 rd_reg_dword(&reg->hccr);
2396
2397                 wrt_reg_dword(&reg->hccr, HCCRX_REL_RISC_PAUSE);
2398                 rd_reg_dword(&reg->hccr);
2399
2400                 wrt_reg_dword(&reg->hccr, HCCRX_CLR_RISC_RESET);
2401                 rd_reg_dword(&reg->hccr);
2402
2403                 for (cnt = 30000; cnt && (rd_reg_word(&reg->mailbox0)); cnt--)
2404                         udelay(5);
2405
2406                 if (!cnt) {
2407                         nxt = fw->code_ram;
2408                         nxt += sizeof(fw->code_ram);
2409                         nxt += (ha->fw_memory_size - 0x100000 + 1);
2410                         goto copy_queue;
2411                 } else {
2412                         set_bit(RISC_RDY_AFT_RESET, &ha->fw_dump_cap_flags);
2413                         ql_log(ql_log_warn, vha, 0xd010,
2414                             "bigger hammer success?\n");
2415                 }
2416         }
2417
2418         rval = qla24xx_dump_memory(ha, fw->code_ram, sizeof(fw->code_ram),
2419             &nxt);
2420         if (rval != QLA_SUCCESS)
2421                 goto qla83xx_fw_dump_failed_0;
2422
2423 copy_queue:
2424         nxt = qla2xxx_copy_queues(ha, nxt);
2425
2426         qla24xx_copy_eft(ha, nxt);
2427
2428         /* Chain entries -- started with MQ. */
2429         nxt_chain = qla25xx_copy_fce(ha, nxt_chain, &last_chain);
2430         nxt_chain = qla25xx_copy_mqueues(ha, nxt_chain, &last_chain);
2431         nxt_chain = qla2xxx_copy_atioqueues(ha, nxt_chain, &last_chain);
2432         nxt_chain = qla25xx_copy_exlogin(ha, nxt_chain, &last_chain);
2433         nxt_chain = qla81xx_copy_exchoffld(ha, nxt_chain, &last_chain);
2434         if (last_chain) {
2435                 ha->fw_dump->version |= htonl(DUMP_CHAIN_VARIANT);
2436                 *last_chain |= htonl(DUMP_CHAIN_LAST);
2437         }
2438
2439         /* Adjust valid length. */
2440         ha->fw_dump_len = (nxt_chain - (void *)ha->fw_dump);
2441
2442 qla83xx_fw_dump_failed_0:
2443         qla2xxx_dump_post_process(base_vha, rval);
2444 }
2445
2446 /****************************************************************************/
2447 /*                         Driver Debug Functions.                          */
2448 /****************************************************************************/
2449
2450 /*
2451  * This function is for formatting and logging debug information.
2452  * It is to be used when vha is available. It formats the message
2453  * and logs it to the messages file.
2454  * parameters:
2455  * level: The level of the debug messages to be printed.
2456  *        If ql2xextended_error_logging value is correctly set,
2457  *        this message will appear in the messages file.
2458  * vha:   Pointer to the scsi_qla_host_t.
2459  * id:    This is a unique identifier for the level. It identifies the
2460  *        part of the code from where the message originated.
2461  * msg:   The message to be displayed.
2462  */
2463 void
2464 ql_dbg(uint level, scsi_qla_host_t *vha, uint id, const char *fmt, ...)
2465 {
2466         va_list va;
2467         struct va_format vaf;
2468
2469         va_start(va, fmt);
2470
2471         vaf.fmt = fmt;
2472         vaf.va = &va;
2473
2474         if (!ql_mask_match(level)) {
2475                 char pbuf[64];
2476
2477                 if (vha != NULL) {
2478                         const struct pci_dev *pdev = vha->hw->pdev;
2479                         /* <module-name> <msg-id>:<host> Message */
2480                         snprintf(pbuf, sizeof(pbuf), "%s [%s]-%04x:%ld: ",
2481                             QL_MSGHDR, dev_name(&(pdev->dev)), id,
2482                             vha->host_no);
2483                 } else {
2484                         snprintf(pbuf, sizeof(pbuf), "%s [%s]-%04x: : ",
2485                             QL_MSGHDR, "0000:00:00.0", id);
2486                 }
2487                 pbuf[sizeof(pbuf) - 1] = 0;
2488                 trace_ql_dbg_log(pbuf, &vaf);
2489                 va_end(va);
2490                 return;
2491         }
2492
2493         if (vha != NULL) {
2494                 const struct pci_dev *pdev = vha->hw->pdev;
2495                 /* <module-name> <pci-name> <msg-id>:<host> Message */
2496                 pr_warn("%s [%s]-%04x:%ld: %pV",
2497                         QL_MSGHDR, dev_name(&(pdev->dev)), id + ql_dbg_offset,
2498                         vha->host_no, &vaf);
2499         } else {
2500                 pr_warn("%s [%s]-%04x: : %pV",
2501                         QL_MSGHDR, "0000:00:00.0", id + ql_dbg_offset, &vaf);
2502         }
2503
2504         va_end(va);
2505
2506 }
2507
2508 /*
2509  * This function is for formatting and logging debug information.
2510  * It is to be used when vha is not available and pci is available,
2511  * i.e., before host allocation. It formats the message and logs it
2512  * to the messages file.
2513  * parameters:
2514  * level: The level of the debug messages to be printed.
2515  *        If ql2xextended_error_logging value is correctly set,
2516  *        this message will appear in the messages file.
2517  * pdev:  Pointer to the struct pci_dev.
2518  * id:    This is a unique id for the level. It identifies the part
2519  *        of the code from where the message originated.
2520  * msg:   The message to be displayed.
2521  */
2522 void
2523 ql_dbg_pci(uint level, struct pci_dev *pdev, uint id, const char *fmt, ...)
2524 {
2525         va_list va;
2526         struct va_format vaf;
2527
2528         if (pdev == NULL)
2529                 return;
2530         if (!ql_mask_match(level))
2531                 return;
2532
2533         va_start(va, fmt);
2534
2535         vaf.fmt = fmt;
2536         vaf.va = &va;
2537
2538         /* <module-name> <dev-name>:<msg-id> Message */
2539         pr_warn("%s [%s]-%04x: : %pV",
2540                 QL_MSGHDR, dev_name(&(pdev->dev)), id + ql_dbg_offset, &vaf);
2541
2542         va_end(va);
2543 }
2544
2545 /*
2546  * This function is for formatting and logging log messages.
2547  * It is to be used when vha is available. It formats the message
2548  * and logs it to the messages file. All the messages will be logged
2549  * irrespective of value of ql2xextended_error_logging.
2550  * parameters:
2551  * level: The level of the log messages to be printed in the
2552  *        messages file.
2553  * vha:   Pointer to the scsi_qla_host_t
2554  * id:    This is a unique id for the level. It identifies the
2555  *        part of the code from where the message originated.
2556  * msg:   The message to be displayed.
2557  */
2558 void
2559 ql_log(uint level, scsi_qla_host_t *vha, uint id, const char *fmt, ...)
2560 {
2561         va_list va;
2562         struct va_format vaf;
2563         char pbuf[128];
2564
2565         if (level > ql_errlev)
2566                 return;
2567
2568         if (vha != NULL) {
2569                 const struct pci_dev *pdev = vha->hw->pdev;
2570                 /* <module-name> <msg-id>:<host> Message */
2571                 snprintf(pbuf, sizeof(pbuf), "%s [%s]-%04x:%ld: ",
2572                         QL_MSGHDR, dev_name(&(pdev->dev)), id, vha->host_no);
2573         } else {
2574                 snprintf(pbuf, sizeof(pbuf), "%s [%s]-%04x: : ",
2575                         QL_MSGHDR, "0000:00:00.0", id);
2576         }
2577         pbuf[sizeof(pbuf) - 1] = 0;
2578
2579         va_start(va, fmt);
2580
2581         vaf.fmt = fmt;
2582         vaf.va = &va;
2583
2584         switch (level) {
2585         case ql_log_fatal: /* FATAL LOG */
2586                 pr_crit("%s%pV", pbuf, &vaf);
2587                 break;
2588         case ql_log_warn:
2589                 pr_err("%s%pV", pbuf, &vaf);
2590                 break;
2591         case ql_log_info:
2592                 pr_warn("%s%pV", pbuf, &vaf);
2593                 break;
2594         default:
2595                 pr_info("%s%pV", pbuf, &vaf);
2596                 break;
2597         }
2598
2599         va_end(va);
2600 }
2601
2602 /*
2603  * This function is for formatting and logging log messages.
2604  * It is to be used when vha is not available and pci is available,
2605  * i.e., before host allocation. It formats the message and logs
2606  * it to the messages file. All the messages are logged irrespective
2607  * of the value of ql2xextended_error_logging.
2608  * parameters:
2609  * level: The level of the log messages to be printed in the
2610  *        messages file.
2611  * pdev:  Pointer to the struct pci_dev.
2612  * id:    This is a unique id for the level. It identifies the
2613  *        part of the code from where the message originated.
2614  * msg:   The message to be displayed.
2615  */
2616 void
2617 ql_log_pci(uint level, struct pci_dev *pdev, uint id, const char *fmt, ...)
2618 {
2619         va_list va;
2620         struct va_format vaf;
2621         char pbuf[128];
2622
2623         if (pdev == NULL)
2624                 return;
2625         if (level > ql_errlev)
2626                 return;
2627
2628         /* <module-name> <dev-name>:<msg-id> Message */
2629         snprintf(pbuf, sizeof(pbuf), "%s [%s]-%04x: : ",
2630                  QL_MSGHDR, dev_name(&(pdev->dev)), id);
2631         pbuf[sizeof(pbuf) - 1] = 0;
2632
2633         va_start(va, fmt);
2634
2635         vaf.fmt = fmt;
2636         vaf.va = &va;
2637
2638         switch (level) {
2639         case ql_log_fatal: /* FATAL LOG */
2640                 pr_crit("%s%pV", pbuf, &vaf);
2641                 break;
2642         case ql_log_warn:
2643                 pr_err("%s%pV", pbuf, &vaf);
2644                 break;
2645         case ql_log_info:
2646                 pr_warn("%s%pV", pbuf, &vaf);
2647                 break;
2648         default:
2649                 pr_info("%s%pV", pbuf, &vaf);
2650                 break;
2651         }
2652
2653         va_end(va);
2654 }
2655
2656 void
2657 ql_dump_regs(uint level, scsi_qla_host_t *vha, uint id)
2658 {
2659         int i;
2660         struct qla_hw_data *ha = vha->hw;
2661         struct device_reg_2xxx __iomem *reg = &ha->iobase->isp;
2662         struct device_reg_24xx __iomem *reg24 = &ha->iobase->isp24;
2663         struct device_reg_82xx __iomem *reg82 = &ha->iobase->isp82;
2664         __le16 __iomem *mbx_reg;
2665
2666         if (!ql_mask_match(level))
2667                 return;
2668
2669         if (IS_P3P_TYPE(ha))
2670                 mbx_reg = &reg82->mailbox_in[0];
2671         else if (IS_FWI2_CAPABLE(ha))
2672                 mbx_reg = &reg24->mailbox0;
2673         else
2674                 mbx_reg = MAILBOX_REG(ha, reg, 0);
2675
2676         ql_dbg(level, vha, id, "Mailbox registers:\n");
2677         for (i = 0; i < 6; i++, mbx_reg++)
2678                 ql_dbg(level, vha, id,
2679                     "mbox[%d] %#04x\n", i, rd_reg_word(mbx_reg));
2680 }
2681
2682
2683 void
2684 ql_dump_buffer(uint level, scsi_qla_host_t *vha, uint id, const void *buf,
2685                uint size)
2686 {
2687         uint cnt;
2688
2689         if (!ql_mask_match(level))
2690                 return;
2691
2692         ql_dbg(level, vha, id,
2693             "%-+5d  0  1  2  3  4  5  6  7  8  9  A  B  C  D  E  F\n", size);
2694         ql_dbg(level, vha, id,
2695             "----- -----------------------------------------------\n");
2696         for (cnt = 0; cnt < size; cnt += 16) {
2697                 ql_dbg(level, vha, id, "%04x: ", cnt);
2698                 print_hex_dump(KERN_CONT, "", DUMP_PREFIX_NONE, 16, 1,
2699                                buf + cnt, min(16U, size - cnt), false);
2700         }
2701 }
2702
2703 /*
2704  * This function is for formatting and logging log messages.
2705  * It is to be used when vha is available. It formats the message
2706  * and logs it to the messages file. All the messages will be logged
2707  * irrespective of value of ql2xextended_error_logging.
2708  * parameters:
2709  * level: The level of the log messages to be printed in the
2710  *        messages file.
2711  * vha:   Pointer to the scsi_qla_host_t
2712  * id:    This is a unique id for the level. It identifies the
2713  *        part of the code from where the message originated.
2714  * msg:   The message to be displayed.
2715  */
2716 void
2717 ql_log_qp(uint32_t level, struct qla_qpair *qpair, int32_t id,
2718     const char *fmt, ...)
2719 {
2720         va_list va;
2721         struct va_format vaf;
2722         char pbuf[128];
2723
2724         if (level > ql_errlev)
2725                 return;
2726
2727         if (qpair != NULL) {
2728                 const struct pci_dev *pdev = qpair->pdev;
2729                 /* <module-name> <msg-id>:<host> Message */
2730                 snprintf(pbuf, sizeof(pbuf), "%s [%s]-%04x: ",
2731                         QL_MSGHDR, dev_name(&(pdev->dev)), id);
2732         } else {
2733                 snprintf(pbuf, sizeof(pbuf), "%s [%s]-%04x: : ",
2734                         QL_MSGHDR, "0000:00:00.0", id);
2735         }
2736         pbuf[sizeof(pbuf) - 1] = 0;
2737
2738         va_start(va, fmt);
2739
2740         vaf.fmt = fmt;
2741         vaf.va = &va;
2742
2743         switch (level) {
2744         case ql_log_fatal: /* FATAL LOG */
2745                 pr_crit("%s%pV", pbuf, &vaf);
2746                 break;
2747         case ql_log_warn:
2748                 pr_err("%s%pV", pbuf, &vaf);
2749                 break;
2750         case ql_log_info:
2751                 pr_warn("%s%pV", pbuf, &vaf);
2752                 break;
2753         default:
2754                 pr_info("%s%pV", pbuf, &vaf);
2755                 break;
2756         }
2757
2758         va_end(va);
2759 }
2760
2761 /*
2762  * This function is for formatting and logging debug information.
2763  * It is to be used when vha is available. It formats the message
2764  * and logs it to the messages file.
2765  * parameters:
2766  * level: The level of the debug messages to be printed.
2767  *        If ql2xextended_error_logging value is correctly set,
2768  *        this message will appear in the messages file.
2769  * vha:   Pointer to the scsi_qla_host_t.
2770  * id:    This is a unique identifier for the level. It identifies the
2771  *        part of the code from where the message originated.
2772  * msg:   The message to be displayed.
2773  */
2774 void
2775 ql_dbg_qp(uint32_t level, struct qla_qpair *qpair, int32_t id,
2776     const char *fmt, ...)
2777 {
2778         va_list va;
2779         struct va_format vaf;
2780
2781         if (!ql_mask_match(level))
2782                 return;
2783
2784         va_start(va, fmt);
2785
2786         vaf.fmt = fmt;
2787         vaf.va = &va;
2788
2789         if (qpair != NULL) {
2790                 const struct pci_dev *pdev = qpair->pdev;
2791                 /* <module-name> <pci-name> <msg-id>:<host> Message */
2792                 pr_warn("%s [%s]-%04x: %pV",
2793                     QL_MSGHDR, dev_name(&(pdev->dev)), id + ql_dbg_offset,
2794                     &vaf);
2795         } else {
2796                 pr_warn("%s [%s]-%04x: : %pV",
2797                         QL_MSGHDR, "0000:00:00.0", id + ql_dbg_offset, &vaf);
2798         }
2799
2800         va_end(va);
2801
2802 }