|
@@ -20,12 +20,513 @@
|
|
|
* DOC: contains nan target if functions
|
|
|
*/
|
|
|
|
|
|
-#include "wlan_nan_api.h"
|
|
|
+#include "../../../umac/nan/core/src/nan_main_i.h"
|
|
|
#include "nan_public_structs.h"
|
|
|
#include "target_if_nan.h"
|
|
|
+#include "wmi_unified_api.h"
|
|
|
+#include "scheduler_api.h"
|
|
|
|
|
|
-static QDF_STATUS target_if_nan_req(void *in_req, uint32_t req_type)
|
|
|
+static QDF_STATUS target_if_nan_event_dispatcher(struct scheduler_msg *msg)
|
|
|
{
|
|
|
+ QDF_STATUS status;
|
|
|
+ struct wlan_objmgr_vdev *vdev = NULL;
|
|
|
+ struct wlan_objmgr_psoc *psoc;
|
|
|
+ struct wlan_lmac_if_nan_rx_ops *nan_rx_ops;
|
|
|
+
|
|
|
+ switch (msg->type) {
|
|
|
+ case NDP_INITIATOR_RSP: {
|
|
|
+ struct nan_datapath_initiator_rsp *initiator_rsp = msg->bodyptr;
|
|
|
+ vdev = initiator_rsp->vdev;
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ case NDP_INDICATION: {
|
|
|
+ struct nan_datapath_indication_event *ind = msg->bodyptr;
|
|
|
+ vdev = ind->vdev;
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ case NDP_CONFIRM: {
|
|
|
+ struct nan_datapath_confirm_event *confirm = msg->bodyptr;
|
|
|
+ vdev = confirm->vdev;
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ default:
|
|
|
+ target_if_err("invalid msg type %d", msg->type);
|
|
|
+ qdf_mem_free(msg->bodyptr);
|
|
|
+ return QDF_STATUS_E_INVAL;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (!vdev) {
|
|
|
+ target_if_err("vdev is null");
|
|
|
+ qdf_mem_free(msg->bodyptr);
|
|
|
+ return QDF_STATUS_E_NULL_VALUE;
|
|
|
+ }
|
|
|
+
|
|
|
+ /* try get ref now, if failure, then vdev may have been deleted */
|
|
|
+ status = wlan_objmgr_vdev_try_get_ref(vdev, WLAN_NAN_ID);
|
|
|
+ if (QDF_IS_STATUS_ERROR(status)) {
|
|
|
+ nan_alert("couldn't get ref. vdev maybe deleted");
|
|
|
+ qdf_mem_free(msg->bodyptr);
|
|
|
+ return QDF_STATUS_E_INVAL;
|
|
|
+ }
|
|
|
+
|
|
|
+ psoc = wlan_vdev_get_psoc(vdev);
|
|
|
+ if (!psoc) {
|
|
|
+ target_if_err("psoc is null");
|
|
|
+ wlan_objmgr_vdev_release_ref(vdev, WLAN_NAN_ID);
|
|
|
+ qdf_mem_free(msg->bodyptr);
|
|
|
+ return QDF_STATUS_E_NULL_VALUE;
|
|
|
+ }
|
|
|
+
|
|
|
+ nan_rx_ops = target_if_nan_get_rx_ops(psoc);
|
|
|
+ if (!nan_rx_ops) {
|
|
|
+ target_if_err("nan_rx_ops is null");
|
|
|
+ wlan_objmgr_vdev_release_ref(vdev, WLAN_NAN_ID);
|
|
|
+ qdf_mem_free(msg->bodyptr);
|
|
|
+ return QDF_STATUS_E_NULL_VALUE;
|
|
|
+ }
|
|
|
+
|
|
|
+ status = nan_rx_ops->nan_event_rx(msg);
|
|
|
+ wlan_objmgr_vdev_release_ref(vdev, WLAN_NAN_ID);
|
|
|
+ qdf_mem_free(msg->bodyptr);
|
|
|
+
|
|
|
+ return status;
|
|
|
+}
|
|
|
+
|
|
|
+static QDF_STATUS target_if_nan_ndp_intiaitor_req(void *req)
|
|
|
+{
|
|
|
+ int ret;
|
|
|
+ uint16_t len;
|
|
|
+ wmi_buf_t buf;
|
|
|
+ uint8_t *tlv_ptr;
|
|
|
+ QDF_STATUS status;
|
|
|
+ wmi_channel *ch_tlv;
|
|
|
+ wmi_unified_t wmi_handle;
|
|
|
+ struct wlan_objmgr_psoc *psoc;
|
|
|
+ struct scheduler_msg pe_msg = {0};
|
|
|
+ wmi_ndp_initiator_req_fixed_param *cmd;
|
|
|
+ struct wlan_lmac_if_nan_rx_ops *nan_rx_ops;
|
|
|
+ uint32_t ndp_cfg_len, ndp_app_info_len, pmk_len;
|
|
|
+ struct nan_datapath_initiator_rsp ndp_rsp = {0};
|
|
|
+ struct nan_datapath_initiator_req *ndp_req = req;
|
|
|
+
|
|
|
+ if (!ndp_req) {
|
|
|
+ target_if_err("ndp_req is null.");
|
|
|
+ return QDF_STATUS_E_INVAL;
|
|
|
+ }
|
|
|
+
|
|
|
+ psoc = wlan_vdev_get_psoc(ndp_req->vdev);
|
|
|
+ if (!psoc) {
|
|
|
+ target_if_err("psoc is null.");
|
|
|
+ return QDF_STATUS_E_INVAL;
|
|
|
+ }
|
|
|
+
|
|
|
+ wmi_handle = GET_WMI_HDL_FROM_PSOC(psoc);
|
|
|
+ if (!wmi_handle) {
|
|
|
+ target_if_err("wmi_handle is null.");
|
|
|
+ return QDF_STATUS_E_INVAL;
|
|
|
+ }
|
|
|
+
|
|
|
+ nan_rx_ops = target_if_nan_get_rx_ops(psoc);
|
|
|
+ if (!nan_rx_ops) {
|
|
|
+ target_if_err("nan_rx_ops is null.");
|
|
|
+ return QDF_STATUS_E_INVAL;
|
|
|
+ }
|
|
|
+
|
|
|
+ /*
|
|
|
+ * WMI command expects 4 byte alligned len:
|
|
|
+ * round up ndp_cfg_len and ndp_app_info_len to 4 bytes
|
|
|
+ */
|
|
|
+ ndp_cfg_len = qdf_roundup(ndp_req->ndp_config.ndp_cfg_len, 4);
|
|
|
+ ndp_app_info_len = qdf_roundup(ndp_req->ndp_info.ndp_app_info_len, 4);
|
|
|
+ pmk_len = qdf_roundup(ndp_req->pmk.pmk_len, 4);
|
|
|
+ /* allocated memory for fixed params as well as variable size data */
|
|
|
+ len = sizeof(*cmd) + sizeof(*ch_tlv) + (3 * WMI_TLV_HDR_SIZE)
|
|
|
+ + ndp_cfg_len + ndp_app_info_len + pmk_len;
|
|
|
+
|
|
|
+ buf = wmi_buf_alloc(wmi_handle, len);
|
|
|
+ if (!buf) {
|
|
|
+ target_if_err("wmi_buf_alloc failed");
|
|
|
+ status = QDF_STATUS_E_NOMEM;
|
|
|
+ goto send_ndp_initiator_fail;
|
|
|
+ }
|
|
|
+ cmd = (wmi_ndp_initiator_req_fixed_param *) wmi_buf_data(buf);
|
|
|
+ WMITLV_SET_HDR(&cmd->tlv_header,
|
|
|
+ WMITLV_TAG_STRUC_wmi_ndp_initiator_req_fixed_param,
|
|
|
+ WMITLV_GET_STRUCT_TLVLEN(
|
|
|
+ wmi_ndp_initiator_req_fixed_param));
|
|
|
+ cmd->vdev_id = wlan_vdev_get_id(ndp_req->vdev);
|
|
|
+ cmd->transaction_id = ndp_req->transaction_id;
|
|
|
+ cmd->service_instance_id = ndp_req->service_instance_id;
|
|
|
+ WMI_CHAR_ARRAY_TO_MAC_ADDR(ndp_req->peer_discovery_mac_addr.bytes,
|
|
|
+ &cmd->peer_discovery_mac_addr);
|
|
|
+
|
|
|
+ cmd->ndp_cfg_len = ndp_req->ndp_config.ndp_cfg_len;
|
|
|
+ cmd->ndp_app_info_len = ndp_req->ndp_info.ndp_app_info_len;
|
|
|
+ cmd->ndp_channel_cfg = ndp_req->channel_cfg;
|
|
|
+ cmd->nan_pmk_len = ndp_req->pmk.pmk_len;
|
|
|
+ cmd->nan_csid = ndp_req->ncs_sk_type;
|
|
|
+
|
|
|
+ ch_tlv = (wmi_channel *)&cmd[1];
|
|
|
+ WMITLV_SET_HDR(ch_tlv, WMITLV_TAG_STRUC_wmi_channel,
|
|
|
+ WMITLV_GET_STRUCT_TLVLEN(wmi_channel));
|
|
|
+ ch_tlv->mhz = ndp_req->channel;
|
|
|
+ /*
|
|
|
+ ch_tlv->band_center_freq1 =
|
|
|
+ cds_chan_to_freq(cds_freq_to_chan(ndp_req->channel));
|
|
|
+ */
|
|
|
+ tlv_ptr = (uint8_t *)&ch_tlv[1];
|
|
|
+
|
|
|
+ WMITLV_SET_HDR(tlv_ptr, WMITLV_TAG_ARRAY_BYTE, ndp_cfg_len);
|
|
|
+ qdf_mem_copy(&tlv_ptr[WMI_TLV_HDR_SIZE],
|
|
|
+ ndp_req->ndp_config.ndp_cfg, cmd->ndp_cfg_len);
|
|
|
+ tlv_ptr = tlv_ptr + WMI_TLV_HDR_SIZE + ndp_cfg_len;
|
|
|
+
|
|
|
+ WMITLV_SET_HDR(tlv_ptr, WMITLV_TAG_ARRAY_BYTE, ndp_app_info_len);
|
|
|
+ qdf_mem_copy(&tlv_ptr[WMI_TLV_HDR_SIZE],
|
|
|
+ ndp_req->ndp_info.ndp_app_info, cmd->ndp_app_info_len);
|
|
|
+ tlv_ptr = tlv_ptr + WMI_TLV_HDR_SIZE + ndp_app_info_len;
|
|
|
+
|
|
|
+ WMITLV_SET_HDR(tlv_ptr, WMITLV_TAG_ARRAY_BYTE, pmk_len);
|
|
|
+ qdf_mem_copy(&tlv_ptr[WMI_TLV_HDR_SIZE], ndp_req->pmk.pmk,
|
|
|
+ cmd->nan_pmk_len);
|
|
|
+ tlv_ptr = tlv_ptr + WMI_TLV_HDR_SIZE + pmk_len;
|
|
|
+
|
|
|
+ target_if_debug("vdev_id = %d, transaction_id: %d, service_instance_id: %d, ch: %d, ch_cfg: %d, csid: %d",
|
|
|
+ cmd->vdev_id, cmd->transaction_id, cmd->service_instance_id,
|
|
|
+ ch_tlv->mhz, cmd->ndp_channel_cfg, cmd->nan_csid);
|
|
|
+ target_if_debug("peer mac addr: mac_addr31to0: 0x%x, mac_addr47to32: 0x%x",
|
|
|
+ cmd->peer_discovery_mac_addr.mac_addr31to0,
|
|
|
+ cmd->peer_discovery_mac_addr.mac_addr47to32);
|
|
|
+
|
|
|
+ target_if_debug("ndp_config len: %d", cmd->ndp_cfg_len);
|
|
|
+ QDF_TRACE_HEX_DUMP(QDF_MODULE_ID_WMA, QDF_TRACE_LEVEL_DEBUG,
|
|
|
+ ndp_req->ndp_config.ndp_cfg,
|
|
|
+ ndp_req->ndp_config.ndp_cfg_len);
|
|
|
+
|
|
|
+ target_if_debug("ndp_app_info len: %d", cmd->ndp_app_info_len);
|
|
|
+ QDF_TRACE_HEX_DUMP(QDF_MODULE_ID_WMA, QDF_TRACE_LEVEL_DEBUG,
|
|
|
+ ndp_req->ndp_info.ndp_app_info,
|
|
|
+ ndp_req->ndp_info.ndp_app_info_len);
|
|
|
+
|
|
|
+ target_if_debug("pmk len: %d", cmd->nan_pmk_len);
|
|
|
+ QDF_TRACE_HEX_DUMP(QDF_MODULE_ID_WMA, QDF_TRACE_LEVEL_DEBUG,
|
|
|
+ ndp_req->pmk.pmk, cmd->nan_pmk_len);
|
|
|
+ target_if_debug("sending WMI_NDP_INITIATOR_REQ_CMDID(0x%X)",
|
|
|
+ WMI_NDP_INITIATOR_REQ_CMDID);
|
|
|
+
|
|
|
+ ret = wmi_unified_cmd_send(wmi_handle, buf, len,
|
|
|
+ WMI_NDP_INITIATOR_REQ_CMDID);
|
|
|
+ if (ret < 0) {
|
|
|
+ target_if_err("WMI_NDP_INITIATOR_REQ_CMDID failed, ret: %d",
|
|
|
+ ret);
|
|
|
+ wmi_buf_free(buf);
|
|
|
+ goto send_ndp_initiator_fail;
|
|
|
+ }
|
|
|
+
|
|
|
+ return QDF_STATUS_SUCCESS;
|
|
|
+send_ndp_initiator_fail:
|
|
|
+ ndp_rsp.vdev = ndp_req->vdev;
|
|
|
+ ndp_rsp.transaction_id = ndp_req->transaction_id;
|
|
|
+ ndp_rsp.ndp_instance_id = ndp_req->service_instance_id;
|
|
|
+ ndp_rsp.status = NAN_DATAPATH_DATA_INITIATOR_REQ_FAILED;
|
|
|
+ pe_msg.type = NDP_INITIATOR_RSP;
|
|
|
+ pe_msg.bodyptr = &ndp_rsp;
|
|
|
+ /* process even here and call callback */
|
|
|
+ if (nan_rx_ops && nan_rx_ops->nan_event_rx)
|
|
|
+ nan_rx_ops->nan_event_rx(&pe_msg);
|
|
|
+
|
|
|
+ return status;
|
|
|
+}
|
|
|
+
|
|
|
+static int target_if_ndp_initiator_rsp_handler(ol_scn_t scn, uint8_t *data,
|
|
|
+ uint32_t len)
|
|
|
+{
|
|
|
+ QDF_STATUS status;
|
|
|
+ struct wlan_objmgr_vdev *vdev;
|
|
|
+ struct wlan_objmgr_psoc *psoc;
|
|
|
+ struct scheduler_msg msg = {0};
|
|
|
+ struct nan_datapath_initiator_rsp *rsp;
|
|
|
+ WMI_NDP_INITIATOR_RSP_EVENTID_param_tlvs *event;
|
|
|
+ wmi_ndp_initiator_rsp_event_fixed_param *fixed_params;
|
|
|
+
|
|
|
+ psoc = target_if_get_psoc_from_scn_hdl(scn);
|
|
|
+ if (!psoc) {
|
|
|
+ target_if_err("psoc is null");
|
|
|
+ return -EINVAL;
|
|
|
+ }
|
|
|
+
|
|
|
+ event = (WMI_NDP_INITIATOR_RSP_EVENTID_param_tlvs *)data;
|
|
|
+ fixed_params = event->fixed_param;
|
|
|
+
|
|
|
+ vdev = wlan_objmgr_get_vdev_by_id_from_psoc(psoc,
|
|
|
+ fixed_params->vdev_id, WLAN_NAN_ID);
|
|
|
+ if (!vdev) {
|
|
|
+ target_if_err("vdev is null");
|
|
|
+ return -EINVAL;
|
|
|
+ }
|
|
|
+
|
|
|
+ rsp = qdf_mem_malloc(sizeof(*rsp));
|
|
|
+ if (!rsp) {
|
|
|
+ target_if_err("malloc failed");
|
|
|
+ wlan_objmgr_vdev_release_ref(vdev, WLAN_NAN_ID);
|
|
|
+ return -ENOMEM;
|
|
|
+ }
|
|
|
+
|
|
|
+ rsp->vdev = vdev;
|
|
|
+ rsp->transaction_id = fixed_params->transaction_id;
|
|
|
+ rsp->ndp_instance_id = fixed_params->ndp_instance_id;
|
|
|
+ rsp->status = fixed_params->rsp_status;
|
|
|
+ rsp->reason = fixed_params->reason_code;
|
|
|
+
|
|
|
+ msg.type = NDP_INITIATOR_RSP;
|
|
|
+ msg.bodyptr = rsp;
|
|
|
+ msg.callback = target_if_nan_event_dispatcher;
|
|
|
+
|
|
|
+ target_if_err("NDP_INITIATOR_RSP sent: %d", msg.type);
|
|
|
+ status = scheduler_post_msg(QDF_MODULE_ID_TARGET_IF, &msg);
|
|
|
+ wlan_objmgr_vdev_release_ref(vdev, WLAN_NAN_ID);
|
|
|
+ if (QDF_IS_STATUS_ERROR(status)) {
|
|
|
+ target_if_err("failed to post msg, status: %d", status);
|
|
|
+ qdf_mem_free(rsp);
|
|
|
+ return -EINVAL;
|
|
|
+ }
|
|
|
+
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+
|
|
|
+static int target_if_ndp_ind_handler(ol_scn_t scn, uint8_t *data,
|
|
|
+ uint32_t data_len)
|
|
|
+{
|
|
|
+ int ret;
|
|
|
+ QDF_STATUS status;
|
|
|
+ struct wlan_objmgr_psoc *psoc;
|
|
|
+ struct wlan_objmgr_vdev *vdev;
|
|
|
+ struct scheduler_msg msg = {0};
|
|
|
+ struct nan_datapath_indication_event *rsp;
|
|
|
+ WMI_NDP_INDICATION_EVENTID_param_tlvs *event;
|
|
|
+ wmi_ndp_indication_event_fixed_param *fixed_params;
|
|
|
+
|
|
|
+ psoc = target_if_get_psoc_from_scn_hdl(scn);
|
|
|
+ if (!psoc) {
|
|
|
+ target_if_err("psoc is null");
|
|
|
+ return -EINVAL;
|
|
|
+ }
|
|
|
+
|
|
|
+ event = (WMI_NDP_INDICATION_EVENTID_param_tlvs *)data;
|
|
|
+ fixed_params =
|
|
|
+ (wmi_ndp_indication_event_fixed_param *)event->fixed_param;
|
|
|
+
|
|
|
+ vdev = wlan_objmgr_get_vdev_by_id_from_psoc(psoc,
|
|
|
+ fixed_params->vdev_id, WLAN_NAN_ID);
|
|
|
+ if (!vdev) {
|
|
|
+ target_if_err("vdev is null");
|
|
|
+ return -EINVAL;
|
|
|
+ }
|
|
|
+
|
|
|
+ rsp = qdf_mem_malloc(sizeof(*rsp));
|
|
|
+ if (!rsp) {
|
|
|
+ target_if_err("malloc failed");
|
|
|
+ wlan_objmgr_vdev_release_ref(vdev, WLAN_NAN_ID);
|
|
|
+ return -ENOMEM;
|
|
|
+ }
|
|
|
+
|
|
|
+ rsp->vdev = vdev;
|
|
|
+ rsp->service_instance_id = fixed_params->service_instance_id;
|
|
|
+ rsp->ndp_instance_id = fixed_params->ndp_instance_id;
|
|
|
+ rsp->role = fixed_params->self_ndp_role;
|
|
|
+ rsp->policy = fixed_params->accept_policy;
|
|
|
+
|
|
|
+ WMI_MAC_ADDR_TO_CHAR_ARRAY(&fixed_params->peer_ndi_mac_addr,
|
|
|
+ rsp->peer_mac_addr.bytes);
|
|
|
+ WMI_MAC_ADDR_TO_CHAR_ARRAY(&fixed_params->peer_discovery_mac_addr,
|
|
|
+ rsp->peer_discovery_mac_addr.bytes);
|
|
|
+
|
|
|
+ target_if_debug("WMI_NDP_INDICATION_EVENTID(0x%X) received. vdev %d,\n"
|
|
|
+ "service_instance %d, ndp_instance %d, role %d, policy %d,\n"
|
|
|
+ "csid: %d, scid_len: %d, peer_addr: %pM, peer_disc_addr: %pM",
|
|
|
+ WMI_NDP_INDICATION_EVENTID, fixed_params->vdev_id,
|
|
|
+ fixed_params->service_instance_id,
|
|
|
+ fixed_params->ndp_instance_id, fixed_params->self_ndp_role,
|
|
|
+ fixed_params->accept_policy,
|
|
|
+ fixed_params->nan_csid, fixed_params->nan_scid_len,
|
|
|
+ rsp->peer_mac_addr.bytes,
|
|
|
+ rsp->peer_discovery_mac_addr.bytes);
|
|
|
+
|
|
|
+ target_if_debug("ndp_cfg - %d bytes", fixed_params->ndp_cfg_len);
|
|
|
+ QDF_TRACE_HEX_DUMP(QDF_MODULE_ID_WMA, QDF_TRACE_LEVEL_DEBUG,
|
|
|
+ &event->ndp_cfg, fixed_params->ndp_cfg_len);
|
|
|
+
|
|
|
+ target_if_debug("ndp_app_info - %d bytes",
|
|
|
+ fixed_params->ndp_app_info_len);
|
|
|
+ QDF_TRACE_HEX_DUMP(QDF_MODULE_ID_WMA, QDF_TRACE_LEVEL_DEBUG,
|
|
|
+ &event->ndp_app_info, fixed_params->ndp_app_info_len);
|
|
|
+
|
|
|
+ rsp->ndp_config.ndp_cfg_len = fixed_params->ndp_cfg_len;
|
|
|
+ rsp->ndp_info.ndp_app_info_len = fixed_params->ndp_app_info_len;
|
|
|
+ rsp->ncs_sk_type = fixed_params->nan_csid;
|
|
|
+ rsp->scid.scid_len = fixed_params->nan_scid_len;
|
|
|
+
|
|
|
+ if (rsp->ndp_config.ndp_cfg_len) {
|
|
|
+ rsp->ndp_config.ndp_cfg =
|
|
|
+ qdf_mem_malloc(fixed_params->ndp_cfg_len);
|
|
|
+ if (!rsp->ndp_config.ndp_cfg) {
|
|
|
+ target_if_err("malloc failed");
|
|
|
+ ret = -ENOMEM;
|
|
|
+ goto free_ind_resources;
|
|
|
+ }
|
|
|
+ qdf_mem_copy(rsp->ndp_config.ndp_cfg, event->ndp_cfg,
|
|
|
+ rsp->ndp_config.ndp_cfg_len);
|
|
|
+ }
|
|
|
+
|
|
|
+ if (rsp->ndp_info.ndp_app_info_len) {
|
|
|
+ rsp->ndp_info.ndp_app_info =
|
|
|
+ qdf_mem_malloc(rsp->ndp_info.ndp_app_info_len);
|
|
|
+ if (!rsp->ndp_info.ndp_app_info) {
|
|
|
+ target_if_err("malloc failed");
|
|
|
+ ret = -ENOMEM;
|
|
|
+ goto free_ind_resources;
|
|
|
+ }
|
|
|
+ qdf_mem_copy(rsp->ndp_info.ndp_app_info,
|
|
|
+ event->ndp_app_info,
|
|
|
+ rsp->ndp_info.ndp_app_info_len);
|
|
|
+ }
|
|
|
+
|
|
|
+ if (rsp->scid.scid_len) {
|
|
|
+ rsp->scid.scid =
|
|
|
+ qdf_mem_malloc(rsp->scid.scid_len);
|
|
|
+ if (!rsp->scid.scid) {
|
|
|
+ target_if_err("malloc failed");
|
|
|
+ ret = -ENOMEM;
|
|
|
+ goto free_ind_resources;
|
|
|
+ }
|
|
|
+ qdf_mem_copy(rsp->scid.scid,
|
|
|
+ event->ndp_scid, rsp->scid.scid_len);
|
|
|
+ target_if_debug("scid hex dump:");
|
|
|
+ QDF_TRACE_HEX_DUMP(QDF_MODULE_ID_WMA, QDF_TRACE_LEVEL_DEBUG,
|
|
|
+ rsp->scid.scid, rsp->scid.scid_len);
|
|
|
+ }
|
|
|
+
|
|
|
+ msg.type = NDP_INDICATION;
|
|
|
+ msg.bodyptr = rsp;
|
|
|
+ msg.callback = target_if_nan_event_dispatcher;
|
|
|
+ target_if_debug("NDP_INDICATION sent: %d", msg.type);
|
|
|
+ status = scheduler_post_msg(QDF_MODULE_ID_TARGET_IF, &msg);
|
|
|
+ if (QDF_IS_STATUS_ERROR(status)) {
|
|
|
+ target_if_err("failed to post msg, status: %d", status);
|
|
|
+ ret = -EINVAL;
|
|
|
+ goto free_ind_resources;
|
|
|
+ }
|
|
|
+ wlan_objmgr_vdev_release_ref(vdev, WLAN_NAN_ID);
|
|
|
+ return 0;
|
|
|
+
|
|
|
+free_ind_resources:
|
|
|
+ wlan_objmgr_vdev_release_ref(vdev, WLAN_NAN_ID);
|
|
|
+ qdf_mem_free(rsp->ndp_config.ndp_cfg);
|
|
|
+ qdf_mem_free(rsp->ndp_info.ndp_app_info);
|
|
|
+ qdf_mem_free(rsp->scid.scid);
|
|
|
+ qdf_mem_free(rsp);
|
|
|
+
|
|
|
+ return ret;
|
|
|
+}
|
|
|
+
|
|
|
+static int target_if_ndp_confirm_handler(ol_scn_t scn, uint8_t *data,
|
|
|
+ uint32_t data_len)
|
|
|
+{
|
|
|
+ QDF_STATUS status;
|
|
|
+ struct wlan_objmgr_psoc *psoc;
|
|
|
+ struct wlan_objmgr_vdev *vdev;
|
|
|
+ struct scheduler_msg msg = {0};
|
|
|
+ WMI_NDP_CONFIRM_EVENTID_param_tlvs *event;
|
|
|
+ wmi_ndp_confirm_event_fixed_param *fixed_params;
|
|
|
+ struct nan_datapath_confirm_event *rsp;
|
|
|
+
|
|
|
+ psoc = target_if_get_psoc_from_scn_hdl(scn);
|
|
|
+ if (!psoc) {
|
|
|
+ target_if_err("psoc is null");
|
|
|
+ return -EINVAL;
|
|
|
+ }
|
|
|
+
|
|
|
+ rsp = qdf_mem_malloc(sizeof(*rsp));
|
|
|
+ if (!rsp) {
|
|
|
+ target_if_err("malloc failed");
|
|
|
+ return -ENOMEM;
|
|
|
+ }
|
|
|
+
|
|
|
+ event = (WMI_NDP_CONFIRM_EVENTID_param_tlvs *) data;
|
|
|
+ fixed_params = (wmi_ndp_confirm_event_fixed_param *)event->fixed_param;
|
|
|
+ target_if_debug("WMI_NDP_CONFIRM_EVENTID(0x%X) recieved. vdev %d, ndp_instance %d, rsp_code %d, reason_code: %d, num_active_ndps_on_peer: %d",
|
|
|
+ WMI_NDP_CONFIRM_EVENTID, fixed_params->vdev_id,
|
|
|
+ fixed_params->ndp_instance_id, fixed_params->rsp_code,
|
|
|
+ fixed_params->reason_code,
|
|
|
+ fixed_params->num_active_ndps_on_peer);
|
|
|
+ target_if_debug("ndp_cfg - %d bytes", fixed_params->ndp_cfg_len);
|
|
|
+ QDF_TRACE_HEX_DUMP(QDF_MODULE_ID_WMA, QDF_TRACE_LEVEL_DEBUG,
|
|
|
+ &event->ndp_cfg, fixed_params->ndp_cfg_len);
|
|
|
+
|
|
|
+ target_if_debug("ndp_app_info - %d bytes",
|
|
|
+ fixed_params->ndp_app_info_len);
|
|
|
+ QDF_TRACE_HEX_DUMP(QDF_MODULE_ID_WMA, QDF_TRACE_LEVEL_DEBUG,
|
|
|
+ &event->ndp_app_info, fixed_params->ndp_app_info_len);
|
|
|
+
|
|
|
+ vdev = wlan_objmgr_get_vdev_by_id_from_psoc(psoc,
|
|
|
+ fixed_params->vdev_id, WLAN_NAN_ID);
|
|
|
+ if (!vdev) {
|
|
|
+ target_if_err("vdev is null");
|
|
|
+ return -EINVAL;
|
|
|
+ }
|
|
|
+
|
|
|
+ rsp->vdev = vdev;
|
|
|
+ rsp->ndp_instance_id = fixed_params->ndp_instance_id;
|
|
|
+ rsp->rsp_code = fixed_params->rsp_code;
|
|
|
+ rsp->reason_code = fixed_params->reason_code;
|
|
|
+ rsp->num_active_ndps_on_peer =
|
|
|
+ fixed_params->num_active_ndps_on_peer;
|
|
|
+
|
|
|
+ WMI_MAC_ADDR_TO_CHAR_ARRAY(&fixed_params->peer_ndi_mac_addr,
|
|
|
+ rsp->peer_ndi_mac_addr.bytes);
|
|
|
+
|
|
|
+ rsp->ndp_info.ndp_app_info_len = fixed_params->ndp_app_info_len;
|
|
|
+
|
|
|
+ if (rsp->ndp_info.ndp_app_info_len) {
|
|
|
+ rsp->ndp_info.ndp_app_info =
|
|
|
+ qdf_mem_malloc(fixed_params->ndp_app_info_len);
|
|
|
+ if (!rsp->ndp_info.ndp_app_info) {
|
|
|
+ target_if_err("malloc failed");
|
|
|
+ qdf_mem_free(rsp);
|
|
|
+ wlan_objmgr_vdev_release_ref(vdev, WLAN_NAN_ID);
|
|
|
+ return -ENOMEM;
|
|
|
+ }
|
|
|
+ qdf_mem_copy(&rsp->ndp_info.ndp_app_info,
|
|
|
+ event->ndp_app_info,
|
|
|
+ rsp->ndp_info.ndp_app_info_len);
|
|
|
+ }
|
|
|
+ msg.type = NDP_CONFIRM;
|
|
|
+ msg.bodyptr = rsp;
|
|
|
+ msg.callback = target_if_nan_event_dispatcher;
|
|
|
+ target_if_err("NDP_CONFIRM sent: %d", msg.type);
|
|
|
+ status = scheduler_post_msg(QDF_MODULE_ID_TARGET_IF, &msg);
|
|
|
+ wlan_objmgr_vdev_release_ref(vdev, WLAN_NAN_ID);
|
|
|
+ if (QDF_IS_STATUS_ERROR(status)) {
|
|
|
+ target_if_err("failed to post msg, status: %d", status);
|
|
|
+ qdf_mem_free(rsp->ndp_info.ndp_app_info);
|
|
|
+ qdf_mem_free(rsp);
|
|
|
+ return -EINVAL;
|
|
|
+ }
|
|
|
+
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+
|
|
|
+static QDF_STATUS target_if_nan_req(void *req, uint32_t req_type)
|
|
|
+{
|
|
|
+ /* send cmd to fw */
|
|
|
+ switch (req_type) {
|
|
|
+ case NDP_INITIATOR_REQ:
|
|
|
+ target_if_nan_ndp_intiaitor_req(req);
|
|
|
+ break;
|
|
|
+ default:
|
|
|
+ target_if_err("invalid req type");
|
|
|
+ break;
|
|
|
+ }
|
|
|
return QDF_STATUS_SUCCESS;
|
|
|
}
|
|
|
|
|
@@ -36,8 +537,7 @@ void target_if_nan_register_tx_ops(struct wlan_lmac_if_tx_ops *tx_ops)
|
|
|
|
|
|
void target_if_nan_register_rx_ops(struct wlan_lmac_if_rx_ops *rx_ops)
|
|
|
{
|
|
|
- /* TBD */
|
|
|
- rx_ops->nan_rx_ops.nan_event_rx = NULL;
|
|
|
+ rx_ops->nan_rx_ops.nan_event_rx = nan_event_handler;
|
|
|
}
|
|
|
|
|
|
inline struct wlan_lmac_if_nan_tx_ops *target_if_nan_get_tx_ops(
|
|
@@ -64,12 +564,69 @@ inline struct wlan_lmac_if_nan_rx_ops *target_if_nan_get_rx_ops(
|
|
|
|
|
|
QDF_STATUS target_if_nan_register_events(struct wlan_objmgr_psoc *psoc)
|
|
|
{
|
|
|
- /* TBD */
|
|
|
+ int ret;
|
|
|
+ wmi_unified_t handle = GET_WMI_HDL_FROM_PSOC(psoc);
|
|
|
+
|
|
|
+ ret = wmi_unified_register_event_handler(handle,
|
|
|
+ WMI_NDP_INITIATOR_RSP_EVENTID,
|
|
|
+ target_if_ndp_initiator_rsp_handler,
|
|
|
+ WMI_RX_UMAC_CTX);
|
|
|
+ if (ret) {
|
|
|
+ target_if_err("wmi event registration failed, ret: %d", ret);
|
|
|
+ return QDF_STATUS_E_FAILURE;
|
|
|
+ }
|
|
|
+
|
|
|
+ ret = wmi_unified_register_event_handler(handle,
|
|
|
+ WMI_NDP_INDICATION_EVENTID,
|
|
|
+ target_if_ndp_ind_handler,
|
|
|
+ WMI_RX_UMAC_CTX);
|
|
|
+ if (ret) {
|
|
|
+ target_if_err("wmi event registration failed, ret: %d", ret);
|
|
|
+ target_if_nan_deregister_events(psoc);
|
|
|
+ return QDF_STATUS_E_FAILURE;
|
|
|
+ }
|
|
|
+
|
|
|
+ ret = wmi_unified_register_event_handler(handle,
|
|
|
+ WMI_NDP_CONFIRM_EVENTID,
|
|
|
+ target_if_ndp_confirm_handler,
|
|
|
+ WMI_RX_UMAC_CTX);
|
|
|
+ if (ret) {
|
|
|
+ target_if_err("wmi event registration failed, ret: %d", ret);
|
|
|
+ target_if_nan_deregister_events(psoc);
|
|
|
+ return QDF_STATUS_E_FAILURE;
|
|
|
+ }
|
|
|
+
|
|
|
return QDF_STATUS_SUCCESS;
|
|
|
}
|
|
|
|
|
|
QDF_STATUS target_if_nan_deregister_events(struct wlan_objmgr_psoc *psoc)
|
|
|
{
|
|
|
- /* TBD */
|
|
|
- return QDF_STATUS_SUCCESS;
|
|
|
+ int ret, status = 0;
|
|
|
+ wmi_unified_t handle = GET_WMI_HDL_FROM_PSOC(psoc);
|
|
|
+
|
|
|
+ ret = wmi_unified_unregister_event_handler(handle,
|
|
|
+ WMI_NDP_INITIATOR_RSP_EVENTID);
|
|
|
+ if (ret) {
|
|
|
+ target_if_err("wmi event deregistration failed, ret: %d", ret);
|
|
|
+ status = ret;
|
|
|
+ }
|
|
|
+
|
|
|
+ ret = wmi_unified_unregister_event_handler(handle,
|
|
|
+ WMI_NDP_INDICATION_EVENTID);
|
|
|
+ if (ret) {
|
|
|
+ target_if_err("wmi event deregistration failed, ret: %d", ret);
|
|
|
+ status = ret;
|
|
|
+ }
|
|
|
+
|
|
|
+ ret = wmi_unified_unregister_event_handler(handle,
|
|
|
+ WMI_NDP_CONFIRM_EVENTID);
|
|
|
+ if (ret) {
|
|
|
+ target_if_err("wmi event deregistration failed, ret: %d", ret);
|
|
|
+ status = ret;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (status)
|
|
|
+ return QDF_STATUS_E_FAILURE;
|
|
|
+ else
|
|
|
+ return QDF_STATUS_SUCCESS;
|
|
|
}
|