qcacld-3.0: Route GENERIC commands to SON

Route below vendor commands with GENERIC attributes to SON module:
1. QCA_NL80211_VENDOR_SUBCMD_SET_WIFI_CONFIGURATION
2. QCA_NL80211_VENDOR_SUBCMD_GET_WIFI_CONFIGURATION

Change-Id: I3646204a2af9b703190aff0c10f84cbd02ce30ab
CRs-Fixed: 3123141

core/hdd/src/wlan_hdd_cfg80211.c

@@ -177,6 +177,7 @@
 #include "wlan_hdd_mdns_offload.h"
 #include "wlan_pkt_capture_ucfg_api.h"
 #include "os_if_pkt_capture.h"
+#include "wlan_hdd_son.h"
 
 #define g_mode_rates_size (12)
 #define a_mode_rates_size (8)
@@ -7949,6 +7950,37 @@ static int hdd_config_tx_rx_nss(struct hdd_adapter *adapter,
 	return 0;
 }
 
+#ifdef WLAN_FEATURE_SON
+static int hdd_process_generic_set_cmd(struct hdd_adapter *adapter,
+				       struct nlattr *tb[])
+{
+	struct wireless_dev *wdev;
+	struct wiphy *wiphy;
+
+	if (!adapter)
+		return 0;
+
+	wdev = &adapter->wdev;
+	if (!wdev || !wdev->wiphy)
+		return 0;
+	wiphy = wdev->wiphy;
+
+	/* Generic command is used by EasyMesh,
+	 * route the command to SON module if it is Generic
+	 */
+	if (tb[QCA_WLAN_VENDOR_ATTR_CONFIG_GENERIC_COMMAND])
+		return hdd_son_send_set_wifi_generic_command(wiphy, wdev, tb);
+
+	return 0;
+}
+#else
+static int hdd_process_generic_set_cmd(struct hdd_adapter *adapter,
+				       struct nlattr *tb[])
+{
+	return -EINVAL;
+}
+#endif
+
 static int hdd_config_ani(struct hdd_adapter *adapter,
 			  struct nlattr *tb[])
 {
@@ -9974,6 +10006,7 @@ static const interdependent_setter_fn interdependent_setters[] = {
 	hdd_config_vdev_chains,
 	hdd_config_ani,
 	hdd_config_tx_rx_nss,
+	hdd_process_generic_set_cmd,
 };
 
 /**
@@ -10137,6 +10170,19 @@ __wlan_hdd_cfg80211_wifi_configuration_get(struct wiphy *wiphy,
 		return -EINVAL;
 	}
 
+	/* Generic command is used by EasyMesh,
+	 * route the command to SON module if it is Generic
+	 *
+	 * GENERIC_COMMAND to get configs can not be done as part of dispatch
+	 * table because, for each command sent as part of GENERIC command,
+	 * return value is different and is handled in SON module as well.
+	 * Hence having return type with dispatch table is not possible as
+	 * we will not be able to generalize the return for each of get sub
+	 * command sent as part of GENERIC command.
+	 */
+	if (tb[QCA_WLAN_VENDOR_ATTR_CONFIG_GENERIC_COMMAND])
+		return hdd_son_send_get_wifi_generic_command(wiphy, wdev, tb);
+
 	ret = hdd_get_configuration(adapter, tb);
 	if (ret)
 		errno = ret;

core/hdd/src/wlan_hdd_son.c

@@ -2368,3 +2368,19 @@ void hdd_son_deliver_peer_authorize_event(struct hdd_adapter *adapter,
 	wlan_objmgr_peer_release_ref(peer, WLAN_UMAC_COMP_SON);
 	hdd_objmgr_put_vdev_by_user(vdev, WLAN_SON_ID);
 }
+
+int hdd_son_send_set_wifi_generic_command(struct wiphy *wiphy,
+					  struct wireless_dev *wdev,
+					  struct nlattr **tb)
+{
+	return os_if_son_parse_generic_nl_cmd(wiphy, wdev, tb,
+					      OS_IF_SON_VENDOR_SET_CMD);
+}
+
+int hdd_son_send_get_wifi_generic_command(struct wiphy *wiphy,
+					  struct wireless_dev *wdev,
+					  struct nlattr **tb)
+{
+	return os_if_son_parse_generic_nl_cmd(wiphy, wdev, tb,
+					      OS_IF_SON_VENDOR_GET_CMD);
+}

core/hdd/src/wlan_hdd_son.h

@@ -1,6 +1,6 @@
 /*
  * Copyright (c) 2021, The Linux Foundation. All rights reserved.
- * Copyright (c) 2021 Qualcomm Innovation Center, Inc. All rights reserved.
+ * Copyright (c) 2021-2022 Qualcomm Innovation Center, Inc. All rights reserved.
  *
  * Permission to use, copy, modify, and/or distribute this software for any
  * purpose with or without fee is hereby granted, provided that the above
@@ -87,6 +87,31 @@ int hdd_son_deliver_assoc_disassoc_event(struct hdd_adapter *adapter,
 void
 hdd_son_deliver_peer_authorize_event(struct hdd_adapter *adapter,
 				     uint8_t *peer_mac);
+
+/**
+ * hdd_son_send_set_wifi_generic_command() - Send Generic SET command to SON
+ * @wiphy: standard kernel wiphy
+ * @wdev: wireless device
+ * @tb: NL attributes
+ *
+ * Return: 0 on success
+ */
+int hdd_son_send_set_wifi_generic_command(struct wiphy *wiphy,
+					  struct wireless_dev *wdev,
+					  struct nlattr **tb);
+
+/**
+ * hdd_son_send_get_wifi_generic_command() - Send Generic GET command to SON
+ * @wiphy: standard kernel wiphy
+ * @wdev: wireless device
+ * @tb: NL attributes
+ *
+ * Return: 0 on success
+ */
+int hdd_son_send_get_wifi_generic_command(struct wiphy *wiphy,
+					  struct wireless_dev *wdev,
+					  struct nlattr **tb);
+
 #else
 
 static inline void hdd_son_register_callbacks(struct hdd_context *hdd_ctx)
@@ -121,5 +146,20 @@ hdd_son_deliver_peer_authorize_event(struct hdd_adapter *adapter,
 {
 }
 
+static inline
+int hdd_son_send_set_wifi_generic_command(struct wiphy *wiphy,
+					  struct wireless_dev *wdev,
+					  struct nlattr **tb)
+{
+	return -EINVAL;
+}
+
+static inline
+int hdd_son_send_get_wifi_generic_command(struct wiphy *wiphy,
+					  struct wireless_dev *wdev,
+					  struct nlattr **tb)
+{
+	return -EINVAL;
+}
 #endif /* WLAN_FEATURE_SON */
 #endif

os_if/son/inc/os_if_son.h

@@ -722,4 +722,27 @@ int os_if_son_set_acs_chan(struct wlan_objmgr_vdev *vdev,
  */
 int os_if_son_get_acs_report(struct wlan_objmgr_vdev *vdev,
 			     struct ieee80211_acs_dbg *acs_r);
+
+/**
+ * os_if_son_parse_generic_nl_cmd() - Sends the Generic vendor commands
+ *				      to SON.
+ * @wiphy: Standard wiphy object
+ * @wdev: wireless device
+ * @tb: Command type structure pointer
+ * @type: Get/Set command
+ *
+ * This function parses the GENERIC vendor commands received from
+ * userspace then sends the extracted data to SON module for further
+ * processing along with wiphy, wdev, extected structure - param
+ * and command type i.e. GET / SET. Each of the GENERIC commands are
+ * interdependent and hence in SON module, they will be further
+ * parsed based on type i.e. GET / SET.
+ *
+ * Return: 0 on success
+ */
+int os_if_son_parse_generic_nl_cmd(struct wiphy *wiphy,
+				   struct wireless_dev *wdev,
+				   struct nlattr **tb,
+				   enum os_if_son_vendor_cmd_type type);
+
 #endif

os_if/son/src/os_if_son.c

@@ -1486,3 +1486,39 @@ void os_if_son_register_osif_ops(void)
 }
 
 qdf_export_symbol(os_if_son_register_osif_ops);
+
+int os_if_son_parse_generic_nl_cmd(struct wiphy *wiphy,
+				   struct wireless_dev *wdev,
+				   struct nlattr **tb,
+				   enum os_if_son_vendor_cmd_type type)
+{
+	struct os_if_son_rx_ops *rx_ops = &g_son_os_if_txrx_ops.son_osif_rx_ops;
+	struct wlan_cfg8011_genric_params param = {};
+
+	if (!rx_ops->parse_generic_nl_cmd)
+		return -EINVAL;
+
+	if (tb[QCA_WLAN_VENDOR_ATTR_CONFIG_GENERIC_COMMAND])
+		param.command = nla_get_u32(tb
+				[QCA_WLAN_VENDOR_ATTR_CONFIG_GENERIC_COMMAND]);
+
+	if (tb[QCA_WLAN_VENDOR_ATTR_CONFIG_GENERIC_VALUE])
+		param.value = nla_get_u32(tb
+				[QCA_WLAN_VENDOR_ATTR_CONFIG_GENERIC_VALUE]);
+
+	if (tb[QCA_WLAN_VENDOR_ATTR_CONFIG_GENERIC_DATA])
+		param.data = nla_data(tb
+				[QCA_WLAN_VENDOR_ATTR_CONFIG_GENERIC_DATA]);
+		param.data_len = nla_len(tb
+				[QCA_WLAN_VENDOR_ATTR_CONFIG_GENERIC_DATA]);
+
+	if (tb[QCA_WLAN_VENDOR_ATTR_CONFIG_GENERIC_LENGTH])
+		param.length = nla_get_u32(tb
+				[QCA_WLAN_VENDOR_ATTR_CONFIG_GENERIC_LENGTH]);
+
+	if (tb[QCA_WLAN_VENDOR_ATTR_CONFIG_GENERIC_FLAGS])
+		param.flags = nla_get_u32(tb
+				[QCA_WLAN_VENDOR_ATTR_CONFIG_GENERIC_FLAGS]);
+
+	return rx_ops->parse_generic_nl_cmd(wiphy, wdev, &param, type);
+}