1*5113495bSYour Name /*
2*5113495bSYour Name * Copyright (c) 2018 The Linux Foundation. All rights reserved.
3*5113495bSYour Name * Copyright (c) 2022 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: This implementation of init/deint functions for FTM services.
22*5113495bSYour Name */
23*5113495bSYour Name
24*5113495bSYour Name #include <wlan_ftm_ucfg_api.h>
25*5113495bSYour Name #include <wlan_cfg80211_ftm.h>
26*5113495bSYour Name #include "../../core/src/wlan_ftm_svc_i.h"
27*5113495bSYour Name #include <wlan_cmn.h>
28*5113495bSYour Name #include <qdf_module.h>
29*5113495bSYour Name
ucfg_wlan_ftm_testmode_cmd(struct wlan_objmgr_pdev * pdev,uint8_t * data,uint32_t len)30*5113495bSYour Name QDF_STATUS ucfg_wlan_ftm_testmode_cmd(struct wlan_objmgr_pdev *pdev,
31*5113495bSYour Name uint8_t *data, uint32_t len)
32*5113495bSYour Name {
33*5113495bSYour Name struct wifi_ftm_pdev_priv_obj *ftm_pdev_obj;
34*5113495bSYour Name uint8_t pdev_id;
35*5113495bSYour Name
36*5113495bSYour Name ftm_pdev_obj = wlan_objmgr_pdev_get_comp_private_obj(pdev,
37*5113495bSYour Name WLAN_UMAC_COMP_FTM);
38*5113495bSYour Name if (!ftm_pdev_obj) {
39*5113495bSYour Name ftm_err("Failed to get ftm pdev component");
40*5113495bSYour Name return QDF_STATUS_E_FAILURE;
41*5113495bSYour Name }
42*5113495bSYour Name
43*5113495bSYour Name ftm_pdev_obj->length = 0;
44*5113495bSYour Name pdev_id = wlan_objmgr_pdev_get_pdev_id(pdev);
45*5113495bSYour Name
46*5113495bSYour Name return wlan_ftm_cmd_send(pdev, data, len, pdev_id);
47*5113495bSYour Name }
48*5113495bSYour Name
49*5113495bSYour Name QDF_STATUS
wlan_ftm_process_utf_event(struct wlan_objmgr_pdev * pdev,uint8_t * event_buf,uint32_t len)50*5113495bSYour Name wlan_ftm_process_utf_event(struct wlan_objmgr_pdev *pdev,
51*5113495bSYour Name uint8_t *event_buf, uint32_t len)
52*5113495bSYour Name {
53*5113495bSYour Name struct wifi_ftm_pdev_priv_obj *ftm_pdev_obj;
54*5113495bSYour Name uint32_t utf_datalen;
55*5113495bSYour Name uint8_t *utf_data;
56*5113495bSYour Name struct ftm_seg_hdr_info seghdr_info;
57*5113495bSYour Name u_int8_t total_segments, current_seq;
58*5113495bSYour Name
59*5113495bSYour Name ftm_pdev_obj = wlan_objmgr_pdev_get_comp_private_obj(pdev,
60*5113495bSYour Name WLAN_UMAC_COMP_FTM);
61*5113495bSYour Name if (!ftm_pdev_obj) {
62*5113495bSYour Name ftm_err("Failed to get ftm pdev component");
63*5113495bSYour Name return QDF_STATUS_E_FAILURE;
64*5113495bSYour Name }
65*5113495bSYour Name
66*5113495bSYour Name utf_data = event_buf;
67*5113495bSYour Name seghdr_info = *(struct ftm_seg_hdr_info *)(event_buf);
68*5113495bSYour Name ftm_pdev_obj->current_seq = (seghdr_info.segment_info & 0xF);
69*5113495bSYour Name
70*5113495bSYour Name current_seq = (seghdr_info.segment_info & 0xF);
71*5113495bSYour Name total_segments = (seghdr_info.segment_info >> 4) & 0xF;
72*5113495bSYour Name
73*5113495bSYour Name utf_datalen = len - sizeof(seghdr_info);
74*5113495bSYour Name
75*5113495bSYour Name if (current_seq == 0) {
76*5113495bSYour Name ftm_pdev_obj->expected_seq = 0;
77*5113495bSYour Name ftm_pdev_obj->offset = 0;
78*5113495bSYour Name } else {
79*5113495bSYour Name if (ftm_pdev_obj->expected_seq != current_seq) {
80*5113495bSYour Name ftm_debug("seq mismatch exp Seq %d got seq %d\n",
81*5113495bSYour Name ftm_pdev_obj->expected_seq, current_seq);
82*5113495bSYour Name }
83*5113495bSYour Name }
84*5113495bSYour Name
85*5113495bSYour Name if ((len > FTM_CMD_MAX_BUF_LENGTH) ||
86*5113495bSYour Name (ftm_pdev_obj->offset > (FTM_CMD_MAX_BUF_LENGTH - utf_datalen))) {
87*5113495bSYour Name ftm_err("Invalid utf data len :%d", len);
88*5113495bSYour Name return QDF_STATUS_E_FAILURE;
89*5113495bSYour Name }
90*5113495bSYour Name qdf_mem_copy(&ftm_pdev_obj->data[ftm_pdev_obj->offset],
91*5113495bSYour Name &utf_data[sizeof(seghdr_info)], utf_datalen);
92*5113495bSYour Name
93*5113495bSYour Name ftm_pdev_obj->offset = ftm_pdev_obj->offset + utf_datalen;
94*5113495bSYour Name ftm_pdev_obj->expected_seq++;
95*5113495bSYour Name
96*5113495bSYour Name if (ftm_pdev_obj->expected_seq == total_segments) {
97*5113495bSYour Name if (ftm_pdev_obj->offset != seghdr_info.len) {
98*5113495bSYour Name ftm_debug("len mismatch len %zu total len %d\n",
99*5113495bSYour Name ftm_pdev_obj->offset, seghdr_info.len);
100*5113495bSYour Name }
101*5113495bSYour Name
102*5113495bSYour Name ftm_pdev_obj->length = ftm_pdev_obj->offset;
103*5113495bSYour Name
104*5113495bSYour Name /**
105*5113495bSYour Name * If the response is for a command from FTM daemon,
106*5113495bSYour Name * send this response data to cfg80211
107*5113495bSYour Name */
108*5113495bSYour Name if (ftm_pdev_obj->cmd_type == WIFI_FTM_CMD_NL80211) {
109*5113495bSYour Name if (wlan_cfg80211_ftm_rx_event(pdev, ftm_pdev_obj->data,
110*5113495bSYour Name ftm_pdev_obj->length) != QDF_STATUS_SUCCESS) {
111*5113495bSYour Name return QDF_STATUS_E_FAILURE;
112*5113495bSYour Name }
113*5113495bSYour Name ftm_pdev_obj->cmd_type = WIFI_FTM_CMD_UNKNOWN;
114*5113495bSYour Name }
115*5113495bSYour Name }
116*5113495bSYour Name
117*5113495bSYour Name return QDF_STATUS_SUCCESS;
118*5113495bSYour Name }
119*5113495bSYour Name
120*5113495bSYour Name #ifdef QCA_WIFI_FTM_IOCTL
ucfg_wlan_ftm_testmode_rsp(struct wlan_objmgr_pdev * pdev,uint8_t * data)121*5113495bSYour Name QDF_STATUS ucfg_wlan_ftm_testmode_rsp(struct wlan_objmgr_pdev *pdev,
122*5113495bSYour Name uint8_t *data)
123*5113495bSYour Name {
124*5113495bSYour Name struct wifi_ftm_pdev_priv_obj *ftm_pdev_obj;
125*5113495bSYour Name uint32_t *len;
126*5113495bSYour Name
127*5113495bSYour Name ftm_pdev_obj =
128*5113495bSYour Name wlan_objmgr_pdev_get_comp_private_obj(pdev,
129*5113495bSYour Name WLAN_UMAC_COMP_FTM);
130*5113495bSYour Name if (!ftm_pdev_obj) {
131*5113495bSYour Name ftm_err("Failed to get ftm pdev component");
132*5113495bSYour Name return QDF_STATUS_E_FAILURE;
133*5113495bSYour Name }
134*5113495bSYour Name
135*5113495bSYour Name if (ftm_pdev_obj->length) {
136*5113495bSYour Name len = (uint32_t *)data;
137*5113495bSYour Name *len = ftm_pdev_obj->length;
138*5113495bSYour Name qdf_mem_copy((data + 4), ftm_pdev_obj->data,
139*5113495bSYour Name ftm_pdev_obj->length);
140*5113495bSYour Name
141*5113495bSYour Name ftm_pdev_obj->length = 0;
142*5113495bSYour Name return QDF_STATUS_SUCCESS;
143*5113495bSYour Name }
144*5113495bSYour Name
145*5113495bSYour Name return QDF_STATUS_E_FAILURE;
146*5113495bSYour Name }
147*5113495bSYour Name #endif
148