Author | Tokens | Token Proportion | Commits | Commit Proportion |
---|---|---|---|---|
Miri Korenblit | 2290 | 40.05% | 19 | 18.27% |
Johannes Berg | 1555 | 27.19% | 28 | 26.92% |
Gregory Greenman | 730 | 12.77% | 12 | 11.54% |
Ilan Peer | 541 | 9.46% | 6 | 5.77% |
Emmanuel Grumbach | 363 | 6.35% | 5 | 4.81% |
Arik Nemtsov | 112 | 1.96% | 5 | 4.81% |
striebit | 17 | 0.30% | 2 | 1.92% |
Luciano Coelho | 17 | 0.30% | 4 | 3.85% |
David Spinadel | 14 | 0.24% | 2 | 1.92% |
Anjaneyulu | 13 | 0.23% | 1 | 0.96% |
Sara Sharon | 13 | 0.23% | 4 | 3.85% |
Avraham Stern | 13 | 0.23% | 4 | 3.85% |
Andrei Otcheretianski | 11 | 0.19% | 3 | 2.88% |
Alexander Bondar | 7 | 0.12% | 2 | 1.92% |
Eliad Peller | 7 | 0.12% | 2 | 1.92% |
Ben Greear | 5 | 0.09% | 1 | 0.96% |
Lilach Edelstein | 5 | 0.09% | 1 | 0.96% |
Liad Kaufman | 2 | 0.03% | 1 | 0.96% |
Benjamin Berg | 2 | 0.03% | 1 | 0.96% |
Hila Gonen | 1 | 0.02% | 1 | 0.96% |
Total | 5718 | 104 |
// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause /* * Copyright (C) 2022-2023 Intel Corporation */ #include "mvm.h" static int iwl_mvm_mld_mac_add_interface(struct ieee80211_hw *hw, struct ieee80211_vif *vif) { struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw); struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif); int ret; int i; mutex_lock(&mvm->mutex); mvmvif->mvm = mvm; /* Not much to do here. The stack will not allow interface * types or combinations that we didn't advertise, so we * don't really have to check the types. */ /* make sure that beacon statistics don't go backwards with FW reset */ if (test_bit(IWL_MVM_STATUS_IN_HW_RESTART, &mvm->status)) for_each_mvm_vif_valid_link(mvmvif, i) mvmvif->link[i]->beacon_stats.accu_num_beacons += mvmvif->link[i]->beacon_stats.num_beacons; /* Allocate resources for the MAC context, and add it to the fw */ ret = iwl_mvm_mac_ctxt_init(mvm, vif); if (ret) goto out_unlock; rcu_assign_pointer(mvm->vif_id_to_mac[mvmvif->id], vif); mvmvif->features |= hw->netdev_features; /* reset deflink MLO parameters */ mvmvif->deflink.fw_link_id = IWL_MVM_FW_LINK_ID_INVALID; mvmvif->deflink.active = 0; /* the first link always points to the default one */ mvmvif->link[0] = &mvmvif->deflink; ret = iwl_mvm_mld_mac_ctxt_add(mvm, vif); if (ret) goto out_unlock; /* beacon filtering */ ret = iwl_mvm_disable_beacon_filter(mvm, vif, 0); if (ret) goto out_remove_mac; if (!mvm->bf_allowed_vif && vif->type == NL80211_IFTYPE_STATION && !vif->p2p) { mvm->bf_allowed_vif = mvmvif; vif->driver_flags |= IEEE80211_VIF_BEACON_FILTER | IEEE80211_VIF_SUPPORTS_CQM_RSSI; } ret = iwl_mvm_add_link(mvm, vif, &vif->bss_conf); if (ret) goto out_free_bf; /* Save a pointer to p2p device vif, so it can later be used to * update the p2p device MAC when a GO is started/stopped */ if (vif->type == NL80211_IFTYPE_P2P_DEVICE) mvm->p2p_device_vif = vif; ret = iwl_mvm_power_update_mac(mvm); if (ret) goto out_free_bf; iwl_mvm_tcm_add_vif(mvm, vif); INIT_DELAYED_WORK(&mvmvif->csa_work, iwl_mvm_channel_switch_disconnect_wk); if (vif->type == NL80211_IFTYPE_MONITOR) { mvm->monitor_on = true; ieee80211_hw_set(mvm->hw, RX_INCLUDES_FCS); } iwl_mvm_vif_dbgfs_add_link(mvm, vif); if (!test_bit(IWL_MVM_STATUS_IN_HW_RESTART, &mvm->status) && vif->type == NL80211_IFTYPE_STATION && !vif->p2p && !mvm->csme_vif && mvm->mei_registered) { iwl_mei_set_nic_info(vif->addr, mvm->nvm_data->hw_addr); iwl_mei_set_netdev(ieee80211_vif_to_wdev(vif)->netdev); mvm->csme_vif = vif; } goto out_unlock; out_free_bf: if (mvm->bf_allowed_vif == mvmvif) { mvm->bf_allowed_vif = NULL; vif->driver_flags &= ~(IEEE80211_VIF_BEACON_FILTER | IEEE80211_VIF_SUPPORTS_CQM_RSSI); } out_remove_mac: mvmvif->link[0] = NULL; iwl_mvm_mld_mac_ctxt_remove(mvm, vif); out_unlock: mutex_unlock(&mvm->mutex); return ret; } static void iwl_mvm_mld_mac_remove_interface(struct ieee80211_hw *hw, struct ieee80211_vif *vif) { struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw); struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif); struct iwl_probe_resp_data *probe_data; iwl_mvm_prepare_mac_removal(mvm, vif); if (!(vif->type == NL80211_IFTYPE_AP || vif->type == NL80211_IFTYPE_ADHOC)) iwl_mvm_tcm_rm_vif(mvm, vif); mutex_lock(&mvm->mutex); if (vif == mvm->csme_vif) { iwl_mei_set_netdev(NULL); mvm->csme_vif = NULL; } if (mvm->bf_allowed_vif == mvmvif) { mvm->bf_allowed_vif = NULL; vif->driver_flags &= ~(IEEE80211_VIF_BEACON_FILTER | IEEE80211_VIF_SUPPORTS_CQM_RSSI); } if (vif->bss_conf.ftm_responder) memset(&mvm->ftm_resp_stats, 0, sizeof(mvm->ftm_resp_stats)); iwl_mvm_vif_dbgfs_rm_link(mvm, vif); /* For AP/GO interface, the tear down of the resources allocated to the * interface is be handled as part of the stop_ap flow. */ if (vif->type == NL80211_IFTYPE_AP || vif->type == NL80211_IFTYPE_ADHOC) { #ifdef CONFIG_NL80211_TESTMODE if (vif == mvm->noa_vif) { mvm->noa_vif = NULL; mvm->noa_duration = 0; } #endif } iwl_mvm_power_update_mac(mvm); /* Before the interface removal, mac80211 would cancel the ROC, and the * ROC worker would be scheduled if needed. The worker would be flushed * in iwl_mvm_prepare_mac_removal() and thus at this point the link is * not active. So need only to remove the link. */ if (vif->type == NL80211_IFTYPE_P2P_DEVICE) { if (mvmvif->deflink.phy_ctxt) { iwl_mvm_phy_ctxt_unref(mvm, mvmvif->deflink.phy_ctxt); mvmvif->deflink.phy_ctxt = NULL; } mvm->p2p_device_vif = NULL; iwl_mvm_remove_link(mvm, vif, &vif->bss_conf); } else { iwl_mvm_disable_link(mvm, vif, &vif->bss_conf); } iwl_mvm_mld_mac_ctxt_remove(mvm, vif); RCU_INIT_POINTER(mvm->vif_id_to_mac[mvmvif->id], NULL); probe_data = rcu_dereference_protected(mvmvif->deflink.probe_resp_data, lockdep_is_held(&mvm->mutex)); RCU_INIT_POINTER(mvmvif->deflink.probe_resp_data, NULL); if (probe_data) kfree_rcu(probe_data, rcu_head); if (vif->type == NL80211_IFTYPE_MONITOR) { mvm->monitor_on = false; __clear_bit(IEEE80211_HW_RX_INCLUDES_FCS, mvm->hw->flags); } mutex_unlock(&mvm->mutex); } static unsigned int iwl_mvm_mld_count_active_links(struct ieee80211_vif *vif) { unsigned int n_active = 0; int i; for (i = 0; i < IEEE80211_MLD_MAX_NUM_LINKS; i++) { struct ieee80211_bss_conf *link_conf; link_conf = link_conf_dereference_protected(vif, i); if (link_conf && rcu_access_pointer(link_conf->chanctx_conf)) n_active++; } return n_active; } static int iwl_mvm_esr_mode_active(struct iwl_mvm *mvm, struct ieee80211_vif *vif) { struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif); int link_id, ret = 0; mvmvif->esr_active = true; /* Indicate to mac80211 that EML is enabled */ vif->driver_flags |= IEEE80211_VIF_EML_ACTIVE; iwl_mvm_update_smps_on_active_links(mvm, vif, IWL_MVM_SMPS_REQ_FW, IEEE80211_SMPS_OFF); for_each_mvm_vif_valid_link(mvmvif, link_id) { struct iwl_mvm_vif_link_info *link = mvmvif->link[link_id]; if (!link->phy_ctxt) continue; ret = iwl_mvm_phy_send_rlc(mvm, link->phy_ctxt, 2, 2); if (ret) break; link->phy_ctxt->rlc_disabled = true; } return ret; } static int __iwl_mvm_mld_assign_vif_chanctx(struct iwl_mvm *mvm, struct ieee80211_vif *vif, struct ieee80211_bss_conf *link_conf, struct ieee80211_chanctx_conf *ctx, bool switching_chanctx) { u16 *phy_ctxt_id = (u16 *)ctx->drv_priv; struct iwl_mvm_phy_ctxt *phy_ctxt = &mvm->phy_ctxts[*phy_ctxt_id]; unsigned int n_active = iwl_mvm_mld_count_active_links(vif); struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif); unsigned int link_id = link_conf->link_id; int ret; /* if the assigned one was not counted yet, count it now */ if (!rcu_access_pointer(link_conf->chanctx_conf)) n_active++; if (n_active > iwl_mvm_max_active_links(mvm, vif)) return -EOPNOTSUPP; if (WARN_ON_ONCE(!mvmvif->link[link_id])) return -EINVAL; /* mac parameters such as HE support can change at this stage * For sta, need first to configure correct state from drv_sta_state * and only after that update mac config. */ if (vif->type == NL80211_IFTYPE_AP) { ret = iwl_mvm_mld_mac_ctxt_changed(mvm, vif, false); if (ret) { IWL_ERR(mvm, "failed to update MAC %pM\n", vif->addr); return -EINVAL; } } if (iwl_mvm_is_esr_supported(mvm->fwrt.trans) && n_active > 1) { mvmvif->link[link_id]->listen_lmac = true; ret = iwl_mvm_esr_mode_active(mvm, vif); if (ret) { IWL_ERR(mvm, "failed to activate ESR mode (%d)\n", ret); return ret; } } mvmvif->link[link_id]->phy_ctxt = phy_ctxt; if (switching_chanctx) { /* reactivate if we turned this off during channel switch */ if (vif->type == NL80211_IFTYPE_AP) mvmvif->ap_ibss_active = true; } /* send it first with phy context ID */ ret = iwl_mvm_link_changed(mvm, vif, link_conf, 0, false); if (ret) goto out; /* Initialize rate control for the AP station, since we might be * doing a link switch here - we cannot initialize it before since * this needs the phy context assigned (and in FW?), and we cannot * do it later because it needs to be initialized as soon as we're * able to TX on the link, i.e. when active. * * Firmware restart isn't quite correct yet for MLO, but we don't * need to do it in that case anyway since it will happen from the * normal station state callback. */ if (mvmvif->ap_sta && !test_bit(IWL_MVM_STATUS_IN_HW_RESTART, &mvm->status)) { struct ieee80211_link_sta *link_sta; rcu_read_lock(); link_sta = rcu_dereference(mvmvif->ap_sta->link[link_id]); if (!WARN_ON_ONCE(!link_sta)) iwl_mvm_rs_rate_init(mvm, vif, mvmvif->ap_sta, link_conf, link_sta, phy_ctxt->channel->band); rcu_read_unlock(); } /* then activate */ ret = iwl_mvm_link_changed(mvm, vif, link_conf, LINK_CONTEXT_MODIFY_ACTIVE | LINK_CONTEXT_MODIFY_RATES_INFO, true); if (ret) goto out; /* * Power state must be updated before quotas, * otherwise fw will complain. */ iwl_mvm_power_update_mac(mvm); if (vif->type == NL80211_IFTYPE_MONITOR) { ret = iwl_mvm_mld_add_snif_sta(mvm, vif, link_conf); if (ret) goto deactivate; } return 0; deactivate: iwl_mvm_link_changed(mvm, vif, link_conf, LINK_CONTEXT_MODIFY_ACTIVE, false); out: mvmvif->link[link_id]->phy_ctxt = NULL; iwl_mvm_power_update_mac(mvm); return ret; } static int iwl_mvm_mld_assign_vif_chanctx(struct ieee80211_hw *hw, struct ieee80211_vif *vif, struct ieee80211_bss_conf *link_conf, struct ieee80211_chanctx_conf *ctx) { struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw); int ret; mutex_lock(&mvm->mutex); ret = __iwl_mvm_mld_assign_vif_chanctx(mvm, vif, link_conf, ctx, false); mutex_unlock(&mvm->mutex); return ret; } static int iwl_mvm_esr_mode_inactive(struct iwl_mvm *mvm, struct ieee80211_vif *vif) { struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif); struct ieee80211_bss_conf *link_conf; int link_id, ret = 0; mvmvif->esr_active = false; vif->driver_flags &= ~IEEE80211_VIF_EML_ACTIVE; iwl_mvm_update_smps_on_active_links(mvm, vif, IWL_MVM_SMPS_REQ_FW, IEEE80211_SMPS_AUTOMATIC); for_each_vif_active_link(vif, link_conf, link_id) { struct ieee80211_chanctx_conf *chanctx_conf; struct iwl_mvm_phy_ctxt *phy_ctxt; u8 static_chains, dynamic_chains; mvmvif->link[link_id]->listen_lmac = false; rcu_read_lock(); chanctx_conf = rcu_dereference(link_conf->chanctx_conf); phy_ctxt = mvmvif->link[link_id]->phy_ctxt; if (!chanctx_conf || !phy_ctxt) { rcu_read_unlock(); continue; } phy_ctxt->rlc_disabled = false; static_chains = chanctx_conf->rx_chains_static; dynamic_chains = chanctx_conf->rx_chains_dynamic; rcu_read_unlock(); ret = iwl_mvm_phy_send_rlc(mvm, phy_ctxt, static_chains, dynamic_chains); if (ret) break; } return ret; } static void __iwl_mvm_mld_unassign_vif_chanctx(struct iwl_mvm *mvm, struct ieee80211_vif *vif, struct ieee80211_bss_conf *link_conf, struct ieee80211_chanctx_conf *ctx, bool switching_chanctx) { struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif); unsigned int n_active = iwl_mvm_mld_count_active_links(vif); unsigned int link_id = link_conf->link_id; /* shouldn't happen, but verify link_id is valid before accessing */ if (WARN_ON_ONCE(!mvmvif->link[link_id])) return; if (vif->type == NL80211_IFTYPE_AP && switching_chanctx) { mvmvif->csa_countdown = false; /* Set CS bit on all the stations */ iwl_mvm_modify_all_sta_disable_tx(mvm, mvmvif, true); /* Save blocked iface, the timeout is set on the next beacon */ rcu_assign_pointer(mvm->csa_tx_blocked_vif, vif); mvmvif->ap_ibss_active = false; } if (iwl_mvm_is_esr_supported(mvm->fwrt.trans) && n_active > 1) { int ret = iwl_mvm_esr_mode_inactive(mvm, vif); if (ret) IWL_ERR(mvm, "failed to deactivate ESR mode (%d)\n", ret); } if (vif->type == NL80211_IFTYPE_MONITOR) iwl_mvm_mld_rm_snif_sta(mvm, vif); iwl_mvm_link_changed(mvm, vif, link_conf, LINK_CONTEXT_MODIFY_ACTIVE, false); if (switching_chanctx) return; mvmvif->link[link_id]->phy_ctxt = NULL; iwl_mvm_power_update_mac(mvm); } static void iwl_mvm_mld_unassign_vif_chanctx(struct ieee80211_hw *hw, struct ieee80211_vif *vif, struct ieee80211_bss_conf *link_conf, struct ieee80211_chanctx_conf *ctx) { struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif); struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw); mutex_lock(&mvm->mutex); __iwl_mvm_mld_unassign_vif_chanctx(mvm, vif, link_conf, ctx, false); /* in the non-MLD case, remove/re-add the link to clean up FW state */ if (!ieee80211_vif_is_mld(vif) && !mvmvif->ap_sta && !WARN_ON_ONCE(vif->cfg.assoc)) { iwl_mvm_remove_link(mvm, vif, link_conf); iwl_mvm_add_link(mvm, vif, link_conf); } mutex_unlock(&mvm->mutex); } static int iwl_mvm_mld_start_ap_ibss(struct ieee80211_hw *hw, struct ieee80211_vif *vif, struct ieee80211_bss_conf *link_conf) { struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw); struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif); int ret; mutex_lock(&mvm->mutex); /* Send the beacon template */ ret = iwl_mvm_mac_ctxt_beacon_changed(mvm, vif, link_conf); if (ret) goto out_unlock; /* the link should be already activated when assigning chan context */ ret = iwl_mvm_link_changed(mvm, vif, link_conf, LINK_CONTEXT_MODIFY_ALL & ~LINK_CONTEXT_MODIFY_ACTIVE, true); if (ret) goto out_unlock; ret = iwl_mvm_mld_add_mcast_sta(mvm, vif, link_conf); if (ret) goto out_unlock; /* Send the bcast station. At this stage the TBTT and DTIM time * events are added and applied to the scheduler */ ret = iwl_mvm_mld_add_bcast_sta(mvm, vif, link_conf); if (ret) goto out_rm_mcast; if (iwl_mvm_start_ap_ibss_common(hw, vif, &ret)) goto out_failed; /* Need to update the P2P Device MAC (only GO, IBSS is single vif) */ if (vif->p2p && mvm->p2p_device_vif) iwl_mvm_mld_mac_ctxt_changed(mvm, mvm->p2p_device_vif, false); iwl_mvm_bt_coex_vif_change(mvm); /* we don't support TDLS during DCM */ if (iwl_mvm_phy_ctx_count(mvm) > 1) iwl_mvm_teardown_tdls_peers(mvm); iwl_mvm_ftm_restart_responder(mvm, vif, link_conf); goto out_unlock; out_failed: iwl_mvm_power_update_mac(mvm); mvmvif->ap_ibss_active = false; iwl_mvm_mld_rm_bcast_sta(mvm, vif, link_conf); out_rm_mcast: iwl_mvm_mld_rm_mcast_sta(mvm, vif, link_conf); out_unlock: mutex_unlock(&mvm->mutex); return ret; } static int iwl_mvm_mld_start_ap(struct ieee80211_hw *hw, struct ieee80211_vif *vif, struct ieee80211_bss_conf *link_conf) { return iwl_mvm_mld_start_ap_ibss(hw, vif, link_conf); } static int iwl_mvm_mld_start_ibss(struct ieee80211_hw *hw, struct ieee80211_vif *vif) { return iwl_mvm_mld_start_ap_ibss(hw, vif, &vif->bss_conf); } static void iwl_mvm_mld_stop_ap_ibss(struct ieee80211_hw *hw, struct ieee80211_vif *vif, struct ieee80211_bss_conf *link_conf) { struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw); mutex_lock(&mvm->mutex); iwl_mvm_stop_ap_ibss_common(mvm, vif); /* Need to update the P2P Device MAC (only GO, IBSS is single vif) */ if (vif->p2p && mvm->p2p_device_vif) iwl_mvm_mld_mac_ctxt_changed(mvm, mvm->p2p_device_vif, false); iwl_mvm_ftm_responder_clear(mvm, vif); iwl_mvm_mld_rm_bcast_sta(mvm, vif, link_conf); iwl_mvm_mld_rm_mcast_sta(mvm, vif, link_conf); iwl_mvm_power_update_mac(mvm); mutex_unlock(&mvm->mutex); } static void iwl_mvm_mld_stop_ap(struct ieee80211_hw *hw, struct ieee80211_vif *vif, struct ieee80211_bss_conf *link_conf) { iwl_mvm_mld_stop_ap_ibss(hw, vif, link_conf); } static void iwl_mvm_mld_stop_ibss(struct ieee80211_hw *hw, struct ieee80211_vif *vif) { iwl_mvm_mld_stop_ap_ibss(hw, vif, &vif->bss_conf); } static int iwl_mvm_mld_mac_sta_state(struct ieee80211_hw *hw, struct ieee80211_vif *vif, struct ieee80211_sta *sta, enum ieee80211_sta_state old_state, enum ieee80211_sta_state new_state) { static const struct iwl_mvm_sta_state_ops callbacks = { .add_sta = iwl_mvm_mld_add_sta, .update_sta = iwl_mvm_mld_update_sta, .rm_sta = iwl_mvm_mld_rm_sta, .mac_ctxt_changed = iwl_mvm_mld_mac_ctxt_changed, }; return iwl_mvm_mac_sta_state_common(hw, vif, sta, old_state, new_state, &callbacks); } struct iwl_mvm_link_sel_data { u8 link_id; enum nl80211_band band; bool active; }; static bool iwl_mvm_mld_valid_link_pair(struct iwl_mvm_link_sel_data *a, struct iwl_mvm_link_sel_data *b) { return a->band != b->band; } void iwl_mvm_mld_select_links(struct iwl_mvm *mvm, struct ieee80211_vif *vif, bool valid_links_changed) { struct iwl_mvm_link_sel_data data[IEEE80211_MLD_MAX_NUM_LINKS]; unsigned long usable_links = ieee80211_vif_usable_links(vif); u32 max_active_links = iwl_mvm_max_active_links(mvm, vif); u16 new_active_links; u8 link_id, n_data = 0, i, j; if (!IWL_MVM_AUTO_EML_ENABLE) return; if (!ieee80211_vif_is_mld(vif) || usable_links == 1) return; /* The logic below is a simple version that doesn't suit more than 2 * links */ WARN_ON_ONCE(max_active_links > 2); /* if only a single active link is supported, assume that the one * selected by higher layer for connection establishment is the best. */ if (max_active_links == 1 && !valid_links_changed) return; /* If we are already using the maximal number of active links, don't do * any change. This can later be optimized to pick a 'better' link pair. */ if (hweight16(vif->active_links) == max_active_links) return; rcu_read_lock(); for_each_set_bit(link_id, &usable_links, IEEE80211_MLD_MAX_NUM_LINKS) { struct ieee80211_bss_conf *link_conf = rcu_dereference(vif->link_conf[link_id]); if (WARN_ON_ONCE(!link_conf)) continue; data[n_data].link_id = link_id; data[n_data].band = link_conf->chandef.chan->band; data[n_data].active = vif->active_links & BIT(link_id); n_data++; } rcu_read_unlock(); /* this is expected to be the current active link */ if (n_data == 1) return; new_active_links = 0; /* Assume that after association only a single link is active, thus, * select only the 2nd link */ if (!valid_links_changed) { for (i = 0; i < n_data; i++) { if (data[i].active) break; } if (WARN_ON_ONCE(i == n_data)) return; for (j = 0; j < n_data; j++) { if (i == j) continue; if (iwl_mvm_mld_valid_link_pair(&data[i], &data[j])) break; } if (j != n_data) new_active_links = BIT(data[i].link_id) | BIT(data[j].link_id); } else { /* Try to find a valid link pair for EMLSR operation. If a pair * is not found continue using the current active link. */ for (i = 0; i < n_data; i++) { for (j = 0; j < n_data; j++) { if (i == j) continue; if (iwl_mvm_mld_valid_link_pair(&data[i], &data[j])) break; } /* found a valid pair for EMLSR, use it */ if (j != n_data) { new_active_links = BIT(data[i].link_id) | BIT(data[j].link_id); break; } } } if (WARN_ON(!new_active_links)) return; if (vif->active_links != new_active_links) ieee80211_set_active_links_async(vif, new_active_links); } static void iwl_mvm_mld_link_info_changed_station(struct iwl_mvm *mvm, struct ieee80211_vif *vif, struct ieee80211_bss_conf *link_conf, u64 changes) { struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif); bool has_he, has_eht; u32 link_changes = 0; int ret; if (WARN_ON_ONCE(!mvmvif->link[link_conf->link_id])) return; has_he = link_conf->he_support && !iwlwifi_mod_params.disable_11ax; has_eht = link_conf->eht_support && !iwlwifi_mod_params.disable_11be; /* Update EDCA params */ if (changes & BSS_CHANGED_QOS && vif->cfg.assoc && link_conf->qos) link_changes |= LINK_CONTEXT_MODIFY_QOS_PARAMS; if (changes & BSS_CHANGED_ERP_SLOT) link_changes |= LINK_CONTEXT_MODIFY_RATES_INFO; if (vif->cfg.assoc && (has_he || has_eht)) { IWL_DEBUG_MAC80211(mvm, "Associated in HE mode\n"); link_changes |= LINK_CONTEXT_MODIFY_HE_PARAMS; } /* Update EHT Puncturing info */ if (changes & BSS_CHANGED_EHT_PUNCTURING && vif->cfg.assoc) link_changes |= LINK_CONTEXT_MODIFY_EHT_PARAMS; if (link_changes) { ret = iwl_mvm_link_changed(mvm, vif, link_conf, link_changes, true); if (ret) IWL_ERR(mvm, "failed to update link\n"); } ret = iwl_mvm_mld_mac_ctxt_changed(mvm, vif, false); if (ret) IWL_ERR(mvm, "failed to update MAC %pM\n", vif->addr); if (changes & BSS_CHANGED_MLD_VALID_LINKS) iwl_mvm_mld_select_links(mvm, vif, true); memcpy(mvmvif->link[link_conf->link_id]->bssid, link_conf->bssid, ETH_ALEN); iwl_mvm_bss_info_changed_station_common(mvm, vif, link_conf, changes); } static bool iwl_mvm_mld_vif_have_valid_ap_sta(struct iwl_mvm_vif *mvmvif) { int i; for_each_mvm_vif_valid_link(mvmvif, i) { if (mvmvif->link[i]->ap_sta_id != IWL_MVM_INVALID_STA) return true; } return false; } static void iwl_mvm_mld_vif_delete_all_stas(struct iwl_mvm *mvm, struct ieee80211_vif *vif) { struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif); int i, ret; if (test_bit(IWL_MVM_STATUS_IN_HW_RESTART, &mvm->status)) return; for_each_mvm_vif_valid_link(mvmvif, i) { struct iwl_mvm_vif_link_info *link = mvmvif->link[i]; if (!link) continue; iwl_mvm_sec_key_remove_ap(mvm, vif, link, i); ret = iwl_mvm_mld_rm_sta_id(mvm, link->ap_sta_id); if (ret) IWL_ERR(mvm, "failed to remove AP station\n"); link->ap_sta_id = IWL_MVM_INVALID_STA; } } static void iwl_mvm_mld_vif_cfg_changed_station(struct iwl_mvm *mvm, struct ieee80211_vif *vif, u64 changes) { struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif); struct ieee80211_bss_conf *link_conf; bool protect = false; unsigned int i; int ret; /* This might get called without active links during the * chanctx switch, but we don't care about it anyway. */ if (changes == BSS_CHANGED_IDLE) return; ret = iwl_mvm_mld_mac_ctxt_changed(mvm, vif, false); if (ret) IWL_ERR(mvm, "failed to update MAC %pM\n", vif->addr); mvmvif->associated = vif->cfg.assoc; if (changes & BSS_CHANGED_ASSOC) { if (vif->cfg.assoc) { /* clear statistics to get clean beacon counter */ iwl_mvm_request_statistics(mvm, true); iwl_mvm_sf_update(mvm, vif, false); iwl_mvm_power_vif_assoc(mvm, vif); for_each_mvm_vif_valid_link(mvmvif, i) { memset(&mvmvif->link[i]->beacon_stats, 0, sizeof(mvmvif->link[i]->beacon_stats)); if (vif->p2p) { iwl_mvm_update_smps(mvm, vif, IWL_MVM_SMPS_REQ_PROT, IEEE80211_SMPS_DYNAMIC, i); } rcu_read_lock(); link_conf = rcu_dereference(vif->link_conf[i]); if (link_conf && !link_conf->dtim_period) protect = true; rcu_read_unlock(); } if (!test_bit(IWL_MVM_STATUS_IN_HW_RESTART, &mvm->status) && protect) { /* We are in assoc so only one link is active- * The association link */ unsigned int link_id = ffs(vif->active_links) - 1; /* If we're not restarting and still haven't * heard a beacon (dtim period unknown) then * make sure we still have enough minimum time * remaining in the time event, since the auth * might actually have taken quite a while * (especially for SAE) and so the remaining * time could be small without us having heard * a beacon yet. */ iwl_mvm_protect_assoc(mvm, vif, 0, link_id); } iwl_mvm_sf_update(mvm, vif, false); /* FIXME: need to decide about misbehaving AP handling */ iwl_mvm_power_vif_assoc(mvm, vif); } else if (iwl_mvm_mld_vif_have_valid_ap_sta(mvmvif)) { iwl_mvm_mei_host_disassociated(mvm); /* If update fails - SF might be running in associated * mode while disassociated - which is forbidden. */ ret = iwl_mvm_sf_update(mvm, vif, false); WARN_ONCE(ret && !test_bit(IWL_MVM_STATUS_HW_RESTART_REQUESTED, &mvm->status), "Failed to update SF upon disassociation\n"); /* If we get an assert during the connection (after the * station has been added, but before the vif is set * to associated), mac80211 will re-add the station and * then configure the vif. Since the vif is not * associated, we would remove the station here and * this would fail the recovery. */ iwl_mvm_mld_vif_delete_all_stas(mvm, vif); } iwl_mvm_bss_info_changed_station_assoc(mvm, vif, changes); } if (changes & BSS_CHANGED_PS) { ret = iwl_mvm_power_update_mac(mvm); if (ret) IWL_ERR(mvm, "failed to update power mode\n"); } } static void iwl_mvm_mld_link_info_changed_ap_ibss(struct iwl_mvm *mvm, struct ieee80211_vif *vif, struct ieee80211_bss_conf *link_conf, u64 changes) { struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif); u32 link_changes = LINK_CONTEXT_MODIFY_PROTECT_FLAGS | LINK_CONTEXT_MODIFY_QOS_PARAMS; /* Changes will be applied when the AP/IBSS is started */ if (!mvmvif->ap_ibss_active) return; if (link_conf->he_support) link_changes |= LINK_CONTEXT_MODIFY_HE_PARAMS; if (changes & BSS_CHANGED_ERP_SLOT) link_changes |= LINK_CONTEXT_MODIFY_RATES_INFO; if (changes & (BSS_CHANGED_ERP_CTS_PROT | BSS_CHANGED_ERP_SLOT | BSS_CHANGED_HT | BSS_CHANGED_BANDWIDTH | BSS_CHANGED_QOS | BSS_CHANGED_HE_BSS_COLOR) && iwl_mvm_link_changed(mvm, vif, link_conf, link_changes, true)) IWL_ERR(mvm, "failed to update MAC %pM\n", vif->addr); /* Need to send a new beacon template to the FW */ if (changes & BSS_CHANGED_BEACON && iwl_mvm_mac_ctxt_beacon_changed(mvm, vif, link_conf)) IWL_WARN(mvm, "Failed updating beacon data\n"); /* FIXME: need to decide if we need FTM responder per link */ if (changes & BSS_CHANGED_FTM_RESPONDER) { int ret = iwl_mvm_ftm_start_responder(mvm, vif, link_conf); if (ret) IWL_WARN(mvm, "Failed to enable FTM responder (%d)\n", ret); } } static void iwl_mvm_mld_link_info_changed(struct ieee80211_hw *hw, struct ieee80211_vif *vif, struct ieee80211_bss_conf *link_conf, u64 changes) { struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw); mutex_lock(&mvm->mutex); switch (vif->type) { case NL80211_IFTYPE_STATION: iwl_mvm_mld_link_info_changed_station(mvm, vif, link_conf, changes); break; case NL80211_IFTYPE_AP: case NL80211_IFTYPE_ADHOC: iwl_mvm_mld_link_info_changed_ap_ibss(mvm, vif, link_conf, changes); break; case NL80211_IFTYPE_MONITOR: if (changes & BSS_CHANGED_MU_GROUPS) iwl_mvm_update_mu_groups(mvm, vif); break; default: /* shouldn't happen */ WARN_ON_ONCE(1); } if (changes & BSS_CHANGED_TXPOWER) { IWL_DEBUG_CALIB(mvm, "Changing TX Power to %d dBm\n", link_conf->txpower); iwl_mvm_set_tx_power(mvm, vif, link_conf->txpower); } mutex_unlock(&mvm->mutex); } static void iwl_mvm_mld_vif_cfg_changed(struct ieee80211_hw *hw, struct ieee80211_vif *vif, u64 changes) { struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw); mutex_lock(&mvm->mutex); if (changes & BSS_CHANGED_IDLE && !vif->cfg.idle) iwl_mvm_scan_stop(mvm, IWL_MVM_SCAN_SCHED, true); if (vif->type == NL80211_IFTYPE_STATION) iwl_mvm_mld_vif_cfg_changed_station(mvm, vif, changes); mutex_unlock(&mvm->mutex); } static int iwl_mvm_mld_switch_vif_chanctx(struct ieee80211_hw *hw, struct ieee80211_vif_chanctx_switch *vifs, int n_vifs, enum ieee80211_chanctx_switch_mode mode) { static const struct iwl_mvm_switch_vif_chanctx_ops ops = { .__assign_vif_chanctx = __iwl_mvm_mld_assign_vif_chanctx, .__unassign_vif_chanctx = __iwl_mvm_mld_unassign_vif_chanctx, }; return iwl_mvm_switch_vif_chanctx_common(hw, vifs, n_vifs, mode, &ops); } static void iwl_mvm_mld_config_iface_filter(struct ieee80211_hw *hw, struct ieee80211_vif *vif, unsigned int filter_flags, unsigned int changed_flags) { struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw); /* We support only filter for probe requests */ if (!(changed_flags & FIF_PROBE_REQ)) return; /* Supported only for p2p client interfaces */ if (vif->type != NL80211_IFTYPE_STATION || !vif->cfg.assoc || !vif->p2p) return; mutex_lock(&mvm->mutex); iwl_mvm_mld_mac_ctxt_changed(mvm, vif, false); mutex_unlock(&mvm->mutex); } static int iwl_mvm_mld_mac_conf_tx(struct ieee80211_hw *hw, struct ieee80211_vif *vif, unsigned int link_id, u16 ac, const struct ieee80211_tx_queue_params *params) { struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw); struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif); struct iwl_mvm_vif_link_info *mvm_link = mvmvif->link[link_id]; if (!mvm_link) return -EINVAL; mvm_link->queue_params[ac] = *params; /* No need to update right away, we'll get BSS_CHANGED_QOS * The exception is P2P_DEVICE interface which needs immediate update. */ if (vif->type == NL80211_IFTYPE_P2P_DEVICE) { int ret; mutex_lock(&mvm->mutex); ret = iwl_mvm_link_changed(mvm, vif, &vif->bss_conf, LINK_CONTEXT_MODIFY_QOS_PARAMS, true); mutex_unlock(&mvm->mutex); return ret; } return 0; } static int iwl_mvm_mld_roc_link(struct iwl_mvm *mvm, struct ieee80211_vif *vif) { int ret; lockdep_assert_held(&mvm->mutex); /* The PHY context ID might have changed so need to set it */ ret = iwl_mvm_link_changed(mvm, vif, &vif->bss_conf, 0, false); if (WARN(ret, "Failed to set PHY context ID\n")) return ret; ret = iwl_mvm_link_changed(mvm, vif, &vif->bss_conf, LINK_CONTEXT_MODIFY_ACTIVE | LINK_CONTEXT_MODIFY_RATES_INFO, true); if (WARN(ret, "Failed linking P2P_DEVICE\n")) return ret; /* The station and queue allocation must be done only after the linking * is done, as otherwise the FW might incorrectly configure its state. */ return iwl_mvm_mld_add_bcast_sta(mvm, vif, &vif->bss_conf); } static int iwl_mvm_mld_roc(struct ieee80211_hw *hw, struct ieee80211_vif *vif, struct ieee80211_channel *channel, int duration, enum ieee80211_roc_type type) { static const struct iwl_mvm_roc_ops ops = { .add_aux_sta_for_hs20 = iwl_mvm_mld_add_aux_sta, .link = iwl_mvm_mld_roc_link, }; return iwl_mvm_roc_common(hw, vif, channel, duration, type, &ops); } static int iwl_mvm_mld_change_vif_links(struct ieee80211_hw *hw, struct ieee80211_vif *vif, u16 old_links, u16 new_links, struct ieee80211_bss_conf *old[IEEE80211_MLD_MAX_NUM_LINKS]) { struct iwl_mvm_vif_link_info *new_link[IEEE80211_MLD_MAX_NUM_LINKS] = {}; unsigned int n_active = iwl_mvm_mld_count_active_links(vif); struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif); struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw); u16 removed = old_links & ~new_links; u16 added = new_links & ~old_links; int err, i; if (hweight16(new_links) > 1 && n_active > iwl_mvm_max_active_links(mvm, vif)) return -EOPNOTSUPP; for (i = 0; i < IEEE80211_MLD_MAX_NUM_LINKS; i++) { int r; if (test_bit(IWL_MVM_STATUS_IN_HW_RESTART, &mvm->status)) break; if (!(added & BIT(i))) continue; new_link[i] = kzalloc(sizeof(*new_link[i]), GFP_KERNEL); if (!new_link[i]) { err = -ENOMEM; goto free; } new_link[i]->bcast_sta.sta_id = IWL_MVM_INVALID_STA; new_link[i]->mcast_sta.sta_id = IWL_MVM_INVALID_STA; new_link[i]->ap_sta_id = IWL_MVM_INVALID_STA; new_link[i]->fw_link_id = IWL_MVM_FW_LINK_ID_INVALID; for (r = 0; r < NUM_IWL_MVM_SMPS_REQ; r++) new_link[i]->smps_requests[r] = IEEE80211_SMPS_AUTOMATIC; } mutex_lock(&mvm->mutex); if (old_links == 0) { err = iwl_mvm_disable_link(mvm, vif, &vif->bss_conf); if (err) goto out_err; mvmvif->link[0] = NULL; } for (i = 0; i < IEEE80211_MLD_MAX_NUM_LINKS; i++) { if (removed & BIT(i)) { struct ieee80211_bss_conf *link_conf = old[i]; err = iwl_mvm_disable_link(mvm, vif, link_conf); if (err) goto out_err; kfree(mvmvif->link[i]); mvmvif->link[i] = NULL; } else if (added & BIT(i)) { struct ieee80211_bss_conf *link_conf; link_conf = link_conf_dereference_protected(vif, i); if (WARN_ON(!link_conf)) continue; if (!test_bit(IWL_MVM_STATUS_IN_HW_RESTART, &mvm->status)) mvmvif->link[i] = new_link[i]; new_link[i] = NULL; err = iwl_mvm_add_link(mvm, vif, link_conf); if (err) goto out_err; } } err = 0; if (new_links == 0) { mvmvif->link[0] = &mvmvif->deflink; err = iwl_mvm_add_link(mvm, vif, &vif->bss_conf); } out_err: /* we really don't have a good way to roll back here ... */ mutex_unlock(&mvm->mutex); free: for (i = 0; i < IEEE80211_MLD_MAX_NUM_LINKS; i++) kfree(new_link[i]); return err; } static int iwl_mvm_mld_change_sta_links(struct ieee80211_hw *hw, struct ieee80211_vif *vif, struct ieee80211_sta *sta, u16 old_links, u16 new_links) { struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw); int ret; mutex_lock(&mvm->mutex); ret = iwl_mvm_mld_update_sta_links(mvm, vif, sta, old_links, new_links); mutex_unlock(&mvm->mutex); return ret; } const struct ieee80211_ops iwl_mvm_mld_hw_ops = { .tx = iwl_mvm_mac_tx, .wake_tx_queue = iwl_mvm_mac_wake_tx_queue, .ampdu_action = iwl_mvm_mac_ampdu_action, .get_antenna = iwl_mvm_op_get_antenna, .set_antenna = iwl_mvm_op_set_antenna, .start = iwl_mvm_mac_start, .reconfig_complete = iwl_mvm_mac_reconfig_complete, .stop = iwl_mvm_mac_stop, .add_interface = iwl_mvm_mld_mac_add_interface, .remove_interface = iwl_mvm_mld_mac_remove_interface, .config = iwl_mvm_mac_config, .prepare_multicast = iwl_mvm_prepare_multicast, .configure_filter = iwl_mvm_configure_filter, .config_iface_filter = iwl_mvm_mld_config_iface_filter, .link_info_changed = iwl_mvm_mld_link_info_changed, .vif_cfg_changed = iwl_mvm_mld_vif_cfg_changed, .hw_scan = iwl_mvm_mac_hw_scan, .cancel_hw_scan = iwl_mvm_mac_cancel_hw_scan, .sta_pre_rcu_remove = iwl_mvm_sta_pre_rcu_remove, .sta_state = iwl_mvm_mld_mac_sta_state, .sta_notify = iwl_mvm_mac_sta_notify, .allow_buffered_frames = iwl_mvm_mac_allow_buffered_frames, .release_buffered_frames = iwl_mvm_mac_release_buffered_frames, .set_rts_threshold = iwl_mvm_mac_set_rts_threshold, .sta_rc_update = iwl_mvm_sta_rc_update, .conf_tx = iwl_mvm_mld_mac_conf_tx, .mgd_prepare_tx = iwl_mvm_mac_mgd_prepare_tx, .mgd_complete_tx = iwl_mvm_mac_mgd_complete_tx, .mgd_protect_tdls_discover = iwl_mvm_mac_mgd_protect_tdls_discover, .flush = iwl_mvm_mac_flush, .flush_sta = iwl_mvm_mac_flush_sta, .sched_scan_start = iwl_mvm_mac_sched_scan_start, .sched_scan_stop = iwl_mvm_mac_sched_scan_stop, .set_key = iwl_mvm_mac_set_key, .update_tkip_key = iwl_mvm_mac_update_tkip_key, .remain_on_channel = iwl_mvm_mld_roc, .cancel_remain_on_channel = iwl_mvm_cancel_roc, .add_chanctx = iwl_mvm_add_chanctx, .remove_chanctx = iwl_mvm_remove_chanctx, .change_chanctx = iwl_mvm_change_chanctx, .assign_vif_chanctx = iwl_mvm_mld_assign_vif_chanctx, .unassign_vif_chanctx = iwl_mvm_mld_unassign_vif_chanctx, .switch_vif_chanctx = iwl_mvm_mld_switch_vif_chanctx, .start_ap = iwl_mvm_mld_start_ap, .stop_ap = iwl_mvm_mld_stop_ap, .join_ibss = iwl_mvm_mld_start_ibss, .leave_ibss = iwl_mvm_mld_stop_ibss, .tx_last_beacon = iwl_mvm_tx_last_beacon, .channel_switch = iwl_mvm_channel_switch, .pre_channel_switch = iwl_mvm_pre_channel_switch, .post_channel_switch = iwl_mvm_post_channel_switch, .abort_channel_switch = iwl_mvm_abort_channel_switch, .channel_switch_rx_beacon = iwl_mvm_channel_switch_rx_beacon, .tdls_channel_switch = iwl_mvm_tdls_channel_switch, .tdls_cancel_channel_switch = iwl_mvm_tdls_cancel_channel_switch, .tdls_recv_channel_switch = iwl_mvm_tdls_recv_channel_switch, .event_callback = iwl_mvm_mac_event_callback, .sync_rx_queues = iwl_mvm_sync_rx_queues, CFG80211_TESTMODE_CMD(iwl_mvm_mac_testmode_cmd) #ifdef CONFIG_PM_SLEEP /* look at d3.c */ .suspend = iwl_mvm_suspend, .resume = iwl_mvm_resume, .set_wakeup = iwl_mvm_set_wakeup, .set_rekey_data = iwl_mvm_set_rekey_data, #if IS_ENABLED(CONFIG_IPV6) .ipv6_addr_change = iwl_mvm_ipv6_addr_change, #endif .set_default_unicast_key = iwl_mvm_set_default_unicast_key, #endif .get_survey = iwl_mvm_mac_get_survey, .sta_statistics = iwl_mvm_mac_sta_statistics, .get_ftm_responder_stats = iwl_mvm_mac_get_ftm_responder_stats, .start_pmsr = iwl_mvm_start_pmsr, .abort_pmsr = iwl_mvm_abort_pmsr, #ifdef CONFIG_IWLWIFI_DEBUGFS .vif_add_debugfs = iwl_mvm_vif_add_debugfs, .link_add_debugfs = iwl_mvm_link_add_debugfs, .link_sta_add_debugfs = iwl_mvm_link_sta_add_debugfs, #endif .set_hw_timestamp = iwl_mvm_set_hw_timestamp, .change_vif_links = iwl_mvm_mld_change_vif_links, .change_sta_links = iwl_mvm_mld_change_sta_links, };
Information contained on this website is for historical information purposes only and does not indicate or represent copyright ownership.
Created with Cregit http://github.com/cregit/cregit
Version 2.0-RC1