qcacld-3.0: Move GO to other band for SAP starting on 3vif conc

In GO+STA+SAP concurrency, if GO is MCC with STA, the new SAP
will not be allowed in same MAC. FW doesn't support MCC in same
MAC for 3 or more vdevs. Move GO to other band to avoid SAP
starting failed.

Change-Id: Ia19abd1b11f7416797af3e975ab8ffde9037c11f
CRs-Fixed: 3262185

components/cmn_services/policy_mgr/inc/wlan_policy_mgr_public_struct.h

@@ -95,6 +95,8 @@ typedef int (*send_mode_change_event_cb)(void);
  * @CSA_REASON_CHAN_PASSIVE: channel is passive
  * @CSA_REASON_GO_BSS_STARED: P2P go started
  * @CSA_REASON_SAP_ACS: 2.4 GHz perferred SAP ACS starting
+ * @CSA_REASON_SAP_FIX_CH_CONC_WITH_GO: SAP fix channel start
+ *  and move GO to other band
  */
 enum sap_csa_reason_code {
 	CSA_REASON_UNKNOWN,
@@ -111,7 +113,8 @@ enum sap_csa_reason_code {
 	CSA_REASON_CHAN_DISABLED,
 	CSA_REASON_CHAN_PASSIVE,
 	CSA_REASON_GO_BSS_STARTED,
-	CSA_REASON_SAP_ACS
+	CSA_REASON_SAP_ACS,
+	CSA_REASON_SAP_FIX_CH_CONC_WITH_GO
 };
 
 /**

core/hdd/src/wlan_hdd_hostapd.c

@@ -3565,6 +3565,8 @@ void wlan_hdd_set_sap_csa_reason(struct wlan_objmgr_psoc *psoc, uint8_t vdev_id,
 	sap_ctx = WLAN_HDD_GET_SAP_CTX_PTR(ap_adapter);
 	if (sap_ctx)
 		sap_ctx->csa_reason = reason;
+	hdd_nofl_debug("set csa reason %d %s vdev %d",
+		       reason, sap_get_csa_reason_str(reason), vdev_id);
 }
 
 QDF_STATUS wlan_hdd_get_channel_for_sap_restart(
@@ -5373,6 +5375,9 @@ hdd_handle_acs_2g_preferred_sap_conc(struct wlan_objmgr_psoc *psoc,
 	uint8_t vdev_id_list[MAX_NUMBER_OF_CONC_CONNECTIONS];
 	uint32_t freq_list[MAX_NUMBER_OF_CONC_CONNECTIONS];
 	uint8_t vdev_num;
+	uint8_t sta_vdev_id_list[MAX_NUMBER_OF_CONC_CONNECTIONS];
+	uint32_t sta_freq_list[MAX_NUMBER_OF_CONC_CONNECTIONS];
+	uint8_t sta_vdev_num;
 	struct hdd_hostapd_state *hostapd_state;
 	uint8_t go_vdev_id = WLAN_UMAC_VDEV_ID_MAX;
 	qdf_freq_t go_ch_freq = 0, go_new_ch_freq;
@@ -5395,7 +5400,7 @@ hdd_handle_acs_2g_preferred_sap_conc(struct wlan_objmgr_psoc *psoc,
 	vdev_num = policy_mgr_get_mode_specific_conn_info(
 			psoc, freq_list, vdev_id_list,
 			PM_P2P_GO_MODE);
-	if (!vdev_num)
+	if (!vdev_num || vdev_num > 1)
 		return;
 	for (i = 0; i < vdev_num; i++) {
 		if (WLAN_REG_IS_24GHZ_CH_FREQ(freq_list[i])) {
@@ -5406,6 +5411,13 @@ hdd_handle_acs_2g_preferred_sap_conc(struct wlan_objmgr_psoc *psoc,
 	}
 	if (!go_ch_freq)
 		return;
+	sta_vdev_num = policy_mgr_get_mode_specific_conn_info(
+			psoc, sta_freq_list, sta_vdev_id_list,
+			PM_STA_MODE);
+	for (i = 0; i < sta_vdev_num; i++)
+		if (go_ch_freq == sta_freq_list[i])
+			return;
+
 	go_new_ch_freq =
 		policy_mgr_get_alternate_channel_for_sap(psoc,
 							 go_vdev_id,
@@ -5437,6 +5449,108 @@ hdd_handle_acs_2g_preferred_sap_conc(struct wlan_objmgr_psoc *psoc,
 		hdd_err("wait for qdf_event failed!!");
 }
 
+/**
+ * hdd_handle_p2p_go_for_3rd_ap_conc() - Move P2P GO to other band if
+ * SAP starting
+ * @psoc: soc object
+ * @adapter: sap adapter
+ * @sap_ch_freq: sap channel frequency
+ *
+ * In GO+STA+SAP concurrency, if GO is MCC with STA, the new SAP
+ * will not be allowed in same MAC. FW doesn't support MCC in same
+ * MAC for 3 or more vdevs. Move GO to other band to avoid SAP
+ * starting failed.
+ *
+ * Return: true if GO is moved to other band successfully.
+ */
+static bool
+hdd_handle_p2p_go_for_3rd_ap_conc(struct wlan_objmgr_psoc *psoc,
+				  struct hdd_adapter *adapter,
+				  uint32_t sap_ch_freq)
+{
+	uint32_t i;
+	int ret;
+	QDF_STATUS status;
+	uint8_t go_vdev_id_list[MAX_NUMBER_OF_CONC_CONNECTIONS];
+	uint32_t go_freq_list[MAX_NUMBER_OF_CONC_CONNECTIONS];
+	uint8_t go_vdev_num;
+	uint8_t sta_vdev_id_list[MAX_NUMBER_OF_CONC_CONNECTIONS];
+	uint32_t sta_freq_list[MAX_NUMBER_OF_CONC_CONNECTIONS];
+	uint8_t sta_vdev_num;
+	struct hdd_hostapd_state *hostapd_state;
+	uint8_t go_vdev_id;
+	qdf_freq_t go_ch_freq, go_new_ch_freq;
+	struct hdd_adapter *go_adapter;
+
+	if (adapter->device_mode != QDF_SAP_MODE)
+		return false;
+	if (!policy_mgr_is_hw_dbs_capable(psoc))
+		return false;
+	go_vdev_num = policy_mgr_get_mode_specific_conn_info(
+			psoc, go_freq_list, go_vdev_id_list,
+			PM_P2P_GO_MODE);
+	if (!go_vdev_num || go_vdev_num > 1)
+		return false;
+
+	if (!policy_mgr_2_freq_always_on_same_mac(
+			psoc, go_freq_list[0], sap_ch_freq))
+		return false;
+
+	sta_vdev_num = policy_mgr_get_mode_specific_conn_info(
+			psoc, sta_freq_list, sta_vdev_id_list,
+			PM_STA_MODE);
+	if (!sta_vdev_num)
+		return false;
+	for (i = 0; i < sta_vdev_num; i++) {
+		if (go_freq_list[0] != sta_freq_list[i] &&
+		    policy_mgr_2_freq_always_on_same_mac(
+				psoc, go_freq_list[0], sta_freq_list[i]))
+			break;
+	}
+	if (i == sta_vdev_num)
+		return false;
+	go_ch_freq = go_freq_list[0];
+	go_vdev_id = go_vdev_id_list[0];
+	go_new_ch_freq =
+		policy_mgr_get_alternate_channel_for_sap(psoc,
+							 go_vdev_id,
+							 go_ch_freq,
+							 REG_BAND_UNKNOWN);
+	if (!go_new_ch_freq) {
+		hdd_debug("no alternate GO channel");
+		return false;
+	}
+	if (go_new_ch_freq != sta_freq_list[i] &&
+	    policy_mgr_3_freq_always_on_same_mac(
+			psoc, sap_ch_freq, go_new_ch_freq, sta_freq_list[i])) {
+		hdd_debug("no alternate GO channel to avoid 3vif MCC");
+		return false;
+	}
+
+	go_adapter = hdd_get_adapter_by_vdev(adapter->hdd_ctx, go_vdev_id);
+	if (hdd_validate_adapter(go_adapter))
+		return false;
+
+	wlan_hdd_set_sap_csa_reason(psoc, go_vdev_id,
+				    CSA_REASON_SAP_FIX_CH_CONC_WITH_GO);
+	hostapd_state = WLAN_HDD_GET_HOSTAP_STATE_PTR(go_adapter);
+	qdf_event_reset(&hostapd_state->qdf_event);
+
+	ret = hdd_softap_set_channel_change(go_adapter->dev, go_new_ch_freq,
+					    CH_WIDTH_80MHZ, false);
+	if (ret) {
+		hdd_err("CSA failed to %d, ret %d", go_new_ch_freq, ret);
+		return false;
+	}
+
+	status = qdf_wait_for_event_completion(&hostapd_state->qdf_event,
+					       SME_CMD_START_BSS_TIMEOUT);
+	if (!QDF_IS_STATUS_SUCCESS(status))
+		hdd_err("wait for qdf_event failed!!");
+
+	return true;
+}
+
 #ifdef DISABLE_CHANNEL_LIST
 /**
  * wlan_hdd_get_wiphy_channel() - Get wiphy channel
@@ -7046,6 +7160,9 @@ wlan_hdd_is_ap_ap_force_scc_override(struct hdd_adapter *adapter,
 	}
 	hdd_objmgr_put_vdev_by_user(vdev, WLAN_OSIF_ID);
 
+	if (hdd_handle_p2p_go_for_3rd_ap_conc(hdd_ctx->psoc, adapter, freq))
+		return false;
+
 	cc_count = policy_mgr_get_mode_specific_conn_info(hdd_ctx->psoc,
 							  &op_freq[0],
 							  &vdev_id[0],

core/sap/inc/sap_api.h

@@ -1567,6 +1567,14 @@ wlansap_override_csa_strict_for_sap(mac_handle_t mac_handle,
 				    uint32_t target_chan_freq,
 				    bool strict);
 
+/**
+ * sap_get_csa_reason_str() - Get csa reason in string
+ * @reason: sap reason enum value
+ *
+ * Return: string reason
+ */
+const char *sap_get_csa_reason_str(enum sap_csa_reason_code reason);
+
 #ifdef FEATURE_RADAR_HISTORY
 /**
  * wlansap_query_radar_history() -  get radar history info

core/sap/src/sap_module.c

@@ -1333,7 +1333,7 @@ static inline void sap_start_csa_restart(struct mac_context *mac,
  *
  * Return: string reason
  */
-static char *sap_get_csa_reason_str(enum sap_csa_reason_code reason)
+const char *sap_get_csa_reason_str(enum sap_csa_reason_code reason)
 {
 	switch (reason) {
 	case CSA_REASON_UNKNOWN:
@@ -1362,6 +1362,12 @@ static char *sap_get_csa_reason_str(enum sap_csa_reason_code reason)
 		return "DISABLED";
 	case CSA_REASON_CHAN_PASSIVE:
 		return "PASSIVE";
+	case CSA_REASON_GO_BSS_STARTED:
+		return "GO_BSS_STARTED";
+	case CSA_REASON_SAP_ACS:
+		return "CSA_REASON_SAP_ACS";
+	case CSA_REASON_SAP_FIX_CH_CONC_WITH_GO:
+		return "SAP_FIX_CH_CONC_WITH_GO";
 	default:
 		return "UNKNOWN";
 	}