xref: /openbmc/linux/drivers/scsi/lpfc/lpfc_debugfs.c (revision 293d5b43)
1 /*******************************************************************
2  * This file is part of the Emulex Linux Device Driver for         *
3  * Fibre Channel Host Bus Adapters.                                *
4  * Copyright (C) 2007-2015 Emulex.  All rights reserved.           *
5  * EMULEX and SLI are trademarks of Emulex.                        *
6  * www.emulex.com                                                  *
7  *                                                                 *
8  * This program is free software; you can redistribute it and/or   *
9  * modify it under the terms of version 2 of the GNU General       *
10  * Public License as published by the Free Software Foundation.    *
11  * This program is distributed in the hope that it will be useful. *
12  * ALL EXPRESS OR IMPLIED CONDITIONS, REPRESENTATIONS AND          *
13  * WARRANTIES, INCLUDING ANY IMPLIED WARRANTY OF MERCHANTABILITY,  *
14  * FITNESS FOR A PARTICULAR PURPOSE, OR NON-INFRINGEMENT, ARE      *
15  * DISCLAIMED, EXCEPT TO THE EXTENT THAT SUCH DISCLAIMERS ARE HELD *
16  * TO BE LEGALLY INVALID.  See the GNU General Public License for  *
17  * more details, a copy of which can be found in the file COPYING  *
18  * included with this package.                                     *
19  *******************************************************************/
20 
21 #include <linux/blkdev.h>
22 #include <linux/delay.h>
23 #include <linux/module.h>
24 #include <linux/dma-mapping.h>
25 #include <linux/idr.h>
26 #include <linux/interrupt.h>
27 #include <linux/kthread.h>
28 #include <linux/slab.h>
29 #include <linux/pci.h>
30 #include <linux/spinlock.h>
31 #include <linux/ctype.h>
32 
33 #include <scsi/scsi.h>
34 #include <scsi/scsi_device.h>
35 #include <scsi/scsi_host.h>
36 #include <scsi/scsi_transport_fc.h>
37 
38 #include "lpfc_hw4.h"
39 #include "lpfc_hw.h"
40 #include "lpfc_sli.h"
41 #include "lpfc_sli4.h"
42 #include "lpfc_nl.h"
43 #include "lpfc_disc.h"
44 #include "lpfc_scsi.h"
45 #include "lpfc.h"
46 #include "lpfc_logmsg.h"
47 #include "lpfc_crtn.h"
48 #include "lpfc_vport.h"
49 #include "lpfc_version.h"
50 #include "lpfc_compat.h"
51 #include "lpfc_debugfs.h"
52 #include "lpfc_bsg.h"
53 
54 #ifdef CONFIG_SCSI_LPFC_DEBUG_FS
55 /*
56  * debugfs interface
57  *
58  * To access this interface the user should:
59  * # mount -t debugfs none /sys/kernel/debug
60  *
61  * The lpfc debugfs directory hierarchy is:
62  * /sys/kernel/debug/lpfc/fnX/vportY
63  * where X is the lpfc hba function unique_id
64  * where Y is the vport VPI on that hba
65  *
66  * Debugging services available per vport:
67  * discovery_trace
68  * This is an ACSII readable file that contains a trace of the last
69  * lpfc_debugfs_max_disc_trc events that happened on a specific vport.
70  * See lpfc_debugfs.h for different categories of  discovery events.
71  * To enable the discovery trace, the following module parameters must be set:
72  * lpfc_debugfs_enable=1         Turns on lpfc debugfs filesystem support
73  * lpfc_debugfs_max_disc_trc=X   Where X is the event trace depth for
74  *                               EACH vport. X MUST also be a power of 2.
75  * lpfc_debugfs_mask_disc_trc=Y  Where Y is an event mask as defined in
76  *                               lpfc_debugfs.h .
77  *
78  * slow_ring_trace
79  * This is an ACSII readable file that contains a trace of the last
80  * lpfc_debugfs_max_slow_ring_trc events that happened on a specific HBA.
81  * To enable the slow ring trace, the following module parameters must be set:
82  * lpfc_debugfs_enable=1         Turns on lpfc debugfs filesystem support
83  * lpfc_debugfs_max_slow_ring_trc=X   Where X is the event trace depth for
84  *                               the HBA. X MUST also be a power of 2.
85  */
86 static int lpfc_debugfs_enable = 1;
87 module_param(lpfc_debugfs_enable, int, S_IRUGO);
88 MODULE_PARM_DESC(lpfc_debugfs_enable, "Enable debugfs services");
89 
90 /* This MUST be a power of 2 */
91 static int lpfc_debugfs_max_disc_trc;
92 module_param(lpfc_debugfs_max_disc_trc, int, S_IRUGO);
93 MODULE_PARM_DESC(lpfc_debugfs_max_disc_trc,
94 	"Set debugfs discovery trace depth");
95 
96 /* This MUST be a power of 2 */
97 static int lpfc_debugfs_max_slow_ring_trc;
98 module_param(lpfc_debugfs_max_slow_ring_trc, int, S_IRUGO);
99 MODULE_PARM_DESC(lpfc_debugfs_max_slow_ring_trc,
100 	"Set debugfs slow ring trace depth");
101 
102 static int lpfc_debugfs_mask_disc_trc;
103 module_param(lpfc_debugfs_mask_disc_trc, int, S_IRUGO);
104 MODULE_PARM_DESC(lpfc_debugfs_mask_disc_trc,
105 	"Set debugfs discovery trace mask");
106 
107 #include <linux/debugfs.h>
108 
109 static atomic_t lpfc_debugfs_seq_trc_cnt = ATOMIC_INIT(0);
110 static unsigned long lpfc_debugfs_start_time = 0L;
111 
112 /* iDiag */
113 static struct lpfc_idiag idiag;
114 
115 /**
116  * lpfc_debugfs_disc_trc_data - Dump discovery logging to a buffer
117  * @vport: The vport to gather the log info from.
118  * @buf: The buffer to dump log into.
119  * @size: The maximum amount of data to process.
120  *
121  * Description:
122  * This routine gathers the lpfc discovery debugfs data from the @vport and
123  * dumps it to @buf up to @size number of bytes. It will start at the next entry
124  * in the log and process the log until the end of the buffer. Then it will
125  * gather from the beginning of the log and process until the current entry.
126  *
127  * Notes:
128  * Discovery logging will be disabled while while this routine dumps the log.
129  *
130  * Return Value:
131  * This routine returns the amount of bytes that were dumped into @buf and will
132  * not exceed @size.
133  **/
134 static int
135 lpfc_debugfs_disc_trc_data(struct lpfc_vport *vport, char *buf, int size)
136 {
137 	int i, index, len, enable;
138 	uint32_t ms;
139 	struct lpfc_debugfs_trc *dtp;
140 	char *buffer;
141 
142 	buffer = kmalloc(LPFC_DEBUG_TRC_ENTRY_SIZE, GFP_KERNEL);
143 	if (!buffer)
144 		return 0;
145 
146 	enable = lpfc_debugfs_enable;
147 	lpfc_debugfs_enable = 0;
148 
149 	len = 0;
150 	index = (atomic_read(&vport->disc_trc_cnt) + 1) &
151 		(lpfc_debugfs_max_disc_trc - 1);
152 	for (i = index; i < lpfc_debugfs_max_disc_trc; i++) {
153 		dtp = vport->disc_trc + i;
154 		if (!dtp->fmt)
155 			continue;
156 		ms = jiffies_to_msecs(dtp->jif - lpfc_debugfs_start_time);
157 		snprintf(buffer,
158 			LPFC_DEBUG_TRC_ENTRY_SIZE, "%010d:%010d ms:%s\n",
159 			dtp->seq_cnt, ms, dtp->fmt);
160 		len +=  snprintf(buf+len, size-len, buffer,
161 			dtp->data1, dtp->data2, dtp->data3);
162 	}
163 	for (i = 0; i < index; i++) {
164 		dtp = vport->disc_trc + i;
165 		if (!dtp->fmt)
166 			continue;
167 		ms = jiffies_to_msecs(dtp->jif - lpfc_debugfs_start_time);
168 		snprintf(buffer,
169 			LPFC_DEBUG_TRC_ENTRY_SIZE, "%010d:%010d ms:%s\n",
170 			dtp->seq_cnt, ms, dtp->fmt);
171 		len +=  snprintf(buf+len, size-len, buffer,
172 			dtp->data1, dtp->data2, dtp->data3);
173 	}
174 
175 	lpfc_debugfs_enable = enable;
176 	kfree(buffer);
177 
178 	return len;
179 }
180 
181 /**
182  * lpfc_debugfs_slow_ring_trc_data - Dump slow ring logging to a buffer
183  * @phba: The HBA to gather the log info from.
184  * @buf: The buffer to dump log into.
185  * @size: The maximum amount of data to process.
186  *
187  * Description:
188  * This routine gathers the lpfc slow ring debugfs data from the @phba and
189  * dumps it to @buf up to @size number of bytes. It will start at the next entry
190  * in the log and process the log until the end of the buffer. Then it will
191  * gather from the beginning of the log and process until the current entry.
192  *
193  * Notes:
194  * Slow ring logging will be disabled while while this routine dumps the log.
195  *
196  * Return Value:
197  * This routine returns the amount of bytes that were dumped into @buf and will
198  * not exceed @size.
199  **/
200 static int
201 lpfc_debugfs_slow_ring_trc_data(struct lpfc_hba *phba, char *buf, int size)
202 {
203 	int i, index, len, enable;
204 	uint32_t ms;
205 	struct lpfc_debugfs_trc *dtp;
206 	char *buffer;
207 
208 	buffer = kmalloc(LPFC_DEBUG_TRC_ENTRY_SIZE, GFP_KERNEL);
209 	if (!buffer)
210 		return 0;
211 
212 	enable = lpfc_debugfs_enable;
213 	lpfc_debugfs_enable = 0;
214 
215 	len = 0;
216 	index = (atomic_read(&phba->slow_ring_trc_cnt) + 1) &
217 		(lpfc_debugfs_max_slow_ring_trc - 1);
218 	for (i = index; i < lpfc_debugfs_max_slow_ring_trc; i++) {
219 		dtp = phba->slow_ring_trc + i;
220 		if (!dtp->fmt)
221 			continue;
222 		ms = jiffies_to_msecs(dtp->jif - lpfc_debugfs_start_time);
223 		snprintf(buffer,
224 			LPFC_DEBUG_TRC_ENTRY_SIZE, "%010d:%010d ms:%s\n",
225 			dtp->seq_cnt, ms, dtp->fmt);
226 		len +=  snprintf(buf+len, size-len, buffer,
227 			dtp->data1, dtp->data2, dtp->data3);
228 	}
229 	for (i = 0; i < index; i++) {
230 		dtp = phba->slow_ring_trc + i;
231 		if (!dtp->fmt)
232 			continue;
233 		ms = jiffies_to_msecs(dtp->jif - lpfc_debugfs_start_time);
234 		snprintf(buffer,
235 			LPFC_DEBUG_TRC_ENTRY_SIZE, "%010d:%010d ms:%s\n",
236 			dtp->seq_cnt, ms, dtp->fmt);
237 		len +=  snprintf(buf+len, size-len, buffer,
238 			dtp->data1, dtp->data2, dtp->data3);
239 	}
240 
241 	lpfc_debugfs_enable = enable;
242 	kfree(buffer);
243 
244 	return len;
245 }
246 
247 static int lpfc_debugfs_last_hbq = -1;
248 
249 /**
250  * lpfc_debugfs_hbqinfo_data - Dump host buffer queue info to a buffer
251  * @phba: The HBA to gather host buffer info from.
252  * @buf: The buffer to dump log into.
253  * @size: The maximum amount of data to process.
254  *
255  * Description:
256  * This routine dumps the host buffer queue info from the @phba to @buf up to
257  * @size number of bytes. A header that describes the current hbq state will be
258  * dumped to @buf first and then info on each hbq entry will be dumped to @buf
259  * until @size bytes have been dumped or all the hbq info has been dumped.
260  *
261  * Notes:
262  * This routine will rotate through each configured HBQ each time called.
263  *
264  * Return Value:
265  * This routine returns the amount of bytes that were dumped into @buf and will
266  * not exceed @size.
267  **/
268 static int
269 lpfc_debugfs_hbqinfo_data(struct lpfc_hba *phba, char *buf, int size)
270 {
271 	int len = 0;
272 	int i, j, found, posted, low;
273 	uint32_t phys, raw_index, getidx;
274 	struct lpfc_hbq_init *hip;
275 	struct hbq_s *hbqs;
276 	struct lpfc_hbq_entry *hbqe;
277 	struct lpfc_dmabuf *d_buf;
278 	struct hbq_dmabuf *hbq_buf;
279 
280 	if (phba->sli_rev != 3)
281 		return 0;
282 
283 	spin_lock_irq(&phba->hbalock);
284 
285 	/* toggle between multiple hbqs, if any */
286 	i = lpfc_sli_hbq_count();
287 	if (i > 1) {
288 		 lpfc_debugfs_last_hbq++;
289 		 if (lpfc_debugfs_last_hbq >= i)
290 			lpfc_debugfs_last_hbq = 0;
291 	}
292 	else
293 		lpfc_debugfs_last_hbq = 0;
294 
295 	i = lpfc_debugfs_last_hbq;
296 
297 	len +=  snprintf(buf+len, size-len, "HBQ %d Info\n", i);
298 
299 	hbqs =  &phba->hbqs[i];
300 	posted = 0;
301 	list_for_each_entry(d_buf, &hbqs->hbq_buffer_list, list)
302 		posted++;
303 
304 	hip =  lpfc_hbq_defs[i];
305 	len +=  snprintf(buf+len, size-len,
306 		"idx:%d prof:%d rn:%d bufcnt:%d icnt:%d acnt:%d posted %d\n",
307 		hip->hbq_index, hip->profile, hip->rn,
308 		hip->buffer_count, hip->init_count, hip->add_count, posted);
309 
310 	raw_index = phba->hbq_get[i];
311 	getidx = le32_to_cpu(raw_index);
312 	len +=  snprintf(buf+len, size-len,
313 		"entrys:%d bufcnt:%d Put:%d nPut:%d localGet:%d hbaGet:%d\n",
314 		hbqs->entry_count, hbqs->buffer_count, hbqs->hbqPutIdx,
315 		hbqs->next_hbqPutIdx, hbqs->local_hbqGetIdx, getidx);
316 
317 	hbqe = (struct lpfc_hbq_entry *) phba->hbqs[i].hbq_virt;
318 	for (j=0; j<hbqs->entry_count; j++) {
319 		len +=  snprintf(buf+len, size-len,
320 			"%03d: %08x %04x %05x ", j,
321 			le32_to_cpu(hbqe->bde.addrLow),
322 			le32_to_cpu(hbqe->bde.tus.w),
323 			le32_to_cpu(hbqe->buffer_tag));
324 		i = 0;
325 		found = 0;
326 
327 		/* First calculate if slot has an associated posted buffer */
328 		low = hbqs->hbqPutIdx - posted;
329 		if (low >= 0) {
330 			if ((j >= hbqs->hbqPutIdx) || (j < low)) {
331 				len +=  snprintf(buf+len, size-len, "Unused\n");
332 				goto skipit;
333 			}
334 		}
335 		else {
336 			if ((j >= hbqs->hbqPutIdx) &&
337 				(j < (hbqs->entry_count+low))) {
338 				len +=  snprintf(buf+len, size-len, "Unused\n");
339 				goto skipit;
340 			}
341 		}
342 
343 		/* Get the Buffer info for the posted buffer */
344 		list_for_each_entry(d_buf, &hbqs->hbq_buffer_list, list) {
345 			hbq_buf = container_of(d_buf, struct hbq_dmabuf, dbuf);
346 			phys = ((uint64_t)hbq_buf->dbuf.phys & 0xffffffff);
347 			if (phys == le32_to_cpu(hbqe->bde.addrLow)) {
348 				len +=  snprintf(buf+len, size-len,
349 					"Buf%d: %p %06x\n", i,
350 					hbq_buf->dbuf.virt, hbq_buf->tag);
351 				found = 1;
352 				break;
353 			}
354 			i++;
355 		}
356 		if (!found) {
357 			len +=  snprintf(buf+len, size-len, "No DMAinfo?\n");
358 		}
359 skipit:
360 		hbqe++;
361 		if (len > LPFC_HBQINFO_SIZE - 54)
362 			break;
363 	}
364 	spin_unlock_irq(&phba->hbalock);
365 	return len;
366 }
367 
368 static int lpfc_debugfs_last_hba_slim_off;
369 
370 /**
371  * lpfc_debugfs_dumpHBASlim_data - Dump HBA SLIM info to a buffer
372  * @phba: The HBA to gather SLIM info from.
373  * @buf: The buffer to dump log into.
374  * @size: The maximum amount of data to process.
375  *
376  * Description:
377  * This routine dumps the current contents of HBA SLIM for the HBA associated
378  * with @phba to @buf up to @size bytes of data. This is the raw HBA SLIM data.
379  *
380  * Notes:
381  * This routine will only dump up to 1024 bytes of data each time called and
382  * should be called multiple times to dump the entire HBA SLIM.
383  *
384  * Return Value:
385  * This routine returns the amount of bytes that were dumped into @buf and will
386  * not exceed @size.
387  **/
388 static int
389 lpfc_debugfs_dumpHBASlim_data(struct lpfc_hba *phba, char *buf, int size)
390 {
391 	int len = 0;
392 	int i, off;
393 	uint32_t *ptr;
394 	char *buffer;
395 
396 	buffer = kmalloc(1024, GFP_KERNEL);
397 	if (!buffer)
398 		return 0;
399 
400 	off = 0;
401 	spin_lock_irq(&phba->hbalock);
402 
403 	len +=  snprintf(buf+len, size-len, "HBA SLIM\n");
404 	lpfc_memcpy_from_slim(buffer,
405 		phba->MBslimaddr + lpfc_debugfs_last_hba_slim_off, 1024);
406 
407 	ptr = (uint32_t *)&buffer[0];
408 	off = lpfc_debugfs_last_hba_slim_off;
409 
410 	/* Set it up for the next time */
411 	lpfc_debugfs_last_hba_slim_off += 1024;
412 	if (lpfc_debugfs_last_hba_slim_off >= 4096)
413 		lpfc_debugfs_last_hba_slim_off = 0;
414 
415 	i = 1024;
416 	while (i > 0) {
417 		len +=  snprintf(buf+len, size-len,
418 		"%08x: %08x %08x %08x %08x %08x %08x %08x %08x\n",
419 		off, *ptr, *(ptr+1), *(ptr+2), *(ptr+3), *(ptr+4),
420 		*(ptr+5), *(ptr+6), *(ptr+7));
421 		ptr += 8;
422 		i -= (8 * sizeof(uint32_t));
423 		off += (8 * sizeof(uint32_t));
424 	}
425 
426 	spin_unlock_irq(&phba->hbalock);
427 	kfree(buffer);
428 
429 	return len;
430 }
431 
432 /**
433  * lpfc_debugfs_dumpHostSlim_data - Dump host SLIM info to a buffer
434  * @phba: The HBA to gather Host SLIM info from.
435  * @buf: The buffer to dump log into.
436  * @size: The maximum amount of data to process.
437  *
438  * Description:
439  * This routine dumps the current contents of host SLIM for the host associated
440  * with @phba to @buf up to @size bytes of data. The dump will contain the
441  * Mailbox, PCB, Rings, and Registers that are located in host memory.
442  *
443  * Return Value:
444  * This routine returns the amount of bytes that were dumped into @buf and will
445  * not exceed @size.
446  **/
447 static int
448 lpfc_debugfs_dumpHostSlim_data(struct lpfc_hba *phba, char *buf, int size)
449 {
450 	int len = 0;
451 	int i, off;
452 	uint32_t word0, word1, word2, word3;
453 	uint32_t *ptr;
454 	struct lpfc_pgp *pgpp;
455 	struct lpfc_sli *psli = &phba->sli;
456 	struct lpfc_sli_ring *pring;
457 
458 	off = 0;
459 	spin_lock_irq(&phba->hbalock);
460 
461 	len +=  snprintf(buf+len, size-len, "SLIM Mailbox\n");
462 	ptr = (uint32_t *)phba->slim2p.virt;
463 	i = sizeof(MAILBOX_t);
464 	while (i > 0) {
465 		len +=  snprintf(buf+len, size-len,
466 		"%08x: %08x %08x %08x %08x %08x %08x %08x %08x\n",
467 		off, *ptr, *(ptr+1), *(ptr+2), *(ptr+3), *(ptr+4),
468 		*(ptr+5), *(ptr+6), *(ptr+7));
469 		ptr += 8;
470 		i -= (8 * sizeof(uint32_t));
471 		off += (8 * sizeof(uint32_t));
472 	}
473 
474 	len +=  snprintf(buf+len, size-len, "SLIM PCB\n");
475 	ptr = (uint32_t *)phba->pcb;
476 	i = sizeof(PCB_t);
477 	while (i > 0) {
478 		len +=  snprintf(buf+len, size-len,
479 		"%08x: %08x %08x %08x %08x %08x %08x %08x %08x\n",
480 		off, *ptr, *(ptr+1), *(ptr+2), *(ptr+3), *(ptr+4),
481 		*(ptr+5), *(ptr+6), *(ptr+7));
482 		ptr += 8;
483 		i -= (8 * sizeof(uint32_t));
484 		off += (8 * sizeof(uint32_t));
485 	}
486 
487 	for (i = 0; i < 4; i++) {
488 		pgpp = &phba->port_gp[i];
489 		pring = &psli->ring[i];
490 		len +=  snprintf(buf+len, size-len,
491 				 "Ring %d: CMD GetInx:%d (Max:%d Next:%d "
492 				 "Local:%d flg:x%x)  RSP PutInx:%d Max:%d\n",
493 				 i, pgpp->cmdGetInx, pring->sli.sli3.numCiocb,
494 				 pring->sli.sli3.next_cmdidx,
495 				 pring->sli.sli3.local_getidx,
496 				 pring->flag, pgpp->rspPutInx,
497 				 pring->sli.sli3.numRiocb);
498 	}
499 
500 	if (phba->sli_rev <= LPFC_SLI_REV3) {
501 		word0 = readl(phba->HAregaddr);
502 		word1 = readl(phba->CAregaddr);
503 		word2 = readl(phba->HSregaddr);
504 		word3 = readl(phba->HCregaddr);
505 		len +=  snprintf(buf+len, size-len, "HA:%08x CA:%08x HS:%08x "
506 				 "HC:%08x\n", word0, word1, word2, word3);
507 	}
508 	spin_unlock_irq(&phba->hbalock);
509 	return len;
510 }
511 
512 /**
513  * lpfc_debugfs_nodelist_data - Dump target node list to a buffer
514  * @vport: The vport to gather target node info from.
515  * @buf: The buffer to dump log into.
516  * @size: The maximum amount of data to process.
517  *
518  * Description:
519  * This routine dumps the current target node list associated with @vport to
520  * @buf up to @size bytes of data. Each node entry in the dump will contain a
521  * node state, DID, WWPN, WWNN, RPI, flags, type, and other useful fields.
522  *
523  * Return Value:
524  * This routine returns the amount of bytes that were dumped into @buf and will
525  * not exceed @size.
526  **/
527 static int
528 lpfc_debugfs_nodelist_data(struct lpfc_vport *vport, char *buf, int size)
529 {
530 	int len = 0;
531 	int cnt;
532 	struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
533 	struct lpfc_nodelist *ndlp;
534 	unsigned char *statep, *name;
535 
536 	cnt = (LPFC_NODELIST_SIZE / LPFC_NODELIST_ENTRY_SIZE);
537 
538 	spin_lock_irq(shost->host_lock);
539 	list_for_each_entry(ndlp, &vport->fc_nodes, nlp_listp) {
540 		if (!cnt) {
541 			len +=  snprintf(buf+len, size-len,
542 				"Missing Nodelist Entries\n");
543 			break;
544 		}
545 		cnt--;
546 		switch (ndlp->nlp_state) {
547 		case NLP_STE_UNUSED_NODE:
548 			statep = "UNUSED";
549 			break;
550 		case NLP_STE_PLOGI_ISSUE:
551 			statep = "PLOGI ";
552 			break;
553 		case NLP_STE_ADISC_ISSUE:
554 			statep = "ADISC ";
555 			break;
556 		case NLP_STE_REG_LOGIN_ISSUE:
557 			statep = "REGLOG";
558 			break;
559 		case NLP_STE_PRLI_ISSUE:
560 			statep = "PRLI  ";
561 			break;
562 		case NLP_STE_LOGO_ISSUE:
563 			statep = "LOGO  ";
564 			break;
565 		case NLP_STE_UNMAPPED_NODE:
566 			statep = "UNMAP ";
567 			break;
568 		case NLP_STE_MAPPED_NODE:
569 			statep = "MAPPED";
570 			break;
571 		case NLP_STE_NPR_NODE:
572 			statep = "NPR   ";
573 			break;
574 		default:
575 			statep = "UNKNOWN";
576 		}
577 		len +=  snprintf(buf+len, size-len, "%s DID:x%06x ",
578 			statep, ndlp->nlp_DID);
579 		name = (unsigned char *)&ndlp->nlp_portname;
580 		len +=  snprintf(buf+len, size-len,
581 			"WWPN %02x:%02x:%02x:%02x:%02x:%02x:%02x:%02x ",
582 			*name, *(name+1), *(name+2), *(name+3),
583 			*(name+4), *(name+5), *(name+6), *(name+7));
584 		name = (unsigned char *)&ndlp->nlp_nodename;
585 		len +=  snprintf(buf+len, size-len,
586 			"WWNN %02x:%02x:%02x:%02x:%02x:%02x:%02x:%02x ",
587 			*name, *(name+1), *(name+2), *(name+3),
588 			*(name+4), *(name+5), *(name+6), *(name+7));
589 		if (ndlp->nlp_flag & NLP_RPI_REGISTERED)
590 			len +=  snprintf(buf+len, size-len, "RPI:%03d ",
591 				ndlp->nlp_rpi);
592 		else
593 			len +=  snprintf(buf+len, size-len, "RPI:none ");
594 		len +=  snprintf(buf+len, size-len, "flag:x%08x ",
595 			ndlp->nlp_flag);
596 		if (!ndlp->nlp_type)
597 			len +=  snprintf(buf+len, size-len, "UNKNOWN_TYPE ");
598 		if (ndlp->nlp_type & NLP_FC_NODE)
599 			len +=  snprintf(buf+len, size-len, "FC_NODE ");
600 		if (ndlp->nlp_type & NLP_FABRIC)
601 			len +=  snprintf(buf+len, size-len, "FABRIC ");
602 		if (ndlp->nlp_type & NLP_FCP_TARGET)
603 			len +=  snprintf(buf+len, size-len, "FCP_TGT sid:%d ",
604 				ndlp->nlp_sid);
605 		if (ndlp->nlp_type & NLP_FCP_INITIATOR)
606 			len +=  snprintf(buf+len, size-len, "FCP_INITIATOR ");
607 		len += snprintf(buf+len, size-len, "usgmap:%x ",
608 			ndlp->nlp_usg_map);
609 		len += snprintf(buf+len, size-len, "refcnt:%x",
610 			atomic_read(&ndlp->kref.refcount));
611 		len +=  snprintf(buf+len, size-len, "\n");
612 	}
613 	spin_unlock_irq(shost->host_lock);
614 	return len;
615 }
616 #endif
617 
618 /**
619  * lpfc_debugfs_disc_trc - Store discovery trace log
620  * @vport: The vport to associate this trace string with for retrieval.
621  * @mask: Log entry classification.
622  * @fmt: Format string to be displayed when dumping the log.
623  * @data1: 1st data parameter to be applied to @fmt.
624  * @data2: 2nd data parameter to be applied to @fmt.
625  * @data3: 3rd data parameter to be applied to @fmt.
626  *
627  * Description:
628  * This routine is used by the driver code to add a debugfs log entry to the
629  * discovery trace buffer associated with @vport. Only entries with a @mask that
630  * match the current debugfs discovery mask will be saved. Entries that do not
631  * match will be thrown away. @fmt, @data1, @data2, and @data3 are used like
632  * printf when displaying the log.
633  **/
634 inline void
635 lpfc_debugfs_disc_trc(struct lpfc_vport *vport, int mask, char *fmt,
636 	uint32_t data1, uint32_t data2, uint32_t data3)
637 {
638 #ifdef CONFIG_SCSI_LPFC_DEBUG_FS
639 	struct lpfc_debugfs_trc *dtp;
640 	int index;
641 
642 	if (!(lpfc_debugfs_mask_disc_trc & mask))
643 		return;
644 
645 	if (!lpfc_debugfs_enable || !lpfc_debugfs_max_disc_trc ||
646 		!vport || !vport->disc_trc)
647 		return;
648 
649 	index = atomic_inc_return(&vport->disc_trc_cnt) &
650 		(lpfc_debugfs_max_disc_trc - 1);
651 	dtp = vport->disc_trc + index;
652 	dtp->fmt = fmt;
653 	dtp->data1 = data1;
654 	dtp->data2 = data2;
655 	dtp->data3 = data3;
656 	dtp->seq_cnt = atomic_inc_return(&lpfc_debugfs_seq_trc_cnt);
657 	dtp->jif = jiffies;
658 #endif
659 	return;
660 }
661 
662 /**
663  * lpfc_debugfs_slow_ring_trc - Store slow ring trace log
664  * @phba: The phba to associate this trace string with for retrieval.
665  * @fmt: Format string to be displayed when dumping the log.
666  * @data1: 1st data parameter to be applied to @fmt.
667  * @data2: 2nd data parameter to be applied to @fmt.
668  * @data3: 3rd data parameter to be applied to @fmt.
669  *
670  * Description:
671  * This routine is used by the driver code to add a debugfs log entry to the
672  * discovery trace buffer associated with @vport. @fmt, @data1, @data2, and
673  * @data3 are used like printf when displaying the log.
674  **/
675 inline void
676 lpfc_debugfs_slow_ring_trc(struct lpfc_hba *phba, char *fmt,
677 	uint32_t data1, uint32_t data2, uint32_t data3)
678 {
679 #ifdef CONFIG_SCSI_LPFC_DEBUG_FS
680 	struct lpfc_debugfs_trc *dtp;
681 	int index;
682 
683 	if (!lpfc_debugfs_enable || !lpfc_debugfs_max_slow_ring_trc ||
684 		!phba || !phba->slow_ring_trc)
685 		return;
686 
687 	index = atomic_inc_return(&phba->slow_ring_trc_cnt) &
688 		(lpfc_debugfs_max_slow_ring_trc - 1);
689 	dtp = phba->slow_ring_trc + index;
690 	dtp->fmt = fmt;
691 	dtp->data1 = data1;
692 	dtp->data2 = data2;
693 	dtp->data3 = data3;
694 	dtp->seq_cnt = atomic_inc_return(&lpfc_debugfs_seq_trc_cnt);
695 	dtp->jif = jiffies;
696 #endif
697 	return;
698 }
699 
700 #ifdef CONFIG_SCSI_LPFC_DEBUG_FS
701 /**
702  * lpfc_debugfs_disc_trc_open - Open the discovery trace log
703  * @inode: The inode pointer that contains a vport pointer.
704  * @file: The file pointer to attach the log output.
705  *
706  * Description:
707  * This routine is the entry point for the debugfs open file operation. It gets
708  * the vport from the i_private field in @inode, allocates the necessary buffer
709  * for the log, fills the buffer from the in-memory log for this vport, and then
710  * returns a pointer to that log in the private_data field in @file.
711  *
712  * Returns:
713  * This function returns zero if successful. On error it will return a negative
714  * error value.
715  **/
716 static int
717 lpfc_debugfs_disc_trc_open(struct inode *inode, struct file *file)
718 {
719 	struct lpfc_vport *vport = inode->i_private;
720 	struct lpfc_debug *debug;
721 	int size;
722 	int rc = -ENOMEM;
723 
724 	if (!lpfc_debugfs_max_disc_trc) {
725 		 rc = -ENOSPC;
726 		goto out;
727 	}
728 
729 	debug = kmalloc(sizeof(*debug), GFP_KERNEL);
730 	if (!debug)
731 		goto out;
732 
733 	/* Round to page boundary */
734 	size =  (lpfc_debugfs_max_disc_trc * LPFC_DEBUG_TRC_ENTRY_SIZE);
735 	size = PAGE_ALIGN(size);
736 
737 	debug->buffer = kmalloc(size, GFP_KERNEL);
738 	if (!debug->buffer) {
739 		kfree(debug);
740 		goto out;
741 	}
742 
743 	debug->len = lpfc_debugfs_disc_trc_data(vport, debug->buffer, size);
744 	file->private_data = debug;
745 
746 	rc = 0;
747 out:
748 	return rc;
749 }
750 
751 /**
752  * lpfc_debugfs_slow_ring_trc_open - Open the Slow Ring trace log
753  * @inode: The inode pointer that contains a vport pointer.
754  * @file: The file pointer to attach the log output.
755  *
756  * Description:
757  * This routine is the entry point for the debugfs open file operation. It gets
758  * the vport from the i_private field in @inode, allocates the necessary buffer
759  * for the log, fills the buffer from the in-memory log for this vport, and then
760  * returns a pointer to that log in the private_data field in @file.
761  *
762  * Returns:
763  * This function returns zero if successful. On error it will return a negative
764  * error value.
765  **/
766 static int
767 lpfc_debugfs_slow_ring_trc_open(struct inode *inode, struct file *file)
768 {
769 	struct lpfc_hba *phba = inode->i_private;
770 	struct lpfc_debug *debug;
771 	int size;
772 	int rc = -ENOMEM;
773 
774 	if (!lpfc_debugfs_max_slow_ring_trc) {
775 		 rc = -ENOSPC;
776 		goto out;
777 	}
778 
779 	debug = kmalloc(sizeof(*debug), GFP_KERNEL);
780 	if (!debug)
781 		goto out;
782 
783 	/* Round to page boundary */
784 	size =  (lpfc_debugfs_max_slow_ring_trc * LPFC_DEBUG_TRC_ENTRY_SIZE);
785 	size = PAGE_ALIGN(size);
786 
787 	debug->buffer = kmalloc(size, GFP_KERNEL);
788 	if (!debug->buffer) {
789 		kfree(debug);
790 		goto out;
791 	}
792 
793 	debug->len = lpfc_debugfs_slow_ring_trc_data(phba, debug->buffer, size);
794 	file->private_data = debug;
795 
796 	rc = 0;
797 out:
798 	return rc;
799 }
800 
801 /**
802  * lpfc_debugfs_hbqinfo_open - Open the hbqinfo debugfs buffer
803  * @inode: The inode pointer that contains a vport pointer.
804  * @file: The file pointer to attach the log output.
805  *
806  * Description:
807  * This routine is the entry point for the debugfs open file operation. It gets
808  * the vport from the i_private field in @inode, allocates the necessary buffer
809  * for the log, fills the buffer from the in-memory log for this vport, and then
810  * returns a pointer to that log in the private_data field in @file.
811  *
812  * Returns:
813  * This function returns zero if successful. On error it will return a negative
814  * error value.
815  **/
816 static int
817 lpfc_debugfs_hbqinfo_open(struct inode *inode, struct file *file)
818 {
819 	struct lpfc_hba *phba = inode->i_private;
820 	struct lpfc_debug *debug;
821 	int rc = -ENOMEM;
822 
823 	debug = kmalloc(sizeof(*debug), GFP_KERNEL);
824 	if (!debug)
825 		goto out;
826 
827 	/* Round to page boundary */
828 	debug->buffer = kmalloc(LPFC_HBQINFO_SIZE, GFP_KERNEL);
829 	if (!debug->buffer) {
830 		kfree(debug);
831 		goto out;
832 	}
833 
834 	debug->len = lpfc_debugfs_hbqinfo_data(phba, debug->buffer,
835 		LPFC_HBQINFO_SIZE);
836 	file->private_data = debug;
837 
838 	rc = 0;
839 out:
840 	return rc;
841 }
842 
843 /**
844  * lpfc_debugfs_dumpHBASlim_open - Open the Dump HBA SLIM debugfs buffer
845  * @inode: The inode pointer that contains a vport pointer.
846  * @file: The file pointer to attach the log output.
847  *
848  * Description:
849  * This routine is the entry point for the debugfs open file operation. It gets
850  * the vport from the i_private field in @inode, allocates the necessary buffer
851  * for the log, fills the buffer from the in-memory log for this vport, and then
852  * returns a pointer to that log in the private_data field in @file.
853  *
854  * Returns:
855  * This function returns zero if successful. On error it will return a negative
856  * error value.
857  **/
858 static int
859 lpfc_debugfs_dumpHBASlim_open(struct inode *inode, struct file *file)
860 {
861 	struct lpfc_hba *phba = inode->i_private;
862 	struct lpfc_debug *debug;
863 	int rc = -ENOMEM;
864 
865 	debug = kmalloc(sizeof(*debug), GFP_KERNEL);
866 	if (!debug)
867 		goto out;
868 
869 	/* Round to page boundary */
870 	debug->buffer = kmalloc(LPFC_DUMPHBASLIM_SIZE, GFP_KERNEL);
871 	if (!debug->buffer) {
872 		kfree(debug);
873 		goto out;
874 	}
875 
876 	debug->len = lpfc_debugfs_dumpHBASlim_data(phba, debug->buffer,
877 		LPFC_DUMPHBASLIM_SIZE);
878 	file->private_data = debug;
879 
880 	rc = 0;
881 out:
882 	return rc;
883 }
884 
885 /**
886  * lpfc_debugfs_dumpHostSlim_open - Open the Dump Host SLIM debugfs buffer
887  * @inode: The inode pointer that contains a vport pointer.
888  * @file: The file pointer to attach the log output.
889  *
890  * Description:
891  * This routine is the entry point for the debugfs open file operation. It gets
892  * the vport from the i_private field in @inode, allocates the necessary buffer
893  * for the log, fills the buffer from the in-memory log for this vport, and then
894  * returns a pointer to that log in the private_data field in @file.
895  *
896  * Returns:
897  * This function returns zero if successful. On error it will return a negative
898  * error value.
899  **/
900 static int
901 lpfc_debugfs_dumpHostSlim_open(struct inode *inode, struct file *file)
902 {
903 	struct lpfc_hba *phba = inode->i_private;
904 	struct lpfc_debug *debug;
905 	int rc = -ENOMEM;
906 
907 	debug = kmalloc(sizeof(*debug), GFP_KERNEL);
908 	if (!debug)
909 		goto out;
910 
911 	/* Round to page boundary */
912 	debug->buffer = kmalloc(LPFC_DUMPHOSTSLIM_SIZE, GFP_KERNEL);
913 	if (!debug->buffer) {
914 		kfree(debug);
915 		goto out;
916 	}
917 
918 	debug->len = lpfc_debugfs_dumpHostSlim_data(phba, debug->buffer,
919 		LPFC_DUMPHOSTSLIM_SIZE);
920 	file->private_data = debug;
921 
922 	rc = 0;
923 out:
924 	return rc;
925 }
926 
927 static int
928 lpfc_debugfs_dumpData_open(struct inode *inode, struct file *file)
929 {
930 	struct lpfc_debug *debug;
931 	int rc = -ENOMEM;
932 
933 	if (!_dump_buf_data)
934 		return -EBUSY;
935 
936 	debug = kmalloc(sizeof(*debug), GFP_KERNEL);
937 	if (!debug)
938 		goto out;
939 
940 	/* Round to page boundary */
941 	printk(KERN_ERR "9059 BLKGRD:  %s: _dump_buf_data=0x%p\n",
942 			__func__, _dump_buf_data);
943 	debug->buffer = _dump_buf_data;
944 	if (!debug->buffer) {
945 		kfree(debug);
946 		goto out;
947 	}
948 
949 	debug->len = (1 << _dump_buf_data_order) << PAGE_SHIFT;
950 	file->private_data = debug;
951 
952 	rc = 0;
953 out:
954 	return rc;
955 }
956 
957 static int
958 lpfc_debugfs_dumpDif_open(struct inode *inode, struct file *file)
959 {
960 	struct lpfc_debug *debug;
961 	int rc = -ENOMEM;
962 
963 	if (!_dump_buf_dif)
964 		return -EBUSY;
965 
966 	debug = kmalloc(sizeof(*debug), GFP_KERNEL);
967 	if (!debug)
968 		goto out;
969 
970 	/* Round to page boundary */
971 	printk(KERN_ERR	"9060 BLKGRD: %s: _dump_buf_dif=0x%p file=%pD\n",
972 		__func__, _dump_buf_dif, file);
973 	debug->buffer = _dump_buf_dif;
974 	if (!debug->buffer) {
975 		kfree(debug);
976 		goto out;
977 	}
978 
979 	debug->len = (1 << _dump_buf_dif_order) << PAGE_SHIFT;
980 	file->private_data = debug;
981 
982 	rc = 0;
983 out:
984 	return rc;
985 }
986 
987 static ssize_t
988 lpfc_debugfs_dumpDataDif_write(struct file *file, const char __user *buf,
989 		  size_t nbytes, loff_t *ppos)
990 {
991 	/*
992 	 * The Data/DIF buffers only save one failing IO
993 	 * The write op is used as a reset mechanism after an IO has
994 	 * already been saved to the next one can be saved
995 	 */
996 	spin_lock(&_dump_buf_lock);
997 
998 	memset((void *)_dump_buf_data, 0,
999 			((1 << PAGE_SHIFT) << _dump_buf_data_order));
1000 	memset((void *)_dump_buf_dif, 0,
1001 			((1 << PAGE_SHIFT) << _dump_buf_dif_order));
1002 
1003 	_dump_buf_done = 0;
1004 
1005 	spin_unlock(&_dump_buf_lock);
1006 
1007 	return nbytes;
1008 }
1009 
1010 static ssize_t
1011 lpfc_debugfs_dif_err_read(struct file *file, char __user *buf,
1012 	size_t nbytes, loff_t *ppos)
1013 {
1014 	struct dentry *dent = file->f_path.dentry;
1015 	struct lpfc_hba *phba = file->private_data;
1016 	char cbuf[32];
1017 	uint64_t tmp = 0;
1018 	int cnt = 0;
1019 
1020 	if (dent == phba->debug_writeGuard)
1021 		cnt = snprintf(cbuf, 32, "%u\n", phba->lpfc_injerr_wgrd_cnt);
1022 	else if (dent == phba->debug_writeApp)
1023 		cnt = snprintf(cbuf, 32, "%u\n", phba->lpfc_injerr_wapp_cnt);
1024 	else if (dent == phba->debug_writeRef)
1025 		cnt = snprintf(cbuf, 32, "%u\n", phba->lpfc_injerr_wref_cnt);
1026 	else if (dent == phba->debug_readGuard)
1027 		cnt = snprintf(cbuf, 32, "%u\n", phba->lpfc_injerr_rgrd_cnt);
1028 	else if (dent == phba->debug_readApp)
1029 		cnt = snprintf(cbuf, 32, "%u\n", phba->lpfc_injerr_rapp_cnt);
1030 	else if (dent == phba->debug_readRef)
1031 		cnt = snprintf(cbuf, 32, "%u\n", phba->lpfc_injerr_rref_cnt);
1032 	else if (dent == phba->debug_InjErrNPortID)
1033 		cnt = snprintf(cbuf, 32, "0x%06x\n", phba->lpfc_injerr_nportid);
1034 	else if (dent == phba->debug_InjErrWWPN) {
1035 		memcpy(&tmp, &phba->lpfc_injerr_wwpn, sizeof(struct lpfc_name));
1036 		tmp = cpu_to_be64(tmp);
1037 		cnt = snprintf(cbuf, 32, "0x%016llx\n", tmp);
1038 	} else if (dent == phba->debug_InjErrLBA) {
1039 		if (phba->lpfc_injerr_lba == (sector_t)(-1))
1040 			cnt = snprintf(cbuf, 32, "off\n");
1041 		else
1042 			cnt = snprintf(cbuf, 32, "0x%llx\n",
1043 				 (uint64_t) phba->lpfc_injerr_lba);
1044 	} else
1045 		lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
1046 			 "0547 Unknown debugfs error injection entry\n");
1047 
1048 	return simple_read_from_buffer(buf, nbytes, ppos, &cbuf, cnt);
1049 }
1050 
1051 static ssize_t
1052 lpfc_debugfs_dif_err_write(struct file *file, const char __user *buf,
1053 	size_t nbytes, loff_t *ppos)
1054 {
1055 	struct dentry *dent = file->f_path.dentry;
1056 	struct lpfc_hba *phba = file->private_data;
1057 	char dstbuf[33];
1058 	uint64_t tmp = 0;
1059 	int size;
1060 
1061 	memset(dstbuf, 0, 33);
1062 	size = (nbytes < 32) ? nbytes : 32;
1063 	if (copy_from_user(dstbuf, buf, size))
1064 		return 0;
1065 
1066 	if (dent == phba->debug_InjErrLBA) {
1067 		if ((buf[0] == 'o') && (buf[1] == 'f') && (buf[2] == 'f'))
1068 			tmp = (uint64_t)(-1);
1069 	}
1070 
1071 	if ((tmp == 0) && (kstrtoull(dstbuf, 0, &tmp)))
1072 		return 0;
1073 
1074 	if (dent == phba->debug_writeGuard)
1075 		phba->lpfc_injerr_wgrd_cnt = (uint32_t)tmp;
1076 	else if (dent == phba->debug_writeApp)
1077 		phba->lpfc_injerr_wapp_cnt = (uint32_t)tmp;
1078 	else if (dent == phba->debug_writeRef)
1079 		phba->lpfc_injerr_wref_cnt = (uint32_t)tmp;
1080 	else if (dent == phba->debug_readGuard)
1081 		phba->lpfc_injerr_rgrd_cnt = (uint32_t)tmp;
1082 	else if (dent == phba->debug_readApp)
1083 		phba->lpfc_injerr_rapp_cnt = (uint32_t)tmp;
1084 	else if (dent == phba->debug_readRef)
1085 		phba->lpfc_injerr_rref_cnt = (uint32_t)tmp;
1086 	else if (dent == phba->debug_InjErrLBA)
1087 		phba->lpfc_injerr_lba = (sector_t)tmp;
1088 	else if (dent == phba->debug_InjErrNPortID)
1089 		phba->lpfc_injerr_nportid = (uint32_t)(tmp & Mask_DID);
1090 	else if (dent == phba->debug_InjErrWWPN) {
1091 		tmp = cpu_to_be64(tmp);
1092 		memcpy(&phba->lpfc_injerr_wwpn, &tmp, sizeof(struct lpfc_name));
1093 	} else
1094 		lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
1095 			 "0548 Unknown debugfs error injection entry\n");
1096 
1097 	return nbytes;
1098 }
1099 
1100 static int
1101 lpfc_debugfs_dif_err_release(struct inode *inode, struct file *file)
1102 {
1103 	return 0;
1104 }
1105 
1106 /**
1107  * lpfc_debugfs_nodelist_open - Open the nodelist debugfs file
1108  * @inode: The inode pointer that contains a vport pointer.
1109  * @file: The file pointer to attach the log output.
1110  *
1111  * Description:
1112  * This routine is the entry point for the debugfs open file operation. It gets
1113  * the vport from the i_private field in @inode, allocates the necessary buffer
1114  * for the log, fills the buffer from the in-memory log for this vport, and then
1115  * returns a pointer to that log in the private_data field in @file.
1116  *
1117  * Returns:
1118  * This function returns zero if successful. On error it will return a negative
1119  * error value.
1120  **/
1121 static int
1122 lpfc_debugfs_nodelist_open(struct inode *inode, struct file *file)
1123 {
1124 	struct lpfc_vport *vport = inode->i_private;
1125 	struct lpfc_debug *debug;
1126 	int rc = -ENOMEM;
1127 
1128 	debug = kmalloc(sizeof(*debug), GFP_KERNEL);
1129 	if (!debug)
1130 		goto out;
1131 
1132 	/* Round to page boundary */
1133 	debug->buffer = kmalloc(LPFC_NODELIST_SIZE, GFP_KERNEL);
1134 	if (!debug->buffer) {
1135 		kfree(debug);
1136 		goto out;
1137 	}
1138 
1139 	debug->len = lpfc_debugfs_nodelist_data(vport, debug->buffer,
1140 		LPFC_NODELIST_SIZE);
1141 	file->private_data = debug;
1142 
1143 	rc = 0;
1144 out:
1145 	return rc;
1146 }
1147 
1148 /**
1149  * lpfc_debugfs_lseek - Seek through a debugfs file
1150  * @file: The file pointer to seek through.
1151  * @off: The offset to seek to or the amount to seek by.
1152  * @whence: Indicates how to seek.
1153  *
1154  * Description:
1155  * This routine is the entry point for the debugfs lseek file operation. The
1156  * @whence parameter indicates whether @off is the offset to directly seek to,
1157  * or if it is a value to seek forward or reverse by. This function figures out
1158  * what the new offset of the debugfs file will be and assigns that value to the
1159  * f_pos field of @file.
1160  *
1161  * Returns:
1162  * This function returns the new offset if successful and returns a negative
1163  * error if unable to process the seek.
1164  **/
1165 static loff_t
1166 lpfc_debugfs_lseek(struct file *file, loff_t off, int whence)
1167 {
1168 	struct lpfc_debug *debug = file->private_data;
1169 	return fixed_size_llseek(file, off, whence, debug->len);
1170 }
1171 
1172 /**
1173  * lpfc_debugfs_read - Read a debugfs file
1174  * @file: The file pointer to read from.
1175  * @buf: The buffer to copy the data to.
1176  * @nbytes: The number of bytes to read.
1177  * @ppos: The position in the file to start reading from.
1178  *
1179  * Description:
1180  * This routine reads data from from the buffer indicated in the private_data
1181  * field of @file. It will start reading at @ppos and copy up to @nbytes of
1182  * data to @buf.
1183  *
1184  * Returns:
1185  * This function returns the amount of data that was read (this could be less
1186  * than @nbytes if the end of the file was reached) or a negative error value.
1187  **/
1188 static ssize_t
1189 lpfc_debugfs_read(struct file *file, char __user *buf,
1190 		  size_t nbytes, loff_t *ppos)
1191 {
1192 	struct lpfc_debug *debug = file->private_data;
1193 
1194 	return simple_read_from_buffer(buf, nbytes, ppos, debug->buffer,
1195 				       debug->len);
1196 }
1197 
1198 /**
1199  * lpfc_debugfs_release - Release the buffer used to store debugfs file data
1200  * @inode: The inode pointer that contains a vport pointer. (unused)
1201  * @file: The file pointer that contains the buffer to release.
1202  *
1203  * Description:
1204  * This routine frees the buffer that was allocated when the debugfs file was
1205  * opened.
1206  *
1207  * Returns:
1208  * This function returns zero.
1209  **/
1210 static int
1211 lpfc_debugfs_release(struct inode *inode, struct file *file)
1212 {
1213 	struct lpfc_debug *debug = file->private_data;
1214 
1215 	kfree(debug->buffer);
1216 	kfree(debug);
1217 
1218 	return 0;
1219 }
1220 
1221 static int
1222 lpfc_debugfs_dumpDataDif_release(struct inode *inode, struct file *file)
1223 {
1224 	struct lpfc_debug *debug = file->private_data;
1225 
1226 	debug->buffer = NULL;
1227 	kfree(debug);
1228 
1229 	return 0;
1230 }
1231 
1232 /*
1233  * ---------------------------------
1234  * iDiag debugfs file access methods
1235  * ---------------------------------
1236  *
1237  * All access methods are through the proper SLI4 PCI function's debugfs
1238  * iDiag directory:
1239  *
1240  *     /sys/kernel/debug/lpfc/fn<#>/iDiag
1241  */
1242 
1243 /**
1244  * lpfc_idiag_cmd_get - Get and parse idiag debugfs comands from user space
1245  * @buf: The pointer to the user space buffer.
1246  * @nbytes: The number of bytes in the user space buffer.
1247  * @idiag_cmd: pointer to the idiag command struct.
1248  *
1249  * This routine reads data from debugfs user space buffer and parses the
1250  * buffer for getting the idiag command and arguments. The while space in
1251  * between the set of data is used as the parsing separator.
1252  *
1253  * This routine returns 0 when successful, it returns proper error code
1254  * back to the user space in error conditions.
1255  */
1256 static int lpfc_idiag_cmd_get(const char __user *buf, size_t nbytes,
1257 			      struct lpfc_idiag_cmd *idiag_cmd)
1258 {
1259 	char mybuf[64];
1260 	char *pbuf, *step_str;
1261 	int i;
1262 	size_t bsize;
1263 
1264 	/* Protect copy from user */
1265 	if (!access_ok(VERIFY_READ, buf, nbytes))
1266 		return -EFAULT;
1267 
1268 	memset(mybuf, 0, sizeof(mybuf));
1269 	memset(idiag_cmd, 0, sizeof(*idiag_cmd));
1270 	bsize = min(nbytes, (sizeof(mybuf)-1));
1271 
1272 	if (copy_from_user(mybuf, buf, bsize))
1273 		return -EFAULT;
1274 	pbuf = &mybuf[0];
1275 	step_str = strsep(&pbuf, "\t ");
1276 
1277 	/* The opcode must present */
1278 	if (!step_str)
1279 		return -EINVAL;
1280 
1281 	idiag_cmd->opcode = simple_strtol(step_str, NULL, 0);
1282 	if (idiag_cmd->opcode == 0)
1283 		return -EINVAL;
1284 
1285 	for (i = 0; i < LPFC_IDIAG_CMD_DATA_SIZE; i++) {
1286 		step_str = strsep(&pbuf, "\t ");
1287 		if (!step_str)
1288 			return i;
1289 		idiag_cmd->data[i] = simple_strtol(step_str, NULL, 0);
1290 	}
1291 	return i;
1292 }
1293 
1294 /**
1295  * lpfc_idiag_open - idiag open debugfs
1296  * @inode: The inode pointer that contains a pointer to phba.
1297  * @file: The file pointer to attach the file operation.
1298  *
1299  * Description:
1300  * This routine is the entry point for the debugfs open file operation. It
1301  * gets the reference to phba from the i_private field in @inode, it then
1302  * allocates buffer for the file operation, performs the necessary PCI config
1303  * space read into the allocated buffer according to the idiag user command
1304  * setup, and then returns a pointer to buffer in the private_data field in
1305  * @file.
1306  *
1307  * Returns:
1308  * This function returns zero if successful. On error it will return an
1309  * negative error value.
1310  **/
1311 static int
1312 lpfc_idiag_open(struct inode *inode, struct file *file)
1313 {
1314 	struct lpfc_debug *debug;
1315 
1316 	debug = kmalloc(sizeof(*debug), GFP_KERNEL);
1317 	if (!debug)
1318 		return -ENOMEM;
1319 
1320 	debug->i_private = inode->i_private;
1321 	debug->buffer = NULL;
1322 	file->private_data = debug;
1323 
1324 	return 0;
1325 }
1326 
1327 /**
1328  * lpfc_idiag_release - Release idiag access file operation
1329  * @inode: The inode pointer that contains a vport pointer. (unused)
1330  * @file: The file pointer that contains the buffer to release.
1331  *
1332  * Description:
1333  * This routine is the generic release routine for the idiag access file
1334  * operation, it frees the buffer that was allocated when the debugfs file
1335  * was opened.
1336  *
1337  * Returns:
1338  * This function returns zero.
1339  **/
1340 static int
1341 lpfc_idiag_release(struct inode *inode, struct file *file)
1342 {
1343 	struct lpfc_debug *debug = file->private_data;
1344 
1345 	/* Free the buffers to the file operation */
1346 	kfree(debug->buffer);
1347 	kfree(debug);
1348 
1349 	return 0;
1350 }
1351 
1352 /**
1353  * lpfc_idiag_cmd_release - Release idiag cmd access file operation
1354  * @inode: The inode pointer that contains a vport pointer. (unused)
1355  * @file: The file pointer that contains the buffer to release.
1356  *
1357  * Description:
1358  * This routine frees the buffer that was allocated when the debugfs file
1359  * was opened. It also reset the fields in the idiag command struct in the
1360  * case of command for write operation.
1361  *
1362  * Returns:
1363  * This function returns zero.
1364  **/
1365 static int
1366 lpfc_idiag_cmd_release(struct inode *inode, struct file *file)
1367 {
1368 	struct lpfc_debug *debug = file->private_data;
1369 
1370 	if (debug->op == LPFC_IDIAG_OP_WR) {
1371 		switch (idiag.cmd.opcode) {
1372 		case LPFC_IDIAG_CMD_PCICFG_WR:
1373 		case LPFC_IDIAG_CMD_PCICFG_ST:
1374 		case LPFC_IDIAG_CMD_PCICFG_CL:
1375 		case LPFC_IDIAG_CMD_QUEACC_WR:
1376 		case LPFC_IDIAG_CMD_QUEACC_ST:
1377 		case LPFC_IDIAG_CMD_QUEACC_CL:
1378 			memset(&idiag, 0, sizeof(idiag));
1379 			break;
1380 		default:
1381 			break;
1382 		}
1383 	}
1384 
1385 	/* Free the buffers to the file operation */
1386 	kfree(debug->buffer);
1387 	kfree(debug);
1388 
1389 	return 0;
1390 }
1391 
1392 /**
1393  * lpfc_idiag_pcicfg_read - idiag debugfs read pcicfg
1394  * @file: The file pointer to read from.
1395  * @buf: The buffer to copy the data to.
1396  * @nbytes: The number of bytes to read.
1397  * @ppos: The position in the file to start reading from.
1398  *
1399  * Description:
1400  * This routine reads data from the @phba pci config space according to the
1401  * idiag command, and copies to user @buf. Depending on the PCI config space
1402  * read command setup, it does either a single register read of a byte
1403  * (8 bits), a word (16 bits), or a dword (32 bits) or browsing through all
1404  * registers from the 4K extended PCI config space.
1405  *
1406  * Returns:
1407  * This function returns the amount of data that was read (this could be less
1408  * than @nbytes if the end of the file was reached) or a negative error value.
1409  **/
1410 static ssize_t
1411 lpfc_idiag_pcicfg_read(struct file *file, char __user *buf, size_t nbytes,
1412 		       loff_t *ppos)
1413 {
1414 	struct lpfc_debug *debug = file->private_data;
1415 	struct lpfc_hba *phba = (struct lpfc_hba *)debug->i_private;
1416 	int offset_label, offset, len = 0, index = LPFC_PCI_CFG_RD_SIZE;
1417 	int where, count;
1418 	char *pbuffer;
1419 	struct pci_dev *pdev;
1420 	uint32_t u32val;
1421 	uint16_t u16val;
1422 	uint8_t u8val;
1423 
1424 	pdev = phba->pcidev;
1425 	if (!pdev)
1426 		return 0;
1427 
1428 	/* This is a user read operation */
1429 	debug->op = LPFC_IDIAG_OP_RD;
1430 
1431 	if (!debug->buffer)
1432 		debug->buffer = kmalloc(LPFC_PCI_CFG_SIZE, GFP_KERNEL);
1433 	if (!debug->buffer)
1434 		return 0;
1435 	pbuffer = debug->buffer;
1436 
1437 	if (*ppos)
1438 		return 0;
1439 
1440 	if (idiag.cmd.opcode == LPFC_IDIAG_CMD_PCICFG_RD) {
1441 		where = idiag.cmd.data[IDIAG_PCICFG_WHERE_INDX];
1442 		count = idiag.cmd.data[IDIAG_PCICFG_COUNT_INDX];
1443 	} else
1444 		return 0;
1445 
1446 	/* Read single PCI config space register */
1447 	switch (count) {
1448 	case SIZE_U8: /* byte (8 bits) */
1449 		pci_read_config_byte(pdev, where, &u8val);
1450 		len += snprintf(pbuffer+len, LPFC_PCI_CFG_SIZE-len,
1451 				"%03x: %02x\n", where, u8val);
1452 		break;
1453 	case SIZE_U16: /* word (16 bits) */
1454 		pci_read_config_word(pdev, where, &u16val);
1455 		len += snprintf(pbuffer+len, LPFC_PCI_CFG_SIZE-len,
1456 				"%03x: %04x\n", where, u16val);
1457 		break;
1458 	case SIZE_U32: /* double word (32 bits) */
1459 		pci_read_config_dword(pdev, where, &u32val);
1460 		len += snprintf(pbuffer+len, LPFC_PCI_CFG_SIZE-len,
1461 				"%03x: %08x\n", where, u32val);
1462 		break;
1463 	case LPFC_PCI_CFG_BROWSE: /* browse all */
1464 		goto pcicfg_browse;
1465 		break;
1466 	default:
1467 		/* illegal count */
1468 		len = 0;
1469 		break;
1470 	}
1471 	return simple_read_from_buffer(buf, nbytes, ppos, pbuffer, len);
1472 
1473 pcicfg_browse:
1474 
1475 	/* Browse all PCI config space registers */
1476 	offset_label = idiag.offset.last_rd;
1477 	offset = offset_label;
1478 
1479 	/* Read PCI config space */
1480 	len += snprintf(pbuffer+len, LPFC_PCI_CFG_SIZE-len,
1481 			"%03x: ", offset_label);
1482 	while (index > 0) {
1483 		pci_read_config_dword(pdev, offset, &u32val);
1484 		len += snprintf(pbuffer+len, LPFC_PCI_CFG_SIZE-len,
1485 				"%08x ", u32val);
1486 		offset += sizeof(uint32_t);
1487 		if (offset >= LPFC_PCI_CFG_SIZE) {
1488 			len += snprintf(pbuffer+len,
1489 					LPFC_PCI_CFG_SIZE-len, "\n");
1490 			break;
1491 		}
1492 		index -= sizeof(uint32_t);
1493 		if (!index)
1494 			len += snprintf(pbuffer+len, LPFC_PCI_CFG_SIZE-len,
1495 					"\n");
1496 		else if (!(index % (8 * sizeof(uint32_t)))) {
1497 			offset_label += (8 * sizeof(uint32_t));
1498 			len += snprintf(pbuffer+len, LPFC_PCI_CFG_SIZE-len,
1499 					"\n%03x: ", offset_label);
1500 		}
1501 	}
1502 
1503 	/* Set up the offset for next portion of pci cfg read */
1504 	if (index == 0) {
1505 		idiag.offset.last_rd += LPFC_PCI_CFG_RD_SIZE;
1506 		if (idiag.offset.last_rd >= LPFC_PCI_CFG_SIZE)
1507 			idiag.offset.last_rd = 0;
1508 	} else
1509 		idiag.offset.last_rd = 0;
1510 
1511 	return simple_read_from_buffer(buf, nbytes, ppos, pbuffer, len);
1512 }
1513 
1514 /**
1515  * lpfc_idiag_pcicfg_write - Syntax check and set up idiag pcicfg commands
1516  * @file: The file pointer to read from.
1517  * @buf: The buffer to copy the user data from.
1518  * @nbytes: The number of bytes to get.
1519  * @ppos: The position in the file to start reading from.
1520  *
1521  * This routine get the debugfs idiag command struct from user space and
1522  * then perform the syntax check for PCI config space read or write command
1523  * accordingly. In the case of PCI config space read command, it sets up
1524  * the command in the idiag command struct for the debugfs read operation.
1525  * In the case of PCI config space write operation, it executes the write
1526  * operation into the PCI config space accordingly.
1527  *
1528  * It returns the @nbytges passing in from debugfs user space when successful.
1529  * In case of error conditions, it returns proper error code back to the user
1530  * space.
1531  */
1532 static ssize_t
1533 lpfc_idiag_pcicfg_write(struct file *file, const char __user *buf,
1534 			size_t nbytes, loff_t *ppos)
1535 {
1536 	struct lpfc_debug *debug = file->private_data;
1537 	struct lpfc_hba *phba = (struct lpfc_hba *)debug->i_private;
1538 	uint32_t where, value, count;
1539 	uint32_t u32val;
1540 	uint16_t u16val;
1541 	uint8_t u8val;
1542 	struct pci_dev *pdev;
1543 	int rc;
1544 
1545 	pdev = phba->pcidev;
1546 	if (!pdev)
1547 		return -EFAULT;
1548 
1549 	/* This is a user write operation */
1550 	debug->op = LPFC_IDIAG_OP_WR;
1551 
1552 	rc = lpfc_idiag_cmd_get(buf, nbytes, &idiag.cmd);
1553 	if (rc < 0)
1554 		return rc;
1555 
1556 	if (idiag.cmd.opcode == LPFC_IDIAG_CMD_PCICFG_RD) {
1557 		/* Sanity check on PCI config read command line arguments */
1558 		if (rc != LPFC_PCI_CFG_RD_CMD_ARG)
1559 			goto error_out;
1560 		/* Read command from PCI config space, set up command fields */
1561 		where = idiag.cmd.data[IDIAG_PCICFG_WHERE_INDX];
1562 		count = idiag.cmd.data[IDIAG_PCICFG_COUNT_INDX];
1563 		if (count == LPFC_PCI_CFG_BROWSE) {
1564 			if (where % sizeof(uint32_t))
1565 				goto error_out;
1566 			/* Starting offset to browse */
1567 			idiag.offset.last_rd = where;
1568 		} else if ((count != sizeof(uint8_t)) &&
1569 			   (count != sizeof(uint16_t)) &&
1570 			   (count != sizeof(uint32_t)))
1571 			goto error_out;
1572 		if (count == sizeof(uint8_t)) {
1573 			if (where > LPFC_PCI_CFG_SIZE - sizeof(uint8_t))
1574 				goto error_out;
1575 			if (where % sizeof(uint8_t))
1576 				goto error_out;
1577 		}
1578 		if (count == sizeof(uint16_t)) {
1579 			if (where > LPFC_PCI_CFG_SIZE - sizeof(uint16_t))
1580 				goto error_out;
1581 			if (where % sizeof(uint16_t))
1582 				goto error_out;
1583 		}
1584 		if (count == sizeof(uint32_t)) {
1585 			if (where > LPFC_PCI_CFG_SIZE - sizeof(uint32_t))
1586 				goto error_out;
1587 			if (where % sizeof(uint32_t))
1588 				goto error_out;
1589 		}
1590 	} else if (idiag.cmd.opcode == LPFC_IDIAG_CMD_PCICFG_WR ||
1591 		   idiag.cmd.opcode == LPFC_IDIAG_CMD_PCICFG_ST ||
1592 		   idiag.cmd.opcode == LPFC_IDIAG_CMD_PCICFG_CL) {
1593 		/* Sanity check on PCI config write command line arguments */
1594 		if (rc != LPFC_PCI_CFG_WR_CMD_ARG)
1595 			goto error_out;
1596 		/* Write command to PCI config space, read-modify-write */
1597 		where = idiag.cmd.data[IDIAG_PCICFG_WHERE_INDX];
1598 		count = idiag.cmd.data[IDIAG_PCICFG_COUNT_INDX];
1599 		value = idiag.cmd.data[IDIAG_PCICFG_VALUE_INDX];
1600 		/* Sanity checks */
1601 		if ((count != sizeof(uint8_t)) &&
1602 		    (count != sizeof(uint16_t)) &&
1603 		    (count != sizeof(uint32_t)))
1604 			goto error_out;
1605 		if (count == sizeof(uint8_t)) {
1606 			if (where > LPFC_PCI_CFG_SIZE - sizeof(uint8_t))
1607 				goto error_out;
1608 			if (where % sizeof(uint8_t))
1609 				goto error_out;
1610 			if (idiag.cmd.opcode == LPFC_IDIAG_CMD_PCICFG_WR)
1611 				pci_write_config_byte(pdev, where,
1612 						      (uint8_t)value);
1613 			if (idiag.cmd.opcode == LPFC_IDIAG_CMD_PCICFG_ST) {
1614 				rc = pci_read_config_byte(pdev, where, &u8val);
1615 				if (!rc) {
1616 					u8val |= (uint8_t)value;
1617 					pci_write_config_byte(pdev, where,
1618 							      u8val);
1619 				}
1620 			}
1621 			if (idiag.cmd.opcode == LPFC_IDIAG_CMD_PCICFG_CL) {
1622 				rc = pci_read_config_byte(pdev, where, &u8val);
1623 				if (!rc) {
1624 					u8val &= (uint8_t)(~value);
1625 					pci_write_config_byte(pdev, where,
1626 							      u8val);
1627 				}
1628 			}
1629 		}
1630 		if (count == sizeof(uint16_t)) {
1631 			if (where > LPFC_PCI_CFG_SIZE - sizeof(uint16_t))
1632 				goto error_out;
1633 			if (where % sizeof(uint16_t))
1634 				goto error_out;
1635 			if (idiag.cmd.opcode == LPFC_IDIAG_CMD_PCICFG_WR)
1636 				pci_write_config_word(pdev, where,
1637 						      (uint16_t)value);
1638 			if (idiag.cmd.opcode == LPFC_IDIAG_CMD_PCICFG_ST) {
1639 				rc = pci_read_config_word(pdev, where, &u16val);
1640 				if (!rc) {
1641 					u16val |= (uint16_t)value;
1642 					pci_write_config_word(pdev, where,
1643 							      u16val);
1644 				}
1645 			}
1646 			if (idiag.cmd.opcode == LPFC_IDIAG_CMD_PCICFG_CL) {
1647 				rc = pci_read_config_word(pdev, where, &u16val);
1648 				if (!rc) {
1649 					u16val &= (uint16_t)(~value);
1650 					pci_write_config_word(pdev, where,
1651 							      u16val);
1652 				}
1653 			}
1654 		}
1655 		if (count == sizeof(uint32_t)) {
1656 			if (where > LPFC_PCI_CFG_SIZE - sizeof(uint32_t))
1657 				goto error_out;
1658 			if (where % sizeof(uint32_t))
1659 				goto error_out;
1660 			if (idiag.cmd.opcode == LPFC_IDIAG_CMD_PCICFG_WR)
1661 				pci_write_config_dword(pdev, where, value);
1662 			if (idiag.cmd.opcode == LPFC_IDIAG_CMD_PCICFG_ST) {
1663 				rc = pci_read_config_dword(pdev, where,
1664 							   &u32val);
1665 				if (!rc) {
1666 					u32val |= value;
1667 					pci_write_config_dword(pdev, where,
1668 							       u32val);
1669 				}
1670 			}
1671 			if (idiag.cmd.opcode == LPFC_IDIAG_CMD_PCICFG_CL) {
1672 				rc = pci_read_config_dword(pdev, where,
1673 							   &u32val);
1674 				if (!rc) {
1675 					u32val &= ~value;
1676 					pci_write_config_dword(pdev, where,
1677 							       u32val);
1678 				}
1679 			}
1680 		}
1681 	} else
1682 		/* All other opecodes are illegal for now */
1683 		goto error_out;
1684 
1685 	return nbytes;
1686 error_out:
1687 	memset(&idiag, 0, sizeof(idiag));
1688 	return -EINVAL;
1689 }
1690 
1691 /**
1692  * lpfc_idiag_baracc_read - idiag debugfs pci bar access read
1693  * @file: The file pointer to read from.
1694  * @buf: The buffer to copy the data to.
1695  * @nbytes: The number of bytes to read.
1696  * @ppos: The position in the file to start reading from.
1697  *
1698  * Description:
1699  * This routine reads data from the @phba pci bar memory mapped space
1700  * according to the idiag command, and copies to user @buf.
1701  *
1702  * Returns:
1703  * This function returns the amount of data that was read (this could be less
1704  * than @nbytes if the end of the file was reached) or a negative error value.
1705  **/
1706 static ssize_t
1707 lpfc_idiag_baracc_read(struct file *file, char __user *buf, size_t nbytes,
1708 		       loff_t *ppos)
1709 {
1710 	struct lpfc_debug *debug = file->private_data;
1711 	struct lpfc_hba *phba = (struct lpfc_hba *)debug->i_private;
1712 	int offset_label, offset, offset_run, len = 0, index;
1713 	int bar_num, acc_range, bar_size;
1714 	char *pbuffer;
1715 	void __iomem *mem_mapped_bar;
1716 	uint32_t if_type;
1717 	struct pci_dev *pdev;
1718 	uint32_t u32val;
1719 
1720 	pdev = phba->pcidev;
1721 	if (!pdev)
1722 		return 0;
1723 
1724 	/* This is a user read operation */
1725 	debug->op = LPFC_IDIAG_OP_RD;
1726 
1727 	if (!debug->buffer)
1728 		debug->buffer = kmalloc(LPFC_PCI_BAR_RD_BUF_SIZE, GFP_KERNEL);
1729 	if (!debug->buffer)
1730 		return 0;
1731 	pbuffer = debug->buffer;
1732 
1733 	if (*ppos)
1734 		return 0;
1735 
1736 	if (idiag.cmd.opcode == LPFC_IDIAG_CMD_BARACC_RD) {
1737 		bar_num   = idiag.cmd.data[IDIAG_BARACC_BAR_NUM_INDX];
1738 		offset    = idiag.cmd.data[IDIAG_BARACC_OFF_SET_INDX];
1739 		acc_range = idiag.cmd.data[IDIAG_BARACC_ACC_MOD_INDX];
1740 		bar_size = idiag.cmd.data[IDIAG_BARACC_BAR_SZE_INDX];
1741 	} else
1742 		return 0;
1743 
1744 	if (acc_range == 0)
1745 		return 0;
1746 
1747 	if_type = bf_get(lpfc_sli_intf_if_type, &phba->sli4_hba.sli_intf);
1748 	if (if_type == LPFC_SLI_INTF_IF_TYPE_0) {
1749 		if (bar_num == IDIAG_BARACC_BAR_0)
1750 			mem_mapped_bar = phba->sli4_hba.conf_regs_memmap_p;
1751 		else if (bar_num == IDIAG_BARACC_BAR_1)
1752 			mem_mapped_bar = phba->sli4_hba.ctrl_regs_memmap_p;
1753 		else if (bar_num == IDIAG_BARACC_BAR_2)
1754 			mem_mapped_bar = phba->sli4_hba.drbl_regs_memmap_p;
1755 		else
1756 			return 0;
1757 	} else if (if_type == LPFC_SLI_INTF_IF_TYPE_2) {
1758 		if (bar_num == IDIAG_BARACC_BAR_0)
1759 			mem_mapped_bar = phba->sli4_hba.conf_regs_memmap_p;
1760 		else
1761 			return 0;
1762 	} else
1763 		return 0;
1764 
1765 	/* Read single PCI bar space register */
1766 	if (acc_range == SINGLE_WORD) {
1767 		offset_run = offset;
1768 		u32val = readl(mem_mapped_bar + offset_run);
1769 		len += snprintf(pbuffer+len, LPFC_PCI_BAR_RD_BUF_SIZE-len,
1770 				"%05x: %08x\n", offset_run, u32val);
1771 	} else
1772 		goto baracc_browse;
1773 
1774 	return simple_read_from_buffer(buf, nbytes, ppos, pbuffer, len);
1775 
1776 baracc_browse:
1777 
1778 	/* Browse all PCI bar space registers */
1779 	offset_label = idiag.offset.last_rd;
1780 	offset_run = offset_label;
1781 
1782 	/* Read PCI bar memory mapped space */
1783 	len += snprintf(pbuffer+len, LPFC_PCI_BAR_RD_BUF_SIZE-len,
1784 			"%05x: ", offset_label);
1785 	index = LPFC_PCI_BAR_RD_SIZE;
1786 	while (index > 0) {
1787 		u32val = readl(mem_mapped_bar + offset_run);
1788 		len += snprintf(pbuffer+len, LPFC_PCI_BAR_RD_BUF_SIZE-len,
1789 				"%08x ", u32val);
1790 		offset_run += sizeof(uint32_t);
1791 		if (acc_range == LPFC_PCI_BAR_BROWSE) {
1792 			if (offset_run >= bar_size) {
1793 				len += snprintf(pbuffer+len,
1794 					LPFC_PCI_BAR_RD_BUF_SIZE-len, "\n");
1795 				break;
1796 			}
1797 		} else {
1798 			if (offset_run >= offset +
1799 			    (acc_range * sizeof(uint32_t))) {
1800 				len += snprintf(pbuffer+len,
1801 					LPFC_PCI_BAR_RD_BUF_SIZE-len, "\n");
1802 				break;
1803 			}
1804 		}
1805 		index -= sizeof(uint32_t);
1806 		if (!index)
1807 			len += snprintf(pbuffer+len,
1808 					LPFC_PCI_BAR_RD_BUF_SIZE-len, "\n");
1809 		else if (!(index % (8 * sizeof(uint32_t)))) {
1810 			offset_label += (8 * sizeof(uint32_t));
1811 			len += snprintf(pbuffer+len,
1812 					LPFC_PCI_BAR_RD_BUF_SIZE-len,
1813 					"\n%05x: ", offset_label);
1814 		}
1815 	}
1816 
1817 	/* Set up the offset for next portion of pci bar read */
1818 	if (index == 0) {
1819 		idiag.offset.last_rd += LPFC_PCI_BAR_RD_SIZE;
1820 		if (acc_range == LPFC_PCI_BAR_BROWSE) {
1821 			if (idiag.offset.last_rd >= bar_size)
1822 				idiag.offset.last_rd = 0;
1823 		} else {
1824 			if (offset_run >= offset +
1825 			    (acc_range * sizeof(uint32_t)))
1826 				idiag.offset.last_rd = offset;
1827 		}
1828 	} else {
1829 		if (acc_range == LPFC_PCI_BAR_BROWSE)
1830 			idiag.offset.last_rd = 0;
1831 		else
1832 			idiag.offset.last_rd = offset;
1833 	}
1834 
1835 	return simple_read_from_buffer(buf, nbytes, ppos, pbuffer, len);
1836 }
1837 
1838 /**
1839  * lpfc_idiag_baracc_write - Syntax check and set up idiag bar access commands
1840  * @file: The file pointer to read from.
1841  * @buf: The buffer to copy the user data from.
1842  * @nbytes: The number of bytes to get.
1843  * @ppos: The position in the file to start reading from.
1844  *
1845  * This routine get the debugfs idiag command struct from user space and
1846  * then perform the syntax check for PCI bar memory mapped space read or
1847  * write command accordingly. In the case of PCI bar memory mapped space
1848  * read command, it sets up the command in the idiag command struct for
1849  * the debugfs read operation. In the case of PCI bar memorpy mapped space
1850  * write operation, it executes the write operation into the PCI bar memory
1851  * mapped space accordingly.
1852  *
1853  * It returns the @nbytges passing in from debugfs user space when successful.
1854  * In case of error conditions, it returns proper error code back to the user
1855  * space.
1856  */
1857 static ssize_t
1858 lpfc_idiag_baracc_write(struct file *file, const char __user *buf,
1859 			size_t nbytes, loff_t *ppos)
1860 {
1861 	struct lpfc_debug *debug = file->private_data;
1862 	struct lpfc_hba *phba = (struct lpfc_hba *)debug->i_private;
1863 	uint32_t bar_num, bar_size, offset, value, acc_range;
1864 	struct pci_dev *pdev;
1865 	void __iomem *mem_mapped_bar;
1866 	uint32_t if_type;
1867 	uint32_t u32val;
1868 	int rc;
1869 
1870 	pdev = phba->pcidev;
1871 	if (!pdev)
1872 		return -EFAULT;
1873 
1874 	/* This is a user write operation */
1875 	debug->op = LPFC_IDIAG_OP_WR;
1876 
1877 	rc = lpfc_idiag_cmd_get(buf, nbytes, &idiag.cmd);
1878 	if (rc < 0)
1879 		return rc;
1880 
1881 	if_type = bf_get(lpfc_sli_intf_if_type, &phba->sli4_hba.sli_intf);
1882 	bar_num = idiag.cmd.data[IDIAG_BARACC_BAR_NUM_INDX];
1883 
1884 	if (if_type == LPFC_SLI_INTF_IF_TYPE_0) {
1885 		if ((bar_num != IDIAG_BARACC_BAR_0) &&
1886 		    (bar_num != IDIAG_BARACC_BAR_1) &&
1887 		    (bar_num != IDIAG_BARACC_BAR_2))
1888 			goto error_out;
1889 	} else if (if_type == LPFC_SLI_INTF_IF_TYPE_2) {
1890 		if (bar_num != IDIAG_BARACC_BAR_0)
1891 			goto error_out;
1892 	} else
1893 		goto error_out;
1894 
1895 	if (if_type == LPFC_SLI_INTF_IF_TYPE_0) {
1896 		if (bar_num == IDIAG_BARACC_BAR_0) {
1897 			idiag.cmd.data[IDIAG_BARACC_BAR_SZE_INDX] =
1898 				LPFC_PCI_IF0_BAR0_SIZE;
1899 			mem_mapped_bar = phba->sli4_hba.conf_regs_memmap_p;
1900 		} else if (bar_num == IDIAG_BARACC_BAR_1) {
1901 			idiag.cmd.data[IDIAG_BARACC_BAR_SZE_INDX] =
1902 				LPFC_PCI_IF0_BAR1_SIZE;
1903 			mem_mapped_bar = phba->sli4_hba.ctrl_regs_memmap_p;
1904 		} else if (bar_num == IDIAG_BARACC_BAR_2) {
1905 			idiag.cmd.data[IDIAG_BARACC_BAR_SZE_INDX] =
1906 				LPFC_PCI_IF0_BAR2_SIZE;
1907 			mem_mapped_bar = phba->sli4_hba.drbl_regs_memmap_p;
1908 		} else
1909 			goto error_out;
1910 	} else if (if_type == LPFC_SLI_INTF_IF_TYPE_2) {
1911 		if (bar_num == IDIAG_BARACC_BAR_0) {
1912 			idiag.cmd.data[IDIAG_BARACC_BAR_SZE_INDX] =
1913 				LPFC_PCI_IF2_BAR0_SIZE;
1914 			mem_mapped_bar = phba->sli4_hba.conf_regs_memmap_p;
1915 		} else
1916 			goto error_out;
1917 	} else
1918 		goto error_out;
1919 
1920 	offset = idiag.cmd.data[IDIAG_BARACC_OFF_SET_INDX];
1921 	if (offset % sizeof(uint32_t))
1922 		goto error_out;
1923 
1924 	bar_size = idiag.cmd.data[IDIAG_BARACC_BAR_SZE_INDX];
1925 	if (idiag.cmd.opcode == LPFC_IDIAG_CMD_BARACC_RD) {
1926 		/* Sanity check on PCI config read command line arguments */
1927 		if (rc != LPFC_PCI_BAR_RD_CMD_ARG)
1928 			goto error_out;
1929 		acc_range = idiag.cmd.data[IDIAG_BARACC_ACC_MOD_INDX];
1930 		if (acc_range == LPFC_PCI_BAR_BROWSE) {
1931 			if (offset > bar_size - sizeof(uint32_t))
1932 				goto error_out;
1933 			/* Starting offset to browse */
1934 			idiag.offset.last_rd = offset;
1935 		} else if (acc_range > SINGLE_WORD) {
1936 			if (offset + acc_range * sizeof(uint32_t) > bar_size)
1937 				goto error_out;
1938 			/* Starting offset to browse */
1939 			idiag.offset.last_rd = offset;
1940 		} else if (acc_range != SINGLE_WORD)
1941 			goto error_out;
1942 	} else if (idiag.cmd.opcode == LPFC_IDIAG_CMD_BARACC_WR ||
1943 		   idiag.cmd.opcode == LPFC_IDIAG_CMD_BARACC_ST ||
1944 		   idiag.cmd.opcode == LPFC_IDIAG_CMD_BARACC_CL) {
1945 		/* Sanity check on PCI bar write command line arguments */
1946 		if (rc != LPFC_PCI_BAR_WR_CMD_ARG)
1947 			goto error_out;
1948 		/* Write command to PCI bar space, read-modify-write */
1949 		acc_range = SINGLE_WORD;
1950 		value = idiag.cmd.data[IDIAG_BARACC_REG_VAL_INDX];
1951 		if (idiag.cmd.opcode == LPFC_IDIAG_CMD_BARACC_WR) {
1952 			writel(value, mem_mapped_bar + offset);
1953 			readl(mem_mapped_bar + offset);
1954 		}
1955 		if (idiag.cmd.opcode == LPFC_IDIAG_CMD_BARACC_ST) {
1956 			u32val = readl(mem_mapped_bar + offset);
1957 			u32val |= value;
1958 			writel(u32val, mem_mapped_bar + offset);
1959 			readl(mem_mapped_bar + offset);
1960 		}
1961 		if (idiag.cmd.opcode == LPFC_IDIAG_CMD_BARACC_CL) {
1962 			u32val = readl(mem_mapped_bar + offset);
1963 			u32val &= ~value;
1964 			writel(u32val, mem_mapped_bar + offset);
1965 			readl(mem_mapped_bar + offset);
1966 		}
1967 	} else
1968 		/* All other opecodes are illegal for now */
1969 		goto error_out;
1970 
1971 	return nbytes;
1972 error_out:
1973 	memset(&idiag, 0, sizeof(idiag));
1974 	return -EINVAL;
1975 }
1976 
1977 /**
1978  * lpfc_idiag_queinfo_read - idiag debugfs read queue information
1979  * @file: The file pointer to read from.
1980  * @buf: The buffer to copy the data to.
1981  * @nbytes: The number of bytes to read.
1982  * @ppos: The position in the file to start reading from.
1983  *
1984  * Description:
1985  * This routine reads data from the @phba SLI4 PCI function queue information,
1986  * and copies to user @buf.
1987  *
1988  * Returns:
1989  * This function returns the amount of data that was read (this could be less
1990  * than @nbytes if the end of the file was reached) or a negative error value.
1991  **/
1992 static ssize_t
1993 lpfc_idiag_queinfo_read(struct file *file, char __user *buf, size_t nbytes,
1994 			loff_t *ppos)
1995 {
1996 	struct lpfc_debug *debug = file->private_data;
1997 	struct lpfc_hba *phba = (struct lpfc_hba *)debug->i_private;
1998 	int len = 0;
1999 	char *pbuffer;
2000 	int x, cnt;
2001 	int max_cnt;
2002 	struct lpfc_queue *qp = NULL;
2003 
2004 
2005 	if (!debug->buffer)
2006 		debug->buffer = kmalloc(LPFC_QUE_INFO_GET_BUF_SIZE, GFP_KERNEL);
2007 	if (!debug->buffer)
2008 		return 0;
2009 	pbuffer = debug->buffer;
2010 	max_cnt = LPFC_QUE_INFO_GET_BUF_SIZE - 128;
2011 
2012 	if (*ppos)
2013 		return 0;
2014 
2015 	spin_lock_irq(&phba->hbalock);
2016 
2017 	/* Fast-path event queue */
2018 	if (phba->sli4_hba.hba_eq && phba->cfg_fcp_io_channel) {
2019 		cnt = phba->cfg_fcp_io_channel;
2020 
2021 		for (x = 0; x < cnt; x++) {
2022 
2023 			/* Fast-path EQ */
2024 			qp = phba->sli4_hba.hba_eq[x];
2025 			if (!qp)
2026 				goto proc_cq;
2027 
2028 			len += snprintf(pbuffer+len,
2029 				LPFC_QUE_INFO_GET_BUF_SIZE-len,
2030 				"\nHBA EQ info: "
2031 				"EQ-STAT[max:x%x noE:x%x "
2032 				"bs:x%x proc:x%llx]\n",
2033 				qp->q_cnt_1, qp->q_cnt_2,
2034 				qp->q_cnt_3, (unsigned long long)qp->q_cnt_4);
2035 
2036 			len += snprintf(pbuffer+len,
2037 				LPFC_QUE_INFO_GET_BUF_SIZE-len,
2038 				"EQID[%02d], "
2039 				"QE-CNT[%04d], QE-SIZE[%04d], "
2040 				"HOST-IDX[%04d], PORT-IDX[%04d]",
2041 				qp->queue_id,
2042 				qp->entry_count,
2043 				qp->entry_size,
2044 				qp->host_index,
2045 				qp->hba_index);
2046 
2047 
2048 			/* Reset max counter */
2049 			qp->EQ_max_eqe = 0;
2050 
2051 			len +=  snprintf(pbuffer+len,
2052 				LPFC_QUE_INFO_GET_BUF_SIZE-len, "\n");
2053 			if (len >= max_cnt)
2054 				goto too_big;
2055 proc_cq:
2056 			/* Fast-path FCP CQ */
2057 			qp = phba->sli4_hba.fcp_cq[x];
2058 			len += snprintf(pbuffer+len,
2059 				LPFC_QUE_INFO_GET_BUF_SIZE-len,
2060 				"\tFCP CQ info: ");
2061 			len += snprintf(pbuffer+len,
2062 				LPFC_QUE_INFO_GET_BUF_SIZE-len,
2063 				"AssocEQID[%02d]: "
2064 				"CQ STAT[max:x%x relw:x%x "
2065 				"xabt:x%x wq:x%llx]\n",
2066 				qp->assoc_qid,
2067 				qp->q_cnt_1, qp->q_cnt_2,
2068 				qp->q_cnt_3, (unsigned long long)qp->q_cnt_4);
2069 			len += snprintf(pbuffer+len,
2070 				LPFC_QUE_INFO_GET_BUF_SIZE-len,
2071 				"\tCQID[%02d], "
2072 				"QE-CNT[%04d], QE-SIZE[%04d], "
2073 				"HOST-IDX[%04d], PORT-IDX[%04d]",
2074 				qp->queue_id, qp->entry_count,
2075 				qp->entry_size, qp->host_index,
2076 				qp->hba_index);
2077 
2078 
2079 			/* Reset max counter */
2080 			qp->CQ_max_cqe = 0;
2081 
2082 			len +=  snprintf(pbuffer+len,
2083 				LPFC_QUE_INFO_GET_BUF_SIZE-len, "\n");
2084 			if (len >= max_cnt)
2085 				goto too_big;
2086 
2087 			/* Fast-path FCP WQ */
2088 			qp = phba->sli4_hba.fcp_wq[x];
2089 
2090 			len += snprintf(pbuffer+len,
2091 				LPFC_QUE_INFO_GET_BUF_SIZE-len,
2092 				"\t\tFCP WQ info: ");
2093 			len += snprintf(pbuffer+len,
2094 				LPFC_QUE_INFO_GET_BUF_SIZE-len,
2095 				"AssocCQID[%02d]: "
2096 				"WQ-STAT[oflow:x%x posted:x%llx]\n",
2097 				qp->assoc_qid,
2098 				qp->q_cnt_1, (unsigned long long)qp->q_cnt_4);
2099 			len += snprintf(pbuffer+len,
2100 				LPFC_QUE_INFO_GET_BUF_SIZE-len,
2101 				"\t\tWQID[%02d], "
2102 				"QE-CNT[%04d], QE-SIZE[%04d], "
2103 				"HOST-IDX[%04d], PORT-IDX[%04d]",
2104 				qp->queue_id,
2105 				qp->entry_count,
2106 				qp->entry_size,
2107 				qp->host_index,
2108 				qp->hba_index);
2109 
2110 			len +=  snprintf(pbuffer+len,
2111 				LPFC_QUE_INFO_GET_BUF_SIZE-len, "\n");
2112 			if (len >= max_cnt)
2113 				goto too_big;
2114 
2115 			if (x)
2116 				continue;
2117 
2118 			/* Only EQ 0 has slow path CQs configured */
2119 
2120 			/* Slow-path mailbox CQ */
2121 			qp = phba->sli4_hba.mbx_cq;
2122 			if (qp) {
2123 				len += snprintf(pbuffer+len,
2124 					LPFC_QUE_INFO_GET_BUF_SIZE-len,
2125 					"\tMBX CQ info: ");
2126 				len += snprintf(pbuffer+len,
2127 					LPFC_QUE_INFO_GET_BUF_SIZE-len,
2128 					"AssocEQID[%02d]: "
2129 					"CQ-STAT[mbox:x%x relw:x%x "
2130 					"xabt:x%x wq:x%llx]\n",
2131 					qp->assoc_qid,
2132 					qp->q_cnt_1, qp->q_cnt_2,
2133 					qp->q_cnt_3,
2134 					(unsigned long long)qp->q_cnt_4);
2135 				len += snprintf(pbuffer+len,
2136 					LPFC_QUE_INFO_GET_BUF_SIZE-len,
2137 					"\tCQID[%02d], "
2138 					"QE-CNT[%04d], QE-SIZE[%04d], "
2139 					"HOST-IDX[%04d], PORT-IDX[%04d]",
2140 					qp->queue_id, qp->entry_count,
2141 					qp->entry_size, qp->host_index,
2142 					qp->hba_index);
2143 
2144 				len +=  snprintf(pbuffer+len,
2145 					LPFC_QUE_INFO_GET_BUF_SIZE-len, "\n");
2146 				if (len >= max_cnt)
2147 					goto too_big;
2148 			}
2149 
2150 			/* Slow-path MBOX MQ */
2151 			qp = phba->sli4_hba.mbx_wq;
2152 			if (qp) {
2153 				len += snprintf(pbuffer+len,
2154 					LPFC_QUE_INFO_GET_BUF_SIZE-len,
2155 					"\t\tMBX MQ info: ");
2156 				len += snprintf(pbuffer+len,
2157 					LPFC_QUE_INFO_GET_BUF_SIZE-len,
2158 					"AssocCQID[%02d]:\n",
2159 					phba->sli4_hba.mbx_wq->assoc_qid);
2160 				len += snprintf(pbuffer+len,
2161 					LPFC_QUE_INFO_GET_BUF_SIZE-len,
2162 					"\t\tWQID[%02d], "
2163 					"QE-CNT[%04d], QE-SIZE[%04d], "
2164 					"HOST-IDX[%04d], PORT-IDX[%04d]",
2165 					qp->queue_id, qp->entry_count,
2166 					qp->entry_size, qp->host_index,
2167 					qp->hba_index);
2168 
2169 				len +=  snprintf(pbuffer+len,
2170 					LPFC_QUE_INFO_GET_BUF_SIZE-len, "\n");
2171 				if (len >= max_cnt)
2172 					goto too_big;
2173 			}
2174 
2175 			/* Slow-path ELS response CQ */
2176 			qp = phba->sli4_hba.els_cq;
2177 			if (qp) {
2178 				len += snprintf(pbuffer+len,
2179 					LPFC_QUE_INFO_GET_BUF_SIZE-len,
2180 					"\tELS CQ info: ");
2181 				len += snprintf(pbuffer+len,
2182 					LPFC_QUE_INFO_GET_BUF_SIZE-len,
2183 					"AssocEQID[%02d]: "
2184 					"CQ-STAT[max:x%x relw:x%x "
2185 					"xabt:x%x wq:x%llx]\n",
2186 					qp->assoc_qid,
2187 					qp->q_cnt_1, qp->q_cnt_2,
2188 					qp->q_cnt_3,
2189 					(unsigned long long)qp->q_cnt_4);
2190 				len += snprintf(pbuffer+len,
2191 					LPFC_QUE_INFO_GET_BUF_SIZE-len,
2192 					"\tCQID [%02d], "
2193 					"QE-CNT[%04d], QE-SIZE[%04d], "
2194 					"HOST-IDX[%04d], PORT-IDX[%04d]",
2195 					qp->queue_id, qp->entry_count,
2196 					qp->entry_size, qp->host_index,
2197 					qp->hba_index);
2198 
2199 				/* Reset max counter */
2200 				qp->CQ_max_cqe = 0;
2201 
2202 				len +=  snprintf(pbuffer+len,
2203 					LPFC_QUE_INFO_GET_BUF_SIZE-len, "\n");
2204 				if (len >= max_cnt)
2205 					goto too_big;
2206 			}
2207 
2208 			/* Slow-path ELS WQ */
2209 			qp = phba->sli4_hba.els_wq;
2210 			if (qp) {
2211 				len += snprintf(pbuffer+len,
2212 					LPFC_QUE_INFO_GET_BUF_SIZE-len,
2213 					"\t\tELS WQ info: ");
2214 				len += snprintf(pbuffer+len,
2215 					LPFC_QUE_INFO_GET_BUF_SIZE-len,
2216 					"AssocCQID[%02d]: "
2217 					" WQ-STAT[oflow:x%x "
2218 					"posted:x%llx]\n",
2219 					qp->assoc_qid,
2220 					qp->q_cnt_1,
2221 					(unsigned long long)qp->q_cnt_4);
2222 				len += snprintf(pbuffer+len,
2223 					LPFC_QUE_INFO_GET_BUF_SIZE-len,
2224 					"\t\tWQID[%02d], "
2225 					"QE-CNT[%04d], QE-SIZE[%04d], "
2226 					"HOST-IDX[%04d], PORT-IDX[%04d]",
2227 					qp->queue_id, qp->entry_count,
2228 					qp->entry_size, qp->host_index,
2229 					qp->hba_index);
2230 
2231 				len +=  snprintf(pbuffer+len,
2232 					LPFC_QUE_INFO_GET_BUF_SIZE-len, "\n");
2233 				if (len >= max_cnt)
2234 					goto too_big;
2235 			}
2236 
2237 			if (phba->sli4_hba.hdr_rq && phba->sli4_hba.dat_rq) {
2238 				/* Slow-path RQ header */
2239 				qp = phba->sli4_hba.hdr_rq;
2240 
2241 				len += snprintf(pbuffer+len,
2242 				LPFC_QUE_INFO_GET_BUF_SIZE-len,
2243 					"\t\tRQ info: ");
2244 				len += snprintf(pbuffer+len,
2245 					LPFC_QUE_INFO_GET_BUF_SIZE-len,
2246 					"AssocCQID[%02d]: "
2247 					"RQ-STAT[nopost:x%x nobuf:x%x "
2248 					"trunc:x%x rcv:x%llx]\n",
2249 					qp->assoc_qid,
2250 					qp->q_cnt_1, qp->q_cnt_2,
2251 					qp->q_cnt_3,
2252 					(unsigned long long)qp->q_cnt_4);
2253 				len += snprintf(pbuffer+len,
2254 					LPFC_QUE_INFO_GET_BUF_SIZE-len,
2255 					"\t\tHQID[%02d], "
2256 					"QE-CNT[%04d], QE-SIZE[%04d], "
2257 					"HOST-IDX[%04d], PORT-IDX[%04d]\n",
2258 					qp->queue_id,
2259 					qp->entry_count,
2260 					qp->entry_size,
2261 					qp->host_index,
2262 					qp->hba_index);
2263 
2264 				/* Slow-path RQ data */
2265 				qp = phba->sli4_hba.dat_rq;
2266 				len += snprintf(pbuffer+len,
2267 					LPFC_QUE_INFO_GET_BUF_SIZE-len,
2268 					"\t\tDQID[%02d], "
2269 					"QE-CNT[%04d], QE-SIZE[%04d], "
2270 					"HOST-IDX[%04d], PORT-IDX[%04d]\n",
2271 					qp->queue_id,
2272 					qp->entry_count,
2273 					qp->entry_size,
2274 					qp->host_index,
2275 					qp->hba_index);
2276 
2277 				len +=  snprintf(pbuffer+len,
2278 					LPFC_QUE_INFO_GET_BUF_SIZE-len, "\n");
2279 			}
2280 		}
2281 	}
2282 
2283 	if (phba->cfg_fof) {
2284 		/* FOF EQ */
2285 		qp = phba->sli4_hba.fof_eq;
2286 		if (!qp)
2287 			goto out;
2288 
2289 		len += snprintf(pbuffer+len,
2290 			LPFC_QUE_INFO_GET_BUF_SIZE-len,
2291 			"\nFOF EQ info: "
2292 			"EQ-STAT[max:x%x noE:x%x "
2293 			"bs:x%x proc:x%llx]\n",
2294 			qp->q_cnt_1, qp->q_cnt_2,
2295 			qp->q_cnt_3, (unsigned long long)qp->q_cnt_4);
2296 
2297 		len += snprintf(pbuffer+len,
2298 			LPFC_QUE_INFO_GET_BUF_SIZE-len,
2299 			"EQID[%02d], "
2300 			"QE-CNT[%04d], QE-SIZE[%04d], "
2301 			"HOST-IDX[%04d], PORT-IDX[%04d]",
2302 			qp->queue_id,
2303 			qp->entry_count,
2304 			qp->entry_size,
2305 			qp->host_index,
2306 			qp->hba_index);
2307 
2308 		/* Reset max counter */
2309 		qp->EQ_max_eqe = 0;
2310 
2311 		len +=  snprintf(pbuffer+len,
2312 			LPFC_QUE_INFO_GET_BUF_SIZE-len, "\n");
2313 		if (len >= max_cnt)
2314 			goto too_big;
2315 	}
2316 
2317 	if (phba->cfg_fof) {
2318 
2319 		/* OAS CQ */
2320 		qp = phba->sli4_hba.oas_cq;
2321 		if (qp) {
2322 			len += snprintf(pbuffer+len,
2323 				LPFC_QUE_INFO_GET_BUF_SIZE-len,
2324 				"\tOAS CQ info: ");
2325 			len += snprintf(pbuffer+len,
2326 				LPFC_QUE_INFO_GET_BUF_SIZE-len,
2327 				"AssocEQID[%02d]: "
2328 				"CQ STAT[max:x%x relw:x%x "
2329 				"xabt:x%x wq:x%llx]\n",
2330 				qp->assoc_qid,
2331 				qp->q_cnt_1, qp->q_cnt_2,
2332 				qp->q_cnt_3, (unsigned long long)qp->q_cnt_4);
2333 			len += snprintf(pbuffer+len,
2334 				LPFC_QUE_INFO_GET_BUF_SIZE-len,
2335 				"\tCQID[%02d], "
2336 				"QE-CNT[%04d], QE-SIZE[%04d], "
2337 				"HOST-IDX[%04d], PORT-IDX[%04d]",
2338 				qp->queue_id, qp->entry_count,
2339 				qp->entry_size, qp->host_index,
2340 				qp->hba_index);
2341 
2342 			/* Reset max counter */
2343 			qp->CQ_max_cqe = 0;
2344 
2345 			len +=  snprintf(pbuffer+len,
2346 				LPFC_QUE_INFO_GET_BUF_SIZE-len, "\n");
2347 			if (len >= max_cnt)
2348 				goto too_big;
2349 		}
2350 
2351 		/* OAS WQ */
2352 		qp = phba->sli4_hba.oas_wq;
2353 		if (qp) {
2354 			len += snprintf(pbuffer+len,
2355 				LPFC_QUE_INFO_GET_BUF_SIZE-len,
2356 				"\t\tOAS WQ info: ");
2357 			len += snprintf(pbuffer+len,
2358 				LPFC_QUE_INFO_GET_BUF_SIZE-len,
2359 				"AssocCQID[%02d]: "
2360 				"WQ-STAT[oflow:x%x posted:x%llx]\n",
2361 				qp->assoc_qid,
2362 				qp->q_cnt_1, (unsigned long long)qp->q_cnt_4);
2363 			len += snprintf(pbuffer+len,
2364 				LPFC_QUE_INFO_GET_BUF_SIZE-len,
2365 				"\t\tWQID[%02d], "
2366 				"QE-CNT[%04d], QE-SIZE[%04d], "
2367 				"HOST-IDX[%04d], PORT-IDX[%04d]",
2368 				qp->queue_id,
2369 				qp->entry_count,
2370 				qp->entry_size,
2371 				qp->host_index,
2372 				qp->hba_index);
2373 
2374 			len +=  snprintf(pbuffer+len,
2375 				LPFC_QUE_INFO_GET_BUF_SIZE-len, "\n");
2376 			if (len >= max_cnt)
2377 				goto too_big;
2378 		}
2379 	}
2380 out:
2381 	spin_unlock_irq(&phba->hbalock);
2382 	return simple_read_from_buffer(buf, nbytes, ppos, pbuffer, len);
2383 
2384 too_big:
2385 	len +=  snprintf(pbuffer+len,
2386 		LPFC_QUE_INFO_GET_BUF_SIZE-len, "Truncated ...\n");
2387 	spin_unlock_irq(&phba->hbalock);
2388 	return simple_read_from_buffer(buf, nbytes, ppos, pbuffer, len);
2389 }
2390 
2391 /**
2392  * lpfc_idiag_que_param_check - queue access command parameter sanity check
2393  * @q: The pointer to queue structure.
2394  * @index: The index into a queue entry.
2395  * @count: The number of queue entries to access.
2396  *
2397  * Description:
2398  * The routine performs sanity check on device queue access method commands.
2399  *
2400  * Returns:
2401  * This function returns -EINVAL when fails the sanity check, otherwise, it
2402  * returns 0.
2403  **/
2404 static int
2405 lpfc_idiag_que_param_check(struct lpfc_queue *q, int index, int count)
2406 {
2407 	/* Only support single entry read or browsing */
2408 	if ((count != 1) && (count != LPFC_QUE_ACC_BROWSE))
2409 		return -EINVAL;
2410 	if (index > q->entry_count - 1)
2411 		return -EINVAL;
2412 	return 0;
2413 }
2414 
2415 /**
2416  * lpfc_idiag_queacc_read_qe - read a single entry from the given queue index
2417  * @pbuffer: The pointer to buffer to copy the read data into.
2418  * @pque: The pointer to the queue to be read.
2419  * @index: The index into the queue entry.
2420  *
2421  * Description:
2422  * This routine reads out a single entry from the given queue's index location
2423  * and copies it into the buffer provided.
2424  *
2425  * Returns:
2426  * This function returns 0 when it fails, otherwise, it returns the length of
2427  * the data read into the buffer provided.
2428  **/
2429 static int
2430 lpfc_idiag_queacc_read_qe(char *pbuffer, int len, struct lpfc_queue *pque,
2431 			  uint32_t index)
2432 {
2433 	int offset, esize;
2434 	uint32_t *pentry;
2435 
2436 	if (!pbuffer || !pque)
2437 		return 0;
2438 
2439 	esize = pque->entry_size;
2440 	len += snprintf(pbuffer+len, LPFC_QUE_ACC_BUF_SIZE-len,
2441 			"QE-INDEX[%04d]:\n", index);
2442 
2443 	offset = 0;
2444 	pentry = pque->qe[index].address;
2445 	while (esize > 0) {
2446 		len += snprintf(pbuffer+len, LPFC_QUE_ACC_BUF_SIZE-len,
2447 				"%08x ", *pentry);
2448 		pentry++;
2449 		offset += sizeof(uint32_t);
2450 		esize -= sizeof(uint32_t);
2451 		if (esize > 0 && !(offset % (4 * sizeof(uint32_t))))
2452 			len += snprintf(pbuffer+len,
2453 					LPFC_QUE_ACC_BUF_SIZE-len, "\n");
2454 	}
2455 	len += snprintf(pbuffer+len, LPFC_QUE_ACC_BUF_SIZE-len, "\n");
2456 
2457 	return len;
2458 }
2459 
2460 /**
2461  * lpfc_idiag_queacc_read - idiag debugfs read port queue
2462  * @file: The file pointer to read from.
2463  * @buf: The buffer to copy the data to.
2464  * @nbytes: The number of bytes to read.
2465  * @ppos: The position in the file to start reading from.
2466  *
2467  * Description:
2468  * This routine reads data from the @phba device queue memory according to the
2469  * idiag command, and copies to user @buf. Depending on the queue dump read
2470  * command setup, it does either a single queue entry read or browing through
2471  * all entries of the queue.
2472  *
2473  * Returns:
2474  * This function returns the amount of data that was read (this could be less
2475  * than @nbytes if the end of the file was reached) or a negative error value.
2476  **/
2477 static ssize_t
2478 lpfc_idiag_queacc_read(struct file *file, char __user *buf, size_t nbytes,
2479 		       loff_t *ppos)
2480 {
2481 	struct lpfc_debug *debug = file->private_data;
2482 	uint32_t last_index, index, count;
2483 	struct lpfc_queue *pque = NULL;
2484 	char *pbuffer;
2485 	int len = 0;
2486 
2487 	/* This is a user read operation */
2488 	debug->op = LPFC_IDIAG_OP_RD;
2489 
2490 	if (!debug->buffer)
2491 		debug->buffer = kmalloc(LPFC_QUE_ACC_BUF_SIZE, GFP_KERNEL);
2492 	if (!debug->buffer)
2493 		return 0;
2494 	pbuffer = debug->buffer;
2495 
2496 	if (*ppos)
2497 		return 0;
2498 
2499 	if (idiag.cmd.opcode == LPFC_IDIAG_CMD_QUEACC_RD) {
2500 		index = idiag.cmd.data[IDIAG_QUEACC_INDEX_INDX];
2501 		count = idiag.cmd.data[IDIAG_QUEACC_COUNT_INDX];
2502 		pque = (struct lpfc_queue *)idiag.ptr_private;
2503 	} else
2504 		return 0;
2505 
2506 	/* Browse the queue starting from index */
2507 	if (count == LPFC_QUE_ACC_BROWSE)
2508 		goto que_browse;
2509 
2510 	/* Read a single entry from the queue */
2511 	len = lpfc_idiag_queacc_read_qe(pbuffer, len, pque, index);
2512 
2513 	return simple_read_from_buffer(buf, nbytes, ppos, pbuffer, len);
2514 
2515 que_browse:
2516 
2517 	/* Browse all entries from the queue */
2518 	last_index = idiag.offset.last_rd;
2519 	index = last_index;
2520 
2521 	while (len < LPFC_QUE_ACC_SIZE - pque->entry_size) {
2522 		len = lpfc_idiag_queacc_read_qe(pbuffer, len, pque, index);
2523 		index++;
2524 		if (index > pque->entry_count - 1)
2525 			break;
2526 	}
2527 
2528 	/* Set up the offset for next portion of pci cfg read */
2529 	if (index > pque->entry_count - 1)
2530 		index = 0;
2531 	idiag.offset.last_rd = index;
2532 
2533 	return simple_read_from_buffer(buf, nbytes, ppos, pbuffer, len);
2534 }
2535 
2536 /**
2537  * lpfc_idiag_queacc_write - Syntax check and set up idiag queacc commands
2538  * @file: The file pointer to read from.
2539  * @buf: The buffer to copy the user data from.
2540  * @nbytes: The number of bytes to get.
2541  * @ppos: The position in the file to start reading from.
2542  *
2543  * This routine get the debugfs idiag command struct from user space and then
2544  * perform the syntax check for port queue read (dump) or write (set) command
2545  * accordingly. In the case of port queue read command, it sets up the command
2546  * in the idiag command struct for the following debugfs read operation. In
2547  * the case of port queue write operation, it executes the write operation
2548  * into the port queue entry accordingly.
2549  *
2550  * It returns the @nbytges passing in from debugfs user space when successful.
2551  * In case of error conditions, it returns proper error code back to the user
2552  * space.
2553  **/
2554 static ssize_t
2555 lpfc_idiag_queacc_write(struct file *file, const char __user *buf,
2556 			size_t nbytes, loff_t *ppos)
2557 {
2558 	struct lpfc_debug *debug = file->private_data;
2559 	struct lpfc_hba *phba = (struct lpfc_hba *)debug->i_private;
2560 	uint32_t qidx, quetp, queid, index, count, offset, value;
2561 	uint32_t *pentry;
2562 	struct lpfc_queue *pque;
2563 	int rc;
2564 
2565 	/* This is a user write operation */
2566 	debug->op = LPFC_IDIAG_OP_WR;
2567 
2568 	rc = lpfc_idiag_cmd_get(buf, nbytes, &idiag.cmd);
2569 	if (rc < 0)
2570 		return rc;
2571 
2572 	/* Get and sanity check on command feilds */
2573 	quetp  = idiag.cmd.data[IDIAG_QUEACC_QUETP_INDX];
2574 	queid  = idiag.cmd.data[IDIAG_QUEACC_QUEID_INDX];
2575 	index  = idiag.cmd.data[IDIAG_QUEACC_INDEX_INDX];
2576 	count  = idiag.cmd.data[IDIAG_QUEACC_COUNT_INDX];
2577 	offset = idiag.cmd.data[IDIAG_QUEACC_OFFST_INDX];
2578 	value  = idiag.cmd.data[IDIAG_QUEACC_VALUE_INDX];
2579 
2580 	/* Sanity check on command line arguments */
2581 	if (idiag.cmd.opcode == LPFC_IDIAG_CMD_QUEACC_WR ||
2582 	    idiag.cmd.opcode == LPFC_IDIAG_CMD_QUEACC_ST ||
2583 	    idiag.cmd.opcode == LPFC_IDIAG_CMD_QUEACC_CL) {
2584 		if (rc != LPFC_QUE_ACC_WR_CMD_ARG)
2585 			goto error_out;
2586 		if (count != 1)
2587 			goto error_out;
2588 	} else if (idiag.cmd.opcode == LPFC_IDIAG_CMD_QUEACC_RD) {
2589 		if (rc != LPFC_QUE_ACC_RD_CMD_ARG)
2590 			goto error_out;
2591 	} else
2592 		goto error_out;
2593 
2594 	switch (quetp) {
2595 	case LPFC_IDIAG_EQ:
2596 		/* HBA event queue */
2597 		if (phba->sli4_hba.hba_eq) {
2598 			for (qidx = 0; qidx < phba->cfg_fcp_io_channel;
2599 				qidx++) {
2600 				if (phba->sli4_hba.hba_eq[qidx] &&
2601 				    phba->sli4_hba.hba_eq[qidx]->queue_id ==
2602 				    queid) {
2603 					/* Sanity check */
2604 					rc = lpfc_idiag_que_param_check(
2605 						phba->sli4_hba.hba_eq[qidx],
2606 						index, count);
2607 					if (rc)
2608 						goto error_out;
2609 					idiag.ptr_private =
2610 						phba->sli4_hba.hba_eq[qidx];
2611 					goto pass_check;
2612 				}
2613 			}
2614 		}
2615 		goto error_out;
2616 		break;
2617 	case LPFC_IDIAG_CQ:
2618 		/* MBX complete queue */
2619 		if (phba->sli4_hba.mbx_cq &&
2620 		    phba->sli4_hba.mbx_cq->queue_id == queid) {
2621 			/* Sanity check */
2622 			rc = lpfc_idiag_que_param_check(
2623 					phba->sli4_hba.mbx_cq, index, count);
2624 			if (rc)
2625 				goto error_out;
2626 			idiag.ptr_private = phba->sli4_hba.mbx_cq;
2627 			goto pass_check;
2628 		}
2629 		/* ELS complete queue */
2630 		if (phba->sli4_hba.els_cq &&
2631 		    phba->sli4_hba.els_cq->queue_id == queid) {
2632 			/* Sanity check */
2633 			rc = lpfc_idiag_que_param_check(
2634 					phba->sli4_hba.els_cq, index, count);
2635 			if (rc)
2636 				goto error_out;
2637 			idiag.ptr_private = phba->sli4_hba.els_cq;
2638 			goto pass_check;
2639 		}
2640 		/* FCP complete queue */
2641 		if (phba->sli4_hba.fcp_cq) {
2642 			qidx = 0;
2643 			do {
2644 				if (phba->sli4_hba.fcp_cq[qidx] &&
2645 				    phba->sli4_hba.fcp_cq[qidx]->queue_id ==
2646 				    queid) {
2647 					/* Sanity check */
2648 					rc = lpfc_idiag_que_param_check(
2649 						phba->sli4_hba.fcp_cq[qidx],
2650 						index, count);
2651 					if (rc)
2652 						goto error_out;
2653 					idiag.ptr_private =
2654 						phba->sli4_hba.fcp_cq[qidx];
2655 					goto pass_check;
2656 				}
2657 			} while (++qidx < phba->cfg_fcp_io_channel);
2658 		}
2659 		goto error_out;
2660 		break;
2661 	case LPFC_IDIAG_MQ:
2662 		/* MBX work queue */
2663 		if (phba->sli4_hba.mbx_wq &&
2664 		    phba->sli4_hba.mbx_wq->queue_id == queid) {
2665 			/* Sanity check */
2666 			rc = lpfc_idiag_que_param_check(
2667 					phba->sli4_hba.mbx_wq, index, count);
2668 			if (rc)
2669 				goto error_out;
2670 			idiag.ptr_private = phba->sli4_hba.mbx_wq;
2671 			goto pass_check;
2672 		}
2673 		goto error_out;
2674 		break;
2675 	case LPFC_IDIAG_WQ:
2676 		/* ELS work queue */
2677 		if (phba->sli4_hba.els_wq &&
2678 		    phba->sli4_hba.els_wq->queue_id == queid) {
2679 			/* Sanity check */
2680 			rc = lpfc_idiag_que_param_check(
2681 					phba->sli4_hba.els_wq, index, count);
2682 			if (rc)
2683 				goto error_out;
2684 			idiag.ptr_private = phba->sli4_hba.els_wq;
2685 			goto pass_check;
2686 		}
2687 		/* FCP work queue */
2688 		if (phba->sli4_hba.fcp_wq) {
2689 			for (qidx = 0; qidx < phba->cfg_fcp_io_channel;
2690 				qidx++) {
2691 				if (!phba->sli4_hba.fcp_wq[qidx])
2692 					continue;
2693 				if (phba->sli4_hba.fcp_wq[qidx]->queue_id ==
2694 				    queid) {
2695 					/* Sanity check */
2696 					rc = lpfc_idiag_que_param_check(
2697 						phba->sli4_hba.fcp_wq[qidx],
2698 						index, count);
2699 					if (rc)
2700 						goto error_out;
2701 					idiag.ptr_private =
2702 						phba->sli4_hba.fcp_wq[qidx];
2703 					goto pass_check;
2704 				}
2705 			}
2706 		}
2707 		goto error_out;
2708 		break;
2709 	case LPFC_IDIAG_RQ:
2710 		/* HDR queue */
2711 		if (phba->sli4_hba.hdr_rq &&
2712 		    phba->sli4_hba.hdr_rq->queue_id == queid) {
2713 			/* Sanity check */
2714 			rc = lpfc_idiag_que_param_check(
2715 					phba->sli4_hba.hdr_rq, index, count);
2716 			if (rc)
2717 				goto error_out;
2718 			idiag.ptr_private = phba->sli4_hba.hdr_rq;
2719 			goto pass_check;
2720 		}
2721 		/* DAT queue */
2722 		if (phba->sli4_hba.dat_rq &&
2723 		    phba->sli4_hba.dat_rq->queue_id == queid) {
2724 			/* Sanity check */
2725 			rc = lpfc_idiag_que_param_check(
2726 					phba->sli4_hba.dat_rq, index, count);
2727 			if (rc)
2728 				goto error_out;
2729 			idiag.ptr_private = phba->sli4_hba.dat_rq;
2730 			goto pass_check;
2731 		}
2732 		goto error_out;
2733 		break;
2734 	default:
2735 		goto error_out;
2736 		break;
2737 	}
2738 
2739 pass_check:
2740 
2741 	if (idiag.cmd.opcode == LPFC_IDIAG_CMD_QUEACC_RD) {
2742 		if (count == LPFC_QUE_ACC_BROWSE)
2743 			idiag.offset.last_rd = index;
2744 	}
2745 
2746 	if (idiag.cmd.opcode == LPFC_IDIAG_CMD_QUEACC_WR ||
2747 	    idiag.cmd.opcode == LPFC_IDIAG_CMD_QUEACC_ST ||
2748 	    idiag.cmd.opcode == LPFC_IDIAG_CMD_QUEACC_CL) {
2749 		/* Additional sanity checks on write operation */
2750 		pque = (struct lpfc_queue *)idiag.ptr_private;
2751 		if (offset > pque->entry_size/sizeof(uint32_t) - 1)
2752 			goto error_out;
2753 		pentry = pque->qe[index].address;
2754 		pentry += offset;
2755 		if (idiag.cmd.opcode == LPFC_IDIAG_CMD_QUEACC_WR)
2756 			*pentry = value;
2757 		if (idiag.cmd.opcode == LPFC_IDIAG_CMD_QUEACC_ST)
2758 			*pentry |= value;
2759 		if (idiag.cmd.opcode == LPFC_IDIAG_CMD_QUEACC_CL)
2760 			*pentry &= ~value;
2761 	}
2762 	return nbytes;
2763 
2764 error_out:
2765 	/* Clean out command structure on command error out */
2766 	memset(&idiag, 0, sizeof(idiag));
2767 	return -EINVAL;
2768 }
2769 
2770 /**
2771  * lpfc_idiag_drbacc_read_reg - idiag debugfs read a doorbell register
2772  * @phba: The pointer to hba structure.
2773  * @pbuffer: The pointer to the buffer to copy the data to.
2774  * @len: The lenght of bytes to copied.
2775  * @drbregid: The id to doorbell registers.
2776  *
2777  * Description:
2778  * This routine reads a doorbell register and copies its content to the
2779  * user buffer pointed to by @pbuffer.
2780  *
2781  * Returns:
2782  * This function returns the amount of data that was copied into @pbuffer.
2783  **/
2784 static int
2785 lpfc_idiag_drbacc_read_reg(struct lpfc_hba *phba, char *pbuffer,
2786 			   int len, uint32_t drbregid)
2787 {
2788 
2789 	if (!pbuffer)
2790 		return 0;
2791 
2792 	switch (drbregid) {
2793 	case LPFC_DRB_EQCQ:
2794 		len += snprintf(pbuffer+len, LPFC_DRB_ACC_BUF_SIZE-len,
2795 				"EQCQ-DRB-REG: 0x%08x\n",
2796 				readl(phba->sli4_hba.EQCQDBregaddr));
2797 		break;
2798 	case LPFC_DRB_MQ:
2799 		len += snprintf(pbuffer+len, LPFC_DRB_ACC_BUF_SIZE-len,
2800 				"MQ-DRB-REG:   0x%08x\n",
2801 				readl(phba->sli4_hba.MQDBregaddr));
2802 		break;
2803 	case LPFC_DRB_WQ:
2804 		len += snprintf(pbuffer+len, LPFC_DRB_ACC_BUF_SIZE-len,
2805 				"WQ-DRB-REG:   0x%08x\n",
2806 				readl(phba->sli4_hba.WQDBregaddr));
2807 		break;
2808 	case LPFC_DRB_RQ:
2809 		len += snprintf(pbuffer+len, LPFC_DRB_ACC_BUF_SIZE-len,
2810 				"RQ-DRB-REG:   0x%08x\n",
2811 				readl(phba->sli4_hba.RQDBregaddr));
2812 		break;
2813 	default:
2814 		break;
2815 	}
2816 
2817 	return len;
2818 }
2819 
2820 /**
2821  * lpfc_idiag_drbacc_read - idiag debugfs read port doorbell
2822  * @file: The file pointer to read from.
2823  * @buf: The buffer to copy the data to.
2824  * @nbytes: The number of bytes to read.
2825  * @ppos: The position in the file to start reading from.
2826  *
2827  * Description:
2828  * This routine reads data from the @phba device doorbell register according
2829  * to the idiag command, and copies to user @buf. Depending on the doorbell
2830  * register read command setup, it does either a single doorbell register
2831  * read or dump all doorbell registers.
2832  *
2833  * Returns:
2834  * This function returns the amount of data that was read (this could be less
2835  * than @nbytes if the end of the file was reached) or a negative error value.
2836  **/
2837 static ssize_t
2838 lpfc_idiag_drbacc_read(struct file *file, char __user *buf, size_t nbytes,
2839 		       loff_t *ppos)
2840 {
2841 	struct lpfc_debug *debug = file->private_data;
2842 	struct lpfc_hba *phba = (struct lpfc_hba *)debug->i_private;
2843 	uint32_t drb_reg_id, i;
2844 	char *pbuffer;
2845 	int len = 0;
2846 
2847 	/* This is a user read operation */
2848 	debug->op = LPFC_IDIAG_OP_RD;
2849 
2850 	if (!debug->buffer)
2851 		debug->buffer = kmalloc(LPFC_DRB_ACC_BUF_SIZE, GFP_KERNEL);
2852 	if (!debug->buffer)
2853 		return 0;
2854 	pbuffer = debug->buffer;
2855 
2856 	if (*ppos)
2857 		return 0;
2858 
2859 	if (idiag.cmd.opcode == LPFC_IDIAG_CMD_DRBACC_RD)
2860 		drb_reg_id = idiag.cmd.data[IDIAG_DRBACC_REGID_INDX];
2861 	else
2862 		return 0;
2863 
2864 	if (drb_reg_id == LPFC_DRB_ACC_ALL)
2865 		for (i = 1; i <= LPFC_DRB_MAX; i++)
2866 			len = lpfc_idiag_drbacc_read_reg(phba,
2867 							 pbuffer, len, i);
2868 	else
2869 		len = lpfc_idiag_drbacc_read_reg(phba,
2870 						 pbuffer, len, drb_reg_id);
2871 
2872 	return simple_read_from_buffer(buf, nbytes, ppos, pbuffer, len);
2873 }
2874 
2875 /**
2876  * lpfc_idiag_drbacc_write - Syntax check and set up idiag drbacc commands
2877  * @file: The file pointer to read from.
2878  * @buf: The buffer to copy the user data from.
2879  * @nbytes: The number of bytes to get.
2880  * @ppos: The position in the file to start reading from.
2881  *
2882  * This routine get the debugfs idiag command struct from user space and then
2883  * perform the syntax check for port doorbell register read (dump) or write
2884  * (set) command accordingly. In the case of port queue read command, it sets
2885  * up the command in the idiag command struct for the following debugfs read
2886  * operation. In the case of port doorbell register write operation, it
2887  * executes the write operation into the port doorbell register accordingly.
2888  *
2889  * It returns the @nbytges passing in from debugfs user space when successful.
2890  * In case of error conditions, it returns proper error code back to the user
2891  * space.
2892  **/
2893 static ssize_t
2894 lpfc_idiag_drbacc_write(struct file *file, const char __user *buf,
2895 			size_t nbytes, loff_t *ppos)
2896 {
2897 	struct lpfc_debug *debug = file->private_data;
2898 	struct lpfc_hba *phba = (struct lpfc_hba *)debug->i_private;
2899 	uint32_t drb_reg_id, value, reg_val = 0;
2900 	void __iomem *drb_reg;
2901 	int rc;
2902 
2903 	/* This is a user write operation */
2904 	debug->op = LPFC_IDIAG_OP_WR;
2905 
2906 	rc = lpfc_idiag_cmd_get(buf, nbytes, &idiag.cmd);
2907 	if (rc < 0)
2908 		return rc;
2909 
2910 	/* Sanity check on command line arguments */
2911 	drb_reg_id = idiag.cmd.data[IDIAG_DRBACC_REGID_INDX];
2912 	value = idiag.cmd.data[IDIAG_DRBACC_VALUE_INDX];
2913 
2914 	if (idiag.cmd.opcode == LPFC_IDIAG_CMD_DRBACC_WR ||
2915 	    idiag.cmd.opcode == LPFC_IDIAG_CMD_DRBACC_ST ||
2916 	    idiag.cmd.opcode == LPFC_IDIAG_CMD_DRBACC_CL) {
2917 		if (rc != LPFC_DRB_ACC_WR_CMD_ARG)
2918 			goto error_out;
2919 		if (drb_reg_id > LPFC_DRB_MAX)
2920 			goto error_out;
2921 	} else if (idiag.cmd.opcode == LPFC_IDIAG_CMD_DRBACC_RD) {
2922 		if (rc != LPFC_DRB_ACC_RD_CMD_ARG)
2923 			goto error_out;
2924 		if ((drb_reg_id > LPFC_DRB_MAX) &&
2925 		    (drb_reg_id != LPFC_DRB_ACC_ALL))
2926 			goto error_out;
2927 	} else
2928 		goto error_out;
2929 
2930 	/* Perform the write access operation */
2931 	if (idiag.cmd.opcode == LPFC_IDIAG_CMD_DRBACC_WR ||
2932 	    idiag.cmd.opcode == LPFC_IDIAG_CMD_DRBACC_ST ||
2933 	    idiag.cmd.opcode == LPFC_IDIAG_CMD_DRBACC_CL) {
2934 		switch (drb_reg_id) {
2935 		case LPFC_DRB_EQCQ:
2936 			drb_reg = phba->sli4_hba.EQCQDBregaddr;
2937 			break;
2938 		case LPFC_DRB_MQ:
2939 			drb_reg = phba->sli4_hba.MQDBregaddr;
2940 			break;
2941 		case LPFC_DRB_WQ:
2942 			drb_reg = phba->sli4_hba.WQDBregaddr;
2943 			break;
2944 		case LPFC_DRB_RQ:
2945 			drb_reg = phba->sli4_hba.RQDBregaddr;
2946 			break;
2947 		default:
2948 			goto error_out;
2949 		}
2950 
2951 		if (idiag.cmd.opcode == LPFC_IDIAG_CMD_DRBACC_WR)
2952 			reg_val = value;
2953 		if (idiag.cmd.opcode == LPFC_IDIAG_CMD_DRBACC_ST) {
2954 			reg_val = readl(drb_reg);
2955 			reg_val |= value;
2956 		}
2957 		if (idiag.cmd.opcode == LPFC_IDIAG_CMD_DRBACC_CL) {
2958 			reg_val = readl(drb_reg);
2959 			reg_val &= ~value;
2960 		}
2961 		writel(reg_val, drb_reg);
2962 		readl(drb_reg); /* flush */
2963 	}
2964 	return nbytes;
2965 
2966 error_out:
2967 	/* Clean out command structure on command error out */
2968 	memset(&idiag, 0, sizeof(idiag));
2969 	return -EINVAL;
2970 }
2971 
2972 /**
2973  * lpfc_idiag_ctlacc_read_reg - idiag debugfs read a control registers
2974  * @phba: The pointer to hba structure.
2975  * @pbuffer: The pointer to the buffer to copy the data to.
2976  * @len: The lenght of bytes to copied.
2977  * @drbregid: The id to doorbell registers.
2978  *
2979  * Description:
2980  * This routine reads a control register and copies its content to the
2981  * user buffer pointed to by @pbuffer.
2982  *
2983  * Returns:
2984  * This function returns the amount of data that was copied into @pbuffer.
2985  **/
2986 static int
2987 lpfc_idiag_ctlacc_read_reg(struct lpfc_hba *phba, char *pbuffer,
2988 			   int len, uint32_t ctlregid)
2989 {
2990 
2991 	if (!pbuffer)
2992 		return 0;
2993 
2994 	switch (ctlregid) {
2995 	case LPFC_CTL_PORT_SEM:
2996 		len += snprintf(pbuffer+len, LPFC_CTL_ACC_BUF_SIZE-len,
2997 				"Port SemReg:   0x%08x\n",
2998 				readl(phba->sli4_hba.conf_regs_memmap_p +
2999 				      LPFC_CTL_PORT_SEM_OFFSET));
3000 		break;
3001 	case LPFC_CTL_PORT_STA:
3002 		len += snprintf(pbuffer+len, LPFC_CTL_ACC_BUF_SIZE-len,
3003 				"Port StaReg:   0x%08x\n",
3004 				readl(phba->sli4_hba.conf_regs_memmap_p +
3005 				      LPFC_CTL_PORT_STA_OFFSET));
3006 		break;
3007 	case LPFC_CTL_PORT_CTL:
3008 		len += snprintf(pbuffer+len, LPFC_CTL_ACC_BUF_SIZE-len,
3009 				"Port CtlReg:   0x%08x\n",
3010 				readl(phba->sli4_hba.conf_regs_memmap_p +
3011 				      LPFC_CTL_PORT_CTL_OFFSET));
3012 		break;
3013 	case LPFC_CTL_PORT_ER1:
3014 		len += snprintf(pbuffer+len, LPFC_CTL_ACC_BUF_SIZE-len,
3015 				"Port Er1Reg:   0x%08x\n",
3016 				readl(phba->sli4_hba.conf_regs_memmap_p +
3017 				      LPFC_CTL_PORT_ER1_OFFSET));
3018 		break;
3019 	case LPFC_CTL_PORT_ER2:
3020 		len += snprintf(pbuffer+len, LPFC_CTL_ACC_BUF_SIZE-len,
3021 				"Port Er2Reg:   0x%08x\n",
3022 				readl(phba->sli4_hba.conf_regs_memmap_p +
3023 				      LPFC_CTL_PORT_ER2_OFFSET));
3024 		break;
3025 	case LPFC_CTL_PDEV_CTL:
3026 		len += snprintf(pbuffer+len, LPFC_CTL_ACC_BUF_SIZE-len,
3027 				"PDev CtlReg:   0x%08x\n",
3028 				readl(phba->sli4_hba.conf_regs_memmap_p +
3029 				      LPFC_CTL_PDEV_CTL_OFFSET));
3030 		break;
3031 	default:
3032 		break;
3033 	}
3034 	return len;
3035 }
3036 
3037 /**
3038  * lpfc_idiag_ctlacc_read - idiag debugfs read port and device control register
3039  * @file: The file pointer to read from.
3040  * @buf: The buffer to copy the data to.
3041  * @nbytes: The number of bytes to read.
3042  * @ppos: The position in the file to start reading from.
3043  *
3044  * Description:
3045  * This routine reads data from the @phba port and device registers according
3046  * to the idiag command, and copies to user @buf.
3047  *
3048  * Returns:
3049  * This function returns the amount of data that was read (this could be less
3050  * than @nbytes if the end of the file was reached) or a negative error value.
3051  **/
3052 static ssize_t
3053 lpfc_idiag_ctlacc_read(struct file *file, char __user *buf, size_t nbytes,
3054 		       loff_t *ppos)
3055 {
3056 	struct lpfc_debug *debug = file->private_data;
3057 	struct lpfc_hba *phba = (struct lpfc_hba *)debug->i_private;
3058 	uint32_t ctl_reg_id, i;
3059 	char *pbuffer;
3060 	int len = 0;
3061 
3062 	/* This is a user read operation */
3063 	debug->op = LPFC_IDIAG_OP_RD;
3064 
3065 	if (!debug->buffer)
3066 		debug->buffer = kmalloc(LPFC_CTL_ACC_BUF_SIZE, GFP_KERNEL);
3067 	if (!debug->buffer)
3068 		return 0;
3069 	pbuffer = debug->buffer;
3070 
3071 	if (*ppos)
3072 		return 0;
3073 
3074 	if (idiag.cmd.opcode == LPFC_IDIAG_CMD_CTLACC_RD)
3075 		ctl_reg_id = idiag.cmd.data[IDIAG_CTLACC_REGID_INDX];
3076 	else
3077 		return 0;
3078 
3079 	if (ctl_reg_id == LPFC_CTL_ACC_ALL)
3080 		for (i = 1; i <= LPFC_CTL_MAX; i++)
3081 			len = lpfc_idiag_ctlacc_read_reg(phba,
3082 							 pbuffer, len, i);
3083 	else
3084 		len = lpfc_idiag_ctlacc_read_reg(phba,
3085 						 pbuffer, len, ctl_reg_id);
3086 
3087 	return simple_read_from_buffer(buf, nbytes, ppos, pbuffer, len);
3088 }
3089 
3090 /**
3091  * lpfc_idiag_ctlacc_write - Syntax check and set up idiag ctlacc commands
3092  * @file: The file pointer to read from.
3093  * @buf: The buffer to copy the user data from.
3094  * @nbytes: The number of bytes to get.
3095  * @ppos: The position in the file to start reading from.
3096  *
3097  * This routine get the debugfs idiag command struct from user space and then
3098  * perform the syntax check for port and device control register read (dump)
3099  * or write (set) command accordingly.
3100  *
3101  * It returns the @nbytges passing in from debugfs user space when successful.
3102  * In case of error conditions, it returns proper error code back to the user
3103  * space.
3104  **/
3105 static ssize_t
3106 lpfc_idiag_ctlacc_write(struct file *file, const char __user *buf,
3107 			size_t nbytes, loff_t *ppos)
3108 {
3109 	struct lpfc_debug *debug = file->private_data;
3110 	struct lpfc_hba *phba = (struct lpfc_hba *)debug->i_private;
3111 	uint32_t ctl_reg_id, value, reg_val = 0;
3112 	void __iomem *ctl_reg;
3113 	int rc;
3114 
3115 	/* This is a user write operation */
3116 	debug->op = LPFC_IDIAG_OP_WR;
3117 
3118 	rc = lpfc_idiag_cmd_get(buf, nbytes, &idiag.cmd);
3119 	if (rc < 0)
3120 		return rc;
3121 
3122 	/* Sanity check on command line arguments */
3123 	ctl_reg_id = idiag.cmd.data[IDIAG_CTLACC_REGID_INDX];
3124 	value = idiag.cmd.data[IDIAG_CTLACC_VALUE_INDX];
3125 
3126 	if (idiag.cmd.opcode == LPFC_IDIAG_CMD_CTLACC_WR ||
3127 	    idiag.cmd.opcode == LPFC_IDIAG_CMD_CTLACC_ST ||
3128 	    idiag.cmd.opcode == LPFC_IDIAG_CMD_CTLACC_CL) {
3129 		if (rc != LPFC_CTL_ACC_WR_CMD_ARG)
3130 			goto error_out;
3131 		if (ctl_reg_id > LPFC_CTL_MAX)
3132 			goto error_out;
3133 	} else if (idiag.cmd.opcode == LPFC_IDIAG_CMD_CTLACC_RD) {
3134 		if (rc != LPFC_CTL_ACC_RD_CMD_ARG)
3135 			goto error_out;
3136 		if ((ctl_reg_id > LPFC_CTL_MAX) &&
3137 		    (ctl_reg_id != LPFC_CTL_ACC_ALL))
3138 			goto error_out;
3139 	} else
3140 		goto error_out;
3141 
3142 	/* Perform the write access operation */
3143 	if (idiag.cmd.opcode == LPFC_IDIAG_CMD_CTLACC_WR ||
3144 	    idiag.cmd.opcode == LPFC_IDIAG_CMD_CTLACC_ST ||
3145 	    idiag.cmd.opcode == LPFC_IDIAG_CMD_CTLACC_CL) {
3146 		switch (ctl_reg_id) {
3147 		case LPFC_CTL_PORT_SEM:
3148 			ctl_reg = phba->sli4_hba.conf_regs_memmap_p +
3149 					LPFC_CTL_PORT_SEM_OFFSET;
3150 			break;
3151 		case LPFC_CTL_PORT_STA:
3152 			ctl_reg = phba->sli4_hba.conf_regs_memmap_p +
3153 					LPFC_CTL_PORT_STA_OFFSET;
3154 			break;
3155 		case LPFC_CTL_PORT_CTL:
3156 			ctl_reg = phba->sli4_hba.conf_regs_memmap_p +
3157 					LPFC_CTL_PORT_CTL_OFFSET;
3158 			break;
3159 		case LPFC_CTL_PORT_ER1:
3160 			ctl_reg = phba->sli4_hba.conf_regs_memmap_p +
3161 					LPFC_CTL_PORT_ER1_OFFSET;
3162 			break;
3163 		case LPFC_CTL_PORT_ER2:
3164 			ctl_reg = phba->sli4_hba.conf_regs_memmap_p +
3165 					LPFC_CTL_PORT_ER2_OFFSET;
3166 			break;
3167 		case LPFC_CTL_PDEV_CTL:
3168 			ctl_reg = phba->sli4_hba.conf_regs_memmap_p +
3169 					LPFC_CTL_PDEV_CTL_OFFSET;
3170 			break;
3171 		default:
3172 			goto error_out;
3173 		}
3174 
3175 		if (idiag.cmd.opcode == LPFC_IDIAG_CMD_CTLACC_WR)
3176 			reg_val = value;
3177 		if (idiag.cmd.opcode == LPFC_IDIAG_CMD_CTLACC_ST) {
3178 			reg_val = readl(ctl_reg);
3179 			reg_val |= value;
3180 		}
3181 		if (idiag.cmd.opcode == LPFC_IDIAG_CMD_CTLACC_CL) {
3182 			reg_val = readl(ctl_reg);
3183 			reg_val &= ~value;
3184 		}
3185 		writel(reg_val, ctl_reg);
3186 		readl(ctl_reg); /* flush */
3187 	}
3188 	return nbytes;
3189 
3190 error_out:
3191 	/* Clean out command structure on command error out */
3192 	memset(&idiag, 0, sizeof(idiag));
3193 	return -EINVAL;
3194 }
3195 
3196 /**
3197  * lpfc_idiag_mbxacc_get_setup - idiag debugfs get mailbox access setup
3198  * @phba: Pointer to HBA context object.
3199  * @pbuffer: Pointer to data buffer.
3200  *
3201  * Description:
3202  * This routine gets the driver mailbox access debugfs setup information.
3203  *
3204  * Returns:
3205  * This function returns the amount of data that was read (this could be less
3206  * than @nbytes if the end of the file was reached) or a negative error value.
3207  **/
3208 static int
3209 lpfc_idiag_mbxacc_get_setup(struct lpfc_hba *phba, char *pbuffer)
3210 {
3211 	uint32_t mbx_dump_map, mbx_dump_cnt, mbx_word_cnt, mbx_mbox_cmd;
3212 	int len = 0;
3213 
3214 	mbx_mbox_cmd = idiag.cmd.data[IDIAG_MBXACC_MBCMD_INDX];
3215 	mbx_dump_map = idiag.cmd.data[IDIAG_MBXACC_DPMAP_INDX];
3216 	mbx_dump_cnt = idiag.cmd.data[IDIAG_MBXACC_DPCNT_INDX];
3217 	mbx_word_cnt = idiag.cmd.data[IDIAG_MBXACC_WDCNT_INDX];
3218 
3219 	len += snprintf(pbuffer+len, LPFC_MBX_ACC_BUF_SIZE-len,
3220 			"mbx_dump_map: 0x%08x\n", mbx_dump_map);
3221 	len += snprintf(pbuffer+len, LPFC_MBX_ACC_BUF_SIZE-len,
3222 			"mbx_dump_cnt: %04d\n", mbx_dump_cnt);
3223 	len += snprintf(pbuffer+len, LPFC_MBX_ACC_BUF_SIZE-len,
3224 			"mbx_word_cnt: %04d\n", mbx_word_cnt);
3225 	len += snprintf(pbuffer+len, LPFC_MBX_ACC_BUF_SIZE-len,
3226 			"mbx_mbox_cmd: 0x%02x\n", mbx_mbox_cmd);
3227 
3228 	return len;
3229 }
3230 
3231 /**
3232  * lpfc_idiag_mbxacc_read - idiag debugfs read on mailbox access
3233  * @file: The file pointer to read from.
3234  * @buf: The buffer to copy the data to.
3235  * @nbytes: The number of bytes to read.
3236  * @ppos: The position in the file to start reading from.
3237  *
3238  * Description:
3239  * This routine reads data from the @phba driver mailbox access debugfs setup
3240  * information.
3241  *
3242  * Returns:
3243  * This function returns the amount of data that was read (this could be less
3244  * than @nbytes if the end of the file was reached) or a negative error value.
3245  **/
3246 static ssize_t
3247 lpfc_idiag_mbxacc_read(struct file *file, char __user *buf, size_t nbytes,
3248 		       loff_t *ppos)
3249 {
3250 	struct lpfc_debug *debug = file->private_data;
3251 	struct lpfc_hba *phba = (struct lpfc_hba *)debug->i_private;
3252 	char *pbuffer;
3253 	int len = 0;
3254 
3255 	/* This is a user read operation */
3256 	debug->op = LPFC_IDIAG_OP_RD;
3257 
3258 	if (!debug->buffer)
3259 		debug->buffer = kmalloc(LPFC_MBX_ACC_BUF_SIZE, GFP_KERNEL);
3260 	if (!debug->buffer)
3261 		return 0;
3262 	pbuffer = debug->buffer;
3263 
3264 	if (*ppos)
3265 		return 0;
3266 
3267 	if ((idiag.cmd.opcode != LPFC_IDIAG_CMD_MBXACC_DP) &&
3268 	    (idiag.cmd.opcode != LPFC_IDIAG_BSG_MBXACC_DP))
3269 		return 0;
3270 
3271 	len = lpfc_idiag_mbxacc_get_setup(phba, pbuffer);
3272 
3273 	return simple_read_from_buffer(buf, nbytes, ppos, pbuffer, len);
3274 }
3275 
3276 /**
3277  * lpfc_idiag_mbxacc_write - Syntax check and set up idiag mbxacc commands
3278  * @file: The file pointer to read from.
3279  * @buf: The buffer to copy the user data from.
3280  * @nbytes: The number of bytes to get.
3281  * @ppos: The position in the file to start reading from.
3282  *
3283  * This routine get the debugfs idiag command struct from user space and then
3284  * perform the syntax check for driver mailbox command (dump) and sets up the
3285  * necessary states in the idiag command struct accordingly.
3286  *
3287  * It returns the @nbytges passing in from debugfs user space when successful.
3288  * In case of error conditions, it returns proper error code back to the user
3289  * space.
3290  **/
3291 static ssize_t
3292 lpfc_idiag_mbxacc_write(struct file *file, const char __user *buf,
3293 			size_t nbytes, loff_t *ppos)
3294 {
3295 	struct lpfc_debug *debug = file->private_data;
3296 	uint32_t mbx_dump_map, mbx_dump_cnt, mbx_word_cnt, mbx_mbox_cmd;
3297 	int rc;
3298 
3299 	/* This is a user write operation */
3300 	debug->op = LPFC_IDIAG_OP_WR;
3301 
3302 	rc = lpfc_idiag_cmd_get(buf, nbytes, &idiag.cmd);
3303 	if (rc < 0)
3304 		return rc;
3305 
3306 	/* Sanity check on command line arguments */
3307 	mbx_mbox_cmd = idiag.cmd.data[IDIAG_MBXACC_MBCMD_INDX];
3308 	mbx_dump_map = idiag.cmd.data[IDIAG_MBXACC_DPMAP_INDX];
3309 	mbx_dump_cnt = idiag.cmd.data[IDIAG_MBXACC_DPCNT_INDX];
3310 	mbx_word_cnt = idiag.cmd.data[IDIAG_MBXACC_WDCNT_INDX];
3311 
3312 	if (idiag.cmd.opcode == LPFC_IDIAG_CMD_MBXACC_DP) {
3313 		if (!(mbx_dump_map & LPFC_MBX_DMP_MBX_ALL))
3314 			goto error_out;
3315 		if ((mbx_dump_map & ~LPFC_MBX_DMP_MBX_ALL) &&
3316 		    (mbx_dump_map != LPFC_MBX_DMP_ALL))
3317 			goto error_out;
3318 		if (mbx_word_cnt > sizeof(MAILBOX_t))
3319 			goto error_out;
3320 	} else if (idiag.cmd.opcode == LPFC_IDIAG_BSG_MBXACC_DP) {
3321 		if (!(mbx_dump_map & LPFC_BSG_DMP_MBX_ALL))
3322 			goto error_out;
3323 		if ((mbx_dump_map & ~LPFC_BSG_DMP_MBX_ALL) &&
3324 		    (mbx_dump_map != LPFC_MBX_DMP_ALL))
3325 			goto error_out;
3326 		if (mbx_word_cnt > (BSG_MBOX_SIZE)/4)
3327 			goto error_out;
3328 		if (mbx_mbox_cmd != 0x9b)
3329 			goto error_out;
3330 	} else
3331 		goto error_out;
3332 
3333 	if (mbx_word_cnt == 0)
3334 		goto error_out;
3335 	if (rc != LPFC_MBX_DMP_ARG)
3336 		goto error_out;
3337 	if (mbx_mbox_cmd & ~0xff)
3338 		goto error_out;
3339 
3340 	/* condition for stop mailbox dump */
3341 	if (mbx_dump_cnt == 0)
3342 		goto reset_out;
3343 
3344 	return nbytes;
3345 
3346 reset_out:
3347 	/* Clean out command structure on command error out */
3348 	memset(&idiag, 0, sizeof(idiag));
3349 	return nbytes;
3350 
3351 error_out:
3352 	/* Clean out command structure on command error out */
3353 	memset(&idiag, 0, sizeof(idiag));
3354 	return -EINVAL;
3355 }
3356 
3357 /**
3358  * lpfc_idiag_extacc_avail_get - get the available extents information
3359  * @phba: pointer to lpfc hba data structure.
3360  * @pbuffer: pointer to internal buffer.
3361  * @len: length into the internal buffer data has been copied.
3362  *
3363  * Description:
3364  * This routine is to get the available extent information.
3365  *
3366  * Returns:
3367  * overall lenth of the data read into the internal buffer.
3368  **/
3369 static int
3370 lpfc_idiag_extacc_avail_get(struct lpfc_hba *phba, char *pbuffer, int len)
3371 {
3372 	uint16_t ext_cnt, ext_size;
3373 
3374 	len += snprintf(pbuffer+len, LPFC_EXT_ACC_BUF_SIZE-len,
3375 			"\nAvailable Extents Information:\n");
3376 
3377 	len += snprintf(pbuffer+len, LPFC_EXT_ACC_BUF_SIZE-len,
3378 			"\tPort Available VPI extents: ");
3379 	lpfc_sli4_get_avail_extnt_rsrc(phba, LPFC_RSC_TYPE_FCOE_VPI,
3380 				       &ext_cnt, &ext_size);
3381 	len += snprintf(pbuffer+len, LPFC_EXT_ACC_BUF_SIZE-len,
3382 			"Count %3d, Size %3d\n", ext_cnt, ext_size);
3383 
3384 	len += snprintf(pbuffer+len, LPFC_EXT_ACC_BUF_SIZE-len,
3385 			"\tPort Available VFI extents: ");
3386 	lpfc_sli4_get_avail_extnt_rsrc(phba, LPFC_RSC_TYPE_FCOE_VFI,
3387 				       &ext_cnt, &ext_size);
3388 	len += snprintf(pbuffer+len, LPFC_EXT_ACC_BUF_SIZE-len,
3389 			"Count %3d, Size %3d\n", ext_cnt, ext_size);
3390 
3391 	len += snprintf(pbuffer+len, LPFC_EXT_ACC_BUF_SIZE-len,
3392 			"\tPort Available RPI extents: ");
3393 	lpfc_sli4_get_avail_extnt_rsrc(phba, LPFC_RSC_TYPE_FCOE_RPI,
3394 				       &ext_cnt, &ext_size);
3395 	len += snprintf(pbuffer+len, LPFC_EXT_ACC_BUF_SIZE-len,
3396 			"Count %3d, Size %3d\n", ext_cnt, ext_size);
3397 
3398 	len += snprintf(pbuffer+len, LPFC_EXT_ACC_BUF_SIZE-len,
3399 			"\tPort Available XRI extents: ");
3400 	lpfc_sli4_get_avail_extnt_rsrc(phba, LPFC_RSC_TYPE_FCOE_XRI,
3401 				       &ext_cnt, &ext_size);
3402 	len += snprintf(pbuffer+len, LPFC_EXT_ACC_BUF_SIZE-len,
3403 			"Count %3d, Size %3d\n", ext_cnt, ext_size);
3404 
3405 	return len;
3406 }
3407 
3408 /**
3409  * lpfc_idiag_extacc_alloc_get - get the allocated extents information
3410  * @phba: pointer to lpfc hba data structure.
3411  * @pbuffer: pointer to internal buffer.
3412  * @len: length into the internal buffer data has been copied.
3413  *
3414  * Description:
3415  * This routine is to get the allocated extent information.
3416  *
3417  * Returns:
3418  * overall lenth of the data read into the internal buffer.
3419  **/
3420 static int
3421 lpfc_idiag_extacc_alloc_get(struct lpfc_hba *phba, char *pbuffer, int len)
3422 {
3423 	uint16_t ext_cnt, ext_size;
3424 	int rc;
3425 
3426 	len += snprintf(pbuffer+len, LPFC_EXT_ACC_BUF_SIZE-len,
3427 			"\nAllocated Extents Information:\n");
3428 
3429 	len += snprintf(pbuffer+len, LPFC_EXT_ACC_BUF_SIZE-len,
3430 			"\tHost Allocated VPI extents: ");
3431 	rc = lpfc_sli4_get_allocated_extnts(phba, LPFC_RSC_TYPE_FCOE_VPI,
3432 					    &ext_cnt, &ext_size);
3433 	if (!rc)
3434 		len += snprintf(pbuffer+len, LPFC_EXT_ACC_BUF_SIZE-len,
3435 				"Port %d Extent %3d, Size %3d\n",
3436 				phba->brd_no, ext_cnt, ext_size);
3437 	else
3438 		len += snprintf(pbuffer+len, LPFC_EXT_ACC_BUF_SIZE-len,
3439 				"N/A\n");
3440 
3441 	len += snprintf(pbuffer+len, LPFC_EXT_ACC_BUF_SIZE-len,
3442 			"\tHost Allocated VFI extents: ");
3443 	rc = lpfc_sli4_get_allocated_extnts(phba, LPFC_RSC_TYPE_FCOE_VFI,
3444 					    &ext_cnt, &ext_size);
3445 	if (!rc)
3446 		len += snprintf(pbuffer+len, LPFC_EXT_ACC_BUF_SIZE-len,
3447 				"Port %d Extent %3d, Size %3d\n",
3448 				phba->brd_no, ext_cnt, ext_size);
3449 	else
3450 		len += snprintf(pbuffer+len, LPFC_EXT_ACC_BUF_SIZE-len,
3451 				"N/A\n");
3452 
3453 	len += snprintf(pbuffer+len, LPFC_EXT_ACC_BUF_SIZE-len,
3454 			"\tHost Allocated RPI extents: ");
3455 	rc = lpfc_sli4_get_allocated_extnts(phba, LPFC_RSC_TYPE_FCOE_RPI,
3456 					    &ext_cnt, &ext_size);
3457 	if (!rc)
3458 		len += snprintf(pbuffer+len, LPFC_EXT_ACC_BUF_SIZE-len,
3459 				"Port %d Extent %3d, Size %3d\n",
3460 				phba->brd_no, ext_cnt, ext_size);
3461 	else
3462 		len += snprintf(pbuffer+len, LPFC_EXT_ACC_BUF_SIZE-len,
3463 				"N/A\n");
3464 
3465 	len += snprintf(pbuffer+len, LPFC_EXT_ACC_BUF_SIZE-len,
3466 			"\tHost Allocated XRI extents: ");
3467 	rc = lpfc_sli4_get_allocated_extnts(phba, LPFC_RSC_TYPE_FCOE_XRI,
3468 					    &ext_cnt, &ext_size);
3469 	if (!rc)
3470 		len += snprintf(pbuffer+len, LPFC_EXT_ACC_BUF_SIZE-len,
3471 				"Port %d Extent %3d, Size %3d\n",
3472 				phba->brd_no, ext_cnt, ext_size);
3473 	else
3474 		len += snprintf(pbuffer+len, LPFC_EXT_ACC_BUF_SIZE-len,
3475 				"N/A\n");
3476 
3477 	return len;
3478 }
3479 
3480 /**
3481  * lpfc_idiag_extacc_drivr_get - get driver extent information
3482  * @phba: pointer to lpfc hba data structure.
3483  * @pbuffer: pointer to internal buffer.
3484  * @len: length into the internal buffer data has been copied.
3485  *
3486  * Description:
3487  * This routine is to get the driver extent information.
3488  *
3489  * Returns:
3490  * overall lenth of the data read into the internal buffer.
3491  **/
3492 static int
3493 lpfc_idiag_extacc_drivr_get(struct lpfc_hba *phba, char *pbuffer, int len)
3494 {
3495 	struct lpfc_rsrc_blks *rsrc_blks;
3496 	int index;
3497 
3498 	len += snprintf(pbuffer+len, LPFC_EXT_ACC_BUF_SIZE-len,
3499 			"\nDriver Extents Information:\n");
3500 
3501 	len += snprintf(pbuffer+len, LPFC_EXT_ACC_BUF_SIZE-len,
3502 			"\tVPI extents:\n");
3503 	index = 0;
3504 	list_for_each_entry(rsrc_blks, &phba->lpfc_vpi_blk_list, list) {
3505 		len += snprintf(pbuffer+len, LPFC_EXT_ACC_BUF_SIZE-len,
3506 				"\t\tBlock %3d: Start %4d, Count %4d\n",
3507 				index, rsrc_blks->rsrc_start,
3508 				rsrc_blks->rsrc_size);
3509 		index++;
3510 	}
3511 	len += snprintf(pbuffer+len, LPFC_EXT_ACC_BUF_SIZE-len,
3512 			"\tVFI extents:\n");
3513 	index = 0;
3514 	list_for_each_entry(rsrc_blks, &phba->sli4_hba.lpfc_vfi_blk_list,
3515 			    list) {
3516 		len += snprintf(pbuffer+len, LPFC_EXT_ACC_BUF_SIZE-len,
3517 				"\t\tBlock %3d: Start %4d, Count %4d\n",
3518 				index, rsrc_blks->rsrc_start,
3519 				rsrc_blks->rsrc_size);
3520 		index++;
3521 	}
3522 
3523 	len += snprintf(pbuffer+len, LPFC_EXT_ACC_BUF_SIZE-len,
3524 			"\tRPI extents:\n");
3525 	index = 0;
3526 	list_for_each_entry(rsrc_blks, &phba->sli4_hba.lpfc_rpi_blk_list,
3527 			    list) {
3528 		len += snprintf(pbuffer+len, LPFC_EXT_ACC_BUF_SIZE-len,
3529 				"\t\tBlock %3d: Start %4d, Count %4d\n",
3530 				index, rsrc_blks->rsrc_start,
3531 				rsrc_blks->rsrc_size);
3532 		index++;
3533 	}
3534 
3535 	len += snprintf(pbuffer+len, LPFC_EXT_ACC_BUF_SIZE-len,
3536 			"\tXRI extents:\n");
3537 	index = 0;
3538 	list_for_each_entry(rsrc_blks, &phba->sli4_hba.lpfc_xri_blk_list,
3539 			    list) {
3540 		len += snprintf(pbuffer+len, LPFC_EXT_ACC_BUF_SIZE-len,
3541 				"\t\tBlock %3d: Start %4d, Count %4d\n",
3542 				index, rsrc_blks->rsrc_start,
3543 				rsrc_blks->rsrc_size);
3544 		index++;
3545 	}
3546 
3547 	return len;
3548 }
3549 
3550 /**
3551  * lpfc_idiag_extacc_write - Syntax check and set up idiag extacc commands
3552  * @file: The file pointer to read from.
3553  * @buf: The buffer to copy the user data from.
3554  * @nbytes: The number of bytes to get.
3555  * @ppos: The position in the file to start reading from.
3556  *
3557  * This routine get the debugfs idiag command struct from user space and then
3558  * perform the syntax check for extent information access commands and sets
3559  * up the necessary states in the idiag command struct accordingly.
3560  *
3561  * It returns the @nbytges passing in from debugfs user space when successful.
3562  * In case of error conditions, it returns proper error code back to the user
3563  * space.
3564  **/
3565 static ssize_t
3566 lpfc_idiag_extacc_write(struct file *file, const char __user *buf,
3567 			size_t nbytes, loff_t *ppos)
3568 {
3569 	struct lpfc_debug *debug = file->private_data;
3570 	uint32_t ext_map;
3571 	int rc;
3572 
3573 	/* This is a user write operation */
3574 	debug->op = LPFC_IDIAG_OP_WR;
3575 
3576 	rc = lpfc_idiag_cmd_get(buf, nbytes, &idiag.cmd);
3577 	if (rc < 0)
3578 		return rc;
3579 
3580 	ext_map = idiag.cmd.data[IDIAG_EXTACC_EXMAP_INDX];
3581 
3582 	if (idiag.cmd.opcode != LPFC_IDIAG_CMD_EXTACC_RD)
3583 		goto error_out;
3584 	if (rc != LPFC_EXT_ACC_CMD_ARG)
3585 		goto error_out;
3586 	if (!(ext_map & LPFC_EXT_ACC_ALL))
3587 		goto error_out;
3588 
3589 	return nbytes;
3590 error_out:
3591 	/* Clean out command structure on command error out */
3592 	memset(&idiag, 0, sizeof(idiag));
3593 	return -EINVAL;
3594 }
3595 
3596 /**
3597  * lpfc_idiag_extacc_read - idiag debugfs read access to extent information
3598  * @file: The file pointer to read from.
3599  * @buf: The buffer to copy the data to.
3600  * @nbytes: The number of bytes to read.
3601  * @ppos: The position in the file to start reading from.
3602  *
3603  * Description:
3604  * This routine reads data from the proper extent information according to
3605  * the idiag command, and copies to user @buf.
3606  *
3607  * Returns:
3608  * This function returns the amount of data that was read (this could be less
3609  * than @nbytes if the end of the file was reached) or a negative error value.
3610  **/
3611 static ssize_t
3612 lpfc_idiag_extacc_read(struct file *file, char __user *buf, size_t nbytes,
3613 		       loff_t *ppos)
3614 {
3615 	struct lpfc_debug *debug = file->private_data;
3616 	struct lpfc_hba *phba = (struct lpfc_hba *)debug->i_private;
3617 	char *pbuffer;
3618 	uint32_t ext_map;
3619 	int len = 0;
3620 
3621 	/* This is a user read operation */
3622 	debug->op = LPFC_IDIAG_OP_RD;
3623 
3624 	if (!debug->buffer)
3625 		debug->buffer = kmalloc(LPFC_EXT_ACC_BUF_SIZE, GFP_KERNEL);
3626 	if (!debug->buffer)
3627 		return 0;
3628 	pbuffer = debug->buffer;
3629 	if (*ppos)
3630 		return 0;
3631 	if (idiag.cmd.opcode != LPFC_IDIAG_CMD_EXTACC_RD)
3632 		return 0;
3633 
3634 	ext_map = idiag.cmd.data[IDIAG_EXTACC_EXMAP_INDX];
3635 	if (ext_map & LPFC_EXT_ACC_AVAIL)
3636 		len = lpfc_idiag_extacc_avail_get(phba, pbuffer, len);
3637 	if (ext_map & LPFC_EXT_ACC_ALLOC)
3638 		len = lpfc_idiag_extacc_alloc_get(phba, pbuffer, len);
3639 	if (ext_map & LPFC_EXT_ACC_DRIVR)
3640 		len = lpfc_idiag_extacc_drivr_get(phba, pbuffer, len);
3641 
3642 	return simple_read_from_buffer(buf, nbytes, ppos, pbuffer, len);
3643 }
3644 
3645 #undef lpfc_debugfs_op_disc_trc
3646 static const struct file_operations lpfc_debugfs_op_disc_trc = {
3647 	.owner =        THIS_MODULE,
3648 	.open =         lpfc_debugfs_disc_trc_open,
3649 	.llseek =       lpfc_debugfs_lseek,
3650 	.read =         lpfc_debugfs_read,
3651 	.release =      lpfc_debugfs_release,
3652 };
3653 
3654 #undef lpfc_debugfs_op_nodelist
3655 static const struct file_operations lpfc_debugfs_op_nodelist = {
3656 	.owner =        THIS_MODULE,
3657 	.open =         lpfc_debugfs_nodelist_open,
3658 	.llseek =       lpfc_debugfs_lseek,
3659 	.read =         lpfc_debugfs_read,
3660 	.release =      lpfc_debugfs_release,
3661 };
3662 
3663 #undef lpfc_debugfs_op_hbqinfo
3664 static const struct file_operations lpfc_debugfs_op_hbqinfo = {
3665 	.owner =        THIS_MODULE,
3666 	.open =         lpfc_debugfs_hbqinfo_open,
3667 	.llseek =       lpfc_debugfs_lseek,
3668 	.read =         lpfc_debugfs_read,
3669 	.release =      lpfc_debugfs_release,
3670 };
3671 
3672 #undef lpfc_debugfs_op_dumpHBASlim
3673 static const struct file_operations lpfc_debugfs_op_dumpHBASlim = {
3674 	.owner =        THIS_MODULE,
3675 	.open =         lpfc_debugfs_dumpHBASlim_open,
3676 	.llseek =       lpfc_debugfs_lseek,
3677 	.read =         lpfc_debugfs_read,
3678 	.release =      lpfc_debugfs_release,
3679 };
3680 
3681 #undef lpfc_debugfs_op_dumpHostSlim
3682 static const struct file_operations lpfc_debugfs_op_dumpHostSlim = {
3683 	.owner =        THIS_MODULE,
3684 	.open =         lpfc_debugfs_dumpHostSlim_open,
3685 	.llseek =       lpfc_debugfs_lseek,
3686 	.read =         lpfc_debugfs_read,
3687 	.release =      lpfc_debugfs_release,
3688 };
3689 
3690 #undef lpfc_debugfs_op_dumpData
3691 static const struct file_operations lpfc_debugfs_op_dumpData = {
3692 	.owner =        THIS_MODULE,
3693 	.open =         lpfc_debugfs_dumpData_open,
3694 	.llseek =       lpfc_debugfs_lseek,
3695 	.read =         lpfc_debugfs_read,
3696 	.write =	lpfc_debugfs_dumpDataDif_write,
3697 	.release =      lpfc_debugfs_dumpDataDif_release,
3698 };
3699 
3700 #undef lpfc_debugfs_op_dumpDif
3701 static const struct file_operations lpfc_debugfs_op_dumpDif = {
3702 	.owner =        THIS_MODULE,
3703 	.open =         lpfc_debugfs_dumpDif_open,
3704 	.llseek =       lpfc_debugfs_lseek,
3705 	.read =         lpfc_debugfs_read,
3706 	.write =	lpfc_debugfs_dumpDataDif_write,
3707 	.release =      lpfc_debugfs_dumpDataDif_release,
3708 };
3709 
3710 #undef lpfc_debugfs_op_dif_err
3711 static const struct file_operations lpfc_debugfs_op_dif_err = {
3712 	.owner =	THIS_MODULE,
3713 	.open =		simple_open,
3714 	.llseek =	lpfc_debugfs_lseek,
3715 	.read =		lpfc_debugfs_dif_err_read,
3716 	.write =	lpfc_debugfs_dif_err_write,
3717 	.release =	lpfc_debugfs_dif_err_release,
3718 };
3719 
3720 #undef lpfc_debugfs_op_slow_ring_trc
3721 static const struct file_operations lpfc_debugfs_op_slow_ring_trc = {
3722 	.owner =        THIS_MODULE,
3723 	.open =         lpfc_debugfs_slow_ring_trc_open,
3724 	.llseek =       lpfc_debugfs_lseek,
3725 	.read =         lpfc_debugfs_read,
3726 	.release =      lpfc_debugfs_release,
3727 };
3728 
3729 static struct dentry *lpfc_debugfs_root = NULL;
3730 static atomic_t lpfc_debugfs_hba_count;
3731 
3732 /*
3733  * File operations for the iDiag debugfs
3734  */
3735 #undef lpfc_idiag_op_pciCfg
3736 static const struct file_operations lpfc_idiag_op_pciCfg = {
3737 	.owner =        THIS_MODULE,
3738 	.open =         lpfc_idiag_open,
3739 	.llseek =       lpfc_debugfs_lseek,
3740 	.read =         lpfc_idiag_pcicfg_read,
3741 	.write =        lpfc_idiag_pcicfg_write,
3742 	.release =      lpfc_idiag_cmd_release,
3743 };
3744 
3745 #undef lpfc_idiag_op_barAcc
3746 static const struct file_operations lpfc_idiag_op_barAcc = {
3747 	.owner =        THIS_MODULE,
3748 	.open =         lpfc_idiag_open,
3749 	.llseek =       lpfc_debugfs_lseek,
3750 	.read =         lpfc_idiag_baracc_read,
3751 	.write =        lpfc_idiag_baracc_write,
3752 	.release =      lpfc_idiag_cmd_release,
3753 };
3754 
3755 #undef lpfc_idiag_op_queInfo
3756 static const struct file_operations lpfc_idiag_op_queInfo = {
3757 	.owner =        THIS_MODULE,
3758 	.open =         lpfc_idiag_open,
3759 	.read =         lpfc_idiag_queinfo_read,
3760 	.release =      lpfc_idiag_release,
3761 };
3762 
3763 #undef lpfc_idiag_op_queAcc
3764 static const struct file_operations lpfc_idiag_op_queAcc = {
3765 	.owner =        THIS_MODULE,
3766 	.open =         lpfc_idiag_open,
3767 	.llseek =       lpfc_debugfs_lseek,
3768 	.read =         lpfc_idiag_queacc_read,
3769 	.write =        lpfc_idiag_queacc_write,
3770 	.release =      lpfc_idiag_cmd_release,
3771 };
3772 
3773 #undef lpfc_idiag_op_drbAcc
3774 static const struct file_operations lpfc_idiag_op_drbAcc = {
3775 	.owner =        THIS_MODULE,
3776 	.open =         lpfc_idiag_open,
3777 	.llseek =       lpfc_debugfs_lseek,
3778 	.read =         lpfc_idiag_drbacc_read,
3779 	.write =        lpfc_idiag_drbacc_write,
3780 	.release =      lpfc_idiag_cmd_release,
3781 };
3782 
3783 #undef lpfc_idiag_op_ctlAcc
3784 static const struct file_operations lpfc_idiag_op_ctlAcc = {
3785 	.owner =        THIS_MODULE,
3786 	.open =         lpfc_idiag_open,
3787 	.llseek =       lpfc_debugfs_lseek,
3788 	.read =         lpfc_idiag_ctlacc_read,
3789 	.write =        lpfc_idiag_ctlacc_write,
3790 	.release =      lpfc_idiag_cmd_release,
3791 };
3792 
3793 #undef lpfc_idiag_op_mbxAcc
3794 static const struct file_operations lpfc_idiag_op_mbxAcc = {
3795 	.owner =        THIS_MODULE,
3796 	.open =         lpfc_idiag_open,
3797 	.llseek =       lpfc_debugfs_lseek,
3798 	.read =         lpfc_idiag_mbxacc_read,
3799 	.write =        lpfc_idiag_mbxacc_write,
3800 	.release =      lpfc_idiag_cmd_release,
3801 };
3802 
3803 #undef lpfc_idiag_op_extAcc
3804 static const struct file_operations lpfc_idiag_op_extAcc = {
3805 	.owner =        THIS_MODULE,
3806 	.open =         lpfc_idiag_open,
3807 	.llseek =       lpfc_debugfs_lseek,
3808 	.read =         lpfc_idiag_extacc_read,
3809 	.write =        lpfc_idiag_extacc_write,
3810 	.release =      lpfc_idiag_cmd_release,
3811 };
3812 
3813 #endif
3814 
3815 /* lpfc_idiag_mbxacc_dump_bsg_mbox - idiag debugfs dump bsg mailbox command
3816  * @phba: Pointer to HBA context object.
3817  * @dmabuf: Pointer to a DMA buffer descriptor.
3818  *
3819  * Description:
3820  * This routine dump a bsg pass-through non-embedded mailbox command with
3821  * external buffer.
3822  **/
3823 void
3824 lpfc_idiag_mbxacc_dump_bsg_mbox(struct lpfc_hba *phba, enum nemb_type nemb_tp,
3825 				enum mbox_type mbox_tp, enum dma_type dma_tp,
3826 				enum sta_type sta_tp,
3827 				struct lpfc_dmabuf *dmabuf, uint32_t ext_buf)
3828 {
3829 #ifdef CONFIG_SCSI_LPFC_DEBUG_FS
3830 	uint32_t *mbx_mbox_cmd, *mbx_dump_map, *mbx_dump_cnt, *mbx_word_cnt;
3831 	char line_buf[LPFC_MBX_ACC_LBUF_SZ];
3832 	int len = 0;
3833 	uint32_t do_dump = 0;
3834 	uint32_t *pword;
3835 	uint32_t i;
3836 
3837 	if (idiag.cmd.opcode != LPFC_IDIAG_BSG_MBXACC_DP)
3838 		return;
3839 
3840 	mbx_mbox_cmd = &idiag.cmd.data[IDIAG_MBXACC_MBCMD_INDX];
3841 	mbx_dump_map = &idiag.cmd.data[IDIAG_MBXACC_DPMAP_INDX];
3842 	mbx_dump_cnt = &idiag.cmd.data[IDIAG_MBXACC_DPCNT_INDX];
3843 	mbx_word_cnt = &idiag.cmd.data[IDIAG_MBXACC_WDCNT_INDX];
3844 
3845 	if (!(*mbx_dump_map & LPFC_MBX_DMP_ALL) ||
3846 	    (*mbx_dump_cnt == 0) ||
3847 	    (*mbx_word_cnt == 0))
3848 		return;
3849 
3850 	if (*mbx_mbox_cmd != 0x9B)
3851 		return;
3852 
3853 	if ((mbox_tp == mbox_rd) && (dma_tp == dma_mbox)) {
3854 		if (*mbx_dump_map & LPFC_BSG_DMP_MBX_RD_MBX) {
3855 			do_dump |= LPFC_BSG_DMP_MBX_RD_MBX;
3856 			printk(KERN_ERR "\nRead mbox command (x%x), "
3857 			       "nemb:0x%x, extbuf_cnt:%d:\n",
3858 			       sta_tp, nemb_tp, ext_buf);
3859 		}
3860 	}
3861 	if ((mbox_tp == mbox_rd) && (dma_tp == dma_ebuf)) {
3862 		if (*mbx_dump_map & LPFC_BSG_DMP_MBX_RD_BUF) {
3863 			do_dump |= LPFC_BSG_DMP_MBX_RD_BUF;
3864 			printk(KERN_ERR "\nRead mbox buffer (x%x), "
3865 			       "nemb:0x%x, extbuf_seq:%d:\n",
3866 			       sta_tp, nemb_tp, ext_buf);
3867 		}
3868 	}
3869 	if ((mbox_tp == mbox_wr) && (dma_tp == dma_mbox)) {
3870 		if (*mbx_dump_map & LPFC_BSG_DMP_MBX_WR_MBX) {
3871 			do_dump |= LPFC_BSG_DMP_MBX_WR_MBX;
3872 			printk(KERN_ERR "\nWrite mbox command (x%x), "
3873 			       "nemb:0x%x, extbuf_cnt:%d:\n",
3874 			       sta_tp, nemb_tp, ext_buf);
3875 		}
3876 	}
3877 	if ((mbox_tp == mbox_wr) && (dma_tp == dma_ebuf)) {
3878 		if (*mbx_dump_map & LPFC_BSG_DMP_MBX_WR_BUF) {
3879 			do_dump |= LPFC_BSG_DMP_MBX_WR_BUF;
3880 			printk(KERN_ERR "\nWrite mbox buffer (x%x), "
3881 			       "nemb:0x%x, extbuf_seq:%d:\n",
3882 			       sta_tp, nemb_tp, ext_buf);
3883 		}
3884 	}
3885 
3886 	/* dump buffer content */
3887 	if (do_dump) {
3888 		pword = (uint32_t *)dmabuf->virt;
3889 		for (i = 0; i < *mbx_word_cnt; i++) {
3890 			if (!(i % 8)) {
3891 				if (i != 0)
3892 					printk(KERN_ERR "%s\n", line_buf);
3893 				len = 0;
3894 				len += snprintf(line_buf+len,
3895 						LPFC_MBX_ACC_LBUF_SZ-len,
3896 						"%03d: ", i);
3897 			}
3898 			len += snprintf(line_buf+len, LPFC_MBX_ACC_LBUF_SZ-len,
3899 					"%08x ", (uint32_t)*pword);
3900 			pword++;
3901 		}
3902 		if ((i - 1) % 8)
3903 			printk(KERN_ERR "%s\n", line_buf);
3904 		(*mbx_dump_cnt)--;
3905 	}
3906 
3907 	/* Clean out command structure on reaching dump count */
3908 	if (*mbx_dump_cnt == 0)
3909 		memset(&idiag, 0, sizeof(idiag));
3910 	return;
3911 #endif
3912 }
3913 
3914 /* lpfc_idiag_mbxacc_dump_issue_mbox - idiag debugfs dump issue mailbox command
3915  * @phba: Pointer to HBA context object.
3916  * @dmabuf: Pointer to a DMA buffer descriptor.
3917  *
3918  * Description:
3919  * This routine dump a pass-through non-embedded mailbox command from issue
3920  * mailbox command.
3921  **/
3922 void
3923 lpfc_idiag_mbxacc_dump_issue_mbox(struct lpfc_hba *phba, MAILBOX_t *pmbox)
3924 {
3925 #ifdef CONFIG_SCSI_LPFC_DEBUG_FS
3926 	uint32_t *mbx_dump_map, *mbx_dump_cnt, *mbx_word_cnt, *mbx_mbox_cmd;
3927 	char line_buf[LPFC_MBX_ACC_LBUF_SZ];
3928 	int len = 0;
3929 	uint32_t *pword;
3930 	uint8_t *pbyte;
3931 	uint32_t i, j;
3932 
3933 	if (idiag.cmd.opcode != LPFC_IDIAG_CMD_MBXACC_DP)
3934 		return;
3935 
3936 	mbx_mbox_cmd = &idiag.cmd.data[IDIAG_MBXACC_MBCMD_INDX];
3937 	mbx_dump_map = &idiag.cmd.data[IDIAG_MBXACC_DPMAP_INDX];
3938 	mbx_dump_cnt = &idiag.cmd.data[IDIAG_MBXACC_DPCNT_INDX];
3939 	mbx_word_cnt = &idiag.cmd.data[IDIAG_MBXACC_WDCNT_INDX];
3940 
3941 	if (!(*mbx_dump_map & LPFC_MBX_DMP_MBX_ALL) ||
3942 	    (*mbx_dump_cnt == 0) ||
3943 	    (*mbx_word_cnt == 0))
3944 		return;
3945 
3946 	if ((*mbx_mbox_cmd != LPFC_MBX_ALL_CMD) &&
3947 	    (*mbx_mbox_cmd != pmbox->mbxCommand))
3948 		return;
3949 
3950 	/* dump buffer content */
3951 	if (*mbx_dump_map & LPFC_MBX_DMP_MBX_WORD) {
3952 		printk(KERN_ERR "Mailbox command:0x%x dump by word:\n",
3953 		       pmbox->mbxCommand);
3954 		pword = (uint32_t *)pmbox;
3955 		for (i = 0; i < *mbx_word_cnt; i++) {
3956 			if (!(i % 8)) {
3957 				if (i != 0)
3958 					printk(KERN_ERR "%s\n", line_buf);
3959 				len = 0;
3960 				memset(line_buf, 0, LPFC_MBX_ACC_LBUF_SZ);
3961 				len += snprintf(line_buf+len,
3962 						LPFC_MBX_ACC_LBUF_SZ-len,
3963 						"%03d: ", i);
3964 			}
3965 			len += snprintf(line_buf+len, LPFC_MBX_ACC_LBUF_SZ-len,
3966 					"%08x ",
3967 					((uint32_t)*pword) & 0xffffffff);
3968 			pword++;
3969 		}
3970 		if ((i - 1) % 8)
3971 			printk(KERN_ERR "%s\n", line_buf);
3972 		printk(KERN_ERR "\n");
3973 	}
3974 	if (*mbx_dump_map & LPFC_MBX_DMP_MBX_BYTE) {
3975 		printk(KERN_ERR "Mailbox command:0x%x dump by byte:\n",
3976 		       pmbox->mbxCommand);
3977 		pbyte = (uint8_t *)pmbox;
3978 		for (i = 0; i < *mbx_word_cnt; i++) {
3979 			if (!(i % 8)) {
3980 				if (i != 0)
3981 					printk(KERN_ERR "%s\n", line_buf);
3982 				len = 0;
3983 				memset(line_buf, 0, LPFC_MBX_ACC_LBUF_SZ);
3984 				len += snprintf(line_buf+len,
3985 						LPFC_MBX_ACC_LBUF_SZ-len,
3986 						"%03d: ", i);
3987 			}
3988 			for (j = 0; j < 4; j++) {
3989 				len += snprintf(line_buf+len,
3990 						LPFC_MBX_ACC_LBUF_SZ-len,
3991 						"%02x",
3992 						((uint8_t)*pbyte) & 0xff);
3993 				pbyte++;
3994 			}
3995 			len += snprintf(line_buf+len,
3996 					LPFC_MBX_ACC_LBUF_SZ-len, " ");
3997 		}
3998 		if ((i - 1) % 8)
3999 			printk(KERN_ERR "%s\n", line_buf);
4000 		printk(KERN_ERR "\n");
4001 	}
4002 	(*mbx_dump_cnt)--;
4003 
4004 	/* Clean out command structure on reaching dump count */
4005 	if (*mbx_dump_cnt == 0)
4006 		memset(&idiag, 0, sizeof(idiag));
4007 	return;
4008 #endif
4009 }
4010 
4011 /**
4012  * lpfc_debugfs_initialize - Initialize debugfs for a vport
4013  * @vport: The vport pointer to initialize.
4014  *
4015  * Description:
4016  * When Debugfs is configured this routine sets up the lpfc debugfs file system.
4017  * If not already created, this routine will create the lpfc directory, and
4018  * lpfcX directory (for this HBA), and vportX directory for this vport. It will
4019  * also create each file used to access lpfc specific debugfs information.
4020  **/
4021 inline void
4022 lpfc_debugfs_initialize(struct lpfc_vport *vport)
4023 {
4024 #ifdef CONFIG_SCSI_LPFC_DEBUG_FS
4025 	struct lpfc_hba   *phba = vport->phba;
4026 	char name[64];
4027 	uint32_t num, i;
4028 	bool pport_setup = false;
4029 
4030 	if (!lpfc_debugfs_enable)
4031 		return;
4032 
4033 	/* Setup lpfc root directory */
4034 	if (!lpfc_debugfs_root) {
4035 		lpfc_debugfs_root = debugfs_create_dir("lpfc", NULL);
4036 		atomic_set(&lpfc_debugfs_hba_count, 0);
4037 		if (!lpfc_debugfs_root) {
4038 			lpfc_printf_vlog(vport, KERN_ERR, LOG_INIT,
4039 					 "0408 Cannot create debugfs root\n");
4040 			goto debug_failed;
4041 		}
4042 	}
4043 	if (!lpfc_debugfs_start_time)
4044 		lpfc_debugfs_start_time = jiffies;
4045 
4046 	/* Setup funcX directory for specific HBA PCI function */
4047 	snprintf(name, sizeof(name), "fn%d", phba->brd_no);
4048 	if (!phba->hba_debugfs_root) {
4049 		pport_setup = true;
4050 		phba->hba_debugfs_root =
4051 			debugfs_create_dir(name, lpfc_debugfs_root);
4052 		if (!phba->hba_debugfs_root) {
4053 			lpfc_printf_vlog(vport, KERN_ERR, LOG_INIT,
4054 					 "0412 Cannot create debugfs hba\n");
4055 			goto debug_failed;
4056 		}
4057 		atomic_inc(&lpfc_debugfs_hba_count);
4058 		atomic_set(&phba->debugfs_vport_count, 0);
4059 
4060 		/* Setup hbqinfo */
4061 		snprintf(name, sizeof(name), "hbqinfo");
4062 		phba->debug_hbqinfo =
4063 			debugfs_create_file(name, S_IFREG|S_IRUGO|S_IWUSR,
4064 				 phba->hba_debugfs_root,
4065 				 phba, &lpfc_debugfs_op_hbqinfo);
4066 		if (!phba->debug_hbqinfo) {
4067 			lpfc_printf_vlog(vport, KERN_ERR, LOG_INIT,
4068 				"0411 Cannot create debugfs hbqinfo\n");
4069 			goto debug_failed;
4070 		}
4071 
4072 		/* Setup dumpHBASlim */
4073 		if (phba->sli_rev < LPFC_SLI_REV4) {
4074 			snprintf(name, sizeof(name), "dumpHBASlim");
4075 			phba->debug_dumpHBASlim =
4076 				debugfs_create_file(name,
4077 					S_IFREG|S_IRUGO|S_IWUSR,
4078 					phba->hba_debugfs_root,
4079 					phba, &lpfc_debugfs_op_dumpHBASlim);
4080 			if (!phba->debug_dumpHBASlim) {
4081 				lpfc_printf_vlog(vport, KERN_ERR, LOG_INIT,
4082 						 "0413 Cannot create debugfs "
4083 						"dumpHBASlim\n");
4084 				goto debug_failed;
4085 			}
4086 		} else
4087 			phba->debug_dumpHBASlim = NULL;
4088 
4089 		/* Setup dumpHostSlim */
4090 		if (phba->sli_rev < LPFC_SLI_REV4) {
4091 			snprintf(name, sizeof(name), "dumpHostSlim");
4092 			phba->debug_dumpHostSlim =
4093 				debugfs_create_file(name,
4094 					S_IFREG|S_IRUGO|S_IWUSR,
4095 					phba->hba_debugfs_root,
4096 					phba, &lpfc_debugfs_op_dumpHostSlim);
4097 			if (!phba->debug_dumpHostSlim) {
4098 				lpfc_printf_vlog(vport, KERN_ERR, LOG_INIT,
4099 						 "0414 Cannot create debugfs "
4100 						 "dumpHostSlim\n");
4101 				goto debug_failed;
4102 			}
4103 		} else
4104 			phba->debug_dumpHostSlim = NULL;
4105 
4106 		/* Setup dumpData */
4107 		snprintf(name, sizeof(name), "dumpData");
4108 		phba->debug_dumpData =
4109 			debugfs_create_file(name, S_IFREG|S_IRUGO|S_IWUSR,
4110 				 phba->hba_debugfs_root,
4111 				 phba, &lpfc_debugfs_op_dumpData);
4112 		if (!phba->debug_dumpData) {
4113 			lpfc_printf_vlog(vport, KERN_ERR, LOG_INIT,
4114 				"0800 Cannot create debugfs dumpData\n");
4115 			goto debug_failed;
4116 		}
4117 
4118 		/* Setup dumpDif */
4119 		snprintf(name, sizeof(name), "dumpDif");
4120 		phba->debug_dumpDif =
4121 			debugfs_create_file(name, S_IFREG|S_IRUGO|S_IWUSR,
4122 				 phba->hba_debugfs_root,
4123 				 phba, &lpfc_debugfs_op_dumpDif);
4124 		if (!phba->debug_dumpDif) {
4125 			lpfc_printf_vlog(vport, KERN_ERR, LOG_INIT,
4126 				"0801 Cannot create debugfs dumpDif\n");
4127 			goto debug_failed;
4128 		}
4129 
4130 		/* Setup DIF Error Injections */
4131 		snprintf(name, sizeof(name), "InjErrLBA");
4132 		phba->debug_InjErrLBA =
4133 			debugfs_create_file(name, S_IFREG|S_IRUGO|S_IWUSR,
4134 			phba->hba_debugfs_root,
4135 			phba, &lpfc_debugfs_op_dif_err);
4136 		if (!phba->debug_InjErrLBA) {
4137 			lpfc_printf_vlog(vport, KERN_ERR, LOG_INIT,
4138 				"0807 Cannot create debugfs InjErrLBA\n");
4139 			goto debug_failed;
4140 		}
4141 		phba->lpfc_injerr_lba = LPFC_INJERR_LBA_OFF;
4142 
4143 		snprintf(name, sizeof(name), "InjErrNPortID");
4144 		phba->debug_InjErrNPortID =
4145 			debugfs_create_file(name, S_IFREG|S_IRUGO|S_IWUSR,
4146 			phba->hba_debugfs_root,
4147 			phba, &lpfc_debugfs_op_dif_err);
4148 		if (!phba->debug_InjErrNPortID) {
4149 			lpfc_printf_vlog(vport, KERN_ERR, LOG_INIT,
4150 				"0809 Cannot create debugfs InjErrNPortID\n");
4151 			goto debug_failed;
4152 		}
4153 
4154 		snprintf(name, sizeof(name), "InjErrWWPN");
4155 		phba->debug_InjErrWWPN =
4156 			debugfs_create_file(name, S_IFREG|S_IRUGO|S_IWUSR,
4157 			phba->hba_debugfs_root,
4158 			phba, &lpfc_debugfs_op_dif_err);
4159 		if (!phba->debug_InjErrWWPN) {
4160 			lpfc_printf_vlog(vport, KERN_ERR, LOG_INIT,
4161 				"0810 Cannot create debugfs InjErrWWPN\n");
4162 			goto debug_failed;
4163 		}
4164 
4165 		snprintf(name, sizeof(name), "writeGuardInjErr");
4166 		phba->debug_writeGuard =
4167 			debugfs_create_file(name, S_IFREG|S_IRUGO|S_IWUSR,
4168 			phba->hba_debugfs_root,
4169 			phba, &lpfc_debugfs_op_dif_err);
4170 		if (!phba->debug_writeGuard) {
4171 			lpfc_printf_vlog(vport, KERN_ERR, LOG_INIT,
4172 				"0802 Cannot create debugfs writeGuard\n");
4173 			goto debug_failed;
4174 		}
4175 
4176 		snprintf(name, sizeof(name), "writeAppInjErr");
4177 		phba->debug_writeApp =
4178 			debugfs_create_file(name, S_IFREG|S_IRUGO|S_IWUSR,
4179 			phba->hba_debugfs_root,
4180 			phba, &lpfc_debugfs_op_dif_err);
4181 		if (!phba->debug_writeApp) {
4182 			lpfc_printf_vlog(vport, KERN_ERR, LOG_INIT,
4183 				"0803 Cannot create debugfs writeApp\n");
4184 			goto debug_failed;
4185 		}
4186 
4187 		snprintf(name, sizeof(name), "writeRefInjErr");
4188 		phba->debug_writeRef =
4189 			debugfs_create_file(name, S_IFREG|S_IRUGO|S_IWUSR,
4190 			phba->hba_debugfs_root,
4191 			phba, &lpfc_debugfs_op_dif_err);
4192 		if (!phba->debug_writeRef) {
4193 			lpfc_printf_vlog(vport, KERN_ERR, LOG_INIT,
4194 				"0804 Cannot create debugfs writeRef\n");
4195 			goto debug_failed;
4196 		}
4197 
4198 		snprintf(name, sizeof(name), "readGuardInjErr");
4199 		phba->debug_readGuard =
4200 			debugfs_create_file(name, S_IFREG|S_IRUGO|S_IWUSR,
4201 			phba->hba_debugfs_root,
4202 			phba, &lpfc_debugfs_op_dif_err);
4203 		if (!phba->debug_readGuard) {
4204 			lpfc_printf_vlog(vport, KERN_ERR, LOG_INIT,
4205 				"0808 Cannot create debugfs readGuard\n");
4206 			goto debug_failed;
4207 		}
4208 
4209 		snprintf(name, sizeof(name), "readAppInjErr");
4210 		phba->debug_readApp =
4211 			debugfs_create_file(name, S_IFREG|S_IRUGO|S_IWUSR,
4212 			phba->hba_debugfs_root,
4213 			phba, &lpfc_debugfs_op_dif_err);
4214 		if (!phba->debug_readApp) {
4215 			lpfc_printf_vlog(vport, KERN_ERR, LOG_INIT,
4216 				"0805 Cannot create debugfs readApp\n");
4217 			goto debug_failed;
4218 		}
4219 
4220 		snprintf(name, sizeof(name), "readRefInjErr");
4221 		phba->debug_readRef =
4222 			debugfs_create_file(name, S_IFREG|S_IRUGO|S_IWUSR,
4223 			phba->hba_debugfs_root,
4224 			phba, &lpfc_debugfs_op_dif_err);
4225 		if (!phba->debug_readRef) {
4226 			lpfc_printf_vlog(vport, KERN_ERR, LOG_INIT,
4227 				"0806 Cannot create debugfs readApp\n");
4228 			goto debug_failed;
4229 		}
4230 
4231 		/* Setup slow ring trace */
4232 		if (lpfc_debugfs_max_slow_ring_trc) {
4233 			num = lpfc_debugfs_max_slow_ring_trc - 1;
4234 			if (num & lpfc_debugfs_max_slow_ring_trc) {
4235 				/* Change to be a power of 2 */
4236 				num = lpfc_debugfs_max_slow_ring_trc;
4237 				i = 0;
4238 				while (num > 1) {
4239 					num = num >> 1;
4240 					i++;
4241 				}
4242 				lpfc_debugfs_max_slow_ring_trc = (1 << i);
4243 				printk(KERN_ERR
4244 				       "lpfc_debugfs_max_disc_trc changed to "
4245 				       "%d\n", lpfc_debugfs_max_disc_trc);
4246 			}
4247 		}
4248 
4249 		snprintf(name, sizeof(name), "slow_ring_trace");
4250 		phba->debug_slow_ring_trc =
4251 			debugfs_create_file(name, S_IFREG|S_IRUGO|S_IWUSR,
4252 				 phba->hba_debugfs_root,
4253 				 phba, &lpfc_debugfs_op_slow_ring_trc);
4254 		if (!phba->debug_slow_ring_trc) {
4255 			lpfc_printf_vlog(vport, KERN_ERR, LOG_INIT,
4256 					 "0415 Cannot create debugfs "
4257 					 "slow_ring_trace\n");
4258 			goto debug_failed;
4259 		}
4260 		if (!phba->slow_ring_trc) {
4261 			phba->slow_ring_trc = kmalloc(
4262 				(sizeof(struct lpfc_debugfs_trc) *
4263 				lpfc_debugfs_max_slow_ring_trc),
4264 				GFP_KERNEL);
4265 			if (!phba->slow_ring_trc) {
4266 				lpfc_printf_vlog(vport, KERN_ERR, LOG_INIT,
4267 						 "0416 Cannot create debugfs "
4268 						 "slow_ring buffer\n");
4269 				goto debug_failed;
4270 			}
4271 			atomic_set(&phba->slow_ring_trc_cnt, 0);
4272 			memset(phba->slow_ring_trc, 0,
4273 				(sizeof(struct lpfc_debugfs_trc) *
4274 				lpfc_debugfs_max_slow_ring_trc));
4275 		}
4276 	}
4277 
4278 	snprintf(name, sizeof(name), "vport%d", vport->vpi);
4279 	if (!vport->vport_debugfs_root) {
4280 		vport->vport_debugfs_root =
4281 			debugfs_create_dir(name, phba->hba_debugfs_root);
4282 		if (!vport->vport_debugfs_root) {
4283 			lpfc_printf_vlog(vport, KERN_ERR, LOG_INIT,
4284 					 "0417 Can't create debugfs\n");
4285 			goto debug_failed;
4286 		}
4287 		atomic_inc(&phba->debugfs_vport_count);
4288 	}
4289 
4290 	if (lpfc_debugfs_max_disc_trc) {
4291 		num = lpfc_debugfs_max_disc_trc - 1;
4292 		if (num & lpfc_debugfs_max_disc_trc) {
4293 			/* Change to be a power of 2 */
4294 			num = lpfc_debugfs_max_disc_trc;
4295 			i = 0;
4296 			while (num > 1) {
4297 				num = num >> 1;
4298 				i++;
4299 			}
4300 			lpfc_debugfs_max_disc_trc = (1 << i);
4301 			printk(KERN_ERR
4302 			       "lpfc_debugfs_max_disc_trc changed to %d\n",
4303 			       lpfc_debugfs_max_disc_trc);
4304 		}
4305 	}
4306 
4307 	vport->disc_trc = kzalloc(
4308 		(sizeof(struct lpfc_debugfs_trc) * lpfc_debugfs_max_disc_trc),
4309 		GFP_KERNEL);
4310 
4311 	if (!vport->disc_trc) {
4312 		lpfc_printf_vlog(vport, KERN_ERR, LOG_INIT,
4313 				 "0418 Cannot create debugfs disc trace "
4314 				 "buffer\n");
4315 		goto debug_failed;
4316 	}
4317 	atomic_set(&vport->disc_trc_cnt, 0);
4318 
4319 	snprintf(name, sizeof(name), "discovery_trace");
4320 	vport->debug_disc_trc =
4321 		debugfs_create_file(name, S_IFREG|S_IRUGO|S_IWUSR,
4322 				 vport->vport_debugfs_root,
4323 				 vport, &lpfc_debugfs_op_disc_trc);
4324 	if (!vport->debug_disc_trc) {
4325 		lpfc_printf_vlog(vport, KERN_ERR, LOG_INIT,
4326 				 "0419 Cannot create debugfs "
4327 				 "discovery_trace\n");
4328 		goto debug_failed;
4329 	}
4330 	snprintf(name, sizeof(name), "nodelist");
4331 	vport->debug_nodelist =
4332 		debugfs_create_file(name, S_IFREG|S_IRUGO|S_IWUSR,
4333 				 vport->vport_debugfs_root,
4334 				 vport, &lpfc_debugfs_op_nodelist);
4335 	if (!vport->debug_nodelist) {
4336 		lpfc_printf_vlog(vport, KERN_ERR, LOG_INIT,
4337 				 "2985 Can't create debugfs nodelist\n");
4338 		goto debug_failed;
4339 	}
4340 
4341 	/*
4342 	 * The following section is for additional directories/files for the
4343 	 * physical port.
4344 	 */
4345 
4346 	if (!pport_setup)
4347 		goto debug_failed;
4348 
4349 	/*
4350 	 * iDiag debugfs root entry points for SLI4 device only
4351 	 */
4352 	if (phba->sli_rev < LPFC_SLI_REV4)
4353 		goto debug_failed;
4354 
4355 	snprintf(name, sizeof(name), "iDiag");
4356 	if (!phba->idiag_root) {
4357 		phba->idiag_root =
4358 			debugfs_create_dir(name, phba->hba_debugfs_root);
4359 		if (!phba->idiag_root) {
4360 			lpfc_printf_vlog(vport, KERN_ERR, LOG_INIT,
4361 					 "2922 Can't create idiag debugfs\n");
4362 			goto debug_failed;
4363 		}
4364 		/* Initialize iDiag data structure */
4365 		memset(&idiag, 0, sizeof(idiag));
4366 	}
4367 
4368 	/* iDiag read PCI config space */
4369 	snprintf(name, sizeof(name), "pciCfg");
4370 	if (!phba->idiag_pci_cfg) {
4371 		phba->idiag_pci_cfg =
4372 			debugfs_create_file(name, S_IFREG|S_IRUGO|S_IWUSR,
4373 				phba->idiag_root, phba, &lpfc_idiag_op_pciCfg);
4374 		if (!phba->idiag_pci_cfg) {
4375 			lpfc_printf_vlog(vport, KERN_ERR, LOG_INIT,
4376 					 "2923 Can't create idiag debugfs\n");
4377 			goto debug_failed;
4378 		}
4379 		idiag.offset.last_rd = 0;
4380 	}
4381 
4382 	/* iDiag PCI BAR access */
4383 	snprintf(name, sizeof(name), "barAcc");
4384 	if (!phba->idiag_bar_acc) {
4385 		phba->idiag_bar_acc =
4386 			debugfs_create_file(name, S_IFREG|S_IRUGO|S_IWUSR,
4387 				phba->idiag_root, phba, &lpfc_idiag_op_barAcc);
4388 		if (!phba->idiag_bar_acc) {
4389 			lpfc_printf_vlog(vport, KERN_ERR, LOG_INIT,
4390 					"3056 Can't create idiag debugfs\n");
4391 			goto debug_failed;
4392 		}
4393 		idiag.offset.last_rd = 0;
4394 	}
4395 
4396 	/* iDiag get PCI function queue information */
4397 	snprintf(name, sizeof(name), "queInfo");
4398 	if (!phba->idiag_que_info) {
4399 		phba->idiag_que_info =
4400 			debugfs_create_file(name, S_IFREG|S_IRUGO,
4401 			phba->idiag_root, phba, &lpfc_idiag_op_queInfo);
4402 		if (!phba->idiag_que_info) {
4403 			lpfc_printf_vlog(vport, KERN_ERR, LOG_INIT,
4404 					 "2924 Can't create idiag debugfs\n");
4405 			goto debug_failed;
4406 		}
4407 	}
4408 
4409 	/* iDiag access PCI function queue */
4410 	snprintf(name, sizeof(name), "queAcc");
4411 	if (!phba->idiag_que_acc) {
4412 		phba->idiag_que_acc =
4413 			debugfs_create_file(name, S_IFREG|S_IRUGO|S_IWUSR,
4414 				phba->idiag_root, phba, &lpfc_idiag_op_queAcc);
4415 		if (!phba->idiag_que_acc) {
4416 			lpfc_printf_vlog(vport, KERN_ERR, LOG_INIT,
4417 					 "2926 Can't create idiag debugfs\n");
4418 			goto debug_failed;
4419 		}
4420 	}
4421 
4422 	/* iDiag access PCI function doorbell registers */
4423 	snprintf(name, sizeof(name), "drbAcc");
4424 	if (!phba->idiag_drb_acc) {
4425 		phba->idiag_drb_acc =
4426 			debugfs_create_file(name, S_IFREG|S_IRUGO|S_IWUSR,
4427 				phba->idiag_root, phba, &lpfc_idiag_op_drbAcc);
4428 		if (!phba->idiag_drb_acc) {
4429 			lpfc_printf_vlog(vport, KERN_ERR, LOG_INIT,
4430 					 "2927 Can't create idiag debugfs\n");
4431 			goto debug_failed;
4432 		}
4433 	}
4434 
4435 	/* iDiag access PCI function control registers */
4436 	snprintf(name, sizeof(name), "ctlAcc");
4437 	if (!phba->idiag_ctl_acc) {
4438 		phba->idiag_ctl_acc =
4439 			debugfs_create_file(name, S_IFREG|S_IRUGO|S_IWUSR,
4440 				phba->idiag_root, phba, &lpfc_idiag_op_ctlAcc);
4441 		if (!phba->idiag_ctl_acc) {
4442 			lpfc_printf_vlog(vport, KERN_ERR, LOG_INIT,
4443 					 "2981 Can't create idiag debugfs\n");
4444 			goto debug_failed;
4445 		}
4446 	}
4447 
4448 	/* iDiag access mbox commands */
4449 	snprintf(name, sizeof(name), "mbxAcc");
4450 	if (!phba->idiag_mbx_acc) {
4451 		phba->idiag_mbx_acc =
4452 			debugfs_create_file(name, S_IFREG|S_IRUGO|S_IWUSR,
4453 				phba->idiag_root, phba, &lpfc_idiag_op_mbxAcc);
4454 		if (!phba->idiag_mbx_acc) {
4455 			lpfc_printf_vlog(vport, KERN_ERR, LOG_INIT,
4456 					"2980 Can't create idiag debugfs\n");
4457 			goto debug_failed;
4458 		}
4459 	}
4460 
4461 	/* iDiag extents access commands */
4462 	if (phba->sli4_hba.extents_in_use) {
4463 		snprintf(name, sizeof(name), "extAcc");
4464 		if (!phba->idiag_ext_acc) {
4465 			phba->idiag_ext_acc =
4466 				debugfs_create_file(name,
4467 						    S_IFREG|S_IRUGO|S_IWUSR,
4468 						    phba->idiag_root, phba,
4469 						    &lpfc_idiag_op_extAcc);
4470 			if (!phba->idiag_ext_acc) {
4471 				lpfc_printf_vlog(vport, KERN_ERR, LOG_INIT,
4472 						"2986 Cant create "
4473 						"idiag debugfs\n");
4474 				goto debug_failed;
4475 			}
4476 		}
4477 	}
4478 
4479 debug_failed:
4480 	return;
4481 #endif
4482 }
4483 
4484 /**
4485  * lpfc_debugfs_terminate -  Tear down debugfs infrastructure for this vport
4486  * @vport: The vport pointer to remove from debugfs.
4487  *
4488  * Description:
4489  * When Debugfs is configured this routine removes debugfs file system elements
4490  * that are specific to this vport. It also checks to see if there are any
4491  * users left for the debugfs directories associated with the HBA and driver. If
4492  * this is the last user of the HBA directory or driver directory then it will
4493  * remove those from the debugfs infrastructure as well.
4494  **/
4495 inline void
4496 lpfc_debugfs_terminate(struct lpfc_vport *vport)
4497 {
4498 #ifdef CONFIG_SCSI_LPFC_DEBUG_FS
4499 	struct lpfc_hba   *phba = vport->phba;
4500 
4501 	if (vport->disc_trc) {
4502 		kfree(vport->disc_trc);
4503 		vport->disc_trc = NULL;
4504 	}
4505 	if (vport->debug_disc_trc) {
4506 		debugfs_remove(vport->debug_disc_trc); /* discovery_trace */
4507 		vport->debug_disc_trc = NULL;
4508 	}
4509 	if (vport->debug_nodelist) {
4510 		debugfs_remove(vport->debug_nodelist); /* nodelist */
4511 		vport->debug_nodelist = NULL;
4512 	}
4513 	if (vport->vport_debugfs_root) {
4514 		debugfs_remove(vport->vport_debugfs_root); /* vportX */
4515 		vport->vport_debugfs_root = NULL;
4516 		atomic_dec(&phba->debugfs_vport_count);
4517 	}
4518 	if (atomic_read(&phba->debugfs_vport_count) == 0) {
4519 
4520 		if (phba->debug_hbqinfo) {
4521 			debugfs_remove(phba->debug_hbqinfo); /* hbqinfo */
4522 			phba->debug_hbqinfo = NULL;
4523 		}
4524 		if (phba->debug_dumpHBASlim) {
4525 			debugfs_remove(phba->debug_dumpHBASlim); /* HBASlim */
4526 			phba->debug_dumpHBASlim = NULL;
4527 		}
4528 		if (phba->debug_dumpHostSlim) {
4529 			debugfs_remove(phba->debug_dumpHostSlim); /* HostSlim */
4530 			phba->debug_dumpHostSlim = NULL;
4531 		}
4532 		if (phba->debug_dumpData) {
4533 			debugfs_remove(phba->debug_dumpData); /* dumpData */
4534 			phba->debug_dumpData = NULL;
4535 		}
4536 
4537 		if (phba->debug_dumpDif) {
4538 			debugfs_remove(phba->debug_dumpDif); /* dumpDif */
4539 			phba->debug_dumpDif = NULL;
4540 		}
4541 		if (phba->debug_InjErrLBA) {
4542 			debugfs_remove(phba->debug_InjErrLBA); /* InjErrLBA */
4543 			phba->debug_InjErrLBA = NULL;
4544 		}
4545 		if (phba->debug_InjErrNPortID) {	 /* InjErrNPortID */
4546 			debugfs_remove(phba->debug_InjErrNPortID);
4547 			phba->debug_InjErrNPortID = NULL;
4548 		}
4549 		if (phba->debug_InjErrWWPN) {
4550 			debugfs_remove(phba->debug_InjErrWWPN); /* InjErrWWPN */
4551 			phba->debug_InjErrWWPN = NULL;
4552 		}
4553 		if (phba->debug_writeGuard) {
4554 			debugfs_remove(phba->debug_writeGuard); /* writeGuard */
4555 			phba->debug_writeGuard = NULL;
4556 		}
4557 		if (phba->debug_writeApp) {
4558 			debugfs_remove(phba->debug_writeApp); /* writeApp */
4559 			phba->debug_writeApp = NULL;
4560 		}
4561 		if (phba->debug_writeRef) {
4562 			debugfs_remove(phba->debug_writeRef); /* writeRef */
4563 			phba->debug_writeRef = NULL;
4564 		}
4565 		if (phba->debug_readGuard) {
4566 			debugfs_remove(phba->debug_readGuard); /* readGuard */
4567 			phba->debug_readGuard = NULL;
4568 		}
4569 		if (phba->debug_readApp) {
4570 			debugfs_remove(phba->debug_readApp); /* readApp */
4571 			phba->debug_readApp = NULL;
4572 		}
4573 		if (phba->debug_readRef) {
4574 			debugfs_remove(phba->debug_readRef); /* readRef */
4575 			phba->debug_readRef = NULL;
4576 		}
4577 
4578 		if (phba->slow_ring_trc) {
4579 			kfree(phba->slow_ring_trc);
4580 			phba->slow_ring_trc = NULL;
4581 		}
4582 		if (phba->debug_slow_ring_trc) {
4583 			/* slow_ring_trace */
4584 			debugfs_remove(phba->debug_slow_ring_trc);
4585 			phba->debug_slow_ring_trc = NULL;
4586 		}
4587 
4588 		/*
4589 		 * iDiag release
4590 		 */
4591 		if (phba->sli_rev == LPFC_SLI_REV4) {
4592 			if (phba->idiag_ext_acc) {
4593 				/* iDiag extAcc */
4594 				debugfs_remove(phba->idiag_ext_acc);
4595 				phba->idiag_ext_acc = NULL;
4596 			}
4597 			if (phba->idiag_mbx_acc) {
4598 				/* iDiag mbxAcc */
4599 				debugfs_remove(phba->idiag_mbx_acc);
4600 				phba->idiag_mbx_acc = NULL;
4601 			}
4602 			if (phba->idiag_ctl_acc) {
4603 				/* iDiag ctlAcc */
4604 				debugfs_remove(phba->idiag_ctl_acc);
4605 				phba->idiag_ctl_acc = NULL;
4606 			}
4607 			if (phba->idiag_drb_acc) {
4608 				/* iDiag drbAcc */
4609 				debugfs_remove(phba->idiag_drb_acc);
4610 				phba->idiag_drb_acc = NULL;
4611 			}
4612 			if (phba->idiag_que_acc) {
4613 				/* iDiag queAcc */
4614 				debugfs_remove(phba->idiag_que_acc);
4615 				phba->idiag_que_acc = NULL;
4616 			}
4617 			if (phba->idiag_que_info) {
4618 				/* iDiag queInfo */
4619 				debugfs_remove(phba->idiag_que_info);
4620 				phba->idiag_que_info = NULL;
4621 			}
4622 			if (phba->idiag_bar_acc) {
4623 				/* iDiag barAcc */
4624 				debugfs_remove(phba->idiag_bar_acc);
4625 				phba->idiag_bar_acc = NULL;
4626 			}
4627 			if (phba->idiag_pci_cfg) {
4628 				/* iDiag pciCfg */
4629 				debugfs_remove(phba->idiag_pci_cfg);
4630 				phba->idiag_pci_cfg = NULL;
4631 			}
4632 
4633 			/* Finally remove the iDiag debugfs root */
4634 			if (phba->idiag_root) {
4635 				/* iDiag root */
4636 				debugfs_remove(phba->idiag_root);
4637 				phba->idiag_root = NULL;
4638 			}
4639 		}
4640 
4641 		if (phba->hba_debugfs_root) {
4642 			debugfs_remove(phba->hba_debugfs_root); /* fnX */
4643 			phba->hba_debugfs_root = NULL;
4644 			atomic_dec(&lpfc_debugfs_hba_count);
4645 		}
4646 
4647 		if (atomic_read(&lpfc_debugfs_hba_count) == 0) {
4648 			debugfs_remove(lpfc_debugfs_root); /* lpfc */
4649 			lpfc_debugfs_root = NULL;
4650 		}
4651 	}
4652 #endif
4653 	return;
4654 }
4655 
4656 /*
4657  * Driver debug utility routines outside of debugfs. The debug utility
4658  * routines implemented here is intended to be used in the instrumented
4659  * debug driver for debugging host or port issues.
4660  */
4661 
4662 /**
4663  * lpfc_debug_dump_all_queues - dump all the queues with a hba
4664  * @phba: Pointer to HBA context object.
4665  *
4666  * This function dumps entries of all the queues asociated with the @phba.
4667  **/
4668 void
4669 lpfc_debug_dump_all_queues(struct lpfc_hba *phba)
4670 {
4671 	int fcp_wqidx;
4672 
4673 	/*
4674 	 * Dump Work Queues (WQs)
4675 	 */
4676 	lpfc_debug_dump_mbx_wq(phba);
4677 	lpfc_debug_dump_els_wq(phba);
4678 
4679 	for (fcp_wqidx = 0; fcp_wqidx < phba->cfg_fcp_io_channel; fcp_wqidx++)
4680 		lpfc_debug_dump_fcp_wq(phba, fcp_wqidx);
4681 
4682 	lpfc_debug_dump_hdr_rq(phba);
4683 	lpfc_debug_dump_dat_rq(phba);
4684 	/*
4685 	 * Dump Complete Queues (CQs)
4686 	 */
4687 	lpfc_debug_dump_mbx_cq(phba);
4688 	lpfc_debug_dump_els_cq(phba);
4689 
4690 	for (fcp_wqidx = 0; fcp_wqidx < phba->cfg_fcp_io_channel; fcp_wqidx++)
4691 		lpfc_debug_dump_fcp_cq(phba, fcp_wqidx);
4692 
4693 	/*
4694 	 * Dump Event Queues (EQs)
4695 	 */
4696 	for (fcp_wqidx = 0; fcp_wqidx < phba->cfg_fcp_io_channel; fcp_wqidx++)
4697 		lpfc_debug_dump_hba_eq(phba, fcp_wqidx);
4698 }
4699