xref: /freebsd/sys/dev/ocs_fc/ocs_gendump.c (revision 16b71d98d96a3a9a2ac666440aa80f12d478959d)
129e2dbd4SRam Kishore Vegesna /*
229e2dbd4SRam Kishore Vegesna  * Copyright (c) 2021 Broadcom. All rights reserved.
329e2dbd4SRam Kishore Vegesna  * The term "Broadcom" refers to Broadcom Limited and/or its subsidiaries.
429e2dbd4SRam Kishore Vegesna  *
529e2dbd4SRam Kishore Vegesna  * Redistribution and use in source and binary forms, with or without
629e2dbd4SRam Kishore Vegesna  * modification, are permitted provided that the following conditions are met:
729e2dbd4SRam Kishore Vegesna  *
829e2dbd4SRam Kishore Vegesna  * 1. Redistributions of source code must retain the above copyright notice,
929e2dbd4SRam Kishore Vegesna  *    this list of conditions and the following disclaimer.
1029e2dbd4SRam Kishore Vegesna  *
1129e2dbd4SRam Kishore Vegesna  * 2. Redistributions in binary form must reproduce the above copyright notice,
1229e2dbd4SRam Kishore Vegesna  *    this list of conditions and the following disclaimer in the documentation
1329e2dbd4SRam Kishore Vegesna  *    and/or other materials provided with the distribution.
1429e2dbd4SRam Kishore Vegesna  *
1529e2dbd4SRam Kishore Vegesna  * 3. Neither the name of the copyright holder nor the names of its contributors
1629e2dbd4SRam Kishore Vegesna  *    may be used to endorse or promote products derived from this software
1729e2dbd4SRam Kishore Vegesna  *    without specific prior written permission.
1829e2dbd4SRam Kishore Vegesna  *
1929e2dbd4SRam Kishore Vegesna  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
2029e2dbd4SRam Kishore Vegesna  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
2129e2dbd4SRam Kishore Vegesna  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
2229e2dbd4SRam Kishore Vegesna  * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE
2329e2dbd4SRam Kishore Vegesna  * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
2429e2dbd4SRam Kishore Vegesna  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
2529e2dbd4SRam Kishore Vegesna  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
2629e2dbd4SRam Kishore Vegesna  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
2729e2dbd4SRam Kishore Vegesna  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
2829e2dbd4SRam Kishore Vegesna  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
2929e2dbd4SRam Kishore Vegesna  * POSSIBILITY OF SUCH DAMAGE.
3029e2dbd4SRam Kishore Vegesna  *
3129e2dbd4SRam Kishore Vegesna  */
3229e2dbd4SRam Kishore Vegesna 
3329e2dbd4SRam Kishore Vegesna #include "ocs.h"
3429e2dbd4SRam Kishore Vegesna #include "ocs_gendump.h"
3529e2dbd4SRam Kishore Vegesna 
3629e2dbd4SRam Kishore Vegesna /* Reset all the functions associated with a bus/dev */
3729e2dbd4SRam Kishore Vegesna static int
ocs_gen_dump_reset(uint8_t bus,uint8_t dev)3829e2dbd4SRam Kishore Vegesna ocs_gen_dump_reset(uint8_t bus, uint8_t dev)
3929e2dbd4SRam Kishore Vegesna {
4029e2dbd4SRam Kishore Vegesna 	uint32_t index = 0;
4129e2dbd4SRam Kishore Vegesna 	ocs_t *ocs;
4229e2dbd4SRam Kishore Vegesna 	int rc = 0;
4329e2dbd4SRam Kishore Vegesna 
4429e2dbd4SRam Kishore Vegesna 	while ((ocs = ocs_get_instance(index++)) != NULL) {
4529e2dbd4SRam Kishore Vegesna 		uint8_t ocs_bus, ocs_dev, ocs_func;
4629e2dbd4SRam Kishore Vegesna 		ocs_domain_t *domain;
4729e2dbd4SRam Kishore Vegesna 
4829e2dbd4SRam Kishore Vegesna 		ocs_get_bus_dev_func(ocs, &ocs_bus, &ocs_dev, &ocs_func);
4929e2dbd4SRam Kishore Vegesna 
5029e2dbd4SRam Kishore Vegesna 		if (!(ocs_bus == bus && ocs_dev == dev))
5129e2dbd4SRam Kishore Vegesna 			continue;
5229e2dbd4SRam Kishore Vegesna 
5329e2dbd4SRam Kishore Vegesna 		if (ocs_hw_reset(&ocs->hw, OCS_HW_RESET_FUNCTION)) {
5429e2dbd4SRam Kishore Vegesna 			ocs_log_test(ocs, "failed to reset port\n");
5529e2dbd4SRam Kishore Vegesna 			rc = -1;
5629e2dbd4SRam Kishore Vegesna 			continue;
5729e2dbd4SRam Kishore Vegesna 		}
5829e2dbd4SRam Kishore Vegesna 
5929e2dbd4SRam Kishore Vegesna 		ocs_log_debug(ocs, "successfully reset port\n");
6029e2dbd4SRam Kishore Vegesna 		while ((domain = ocs_list_get_head(&ocs->domain_list)) != NULL) {
6129e2dbd4SRam Kishore Vegesna 			ocs_log_debug(ocs, "free domain %p\n", domain);
6229e2dbd4SRam Kishore Vegesna 			ocs_domain_force_free(domain);
6329e2dbd4SRam Kishore Vegesna 		}
6429e2dbd4SRam Kishore Vegesna 		/* now initialize hw so user can read the dump in */
6529e2dbd4SRam Kishore Vegesna 		if (ocs_hw_init(&ocs->hw)) {
6629e2dbd4SRam Kishore Vegesna 			ocs_log_err(ocs, "failed to initialize hw\n");
6729e2dbd4SRam Kishore Vegesna 			rc = -1;
6829e2dbd4SRam Kishore Vegesna 		} else {
6929e2dbd4SRam Kishore Vegesna 			ocs_log_debug(ocs, "successfully initialized hw\n");
7029e2dbd4SRam Kishore Vegesna 		}
7129e2dbd4SRam Kishore Vegesna 	}
7229e2dbd4SRam Kishore Vegesna 	return rc;
7329e2dbd4SRam Kishore Vegesna }
7429e2dbd4SRam Kishore Vegesna 
7529e2dbd4SRam Kishore Vegesna int
ocs_gen_dump(ocs_t * ocs)7629e2dbd4SRam Kishore Vegesna ocs_gen_dump(ocs_t *ocs)
7729e2dbd4SRam Kishore Vegesna {
7829e2dbd4SRam Kishore Vegesna 	uint32_t reset_required;
7929e2dbd4SRam Kishore Vegesna 	uint32_t dump_ready;
8029e2dbd4SRam Kishore Vegesna 	uint32_t ms_waited;
8129e2dbd4SRam Kishore Vegesna 	uint8_t bus, dev, func;
8229e2dbd4SRam Kishore Vegesna 	int rc = 0;
8329e2dbd4SRam Kishore Vegesna 	int index = 0, port_index = 0;
8429e2dbd4SRam Kishore Vegesna 	ocs_t *nxt_ocs;
8529e2dbd4SRam Kishore Vegesna 	uint8_t nxt_bus, nxt_dev, nxt_func;
8629e2dbd4SRam Kishore Vegesna 	uint8_t prev_port_state[OCS_MAX_HBA_PORTS] = {0,};
8729e2dbd4SRam Kishore Vegesna 	ocs_xport_stats_t link_status;
8829e2dbd4SRam Kishore Vegesna 
8929e2dbd4SRam Kishore Vegesna 	ocs_get_bus_dev_func(ocs, &bus, &dev, &func);
9029e2dbd4SRam Kishore Vegesna 
9129e2dbd4SRam Kishore Vegesna 	/* Drop link on all ports belongs to this HBA*/
9229e2dbd4SRam Kishore Vegesna 	while ((nxt_ocs = ocs_get_instance(index++)) != NULL) {
9329e2dbd4SRam Kishore Vegesna 		ocs_get_bus_dev_func(nxt_ocs, &nxt_bus, &nxt_dev, &nxt_func);
9429e2dbd4SRam Kishore Vegesna 
9529e2dbd4SRam Kishore Vegesna 		if (!(bus == nxt_bus && dev == nxt_dev))
9629e2dbd4SRam Kishore Vegesna 			continue;
9729e2dbd4SRam Kishore Vegesna 
9829e2dbd4SRam Kishore Vegesna 		if ((port_index >= OCS_MAX_HBA_PORTS))
9929e2dbd4SRam Kishore Vegesna 			continue;
10029e2dbd4SRam Kishore Vegesna 
10129e2dbd4SRam Kishore Vegesna 		/* Check current link status and save for future use */
10229e2dbd4SRam Kishore Vegesna 		if (ocs_xport_status(nxt_ocs->xport, OCS_XPORT_PORT_STATUS,
10329e2dbd4SRam Kishore Vegesna 		   &link_status) == 0) {
10429e2dbd4SRam Kishore Vegesna 			if (link_status.value == OCS_XPORT_PORT_ONLINE) {
10529e2dbd4SRam Kishore Vegesna 				prev_port_state[port_index] = 1;
10629e2dbd4SRam Kishore Vegesna 				ocs_xport_control(nxt_ocs->xport,
10729e2dbd4SRam Kishore Vegesna 						  OCS_XPORT_PORT_OFFLINE);
10829e2dbd4SRam Kishore Vegesna 			} else {
10929e2dbd4SRam Kishore Vegesna 				prev_port_state[port_index] = 0;
11029e2dbd4SRam Kishore Vegesna 			}
11129e2dbd4SRam Kishore Vegesna 		}
11229e2dbd4SRam Kishore Vegesna 		port_index++;
11329e2dbd4SRam Kishore Vegesna 	}
11429e2dbd4SRam Kishore Vegesna 
11529e2dbd4SRam Kishore Vegesna 	/* Wait until all ports have quiesced */
11629e2dbd4SRam Kishore Vegesna 	for (index = 0; (nxt_ocs = ocs_get_instance(index++)) != NULL; ) {
11729e2dbd4SRam Kishore Vegesna 		ms_waited = 0;
11829e2dbd4SRam Kishore Vegesna 		for (;;) {
11929e2dbd4SRam Kishore Vegesna 			ocs_xport_stats_t status;
12029e2dbd4SRam Kishore Vegesna 
12129e2dbd4SRam Kishore Vegesna 			ocs_xport_status(nxt_ocs->xport, OCS_XPORT_IS_QUIESCED,
12229e2dbd4SRam Kishore Vegesna 					 &status);
12329e2dbd4SRam Kishore Vegesna 			if (status.value) {
12429e2dbd4SRam Kishore Vegesna 				ocs_log_debug(nxt_ocs, "port quiesced\n");
12529e2dbd4SRam Kishore Vegesna 				break;
12629e2dbd4SRam Kishore Vegesna 			}
12729e2dbd4SRam Kishore Vegesna 
12829e2dbd4SRam Kishore Vegesna 			ocs_msleep(10);
12929e2dbd4SRam Kishore Vegesna 			ms_waited += 10;
13029e2dbd4SRam Kishore Vegesna 			if (ms_waited > 60000) {
13129e2dbd4SRam Kishore Vegesna 				ocs_log_test(nxt_ocs,
13229e2dbd4SRam Kishore Vegesna 				    "timed out waiting for port to quiesce\n");
13329e2dbd4SRam Kishore Vegesna 				break;
13429e2dbd4SRam Kishore Vegesna 			}
13529e2dbd4SRam Kishore Vegesna 		}
13629e2dbd4SRam Kishore Vegesna 	}
13729e2dbd4SRam Kishore Vegesna 
13829e2dbd4SRam Kishore Vegesna 	/* Initiate dump */
13929e2dbd4SRam Kishore Vegesna 	if (ocs_hw_raise_ue(&ocs->hw, 1) == OCS_HW_RTN_SUCCESS) {
14029e2dbd4SRam Kishore Vegesna 
14129e2dbd4SRam Kishore Vegesna 		/* Wait for dump to complete */
14229e2dbd4SRam Kishore Vegesna 		ocs_log_debug(ocs, "Dump requested, wait for completion.\n");
14329e2dbd4SRam Kishore Vegesna 
14429e2dbd4SRam Kishore Vegesna 		dump_ready = 0;
14529e2dbd4SRam Kishore Vegesna 		ms_waited = 0;
14629e2dbd4SRam Kishore Vegesna 		while ((!dump_ready) && (ms_waited < 30000)) {
14729e2dbd4SRam Kishore Vegesna 			ocs_hw_get(&ocs->hw, OCS_HW_DUMP_READY, &dump_ready);
14829e2dbd4SRam Kishore Vegesna 			ocs_udelay(10000);
14929e2dbd4SRam Kishore Vegesna 			ms_waited += 10;
15029e2dbd4SRam Kishore Vegesna 		}
15129e2dbd4SRam Kishore Vegesna 
15229e2dbd4SRam Kishore Vegesna 		if (!dump_ready) {
15329e2dbd4SRam Kishore Vegesna 			ocs_log_test(ocs, "Failed to see dump after 30 secs\n");
15429e2dbd4SRam Kishore Vegesna 			rc = -1;
15529e2dbd4SRam Kishore Vegesna 		} else {
15629e2dbd4SRam Kishore Vegesna 			ocs_log_debug(ocs, "sucessfully generated dump\n");
15729e2dbd4SRam Kishore Vegesna 		}
15829e2dbd4SRam Kishore Vegesna 
15929e2dbd4SRam Kishore Vegesna 		/* now reset port */
16029e2dbd4SRam Kishore Vegesna 		ocs_hw_get(&ocs->hw, OCS_HW_RESET_REQUIRED, &reset_required);
16129e2dbd4SRam Kishore Vegesna 		ocs_log_debug(ocs, "reset required=%d\n", reset_required);
16229e2dbd4SRam Kishore Vegesna 		if (reset_required) {
16329e2dbd4SRam Kishore Vegesna 			if (ocs_gen_dump_reset(bus, dev) == 0) {
16429e2dbd4SRam Kishore Vegesna 				ocs_log_debug(ocs, "all devices reset\n");
16529e2dbd4SRam Kishore Vegesna 			} else {
16629e2dbd4SRam Kishore Vegesna 				ocs_log_test(ocs, "all devices NOT reset\n");
16729e2dbd4SRam Kishore Vegesna 			}
16829e2dbd4SRam Kishore Vegesna 		}
16929e2dbd4SRam Kishore Vegesna 	} else {
17029e2dbd4SRam Kishore Vegesna 		ocs_log_test(ocs, "dump request to hw failed\n");
17129e2dbd4SRam Kishore Vegesna 		rc = -1;
17229e2dbd4SRam Kishore Vegesna 	}
17329e2dbd4SRam Kishore Vegesna 
17429e2dbd4SRam Kishore Vegesna 	index = port_index = 0;
17529e2dbd4SRam Kishore Vegesna 	nxt_ocs = NULL;
17629e2dbd4SRam Kishore Vegesna 	/* Bring links on each HBA port to previous state*/
17729e2dbd4SRam Kishore Vegesna 	while ((nxt_ocs = ocs_get_instance(index++)) != NULL) {
17829e2dbd4SRam Kishore Vegesna 		ocs_get_bus_dev_func(nxt_ocs, &nxt_bus, &nxt_dev, &nxt_func);
17929e2dbd4SRam Kishore Vegesna 		if (port_index > OCS_MAX_HBA_PORTS) {
18029e2dbd4SRam Kishore Vegesna 			ocs_log_err(NULL, "port index(%d) out of boundary\n",
18129e2dbd4SRam Kishore Vegesna 				    port_index);
18229e2dbd4SRam Kishore Vegesna 			rc = -1;
18329e2dbd4SRam Kishore Vegesna 			break;
18429e2dbd4SRam Kishore Vegesna 		}
18529e2dbd4SRam Kishore Vegesna 		if ((bus == nxt_bus) && (dev == nxt_dev) &&
18629e2dbd4SRam Kishore Vegesna 		    prev_port_state[port_index++]) {
18729e2dbd4SRam Kishore Vegesna 			ocs_xport_control(nxt_ocs->xport, OCS_XPORT_PORT_ONLINE);
18829e2dbd4SRam Kishore Vegesna 		}
18929e2dbd4SRam Kishore Vegesna 	}
19029e2dbd4SRam Kishore Vegesna 
19129e2dbd4SRam Kishore Vegesna 	return rc;
19229e2dbd4SRam Kishore Vegesna }
19329e2dbd4SRam Kishore Vegesna 
19429e2dbd4SRam Kishore Vegesna int
ocs_fdb_dump(ocs_t * ocs)19529e2dbd4SRam Kishore Vegesna ocs_fdb_dump(ocs_t *ocs)
19629e2dbd4SRam Kishore Vegesna {
19729e2dbd4SRam Kishore Vegesna 	uint32_t dump_ready;
19829e2dbd4SRam Kishore Vegesna 	uint32_t ms_waited;
19929e2dbd4SRam Kishore Vegesna 	int rc = 0;
20029e2dbd4SRam Kishore Vegesna 
20129e2dbd4SRam Kishore Vegesna #define FDB 2
20229e2dbd4SRam Kishore Vegesna 
20329e2dbd4SRam Kishore Vegesna 	/* Initiate dump */
20429e2dbd4SRam Kishore Vegesna 	if (ocs_hw_raise_ue(&ocs->hw, FDB) == OCS_HW_RTN_SUCCESS) {
20529e2dbd4SRam Kishore Vegesna 
20629e2dbd4SRam Kishore Vegesna 		/* Wait for dump to complete */
20729e2dbd4SRam Kishore Vegesna 		ocs_log_debug(ocs, "Dump requested, wait for completion.\n");
20829e2dbd4SRam Kishore Vegesna 
20929e2dbd4SRam Kishore Vegesna 		dump_ready = 0;
21029e2dbd4SRam Kishore Vegesna 		ms_waited = 0;
21129e2dbd4SRam Kishore Vegesna 		while ((!(dump_ready == FDB)) && (ms_waited < 10000)) {
21229e2dbd4SRam Kishore Vegesna 			ocs_hw_get(&ocs->hw, OCS_HW_DUMP_READY, &dump_ready);
21329e2dbd4SRam Kishore Vegesna 			ocs_udelay(10000);
21429e2dbd4SRam Kishore Vegesna 			ms_waited += 10;
21529e2dbd4SRam Kishore Vegesna 		}
21629e2dbd4SRam Kishore Vegesna 
21729e2dbd4SRam Kishore Vegesna 		if (!dump_ready) {
21829e2dbd4SRam Kishore Vegesna 			ocs_log_err(ocs, "Failed to see dump after 10 secs\n");
21929e2dbd4SRam Kishore Vegesna 			return -1;
22029e2dbd4SRam Kishore Vegesna 		}
22129e2dbd4SRam Kishore Vegesna 
22229e2dbd4SRam Kishore Vegesna 		ocs_log_debug(ocs, "sucessfully generated dump\n");
22329e2dbd4SRam Kishore Vegesna 
22429e2dbd4SRam Kishore Vegesna 	} else {
22529e2dbd4SRam Kishore Vegesna 		ocs_log_err(ocs, "dump request to hw failed\n");
22629e2dbd4SRam Kishore Vegesna 		rc = -1;
22729e2dbd4SRam Kishore Vegesna 	}
22829e2dbd4SRam Kishore Vegesna 
22929e2dbd4SRam Kishore Vegesna 	return rc;
23029e2dbd4SRam Kishore Vegesna }
23129e2dbd4SRam Kishore Vegesna 
23229e2dbd4SRam Kishore Vegesna /**
23329e2dbd4SRam Kishore Vegesna  * @brief Create a Lancer dump into a memory buffer
23429e2dbd4SRam Kishore Vegesna  * @par Description
23529e2dbd4SRam Kishore Vegesna  * This function creates a DMA buffer to hold a Lancer dump,
23629e2dbd4SRam Kishore Vegesna  * sets the dump location to point to that buffer, then calls
237*16b71d98SGordon Bergling  * ocs_gen_dump to cause a dump to be transferred to the buffer.
23829e2dbd4SRam Kishore Vegesna  * After the dump is complete it copies the dump to the provided
23929e2dbd4SRam Kishore Vegesna  * user space buffer.
24029e2dbd4SRam Kishore Vegesna  *
24129e2dbd4SRam Kishore Vegesna  * @param ocs Pointer to ocs structure
24229e2dbd4SRam Kishore Vegesna  * @param buf User space buffer in which to store the dump
24329e2dbd4SRam Kishore Vegesna  * @param buflen Length of the user buffer in bytes
24429e2dbd4SRam Kishore Vegesna  *
24529e2dbd4SRam Kishore Vegesna  * @return Returns 0 on success, non-zero on error.
24629e2dbd4SRam Kishore Vegesna  */
24729e2dbd4SRam Kishore Vegesna int
ocs_dump_to_host(ocs_t * ocs,void * buf,uint32_t buflen)24829e2dbd4SRam Kishore Vegesna ocs_dump_to_host(ocs_t *ocs, void *buf, uint32_t buflen)
24929e2dbd4SRam Kishore Vegesna {
25029e2dbd4SRam Kishore Vegesna 	int rc;
25129e2dbd4SRam Kishore Vegesna 	uint32_t i, num_buffers;
25229e2dbd4SRam Kishore Vegesna 	ocs_dma_t *dump_buffers;
25329e2dbd4SRam Kishore Vegesna 	uint32_t rem_bytes, offset;
25429e2dbd4SRam Kishore Vegesna 
25529e2dbd4SRam Kishore Vegesna 	if (buflen == 0) {
25629e2dbd4SRam Kishore Vegesna 		ocs_log_test(ocs, "zero buffer length is invalid\n");
25729e2dbd4SRam Kishore Vegesna 		return -1;
25829e2dbd4SRam Kishore Vegesna 	}
25929e2dbd4SRam Kishore Vegesna 
26029e2dbd4SRam Kishore Vegesna 	num_buffers = ((buflen + OCS_MAX_DMA_ALLOC - 1) / OCS_MAX_DMA_ALLOC);
26129e2dbd4SRam Kishore Vegesna 
26229e2dbd4SRam Kishore Vegesna 	dump_buffers = ocs_malloc(ocs, sizeof(ocs_dma_t) * num_buffers,
26329e2dbd4SRam Kishore Vegesna 				  OCS_M_ZERO | OCS_M_NOWAIT);
26429e2dbd4SRam Kishore Vegesna 	if (dump_buffers == NULL) {
26529e2dbd4SRam Kishore Vegesna 		ocs_log_err(ocs, "Failed to dump buffers\n");
26629e2dbd4SRam Kishore Vegesna 		return -1;
26729e2dbd4SRam Kishore Vegesna 	}
26829e2dbd4SRam Kishore Vegesna 
26929e2dbd4SRam Kishore Vegesna 	/* Allocate a DMA buffers to hold the dump */
27029e2dbd4SRam Kishore Vegesna 	rem_bytes = buflen;
27129e2dbd4SRam Kishore Vegesna 	for (i = 0; i < num_buffers; i++) {
27229e2dbd4SRam Kishore Vegesna 		uint32_t num_bytes = MIN(rem_bytes, OCS_MAX_DMA_ALLOC);
27329e2dbd4SRam Kishore Vegesna 
27429e2dbd4SRam Kishore Vegesna 		rc = ocs_dma_alloc(ocs, &dump_buffers[i], num_bytes,
27529e2dbd4SRam Kishore Vegesna 				   OCS_MIN_DMA_ALIGNMENT);
27629e2dbd4SRam Kishore Vegesna 		if (rc) {
27729e2dbd4SRam Kishore Vegesna 			ocs_log_err(ocs, "Failed to allocate dump buffer\n");
27829e2dbd4SRam Kishore Vegesna 
27929e2dbd4SRam Kishore Vegesna 			/* Free any previously allocated buffers */
28029e2dbd4SRam Kishore Vegesna 			goto free_and_return;
28129e2dbd4SRam Kishore Vegesna 		}
28229e2dbd4SRam Kishore Vegesna 		rem_bytes -= num_bytes;
28329e2dbd4SRam Kishore Vegesna 	}
28429e2dbd4SRam Kishore Vegesna 
28529e2dbd4SRam Kishore Vegesna 	rc = ocs_hw_set_dump_location(&ocs->hw, num_buffers, dump_buffers, 0);
28629e2dbd4SRam Kishore Vegesna 	if (rc) {
28729e2dbd4SRam Kishore Vegesna 		ocs_log_test(ocs, "ocs_hw_set_dump_location failed\n");
28829e2dbd4SRam Kishore Vegesna 		goto free_and_return;
28929e2dbd4SRam Kishore Vegesna 	}
29029e2dbd4SRam Kishore Vegesna 
29129e2dbd4SRam Kishore Vegesna 	/* Generate the dump */
29229e2dbd4SRam Kishore Vegesna 	rc = ocs_gen_dump(ocs);
29329e2dbd4SRam Kishore Vegesna 	if (rc) {
29429e2dbd4SRam Kishore Vegesna 		ocs_log_test(ocs, "ocs_gen_dump failed\n");
29529e2dbd4SRam Kishore Vegesna 		goto free_and_return;
29629e2dbd4SRam Kishore Vegesna 	}
29729e2dbd4SRam Kishore Vegesna 
29829e2dbd4SRam Kishore Vegesna 	/* Copy the dump from the DMA buffer into the user buffer */
29929e2dbd4SRam Kishore Vegesna 	offset = 0;
30029e2dbd4SRam Kishore Vegesna 	for (i = 0; i < num_buffers; i++) {
30129e2dbd4SRam Kishore Vegesna 		if (ocs_copy_to_user((uint8_t*)buf + offset,
30229e2dbd4SRam Kishore Vegesna 		    dump_buffers[i].virt, dump_buffers[i].size)) {
30329e2dbd4SRam Kishore Vegesna 			ocs_log_test(ocs, "ocs_copy_to_user failed\n");
30429e2dbd4SRam Kishore Vegesna 			rc = -1;
30529e2dbd4SRam Kishore Vegesna 		}
30629e2dbd4SRam Kishore Vegesna 		offset += dump_buffers[i].size;
30729e2dbd4SRam Kishore Vegesna 	}
30829e2dbd4SRam Kishore Vegesna 
30929e2dbd4SRam Kishore Vegesna free_and_return:
31029e2dbd4SRam Kishore Vegesna 	/* Free the DMA buffer and return */
31129e2dbd4SRam Kishore Vegesna 	for (i = 0; i < num_buffers; i++) {
31229e2dbd4SRam Kishore Vegesna 		ocs_dma_free(ocs, &dump_buffers[i]);
31329e2dbd4SRam Kishore Vegesna 	}
31429e2dbd4SRam Kishore Vegesna 	ocs_free(ocs, dump_buffers, sizeof(ocs_dma_t) * num_buffers);
31529e2dbd4SRam Kishore Vegesna 	return rc;
31629e2dbd4SRam Kishore Vegesna }
31729e2dbd4SRam Kishore Vegesna 
31829e2dbd4SRam Kishore Vegesna int
ocs_function_speciic_dump(ocs_t * ocs,void * buf,uint32_t buflen)31929e2dbd4SRam Kishore Vegesna ocs_function_speciic_dump(ocs_t *ocs, void *buf, uint32_t buflen)
32029e2dbd4SRam Kishore Vegesna {
32129e2dbd4SRam Kishore Vegesna 	int rc;
32229e2dbd4SRam Kishore Vegesna 	uint32_t i, num_buffers;
32329e2dbd4SRam Kishore Vegesna 	ocs_dma_t *dump_buffers;
32429e2dbd4SRam Kishore Vegesna 	uint32_t rem_bytes, offset;
32529e2dbd4SRam Kishore Vegesna 
32629e2dbd4SRam Kishore Vegesna 	if (buflen == 0) {
32729e2dbd4SRam Kishore Vegesna 		ocs_log_err(ocs, "zero buffer length is invalid\n");
32829e2dbd4SRam Kishore Vegesna 		return -1;
32929e2dbd4SRam Kishore Vegesna 	}
33029e2dbd4SRam Kishore Vegesna 
33129e2dbd4SRam Kishore Vegesna 	num_buffers = ((buflen + OCS_MAX_DMA_ALLOC - 1) / OCS_MAX_DMA_ALLOC);
33229e2dbd4SRam Kishore Vegesna 
33329e2dbd4SRam Kishore Vegesna 	dump_buffers = ocs_malloc(ocs, sizeof(ocs_dma_t) * num_buffers,
33429e2dbd4SRam Kishore Vegesna 				  OCS_M_ZERO | OCS_M_NOWAIT);
33529e2dbd4SRam Kishore Vegesna 	if (dump_buffers == NULL) {
33629e2dbd4SRam Kishore Vegesna 		ocs_log_err(ocs, "Failed to allocate dump buffers\n");
33729e2dbd4SRam Kishore Vegesna 		return -1;
33829e2dbd4SRam Kishore Vegesna 	}
33929e2dbd4SRam Kishore Vegesna 
34029e2dbd4SRam Kishore Vegesna 	/* Allocate a DMA buffers to hold the dump */
34129e2dbd4SRam Kishore Vegesna 	rem_bytes = buflen;
34229e2dbd4SRam Kishore Vegesna 	for (i = 0; i < num_buffers; i++) {
34329e2dbd4SRam Kishore Vegesna 		uint32_t num_bytes = MIN(rem_bytes, OCS_MAX_DMA_ALLOC);
34429e2dbd4SRam Kishore Vegesna 		rc = ocs_dma_alloc(ocs, &dump_buffers[i], num_bytes,
34529e2dbd4SRam Kishore Vegesna 				   OCS_MIN_DMA_ALIGNMENT);
34629e2dbd4SRam Kishore Vegesna 		if (rc) {
34729e2dbd4SRam Kishore Vegesna 			ocs_log_err(ocs, "Failed to allocate dma buffer\n");
34829e2dbd4SRam Kishore Vegesna 
34929e2dbd4SRam Kishore Vegesna 			/* Free any previously allocated buffers */
35029e2dbd4SRam Kishore Vegesna 			goto free_and_return;
35129e2dbd4SRam Kishore Vegesna 		}
35229e2dbd4SRam Kishore Vegesna 		rem_bytes -= num_bytes;
35329e2dbd4SRam Kishore Vegesna 	}
35429e2dbd4SRam Kishore Vegesna 
35529e2dbd4SRam Kishore Vegesna 	/* register buffers for function spcific dump */
35629e2dbd4SRam Kishore Vegesna 	rc = ocs_hw_set_dump_location(&ocs->hw, num_buffers, dump_buffers, 1);
35729e2dbd4SRam Kishore Vegesna 	if (rc) {
35829e2dbd4SRam Kishore Vegesna 		ocs_log_err(ocs, "ocs_hw_set_dump_location failed\n");
35929e2dbd4SRam Kishore Vegesna 		goto free_and_return;
36029e2dbd4SRam Kishore Vegesna 	}
36129e2dbd4SRam Kishore Vegesna 
36229e2dbd4SRam Kishore Vegesna 	/* Invoke dump by setting fdd=1 and ip=1 in sliport_control register */
36329e2dbd4SRam Kishore Vegesna 	rc = ocs_fdb_dump(ocs);
36429e2dbd4SRam Kishore Vegesna 	if (rc) {
36529e2dbd4SRam Kishore Vegesna 		ocs_log_err(ocs, "ocs_gen_dump failed\n");
36629e2dbd4SRam Kishore Vegesna 		goto free_and_return;
36729e2dbd4SRam Kishore Vegesna 	}
36829e2dbd4SRam Kishore Vegesna 
36929e2dbd4SRam Kishore Vegesna 	/* Copy the dump from the DMA buffer into the user buffer */
37029e2dbd4SRam Kishore Vegesna 	offset = 0;
37129e2dbd4SRam Kishore Vegesna 	for (i = 0; i < num_buffers; i++) {
37229e2dbd4SRam Kishore Vegesna 		if (ocs_copy_to_user((uint8_t*)buf + offset,
37329e2dbd4SRam Kishore Vegesna 		    dump_buffers[i].virt, dump_buffers[i].size)) {
37429e2dbd4SRam Kishore Vegesna 			ocs_log_err(ocs, "ocs_copy_to_user failed\n");
37529e2dbd4SRam Kishore Vegesna 			rc = -1;
37629e2dbd4SRam Kishore Vegesna 		}
37729e2dbd4SRam Kishore Vegesna 		offset += dump_buffers[i].size;
37829e2dbd4SRam Kishore Vegesna 	}
37929e2dbd4SRam Kishore Vegesna 
38029e2dbd4SRam Kishore Vegesna free_and_return:
38129e2dbd4SRam Kishore Vegesna 	/* Free the DMA buffer and return */
38229e2dbd4SRam Kishore Vegesna 	for (i = 0; i < num_buffers; i++) {
38329e2dbd4SRam Kishore Vegesna 		ocs_dma_free(ocs, &dump_buffers[i]);
38429e2dbd4SRam Kishore Vegesna 	}
38529e2dbd4SRam Kishore Vegesna 	ocs_free(ocs, dump_buffers, sizeof(ocs_dma_t) * num_buffers);
38629e2dbd4SRam Kishore Vegesna 	return rc;
38729e2dbd4SRam Kishore Vegesna 
38829e2dbd4SRam Kishore Vegesna }
389