|
|
@@ -10672,3 +10672,267 @@ uint8_t lim_get_vht_ch_width(tDot11fIEVHTCaps *vht_cap,
|
|
|
pe_debug("The VHT Operation channel width is %d", ch_width);
|
|
|
return ch_width;
|
|
|
}
|
|
|
+
|
|
|
+/*
|
|
|
+ * lim_set_tpc_power() - Function to compute and send TPC power level to the
|
|
|
+ * FW based on the opmode of the pe_session
|
|
|
+ *
|
|
|
+ * @mac_ctx: Pointer to Global MAC structure
|
|
|
+ * @pe_session: Pointer to session
|
|
|
+ *
|
|
|
+ * Return: TPC status
|
|
|
+ */
|
|
|
+static bool
|
|
|
+lim_set_tpc_power(struct mac_context *mac_ctx, struct pe_session *session)
|
|
|
+{
|
|
|
+ struct wlan_lmac_if_reg_tx_ops *tx_ops;
|
|
|
+ struct vdev_mlme_obj *mlme_obj;
|
|
|
+ bool tpe_change = false;
|
|
|
+
|
|
|
+ if (!wlan_reg_is_ext_tpc_supported(mac_ctx->psoc))
|
|
|
+ return true;
|
|
|
+ tx_ops = wlan_reg_get_tx_ops(mac_ctx->psoc);
|
|
|
+
|
|
|
+ if (!tx_ops || !tx_ops->set_tpc_power)
|
|
|
+ return false;
|
|
|
+
|
|
|
+ mlme_obj = wlan_vdev_mlme_get_cmpt_obj(session->vdev);
|
|
|
+ if (!mlme_obj)
|
|
|
+ return false;
|
|
|
+
|
|
|
+ if (session->opmode == QDF_STA_MODE ||
|
|
|
+ session->opmode == QDF_P2P_CLIENT_MODE)
|
|
|
+ lim_process_tpe_ie_from_beacon(mac_ctx, session,
|
|
|
+ &session->lim_join_req->bssDescription,
|
|
|
+ &tpe_change);
|
|
|
+
|
|
|
+ if (session->opmode == QDF_SAP_MODE ||
|
|
|
+ session->opmode == QDF_P2P_GO_MODE)
|
|
|
+ mlme_obj->reg_tpc_obj.num_pwr_levels = 0;
|
|
|
+
|
|
|
+ lim_calculate_tpc(mac_ctx, session, false, 0, false);
|
|
|
+
|
|
|
+ tx_ops->set_tpc_power(mac_ctx->psoc, session->vdev_id,
|
|
|
+ &mlme_obj->reg_tpc_obj);
|
|
|
+ return true;
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * lim_get_tx_power() - Function to get the Tx power of the center frequency
|
|
|
+ * of the sap interface.
|
|
|
+ *
|
|
|
+ * @reg_tpc: reg_tpc mlme obj pointer
|
|
|
+ * @freq: center frequency of the SAP.
|
|
|
+ *
|
|
|
+ * Return: tx power
|
|
|
+ */
|
|
|
+static uint8_t
|
|
|
+lim_get_tx_power(struct reg_tpc_power_info *reg_tpc, qdf_freq_t freq)
|
|
|
+{
|
|
|
+ int i;
|
|
|
+
|
|
|
+ for (i = 0; i < reg_tpc->num_pwr_levels; i++) {
|
|
|
+ if (reg_tpc->chan_power_info[i].chan_cfreq == freq)
|
|
|
+ return reg_tpc->chan_power_info[i].tx_power;
|
|
|
+ }
|
|
|
+
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+
|
|
|
+struct pe_session *
|
|
|
+lim_get_concurrent_session(struct mac_context *mac_ctx, uint8_t vdev_id,
|
|
|
+ enum QDF_OPMODE opmode)
|
|
|
+{
|
|
|
+ uint8_t mac_id, conc_vdev_id;
|
|
|
+ struct pe_session *session;
|
|
|
+
|
|
|
+ policy_mgr_get_mac_id_by_session_id(mac_ctx->psoc, vdev_id, &mac_id);
|
|
|
+
|
|
|
+ conc_vdev_id = policy_mgr_get_conc_vdev_on_same_mac(mac_ctx->psoc,
|
|
|
+ vdev_id, mac_id);
|
|
|
+
|
|
|
+ session = pe_find_session_by_vdev_id(mac_ctx, conc_vdev_id);
|
|
|
+ if (!session)
|
|
|
+ return NULL;
|
|
|
+
|
|
|
+ switch (opmode) {
|
|
|
+ case QDF_STA_MODE:
|
|
|
+ case QDF_P2P_CLIENT_MODE:
|
|
|
+ if (session->opmode != QDF_SAP_MODE &&
|
|
|
+ session->opmode != QDF_P2P_GO_MODE)
|
|
|
+ return NULL;
|
|
|
+ break;
|
|
|
+ case QDF_SAP_MODE:
|
|
|
+ case QDF_P2P_GO_MODE:
|
|
|
+ if (session->opmode != QDF_STA_MODE &&
|
|
|
+ session->opmode != QDF_P2P_CLIENT_MODE)
|
|
|
+ return NULL;
|
|
|
+ break;
|
|
|
+ default:
|
|
|
+ return NULL;
|
|
|
+ }
|
|
|
+
|
|
|
+ return session;
|
|
|
+}
|
|
|
+
|
|
|
+QDF_STATUS
|
|
|
+lim_update_tx_power(struct mac_context *mac_ctx, struct pe_session *sap_session,
|
|
|
+ struct pe_session *sta_session, bool restore_sta_power)
|
|
|
+{
|
|
|
+ uint8_t pwr_level;
|
|
|
+ struct vdev_mlme_obj *sta_mlme_obj, *sap_mlme_obj;
|
|
|
+ struct reg_tpc_power_info *reg_info;
|
|
|
+ uint8_t tx_power, i;
|
|
|
+
|
|
|
+ sta_mlme_obj = wlan_vdev_mlme_get_cmpt_obj(sta_session->vdev);
|
|
|
+ sap_mlme_obj = wlan_vdev_mlme_get_cmpt_obj(sap_session->vdev);
|
|
|
+
|
|
|
+ if (!sta_mlme_obj || !sap_mlme_obj)
|
|
|
+ return QDF_STATUS_E_FAILURE;
|
|
|
+
|
|
|
+ if (restore_sta_power) {
|
|
|
+ /* SAP interface is removed, restore the STA power */
|
|
|
+ wlan_set_tpc_update_required_for_sta(sap_session->vdev, false);
|
|
|
+ sta_session->sta_follows_sap_power = false;
|
|
|
+ lim_set_tpc_power(mac_ctx, sta_session);
|
|
|
+ } else {
|
|
|
+ /*
|
|
|
+ * SAP and STA are in different AP power types. Therefore,
|
|
|
+ * update the reg_tpc_obj of STA with new power levels.
|
|
|
+ * Do not send new TPC power to FW.
|
|
|
+ */
|
|
|
+ sta_session->sta_follows_sap_power = true;
|
|
|
+
|
|
|
+ if (sta_mlme_obj->reg_tpc_obj.power_type_6g ==
|
|
|
+ sap_mlme_obj->reg_tpc_obj.power_type_6g) {
|
|
|
+ pe_err("STA and SAP are in same power type");
|
|
|
+ return QDF_STATUS_E_FAILURE;
|
|
|
+ }
|
|
|
+ pe_debug("STA is moved to %d from %d power type",
|
|
|
+ sap_mlme_obj->reg_tpc_obj.power_type_6g,
|
|
|
+ sta_mlme_obj->reg_tpc_obj.power_type_6g);
|
|
|
+ sta_mlme_obj->reg_tpc_obj.power_type_6g =
|
|
|
+ sap_mlme_obj->reg_tpc_obj.power_type_6g;
|
|
|
+
|
|
|
+ tx_power = lim_get_tx_power(&sap_mlme_obj->reg_tpc_obj,
|
|
|
+ sap_session->curr_op_freq);
|
|
|
+
|
|
|
+ reg_info = &sta_mlme_obj->reg_tpc_obj;
|
|
|
+ pwr_level = reg_info->num_pwr_levels;
|
|
|
+ for (i = 0; i < pwr_level; i++)
|
|
|
+ reg_info->chan_power_info[i].tx_power = tx_power;
|
|
|
+ wlan_set_tpc_update_required_for_sta(sap_session->vdev, true);
|
|
|
+ }
|
|
|
+ return QDF_STATUS_SUCCESS;
|
|
|
+}
|
|
|
+
|
|
|
+bool
|
|
|
+lim_is_power_change_required_for_sta(struct mac_context *mac_ctx,
|
|
|
+ struct pe_session *sta_session,
|
|
|
+ struct pe_session *sap_session)
|
|
|
+{
|
|
|
+ enum channel_state channel_state;
|
|
|
+ struct vdev_mlme_obj *mlme_obj;
|
|
|
+ uint32_t ap_power_type_6g = 0;
|
|
|
+
|
|
|
+ channel_state =
|
|
|
+ wlan_reg_get_channel_state_for_pwrmode(mac_ctx->pdev,
|
|
|
+ sap_session->curr_op_freq,
|
|
|
+ REG_AP_VLP);
|
|
|
+
|
|
|
+ mlme_obj = wlan_vdev_mlme_get_cmpt_obj(sap_session->vdev);
|
|
|
+ if (!mlme_obj) {
|
|
|
+ pe_err("vdev component object is NULL");
|
|
|
+ return false;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (sta_session->curr_op_freq != sap_session->curr_op_freq) {
|
|
|
+ pe_err("STA and SAP are not in same frequency, do not change TPC power");
|
|
|
+ return false;
|
|
|
+ }
|
|
|
+
|
|
|
+ wlan_reg_get_cur_6g_ap_pwr_type(mac_ctx->pdev, &ap_power_type_6g);
|
|
|
+
|
|
|
+ if (sta_session->ap_power_type_6g == REG_INDOOR_AP &&
|
|
|
+ channel_state & CHANNEL_STATE_ENABLE &&
|
|
|
+ ap_power_type_6g == REG_VERY_LOW_POWER_AP) {
|
|
|
+ pe_debug("Change the power type of STA from LPI to VLP");
|
|
|
+ return true;
|
|
|
+ }
|
|
|
+
|
|
|
+ return false;
|
|
|
+}
|
|
|
+
|
|
|
+void
|
|
|
+lim_check_conc_power_for_csa(struct mac_context *mac_ctx,
|
|
|
+ struct pe_session *sap_session)
|
|
|
+{
|
|
|
+ struct pe_session *sta_session;
|
|
|
+ bool update_required_scc_sta_power =
|
|
|
+ wlan_get_tpc_update_required_for_sta(sap_session->vdev);
|
|
|
+
|
|
|
+ /*
|
|
|
+ * If SCC power has changed and concurrent session doesn't exist,
|
|
|
+ * then STA must have got deleted or moved out of 6GHz.
|
|
|
+ * In that case, reset the change scc power flag for SAP.
|
|
|
+ */
|
|
|
+ sta_session = lim_get_concurrent_session(mac_ctx, sap_session->vdev_id,
|
|
|
+ sap_session->opmode);
|
|
|
+ if (!sta_session) {
|
|
|
+ pe_debug("STA session doesn't exist");
|
|
|
+ return;
|
|
|
+ }
|
|
|
+
|
|
|
+ /* If SCC power has changed and the SAP is moving away from 6GHz,
|
|
|
+ * reset the scc power flag in SAP vdev and restore the STA
|
|
|
+ * power
|
|
|
+ */
|
|
|
+ if (update_required_scc_sta_power &&
|
|
|
+ !WLAN_REG_IS_6GHZ_CHAN_FREQ(sap_session->curr_op_freq) &&
|
|
|
+ WLAN_REG_IS_6GHZ_CHAN_FREQ(sta_session->curr_op_freq)) {
|
|
|
+ pe_debug("SAP has moved from 6GHz, restore STA power");
|
|
|
+ lim_update_tx_power(mac_ctx, sap_session, sta_session, true);
|
|
|
+ return;
|
|
|
+ }
|
|
|
+
|
|
|
+ /* If SAP is moving to 6GHz. Then:
|
|
|
+ * a) If change scc power is not set, check if it needs to be set
|
|
|
+ * If it is getting set, then send new tpc power to FW.
|
|
|
+ * b) If change scc power is already set, then SAP is moving from one
|
|
|
+ * 6GHz to another 6GHz. Recompute the TPC.
|
|
|
+ */
|
|
|
+ if (WLAN_REG_IS_6GHZ_CHAN_FREQ(sap_session->curr_op_freq) &&
|
|
|
+ sta_session &&
|
|
|
+ WLAN_REG_IS_6GHZ_CHAN_FREQ(sta_session->curr_op_freq) &&
|
|
|
+ (wlan_vdev_mlme_get_state(sap_session->vdev) == WLAN_VDEV_S_UP)) {
|
|
|
+ if (lim_is_power_change_required_for_sta(mac_ctx, sta_session,
|
|
|
+ sap_session)) {
|
|
|
+ lim_set_tpc_power(mac_ctx, sap_session);
|
|
|
+ if (lim_update_tx_power(mac_ctx, sap_session,
|
|
|
+ sta_session, false) ==
|
|
|
+ QDF_STATUS_SUCCESS)
|
|
|
+ wlan_set_tpc_update_required_for_sta(
|
|
|
+ sap_session->vdev,
|
|
|
+ true);
|
|
|
+ }
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+void
|
|
|
+lim_cleanup_power_change(struct mac_context *mac_ctx,
|
|
|
+ struct pe_session *session)
|
|
|
+{
|
|
|
+ struct pe_session *sap_session;
|
|
|
+
|
|
|
+ if (session->opmode != QDF_STA_MODE &&
|
|
|
+ session->opmode != QDF_P2P_CLIENT_MODE)
|
|
|
+ return;
|
|
|
+
|
|
|
+ sap_session =
|
|
|
+ lim_get_concurrent_session(mac_ctx, session->vdev_id,
|
|
|
+ session->opmode);
|
|
|
+ if (!sap_session)
|
|
|
+ return;
|
|
|
+
|
|
|
+ wlan_set_tpc_update_required_for_sta(sap_session->vdev, false);
|
|
|
+}
|
Surya Prakash Sivaraj