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