xref: /wlan-driver/qcacld-3.0/components/pmo/dispatcher/src/wlan_pmo_tgt_pkt_filter.c (revision 5113495b16420b49004c444715d2daae2066e7dc)
1 /*
2  * Copyright (c) 2017-2020 The Linux Foundation. All rights reserved.
3  *
4  * Permission to use, copy, modify, and/or distribute this software for
5  * any purpose with or without fee is hereby granted, provided that the
6  * above copyright notice and this permission notice appear in all
7  * copies.
8  *
9  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL
10  * WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED
11  * WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE
12  * AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL
13  * DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR
14  * PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER
15  * TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
16  * PERFORMANCE OF THIS SOFTWARE.
17  */
18 
19 /**
20  * DOC: Implements public API for pmo to interact with target/WMI
21  */
22 
23 #include "wlan_pmo_tgt_api.h"
24 #include "wlan_pmo_pkt_filter_public_struct.h"
25 #include "wlan_pmo_obj_mgmt_public_struct.h"
26 #include "wlan_pmo_main.h"
27 
pmo_tgt_set_pkt_filter(struct wlan_objmgr_vdev * vdev,struct pmo_rcv_pkt_fltr_cfg * pmo_set_pkt_fltr_req,uint8_t vdev_id)28 QDF_STATUS pmo_tgt_set_pkt_filter(struct wlan_objmgr_vdev *vdev,
29 		struct pmo_rcv_pkt_fltr_cfg *pmo_set_pkt_fltr_req,
30 		uint8_t vdev_id)
31 {
32 	QDF_STATUS status;
33 	struct pmo_rcv_pkt_fltr_cfg *request_buf = NULL;
34 	struct wlan_objmgr_psoc *psoc;
35 	struct wlan_pmo_tx_ops pmo_tx_ops;
36 	struct qdf_mac_addr peer_bssid;
37 
38 	pmo_enter();
39 
40 	psoc = wlan_vdev_get_psoc(vdev);
41 	if (!psoc) {
42 		pmo_err("psoc unavailable for vdev %pK", vdev);
43 		status = QDF_STATUS_E_NULL_VALUE;
44 		goto out;
45 	}
46 
47 	pmo_debug("filter_type=%d, filter_id = %d",
48 		  pmo_set_pkt_fltr_req->filter_type,
49 		  pmo_set_pkt_fltr_req->filter_id);
50 
51 	request_buf = qdf_mem_malloc(sizeof(*request_buf));
52 	if (!request_buf) {
53 		status = QDF_STATUS_E_NOMEM;
54 		goto out;
55 	}
56 
57 	status = pmo_get_vdev_bss_peer_mac_addr(vdev,
58 			&peer_bssid);
59 	if (status != QDF_STATUS_SUCCESS) {
60 		status = QDF_STATUS_E_INVAL;
61 		goto out;
62 	}
63 
64 	qdf_mem_copy(request_buf, pmo_set_pkt_fltr_req, sizeof(*request_buf));
65 
66 	qdf_mem_copy(&request_buf->self_macaddr.bytes,
67 			  wlan_vdev_mlme_get_macaddr(vdev),
68 			  QDF_MAC_ADDR_SIZE);
69 
70 	qdf_copy_macaddr(&pmo_set_pkt_fltr_req->bssid,
71 				&peer_bssid);
72 
73 	pmo_tx_ops = GET_PMO_TX_OPS_FROM_PSOC(psoc);
74 	if (!pmo_tx_ops.send_set_pkt_filter) {
75 		pmo_err("send_set_pkt_filter is null");
76 		status = QDF_STATUS_E_NULL_VALUE;
77 		goto out;
78 	}
79 
80 	status = pmo_tx_ops.send_set_pkt_filter(vdev, request_buf);
81 	if (status != QDF_STATUS_SUCCESS)
82 		goto out;
83 
84 out:
85 	if (request_buf)
86 		qdf_mem_free(request_buf);
87 	pmo_exit();
88 
89 	return status;
90 }
91 
pmo_tgt_clear_pkt_filter(struct wlan_objmgr_vdev * vdev,struct pmo_rcv_pkt_fltr_clear_param * pmo_clr_pkt_fltr_param,uint8_t vdev_id)92 QDF_STATUS pmo_tgt_clear_pkt_filter(struct wlan_objmgr_vdev *vdev,
93 		struct pmo_rcv_pkt_fltr_clear_param *pmo_clr_pkt_fltr_param,
94 		uint8_t vdev_id)
95 {
96 	QDF_STATUS status;
97 	struct pmo_rcv_pkt_fltr_clear_param *request_buf = NULL;
98 	struct wlan_objmgr_psoc *psoc;
99 	struct wlan_pmo_tx_ops pmo_tx_ops;
100 	struct qdf_mac_addr peer_bssid;
101 
102 	pmo_enter();
103 
104 	psoc = wlan_vdev_get_psoc(vdev);
105 	if (!psoc) {
106 		pmo_err("psoc unavailable for vdev %pK", vdev);
107 		status = QDF_STATUS_E_NULL_VALUE;
108 		goto out;
109 	}
110 
111 	pmo_debug("filter_id = %d", pmo_clr_pkt_fltr_param->filter_id);
112 
113 	request_buf = qdf_mem_malloc(sizeof(*request_buf));
114 	if (!request_buf) {
115 		status = QDF_STATUS_E_NOMEM;
116 		goto out;
117 	}
118 
119 	status = pmo_get_vdev_bss_peer_mac_addr(vdev,
120 			&peer_bssid);
121 	if (status != QDF_STATUS_SUCCESS) {
122 		status = QDF_STATUS_E_INVAL;
123 		goto out;
124 	}
125 
126 	qdf_mem_copy(request_buf, pmo_clr_pkt_fltr_param, sizeof(*request_buf));
127 
128 	qdf_mem_copy(&request_buf->self_macaddr.bytes,
129 			  wlan_vdev_mlme_get_macaddr(vdev),
130 			  QDF_MAC_ADDR_SIZE);
131 
132 	qdf_copy_macaddr(&pmo_clr_pkt_fltr_param->bssid,
133 			 &peer_bssid);
134 
135 	pmo_tx_ops = GET_PMO_TX_OPS_FROM_PSOC(psoc);
136 	if (!pmo_tx_ops.send_clear_pkt_filter) {
137 		pmo_err("send_clear_pkt_filter is null");
138 		status = QDF_STATUS_E_NULL_VALUE;
139 		goto out;
140 	}
141 
142 	status = pmo_tx_ops.send_clear_pkt_filter(vdev, request_buf);
143 	if (status != QDF_STATUS_SUCCESS)
144 		goto out;
145 
146 out:
147 	if (request_buf)
148 		qdf_mem_free(request_buf);
149 	pmo_exit();
150 
151 	return status;
152 }
153 
154