1 /* 2 * Copyright (c) 2018-2020 The Linux Foundation. All rights reserved. 3 * 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_svc_i.h" 25 #include <wlan_lmac_if_def.h> 26 #include <wlan_ftm_ucfg_api.h> 27 28 static inline struct wlan_lmac_if_ftm_tx_ops * 29 wlan_psoc_get_ftm_txops(struct wlan_objmgr_psoc *psoc) 30 { 31 struct wlan_lmac_if_tx_ops *tx_ops; 32 33 tx_ops = wlan_psoc_get_lmac_if_txops(psoc); 34 if (!tx_ops) { 35 ftm_err("tx_ops is NULL"); 36 return NULL; 37 } 38 39 return &tx_ops->ftm_tx_ops; 40 } 41 42 static QDF_STATUS 43 ftm_pdev_obj_init(struct wifi_ftm_pdev_priv_obj *ftm_pdev_obj) 44 { 45 ftm_pdev_obj->data = qdf_mem_malloc(FTM_CMD_MAX_BUF_LENGTH); 46 if (!ftm_pdev_obj->data) 47 return QDF_STATUS_E_NOMEM; 48 49 ftm_pdev_obj->length = 0; 50 51 ftm_pdev_obj->cmd_type = WIFI_FTM_CMD_UNKNOWN; 52 return QDF_STATUS_SUCCESS; 53 } 54 55 QDF_STATUS 56 wlan_ftm_pdev_obj_create_notification(struct wlan_objmgr_pdev *pdev, 57 void *arg_list) 58 { 59 QDF_STATUS status; 60 struct wifi_ftm_pdev_priv_obj *ftm_pdev_obj; 61 62 ftm_pdev_obj = qdf_mem_malloc(sizeof(*ftm_pdev_obj)); 63 64 if (!ftm_pdev_obj) 65 return QDF_STATUS_E_NOMEM; 66 67 ftm_pdev_obj->pdev = pdev; 68 status = ftm_pdev_obj_init(ftm_pdev_obj); 69 70 if (QDF_IS_STATUS_ERROR(status)) { 71 ftm_err("ftm pdev obj init failed"); 72 qdf_mem_free(ftm_pdev_obj); 73 return status; 74 } 75 76 status = wlan_objmgr_pdev_component_obj_attach(pdev, 77 WLAN_UMAC_COMP_FTM, 78 ftm_pdev_obj, 79 QDF_STATUS_SUCCESS); 80 81 if (QDF_IS_STATUS_ERROR(status)) { 82 ftm_err("ftm pdev obj attach failed"); 83 qdf_mem_free(ftm_pdev_obj); 84 return status; 85 } 86 87 return status; 88 } 89 90 static QDF_STATUS 91 ftm_pdev_obj_deinit(struct wifi_ftm_pdev_priv_obj *ftm_pdev_obj) 92 { 93 if (ftm_pdev_obj->data) { 94 qdf_mem_free(ftm_pdev_obj->data); 95 96 ftm_pdev_obj->data = NULL; 97 ftm_pdev_obj->length = 0; 98 } 99 100 return QDF_STATUS_SUCCESS; 101 } 102 103 QDF_STATUS 104 wlan_ftm_pdev_obj_destroy_notification(struct wlan_objmgr_pdev *pdev, 105 void *arg_list) 106 { 107 QDF_STATUS status; 108 struct wifi_ftm_pdev_priv_obj *ftm_pdev_obj = 109 wlan_objmgr_pdev_get_comp_private_obj(pdev, WLAN_UMAC_COMP_FTM); 110 111 if (!ftm_pdev_obj) { 112 ftm_err("invalid wifi ftm obj"); 113 return QDF_STATUS_E_FAULT; 114 } 115 116 status = wlan_objmgr_pdev_component_obj_detach(pdev, WLAN_UMAC_COMP_FTM, 117 ftm_pdev_obj); 118 119 status = ftm_pdev_obj_deinit(ftm_pdev_obj); 120 ftm_pdev_obj->pdev = NULL; 121 122 qdf_mem_free(ftm_pdev_obj); 123 124 return status; 125 } 126 127 QDF_STATUS 128 wlan_ftm_testmode_attach(struct wlan_objmgr_psoc *psoc) 129 { 130 struct wlan_lmac_if_ftm_tx_ops *ftm_tx_ops; 131 132 ftm_tx_ops = wlan_psoc_get_ftm_txops(psoc); 133 if (!ftm_tx_ops) { 134 ftm_err("ftm_tx_ops is NULL"); 135 return QDF_STATUS_E_FAULT; 136 } 137 138 if (ftm_tx_ops->ftm_attach) 139 return ftm_tx_ops->ftm_attach(psoc); 140 else 141 return QDF_STATUS_SUCCESS; 142 } 143 144 QDF_STATUS 145 wlan_ftm_testmode_detach(struct wlan_objmgr_psoc *psoc) 146 { 147 struct wlan_lmac_if_ftm_tx_ops *ftm_tx_ops; 148 149 ftm_tx_ops = wlan_psoc_get_ftm_txops(psoc); 150 if (!ftm_tx_ops) { 151 ftm_err("ftm_tx_ops is NULL"); 152 return QDF_STATUS_E_FAULT; 153 } 154 155 if (ftm_tx_ops->ftm_detach) 156 return ftm_tx_ops->ftm_detach(psoc); 157 else 158 return QDF_STATUS_SUCCESS; 159 } 160 161 QDF_STATUS 162 wlan_ftm_cmd_send(struct wlan_objmgr_pdev *pdev, uint8_t *buf, 163 uint32_t len, uint8_t pdev_id) 164 { 165 struct wlan_lmac_if_ftm_tx_ops *ftm_tx_ops; 166 struct wlan_objmgr_psoc *psoc; 167 168 psoc = wlan_pdev_get_psoc(pdev); 169 if (!psoc) 170 return QDF_STATUS_E_NOENT; 171 172 ftm_tx_ops = wlan_psoc_get_ftm_txops(psoc); 173 if (!ftm_tx_ops) { 174 ftm_err("ftm_tx_ops is NULL"); 175 return QDF_STATUS_E_FAULT; 176 } 177 178 if (ftm_tx_ops->ftm_cmd_send) 179 return ftm_tx_ops->ftm_cmd_send(pdev, buf, len, pdev_id); 180 181 return QDF_STATUS_SUCCESS; 182 } 183