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 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 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 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