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