xref: /wlan-driver/qcacld-3.0/core/cds/src/cds_packet.c (revision 5113495b16420b49004c444715d2daae2066e7dc)
1*5113495bSYour Name /*
2*5113495bSYour Name  * Copyright (c) 2014-2016, 2018-2020 The Linux Foundation. All rights reserved.
3*5113495bSYour Name  * Copyright (c) 2023 Qualcomm Innovation Center, Inc. All rights reserved.
4*5113495bSYour Name  *
5*5113495bSYour Name  * Permission to use, copy, modify, and/or distribute this software for
6*5113495bSYour Name  * any purpose with or without fee is hereby granted, provided that the
7*5113495bSYour Name  * above copyright notice and this permission notice appear in all
8*5113495bSYour Name  * copies.
9*5113495bSYour Name  *
10*5113495bSYour Name  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL
11*5113495bSYour Name  * WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED
12*5113495bSYour Name  * WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE
13*5113495bSYour Name  * AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL
14*5113495bSYour Name  * DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR
15*5113495bSYour Name  * PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER
16*5113495bSYour Name  * TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
17*5113495bSYour Name  * PERFORMANCE OF THIS SOFTWARE.
18*5113495bSYour Name  */
19*5113495bSYour Name 
20*5113495bSYour Name /**
21*5113495bSYour Name  * DOC: cds_packet.c
22*5113495bSYour Name  *      Connectivity driver services (CDS) network Packet APIs
23*5113495bSYour Name  *      Network Protocol packet/buffer support interfaces
24*5113495bSYour Name  */
25*5113495bSYour Name 
26*5113495bSYour Name #include <cds_packet.h>
27*5113495bSYour Name #include <i_cds_packet.h>
28*5113495bSYour Name #include <qdf_mc_timer.h>
29*5113495bSYour Name #include <qdf_trace.h>
30*5113495bSYour Name #include <wlan_hdd_main.h>
31*5113495bSYour Name #include "qdf_nbuf.h"
32*5113495bSYour Name #include "qdf_mem.h"
33*5113495bSYour Name #include "cds_utils.h"
34*5113495bSYour Name 
35*5113495bSYour Name #define TX_PKT_MIN_HEADROOM          (64)
36*5113495bSYour Name 
cds_pkt_return_packet(cds_pkt_t * packet)37*5113495bSYour Name QDF_STATUS cds_pkt_return_packet(cds_pkt_t *packet)
38*5113495bSYour Name {
39*5113495bSYour Name 	/* Validate the input parameter pointer */
40*5113495bSYour Name 	if (unlikely(!packet)) {
41*5113495bSYour Name 		return QDF_STATUS_E_INVAL;
42*5113495bSYour Name 	}
43*5113495bSYour Name 
44*5113495bSYour Name 	/* Free up the qdf nbuf */
45*5113495bSYour Name 	qdf_nbuf_free(packet->pkt_buf);
46*5113495bSYour Name 
47*5113495bSYour Name 	packet->pkt_buf = NULL;
48*5113495bSYour Name 
49*5113495bSYour Name 	/* Free up the Rx packet */
50*5113495bSYour Name 	qdf_mem_free(packet);
51*5113495bSYour Name 
52*5113495bSYour Name 	return QDF_STATUS_SUCCESS;
53*5113495bSYour Name }
54*5113495bSYour Name 
55*5113495bSYour Name QDF_STATUS
cds_pkt_get_packet_length(cds_pkt_t * pPacket,uint16_t * pPacketSize)56*5113495bSYour Name cds_pkt_get_packet_length(cds_pkt_t *pPacket, uint16_t *pPacketSize)
57*5113495bSYour Name {
58*5113495bSYour Name 	/* Validate the parameter pointers */
59*5113495bSYour Name 	if (unlikely((!pPacket) || (!pPacketSize)) ||
60*5113495bSYour Name 	    (!pPacket->pkt_buf)) {
61*5113495bSYour Name 		cds_alert("NULL pointer");
62*5113495bSYour Name 		return QDF_STATUS_E_INVAL;
63*5113495bSYour Name 	}
64*5113495bSYour Name 	/* return the requested information */
65*5113495bSYour Name 	*pPacketSize = qdf_nbuf_len(pPacket->pkt_buf);
66*5113495bSYour Name 	return QDF_STATUS_SUCCESS;
67*5113495bSYour Name }
68*5113495bSYour Name 
69*5113495bSYour Name #ifdef MEMORY_DEBUG
cds_packet_alloc_debug(uint16_t size,void ** data,void ** ppPacket,const char * func_name,uint32_t line_num)70*5113495bSYour Name QDF_STATUS cds_packet_alloc_debug(uint16_t size, void **data, void **ppPacket,
71*5113495bSYour Name 				  const char *func_name, uint32_t line_num)
72*5113495bSYour Name {
73*5113495bSYour Name 	QDF_STATUS qdf_ret_status = QDF_STATUS_E_FAILURE;
74*5113495bSYour Name 	qdf_nbuf_t nbuf;
75*5113495bSYour Name 
76*5113495bSYour Name 	nbuf = qdf_nbuf_alloc_debug(NULL,
77*5113495bSYour Name 		roundup(size + TX_PKT_MIN_HEADROOM, 4),
78*5113495bSYour Name 		TX_PKT_MIN_HEADROOM, sizeof(uint32_t), false,
79*5113495bSYour Name 				     func_name, line_num);
80*5113495bSYour Name 
81*5113495bSYour Name 	if (nbuf) {
82*5113495bSYour Name 		qdf_nbuf_put_tail(nbuf, size);
83*5113495bSYour Name 		qdf_nbuf_set_protocol(nbuf, ETH_P_CONTROL);
84*5113495bSYour Name 		*ppPacket = nbuf;
85*5113495bSYour Name 		*data = qdf_nbuf_data(nbuf);
86*5113495bSYour Name 		qdf_ret_status = QDF_STATUS_SUCCESS;
87*5113495bSYour Name 	}
88*5113495bSYour Name 
89*5113495bSYour Name 	return qdf_ret_status;
90*5113495bSYour Name }
91*5113495bSYour Name #else
cds_packet_alloc(uint16_t size,void ** data,void ** ppPacket)92*5113495bSYour Name QDF_STATUS cds_packet_alloc(uint16_t size, void **data, void **ppPacket)
93*5113495bSYour Name {
94*5113495bSYour Name 	QDF_STATUS qdf_ret_status = QDF_STATUS_E_FAILURE;
95*5113495bSYour Name 	qdf_nbuf_t nbuf;
96*5113495bSYour Name 
97*5113495bSYour Name 	nbuf = qdf_nbuf_alloc(NULL, roundup(size + TX_PKT_MIN_HEADROOM, 4),
98*5113495bSYour Name 			      TX_PKT_MIN_HEADROOM, sizeof(uint32_t), false);
99*5113495bSYour Name 
100*5113495bSYour Name 	if (nbuf) {
101*5113495bSYour Name 		qdf_nbuf_put_tail(nbuf, size);
102*5113495bSYour Name 		qdf_nbuf_set_protocol(nbuf, ETH_P_CONTROL);
103*5113495bSYour Name 		*ppPacket = nbuf;
104*5113495bSYour Name 		*data = qdf_nbuf_data(nbuf);
105*5113495bSYour Name 		qdf_ret_status = QDF_STATUS_SUCCESS;
106*5113495bSYour Name 	}
107*5113495bSYour Name 
108*5113495bSYour Name 	return qdf_ret_status;
109*5113495bSYour Name }
110*5113495bSYour Name 
111*5113495bSYour Name #endif
112*5113495bSYour Name 
cds_packet_free(void * pPacket)113*5113495bSYour Name void cds_packet_free(void *pPacket)
114*5113495bSYour Name {
115*5113495bSYour Name 	qdf_nbuf_free((qdf_nbuf_t) pPacket);
116*5113495bSYour Name }
117