qcacld-3.0: Trigger disconnection if width changed for STA

If the max bandwidth changed after channel information
to be updated, then need to disconnect for STA/P2P CLI.

Change-Id: Ied715c32d184e87972936d61bedc6ed2eeffc1ca
CRs-Fixed: 2985651

core/hdd/inc/wlan_hdd_main.h

@@ -2678,6 +2678,17 @@ struct hdd_adapter *hdd_get_adapter_by_macaddr(struct hdd_context *hdd_ctx,
  */
 uint32_t hdd_get_adapter_home_channel(struct hdd_adapter *adapter);
 
+/**
+ * hdd_get_adapter_width() - return current bandwidth of adapter
+ * @adapter: hdd adapter of vdev
+ *
+ * This function returns current bandwidth of station/p2p-cli if
+ * connected, returns current bandwidth of sap/p2p-go if started.
+ *
+ * Return: bandwidth if connected/started or invalid bandwidth 0
+ */
+enum phy_ch_width hdd_get_adapter_width(struct hdd_adapter *adapter);
+
 /*
  * hdd_get_adapter_by_rand_macaddr() - find Random mac adapter
  * @hdd_ctx: hdd context

core/hdd/src/wlan_hdd_main.c

@@ -941,6 +941,29 @@ uint32_t hdd_get_adapter_home_channel(struct hdd_adapter *adapter)
 	return home_chan_freq;
 }
 
+enum phy_ch_width hdd_get_adapter_width(struct hdd_adapter *adapter)
+{
+	enum phy_ch_width width = CH_WIDTH_20MHZ;
+	struct hdd_context *hdd_ctx;
+
+	hdd_ctx = WLAN_HDD_GET_CTX(adapter);
+	if (!hdd_ctx) {
+		hdd_err("hdd context is NULL");
+		return 0;
+	}
+
+	if ((adapter->device_mode == QDF_SAP_MODE ||
+	     adapter->device_mode == QDF_P2P_GO_MODE) &&
+	    test_bit(SOFTAP_BSS_STARTED, &adapter->event_flags)) {
+		width = adapter->session.ap.sap_config.ch_params.ch_width;
+	} else if ((adapter->device_mode == QDF_STA_MODE ||
+		    adapter->device_mode == QDF_P2P_CLIENT_MODE) &&
+		   hdd_cm_is_vdev_associated(adapter)) {
+		width = adapter->session.station.conn_info.ch_width;
+	}
+	return width;
+}
+
 #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 11, 0))
 static inline struct net_device *hdd_net_dev_from_notifier(void *context)
 {

core/hdd/src/wlan_hdd_regulatory.c

@@ -1471,6 +1471,60 @@ static void hdd_regulatory_chanlist_dump(struct regulatory_channel *chan_list)
 	hdd_debug("end total_count %d", count);
 }
 
+#ifdef FEATURE_WLAN_CH_AVOID_EXT
+/**
+ * hdd_country_change_bw_check() - Check if bandwidth changed
+ * @hdd_ctx: Global HDD context
+ * @adapter: HDD vdev context
+ * @oper_freq: current frequency of adapter
+ *
+ * Return: true if bandwidth changed otherwise false.
+ */
+static bool
+hdd_country_change_bw_check(struct hdd_context *hdd_ctx,
+			    struct hdd_adapter *adapter,
+			    qdf_freq_t oper_freq)
+{
+	bool width_changed = false;
+	enum phy_ch_width width;
+	uint16_t org_bw = 0;
+	struct regulatory_channel *cur_chan_list = NULL;
+	int i;
+
+	cur_chan_list = qdf_mem_malloc(sizeof(*cur_chan_list) * NUM_CHANNELS);
+	if (!cur_chan_list)
+		return false;
+
+	ucfg_reg_get_current_chan_list(hdd_ctx->pdev,
+				       cur_chan_list);
+
+	width = hdd_get_adapter_width(adapter);
+	org_bw = wlan_reg_get_bw_value(width);
+
+	for (i = 0; i < NUM_CHANNELS; i++) {
+		if (cur_chan_list[i].state ==
+			CHANNEL_STATE_DISABLE)
+			continue;
+
+		if (cur_chan_list[i].center_freq == oper_freq &&
+		    org_bw > cur_chan_list[i].max_bw) {
+			width_changed = true;
+			break;
+		}
+	}
+	qdf_mem_free(cur_chan_list);
+	return width_changed;
+}
+#else
+static inline bool
+hdd_country_change_bw_check(struct hdd_context *hdd_ctx,
+			    struct hdd_adapter *adapter,
+			    qdf_freq_t oper_freq)
+{
+	return false;
+}
+#endif
+
 /**
  * hdd_country_change_update_sta() - handle country code change for STA
  * @hdd_ctx: Global HDD context
@@ -1486,7 +1540,7 @@ static void hdd_country_change_update_sta(struct hdd_context *hdd_ctx)
 	struct hdd_station_ctx *sta_ctx = NULL;
 	struct wlan_objmgr_pdev *pdev = NULL;
 	uint32_t new_phy_mode;
-	bool freq_changed, phy_changed;
+	bool freq_changed, phy_changed, width_changed;
 	qdf_freq_t oper_freq;
 	eCsrPhyMode csr_phy_mode;
 	wlan_net_dev_ref_dbgid dbgid = NET_DEV_HOLD_COUNTRY_CHANGE_UPDATE_STA;
@@ -1495,6 +1549,7 @@ static void hdd_country_change_update_sta(struct hdd_context *hdd_ctx)
 
 	hdd_for_each_adapter_dev_held_safe(hdd_ctx, adapter, next_adapter,
 					   dbgid) {
+		width_changed = false;
 		oper_freq = hdd_get_adapter_home_channel(adapter);
 		if (oper_freq)
 			freq_changed = wlan_reg_is_disable_for_freq(pdev,
@@ -1517,7 +1572,11 @@ static void hdd_country_change_update_sta(struct hdd_context *hdd_ctx)
 				csr_convert_from_reg_phy_mode(new_phy_mode);
 			phy_changed = (sta_ctx->reg_phymode != csr_phy_mode);
 
-			if (phy_changed || freq_changed) {
+			width_changed = hdd_country_change_bw_check(hdd_ctx,
+								    adapter,
+								    oper_freq);
+
+			if (phy_changed || freq_changed || width_changed) {
 				wlan_hdd_cm_issue_disconnect(adapter,
 							 REASON_UNSPEC_FAILURE,
 							 false);