xref: /OK3568_Linux_fs/kernel/drivers/net/ethernet/chelsio/cxgb4/cudbg_common.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-only
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  *  Copyright (C) 2017 Chelsio Communications.  All rights reserved.
4*4882a593Smuzhiyun  */
5*4882a593Smuzhiyun 
6*4882a593Smuzhiyun #include "cxgb4.h"
7*4882a593Smuzhiyun #include "cudbg_if.h"
8*4882a593Smuzhiyun #include "cudbg_lib_common.h"
9*4882a593Smuzhiyun 
cudbg_get_buff(struct cudbg_init * pdbg_init,struct cudbg_buffer * pdbg_buff,u32 size,struct cudbg_buffer * pin_buff)10*4882a593Smuzhiyun int cudbg_get_buff(struct cudbg_init *pdbg_init,
11*4882a593Smuzhiyun 		   struct cudbg_buffer *pdbg_buff, u32 size,
12*4882a593Smuzhiyun 		   struct cudbg_buffer *pin_buff)
13*4882a593Smuzhiyun {
14*4882a593Smuzhiyun 	u32 offset;
15*4882a593Smuzhiyun 
16*4882a593Smuzhiyun 	offset = pdbg_buff->offset;
17*4882a593Smuzhiyun 	if (offset + size > pdbg_buff->size)
18*4882a593Smuzhiyun 		return CUDBG_STATUS_NO_MEM;
19*4882a593Smuzhiyun 
20*4882a593Smuzhiyun 	if (pdbg_init->compress_type != CUDBG_COMPRESSION_NONE) {
21*4882a593Smuzhiyun 		if (size > pdbg_init->compress_buff_size)
22*4882a593Smuzhiyun 			return CUDBG_STATUS_NO_MEM;
23*4882a593Smuzhiyun 
24*4882a593Smuzhiyun 		pin_buff->data = (char *)pdbg_init->compress_buff;
25*4882a593Smuzhiyun 		pin_buff->offset = 0;
26*4882a593Smuzhiyun 		pin_buff->size = size;
27*4882a593Smuzhiyun 		return 0;
28*4882a593Smuzhiyun 	}
29*4882a593Smuzhiyun 
30*4882a593Smuzhiyun 	pin_buff->data = (char *)pdbg_buff->data + offset;
31*4882a593Smuzhiyun 	pin_buff->offset = offset;
32*4882a593Smuzhiyun 	pin_buff->size = size;
33*4882a593Smuzhiyun 	return 0;
34*4882a593Smuzhiyun }
35*4882a593Smuzhiyun 
cudbg_put_buff(struct cudbg_init * pdbg_init,struct cudbg_buffer * pin_buff)36*4882a593Smuzhiyun void cudbg_put_buff(struct cudbg_init *pdbg_init,
37*4882a593Smuzhiyun 		    struct cudbg_buffer *pin_buff)
38*4882a593Smuzhiyun {
39*4882a593Smuzhiyun 	/* Clear compression buffer for re-use */
40*4882a593Smuzhiyun 	if (pdbg_init->compress_type != CUDBG_COMPRESSION_NONE)
41*4882a593Smuzhiyun 		memset(pdbg_init->compress_buff, 0,
42*4882a593Smuzhiyun 		       pdbg_init->compress_buff_size);
43*4882a593Smuzhiyun 
44*4882a593Smuzhiyun 	pin_buff->data = NULL;
45*4882a593Smuzhiyun 	pin_buff->offset = 0;
46*4882a593Smuzhiyun 	pin_buff->size = 0;
47*4882a593Smuzhiyun }
48*4882a593Smuzhiyun 
cudbg_update_buff(struct cudbg_buffer * pin_buff,struct cudbg_buffer * pout_buff)49*4882a593Smuzhiyun void cudbg_update_buff(struct cudbg_buffer *pin_buff,
50*4882a593Smuzhiyun 		       struct cudbg_buffer *pout_buff)
51*4882a593Smuzhiyun {
52*4882a593Smuzhiyun 	/* We already write to buffer provided by ethool, so just
53*4882a593Smuzhiyun 	 * increment offset to next free space.
54*4882a593Smuzhiyun 	 */
55*4882a593Smuzhiyun 	pout_buff->offset += pin_buff->size;
56*4882a593Smuzhiyun }
57