|
@@ -24,6 +24,7 @@
|
|
|
#include "qdf_trace.h"
|
|
|
#include "os_if_nan.h"
|
|
|
#include "wlan_nan_api.h"
|
|
|
+#include "nan_ucfg_api.h"
|
|
|
#include "nan_public_structs.h"
|
|
|
#include "wlan_osif_priv.h"
|
|
|
#include <net/cfg80211.h>
|
|
@@ -168,6 +169,147 @@ static int os_if_nan_process_ndi_delete(struct wlan_objmgr_psoc *psoc,
|
|
|
return cb_obj.ndi_delete(vdev_id, iface_name, transaction_id);
|
|
|
}
|
|
|
|
|
|
+/**
|
|
|
+ * os_if_nan_process_ndp_initiator_req() - NDP initiator request handler
|
|
|
+ * @ctx: hdd context
|
|
|
+ * @tb: parsed NL attribute list
|
|
|
+ *
|
|
|
+ * tb will contain following vendor attributes:
|
|
|
+ * QCA_WLAN_VENDOR_ATTR_NDP_IFACE_STR
|
|
|
+ * QCA_WLAN_VENDOR_ATTR_NDP_TRANSACTION_ID
|
|
|
+ * QCA_WLAN_VENDOR_ATTR_NDP_CHANNEL - optional
|
|
|
+ * QCA_WLAN_VENDOR_ATTR_NDP_CHANNEL_CONFIG
|
|
|
+ * QCA_WLAN_VENDOR_ATTR_NDP_SERVICE_INSTANCE_ID
|
|
|
+ * QCA_WLAN_VENDOR_ATTR_NDP_PEER_DISCOVERY_MAC_ADDR
|
|
|
+ * QCA_WLAN_VENDOR_ATTR_NDP_APP_INFO - optional
|
|
|
+ * QCA_WLAN_VENDOR_ATTR_NDP_CONFIG_QOS - optional
|
|
|
+ * QCA_WLAN_VENDOR_ATTR_NDP_PMK - optional
|
|
|
+ * QCA_WLAN_VENDOR_ATTR_NDP_NCS_SK_TYPE - optional
|
|
|
+ *
|
|
|
+ * Return: 0 on success or error code on failure
|
|
|
+ */
|
|
|
+static int os_if_nan_process_ndp_initiator_req(struct wlan_objmgr_psoc *psoc,
|
|
|
+ struct nlattr **tb)
|
|
|
+{
|
|
|
+ int ret = 0;
|
|
|
+ char *iface_name;
|
|
|
+ QDF_STATUS status;
|
|
|
+ uint32_t ndp_qos_cfg;
|
|
|
+ enum nan_datapath_state state;
|
|
|
+ struct wlan_objmgr_vdev *nan_vdev;
|
|
|
+ struct nan_datapath_initiator_req req = {0};
|
|
|
+
|
|
|
+ if (!tb[QCA_WLAN_VENDOR_ATTR_NDP_IFACE_STR]) {
|
|
|
+ cfg80211_err("Interface name string is unavailable");
|
|
|
+ return -EINVAL;
|
|
|
+ }
|
|
|
+
|
|
|
+ iface_name = nla_data(tb[QCA_WLAN_VENDOR_ATTR_NDP_IFACE_STR]);
|
|
|
+ nan_vdev = ucfg_nan_get_ndi_vdev(psoc, WLAN_NAN_ID);
|
|
|
+ if (!nan_vdev) {
|
|
|
+ cfg80211_err("NAN data interface %s not available", iface_name);
|
|
|
+ return -EINVAL;
|
|
|
+ }
|
|
|
+
|
|
|
+ state = ucfg_nan_get_ndi_state(nan_vdev);
|
|
|
+ if (state == NAN_DATA_NDI_DELETED_STATE ||
|
|
|
+ state == NAN_DATA_NDI_DELETING_STATE ||
|
|
|
+ state == NAN_DATA_NDI_CREATING_STATE) {
|
|
|
+ cfg80211_err("Data request not allowed in NDI current state: %d",
|
|
|
+ state);
|
|
|
+ ret = -EINVAL;
|
|
|
+ goto initiator_req_failed;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (!tb[QCA_WLAN_VENDOR_ATTR_NDP_TRANSACTION_ID]) {
|
|
|
+ cfg80211_err("Transaction ID is unavailable");
|
|
|
+ ret = -EINVAL;
|
|
|
+ goto initiator_req_failed;
|
|
|
+ }
|
|
|
+ req.transaction_id =
|
|
|
+ nla_get_u16(tb[QCA_WLAN_VENDOR_ATTR_NDP_TRANSACTION_ID]);
|
|
|
+
|
|
|
+ if (tb[QCA_WLAN_VENDOR_ATTR_NDP_CHANNEL])
|
|
|
+ req.channel = nla_get_u32(tb[QCA_WLAN_VENDOR_ATTR_NDP_CHANNEL]);
|
|
|
+
|
|
|
+ if (tb[QCA_WLAN_VENDOR_ATTR_NDP_CHANNEL_CONFIG]) {
|
|
|
+ req.channel_cfg =
|
|
|
+ nla_get_u32(tb[QCA_WLAN_VENDOR_ATTR_NDP_CHANNEL_CONFIG]);
|
|
|
+ } else {
|
|
|
+ cfg80211_err("Channel config is unavailable");
|
|
|
+ ret = -EINVAL;
|
|
|
+ goto initiator_req_failed;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (!tb[QCA_WLAN_VENDOR_ATTR_NDP_SERVICE_INSTANCE_ID]) {
|
|
|
+ cfg80211_err("NDP service instance ID is unavailable");
|
|
|
+ ret = -EINVAL;
|
|
|
+ goto initiator_req_failed;
|
|
|
+ }
|
|
|
+ req.service_instance_id =
|
|
|
+ nla_get_u32(tb[QCA_WLAN_VENDOR_ATTR_NDP_SERVICE_INSTANCE_ID]);
|
|
|
+
|
|
|
+ qdf_mem_copy(req.self_ndi_mac_addr.bytes,
|
|
|
+ wlan_vdev_mlme_get_macaddr(nan_vdev), QDF_MAC_ADDR_SIZE);
|
|
|
+
|
|
|
+ if (!tb[QCA_WLAN_VENDOR_ATTR_NDP_PEER_DISCOVERY_MAC_ADDR]) {
|
|
|
+ cfg80211_err("NDI peer discovery mac addr is unavailable");
|
|
|
+ ret = -EINVAL;
|
|
|
+ goto initiator_req_failed;
|
|
|
+ }
|
|
|
+ qdf_mem_copy(req.peer_discovery_mac_addr.bytes,
|
|
|
+ nla_data(tb[QCA_WLAN_VENDOR_ATTR_NDP_PEER_DISCOVERY_MAC_ADDR]),
|
|
|
+ QDF_MAC_ADDR_SIZE);
|
|
|
+
|
|
|
+ if (tb[QCA_WLAN_VENDOR_ATTR_NDP_APP_INFO]) {
|
|
|
+ req.ndp_info.ndp_app_info_len =
|
|
|
+ nla_len(tb[QCA_WLAN_VENDOR_ATTR_NDP_APP_INFO]);
|
|
|
+ req.ndp_info.ndp_app_info =
|
|
|
+ nla_data(tb[QCA_WLAN_VENDOR_ATTR_NDP_APP_INFO]);
|
|
|
+ }
|
|
|
+
|
|
|
+ if (tb[QCA_WLAN_VENDOR_ATTR_NDP_CONFIG_QOS]) {
|
|
|
+ /* at present ndp config stores 4 bytes QOS info only */
|
|
|
+ req.ndp_config.ndp_cfg_len = 4;
|
|
|
+ req.ndp_config.ndp_cfg = (uint8_t *)&ndp_qos_cfg;
|
|
|
+ ndp_qos_cfg =
|
|
|
+ nla_get_u32(tb[QCA_WLAN_VENDOR_ATTR_NDP_CONFIG_QOS]);
|
|
|
+ }
|
|
|
+
|
|
|
+ if (tb[QCA_WLAN_VENDOR_ATTR_NDP_NCS_SK_TYPE] &&
|
|
|
+ !tb[QCA_WLAN_VENDOR_ATTR_NDP_PMK]) {
|
|
|
+ cfg80211_err("PMK cannot be absent when CSID is present.");
|
|
|
+ ret = -EINVAL;
|
|
|
+ goto initiator_req_failed;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (tb[QCA_WLAN_VENDOR_ATTR_NDP_PMK]) {
|
|
|
+ req.pmk.pmk = nla_data(tb[QCA_WLAN_VENDOR_ATTR_NDP_PMK]);
|
|
|
+ req.pmk.pmk_len = nla_len(tb[QCA_WLAN_VENDOR_ATTR_NDP_PMK]);
|
|
|
+ QDF_TRACE_HEX_DUMP(QDF_MODULE_ID_HDD,
|
|
|
+ QDF_TRACE_LEVEL_DEBUG,
|
|
|
+ req.pmk.pmk, req.pmk.pmk_len);
|
|
|
+ }
|
|
|
+
|
|
|
+ if (tb[QCA_WLAN_VENDOR_ATTR_NDP_NCS_SK_TYPE]) {
|
|
|
+ req.ncs_sk_type =
|
|
|
+ nla_get_u32(tb[QCA_WLAN_VENDOR_ATTR_NDP_NCS_SK_TYPE]);
|
|
|
+
|
|
|
+ }
|
|
|
+
|
|
|
+ cfg80211_debug("vdev_id: %d, transaction_id: %d, channel: %d, service_instance_id: %d, ndp_app_info_len: %d, csid: %d, peer_discovery_mac_addr: %pM",
|
|
|
+ wlan_vdev_get_id(nan_vdev), req.transaction_id, req.channel,
|
|
|
+ req.service_instance_id, req.ndp_info.ndp_app_info_len,
|
|
|
+ req.ncs_sk_type, req.peer_discovery_mac_addr.bytes);
|
|
|
+
|
|
|
+ status = ucfg_nan_req_processor(nan_vdev, &req, NDP_INITIATOR_REQ);
|
|
|
+ ret = qdf_status_to_os_return(status);
|
|
|
+initiator_req_failed:
|
|
|
+ wlan_objmgr_vdev_release_ref(nan_vdev, WLAN_NAN_ID);
|
|
|
+
|
|
|
+ return ret;
|
|
|
+}
|
|
|
+
|
|
|
int os_if_nan_process_ndp_cmd(struct wlan_objmgr_psoc *psoc,
|
|
|
const void *data, int data_len)
|
|
|
{
|
|
@@ -211,6 +353,8 @@ int os_if_nan_process_ndp_cmd(struct wlan_objmgr_psoc *psoc,
|
|
|
return os_if_nan_process_ndi_create(psoc, tb);
|
|
|
case QCA_WLAN_VENDOR_ATTR_NDP_INTERFACE_DELETE:
|
|
|
return os_if_nan_process_ndi_delete(psoc, tb);
|
|
|
+ case QCA_WLAN_VENDOR_ATTR_NDP_INITIATOR_REQUEST:
|
|
|
+ return os_if_nan_process_ndp_initiator_req(psoc, tb);
|
|
|
default:
|
|
|
cfg80211_err("Unrecognized NDP vendor cmd %d", ndp_cmd_type);
|
|
|
return -EINVAL;
|
|
@@ -219,6 +363,368 @@ int os_if_nan_process_ndp_cmd(struct wlan_objmgr_psoc *psoc,
|
|
|
return -EINVAL;
|
|
|
}
|
|
|
|
|
|
+/**
|
|
|
+ * os_if_ndp_initiator_rsp_handler() - NDP initiator response handler
|
|
|
+ * @vdev: pointer to vdev object
|
|
|
+ * @rsp_params: response parameters
|
|
|
+ *
|
|
|
+ * Following vendor event is sent to cfg80211:
|
|
|
+ * QCA_WLAN_VENDOR_ATTR_NDP_SUBCMD =
|
|
|
+ * QCA_WLAN_VENDOR_ATTR_NDP_INITIATOR_RESPONSE (4 bytes)
|
|
|
+ * QCA_WLAN_VENDOR_ATTR_NDP_TRANSACTION_ID (2 bytes)
|
|
|
+ * QCA_WLAN_VENDOR_ATTR_NDP_INSTANCE_ID (4 bytes)
|
|
|
+ * QCA_WLAN_VENDOR_ATTR_NDP_DRV_RESPONSE_STATUS_TYPE (4 bytes)
|
|
|
+ * QCA_WLAN_VENDOR_ATTR_NDP_DRV_RETURN_VALUE (4 bytes)
|
|
|
+ *
|
|
|
+ * Return: none
|
|
|
+ */
|
|
|
+static void os_if_ndp_initiator_rsp_handler(struct wlan_objmgr_vdev *vdev,
|
|
|
+ struct nan_datapath_initiator_rsp *rsp)
|
|
|
+{
|
|
|
+ uint32_t data_len;
|
|
|
+ struct sk_buff *vendor_event;
|
|
|
+ struct wlan_objmgr_pdev *pdev = wlan_vdev_get_pdev(vdev);
|
|
|
+ struct pdev_osif_priv *os_priv = wlan_pdev_get_ospriv(pdev);
|
|
|
+
|
|
|
+ if (!rsp) {
|
|
|
+ cfg80211_err("Invalid NDP Initator response");
|
|
|
+ return;
|
|
|
+ }
|
|
|
+
|
|
|
+ data_len = (4 * sizeof(uint32_t)) + (1 * sizeof(uint16_t)) +
|
|
|
+ NLMSG_HDRLEN + (5 * NLA_HDRLEN);
|
|
|
+ vendor_event = cfg80211_vendor_event_alloc(os_priv->wiphy, NULL,
|
|
|
+ data_len, QCA_NL80211_VENDOR_SUBCMD_NDP_INDEX,
|
|
|
+ GFP_ATOMIC);
|
|
|
+ if (!vendor_event) {
|
|
|
+ cfg80211_err("cfg80211_vendor_event_alloc failed");
|
|
|
+ return;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (nla_put_u32(vendor_event, QCA_WLAN_VENDOR_ATTR_NDP_SUBCMD,
|
|
|
+ QCA_WLAN_VENDOR_ATTR_NDP_INITIATOR_RESPONSE))
|
|
|
+ goto ndp_initiator_rsp_nla_failed;
|
|
|
+
|
|
|
+ if (nla_put_u16(vendor_event, QCA_WLAN_VENDOR_ATTR_NDP_TRANSACTION_ID,
|
|
|
+ rsp->transaction_id))
|
|
|
+ goto ndp_initiator_rsp_nla_failed;
|
|
|
+
|
|
|
+ if (nla_put_u32(vendor_event,
|
|
|
+ QCA_WLAN_VENDOR_ATTR_NDP_INSTANCE_ID,
|
|
|
+ rsp->ndp_instance_id))
|
|
|
+ goto ndp_initiator_rsp_nla_failed;
|
|
|
+
|
|
|
+ if (nla_put_u32(vendor_event,
|
|
|
+ QCA_WLAN_VENDOR_ATTR_NDP_DRV_RESPONSE_STATUS_TYPE,
|
|
|
+ rsp->status))
|
|
|
+ goto ndp_initiator_rsp_nla_failed;
|
|
|
+
|
|
|
+ if (nla_put_u32(vendor_event, QCA_WLAN_VENDOR_ATTR_NDP_DRV_RETURN_VALUE,
|
|
|
+ rsp->reason))
|
|
|
+ goto ndp_initiator_rsp_nla_failed;
|
|
|
+
|
|
|
+ cfg80211_debug("NDP Initiator rsp sent, tid:%d, instance id:%d, status:%d, reason: %d",
|
|
|
+ rsp->transaction_id, rsp->ndp_instance_id, rsp->status,
|
|
|
+ rsp->reason);
|
|
|
+ cfg80211_vendor_event(vendor_event, GFP_ATOMIC);
|
|
|
+ return;
|
|
|
+ndp_initiator_rsp_nla_failed:
|
|
|
+ cfg80211_err("nla_put api failed");
|
|
|
+ kfree_skb(vendor_event);
|
|
|
+}
|
|
|
+
|
|
|
+/**
|
|
|
+ * os_if_ndp_indication_handler() - NDP indication handler
|
|
|
+ * @vdev: pointer to vdev object
|
|
|
+ * @ind_params: indication parameters
|
|
|
+ *
|
|
|
+ * Following vendor event is sent to cfg80211:
|
|
|
+ * QCA_WLAN_VENDOR_ATTR_NDP_SUBCMD =
|
|
|
+ * QCA_WLAN_VENDOR_ATTR_NDP_REQUEST_IND (4 bytes)
|
|
|
+ * QCA_WLAN_VENDOR_ATTR_NDP_IFACE_STR (IFNAMSIZ)
|
|
|
+ * QCA_WLAN_VENDOR_ATTR_NDP_SERVICE_INSTANCE_ID (4 bytes)
|
|
|
+ * QCA_WLAN_VENDOR_ATTR_NDP_NDI_MAC_ADDR (6 bytes)
|
|
|
+ * QCA_WLAN_VENDOR_ATTR_NDP_PEER_DISCOVERY_MAC_ADDR (6 bytes)
|
|
|
+ * QCA_WLAN_VENDOR_ATTR_NDP_INSTANCE_ID (4 bytes)
|
|
|
+ * QCA_WLAN_VENDOR_ATTR_NDP_APP_INFO (ndp_app_info_len size)
|
|
|
+ * QCA_WLAN_VENDOR_ATTR_NDP_CONFIG_QOS (4 bytes)
|
|
|
+ * QCA_WLAN_VENDOR_ATTR_NDP_NCS_SK_TYPE(4 bytes)
|
|
|
+ * QCA_WLAN_VENDOR_ATTR_NDP_SCID(scid_len in size)
|
|
|
+ *
|
|
|
+ * Return: none
|
|
|
+ */
|
|
|
+static void os_if_ndp_indication_handler(struct wlan_objmgr_vdev *vdev,
|
|
|
+ struct nan_datapath_indication_event *event)
|
|
|
+{
|
|
|
+ uint16_t data_len;
|
|
|
+ uint32_t ndp_qos_config;
|
|
|
+ struct sk_buff *vendor_event;
|
|
|
+ struct wlan_objmgr_pdev *pdev = wlan_vdev_get_pdev(vdev);
|
|
|
+ struct pdev_osif_priv *os_priv = wlan_pdev_get_ospriv(pdev);
|
|
|
+ enum nan_datapath_state state;
|
|
|
+
|
|
|
+ if (!event) {
|
|
|
+ cfg80211_err("Invalid NDP Indication");
|
|
|
+ return;
|
|
|
+ }
|
|
|
+
|
|
|
+ cfg80211_debug("NDP Indication, policy: %d", event->policy);
|
|
|
+ state = ucfg_nan_get_ndi_state(vdev);
|
|
|
+ /* check if we are in middle of deleting/creating the interface */
|
|
|
+
|
|
|
+ if (state == NAN_DATA_NDI_DELETED_STATE ||
|
|
|
+ state == NAN_DATA_NDI_DELETING_STATE ||
|
|
|
+ state == NAN_DATA_NDI_CREATING_STATE) {
|
|
|
+ cfg80211_err("Data request not allowed in current NDI state: %d",
|
|
|
+ state);
|
|
|
+ return;
|
|
|
+ }
|
|
|
+
|
|
|
+ data_len = (5 * sizeof(uint32_t)) + (2 * QDF_MAC_ADDR_SIZE) + IFNAMSIZ +
|
|
|
+ event->ndp_info.ndp_app_info_len + event->scid.scid_len +
|
|
|
+ (10 * NLA_HDRLEN) + NLMSG_HDRLEN;
|
|
|
+
|
|
|
+ /* notify response to the upper layer */
|
|
|
+ vendor_event = cfg80211_vendor_event_alloc(os_priv->wiphy,
|
|
|
+ NULL, data_len,
|
|
|
+ QCA_NL80211_VENDOR_SUBCMD_NDP_INDEX,
|
|
|
+ GFP_ATOMIC);
|
|
|
+ if (!vendor_event) {
|
|
|
+ cfg80211_err("cfg80211_vendor_event_alloc failed");
|
|
|
+ return;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (nla_put_u32(vendor_event, QCA_WLAN_VENDOR_ATTR_NDP_SUBCMD,
|
|
|
+ QCA_WLAN_VENDOR_ATTR_NDP_REQUEST_IND))
|
|
|
+ goto ndp_indication_nla_failed;
|
|
|
+
|
|
|
+ if (nla_put(vendor_event, QCA_WLAN_VENDOR_ATTR_NDP_IFACE_STR,
|
|
|
+ IFNAMSIZ, "nan0"/* adapter->dev->name - fetch dev name */))
|
|
|
+ goto ndp_indication_nla_failed;
|
|
|
+
|
|
|
+ if (nla_put_u32(vendor_event,
|
|
|
+ QCA_WLAN_VENDOR_ATTR_NDP_SERVICE_INSTANCE_ID,
|
|
|
+ event->service_instance_id))
|
|
|
+ goto ndp_indication_nla_failed;
|
|
|
+
|
|
|
+ if (nla_put(vendor_event,
|
|
|
+ QCA_WLAN_VENDOR_ATTR_NDP_NDI_MAC_ADDR,
|
|
|
+ QDF_MAC_ADDR_SIZE, event->peer_mac_addr.bytes))
|
|
|
+ goto ndp_indication_nla_failed;
|
|
|
+
|
|
|
+ if (nla_put(vendor_event,
|
|
|
+ QCA_WLAN_VENDOR_ATTR_NDP_PEER_DISCOVERY_MAC_ADDR,
|
|
|
+ QDF_MAC_ADDR_SIZE, event->peer_discovery_mac_addr.bytes))
|
|
|
+ goto ndp_indication_nla_failed;
|
|
|
+
|
|
|
+ if (nla_put_u32(vendor_event, QCA_WLAN_VENDOR_ATTR_NDP_INSTANCE_ID,
|
|
|
+ event->ndp_instance_id))
|
|
|
+ goto ndp_indication_nla_failed;
|
|
|
+
|
|
|
+ if (event->ndp_info.ndp_app_info_len)
|
|
|
+ if (nla_put(vendor_event, QCA_WLAN_VENDOR_ATTR_NDP_APP_INFO,
|
|
|
+ event->ndp_info.ndp_app_info_len,
|
|
|
+ event->ndp_info.ndp_app_info))
|
|
|
+ goto ndp_indication_nla_failed;
|
|
|
+
|
|
|
+ if (event->ndp_config.ndp_cfg_len) {
|
|
|
+ ndp_qos_config = *((uint32_t *)event->ndp_config.ndp_cfg);
|
|
|
+ /* at present ndp config stores 4 bytes QOS info only */
|
|
|
+ if (nla_put_u32(vendor_event,
|
|
|
+ QCA_WLAN_VENDOR_ATTR_NDP_CONFIG_QOS,
|
|
|
+ ndp_qos_config))
|
|
|
+ goto ndp_indication_nla_failed;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (event->scid.scid_len) {
|
|
|
+ if (nla_put_u32(vendor_event,
|
|
|
+ QCA_WLAN_VENDOR_ATTR_NDP_NCS_SK_TYPE,
|
|
|
+ event->ncs_sk_type))
|
|
|
+ goto ndp_indication_nla_failed;
|
|
|
+
|
|
|
+ if (nla_put(vendor_event, QCA_WLAN_VENDOR_ATTR_NDP_SCID,
|
|
|
+ event->scid.scid_len,
|
|
|
+ event->scid.scid))
|
|
|
+ goto ndp_indication_nla_failed;
|
|
|
+
|
|
|
+ cfg80211_debug("csid: %d, scid_len: %d",
|
|
|
+ event->ncs_sk_type, event->scid.scid_len);
|
|
|
+
|
|
|
+ QDF_TRACE_HEX_DUMP(QDF_MODULE_ID_HDD, QDF_TRACE_LEVEL_DEBUG,
|
|
|
+ event->scid.scid, event->scid.scid_len);
|
|
|
+ }
|
|
|
+
|
|
|
+ cfg80211_vendor_event(vendor_event, GFP_ATOMIC);
|
|
|
+ return;
|
|
|
+ndp_indication_nla_failed:
|
|
|
+ cfg80211_err("nla_put api failed");
|
|
|
+ kfree_skb(vendor_event);
|
|
|
+}
|
|
|
+
|
|
|
+/**
|
|
|
+ * os_if_ndp_confirm_ind_handler() - NDP confirm indication handler
|
|
|
+ * @vdev: pointer to vdev object
|
|
|
+ * @ind_params: indication parameters
|
|
|
+ *
|
|
|
+ * Following vendor event is sent to cfg80211:
|
|
|
+ * QCA_WLAN_VENDOR_ATTR_NDP_SUBCMD =
|
|
|
+ * QCA_WLAN_VENDOR_ATTR_NDP_CONFIRM_IND (4 bytes)
|
|
|
+ * QCA_WLAN_VENDOR_ATTR_NDP_INSTANCE_ID (4 bytes)
|
|
|
+ * QCA_WLAN_VENDOR_ATTR_NDP_NDI_MAC_ADDR (6 bytes)
|
|
|
+ * QCA_WLAN_VENDOR_ATTR_NDP_IFACE_STR (IFNAMSIZ)
|
|
|
+ * QCA_WLAN_VENDOR_ATTR_NDP_APP_INFO (ndp_app_info_len size)
|
|
|
+ * QCA_WLAN_VENDOR_ATTR_NDP_RESPONSE_CODE (4 bytes)
|
|
|
+ * QCA_WLAN_VENDOR_ATTR_NDP_RETURN_VALUE (4 bytes)
|
|
|
+ *
|
|
|
+ * Return: none
|
|
|
+ */
|
|
|
+static void os_if_ndp_confirm_ind_handler(struct wlan_objmgr_vdev *vdev,
|
|
|
+ struct nan_datapath_confirm_event *ndp_confirm)
|
|
|
+{
|
|
|
+ int idx = 0;
|
|
|
+ uint32_t data_len;
|
|
|
+ QDF_STATUS status;
|
|
|
+ uint32_t ndp_qos_config = 0;
|
|
|
+ struct sk_buff *vendor_event;
|
|
|
+ struct wlan_objmgr_pdev *pdev = wlan_vdev_get_pdev(vdev);
|
|
|
+ struct wlan_objmgr_psoc *psoc = wlan_vdev_get_psoc(vdev);
|
|
|
+ struct pdev_osif_priv *os_priv = wlan_pdev_get_ospriv(pdev);
|
|
|
+ struct nan_callbacks cb_obj;
|
|
|
+
|
|
|
+ if (!ndp_confirm) {
|
|
|
+ cfg80211_err("Invalid NDP Initator response");
|
|
|
+ return;
|
|
|
+ }
|
|
|
+
|
|
|
+ status = ucfg_nan_get_callbacks(psoc, &cb_obj);
|
|
|
+ if (QDF_IS_STATUS_ERROR(status)) {
|
|
|
+ cfg80211_err("couldn't get callbacks");
|
|
|
+ return;
|
|
|
+ }
|
|
|
+
|
|
|
+ /* ndp_confirm is called each time user generated ndp req succeeds */
|
|
|
+ idx = cb_obj.get_peer_idx(wlan_vdev_get_id(vdev),
|
|
|
+ &ndp_confirm->peer_ndi_mac_addr);
|
|
|
+
|
|
|
+ if (idx < 0)
|
|
|
+ cfg80211_err("can't find addr: %pM in vdev_id: %d, peer table.",
|
|
|
+ &ndp_confirm->peer_ndi_mac_addr,
|
|
|
+ wlan_vdev_get_id(vdev));
|
|
|
+ else if (ndp_confirm->rsp_code == NAN_DATAPATH_RESPONSE_ACCEPT) {
|
|
|
+ uint32_t active_sessions =
|
|
|
+ ucfg_nan_get_active_ndp_sessions(vdev, idx);
|
|
|
+ ucfg_nan_set_active_ndp_sessions(vdev, active_sessions + 1,
|
|
|
+ idx);
|
|
|
+ }
|
|
|
+
|
|
|
+ data_len = (4 * sizeof(uint32_t)) + QDF_MAC_ADDR_SIZE + IFNAMSIZ +
|
|
|
+ + NLMSG_HDRLEN + (7 * NLA_HDRLEN) +
|
|
|
+ ndp_confirm->ndp_info.ndp_app_info_len;
|
|
|
+
|
|
|
+ if (ndp_confirm->ndp_info.ndp_app_info_len)
|
|
|
+ data_len += NLA_HDRLEN + ndp_confirm->ndp_info.ndp_app_info_len;
|
|
|
+
|
|
|
+ vendor_event = cfg80211_vendor_event_alloc(os_priv->wiphy, NULL,
|
|
|
+ data_len, QCA_NL80211_VENDOR_SUBCMD_NDP_INDEX,
|
|
|
+ GFP_ATOMIC);
|
|
|
+ if (!vendor_event) {
|
|
|
+ cfg80211_err("cfg80211_vendor_event_alloc failed");
|
|
|
+ return;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (nla_put_u32(vendor_event, QCA_WLAN_VENDOR_ATTR_NDP_SUBCMD,
|
|
|
+ QCA_WLAN_VENDOR_ATTR_NDP_CONFIRM_IND))
|
|
|
+ goto ndp_confirm_nla_failed;
|
|
|
+
|
|
|
+ if (nla_put_u32(vendor_event, QCA_WLAN_VENDOR_ATTR_NDP_INSTANCE_ID,
|
|
|
+ ndp_confirm->ndp_instance_id))
|
|
|
+ goto ndp_confirm_nla_failed;
|
|
|
+
|
|
|
+ if (nla_put(vendor_event, QCA_WLAN_VENDOR_ATTR_NDP_NDI_MAC_ADDR,
|
|
|
+ QDF_MAC_ADDR_SIZE, ndp_confirm->peer_ndi_mac_addr.bytes))
|
|
|
+ goto ndp_confirm_nla_failed;
|
|
|
+
|
|
|
+ if (nla_put(vendor_event, QCA_WLAN_VENDOR_ATTR_NDP_IFACE_STR,
|
|
|
+ IFNAMSIZ, "nan0" /* TBD adapter->dev->name - fetch name */))
|
|
|
+ goto ndp_confirm_nla_failed;
|
|
|
+
|
|
|
+ if (ndp_confirm->ndp_info.ndp_app_info_len && nla_put(vendor_event,
|
|
|
+ QCA_WLAN_VENDOR_ATTR_NDP_APP_INFO,
|
|
|
+ ndp_confirm->ndp_info.ndp_app_info_len,
|
|
|
+ ndp_confirm->ndp_info.ndp_app_info))
|
|
|
+ goto ndp_confirm_nla_failed;
|
|
|
+
|
|
|
+ if (nla_put_u32(vendor_event,
|
|
|
+ QCA_WLAN_VENDOR_ATTR_NDP_RESPONSE_CODE,
|
|
|
+ ndp_confirm->rsp_code))
|
|
|
+ goto ndp_confirm_nla_failed;
|
|
|
+
|
|
|
+ if (nla_put_u32(vendor_event,
|
|
|
+ QCA_WLAN_VENDOR_ATTR_NDP_DRV_RETURN_VALUE,
|
|
|
+ ndp_confirm->reason_code))
|
|
|
+ goto ndp_confirm_nla_failed;
|
|
|
+
|
|
|
+ cfg80211_vendor_event(vendor_event, GFP_ATOMIC);
|
|
|
+ cfg80211_debug("NDP confim sent, ndp instance id: %d, peer addr: %pM, ndp_cfg: %d, rsp_code: %d, reason_code: %d",
|
|
|
+ ndp_confirm->ndp_instance_id,
|
|
|
+ ndp_confirm->peer_ndi_mac_addr.bytes,
|
|
|
+ ndp_qos_config, ndp_confirm->rsp_code,
|
|
|
+ ndp_confirm->reason_code);
|
|
|
+
|
|
|
+ cfg80211_debug("NDP confim, ndp app info dump");
|
|
|
+ QDF_TRACE_HEX_DUMP(QDF_MODULE_ID_HDD, QDF_TRACE_LEVEL_DEBUG,
|
|
|
+ ndp_confirm->ndp_info.ndp_app_info,
|
|
|
+ ndp_confirm->ndp_info.ndp_app_info_len);
|
|
|
+ return;
|
|
|
+ndp_confirm_nla_failed:
|
|
|
+ cfg80211_err("nla_put api failed");
|
|
|
+ kfree_skb(vendor_event);
|
|
|
+}
|
|
|
+
|
|
|
+/**
|
|
|
+ * os_if_new_peer_ind_handler() - NDP new peer indication handler
|
|
|
+ * @adapter: pointer to adapter context
|
|
|
+ * @ind_params: indication parameters
|
|
|
+ *
|
|
|
+ * Return: none
|
|
|
+ */
|
|
|
+static void os_if_new_peer_ind_handler(struct wlan_objmgr_vdev *vdev,
|
|
|
+ struct nan_datapath_peer_ind *peer_ind)
|
|
|
+{
|
|
|
+ int ret;
|
|
|
+ QDF_STATUS status;
|
|
|
+ uint8_t vdev_id = wlan_vdev_get_id(vdev);
|
|
|
+ struct wlan_objmgr_psoc *psoc = wlan_vdev_get_psoc(vdev);
|
|
|
+ uint32_t active_peers = ucfg_nan_get_active_peers(vdev);
|
|
|
+ struct nan_callbacks cb_obj;
|
|
|
+
|
|
|
+ if (NULL == peer_ind) {
|
|
|
+ cfg80211_err("Invalid new NDP peer params");
|
|
|
+ return;
|
|
|
+ }
|
|
|
+
|
|
|
+ status = ucfg_nan_get_callbacks(psoc, &cb_obj);
|
|
|
+ if (QDF_IS_STATUS_ERROR(status)) {
|
|
|
+ cfg80211_err("failed to get callbacks");
|
|
|
+ return;
|
|
|
+ }
|
|
|
+
|
|
|
+ cfg80211_debug("session_id: %d, peer_mac: %pM, sta_id: %d",
|
|
|
+ peer_ind->session_id, peer_ind->peer_mac_addr.bytes,
|
|
|
+ peer_ind->sta_id);
|
|
|
+ ret = cb_obj.new_peer_ind(vdev_id, peer_ind->sta_id,
|
|
|
+ &peer_ind->peer_mac_addr,
|
|
|
+ (active_peers == 0 ? true : false));
|
|
|
+ if (ret) {
|
|
|
+ cfg80211_err("new peer handling at HDD failed %d", ret);
|
|
|
+ return;
|
|
|
+ }
|
|
|
+
|
|
|
+ active_peers++;
|
|
|
+ ucfg_nan_set_active_peers(vdev, active_peers);
|
|
|
+ cfg80211_debug("vdev_id: %d, num_peers: %d", vdev_id, active_peers);
|
|
|
+}
|
|
|
+
|
|
|
/**
|
|
|
* os_if_ndp_iface_create_rsp_handler() - NDP iface create response handler
|
|
|
* @adapter: pointer to adapter context
|
|
@@ -393,6 +899,18 @@ void os_if_nan_event_handler(struct wlan_objmgr_psoc *psoc,
|
|
|
case NAN_DATAPATH_INF_DELETE_RSP:
|
|
|
os_if_ndp_iface_delete_rsp_handler(psoc, vdev, msg);
|
|
|
break;
|
|
|
+ case NDP_CONFIRM:
|
|
|
+ os_if_ndp_confirm_ind_handler(vdev, msg);
|
|
|
+ break;
|
|
|
+ case NDP_INITIATOR_RSP:
|
|
|
+ os_if_ndp_initiator_rsp_handler(vdev, msg);
|
|
|
+ break;
|
|
|
+ case NDP_INDICATION:
|
|
|
+ os_if_ndp_indication_handler(vdev, msg);
|
|
|
+ break;
|
|
|
+ case NDP_NEW_PEER:
|
|
|
+ os_if_new_peer_ind_handler(vdev, msg);
|
|
|
+ break;
|
|
|
default:
|
|
|
break;
|
|
|
}
|
|
@@ -405,6 +923,12 @@ int os_if_nan_register_hdd_callbacks(struct wlan_objmgr_psoc *psoc,
|
|
|
os_if_nan_event_handler);
|
|
|
}
|
|
|
|
|
|
+int os_if_nan_register_lim_callbacks(struct wlan_objmgr_psoc *psoc,
|
|
|
+ struct nan_callbacks *cb_obj)
|
|
|
+{
|
|
|
+ return ucfg_nan_register_lim_callbacks(psoc, cb_obj);
|
|
|
+}
|
|
|
+
|
|
|
void os_if_nan_post_ndi_create_rsp(struct wlan_objmgr_psoc *psoc,
|
|
|
uint8_t vdev_id, bool success)
|
|
|
{
|