1*5113495bSYour Name /*
2*5113495bSYour Name * Copyright (c) 2013-2018, 2020 The Linux Foundation. All rights reserved.
3*5113495bSYour Name * Copyright (c) 2022-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 #include <osdep.h>
21*5113495bSYour Name #include <wmi.h>
22*5113495bSYour Name #include <wmi_unified_priv.h>
23*5113495bSYour Name #include <wmi_unified_p2p_api.h>
24*5113495bSYour Name
25*5113495bSYour Name /**
26*5113495bSYour Name * send_set_p2pgo_noa_req_cmd_tlv() - send p2p go noa request to fw
27*5113495bSYour Name * @wmi_handle: wmi handle
28*5113495bSYour Name * @noa: p2p power save parameters
29*5113495bSYour Name *
30*5113495bSYour Name * Return: QDF status
31*5113495bSYour Name */
send_set_p2pgo_noa_req_cmd_tlv(wmi_unified_t wmi_handle,struct p2p_ps_params * noa)32*5113495bSYour Name static QDF_STATUS send_set_p2pgo_noa_req_cmd_tlv(wmi_unified_t wmi_handle,
33*5113495bSYour Name struct p2p_ps_params *noa)
34*5113495bSYour Name {
35*5113495bSYour Name wmi_p2p_set_noa_cmd_fixed_param *cmd;
36*5113495bSYour Name wmi_p2p_noa_descriptor *noa_discriptor;
37*5113495bSYour Name wmi_buf_t buf;
38*5113495bSYour Name uint8_t *buf_ptr;
39*5113495bSYour Name uint16_t len;
40*5113495bSYour Name QDF_STATUS status;
41*5113495bSYour Name uint32_t duration;
42*5113495bSYour Name
43*5113495bSYour Name len = sizeof(*cmd) + WMI_TLV_HDR_SIZE + sizeof(*noa_discriptor);
44*5113495bSYour Name buf = wmi_buf_alloc(wmi_handle, len);
45*5113495bSYour Name if (!buf) {
46*5113495bSYour Name status = QDF_STATUS_E_FAILURE;
47*5113495bSYour Name goto end;
48*5113495bSYour Name }
49*5113495bSYour Name
50*5113495bSYour Name buf_ptr = (uint8_t *)wmi_buf_data(buf);
51*5113495bSYour Name cmd = (wmi_p2p_set_noa_cmd_fixed_param *)buf_ptr;
52*5113495bSYour Name WMITLV_SET_HDR(&cmd->tlv_header,
53*5113495bSYour Name WMITLV_TAG_STRUC_wmi_p2p_set_noa_cmd_fixed_param,
54*5113495bSYour Name WMITLV_GET_STRUCT_TLVLEN
55*5113495bSYour Name (wmi_p2p_set_noa_cmd_fixed_param));
56*5113495bSYour Name duration = (noa->count == 1) ? noa->single_noa_duration : noa->duration;
57*5113495bSYour Name cmd->vdev_id = noa->session_id;
58*5113495bSYour Name cmd->enable = (duration) ? true : false;
59*5113495bSYour Name cmd->num_noa = 1;
60*5113495bSYour Name
61*5113495bSYour Name WMITLV_SET_HDR((buf_ptr + sizeof(wmi_p2p_set_noa_cmd_fixed_param)),
62*5113495bSYour Name WMITLV_TAG_ARRAY_STRUC, sizeof(wmi_p2p_noa_descriptor));
63*5113495bSYour Name noa_discriptor = (wmi_p2p_noa_descriptor *)(buf_ptr +
64*5113495bSYour Name sizeof
65*5113495bSYour Name (wmi_p2p_set_noa_cmd_fixed_param)
66*5113495bSYour Name + WMI_TLV_HDR_SIZE);
67*5113495bSYour Name WMITLV_SET_HDR(&noa_discriptor->tlv_header,
68*5113495bSYour Name WMITLV_TAG_STRUC_wmi_p2p_noa_descriptor,
69*5113495bSYour Name WMITLV_GET_STRUCT_TLVLEN(wmi_p2p_noa_descriptor));
70*5113495bSYour Name noa_discriptor->type_count = noa->count;
71*5113495bSYour Name noa_discriptor->duration = duration;
72*5113495bSYour Name noa_discriptor->interval = noa->interval;
73*5113495bSYour Name noa_discriptor->start_time = noa->start;
74*5113495bSYour Name
75*5113495bSYour Name wmi_debug("SET P2P GO NOA:vdev_id:%d count:%d duration:%d interval:%d start:%d",
76*5113495bSYour Name cmd->vdev_id, noa->count, noa_discriptor->duration,
77*5113495bSYour Name noa->interval, noa->start);
78*5113495bSYour Name wmi_mtrace(WMI_FWTEST_P2P_SET_NOA_PARAM_CMDID, cmd->vdev_id, 0);
79*5113495bSYour Name status = wmi_unified_cmd_send(wmi_handle, buf, len,
80*5113495bSYour Name WMI_FWTEST_P2P_SET_NOA_PARAM_CMDID);
81*5113495bSYour Name if (QDF_IS_STATUS_ERROR(status)) {
82*5113495bSYour Name wmi_err("Failed to send WMI_FWTEST_P2P_SET_NOA_PARAM_CMDID");
83*5113495bSYour Name wmi_buf_free(buf);
84*5113495bSYour Name }
85*5113495bSYour Name
86*5113495bSYour Name end:
87*5113495bSYour Name return status;
88*5113495bSYour Name }
89*5113495bSYour Name
90*5113495bSYour Name /**
91*5113495bSYour Name * send_set_p2pgo_oppps_req_cmd_tlv() - send p2p go opp power save request to fw
92*5113495bSYour Name * @wmi_handle: wmi handle
93*5113495bSYour Name * @oppps: p2p opp power save parameters
94*5113495bSYour Name *
95*5113495bSYour Name * Return: QDF status
96*5113495bSYour Name */
send_set_p2pgo_oppps_req_cmd_tlv(wmi_unified_t wmi_handle,struct p2p_ps_params * oppps)97*5113495bSYour Name static QDF_STATUS send_set_p2pgo_oppps_req_cmd_tlv(wmi_unified_t wmi_handle,
98*5113495bSYour Name struct p2p_ps_params *oppps)
99*5113495bSYour Name {
100*5113495bSYour Name wmi_p2p_set_oppps_cmd_fixed_param *cmd;
101*5113495bSYour Name wmi_buf_t buf;
102*5113495bSYour Name QDF_STATUS status;
103*5113495bSYour Name
104*5113495bSYour Name buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
105*5113495bSYour Name if (!buf) {
106*5113495bSYour Name status = QDF_STATUS_E_FAILURE;
107*5113495bSYour Name goto end;
108*5113495bSYour Name }
109*5113495bSYour Name
110*5113495bSYour Name cmd = (wmi_p2p_set_oppps_cmd_fixed_param *) wmi_buf_data(buf);
111*5113495bSYour Name WMITLV_SET_HDR(&cmd->tlv_header,
112*5113495bSYour Name WMITLV_TAG_STRUC_wmi_p2p_set_oppps_cmd_fixed_param,
113*5113495bSYour Name WMITLV_GET_STRUCT_TLVLEN(
114*5113495bSYour Name wmi_p2p_set_oppps_cmd_fixed_param));
115*5113495bSYour Name cmd->vdev_id = oppps->session_id;
116*5113495bSYour Name if (oppps->ctwindow)
117*5113495bSYour Name WMI_UNIFIED_OPPPS_ATTR_ENABLED_SET(cmd);
118*5113495bSYour Name
119*5113495bSYour Name WMI_UNIFIED_OPPPS_ATTR_CTWIN_SET(cmd, oppps->ctwindow);
120*5113495bSYour Name wmi_debug("SET P2P GO OPPPS:vdev_id:%d ctwindow:%d",
121*5113495bSYour Name cmd->vdev_id, oppps->ctwindow);
122*5113495bSYour Name wmi_mtrace(WMI_P2P_SET_OPPPS_PARAM_CMDID, cmd->vdev_id, 0);
123*5113495bSYour Name status = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd),
124*5113495bSYour Name WMI_P2P_SET_OPPPS_PARAM_CMDID);
125*5113495bSYour Name if (QDF_IS_STATUS_ERROR(status)) {
126*5113495bSYour Name wmi_err("Failed to send WMI_P2P_SET_OPPPS_PARAM_CMDID");
127*5113495bSYour Name wmi_buf_free(buf);
128*5113495bSYour Name }
129*5113495bSYour Name
130*5113495bSYour Name end:
131*5113495bSYour Name return status;
132*5113495bSYour Name }
133*5113495bSYour Name
134*5113495bSYour Name /**
135*5113495bSYour Name * extract_p2p_noa_ev_param_tlv() - extract p2p noa information from event
136*5113495bSYour Name * @wmi_handle: wmi handle
137*5113495bSYour Name * @evt_buf: pointer to event buffer
138*5113495bSYour Name * @param: Pointer to hold p2p noa info
139*5113495bSYour Name *
140*5113495bSYour Name * Return: QDF_STATUS_SUCCESS for success or error code
141*5113495bSYour Name */
extract_p2p_noa_ev_param_tlv(wmi_unified_t wmi_handle,void * evt_buf,struct p2p_noa_info * param)142*5113495bSYour Name static QDF_STATUS extract_p2p_noa_ev_param_tlv(
143*5113495bSYour Name wmi_unified_t wmi_handle, void *evt_buf,
144*5113495bSYour Name struct p2p_noa_info *param)
145*5113495bSYour Name {
146*5113495bSYour Name WMI_P2P_NOA_EVENTID_param_tlvs *param_tlvs;
147*5113495bSYour Name wmi_p2p_noa_event_fixed_param *fixed_param;
148*5113495bSYour Name uint8_t i;
149*5113495bSYour Name wmi_p2p_noa_info *wmi_noa_info;
150*5113495bSYour Name uint8_t *buf_ptr;
151*5113495bSYour Name uint32_t descriptors;
152*5113495bSYour Name
153*5113495bSYour Name param_tlvs = (WMI_P2P_NOA_EVENTID_param_tlvs *)evt_buf;
154*5113495bSYour Name if (!param_tlvs) {
155*5113495bSYour Name wmi_err("Invalid P2P NoA event buffer");
156*5113495bSYour Name return QDF_STATUS_E_INVAL;
157*5113495bSYour Name }
158*5113495bSYour Name
159*5113495bSYour Name if (!param) {
160*5113495bSYour Name wmi_err("noa information param is null");
161*5113495bSYour Name return QDF_STATUS_E_INVAL;
162*5113495bSYour Name }
163*5113495bSYour Name
164*5113495bSYour Name fixed_param = param_tlvs->fixed_param;
165*5113495bSYour Name buf_ptr = (uint8_t *) fixed_param;
166*5113495bSYour Name buf_ptr += sizeof(wmi_p2p_noa_event_fixed_param);
167*5113495bSYour Name wmi_noa_info = (wmi_p2p_noa_info *) (buf_ptr);
168*5113495bSYour Name
169*5113495bSYour Name if (!WMI_UNIFIED_NOA_ATTR_IS_MODIFIED(wmi_noa_info)) {
170*5113495bSYour Name wmi_err("noa attr is not modified");
171*5113495bSYour Name return QDF_STATUS_E_INVAL;
172*5113495bSYour Name }
173*5113495bSYour Name
174*5113495bSYour Name param->vdev_id = fixed_param->vdev_id;
175*5113495bSYour Name param->index =
176*5113495bSYour Name (uint8_t)WMI_UNIFIED_NOA_ATTR_INDEX_GET(wmi_noa_info);
177*5113495bSYour Name param->opps_ps =
178*5113495bSYour Name (uint8_t)WMI_UNIFIED_NOA_ATTR_OPP_PS_GET(wmi_noa_info);
179*5113495bSYour Name param->ct_window =
180*5113495bSYour Name (uint8_t)WMI_UNIFIED_NOA_ATTR_CTWIN_GET(wmi_noa_info);
181*5113495bSYour Name descriptors = WMI_UNIFIED_NOA_ATTR_NUM_DESC_GET(wmi_noa_info);
182*5113495bSYour Name param->num_desc = (uint8_t)descriptors;
183*5113495bSYour Name if (param->num_desc > WMI_P2P_MAX_NOA_DESCRIPTORS) {
184*5113495bSYour Name wmi_err("Invalid num desc: %d", param->num_desc);
185*5113495bSYour Name return QDF_STATUS_E_INVAL;
186*5113495bSYour Name }
187*5113495bSYour Name
188*5113495bSYour Name wmi_debug("index %u, opps_ps %u, ct_window %u, num_descriptors = %u",
189*5113495bSYour Name param->index, param->opps_ps, param->ct_window,
190*5113495bSYour Name param->num_desc);
191*5113495bSYour Name for (i = 0; i < param->num_desc; i++) {
192*5113495bSYour Name param->noa_desc[i].type_count =
193*5113495bSYour Name (uint8_t)wmi_noa_info->noa_descriptors[i].
194*5113495bSYour Name type_count;
195*5113495bSYour Name param->noa_desc[i].duration =
196*5113495bSYour Name wmi_noa_info->noa_descriptors[i].duration;
197*5113495bSYour Name param->noa_desc[i].interval =
198*5113495bSYour Name wmi_noa_info->noa_descriptors[i].interval;
199*5113495bSYour Name param->noa_desc[i].start_time =
200*5113495bSYour Name wmi_noa_info->noa_descriptors[i].start_time;
201*5113495bSYour Name wmi_debug("NoA descriptor[%d] type_count %u, duration %u, interval %u, start_time = %u",
202*5113495bSYour Name i, param->noa_desc[i].type_count,
203*5113495bSYour Name param->noa_desc[i].duration,
204*5113495bSYour Name param->noa_desc[i].interval,
205*5113495bSYour Name param->noa_desc[i].start_time);
206*5113495bSYour Name }
207*5113495bSYour Name
208*5113495bSYour Name return QDF_STATUS_SUCCESS;
209*5113495bSYour Name }
210*5113495bSYour Name
extract_mac_addr_rx_filter_evt_param_tlv(wmi_unified_t wmi_handle,void * evt_buf,struct p2p_set_mac_filter_evt * param)211*5113495bSYour Name static QDF_STATUS extract_mac_addr_rx_filter_evt_param_tlv(
212*5113495bSYour Name wmi_unified_t wmi_handle, void *evt_buf,
213*5113495bSYour Name struct p2p_set_mac_filter_evt *param)
214*5113495bSYour Name {
215*5113495bSYour Name WMI_VDEV_ADD_MAC_ADDR_TO_RX_FILTER_STATUS_EVENTID_param_tlvs *param_buf;
216*5113495bSYour Name wmi_vdev_add_mac_addr_to_rx_filter_status_event_fixed_param *event;
217*5113495bSYour Name
218*5113495bSYour Name param_buf =
219*5113495bSYour Name (WMI_VDEV_ADD_MAC_ADDR_TO_RX_FILTER_STATUS_EVENTID_param_tlvs *)
220*5113495bSYour Name evt_buf;
221*5113495bSYour Name if (!param_buf) {
222*5113495bSYour Name wmi_err("Invalid action frame filter mac event");
223*5113495bSYour Name return QDF_STATUS_E_INVAL;
224*5113495bSYour Name }
225*5113495bSYour Name event = param_buf->fixed_param;
226*5113495bSYour Name if (!event) {
227*5113495bSYour Name wmi_err("Invalid fixed param");
228*5113495bSYour Name return QDF_STATUS_E_INVAL;
229*5113495bSYour Name }
230*5113495bSYour Name param->vdev_id = event->vdev_id;
231*5113495bSYour Name param->status = event->status;
232*5113495bSYour Name
233*5113495bSYour Name return QDF_STATUS_SUCCESS;
234*5113495bSYour Name }
235*5113495bSYour Name
236*5113495bSYour Name #ifdef FEATURE_P2P_LISTEN_OFFLOAD
237*5113495bSYour Name /**
238*5113495bSYour Name * send_p2p_lo_start_cmd_tlv() - send p2p lo start request to fw
239*5113495bSYour Name * @wmi_handle: wmi handle
240*5113495bSYour Name * @param: p2p listen offload start parameters
241*5113495bSYour Name *
242*5113495bSYour Name * Return: QDF status
243*5113495bSYour Name */
send_p2p_lo_start_cmd_tlv(wmi_unified_t wmi_handle,struct p2p_lo_start * param)244*5113495bSYour Name static QDF_STATUS send_p2p_lo_start_cmd_tlv(wmi_unified_t wmi_handle,
245*5113495bSYour Name struct p2p_lo_start *param)
246*5113495bSYour Name {
247*5113495bSYour Name wmi_buf_t buf;
248*5113495bSYour Name wmi_p2p_lo_start_cmd_fixed_param *cmd;
249*5113495bSYour Name int32_t len = sizeof(*cmd);
250*5113495bSYour Name uint8_t *buf_ptr;
251*5113495bSYour Name QDF_STATUS status;
252*5113495bSYour Name int device_types_len_aligned;
253*5113495bSYour Name int probe_resp_len_aligned;
254*5113495bSYour Name
255*5113495bSYour Name if (!param) {
256*5113495bSYour Name wmi_err("lo start param is null");
257*5113495bSYour Name return QDF_STATUS_E_INVAL;
258*5113495bSYour Name }
259*5113495bSYour Name
260*5113495bSYour Name wmi_debug("vdev_id: %d", param->vdev_id);
261*5113495bSYour Name
262*5113495bSYour Name device_types_len_aligned =
263*5113495bSYour Name qdf_roundup(param->dev_types_len,
264*5113495bSYour Name sizeof(uint32_t));
265*5113495bSYour Name probe_resp_len_aligned =
266*5113495bSYour Name qdf_roundup(param->probe_resp_len,
267*5113495bSYour Name sizeof(uint32_t));
268*5113495bSYour Name
269*5113495bSYour Name len += 2 * WMI_TLV_HDR_SIZE + device_types_len_aligned +
270*5113495bSYour Name probe_resp_len_aligned;
271*5113495bSYour Name
272*5113495bSYour Name buf = wmi_buf_alloc(wmi_handle, len);
273*5113495bSYour Name if (!buf) {
274*5113495bSYour Name return QDF_STATUS_E_NOMEM;
275*5113495bSYour Name }
276*5113495bSYour Name
277*5113495bSYour Name cmd = (wmi_p2p_lo_start_cmd_fixed_param *)wmi_buf_data(buf);
278*5113495bSYour Name buf_ptr = (uint8_t *) wmi_buf_data(buf);
279*5113495bSYour Name
280*5113495bSYour Name WMITLV_SET_HDR(&cmd->tlv_header,
281*5113495bSYour Name WMITLV_TAG_STRUC_wmi_p2p_lo_start_cmd_fixed_param,
282*5113495bSYour Name WMITLV_GET_STRUCT_TLVLEN(wmi_p2p_lo_start_cmd_fixed_param));
283*5113495bSYour Name
284*5113495bSYour Name cmd->vdev_id = param->vdev_id;
285*5113495bSYour Name cmd->ctl_flags = param->ctl_flags;
286*5113495bSYour Name cmd->channel = param->freq;
287*5113495bSYour Name cmd->period = param->period;
288*5113495bSYour Name cmd->interval = param->interval;
289*5113495bSYour Name cmd->count = param->count;
290*5113495bSYour Name cmd->device_types_len = param->dev_types_len;
291*5113495bSYour Name cmd->prob_resp_len = param->probe_resp_len;
292*5113495bSYour Name
293*5113495bSYour Name buf_ptr += sizeof(wmi_p2p_lo_start_cmd_fixed_param);
294*5113495bSYour Name WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_BYTE,
295*5113495bSYour Name device_types_len_aligned);
296*5113495bSYour Name buf_ptr += WMI_TLV_HDR_SIZE;
297*5113495bSYour Name qdf_mem_copy(buf_ptr, param->device_types,
298*5113495bSYour Name param->dev_types_len);
299*5113495bSYour Name
300*5113495bSYour Name buf_ptr += device_types_len_aligned;
301*5113495bSYour Name WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_BYTE,
302*5113495bSYour Name probe_resp_len_aligned);
303*5113495bSYour Name buf_ptr += WMI_TLV_HDR_SIZE;
304*5113495bSYour Name qdf_mem_copy(buf_ptr, param->probe_resp_tmplt,
305*5113495bSYour Name param->probe_resp_len);
306*5113495bSYour Name
307*5113495bSYour Name wmi_debug("Sending WMI_P2P_LO_START command, channel=%d, period=%d, interval=%d, count=%d",
308*5113495bSYour Name cmd->channel, cmd->period, cmd->interval, cmd->count);
309*5113495bSYour Name
310*5113495bSYour Name wmi_mtrace(WMI_P2P_LISTEN_OFFLOAD_START_CMDID, cmd->vdev_id, 0);
311*5113495bSYour Name status = wmi_unified_cmd_send(wmi_handle,
312*5113495bSYour Name buf, len,
313*5113495bSYour Name WMI_P2P_LISTEN_OFFLOAD_START_CMDID);
314*5113495bSYour Name if (status != QDF_STATUS_SUCCESS) {
315*5113495bSYour Name wmi_err("Failed to send p2p lo start: %d", status);
316*5113495bSYour Name wmi_buf_free(buf);
317*5113495bSYour Name return status;
318*5113495bSYour Name }
319*5113495bSYour Name
320*5113495bSYour Name wmi_debug("Successfully sent WMI_P2P_LO_START");
321*5113495bSYour Name
322*5113495bSYour Name return QDF_STATUS_SUCCESS;
323*5113495bSYour Name }
324*5113495bSYour Name
325*5113495bSYour Name /**
326*5113495bSYour Name * send_p2p_lo_stop_cmd_tlv() - send p2p lo stop request to fw
327*5113495bSYour Name * @wmi_handle: wmi handle
328*5113495bSYour Name * @vdev_id: vdev identifier
329*5113495bSYour Name *
330*5113495bSYour Name * Return: QDF status
331*5113495bSYour Name */
send_p2p_lo_stop_cmd_tlv(wmi_unified_t wmi_handle,uint8_t vdev_id)332*5113495bSYour Name static QDF_STATUS send_p2p_lo_stop_cmd_tlv(wmi_unified_t wmi_handle,
333*5113495bSYour Name uint8_t vdev_id)
334*5113495bSYour Name {
335*5113495bSYour Name wmi_buf_t buf;
336*5113495bSYour Name wmi_p2p_lo_stop_cmd_fixed_param *cmd;
337*5113495bSYour Name int32_t len;
338*5113495bSYour Name QDF_STATUS status;
339*5113495bSYour Name
340*5113495bSYour Name wmi_debug("vdev_id: %d", vdev_id);
341*5113495bSYour Name
342*5113495bSYour Name len = sizeof(*cmd);
343*5113495bSYour Name buf = wmi_buf_alloc(wmi_handle, len);
344*5113495bSYour Name if (!buf) {
345*5113495bSYour Name return QDF_STATUS_E_NOMEM;
346*5113495bSYour Name }
347*5113495bSYour Name cmd = (wmi_p2p_lo_stop_cmd_fixed_param *)wmi_buf_data(buf);
348*5113495bSYour Name
349*5113495bSYour Name WMITLV_SET_HDR(&cmd->tlv_header,
350*5113495bSYour Name WMITLV_TAG_STRUC_wmi_p2p_lo_stop_cmd_fixed_param,
351*5113495bSYour Name WMITLV_GET_STRUCT_TLVLEN(wmi_p2p_lo_stop_cmd_fixed_param));
352*5113495bSYour Name
353*5113495bSYour Name cmd->vdev_id = vdev_id;
354*5113495bSYour Name
355*5113495bSYour Name wmi_debug("Sending WMI_P2P_LO_STOP command");
356*5113495bSYour Name
357*5113495bSYour Name wmi_mtrace(WMI_P2P_LISTEN_OFFLOAD_STOP_CMDID, cmd->vdev_id, 0);
358*5113495bSYour Name status = wmi_unified_cmd_send(wmi_handle,
359*5113495bSYour Name buf, len,
360*5113495bSYour Name WMI_P2P_LISTEN_OFFLOAD_STOP_CMDID);
361*5113495bSYour Name if (status != QDF_STATUS_SUCCESS) {
362*5113495bSYour Name wmi_err("Failed to send p2p lo stop: %d", status);
363*5113495bSYour Name wmi_buf_free(buf);
364*5113495bSYour Name return status;
365*5113495bSYour Name }
366*5113495bSYour Name
367*5113495bSYour Name wmi_debug("Successfully sent WMI_P2P_LO_STOP");
368*5113495bSYour Name
369*5113495bSYour Name return QDF_STATUS_SUCCESS;
370*5113495bSYour Name }
371*5113495bSYour Name
372*5113495bSYour Name /**
373*5113495bSYour Name * extract_p2p_lo_stop_ev_param_tlv() - extract p2p lo stop
374*5113495bSYour Name * information from event
375*5113495bSYour Name * @wmi_handle: wmi handle
376*5113495bSYour Name * @evt_buf: pointer to event buffer
377*5113495bSYour Name * @param: Pointer to hold p2p lo stop event information
378*5113495bSYour Name *
379*5113495bSYour Name * Return: QDF_STATUS_SUCCESS for success or error code
380*5113495bSYour Name */
extract_p2p_lo_stop_ev_param_tlv(wmi_unified_t wmi_handle,void * evt_buf,struct p2p_lo_event * param)381*5113495bSYour Name static QDF_STATUS extract_p2p_lo_stop_ev_param_tlv(
382*5113495bSYour Name wmi_unified_t wmi_handle, void *evt_buf,
383*5113495bSYour Name struct p2p_lo_event *param)
384*5113495bSYour Name {
385*5113495bSYour Name WMI_P2P_LISTEN_OFFLOAD_STOPPED_EVENTID_param_tlvs *param_tlvs;
386*5113495bSYour Name wmi_p2p_lo_stopped_event_fixed_param *lo_param;
387*5113495bSYour Name
388*5113495bSYour Name param_tlvs = (WMI_P2P_LISTEN_OFFLOAD_STOPPED_EVENTID_param_tlvs *)
389*5113495bSYour Name evt_buf;
390*5113495bSYour Name if (!param_tlvs) {
391*5113495bSYour Name wmi_err("Invalid P2P lo stop event buffer");
392*5113495bSYour Name return QDF_STATUS_E_INVAL;
393*5113495bSYour Name }
394*5113495bSYour Name
395*5113495bSYour Name if (!param) {
396*5113495bSYour Name wmi_err("lo stop event param is null");
397*5113495bSYour Name return QDF_STATUS_E_INVAL;
398*5113495bSYour Name }
399*5113495bSYour Name
400*5113495bSYour Name lo_param = param_tlvs->fixed_param;
401*5113495bSYour Name param->vdev_id = lo_param->vdev_id;
402*5113495bSYour Name param->reason_code = lo_param->reason;
403*5113495bSYour Name wmi_debug("vdev_id:%d, reason:%d",
404*5113495bSYour Name param->vdev_id, param->reason_code);
405*5113495bSYour Name
406*5113495bSYour Name return QDF_STATUS_SUCCESS;
407*5113495bSYour Name }
408*5113495bSYour Name
wmi_p2p_listen_offload_attach_tlv(wmi_unified_t wmi_handle)409*5113495bSYour Name void wmi_p2p_listen_offload_attach_tlv(wmi_unified_t wmi_handle)
410*5113495bSYour Name {
411*5113495bSYour Name struct wmi_ops *ops = wmi_handle->ops;
412*5113495bSYour Name
413*5113495bSYour Name ops->send_p2p_lo_start_cmd = send_p2p_lo_start_cmd_tlv;
414*5113495bSYour Name ops->send_p2p_lo_stop_cmd = send_p2p_lo_stop_cmd_tlv;
415*5113495bSYour Name ops->extract_p2p_lo_stop_ev_param =
416*5113495bSYour Name extract_p2p_lo_stop_ev_param_tlv;
417*5113495bSYour Name }
418*5113495bSYour Name #endif /* FEATURE_P2P_LISTEN_OFFLOAD */
419*5113495bSYour Name
wmi_p2p_attach_tlv(wmi_unified_t wmi_handle)420*5113495bSYour Name void wmi_p2p_attach_tlv(wmi_unified_t wmi_handle)
421*5113495bSYour Name {
422*5113495bSYour Name struct wmi_ops *ops = wmi_handle->ops;
423*5113495bSYour Name
424*5113495bSYour Name ops->send_set_p2pgo_oppps_req_cmd = send_set_p2pgo_oppps_req_cmd_tlv;
425*5113495bSYour Name ops->send_set_p2pgo_noa_req_cmd = send_set_p2pgo_noa_req_cmd_tlv;
426*5113495bSYour Name ops->extract_p2p_noa_ev_param = extract_p2p_noa_ev_param_tlv;
427*5113495bSYour Name ops->extract_mac_addr_rx_filter_evt_param =
428*5113495bSYour Name extract_mac_addr_rx_filter_evt_param_tlv,
429*5113495bSYour Name wmi_p2p_listen_offload_attach_tlv(wmi_handle);
430*5113495bSYour Name }
431*5113495bSYour Name
432