1 /*
2 * Copyright (c) 2018 The Linux Foundation. All rights reserved.
3 * Copyright (c) 2022 Qualcomm Innovation Center, Inc. All rights reserved.
4 *
5 * Permission to use, copy, modify, and/or distribute this software for
6 * any purpose with or without fee is hereby granted, provided that the
7 * above copyright notice and this permission notice appear in all
8 * copies.
9 *
10 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL
11 * WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED
12 * WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE
13 * AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL
14 * DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR
15 * PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER
16 * TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
17 * PERFORMANCE OF THIS SOFTWARE.
18 */
19
20 /**
21 * DOC: This implementation of init/deint functions for FTM services.
22 */
23
24 #include <wlan_ftm_ucfg_api.h>
25 #include <wlan_cfg80211_ftm.h>
26 #include "../../core/src/wlan_ftm_svc_i.h"
27 #include <wlan_cmn.h>
28 #include <qdf_module.h>
29
ucfg_wlan_ftm_testmode_cmd(struct wlan_objmgr_pdev * pdev,uint8_t * data,uint32_t len)30 QDF_STATUS ucfg_wlan_ftm_testmode_cmd(struct wlan_objmgr_pdev *pdev,
31 uint8_t *data, uint32_t len)
32 {
33 struct wifi_ftm_pdev_priv_obj *ftm_pdev_obj;
34 uint8_t pdev_id;
35
36 ftm_pdev_obj = wlan_objmgr_pdev_get_comp_private_obj(pdev,
37 WLAN_UMAC_COMP_FTM);
38 if (!ftm_pdev_obj) {
39 ftm_err("Failed to get ftm pdev component");
40 return QDF_STATUS_E_FAILURE;
41 }
42
43 ftm_pdev_obj->length = 0;
44 pdev_id = wlan_objmgr_pdev_get_pdev_id(pdev);
45
46 return wlan_ftm_cmd_send(pdev, data, len, pdev_id);
47 }
48
49 QDF_STATUS
wlan_ftm_process_utf_event(struct wlan_objmgr_pdev * pdev,uint8_t * event_buf,uint32_t len)50 wlan_ftm_process_utf_event(struct wlan_objmgr_pdev *pdev,
51 uint8_t *event_buf, uint32_t len)
52 {
53 struct wifi_ftm_pdev_priv_obj *ftm_pdev_obj;
54 uint32_t utf_datalen;
55 uint8_t *utf_data;
56 struct ftm_seg_hdr_info seghdr_info;
57 u_int8_t total_segments, current_seq;
58
59 ftm_pdev_obj = wlan_objmgr_pdev_get_comp_private_obj(pdev,
60 WLAN_UMAC_COMP_FTM);
61 if (!ftm_pdev_obj) {
62 ftm_err("Failed to get ftm pdev component");
63 return QDF_STATUS_E_FAILURE;
64 }
65
66 utf_data = event_buf;
67 seghdr_info = *(struct ftm_seg_hdr_info *)(event_buf);
68 ftm_pdev_obj->current_seq = (seghdr_info.segment_info & 0xF);
69
70 current_seq = (seghdr_info.segment_info & 0xF);
71 total_segments = (seghdr_info.segment_info >> 4) & 0xF;
72
73 utf_datalen = len - sizeof(seghdr_info);
74
75 if (current_seq == 0) {
76 ftm_pdev_obj->expected_seq = 0;
77 ftm_pdev_obj->offset = 0;
78 } else {
79 if (ftm_pdev_obj->expected_seq != current_seq) {
80 ftm_debug("seq mismatch exp Seq %d got seq %d\n",
81 ftm_pdev_obj->expected_seq, current_seq);
82 }
83 }
84
85 if ((len > FTM_CMD_MAX_BUF_LENGTH) ||
86 (ftm_pdev_obj->offset > (FTM_CMD_MAX_BUF_LENGTH - utf_datalen))) {
87 ftm_err("Invalid utf data len :%d", len);
88 return QDF_STATUS_E_FAILURE;
89 }
90 qdf_mem_copy(&ftm_pdev_obj->data[ftm_pdev_obj->offset],
91 &utf_data[sizeof(seghdr_info)], utf_datalen);
92
93 ftm_pdev_obj->offset = ftm_pdev_obj->offset + utf_datalen;
94 ftm_pdev_obj->expected_seq++;
95
96 if (ftm_pdev_obj->expected_seq == total_segments) {
97 if (ftm_pdev_obj->offset != seghdr_info.len) {
98 ftm_debug("len mismatch len %zu total len %d\n",
99 ftm_pdev_obj->offset, seghdr_info.len);
100 }
101
102 ftm_pdev_obj->length = ftm_pdev_obj->offset;
103
104 /**
105 * If the response is for a command from FTM daemon,
106 * send this response data to cfg80211
107 */
108 if (ftm_pdev_obj->cmd_type == WIFI_FTM_CMD_NL80211) {
109 if (wlan_cfg80211_ftm_rx_event(pdev, ftm_pdev_obj->data,
110 ftm_pdev_obj->length) != QDF_STATUS_SUCCESS) {
111 return QDF_STATUS_E_FAILURE;
112 }
113 ftm_pdev_obj->cmd_type = WIFI_FTM_CMD_UNKNOWN;
114 }
115 }
116
117 return QDF_STATUS_SUCCESS;
118 }
119
120 #ifdef QCA_WIFI_FTM_IOCTL
ucfg_wlan_ftm_testmode_rsp(struct wlan_objmgr_pdev * pdev,uint8_t * data)121 QDF_STATUS ucfg_wlan_ftm_testmode_rsp(struct wlan_objmgr_pdev *pdev,
122 uint8_t *data)
123 {
124 struct wifi_ftm_pdev_priv_obj *ftm_pdev_obj;
125 uint32_t *len;
126
127 ftm_pdev_obj =
128 wlan_objmgr_pdev_get_comp_private_obj(pdev,
129 WLAN_UMAC_COMP_FTM);
130 if (!ftm_pdev_obj) {
131 ftm_err("Failed to get ftm pdev component");
132 return QDF_STATUS_E_FAILURE;
133 }
134
135 if (ftm_pdev_obj->length) {
136 len = (uint32_t *)data;
137 *len = ftm_pdev_obj->length;
138 qdf_mem_copy((data + 4), ftm_pdev_obj->data,
139 ftm_pdev_obj->length);
140
141 ftm_pdev_obj->length = 0;
142 return QDF_STATUS_SUCCESS;
143 }
144
145 return QDF_STATUS_E_FAILURE;
146 }
147 #endif
148