1f0706e82SJiri Benc /* 2f0706e82SJiri Benc * Copyright 2002-2005, Instant802 Networks, Inc. 3f0706e82SJiri Benc * Copyright 2006-2007 Jiri Benc <jbenc@suse.cz> 4d98ad83eSJohannes Berg * Copyright 2013-2014 Intel Mobile Communications GmbH 5f59374ebSSara Sharon * Copyright (C) 2015 - 2016 Intel Deutschland GmbH 6f0706e82SJiri Benc * 7f0706e82SJiri Benc * This program is free software; you can redistribute it and/or modify 8f0706e82SJiri Benc * it under the terms of the GNU General Public License version 2 as 9f0706e82SJiri Benc * published by the Free Software Foundation. 10f0706e82SJiri Benc */ 11f0706e82SJiri Benc 12f0706e82SJiri Benc #include <linux/module.h> 13f0706e82SJiri Benc #include <linux/init.h> 14888d04dfSFelix Fietkau #include <linux/etherdevice.h> 15f0706e82SJiri Benc #include <linux/netdevice.h> 16f0706e82SJiri Benc #include <linux/types.h> 17f0706e82SJiri Benc #include <linux/slab.h> 18f0706e82SJiri Benc #include <linux/skbuff.h> 19f0706e82SJiri Benc #include <linux/if_arp.h> 200d174406SJohannes Berg #include <linux/timer.h> 21d0709a65SJohannes Berg #include <linux/rtnetlink.h> 22f0706e82SJiri Benc 23f0706e82SJiri Benc #include <net/mac80211.h> 24f0706e82SJiri Benc #include "ieee80211_i.h" 2524487981SJohannes Berg #include "driver-ops.h" 262c8dccc7SJohannes Berg #include "rate.h" 27f0706e82SJiri Benc #include "sta_info.h" 28e9f207f0SJiri Benc #include "debugfs_sta.h" 29ee385855SLuis Carlos Cobo #include "mesh.h" 30ce662b44SJohannes Berg #include "wme.h" 31f0706e82SJiri Benc 32d0709a65SJohannes Berg /** 33d0709a65SJohannes Berg * DOC: STA information lifetime rules 34d0709a65SJohannes Berg * 35d0709a65SJohannes Berg * STA info structures (&struct sta_info) are managed in a hash table 36d0709a65SJohannes Berg * for faster lookup and a list for iteration. They are managed using 37d0709a65SJohannes Berg * RCU, i.e. access to the list and hash table is protected by RCU. 38d0709a65SJohannes Berg * 3934e89507SJohannes Berg * Upon allocating a STA info structure with sta_info_alloc(), the caller 4034e89507SJohannes Berg * owns that structure. It must then insert it into the hash table using 4134e89507SJohannes Berg * either sta_info_insert() or sta_info_insert_rcu(); only in the latter 4234e89507SJohannes Berg * case (which acquires an rcu read section but must not be called from 4334e89507SJohannes Berg * within one) will the pointer still be valid after the call. Note that 4434e89507SJohannes Berg * the caller may not do much with the STA info before inserting it, in 4534e89507SJohannes Berg * particular, it may not start any mesh peer link management or add 4634e89507SJohannes Berg * encryption keys. 4793e5deb1SJohannes Berg * 4893e5deb1SJohannes Berg * When the insertion fails (sta_info_insert()) returns non-zero), the 4993e5deb1SJohannes Berg * structure will have been freed by sta_info_insert()! 50d0709a65SJohannes Berg * 5134e89507SJohannes Berg * Station entries are added by mac80211 when you establish a link with a 527e189a12SLuis R. Rodriguez * peer. This means different things for the different type of interfaces 537e189a12SLuis R. Rodriguez * we support. For a regular station this mean we add the AP sta when we 5425985edcSLucas De Marchi * receive an association response from the AP. For IBSS this occurs when 5534e89507SJohannes Berg * get to know about a peer on the same IBSS. For WDS we add the sta for 5625985edcSLucas De Marchi * the peer immediately upon device open. When using AP mode we add stations 5734e89507SJohannes Berg * for each respective station upon request from userspace through nl80211. 587e189a12SLuis R. Rodriguez * 5934e89507SJohannes Berg * In order to remove a STA info structure, various sta_info_destroy_*() 6034e89507SJohannes Berg * calls are available. 61d0709a65SJohannes Berg * 6234e89507SJohannes Berg * There is no concept of ownership on a STA entry, each structure is 6334e89507SJohannes Berg * owned by the global hash table/list until it is removed. All users of 6434e89507SJohannes Berg * the structure need to be RCU protected so that the structure won't be 6534e89507SJohannes Berg * freed before they are done using it. 66d0709a65SJohannes Berg */ 67f0706e82SJiri Benc 687bedd0cfSJohannes Berg static const struct rhashtable_params sta_rht_params = { 697bedd0cfSJohannes Berg .nelem_hint = 3, /* start small */ 70b6bf8c68SBen Greear .insecure_elasticity = true, /* Disable chain-length checks. */ 71caf22d31SJohannes Berg .automatic_shrinking = true, 727bedd0cfSJohannes Berg .head_offset = offsetof(struct sta_info, hash_node), 73ac100ce5SJohannes Berg .key_offset = offsetof(struct sta_info, addr), 747bedd0cfSJohannes Berg .key_len = ETH_ALEN, 757bedd0cfSJohannes Berg .hashfn = sta_addr_hash, 76ebd82b39SJohannes Berg .max_size = CONFIG_MAC80211_STA_HASH_MAX_SIZE, 777bedd0cfSJohannes Berg }; 787bedd0cfSJohannes Berg 794d33960bSJohannes Berg /* Caller must hold local->sta_mtx */ 80be8755e1SMichael Wu static int sta_info_hash_del(struct ieee80211_local *local, 81f0706e82SJiri Benc struct sta_info *sta) 82f0706e82SJiri Benc { 837bedd0cfSJohannes Berg return rhashtable_remove_fast(&local->sta_hash, &sta->hash_node, 847bedd0cfSJohannes Berg sta_rht_params); 85f0706e82SJiri Benc } 86f0706e82SJiri Benc 875108ca82SJohannes Berg static void __cleanup_single_sta(struct sta_info *sta) 88b22cfcfcSEliad Peller { 89b22cfcfcSEliad Peller int ac, i; 90b22cfcfcSEliad Peller struct tid_ampdu_tx *tid_tx; 91b22cfcfcSEliad Peller struct ieee80211_sub_if_data *sdata = sta->sdata; 92b22cfcfcSEliad Peller struct ieee80211_local *local = sdata->local; 93*fa962b92SMichal Kazior struct fq *fq = &local->fq; 94d012a605SMarco Porsch struct ps_data *ps; 95b22cfcfcSEliad Peller 96e3685e03SJohannes Berg if (test_sta_flag(sta, WLAN_STA_PS_STA) || 975ac2e350SJohannes Berg test_sta_flag(sta, WLAN_STA_PS_DRIVER) || 985ac2e350SJohannes Berg test_sta_flag(sta, WLAN_STA_PS_DELIVER)) { 99d012a605SMarco Porsch if (sta->sdata->vif.type == NL80211_IFTYPE_AP || 100d012a605SMarco Porsch sta->sdata->vif.type == NL80211_IFTYPE_AP_VLAN) 101d012a605SMarco Porsch ps = &sdata->bss->ps; 1023f52b7e3SMarco Porsch else if (ieee80211_vif_is_mesh(&sdata->vif)) 1033f52b7e3SMarco Porsch ps = &sdata->u.mesh.ps; 104d012a605SMarco Porsch else 105d012a605SMarco Porsch return; 106b22cfcfcSEliad Peller 107b22cfcfcSEliad Peller clear_sta_flag(sta, WLAN_STA_PS_STA); 108e3685e03SJohannes Berg clear_sta_flag(sta, WLAN_STA_PS_DRIVER); 1095ac2e350SJohannes Berg clear_sta_flag(sta, WLAN_STA_PS_DELIVER); 110b22cfcfcSEliad Peller 111d012a605SMarco Porsch atomic_dec(&ps->num_sta_ps); 112b22cfcfcSEliad Peller } 113b22cfcfcSEliad Peller 114ba8c3d6fSFelix Fietkau if (sta->sta.txq[0]) { 115ba8c3d6fSFelix Fietkau for (i = 0; i < ARRAY_SIZE(sta->sta.txq); i++) { 116ba8c3d6fSFelix Fietkau struct txq_info *txqi = to_txq_info(sta->sta.txq[i]); 117ba8c3d6fSFelix Fietkau 118*fa962b92SMichal Kazior spin_lock_bh(&fq->lock); 119*fa962b92SMichal Kazior ieee80211_txq_purge(local, txqi); 120*fa962b92SMichal Kazior spin_unlock_bh(&fq->lock); 121ba8c3d6fSFelix Fietkau } 122ba8c3d6fSFelix Fietkau } 123ba8c3d6fSFelix Fietkau 124b22cfcfcSEliad Peller for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) { 125b22cfcfcSEliad Peller local->total_ps_buffered -= skb_queue_len(&sta->ps_tx_buf[ac]); 1261f98ab7fSFelix Fietkau ieee80211_purge_tx_queue(&local->hw, &sta->ps_tx_buf[ac]); 1271f98ab7fSFelix Fietkau ieee80211_purge_tx_queue(&local->hw, &sta->tx_filtered[ac]); 128b22cfcfcSEliad Peller } 129b22cfcfcSEliad Peller 13045b5028eSThomas Pedersen if (ieee80211_vif_is_mesh(&sdata->vif)) 13145b5028eSThomas Pedersen mesh_sta_cleanup(sta); 132b22cfcfcSEliad Peller 1335ac2e350SJohannes Berg cancel_work_sync(&sta->drv_deliver_wk); 134b22cfcfcSEliad Peller 135b22cfcfcSEliad Peller /* 136b22cfcfcSEliad Peller * Destroy aggregation state here. It would be nice to wait for the 137b22cfcfcSEliad Peller * driver to finish aggregation stop and then clean up, but for now 138b22cfcfcSEliad Peller * drivers have to handle aggregation stop being requested, followed 139b22cfcfcSEliad Peller * directly by station destruction. 140b22cfcfcSEliad Peller */ 1415a306f58SJohannes Berg for (i = 0; i < IEEE80211_NUM_TIDS; i++) { 142661eb381SJohannes Berg kfree(sta->ampdu_mlme.tid_start_tx[i]); 143b22cfcfcSEliad Peller tid_tx = rcu_dereference_raw(sta->ampdu_mlme.tid_tx[i]); 144b22cfcfcSEliad Peller if (!tid_tx) 145b22cfcfcSEliad Peller continue; 1461f98ab7fSFelix Fietkau ieee80211_purge_tx_queue(&local->hw, &tid_tx->pending); 147b22cfcfcSEliad Peller kfree(tid_tx); 148b22cfcfcSEliad Peller } 1495108ca82SJohannes Berg } 150b22cfcfcSEliad Peller 1515108ca82SJohannes Berg static void cleanup_single_sta(struct sta_info *sta) 1525108ca82SJohannes Berg { 1535108ca82SJohannes Berg struct ieee80211_sub_if_data *sdata = sta->sdata; 1545108ca82SJohannes Berg struct ieee80211_local *local = sdata->local; 1555108ca82SJohannes Berg 1565108ca82SJohannes Berg __cleanup_single_sta(sta); 157b22cfcfcSEliad Peller sta_info_free(local, sta); 158b22cfcfcSEliad Peller } 159b22cfcfcSEliad Peller 160d0709a65SJohannes Berg /* protected by RCU */ 161abe60632SJohannes Berg struct sta_info *sta_info_get(struct ieee80211_sub_if_data *sdata, 162abe60632SJohannes Berg const u8 *addr) 16343ba7e95SJohannes Berg { 164abe60632SJohannes Berg struct ieee80211_local *local = sdata->local; 16560f4b626SJohannes Berg struct sta_info *sta; 16660f4b626SJohannes Berg struct rhash_head *tmp; 16760f4b626SJohannes Berg const struct bucket_table *tbl; 16843ba7e95SJohannes Berg 16960f4b626SJohannes Berg rcu_read_lock(); 17060f4b626SJohannes Berg tbl = rht_dereference_rcu(local->sta_hash.tbl, &local->sta_hash); 17160f4b626SJohannes Berg 17260f4b626SJohannes Berg for_each_sta_info(local, tbl, addr, sta, tmp) { 17360f4b626SJohannes Berg if (sta->sdata == sdata) { 17460f4b626SJohannes Berg rcu_read_unlock(); 17560f4b626SJohannes Berg /* this is safe as the caller must already hold 17660f4b626SJohannes Berg * another rcu read section or the mutex 17760f4b626SJohannes Berg */ 17860f4b626SJohannes Berg return sta; 17960f4b626SJohannes Berg } 18060f4b626SJohannes Berg } 18160f4b626SJohannes Berg rcu_read_unlock(); 18260f4b626SJohannes Berg return NULL; 18343ba7e95SJohannes Berg } 18443ba7e95SJohannes Berg 1850e5ded5aSFelix Fietkau /* 1860e5ded5aSFelix Fietkau * Get sta info either from the specified interface 1870e5ded5aSFelix Fietkau * or from one of its vlans 1880e5ded5aSFelix Fietkau */ 1890e5ded5aSFelix Fietkau struct sta_info *sta_info_get_bss(struct ieee80211_sub_if_data *sdata, 1900e5ded5aSFelix Fietkau const u8 *addr) 1910e5ded5aSFelix Fietkau { 1920e5ded5aSFelix Fietkau struct ieee80211_local *local = sdata->local; 1930e5ded5aSFelix Fietkau struct sta_info *sta; 1947bedd0cfSJohannes Berg struct rhash_head *tmp; 1957bedd0cfSJohannes Berg const struct bucket_table *tbl; 1960e5ded5aSFelix Fietkau 1977bedd0cfSJohannes Berg rcu_read_lock(); 1987bedd0cfSJohannes Berg tbl = rht_dereference_rcu(local->sta_hash.tbl, &local->sta_hash); 1997bedd0cfSJohannes Berg 2007bedd0cfSJohannes Berg for_each_sta_info(local, tbl, addr, sta, tmp) { 2017bedd0cfSJohannes Berg if (sta->sdata == sdata || 2027bedd0cfSJohannes Berg (sta->sdata->bss && sta->sdata->bss == sdata->bss)) { 2037bedd0cfSJohannes Berg rcu_read_unlock(); 2047bedd0cfSJohannes Berg /* this is safe as the caller must already hold 2057bedd0cfSJohannes Berg * another rcu read section or the mutex 2067bedd0cfSJohannes Berg */ 2070e5ded5aSFelix Fietkau return sta; 2080e5ded5aSFelix Fietkau } 2097bedd0cfSJohannes Berg } 2107bedd0cfSJohannes Berg rcu_read_unlock(); 2117bedd0cfSJohannes Berg return NULL; 2127bedd0cfSJohannes Berg } 2130e5ded5aSFelix Fietkau 2143b53fde8SJohannes Berg struct sta_info *sta_info_get_by_idx(struct ieee80211_sub_if_data *sdata, 2153b53fde8SJohannes Berg int idx) 216ee385855SLuis Carlos Cobo { 2173b53fde8SJohannes Berg struct ieee80211_local *local = sdata->local; 218ee385855SLuis Carlos Cobo struct sta_info *sta; 219ee385855SLuis Carlos Cobo int i = 0; 220ee385855SLuis Carlos Cobo 221d0709a65SJohannes Berg list_for_each_entry_rcu(sta, &local->sta_list, list) { 2223b53fde8SJohannes Berg if (sdata != sta->sdata) 2232a8ca29aSLuis Carlos Cobo continue; 224ee385855SLuis Carlos Cobo if (i < idx) { 225ee385855SLuis Carlos Cobo ++i; 226ee385855SLuis Carlos Cobo continue; 227ee385855SLuis Carlos Cobo } 2282a8ca29aSLuis Carlos Cobo return sta; 229ee385855SLuis Carlos Cobo } 230ee385855SLuis Carlos Cobo 231ee385855SLuis Carlos Cobo return NULL; 232ee385855SLuis Carlos Cobo } 233f0706e82SJiri Benc 23493e5deb1SJohannes Berg /** 235d9a7ddb0SJohannes Berg * sta_info_free - free STA 23693e5deb1SJohannes Berg * 2376ef307bcSRandy Dunlap * @local: pointer to the global information 23893e5deb1SJohannes Berg * @sta: STA info to free 23993e5deb1SJohannes Berg * 24093e5deb1SJohannes Berg * This function must undo everything done by sta_info_alloc() 241d9a7ddb0SJohannes Berg * that may happen before sta_info_insert(). It may only be 242d9a7ddb0SJohannes Berg * called when sta_info_insert() has not been attempted (and 243d9a7ddb0SJohannes Berg * if that fails, the station is freed anyway.) 24493e5deb1SJohannes Berg */ 245d9a7ddb0SJohannes Berg void sta_info_free(struct ieee80211_local *local, struct sta_info *sta) 24693e5deb1SJohannes Berg { 247889cbb91SJohannes Berg if (sta->rate_ctrl) 2484b7679a5SJohannes Berg rate_control_free_sta(sta); 24993e5deb1SJohannes Berg 250bdcbd8e0SJohannes Berg sta_dbg(sta->sdata, "Destroyed STA %pM\n", sta->sta.addr); 25193e5deb1SJohannes Berg 252ba8c3d6fSFelix Fietkau if (sta->sta.txq[0]) 253ba8c3d6fSFelix Fietkau kfree(to_txq_info(sta->sta.txq[0])); 25453d04525SFelix Fietkau kfree(rcu_dereference_raw(sta->sta.rates)); 255433f5bc1SJohannes Berg #ifdef CONFIG_MAC80211_MESH 256433f5bc1SJohannes Berg kfree(sta->mesh); 257433f5bc1SJohannes Berg #endif 258c9c5962bSJohannes Berg free_percpu(sta->pcpu_rx_stats); 25993e5deb1SJohannes Berg kfree(sta); 26093e5deb1SJohannes Berg } 26193e5deb1SJohannes Berg 2624d33960bSJohannes Berg /* Caller must hold local->sta_mtx */ 26362b14b24SJohannes Berg static int sta_info_hash_add(struct ieee80211_local *local, 264d0709a65SJohannes Berg struct sta_info *sta) 265f0706e82SJiri Benc { 26662b14b24SJohannes Berg return rhashtable_insert_fast(&local->sta_hash, &sta->hash_node, 2677bedd0cfSJohannes Berg sta_rht_params); 268f0706e82SJiri Benc } 269f0706e82SJiri Benc 2705ac2e350SJohannes Berg static void sta_deliver_ps_frames(struct work_struct *wk) 271af818581SJohannes Berg { 272af818581SJohannes Berg struct sta_info *sta; 273af818581SJohannes Berg 2745ac2e350SJohannes Berg sta = container_of(wk, struct sta_info, drv_deliver_wk); 275af818581SJohannes Berg 276af818581SJohannes Berg if (sta->dead) 277af818581SJohannes Berg return; 278af818581SJohannes Berg 27954420473SHelmut Schaa local_bh_disable(); 2805ac2e350SJohannes Berg if (!test_sta_flag(sta, WLAN_STA_PS_STA)) 281af818581SJohannes Berg ieee80211_sta_ps_deliver_wakeup(sta); 2825ac2e350SJohannes Berg else if (test_and_clear_sta_flag(sta, WLAN_STA_PSPOLL)) 283af818581SJohannes Berg ieee80211_sta_ps_deliver_poll_response(sta); 2845ac2e350SJohannes Berg else if (test_and_clear_sta_flag(sta, WLAN_STA_UAPSD)) 28547086fc5SJohannes Berg ieee80211_sta_ps_deliver_uapsd(sta); 286ce662b44SJohannes Berg local_bh_enable(); 287af818581SJohannes Berg } 288af818581SJohannes Berg 289af65cd96SJohannes Berg static int sta_prepare_rate_control(struct ieee80211_local *local, 290af65cd96SJohannes Berg struct sta_info *sta, gfp_t gfp) 291af65cd96SJohannes Berg { 29230686bf7SJohannes Berg if (ieee80211_hw_check(&local->hw, HAS_RATE_CONTROL)) 293af65cd96SJohannes Berg return 0; 294af65cd96SJohannes Berg 295889cbb91SJohannes Berg sta->rate_ctrl = local->rate_ctrl; 296af65cd96SJohannes Berg sta->rate_ctrl_priv = rate_control_alloc_sta(sta->rate_ctrl, 29735c347acSJohannes Berg sta, gfp); 298889cbb91SJohannes Berg if (!sta->rate_ctrl_priv) 299af65cd96SJohannes Berg return -ENOMEM; 300af65cd96SJohannes Berg 301af65cd96SJohannes Berg return 0; 302af65cd96SJohannes Berg } 303af65cd96SJohannes Berg 30473651ee6SJohannes Berg struct sta_info *sta_info_alloc(struct ieee80211_sub_if_data *sdata, 30556544160SJohannes Berg const u8 *addr, gfp_t gfp) 306f0706e82SJiri Benc { 307d0709a65SJohannes Berg struct ieee80211_local *local = sdata->local; 308ba8c3d6fSFelix Fietkau struct ieee80211_hw *hw = &local->hw; 309f0706e82SJiri Benc struct sta_info *sta; 31016c5f15cSRon Rindjunsky int i; 311f0706e82SJiri Benc 312ba8c3d6fSFelix Fietkau sta = kzalloc(sizeof(*sta) + hw->sta_data_size, gfp); 313f0706e82SJiri Benc if (!sta) 31473651ee6SJohannes Berg return NULL; 315f0706e82SJiri Benc 316c9c5962bSJohannes Berg if (ieee80211_hw_check(hw, USES_RSS)) { 317c9c5962bSJohannes Berg sta->pcpu_rx_stats = 318c9c5962bSJohannes Berg alloc_percpu(struct ieee80211_sta_rx_stats); 319c9c5962bSJohannes Berg if (!sta->pcpu_rx_stats) 320c9c5962bSJohannes Berg goto free; 321c9c5962bSJohannes Berg } 322c9c5962bSJohannes Berg 32307346f81SJohannes Berg spin_lock_init(&sta->lock); 3241d147bfaSEmmanuel Grumbach spin_lock_init(&sta->ps_lock); 3255ac2e350SJohannes Berg INIT_WORK(&sta->drv_deliver_wk, sta_deliver_ps_frames); 32667c282c0SJohannes Berg INIT_WORK(&sta->ampdu_mlme.work, ieee80211_ba_session_work); 327a93e3644SJohannes Berg mutex_init(&sta->ampdu_mlme.mtx); 32887f59c70SThomas Pedersen #ifdef CONFIG_MAC80211_MESH 329433f5bc1SJohannes Berg if (ieee80211_vif_is_mesh(&sdata->vif)) { 330433f5bc1SJohannes Berg sta->mesh = kzalloc(sizeof(*sta->mesh), gfp); 331433f5bc1SJohannes Berg if (!sta->mesh) 332433f5bc1SJohannes Berg goto free; 333433f5bc1SJohannes Berg spin_lock_init(&sta->mesh->plink_lock); 33487f59c70SThomas Pedersen if (ieee80211_vif_is_mesh(&sdata->vif) && 33587f59c70SThomas Pedersen !sdata->u.mesh.user_mpm) 336433f5bc1SJohannes Berg init_timer(&sta->mesh->plink_timer); 337433f5bc1SJohannes Berg sta->mesh->nonpeer_pm = NL80211_MESH_POWER_ACTIVE; 338433f5bc1SJohannes Berg } 33987f59c70SThomas Pedersen #endif 34007346f81SJohannes Berg 341ac100ce5SJohannes Berg memcpy(sta->addr, addr, ETH_ALEN); 34217741cdcSJohannes Berg memcpy(sta->sta.addr, addr, ETH_ALEN); 343d0709a65SJohannes Berg sta->local = local; 344d0709a65SJohannes Berg sta->sdata = sdata; 345e5a9f8d0SJohannes Berg sta->rx_stats.last_rx = jiffies; 346f0706e82SJiri Benc 3470f9c5a61SJohannes Berg u64_stats_init(&sta->rx_stats.syncp); 3480f9c5a61SJohannes Berg 34971ec375cSJohannes Berg sta->sta_state = IEEE80211_STA_NONE; 35071ec375cSJohannes Berg 351b6da911bSLiad Kaufman /* Mark TID as unreserved */ 352b6da911bSLiad Kaufman sta->reserved_tid = IEEE80211_TID_UNRESERVED; 353b6da911bSLiad Kaufman 35484b00607SArnd Bergmann sta->last_connected = ktime_get_seconds(); 3550be6ed13SJohannes Berg ewma_signal_init(&sta->rx_stats_avg.signal); 3560be6ed13SJohannes Berg for (i = 0; i < ARRAY_SIZE(sta->rx_stats_avg.chain_signal); i++) 3570be6ed13SJohannes Berg ewma_signal_init(&sta->rx_stats_avg.chain_signal[i]); 358541a45a1SBruno Randolf 359ba8c3d6fSFelix Fietkau if (local->ops->wake_tx_queue) { 360ba8c3d6fSFelix Fietkau void *txq_data; 361ba8c3d6fSFelix Fietkau int size = sizeof(struct txq_info) + 362ba8c3d6fSFelix Fietkau ALIGN(hw->txq_data_size, sizeof(void *)); 363ba8c3d6fSFelix Fietkau 364ba8c3d6fSFelix Fietkau txq_data = kcalloc(ARRAY_SIZE(sta->sta.txq), size, gfp); 365ba8c3d6fSFelix Fietkau if (!txq_data) 366ba8c3d6fSFelix Fietkau goto free; 367ba8c3d6fSFelix Fietkau 368ba8c3d6fSFelix Fietkau for (i = 0; i < ARRAY_SIZE(sta->sta.txq); i++) { 369ba8c3d6fSFelix Fietkau struct txq_info *txq = txq_data + i * size; 370ba8c3d6fSFelix Fietkau 371*fa962b92SMichal Kazior ieee80211_txq_init(sdata, sta, txq, i); 372abfbc3afSJohannes Berg } 373ba8c3d6fSFelix Fietkau } 374ba8c3d6fSFelix Fietkau 375ba8c3d6fSFelix Fietkau if (sta_prepare_rate_control(local, sta, gfp)) 376ba8c3d6fSFelix Fietkau goto free_txq; 377f0706e82SJiri Benc 3785a306f58SJohannes Berg for (i = 0; i < IEEE80211_NUM_TIDS; i++) { 379a622ab72SJohannes Berg /* 380a622ab72SJohannes Berg * timer_to_tid must be initialized with identity mapping 381a622ab72SJohannes Berg * to enable session_timer's data differentiation. See 382a622ab72SJohannes Berg * sta_rx_agg_session_timer_expired for usage. 383a622ab72SJohannes Berg */ 38416c5f15cSRon Rindjunsky sta->timer_to_tid[i] = i; 38516c5f15cSRon Rindjunsky } 386948d887dSJohannes Berg for (i = 0; i < IEEE80211_NUM_ACS; i++) { 387948d887dSJohannes Berg skb_queue_head_init(&sta->ps_tx_buf[i]); 388948d887dSJohannes Berg skb_queue_head_init(&sta->tx_filtered[i]); 389948d887dSJohannes Berg } 39073651ee6SJohannes Berg 3915a306f58SJohannes Berg for (i = 0; i < IEEE80211_NUM_TIDS; i++) 3924be929beSAlexey Dobriyan sta->last_seq_ctrl[i] = cpu_to_le16(USHRT_MAX); 393cccaec98SSenthil Balasubramanian 394af0ed69bSJohannes Berg sta->sta.smps_mode = IEEE80211_SMPS_OFF; 395687da132SEmmanuel Grumbach if (sdata->vif.type == NL80211_IFTYPE_AP || 396687da132SEmmanuel Grumbach sdata->vif.type == NL80211_IFTYPE_AP_VLAN) { 397687da132SEmmanuel Grumbach struct ieee80211_supported_band *sband = 398ba8c3d6fSFelix Fietkau hw->wiphy->bands[ieee80211_get_sdata_band(sdata)]; 399687da132SEmmanuel Grumbach u8 smps = (sband->ht_cap.cap & IEEE80211_HT_CAP_SM_PS) >> 400687da132SEmmanuel Grumbach IEEE80211_HT_CAP_SM_PS_SHIFT; 401687da132SEmmanuel Grumbach /* 402687da132SEmmanuel Grumbach * Assume that hostapd advertises our caps in the beacon and 403687da132SEmmanuel Grumbach * this is the known_smps_mode for a station that just assciated 404687da132SEmmanuel Grumbach */ 405687da132SEmmanuel Grumbach switch (smps) { 406687da132SEmmanuel Grumbach case WLAN_HT_SMPS_CONTROL_DISABLED: 407687da132SEmmanuel Grumbach sta->known_smps_mode = IEEE80211_SMPS_OFF; 408687da132SEmmanuel Grumbach break; 409687da132SEmmanuel Grumbach case WLAN_HT_SMPS_CONTROL_STATIC: 410687da132SEmmanuel Grumbach sta->known_smps_mode = IEEE80211_SMPS_STATIC; 411687da132SEmmanuel Grumbach break; 412687da132SEmmanuel Grumbach case WLAN_HT_SMPS_CONTROL_DYNAMIC: 413687da132SEmmanuel Grumbach sta->known_smps_mode = IEEE80211_SMPS_DYNAMIC; 414687da132SEmmanuel Grumbach break; 415687da132SEmmanuel Grumbach default: 416687da132SEmmanuel Grumbach WARN_ON(1); 417687da132SEmmanuel Grumbach } 418687da132SEmmanuel Grumbach } 419af0ed69bSJohannes Berg 4206e0456b5SFelix Fietkau sta->sta.max_rc_amsdu_len = IEEE80211_MAX_MPDU_LEN_HT_BA; 4216e0456b5SFelix Fietkau 422bdcbd8e0SJohannes Berg sta_dbg(sdata, "Allocated STA %pM\n", sta->sta.addr); 423ef04a297SJohannes Berg 424abfbc3afSJohannes Berg return sta; 425ba8c3d6fSFelix Fietkau 426ba8c3d6fSFelix Fietkau free_txq: 427ba8c3d6fSFelix Fietkau if (sta->sta.txq[0]) 428ba8c3d6fSFelix Fietkau kfree(to_txq_info(sta->sta.txq[0])); 429ba8c3d6fSFelix Fietkau free: 430433f5bc1SJohannes Berg #ifdef CONFIG_MAC80211_MESH 431433f5bc1SJohannes Berg kfree(sta->mesh); 432433f5bc1SJohannes Berg #endif 433ba8c3d6fSFelix Fietkau kfree(sta); 434ba8c3d6fSFelix Fietkau return NULL; 43573651ee6SJohannes Berg } 43673651ee6SJohannes Berg 4378c71df7aSGuy Eilam static int sta_info_insert_check(struct sta_info *sta) 43834e89507SJohannes Berg { 43934e89507SJohannes Berg struct ieee80211_sub_if_data *sdata = sta->sdata; 44034e89507SJohannes Berg 44103e4497eSJohannes Berg /* 44203e4497eSJohannes Berg * Can't be a WARN_ON because it can be triggered through a race: 44303e4497eSJohannes Berg * something inserts a STA (on one CPU) without holding the RTNL 44403e4497eSJohannes Berg * and another CPU turns off the net device. 44503e4497eSJohannes Berg */ 4468c71df7aSGuy Eilam if (unlikely(!ieee80211_sdata_running(sdata))) 4478c71df7aSGuy Eilam return -ENETDOWN; 44803e4497eSJohannes Berg 449b203ca39SJoe Perches if (WARN_ON(ether_addr_equal(sta->sta.addr, sdata->vif.addr) || 4508c71df7aSGuy Eilam is_multicast_ether_addr(sta->sta.addr))) 4518c71df7aSGuy Eilam return -EINVAL; 4528c71df7aSGuy Eilam 45331104891SJohannes Berg /* Strictly speaking this isn't necessary as we hold the mutex, but 45431104891SJohannes Berg * the rhashtable code can't really deal with that distinction. We 45531104891SJohannes Berg * do require the mutex for correctness though. 45631104891SJohannes Berg */ 45731104891SJohannes Berg rcu_read_lock(); 45831104891SJohannes Berg lockdep_assert_held(&sdata->local->sta_mtx); 45931104891SJohannes Berg if (ieee80211_hw_check(&sdata->local->hw, NEEDS_UNIQUE_STA_ADDR) && 46031104891SJohannes Berg ieee80211_find_sta_by_ifaddr(&sdata->local->hw, sta->addr, NULL)) { 46131104891SJohannes Berg rcu_read_unlock(); 46231104891SJohannes Berg return -ENOTUNIQ; 46331104891SJohannes Berg } 46431104891SJohannes Berg rcu_read_unlock(); 46531104891SJohannes Berg 4668c71df7aSGuy Eilam return 0; 46793e5deb1SJohannes Berg } 46844213b5eSJohannes Berg 469f09603a2SJohannes Berg static int sta_info_insert_drv_state(struct ieee80211_local *local, 470f09603a2SJohannes Berg struct ieee80211_sub_if_data *sdata, 471f09603a2SJohannes Berg struct sta_info *sta) 472f09603a2SJohannes Berg { 473f09603a2SJohannes Berg enum ieee80211_sta_state state; 474f09603a2SJohannes Berg int err = 0; 475f09603a2SJohannes Berg 476f09603a2SJohannes Berg for (state = IEEE80211_STA_NOTEXIST; state < sta->sta_state; state++) { 477f09603a2SJohannes Berg err = drv_sta_state(local, sdata, sta, state, state + 1); 478f09603a2SJohannes Berg if (err) 479f09603a2SJohannes Berg break; 480f09603a2SJohannes Berg } 481f09603a2SJohannes Berg 482f09603a2SJohannes Berg if (!err) { 483a4ec45a4SJohannes Berg /* 484a4ec45a4SJohannes Berg * Drivers using legacy sta_add/sta_remove callbacks only 485a4ec45a4SJohannes Berg * get uploaded set to true after sta_add is called. 486a4ec45a4SJohannes Berg */ 487a4ec45a4SJohannes Berg if (!local->ops->sta_add) 488f09603a2SJohannes Berg sta->uploaded = true; 489f09603a2SJohannes Berg return 0; 490f09603a2SJohannes Berg } 491f09603a2SJohannes Berg 492f09603a2SJohannes Berg if (sdata->vif.type == NL80211_IFTYPE_ADHOC) { 493bdcbd8e0SJohannes Berg sdata_info(sdata, 494bdcbd8e0SJohannes Berg "failed to move IBSS STA %pM to state %d (%d) - keeping it anyway\n", 495bdcbd8e0SJohannes Berg sta->sta.addr, state + 1, err); 496f09603a2SJohannes Berg err = 0; 497f09603a2SJohannes Berg } 498f09603a2SJohannes Berg 499f09603a2SJohannes Berg /* unwind on error */ 500f09603a2SJohannes Berg for (; state > IEEE80211_STA_NOTEXIST; state--) 501f09603a2SJohannes Berg WARN_ON(drv_sta_state(local, sdata, sta, state, state - 1)); 502f09603a2SJohannes Berg 503f09603a2SJohannes Berg return err; 504f09603a2SJohannes Berg } 505f09603a2SJohannes Berg 50634e89507SJohannes Berg /* 5078c71df7aSGuy Eilam * should be called with sta_mtx locked 5088c71df7aSGuy Eilam * this function replaces the mutex lock 5098c71df7aSGuy Eilam * with a RCU lock 5108c71df7aSGuy Eilam */ 5114d33960bSJohannes Berg static int sta_info_insert_finish(struct sta_info *sta) __acquires(RCU) 5128c71df7aSGuy Eilam { 5138c71df7aSGuy Eilam struct ieee80211_local *local = sta->local; 5148c71df7aSGuy Eilam struct ieee80211_sub_if_data *sdata = sta->sdata; 5150ef049dcSArnd Bergmann struct station_info *sinfo; 5168c71df7aSGuy Eilam int err = 0; 5178c71df7aSGuy Eilam 5188c71df7aSGuy Eilam lockdep_assert_held(&local->sta_mtx); 5198c71df7aSGuy Eilam 5200ef049dcSArnd Bergmann sinfo = kzalloc(sizeof(struct station_info), GFP_KERNEL); 5210ef049dcSArnd Bergmann if (!sinfo) { 5220ef049dcSArnd Bergmann err = -ENOMEM; 5230ef049dcSArnd Bergmann goto out_err; 5240ef049dcSArnd Bergmann } 5250ef049dcSArnd Bergmann 5267852e361SJohannes Berg /* check if STA exists already */ 5277852e361SJohannes Berg if (sta_info_get_bss(sdata, sta->sta.addr)) { 5284d33960bSJohannes Berg err = -EEXIST; 5294d33960bSJohannes Berg goto out_err; 53034e89507SJohannes Berg } 53134e89507SJohannes Berg 5324d33960bSJohannes Berg local->num_sta++; 5334d33960bSJohannes Berg local->sta_generation++; 5344d33960bSJohannes Berg smp_mb(); 5354d33960bSJohannes Berg 5365108ca82SJohannes Berg /* simplify things and don't accept BA sessions yet */ 5375108ca82SJohannes Berg set_sta_flag(sta, WLAN_STA_BLOCK_BA); 5385108ca82SJohannes Berg 5394d33960bSJohannes Berg /* make the station visible */ 54062b14b24SJohannes Berg err = sta_info_hash_add(local, sta); 54162b14b24SJohannes Berg if (err) 54262b14b24SJohannes Berg goto out_drop_sta; 5434d33960bSJohannes Berg 5442bad7748SArik Nemtsov list_add_tail_rcu(&sta->list, &local->sta_list); 54583d5cc01SJohannes Berg 5465108ca82SJohannes Berg /* notify driver */ 5475108ca82SJohannes Berg err = sta_info_insert_drv_state(local, sdata, sta); 5485108ca82SJohannes Berg if (err) 5495108ca82SJohannes Berg goto out_remove; 5505108ca82SJohannes Berg 55183d5cc01SJohannes Berg set_sta_flag(sta, WLAN_STA_INSERTED); 5525108ca82SJohannes Berg /* accept BA sessions now */ 5535108ca82SJohannes Berg clear_sta_flag(sta, WLAN_STA_BLOCK_BA); 5544d33960bSJohannes Berg 5554d33960bSJohannes Berg ieee80211_sta_debugfs_add(sta); 5564d33960bSJohannes Berg rate_control_add_sta_debugfs(sta); 5574d33960bSJohannes Berg 5580ef049dcSArnd Bergmann sinfo->generation = local->sta_generation; 5590ef049dcSArnd Bergmann cfg80211_new_sta(sdata->dev, sta->sta.addr, sinfo, GFP_KERNEL); 5600ef049dcSArnd Bergmann kfree(sinfo); 561d0709a65SJohannes Berg 562bdcbd8e0SJohannes Berg sta_dbg(sdata, "Inserted STA %pM\n", sta->sta.addr); 563f0706e82SJiri Benc 56434e89507SJohannes Berg /* move reference to rcu-protected */ 56534e89507SJohannes Berg rcu_read_lock(); 56634e89507SJohannes Berg mutex_unlock(&local->sta_mtx); 567e9f207f0SJiri Benc 56873651ee6SJohannes Berg if (ieee80211_vif_is_mesh(&sdata->vif)) 56973651ee6SJohannes Berg mesh_accept_plinks_update(sdata); 57073651ee6SJohannes Berg 57173651ee6SJohannes Berg return 0; 5725108ca82SJohannes Berg out_remove: 5735108ca82SJohannes Berg sta_info_hash_del(local, sta); 5745108ca82SJohannes Berg list_del_rcu(&sta->list); 57562b14b24SJohannes Berg out_drop_sta: 5765108ca82SJohannes Berg local->num_sta--; 5775108ca82SJohannes Berg synchronize_net(); 5785108ca82SJohannes Berg __cleanup_single_sta(sta); 5794d33960bSJohannes Berg out_err: 5804d33960bSJohannes Berg mutex_unlock(&local->sta_mtx); 581ea32f065SSudip Mukherjee kfree(sinfo); 5824d33960bSJohannes Berg rcu_read_lock(); 5834d33960bSJohannes Berg return err; 5848c71df7aSGuy Eilam } 5858c71df7aSGuy Eilam 5868c71df7aSGuy Eilam int sta_info_insert_rcu(struct sta_info *sta) __acquires(RCU) 5878c71df7aSGuy Eilam { 5888c71df7aSGuy Eilam struct ieee80211_local *local = sta->local; 589308f7fcfSZhao, Gang int err; 5908c71df7aSGuy Eilam 5914d33960bSJohannes Berg might_sleep(); 5924d33960bSJohannes Berg 59331104891SJohannes Berg mutex_lock(&local->sta_mtx); 59431104891SJohannes Berg 5958c71df7aSGuy Eilam err = sta_info_insert_check(sta); 5968c71df7aSGuy Eilam if (err) { 59731104891SJohannes Berg mutex_unlock(&local->sta_mtx); 5988c71df7aSGuy Eilam rcu_read_lock(); 5998c71df7aSGuy Eilam goto out_free; 6008c71df7aSGuy Eilam } 6018c71df7aSGuy Eilam 6024d33960bSJohannes Berg err = sta_info_insert_finish(sta); 6038c71df7aSGuy Eilam if (err) 604004c872eSJohannes Berg goto out_free; 605d0709a65SJohannes Berg 606004c872eSJohannes Berg return 0; 60793e5deb1SJohannes Berg out_free: 608d9a7ddb0SJohannes Berg sta_info_free(local, sta); 60993e5deb1SJohannes Berg return err; 610f0706e82SJiri Benc } 611f0706e82SJiri Benc 61234e89507SJohannes Berg int sta_info_insert(struct sta_info *sta) 61334e89507SJohannes Berg { 61434e89507SJohannes Berg int err = sta_info_insert_rcu(sta); 61534e89507SJohannes Berg 61634e89507SJohannes Berg rcu_read_unlock(); 61734e89507SJohannes Berg 61834e89507SJohannes Berg return err; 61934e89507SJohannes Berg } 62034e89507SJohannes Berg 621d012a605SMarco Porsch static inline void __bss_tim_set(u8 *tim, u16 id) 622004c872eSJohannes Berg { 623004c872eSJohannes Berg /* 624004c872eSJohannes Berg * This format has been mandated by the IEEE specifications, 625004c872eSJohannes Berg * so this line may not be changed to use the __set_bit() format. 626004c872eSJohannes Berg */ 627d012a605SMarco Porsch tim[id / 8] |= (1 << (id % 8)); 628004c872eSJohannes Berg } 629004c872eSJohannes Berg 630d012a605SMarco Porsch static inline void __bss_tim_clear(u8 *tim, u16 id) 631004c872eSJohannes Berg { 632004c872eSJohannes Berg /* 633004c872eSJohannes Berg * This format has been mandated by the IEEE specifications, 634004c872eSJohannes Berg * so this line may not be changed to use the __clear_bit() format. 635004c872eSJohannes Berg */ 636d012a605SMarco Porsch tim[id / 8] &= ~(1 << (id % 8)); 637004c872eSJohannes Berg } 638004c872eSJohannes Berg 6393d5839b6SIlan Peer static inline bool __bss_tim_get(u8 *tim, u16 id) 6403d5839b6SIlan Peer { 6413d5839b6SIlan Peer /* 6423d5839b6SIlan Peer * This format has been mandated by the IEEE specifications, 6433d5839b6SIlan Peer * so this line may not be changed to use the test_bit() format. 6443d5839b6SIlan Peer */ 6453d5839b6SIlan Peer return tim[id / 8] & (1 << (id % 8)); 6463d5839b6SIlan Peer } 6473d5839b6SIlan Peer 648948d887dSJohannes Berg static unsigned long ieee80211_tids_for_ac(int ac) 649004c872eSJohannes Berg { 650948d887dSJohannes Berg /* If we ever support TIDs > 7, this obviously needs to be adjusted */ 651948d887dSJohannes Berg switch (ac) { 652948d887dSJohannes Berg case IEEE80211_AC_VO: 653948d887dSJohannes Berg return BIT(6) | BIT(7); 654948d887dSJohannes Berg case IEEE80211_AC_VI: 655948d887dSJohannes Berg return BIT(4) | BIT(5); 656948d887dSJohannes Berg case IEEE80211_AC_BE: 657948d887dSJohannes Berg return BIT(0) | BIT(3); 658948d887dSJohannes Berg case IEEE80211_AC_BK: 659948d887dSJohannes Berg return BIT(1) | BIT(2); 660948d887dSJohannes Berg default: 661948d887dSJohannes Berg WARN_ON(1); 662948d887dSJohannes Berg return 0; 663d0709a65SJohannes Berg } 664004c872eSJohannes Berg } 665004c872eSJohannes Berg 6669b7a86f3SJohannes Berg static void __sta_info_recalc_tim(struct sta_info *sta, bool ignore_pending) 667004c872eSJohannes Berg { 668c868cb35SJohannes Berg struct ieee80211_local *local = sta->local; 669d012a605SMarco Porsch struct ps_data *ps; 670948d887dSJohannes Berg bool indicate_tim = false; 671948d887dSJohannes Berg u8 ignore_for_tim = sta->sta.uapsd_queues; 672948d887dSJohannes Berg int ac; 673a69bd8e6SBob Copeland u16 id = sta->sta.aid; 674004c872eSJohannes Berg 675d012a605SMarco Porsch if (sta->sdata->vif.type == NL80211_IFTYPE_AP || 676d012a605SMarco Porsch sta->sdata->vif.type == NL80211_IFTYPE_AP_VLAN) { 677c868cb35SJohannes Berg if (WARN_ON_ONCE(!sta->sdata->bss)) 678c868cb35SJohannes Berg return; 6793e122be0SJohannes Berg 680d012a605SMarco Porsch ps = &sta->sdata->bss->ps; 6813f52b7e3SMarco Porsch #ifdef CONFIG_MAC80211_MESH 6823f52b7e3SMarco Porsch } else if (ieee80211_vif_is_mesh(&sta->sdata->vif)) { 6833f52b7e3SMarco Porsch ps = &sta->sdata->u.mesh.ps; 6843f52b7e3SMarco Porsch #endif 685d012a605SMarco Porsch } else { 686d012a605SMarco Porsch return; 687d012a605SMarco Porsch } 688d012a605SMarco Porsch 689c868cb35SJohannes Berg /* No need to do anything if the driver does all */ 69030686bf7SJohannes Berg if (ieee80211_hw_check(&local->hw, AP_LINK_PS)) 691c868cb35SJohannes Berg return; 692004c872eSJohannes Berg 693c868cb35SJohannes Berg if (sta->dead) 694c868cb35SJohannes Berg goto done; 6953e122be0SJohannes Berg 696948d887dSJohannes Berg /* 697948d887dSJohannes Berg * If all ACs are delivery-enabled then we should build 698948d887dSJohannes Berg * the TIM bit for all ACs anyway; if only some are then 699948d887dSJohannes Berg * we ignore those and build the TIM bit using only the 700948d887dSJohannes Berg * non-enabled ones. 701948d887dSJohannes Berg */ 702948d887dSJohannes Berg if (ignore_for_tim == BIT(IEEE80211_NUM_ACS) - 1) 703948d887dSJohannes Berg ignore_for_tim = 0; 704948d887dSJohannes Berg 7059b7a86f3SJohannes Berg if (ignore_pending) 7069b7a86f3SJohannes Berg ignore_for_tim = BIT(IEEE80211_NUM_ACS) - 1; 7079b7a86f3SJohannes Berg 708948d887dSJohannes Berg for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) { 709948d887dSJohannes Berg unsigned long tids; 710948d887dSJohannes Berg 711948d887dSJohannes Berg if (ignore_for_tim & BIT(ac)) 712948d887dSJohannes Berg continue; 713948d887dSJohannes Berg 714948d887dSJohannes Berg indicate_tim |= !skb_queue_empty(&sta->tx_filtered[ac]) || 715948d887dSJohannes Berg !skb_queue_empty(&sta->ps_tx_buf[ac]); 716948d887dSJohannes Berg if (indicate_tim) 717948d887dSJohannes Berg break; 718948d887dSJohannes Berg 719948d887dSJohannes Berg tids = ieee80211_tids_for_ac(ac); 720948d887dSJohannes Berg 721948d887dSJohannes Berg indicate_tim |= 722948d887dSJohannes Berg sta->driver_buffered_tids & tids; 723ba8c3d6fSFelix Fietkau indicate_tim |= 724ba8c3d6fSFelix Fietkau sta->txq_buffered_tids & tids; 725004c872eSJohannes Berg } 726004c872eSJohannes Berg 727c868cb35SJohannes Berg done: 72865f704a5SJohannes Berg spin_lock_bh(&local->tim_lock); 729004c872eSJohannes Berg 7303d5839b6SIlan Peer if (indicate_tim == __bss_tim_get(ps->tim, id)) 7313d5839b6SIlan Peer goto out_unlock; 7323d5839b6SIlan Peer 733948d887dSJohannes Berg if (indicate_tim) 734d012a605SMarco Porsch __bss_tim_set(ps->tim, id); 735c868cb35SJohannes Berg else 736d012a605SMarco Porsch __bss_tim_clear(ps->tim, id); 7373e122be0SJohannes Berg 7389b7a86f3SJohannes Berg if (local->ops->set_tim && !WARN_ON(sta->dead)) { 739c868cb35SJohannes Berg local->tim_in_locked_section = true; 740948d887dSJohannes Berg drv_set_tim(local, &sta->sta, indicate_tim); 741c868cb35SJohannes Berg local->tim_in_locked_section = false; 742004c872eSJohannes Berg } 743004c872eSJohannes Berg 7443d5839b6SIlan Peer out_unlock: 74565f704a5SJohannes Berg spin_unlock_bh(&local->tim_lock); 746004c872eSJohannes Berg } 747004c872eSJohannes Berg 7489b7a86f3SJohannes Berg void sta_info_recalc_tim(struct sta_info *sta) 7499b7a86f3SJohannes Berg { 7509b7a86f3SJohannes Berg __sta_info_recalc_tim(sta, false); 7519b7a86f3SJohannes Berg } 7529b7a86f3SJohannes Berg 753cd0b8d89SJohannes Berg static bool sta_info_buffer_expired(struct sta_info *sta, struct sk_buff *skb) 754f0706e82SJiri Benc { 755e039fa4aSJohannes Berg struct ieee80211_tx_info *info; 756f0706e82SJiri Benc int timeout; 757f0706e82SJiri Benc 758f0706e82SJiri Benc if (!skb) 759cd0b8d89SJohannes Berg return false; 760f0706e82SJiri Benc 761e039fa4aSJohannes Berg info = IEEE80211_SKB_CB(skb); 762f0706e82SJiri Benc 763f0706e82SJiri Benc /* Timeout: (2 * listen_interval * beacon_int * 1024 / 1000000) sec */ 76457c4d7b4SJohannes Berg timeout = (sta->listen_interval * 76557c4d7b4SJohannes Berg sta->sdata->vif.bss_conf.beacon_int * 76657c4d7b4SJohannes Berg 32 / 15625) * HZ; 767f0706e82SJiri Benc if (timeout < STA_TX_BUFFER_EXPIRE) 768f0706e82SJiri Benc timeout = STA_TX_BUFFER_EXPIRE; 769e039fa4aSJohannes Berg return time_after(jiffies, info->control.jiffies + timeout); 770f0706e82SJiri Benc } 771f0706e82SJiri Benc 772f0706e82SJiri Benc 773948d887dSJohannes Berg static bool sta_info_cleanup_expire_buffered_ac(struct ieee80211_local *local, 774948d887dSJohannes Berg struct sta_info *sta, int ac) 775f0706e82SJiri Benc { 776f0706e82SJiri Benc unsigned long flags; 777f0706e82SJiri Benc struct sk_buff *skb; 778f0706e82SJiri Benc 77960750397SJohannes Berg /* 78060750397SJohannes Berg * First check for frames that should expire on the filtered 78160750397SJohannes Berg * queue. Frames here were rejected by the driver and are on 78260750397SJohannes Berg * a separate queue to avoid reordering with normal PS-buffered 78360750397SJohannes Berg * frames. They also aren't accounted for right now in the 78460750397SJohannes Berg * total_ps_buffered counter. 78560750397SJohannes Berg */ 786f0706e82SJiri Benc for (;;) { 787948d887dSJohannes Berg spin_lock_irqsave(&sta->tx_filtered[ac].lock, flags); 788948d887dSJohannes Berg skb = skb_peek(&sta->tx_filtered[ac]); 78957c4d7b4SJohannes Berg if (sta_info_buffer_expired(sta, skb)) 790948d887dSJohannes Berg skb = __skb_dequeue(&sta->tx_filtered[ac]); 791836341a7SJohannes Berg else 792f0706e82SJiri Benc skb = NULL; 793948d887dSJohannes Berg spin_unlock_irqrestore(&sta->tx_filtered[ac].lock, flags); 794f0706e82SJiri Benc 79560750397SJohannes Berg /* 79660750397SJohannes Berg * Frames are queued in order, so if this one 79760750397SJohannes Berg * hasn't expired yet we can stop testing. If 79860750397SJohannes Berg * we actually reached the end of the queue we 79960750397SJohannes Berg * also need to stop, of course. 80060750397SJohannes Berg */ 80160750397SJohannes Berg if (!skb) 80260750397SJohannes Berg break; 803d4fa14cdSFelix Fietkau ieee80211_free_txskb(&local->hw, skb); 80460750397SJohannes Berg } 80560750397SJohannes Berg 80660750397SJohannes Berg /* 80760750397SJohannes Berg * Now also check the normal PS-buffered queue, this will 80860750397SJohannes Berg * only find something if the filtered queue was emptied 80960750397SJohannes Berg * since the filtered frames are all before the normal PS 81060750397SJohannes Berg * buffered frames. 81160750397SJohannes Berg */ 812f0706e82SJiri Benc for (;;) { 813948d887dSJohannes Berg spin_lock_irqsave(&sta->ps_tx_buf[ac].lock, flags); 814948d887dSJohannes Berg skb = skb_peek(&sta->ps_tx_buf[ac]); 815f0706e82SJiri Benc if (sta_info_buffer_expired(sta, skb)) 816948d887dSJohannes Berg skb = __skb_dequeue(&sta->ps_tx_buf[ac]); 817f0706e82SJiri Benc else 818f0706e82SJiri Benc skb = NULL; 819948d887dSJohannes Berg spin_unlock_irqrestore(&sta->ps_tx_buf[ac].lock, flags); 820f0706e82SJiri Benc 82160750397SJohannes Berg /* 82260750397SJohannes Berg * frames are queued in order, so if this one 82360750397SJohannes Berg * hasn't expired yet (or we reached the end of 82460750397SJohannes Berg * the queue) we can stop testing 82560750397SJohannes Berg */ 826836341a7SJohannes Berg if (!skb) 827836341a7SJohannes Berg break; 828836341a7SJohannes Berg 829f0706e82SJiri Benc local->total_ps_buffered--; 830bdcbd8e0SJohannes Berg ps_dbg(sta->sdata, "Buffered frame expired (STA %pM)\n", 831bdcbd8e0SJohannes Berg sta->sta.addr); 832d4fa14cdSFelix Fietkau ieee80211_free_txskb(&local->hw, skb); 833f0706e82SJiri Benc } 8343393a608SJuuso Oikarinen 83560750397SJohannes Berg /* 83660750397SJohannes Berg * Finally, recalculate the TIM bit for this station -- it might 83760750397SJohannes Berg * now be clear because the station was too slow to retrieve its 83860750397SJohannes Berg * frames. 83960750397SJohannes Berg */ 84060750397SJohannes Berg sta_info_recalc_tim(sta); 84160750397SJohannes Berg 84260750397SJohannes Berg /* 84360750397SJohannes Berg * Return whether there are any frames still buffered, this is 84460750397SJohannes Berg * used to check whether the cleanup timer still needs to run, 84560750397SJohannes Berg * if there are no frames we don't need to rearm the timer. 84660750397SJohannes Berg */ 847948d887dSJohannes Berg return !(skb_queue_empty(&sta->ps_tx_buf[ac]) && 848948d887dSJohannes Berg skb_queue_empty(&sta->tx_filtered[ac])); 849948d887dSJohannes Berg } 850948d887dSJohannes Berg 851948d887dSJohannes Berg static bool sta_info_cleanup_expire_buffered(struct ieee80211_local *local, 852948d887dSJohannes Berg struct sta_info *sta) 853948d887dSJohannes Berg { 854948d887dSJohannes Berg bool have_buffered = false; 855948d887dSJohannes Berg int ac; 856948d887dSJohannes Berg 8573f52b7e3SMarco Porsch /* This is only necessary for stations on BSS/MBSS interfaces */ 8583f52b7e3SMarco Porsch if (!sta->sdata->bss && 8593f52b7e3SMarco Porsch !ieee80211_vif_is_mesh(&sta->sdata->vif)) 860948d887dSJohannes Berg return false; 861948d887dSJohannes Berg 862948d887dSJohannes Berg for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) 863948d887dSJohannes Berg have_buffered |= 864948d887dSJohannes Berg sta_info_cleanup_expire_buffered_ac(local, sta, ac); 865948d887dSJohannes Berg 866948d887dSJohannes Berg return have_buffered; 867f0706e82SJiri Benc } 868f0706e82SJiri Benc 869d778207bSJohannes Berg static int __must_check __sta_info_destroy_part1(struct sta_info *sta) 87034e89507SJohannes Berg { 87134e89507SJohannes Berg struct ieee80211_local *local; 87234e89507SJohannes Berg struct ieee80211_sub_if_data *sdata; 8736d10e46bSJohannes Berg int ret; 87434e89507SJohannes Berg 87534e89507SJohannes Berg might_sleep(); 87634e89507SJohannes Berg 87734e89507SJohannes Berg if (!sta) 87834e89507SJohannes Berg return -ENOENT; 87934e89507SJohannes Berg 88034e89507SJohannes Berg local = sta->local; 88134e89507SJohannes Berg sdata = sta->sdata; 88234e89507SJohannes Berg 88383d5cc01SJohannes Berg lockdep_assert_held(&local->sta_mtx); 88483d5cc01SJohannes Berg 885098a6070SJohannes Berg /* 886098a6070SJohannes Berg * Before removing the station from the driver and 887098a6070SJohannes Berg * rate control, it might still start new aggregation 888098a6070SJohannes Berg * sessions -- block that to make sure the tear-down 889098a6070SJohannes Berg * will be sufficient. 890098a6070SJohannes Berg */ 891c2c98fdeSJohannes Berg set_sta_flag(sta, WLAN_STA_BLOCK_BA); 892c82c4a80SJohannes Berg ieee80211_sta_tear_down_BA_sessions(sta, AGG_STOP_DESTROY_STA); 893098a6070SJohannes Berg 894f59374ebSSara Sharon /* 895f59374ebSSara Sharon * Before removing the station from the driver there might be pending 896f59374ebSSara Sharon * rx frames on RSS queues sent prior to the disassociation - wait for 897f59374ebSSara Sharon * all such frames to be processed. 898f59374ebSSara Sharon */ 899f59374ebSSara Sharon drv_sync_rx_queues(local, sta); 900f59374ebSSara Sharon 90134e89507SJohannes Berg ret = sta_info_hash_del(local, sta); 902b01711beSJohannes Berg if (WARN_ON(ret)) 90334e89507SJohannes Berg return ret; 90434e89507SJohannes Berg 905a7a6bdd0SArik Nemtsov /* 906a7a6bdd0SArik Nemtsov * for TDLS peers, make sure to return to the base channel before 907a7a6bdd0SArik Nemtsov * removal. 908a7a6bdd0SArik Nemtsov */ 909a7a6bdd0SArik Nemtsov if (test_sta_flag(sta, WLAN_STA_TDLS_OFF_CHANNEL)) { 910a7a6bdd0SArik Nemtsov drv_tdls_cancel_channel_switch(local, sdata, &sta->sta); 911a7a6bdd0SArik Nemtsov clear_sta_flag(sta, WLAN_STA_TDLS_OFF_CHANNEL); 912a7a6bdd0SArik Nemtsov } 913a7a6bdd0SArik Nemtsov 914794454ceSArik Nemtsov list_del_rcu(&sta->list); 915ef044763SEliad Peller sta->removed = true; 9164d33960bSJohannes Berg 9176a9d1b91SJohannes Berg drv_sta_pre_rcu_remove(local, sta->sdata, sta); 9186a9d1b91SJohannes Berg 919a710c816SJohannes Berg if (sdata->vif.type == NL80211_IFTYPE_AP_VLAN && 920a710c816SJohannes Berg rcu_access_pointer(sdata->u.vlan.sta) == sta) 921a710c816SJohannes Berg RCU_INIT_POINTER(sdata->u.vlan.sta, NULL); 922a710c816SJohannes Berg 923d778207bSJohannes Berg return 0; 924d778207bSJohannes Berg } 925d778207bSJohannes Berg 926d778207bSJohannes Berg static void __sta_info_destroy_part2(struct sta_info *sta) 927d778207bSJohannes Berg { 928d778207bSJohannes Berg struct ieee80211_local *local = sta->local; 929d778207bSJohannes Berg struct ieee80211_sub_if_data *sdata = sta->sdata; 9300ef049dcSArnd Bergmann struct station_info *sinfo; 931d778207bSJohannes Berg int ret; 932d778207bSJohannes Berg 933d778207bSJohannes Berg /* 934d778207bSJohannes Berg * NOTE: This assumes at least synchronize_net() was done 935d778207bSJohannes Berg * after _part1 and before _part2! 936d778207bSJohannes Berg */ 937d778207bSJohannes Berg 938d778207bSJohannes Berg might_sleep(); 939d778207bSJohannes Berg lockdep_assert_held(&local->sta_mtx); 940d778207bSJohannes Berg 941c8782078SJohannes Berg /* now keys can no longer be reached */ 9426d10e46bSJohannes Berg ieee80211_free_sta_keys(local, sta); 94334e89507SJohannes Berg 9449b7a86f3SJohannes Berg /* disable TIM bit - last chance to tell driver */ 9459b7a86f3SJohannes Berg __sta_info_recalc_tim(sta, true); 9469b7a86f3SJohannes Berg 94734e89507SJohannes Berg sta->dead = true; 94834e89507SJohannes Berg 94934e89507SJohannes Berg local->num_sta--; 95034e89507SJohannes Berg local->sta_generation++; 95134e89507SJohannes Berg 95283d5cc01SJohannes Berg while (sta->sta_state > IEEE80211_STA_NONE) { 953f09603a2SJohannes Berg ret = sta_info_move_state(sta, sta->sta_state - 1); 954f09603a2SJohannes Berg if (ret) { 95583d5cc01SJohannes Berg WARN_ON_ONCE(1); 95683d5cc01SJohannes Berg break; 95783d5cc01SJohannes Berg } 95883d5cc01SJohannes Berg } 959d9a7ddb0SJohannes Berg 960f09603a2SJohannes Berg if (sta->uploaded) { 961f09603a2SJohannes Berg ret = drv_sta_state(local, sdata, sta, IEEE80211_STA_NONE, 962f09603a2SJohannes Berg IEEE80211_STA_NOTEXIST); 963f09603a2SJohannes Berg WARN_ON_ONCE(ret != 0); 964f09603a2SJohannes Berg } 96534e89507SJohannes Berg 966bdcbd8e0SJohannes Berg sta_dbg(sdata, "Removed STA %pM\n", sta->sta.addr); 967bdcbd8e0SJohannes Berg 9680ef049dcSArnd Bergmann sinfo = kzalloc(sizeof(*sinfo), GFP_KERNEL); 9690ef049dcSArnd Bergmann if (sinfo) 9700ef049dcSArnd Bergmann sta_set_sinfo(sta, sinfo); 9710ef049dcSArnd Bergmann cfg80211_del_sta_sinfo(sdata->dev, sta->sta.addr, sinfo, GFP_KERNEL); 9720ef049dcSArnd Bergmann kfree(sinfo); 973ec15e68bSJouni Malinen 97434e89507SJohannes Berg rate_control_remove_sta_debugfs(sta); 97534e89507SJohannes Berg ieee80211_sta_debugfs_remove(sta); 97634e89507SJohannes Berg 977d34ba216SJohannes Berg cleanup_single_sta(sta); 978d778207bSJohannes Berg } 979d778207bSJohannes Berg 980d778207bSJohannes Berg int __must_check __sta_info_destroy(struct sta_info *sta) 981d778207bSJohannes Berg { 982d778207bSJohannes Berg int err = __sta_info_destroy_part1(sta); 983d778207bSJohannes Berg 984d778207bSJohannes Berg if (err) 985d778207bSJohannes Berg return err; 986d778207bSJohannes Berg 987d778207bSJohannes Berg synchronize_net(); 988d778207bSJohannes Berg 989d778207bSJohannes Berg __sta_info_destroy_part2(sta); 99034e89507SJohannes Berg 99134e89507SJohannes Berg return 0; 99234e89507SJohannes Berg } 99334e89507SJohannes Berg 99434e89507SJohannes Berg int sta_info_destroy_addr(struct ieee80211_sub_if_data *sdata, const u8 *addr) 99534e89507SJohannes Berg { 99634e89507SJohannes Berg struct sta_info *sta; 99734e89507SJohannes Berg int ret; 99834e89507SJohannes Berg 99934e89507SJohannes Berg mutex_lock(&sdata->local->sta_mtx); 10007852e361SJohannes Berg sta = sta_info_get(sdata, addr); 100134e89507SJohannes Berg ret = __sta_info_destroy(sta); 100234e89507SJohannes Berg mutex_unlock(&sdata->local->sta_mtx); 100334e89507SJohannes Berg 100434e89507SJohannes Berg return ret; 100534e89507SJohannes Berg } 100634e89507SJohannes Berg 100734e89507SJohannes Berg int sta_info_destroy_addr_bss(struct ieee80211_sub_if_data *sdata, 100834e89507SJohannes Berg const u8 *addr) 100934e89507SJohannes Berg { 101034e89507SJohannes Berg struct sta_info *sta; 101134e89507SJohannes Berg int ret; 101234e89507SJohannes Berg 101334e89507SJohannes Berg mutex_lock(&sdata->local->sta_mtx); 10147852e361SJohannes Berg sta = sta_info_get_bss(sdata, addr); 101534e89507SJohannes Berg ret = __sta_info_destroy(sta); 101634e89507SJohannes Berg mutex_unlock(&sdata->local->sta_mtx); 101734e89507SJohannes Berg 101834e89507SJohannes Berg return ret; 101934e89507SJohannes Berg } 1020f0706e82SJiri Benc 1021f0706e82SJiri Benc static void sta_info_cleanup(unsigned long data) 1022f0706e82SJiri Benc { 1023f0706e82SJiri Benc struct ieee80211_local *local = (struct ieee80211_local *) data; 1024f0706e82SJiri Benc struct sta_info *sta; 10253393a608SJuuso Oikarinen bool timer_needed = false; 1026f0706e82SJiri Benc 1027d0709a65SJohannes Berg rcu_read_lock(); 1028d0709a65SJohannes Berg list_for_each_entry_rcu(sta, &local->sta_list, list) 10293393a608SJuuso Oikarinen if (sta_info_cleanup_expire_buffered(local, sta)) 10303393a608SJuuso Oikarinen timer_needed = true; 1031d0709a65SJohannes Berg rcu_read_unlock(); 1032f0706e82SJiri Benc 10335bb644a0SJohannes Berg if (local->quiescing) 10345bb644a0SJohannes Berg return; 10355bb644a0SJohannes Berg 10363393a608SJuuso Oikarinen if (!timer_needed) 10373393a608SJuuso Oikarinen return; 10383393a608SJuuso Oikarinen 103926d59535SJohannes Berg mod_timer(&local->sta_cleanup, 104026d59535SJohannes Berg round_jiffies(jiffies + STA_INFO_CLEANUP_INTERVAL)); 1041f0706e82SJiri Benc } 1042f0706e82SJiri Benc 10437bedd0cfSJohannes Berg u32 sta_addr_hash(const void *key, u32 length, u32 seed) 1044f0706e82SJiri Benc { 10457bedd0cfSJohannes Berg return jhash(key, ETH_ALEN, seed); 10467bedd0cfSJohannes Berg } 10477bedd0cfSJohannes Berg 10487bedd0cfSJohannes Berg int sta_info_init(struct ieee80211_local *local) 10497bedd0cfSJohannes Berg { 10507bedd0cfSJohannes Berg int err; 10517bedd0cfSJohannes Berg 10527bedd0cfSJohannes Berg err = rhashtable_init(&local->sta_hash, &sta_rht_params); 10537bedd0cfSJohannes Berg if (err) 10547bedd0cfSJohannes Berg return err; 10557bedd0cfSJohannes Berg 10564d33960bSJohannes Berg spin_lock_init(&local->tim_lock); 105734e89507SJohannes Berg mutex_init(&local->sta_mtx); 1058f0706e82SJiri Benc INIT_LIST_HEAD(&local->sta_list); 1059f0706e82SJiri Benc 1060b24b8a24SPavel Emelyanov setup_timer(&local->sta_cleanup, sta_info_cleanup, 1061b24b8a24SPavel Emelyanov (unsigned long)local); 10627bedd0cfSJohannes Berg return 0; 1063f0706e82SJiri Benc } 1064f0706e82SJiri Benc 1065f0706e82SJiri Benc void sta_info_stop(struct ieee80211_local *local) 1066f0706e82SJiri Benc { 1067a56f992cSJohannes Berg del_timer_sync(&local->sta_cleanup); 10687bedd0cfSJohannes Berg rhashtable_destroy(&local->sta_hash); 1069f0706e82SJiri Benc } 1070f0706e82SJiri Benc 1071051007d9SJohannes Berg 1072e716251dSJohannes Berg int __sta_info_flush(struct ieee80211_sub_if_data *sdata, bool vlans) 1073f0706e82SJiri Benc { 1074b998e8bbSJohannes Berg struct ieee80211_local *local = sdata->local; 1075f0706e82SJiri Benc struct sta_info *sta, *tmp; 1076d778207bSJohannes Berg LIST_HEAD(free_list); 107744213b5eSJohannes Berg int ret = 0; 1078f0706e82SJiri Benc 1079d0709a65SJohannes Berg might_sleep(); 1080d0709a65SJohannes Berg 1081e716251dSJohannes Berg WARN_ON(vlans && sdata->vif.type != NL80211_IFTYPE_AP); 1082e716251dSJohannes Berg WARN_ON(vlans && !sdata->bss); 1083e716251dSJohannes Berg 108434e89507SJohannes Berg mutex_lock(&local->sta_mtx); 108534e89507SJohannes Berg list_for_each_entry_safe(sta, tmp, &local->sta_list, list) { 1086e716251dSJohannes Berg if (sdata == sta->sdata || 1087e716251dSJohannes Berg (vlans && sdata->bss == sta->sdata->bss)) { 1088d778207bSJohannes Berg if (!WARN_ON(__sta_info_destroy_part1(sta))) 1089d778207bSJohannes Berg list_add(&sta->free_list, &free_list); 109034316837SJohannes Berg ret++; 109134316837SJohannes Berg } 109234e89507SJohannes Berg } 1093d778207bSJohannes Berg 1094d778207bSJohannes Berg if (!list_empty(&free_list)) { 1095d778207bSJohannes Berg synchronize_net(); 1096d778207bSJohannes Berg list_for_each_entry_safe(sta, tmp, &free_list, free_list) 1097d778207bSJohannes Berg __sta_info_destroy_part2(sta); 1098d778207bSJohannes Berg } 109934e89507SJohannes Berg mutex_unlock(&local->sta_mtx); 110044213b5eSJohannes Berg 1101051007d9SJohannes Berg return ret; 1102051007d9SJohannes Berg } 1103051007d9SJohannes Berg 110424723d1bSJohannes Berg void ieee80211_sta_expire(struct ieee80211_sub_if_data *sdata, 110524723d1bSJohannes Berg unsigned long exp_time) 110624723d1bSJohannes Berg { 110724723d1bSJohannes Berg struct ieee80211_local *local = sdata->local; 110824723d1bSJohannes Berg struct sta_info *sta, *tmp; 110924723d1bSJohannes Berg 111034e89507SJohannes Berg mutex_lock(&local->sta_mtx); 1111e46a2cf9SMohammed Shafi Shajakhan 1112e46a2cf9SMohammed Shafi Shajakhan list_for_each_entry_safe(sta, tmp, &local->sta_list, list) { 1113b8da6b6aSJohannes Berg unsigned long last_active = ieee80211_sta_last_active(sta); 1114b8da6b6aSJohannes Berg 1115ec2b774eSMarek Lindner if (sdata != sta->sdata) 1116ec2b774eSMarek Lindner continue; 1117ec2b774eSMarek Lindner 1118b8da6b6aSJohannes Berg if (time_is_before_jiffies(last_active + exp_time)) { 1119eea57d42SMohammed Shafi Shajakhan sta_dbg(sta->sdata, "expiring inactive STA %pM\n", 1120bdcbd8e0SJohannes Berg sta->sta.addr); 11213f52b7e3SMarco Porsch 11223f52b7e3SMarco Porsch if (ieee80211_vif_is_mesh(&sdata->vif) && 11233f52b7e3SMarco Porsch test_sta_flag(sta, WLAN_STA_PS_STA)) 11243f52b7e3SMarco Porsch atomic_dec(&sdata->u.mesh.ps.num_sta_ps); 11253f52b7e3SMarco Porsch 112634e89507SJohannes Berg WARN_ON(__sta_info_destroy(sta)); 112724723d1bSJohannes Berg } 1128e46a2cf9SMohammed Shafi Shajakhan } 1129e46a2cf9SMohammed Shafi Shajakhan 113034e89507SJohannes Berg mutex_unlock(&local->sta_mtx); 113124723d1bSJohannes Berg } 113217741cdcSJohannes Berg 1133686b9cb9SBen Greear struct ieee80211_sta *ieee80211_find_sta_by_ifaddr(struct ieee80211_hw *hw, 1134686b9cb9SBen Greear const u8 *addr, 1135686b9cb9SBen Greear const u8 *localaddr) 113617741cdcSJohannes Berg { 11377bedd0cfSJohannes Berg struct ieee80211_local *local = hw_to_local(hw); 11387bedd0cfSJohannes Berg struct sta_info *sta; 11397bedd0cfSJohannes Berg struct rhash_head *tmp; 11407bedd0cfSJohannes Berg const struct bucket_table *tbl; 11417bedd0cfSJohannes Berg 11427bedd0cfSJohannes Berg tbl = rht_dereference_rcu(local->sta_hash.tbl, &local->sta_hash); 114317741cdcSJohannes Berg 1144686b9cb9SBen Greear /* 1145686b9cb9SBen Greear * Just return a random station if localaddr is NULL 1146686b9cb9SBen Greear * ... first in list. 1147686b9cb9SBen Greear */ 11487bedd0cfSJohannes Berg for_each_sta_info(local, tbl, addr, sta, tmp) { 1149686b9cb9SBen Greear if (localaddr && 1150b203ca39SJoe Perches !ether_addr_equal(sta->sdata->vif.addr, localaddr)) 1151686b9cb9SBen Greear continue; 1152f7c65594SJohannes Berg if (!sta->uploaded) 1153f7c65594SJohannes Berg return NULL; 115417741cdcSJohannes Berg return &sta->sta; 1155f7c65594SJohannes Berg } 1156f7c65594SJohannes Berg 1157abe60632SJohannes Berg return NULL; 115817741cdcSJohannes Berg } 1159686b9cb9SBen Greear EXPORT_SYMBOL_GPL(ieee80211_find_sta_by_ifaddr); 11605ed176e1SJohannes Berg 11615ed176e1SJohannes Berg struct ieee80211_sta *ieee80211_find_sta(struct ieee80211_vif *vif, 11625ed176e1SJohannes Berg const u8 *addr) 11635ed176e1SJohannes Berg { 1164f7c65594SJohannes Berg struct sta_info *sta; 11655ed176e1SJohannes Berg 11665ed176e1SJohannes Berg if (!vif) 11675ed176e1SJohannes Berg return NULL; 11685ed176e1SJohannes Berg 1169f7c65594SJohannes Berg sta = sta_info_get_bss(vif_to_sdata(vif), addr); 1170f7c65594SJohannes Berg if (!sta) 1171f7c65594SJohannes Berg return NULL; 11725ed176e1SJohannes Berg 1173f7c65594SJohannes Berg if (!sta->uploaded) 1174f7c65594SJohannes Berg return NULL; 1175f7c65594SJohannes Berg 1176f7c65594SJohannes Berg return &sta->sta; 11775ed176e1SJohannes Berg } 117817741cdcSJohannes Berg EXPORT_SYMBOL(ieee80211_find_sta); 1179af818581SJohannes Berg 1180e3685e03SJohannes Berg /* powersave support code */ 1181e3685e03SJohannes Berg void ieee80211_sta_ps_deliver_wakeup(struct sta_info *sta) 118250a9432dSJohannes Berg { 1183608383bfSHelmut Schaa struct ieee80211_sub_if_data *sdata = sta->sdata; 1184e3685e03SJohannes Berg struct ieee80211_local *local = sdata->local; 1185e3685e03SJohannes Berg struct sk_buff_head pending; 1186ba8c3d6fSFelix Fietkau int filtered = 0, buffered = 0, ac, i; 1187e3685e03SJohannes Berg unsigned long flags; 1188d012a605SMarco Porsch struct ps_data *ps; 1189d012a605SMarco Porsch 11903918edb0SFelix Fietkau if (sdata->vif.type == NL80211_IFTYPE_AP_VLAN) 11913918edb0SFelix Fietkau sdata = container_of(sdata->bss, struct ieee80211_sub_if_data, 11923918edb0SFelix Fietkau u.ap); 11933918edb0SFelix Fietkau 11943918edb0SFelix Fietkau if (sdata->vif.type == NL80211_IFTYPE_AP) 1195d012a605SMarco Porsch ps = &sdata->bss->ps; 11963f52b7e3SMarco Porsch else if (ieee80211_vif_is_mesh(&sdata->vif)) 11973f52b7e3SMarco Porsch ps = &sdata->u.mesh.ps; 1198d012a605SMarco Porsch else 1199d012a605SMarco Porsch return; 120050a9432dSJohannes Berg 1201c2c98fdeSJohannes Berg clear_sta_flag(sta, WLAN_STA_SP); 120247086fc5SJohannes Berg 12035a306f58SJohannes Berg BUILD_BUG_ON(BITS_TO_LONGS(IEEE80211_NUM_TIDS) > 1); 1204948d887dSJohannes Berg sta->driver_buffered_tids = 0; 1205ba8c3d6fSFelix Fietkau sta->txq_buffered_tids = 0; 1206948d887dSJohannes Berg 120730686bf7SJohannes Berg if (!ieee80211_hw_check(&local->hw, AP_LINK_PS)) 120812375ef9SJohannes Berg drv_sta_notify(local, sdata, STA_NOTIFY_AWAKE, &sta->sta); 1209af818581SJohannes Berg 1210ba8c3d6fSFelix Fietkau if (sta->sta.txq[0]) { 1211ba8c3d6fSFelix Fietkau for (i = 0; i < ARRAY_SIZE(sta->sta.txq); i++) { 1212ba8c3d6fSFelix Fietkau struct txq_info *txqi = to_txq_info(sta->sta.txq[i]); 1213ba8c3d6fSFelix Fietkau 1214*fa962b92SMichal Kazior if (!txqi->tin.backlog_packets) 1215ba8c3d6fSFelix Fietkau continue; 1216ba8c3d6fSFelix Fietkau 1217ba8c3d6fSFelix Fietkau drv_wake_tx_queue(local, txqi); 1218ba8c3d6fSFelix Fietkau } 1219ba8c3d6fSFelix Fietkau } 1220ba8c3d6fSFelix Fietkau 1221948d887dSJohannes Berg skb_queue_head_init(&pending); 1222af818581SJohannes Berg 12231d147bfaSEmmanuel Grumbach /* sync with ieee80211_tx_h_unicast_ps_buf */ 12241d147bfaSEmmanuel Grumbach spin_lock(&sta->ps_lock); 1225af818581SJohannes Berg /* Send all buffered frames to the station */ 1226948d887dSJohannes Berg for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) { 1227948d887dSJohannes Berg int count = skb_queue_len(&pending), tmp; 1228948d887dSJohannes Berg 1229987c285cSArik Nemtsov spin_lock_irqsave(&sta->tx_filtered[ac].lock, flags); 1230948d887dSJohannes Berg skb_queue_splice_tail_init(&sta->tx_filtered[ac], &pending); 1231987c285cSArik Nemtsov spin_unlock_irqrestore(&sta->tx_filtered[ac].lock, flags); 1232948d887dSJohannes Berg tmp = skb_queue_len(&pending); 1233948d887dSJohannes Berg filtered += tmp - count; 1234948d887dSJohannes Berg count = tmp; 1235948d887dSJohannes Berg 1236987c285cSArik Nemtsov spin_lock_irqsave(&sta->ps_tx_buf[ac].lock, flags); 1237948d887dSJohannes Berg skb_queue_splice_tail_init(&sta->ps_tx_buf[ac], &pending); 1238987c285cSArik Nemtsov spin_unlock_irqrestore(&sta->ps_tx_buf[ac].lock, flags); 1239948d887dSJohannes Berg tmp = skb_queue_len(&pending); 1240948d887dSJohannes Berg buffered += tmp - count; 1241948d887dSJohannes Berg } 1242948d887dSJohannes Berg 1243e3685e03SJohannes Berg ieee80211_add_pending_skbs(local, &pending); 12445ac2e350SJohannes Berg 12455ac2e350SJohannes Berg /* now we're no longer in the deliver code */ 12465ac2e350SJohannes Berg clear_sta_flag(sta, WLAN_STA_PS_DELIVER); 12475ac2e350SJohannes Berg 12485ac2e350SJohannes Berg /* The station might have polled and then woken up before we responded, 12495ac2e350SJohannes Berg * so clear these flags now to avoid them sticking around. 12505ac2e350SJohannes Berg */ 12515ac2e350SJohannes Berg clear_sta_flag(sta, WLAN_STA_PSPOLL); 12525ac2e350SJohannes Berg clear_sta_flag(sta, WLAN_STA_UAPSD); 12531d147bfaSEmmanuel Grumbach spin_unlock(&sta->ps_lock); 1254948d887dSJohannes Berg 1255e3685e03SJohannes Berg atomic_dec(&ps->num_sta_ps); 1256e3685e03SJohannes Berg 1257687da132SEmmanuel Grumbach /* This station just woke up and isn't aware of our SMPS state */ 1258062f1d6dSChun-Yeow Yeoh if (!ieee80211_vif_is_mesh(&sdata->vif) && 1259062f1d6dSChun-Yeow Yeoh !ieee80211_smps_is_restrictive(sta->known_smps_mode, 1260687da132SEmmanuel Grumbach sdata->smps_mode) && 1261687da132SEmmanuel Grumbach sta->known_smps_mode != sdata->bss->req_smps && 1262687da132SEmmanuel Grumbach sta_info_tx_streams(sta) != 1) { 1263687da132SEmmanuel Grumbach ht_dbg(sdata, 1264687da132SEmmanuel Grumbach "%pM just woke up and MIMO capable - update SMPS\n", 1265687da132SEmmanuel Grumbach sta->sta.addr); 1266687da132SEmmanuel Grumbach ieee80211_send_smps_action(sdata, sdata->bss->req_smps, 1267687da132SEmmanuel Grumbach sta->sta.addr, 1268687da132SEmmanuel Grumbach sdata->vif.bss_conf.bssid); 1269687da132SEmmanuel Grumbach } 1270687da132SEmmanuel Grumbach 1271af818581SJohannes Berg local->total_ps_buffered -= buffered; 1272af818581SJohannes Berg 1273c868cb35SJohannes Berg sta_info_recalc_tim(sta); 1274c868cb35SJohannes Berg 1275bdcbd8e0SJohannes Berg ps_dbg(sdata, 1276bdcbd8e0SJohannes Berg "STA %pM aid %d sending %d filtered/%d PS frames since STA not sleeping anymore\n", 1277bdcbd8e0SJohannes Berg sta->sta.addr, sta->sta.aid, filtered, buffered); 127817c18bf8SJohannes Berg 127917c18bf8SJohannes Berg ieee80211_check_fast_xmit(sta); 1280af818581SJohannes Berg } 1281af818581SJohannes Berg 12820ead2510SEmmanuel Grumbach static void ieee80211_send_null_response(struct sta_info *sta, int tid, 1283b77cf4f8SJohannes Berg enum ieee80211_frame_release_type reason, 12840ead2510SEmmanuel Grumbach bool call_driver, bool more_data) 1285ce662b44SJohannes Berg { 12860ead2510SEmmanuel Grumbach struct ieee80211_sub_if_data *sdata = sta->sdata; 1287ce662b44SJohannes Berg struct ieee80211_local *local = sdata->local; 1288ce662b44SJohannes Berg struct ieee80211_qos_hdr *nullfunc; 1289ce662b44SJohannes Berg struct sk_buff *skb; 1290ce662b44SJohannes Berg int size = sizeof(*nullfunc); 1291ce662b44SJohannes Berg __le16 fc; 1292a74a8c84SJohannes Berg bool qos = sta->sta.wme; 1293ce662b44SJohannes Berg struct ieee80211_tx_info *info; 129455de908aSJohannes Berg struct ieee80211_chanctx_conf *chanctx_conf; 1295ce662b44SJohannes Berg 1296ce662b44SJohannes Berg if (qos) { 1297ce662b44SJohannes Berg fc = cpu_to_le16(IEEE80211_FTYPE_DATA | 1298ce662b44SJohannes Berg IEEE80211_STYPE_QOS_NULLFUNC | 1299ce662b44SJohannes Berg IEEE80211_FCTL_FROMDS); 1300ce662b44SJohannes Berg } else { 1301ce662b44SJohannes Berg size -= 2; 1302ce662b44SJohannes Berg fc = cpu_to_le16(IEEE80211_FTYPE_DATA | 1303ce662b44SJohannes Berg IEEE80211_STYPE_NULLFUNC | 1304ce662b44SJohannes Berg IEEE80211_FCTL_FROMDS); 1305ce662b44SJohannes Berg } 1306ce662b44SJohannes Berg 1307ce662b44SJohannes Berg skb = dev_alloc_skb(local->hw.extra_tx_headroom + size); 1308ce662b44SJohannes Berg if (!skb) 1309ce662b44SJohannes Berg return; 1310ce662b44SJohannes Berg 1311ce662b44SJohannes Berg skb_reserve(skb, local->hw.extra_tx_headroom); 1312ce662b44SJohannes Berg 1313ce662b44SJohannes Berg nullfunc = (void *) skb_put(skb, size); 1314ce662b44SJohannes Berg nullfunc->frame_control = fc; 1315ce662b44SJohannes Berg nullfunc->duration_id = 0; 1316ce662b44SJohannes Berg memcpy(nullfunc->addr1, sta->sta.addr, ETH_ALEN); 1317ce662b44SJohannes Berg memcpy(nullfunc->addr2, sdata->vif.addr, ETH_ALEN); 1318ce662b44SJohannes Berg memcpy(nullfunc->addr3, sdata->vif.addr, ETH_ALEN); 1319864a6040SJohannes Berg nullfunc->seq_ctrl = 0; 1320ce662b44SJohannes Berg 1321ce662b44SJohannes Berg skb->priority = tid; 1322ce662b44SJohannes Berg skb_set_queue_mapping(skb, ieee802_1d_to_ac[tid]); 132359b66255SJohannes Berg if (qos) { 1324ce662b44SJohannes Berg nullfunc->qos_ctrl = cpu_to_le16(tid); 1325ce662b44SJohannes Berg 13260ead2510SEmmanuel Grumbach if (reason == IEEE80211_FRAME_RELEASE_UAPSD) { 1327ce662b44SJohannes Berg nullfunc->qos_ctrl |= 1328ce662b44SJohannes Berg cpu_to_le16(IEEE80211_QOS_CTL_EOSP); 13290ead2510SEmmanuel Grumbach if (more_data) 13300ead2510SEmmanuel Grumbach nullfunc->frame_control |= 13310ead2510SEmmanuel Grumbach cpu_to_le16(IEEE80211_FCTL_MOREDATA); 13320ead2510SEmmanuel Grumbach } 1333ce662b44SJohannes Berg } 1334ce662b44SJohannes Berg 1335ce662b44SJohannes Berg info = IEEE80211_SKB_CB(skb); 1336ce662b44SJohannes Berg 1337ce662b44SJohannes Berg /* 1338ce662b44SJohannes Berg * Tell TX path to send this frame even though the 1339ce662b44SJohannes Berg * STA may still remain is PS mode after this frame 1340deeaee19SJohannes Berg * exchange. Also set EOSP to indicate this packet 1341deeaee19SJohannes Berg * ends the poll/service period. 1342ce662b44SJohannes Berg */ 134302f2f1a9SJohannes Berg info->flags |= IEEE80211_TX_CTL_NO_PS_BUFFER | 1344deeaee19SJohannes Berg IEEE80211_TX_STATUS_EOSP | 1345ce662b44SJohannes Berg IEEE80211_TX_CTL_REQ_TX_STATUS; 1346ce662b44SJohannes Berg 13476b127c71SSujith Manoharan info->control.flags |= IEEE80211_TX_CTRL_PS_RESPONSE; 13486b127c71SSujith Manoharan 1349b77cf4f8SJohannes Berg if (call_driver) 1350b77cf4f8SJohannes Berg drv_allow_buffered_frames(local, sta, BIT(tid), 1, 1351b77cf4f8SJohannes Berg reason, false); 135240b96408SJohannes Berg 135389afe614SJohannes Berg skb->dev = sdata->dev; 135489afe614SJohannes Berg 135555de908aSJohannes Berg rcu_read_lock(); 135655de908aSJohannes Berg chanctx_conf = rcu_dereference(sdata->vif.chanctx_conf); 135755de908aSJohannes Berg if (WARN_ON(!chanctx_conf)) { 135855de908aSJohannes Berg rcu_read_unlock(); 135955de908aSJohannes Berg kfree_skb(skb); 136055de908aSJohannes Berg return; 136155de908aSJohannes Berg } 136255de908aSJohannes Berg 136373c4e195SJohannes Berg info->band = chanctx_conf->def.chan->band; 13647c10770fSJohannes Berg ieee80211_xmit(sdata, sta, skb); 136555de908aSJohannes Berg rcu_read_unlock(); 1366ce662b44SJohannes Berg } 1367ce662b44SJohannes Berg 13680a1cb809SJohannes Berg static int find_highest_prio_tid(unsigned long tids) 13690a1cb809SJohannes Berg { 13700a1cb809SJohannes Berg /* lower 3 TIDs aren't ordered perfectly */ 13710a1cb809SJohannes Berg if (tids & 0xF8) 13720a1cb809SJohannes Berg return fls(tids) - 1; 13730a1cb809SJohannes Berg /* TID 0 is BE just like TID 3 */ 13740a1cb809SJohannes Berg if (tids & BIT(0)) 13750a1cb809SJohannes Berg return 0; 13760a1cb809SJohannes Berg return fls(tids) - 1; 13770a1cb809SJohannes Berg } 13780a1cb809SJohannes Berg 13790ead2510SEmmanuel Grumbach /* Indicates if the MORE_DATA bit should be set in the last 13800ead2510SEmmanuel Grumbach * frame obtained by ieee80211_sta_ps_get_frames. 13810ead2510SEmmanuel Grumbach * Note that driver_release_tids is relevant only if 13820ead2510SEmmanuel Grumbach * reason = IEEE80211_FRAME_RELEASE_PSPOLL 13830ead2510SEmmanuel Grumbach */ 13840ead2510SEmmanuel Grumbach static bool 13850ead2510SEmmanuel Grumbach ieee80211_sta_ps_more_data(struct sta_info *sta, u8 ignored_acs, 13860ead2510SEmmanuel Grumbach enum ieee80211_frame_release_type reason, 13870ead2510SEmmanuel Grumbach unsigned long driver_release_tids) 13880ead2510SEmmanuel Grumbach { 13890ead2510SEmmanuel Grumbach int ac; 13900ead2510SEmmanuel Grumbach 13910ead2510SEmmanuel Grumbach /* If the driver has data on more than one TID then 13920ead2510SEmmanuel Grumbach * certainly there's more data if we release just a 13930ead2510SEmmanuel Grumbach * single frame now (from a single TID). This will 13940ead2510SEmmanuel Grumbach * only happen for PS-Poll. 13950ead2510SEmmanuel Grumbach */ 13960ead2510SEmmanuel Grumbach if (reason == IEEE80211_FRAME_RELEASE_PSPOLL && 13970ead2510SEmmanuel Grumbach hweight16(driver_release_tids) > 1) 13980ead2510SEmmanuel Grumbach return true; 13990ead2510SEmmanuel Grumbach 14000ead2510SEmmanuel Grumbach for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) { 14010ead2510SEmmanuel Grumbach if (ignored_acs & BIT(ac)) 14020ead2510SEmmanuel Grumbach continue; 14030ead2510SEmmanuel Grumbach 14040ead2510SEmmanuel Grumbach if (!skb_queue_empty(&sta->tx_filtered[ac]) || 14050ead2510SEmmanuel Grumbach !skb_queue_empty(&sta->ps_tx_buf[ac])) 14060ead2510SEmmanuel Grumbach return true; 14070ead2510SEmmanuel Grumbach } 14080ead2510SEmmanuel Grumbach 14090ead2510SEmmanuel Grumbach return false; 14100ead2510SEmmanuel Grumbach } 14110ead2510SEmmanuel Grumbach 141247086fc5SJohannes Berg static void 14130ead2510SEmmanuel Grumbach ieee80211_sta_ps_get_frames(struct sta_info *sta, int n_frames, u8 ignored_acs, 14140ead2510SEmmanuel Grumbach enum ieee80211_frame_release_type reason, 14150ead2510SEmmanuel Grumbach struct sk_buff_head *frames, 14160ead2510SEmmanuel Grumbach unsigned long *driver_release_tids) 1417af818581SJohannes Berg { 1418af818581SJohannes Berg struct ieee80211_sub_if_data *sdata = sta->sdata; 1419af818581SJohannes Berg struct ieee80211_local *local = sdata->local; 1420948d887dSJohannes Berg int ac; 1421af818581SJohannes Berg 1422f9f760b4SJohannes Berg /* Get response frame(s) and more data bit for the last one. */ 1423948d887dSJohannes Berg for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) { 14244049e09aSJohannes Berg unsigned long tids; 14254049e09aSJohannes Berg 142647086fc5SJohannes Berg if (ignored_acs & BIT(ac)) 1427948d887dSJohannes Berg continue; 1428948d887dSJohannes Berg 14294049e09aSJohannes Berg tids = ieee80211_tids_for_ac(ac); 14304049e09aSJohannes Berg 1431f9f760b4SJohannes Berg /* if we already have frames from software, then we can't also 1432f9f760b4SJohannes Berg * release from hardware queues 1433f9f760b4SJohannes Berg */ 14340ead2510SEmmanuel Grumbach if (skb_queue_empty(frames)) { 14350ead2510SEmmanuel Grumbach *driver_release_tids |= 14360ead2510SEmmanuel Grumbach sta->driver_buffered_tids & tids; 14370ead2510SEmmanuel Grumbach *driver_release_tids |= sta->txq_buffered_tids & tids; 1438ba8c3d6fSFelix Fietkau } 1439f9f760b4SJohannes Berg 14400ead2510SEmmanuel Grumbach if (!*driver_release_tids) { 144147086fc5SJohannes Berg struct sk_buff *skb; 144247086fc5SJohannes Berg 144347086fc5SJohannes Berg while (n_frames > 0) { 1444948d887dSJohannes Berg skb = skb_dequeue(&sta->tx_filtered[ac]); 1445948d887dSJohannes Berg if (!skb) { 144647086fc5SJohannes Berg skb = skb_dequeue( 144747086fc5SJohannes Berg &sta->ps_tx_buf[ac]); 1448af818581SJohannes Berg if (skb) 1449af818581SJohannes Berg local->total_ps_buffered--; 1450af818581SJohannes Berg } 145147086fc5SJohannes Berg if (!skb) 145247086fc5SJohannes Berg break; 145347086fc5SJohannes Berg n_frames--; 14540ead2510SEmmanuel Grumbach __skb_queue_tail(frames, skb); 145547086fc5SJohannes Berg } 1456948d887dSJohannes Berg } 1457948d887dSJohannes Berg 14580ead2510SEmmanuel Grumbach /* If we have more frames buffered on this AC, then abort the 14590ead2510SEmmanuel Grumbach * loop since we can't send more data from other ACs before 14600ead2510SEmmanuel Grumbach * the buffered frames from this. 14614049e09aSJohannes Berg */ 1462948d887dSJohannes Berg if (!skb_queue_empty(&sta->tx_filtered[ac]) || 14630ead2510SEmmanuel Grumbach !skb_queue_empty(&sta->ps_tx_buf[ac])) 1464948d887dSJohannes Berg break; 1465948d887dSJohannes Berg } 1466948d887dSJohannes Berg } 1467af818581SJohannes Berg 14680ead2510SEmmanuel Grumbach static void 14690ead2510SEmmanuel Grumbach ieee80211_sta_ps_deliver_response(struct sta_info *sta, 14700ead2510SEmmanuel Grumbach int n_frames, u8 ignored_acs, 14710ead2510SEmmanuel Grumbach enum ieee80211_frame_release_type reason) 14720ead2510SEmmanuel Grumbach { 14730ead2510SEmmanuel Grumbach struct ieee80211_sub_if_data *sdata = sta->sdata; 14740ead2510SEmmanuel Grumbach struct ieee80211_local *local = sdata->local; 14750ead2510SEmmanuel Grumbach unsigned long driver_release_tids = 0; 14760ead2510SEmmanuel Grumbach struct sk_buff_head frames; 14770ead2510SEmmanuel Grumbach bool more_data; 14780ead2510SEmmanuel Grumbach 14790ead2510SEmmanuel Grumbach /* Service or PS-Poll period starts */ 14800ead2510SEmmanuel Grumbach set_sta_flag(sta, WLAN_STA_SP); 14810ead2510SEmmanuel Grumbach 14820ead2510SEmmanuel Grumbach __skb_queue_head_init(&frames); 14830ead2510SEmmanuel Grumbach 14840ead2510SEmmanuel Grumbach ieee80211_sta_ps_get_frames(sta, n_frames, ignored_acs, reason, 14850ead2510SEmmanuel Grumbach &frames, &driver_release_tids); 14860ead2510SEmmanuel Grumbach 14870ead2510SEmmanuel Grumbach more_data = ieee80211_sta_ps_more_data(sta, ignored_acs, reason, driver_release_tids); 14880ead2510SEmmanuel Grumbach 14891a57081aSEmmanuel Grumbach if (driver_release_tids && reason == IEEE80211_FRAME_RELEASE_PSPOLL) 14900ead2510SEmmanuel Grumbach driver_release_tids = 14910ead2510SEmmanuel Grumbach BIT(find_highest_prio_tid(driver_release_tids)); 14920ead2510SEmmanuel Grumbach 1493f9f760b4SJohannes Berg if (skb_queue_empty(&frames) && !driver_release_tids) { 1494ce662b44SJohannes Berg int tid; 14954049e09aSJohannes Berg 1496ce662b44SJohannes Berg /* 1497ce662b44SJohannes Berg * For PS-Poll, this can only happen due to a race condition 1498ce662b44SJohannes Berg * when we set the TIM bit and the station notices it, but 1499ce662b44SJohannes Berg * before it can poll for the frame we expire it. 1500ce662b44SJohannes Berg * 1501ce662b44SJohannes Berg * For uAPSD, this is said in the standard (11.2.1.5 h): 1502ce662b44SJohannes Berg * At each unscheduled SP for a non-AP STA, the AP shall 1503ce662b44SJohannes Berg * attempt to transmit at least one MSDU or MMPDU, but no 1504ce662b44SJohannes Berg * more than the value specified in the Max SP Length field 1505ce662b44SJohannes Berg * in the QoS Capability element from delivery-enabled ACs, 1506ce662b44SJohannes Berg * that are destined for the non-AP STA. 1507ce662b44SJohannes Berg * 1508ce662b44SJohannes Berg * Since we have no other MSDU/MMPDU, transmit a QoS null frame. 1509ce662b44SJohannes Berg */ 1510ce662b44SJohannes Berg 1511ce662b44SJohannes Berg /* This will evaluate to 1, 3, 5 or 7. */ 1512ce662b44SJohannes Berg tid = 7 - ((ffs(~ignored_acs) - 1) << 1); 1513ce662b44SJohannes Berg 15140ead2510SEmmanuel Grumbach ieee80211_send_null_response(sta, tid, reason, true, false); 1515f9f760b4SJohannes Berg } else if (!driver_release_tids) { 151647086fc5SJohannes Berg struct sk_buff_head pending; 151747086fc5SJohannes Berg struct sk_buff *skb; 151840b96408SJohannes Berg int num = 0; 151940b96408SJohannes Berg u16 tids = 0; 1520b77cf4f8SJohannes Berg bool need_null = false; 152147086fc5SJohannes Berg 152247086fc5SJohannes Berg skb_queue_head_init(&pending); 152347086fc5SJohannes Berg 152447086fc5SJohannes Berg while ((skb = __skb_dequeue(&frames))) { 1525af818581SJohannes Berg struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb); 152647086fc5SJohannes Berg struct ieee80211_hdr *hdr = (void *) skb->data; 152740b96408SJohannes Berg u8 *qoshdr = NULL; 152840b96408SJohannes Berg 152940b96408SJohannes Berg num++; 1530af818581SJohannes Berg 1531af818581SJohannes Berg /* 153247086fc5SJohannes Berg * Tell TX path to send this frame even though the 153347086fc5SJohannes Berg * STA may still remain is PS mode after this frame 153447086fc5SJohannes Berg * exchange. 1535af818581SJohannes Berg */ 15366b127c71SSujith Manoharan info->flags |= IEEE80211_TX_CTL_NO_PS_BUFFER; 15376b127c71SSujith Manoharan info->control.flags |= IEEE80211_TX_CTRL_PS_RESPONSE; 1538af818581SJohannes Berg 153947086fc5SJohannes Berg /* 154047086fc5SJohannes Berg * Use MoreData flag to indicate whether there are 154147086fc5SJohannes Berg * more buffered frames for this STA 154247086fc5SJohannes Berg */ 154324b9c373SJanusz.Dziedzic@tieto.com if (more_data || !skb_queue_empty(&frames)) 154447086fc5SJohannes Berg hdr->frame_control |= 154547086fc5SJohannes Berg cpu_to_le16(IEEE80211_FCTL_MOREDATA); 154624b9c373SJanusz.Dziedzic@tieto.com else 154724b9c373SJanusz.Dziedzic@tieto.com hdr->frame_control &= 154824b9c373SJanusz.Dziedzic@tieto.com cpu_to_le16(~IEEE80211_FCTL_MOREDATA); 1549af818581SJohannes Berg 155040b96408SJohannes Berg if (ieee80211_is_data_qos(hdr->frame_control) || 155140b96408SJohannes Berg ieee80211_is_qos_nullfunc(hdr->frame_control)) 155240b96408SJohannes Berg qoshdr = ieee80211_get_qos_ctl(hdr); 155340b96408SJohannes Berg 1554b77cf4f8SJohannes Berg tids |= BIT(skb->priority); 1555b77cf4f8SJohannes Berg 1556b77cf4f8SJohannes Berg __skb_queue_tail(&pending, skb); 1557b77cf4f8SJohannes Berg 1558b77cf4f8SJohannes Berg /* end service period after last frame or add one */ 1559b77cf4f8SJohannes Berg if (!skb_queue_empty(&frames)) 1560b77cf4f8SJohannes Berg continue; 1561b77cf4f8SJohannes Berg 1562b77cf4f8SJohannes Berg if (reason != IEEE80211_FRAME_RELEASE_UAPSD) { 1563b77cf4f8SJohannes Berg /* for PS-Poll, there's only one frame */ 1564b77cf4f8SJohannes Berg info->flags |= IEEE80211_TX_STATUS_EOSP | 1565b77cf4f8SJohannes Berg IEEE80211_TX_CTL_REQ_TX_STATUS; 1566b77cf4f8SJohannes Berg break; 1567b77cf4f8SJohannes Berg } 1568b77cf4f8SJohannes Berg 1569b77cf4f8SJohannes Berg /* For uAPSD, things are a bit more complicated. If the 1570b77cf4f8SJohannes Berg * last frame has a QoS header (i.e. is a QoS-data or 1571b77cf4f8SJohannes Berg * QoS-nulldata frame) then just set the EOSP bit there 1572b77cf4f8SJohannes Berg * and be done. 1573b77cf4f8SJohannes Berg * If the frame doesn't have a QoS header (which means 1574b77cf4f8SJohannes Berg * it should be a bufferable MMPDU) then we can't set 1575b77cf4f8SJohannes Berg * the EOSP bit in the QoS header; add a QoS-nulldata 1576b77cf4f8SJohannes Berg * frame to the list to send it after the MMPDU. 1577b77cf4f8SJohannes Berg * 1578b77cf4f8SJohannes Berg * Note that this code is only in the mac80211-release 1579b77cf4f8SJohannes Berg * code path, we assume that the driver will not buffer 1580b77cf4f8SJohannes Berg * anything but QoS-data frames, or if it does, will 1581b77cf4f8SJohannes Berg * create the QoS-nulldata frame by itself if needed. 1582b77cf4f8SJohannes Berg * 1583b77cf4f8SJohannes Berg * Cf. 802.11-2012 10.2.1.10 (c). 1584b77cf4f8SJohannes Berg */ 1585b77cf4f8SJohannes Berg if (qoshdr) { 158640b96408SJohannes Berg *qoshdr |= IEEE80211_QOS_CTL_EOSP; 1587deeaee19SJohannes Berg 158847086fc5SJohannes Berg info->flags |= IEEE80211_TX_STATUS_EOSP | 158947086fc5SJohannes Berg IEEE80211_TX_CTL_REQ_TX_STATUS; 1590b77cf4f8SJohannes Berg } else { 1591b77cf4f8SJohannes Berg /* The standard isn't completely clear on this 1592b77cf4f8SJohannes Berg * as it says the more-data bit should be set 1593b77cf4f8SJohannes Berg * if there are more BUs. The QoS-Null frame 1594b77cf4f8SJohannes Berg * we're about to send isn't buffered yet, we 1595b77cf4f8SJohannes Berg * only create it below, but let's pretend it 1596b77cf4f8SJohannes Berg * was buffered just in case some clients only 1597b77cf4f8SJohannes Berg * expect more-data=0 when eosp=1. 1598b77cf4f8SJohannes Berg */ 1599b77cf4f8SJohannes Berg hdr->frame_control |= 1600b77cf4f8SJohannes Berg cpu_to_le16(IEEE80211_FCTL_MOREDATA); 1601b77cf4f8SJohannes Berg need_null = true; 1602b77cf4f8SJohannes Berg num++; 160352a3f20cSMarco Porsch } 1604b77cf4f8SJohannes Berg break; 160547086fc5SJohannes Berg } 160647086fc5SJohannes Berg 160740b96408SJohannes Berg drv_allow_buffered_frames(local, sta, tids, num, 160840b96408SJohannes Berg reason, more_data); 160940b96408SJohannes Berg 161047086fc5SJohannes Berg ieee80211_add_pending_skbs(local, &pending); 1611af818581SJohannes Berg 1612b77cf4f8SJohannes Berg if (need_null) 1613b77cf4f8SJohannes Berg ieee80211_send_null_response( 16140ead2510SEmmanuel Grumbach sta, find_highest_prio_tid(tids), 16150ead2510SEmmanuel Grumbach reason, false, false); 1616b77cf4f8SJohannes Berg 1617c868cb35SJohannes Berg sta_info_recalc_tim(sta); 1618af818581SJohannes Berg } else { 1619ba8c3d6fSFelix Fietkau unsigned long tids = sta->txq_buffered_tids & driver_release_tids; 1620ba8c3d6fSFelix Fietkau int tid; 1621ba8c3d6fSFelix Fietkau 1622af818581SJohannes Berg /* 16234049e09aSJohannes Berg * We need to release a frame that is buffered somewhere in the 16244049e09aSJohannes Berg * driver ... it'll have to handle that. 1625f9f760b4SJohannes Berg * Note that the driver also has to check the number of frames 1626f9f760b4SJohannes Berg * on the TIDs we're releasing from - if there are more than 1627f9f760b4SJohannes Berg * n_frames it has to set the more-data bit (if we didn't ask 1628f9f760b4SJohannes Berg * it to set it anyway due to other buffered frames); if there 1629f9f760b4SJohannes Berg * are fewer than n_frames it has to make sure to adjust that 1630f9f760b4SJohannes Berg * to allow the service period to end properly. 1631af818581SJohannes Berg */ 16324049e09aSJohannes Berg drv_release_buffered_frames(local, sta, driver_release_tids, 163347086fc5SJohannes Berg n_frames, reason, more_data); 16344049e09aSJohannes Berg 16354049e09aSJohannes Berg /* 16364049e09aSJohannes Berg * Note that we don't recalculate the TIM bit here as it would 16374049e09aSJohannes Berg * most likely have no effect at all unless the driver told us 1638f9f760b4SJohannes Berg * that the TID(s) became empty before returning here from the 16394049e09aSJohannes Berg * release function. 1640f9f760b4SJohannes Berg * Either way, however, when the driver tells us that the TID(s) 1641ba8c3d6fSFelix Fietkau * became empty or we find that a txq became empty, we'll do the 1642ba8c3d6fSFelix Fietkau * TIM recalculation. 16434049e09aSJohannes Berg */ 1644ba8c3d6fSFelix Fietkau 1645ba8c3d6fSFelix Fietkau if (!sta->sta.txq[0]) 1646ba8c3d6fSFelix Fietkau return; 1647ba8c3d6fSFelix Fietkau 1648ba8c3d6fSFelix Fietkau for (tid = 0; tid < ARRAY_SIZE(sta->sta.txq); tid++) { 1649ba8c3d6fSFelix Fietkau struct txq_info *txqi = to_txq_info(sta->sta.txq[tid]); 1650ba8c3d6fSFelix Fietkau 1651*fa962b92SMichal Kazior if (!(tids & BIT(tid)) || txqi->tin.backlog_packets) 1652ba8c3d6fSFelix Fietkau continue; 1653ba8c3d6fSFelix Fietkau 1654ba8c3d6fSFelix Fietkau sta_info_recalc_tim(sta); 1655ba8c3d6fSFelix Fietkau break; 1656ba8c3d6fSFelix Fietkau } 1657af818581SJohannes Berg } 1658af818581SJohannes Berg } 1659af818581SJohannes Berg 1660af818581SJohannes Berg void ieee80211_sta_ps_deliver_poll_response(struct sta_info *sta) 1661af818581SJohannes Berg { 166247086fc5SJohannes Berg u8 ignore_for_response = sta->sta.uapsd_queues; 1663af818581SJohannes Berg 1664af818581SJohannes Berg /* 166547086fc5SJohannes Berg * If all ACs are delivery-enabled then we should reply 166647086fc5SJohannes Berg * from any of them, if only some are enabled we reply 166747086fc5SJohannes Berg * only from the non-enabled ones. 1668af818581SJohannes Berg */ 166947086fc5SJohannes Berg if (ignore_for_response == BIT(IEEE80211_NUM_ACS) - 1) 167047086fc5SJohannes Berg ignore_for_response = 0; 1671af818581SJohannes Berg 167247086fc5SJohannes Berg ieee80211_sta_ps_deliver_response(sta, 1, ignore_for_response, 167347086fc5SJohannes Berg IEEE80211_FRAME_RELEASE_PSPOLL); 1674af818581SJohannes Berg } 167547086fc5SJohannes Berg 167647086fc5SJohannes Berg void ieee80211_sta_ps_deliver_uapsd(struct sta_info *sta) 167747086fc5SJohannes Berg { 167847086fc5SJohannes Berg int n_frames = sta->sta.max_sp; 167947086fc5SJohannes Berg u8 delivery_enabled = sta->sta.uapsd_queues; 168047086fc5SJohannes Berg 168147086fc5SJohannes Berg /* 168247086fc5SJohannes Berg * If we ever grow support for TSPEC this might happen if 168347086fc5SJohannes Berg * the TSPEC update from hostapd comes in between a trigger 168447086fc5SJohannes Berg * frame setting WLAN_STA_UAPSD in the RX path and this 168547086fc5SJohannes Berg * actually getting called. 168647086fc5SJohannes Berg */ 168747086fc5SJohannes Berg if (!delivery_enabled) 168847086fc5SJohannes Berg return; 168947086fc5SJohannes Berg 169047086fc5SJohannes Berg switch (sta->sta.max_sp) { 169147086fc5SJohannes Berg case 1: 169247086fc5SJohannes Berg n_frames = 2; 169347086fc5SJohannes Berg break; 169447086fc5SJohannes Berg case 2: 169547086fc5SJohannes Berg n_frames = 4; 169647086fc5SJohannes Berg break; 169747086fc5SJohannes Berg case 3: 169847086fc5SJohannes Berg n_frames = 6; 169947086fc5SJohannes Berg break; 170047086fc5SJohannes Berg case 0: 170147086fc5SJohannes Berg /* XXX: what is a good value? */ 170213a8098aSAndrei Otcheretianski n_frames = 128; 170347086fc5SJohannes Berg break; 170447086fc5SJohannes Berg } 170547086fc5SJohannes Berg 170647086fc5SJohannes Berg ieee80211_sta_ps_deliver_response(sta, n_frames, ~delivery_enabled, 170747086fc5SJohannes Berg IEEE80211_FRAME_RELEASE_UAPSD); 1708af818581SJohannes Berg } 1709af818581SJohannes Berg 1710af818581SJohannes Berg void ieee80211_sta_block_awake(struct ieee80211_hw *hw, 1711af818581SJohannes Berg struct ieee80211_sta *pubsta, bool block) 1712af818581SJohannes Berg { 1713af818581SJohannes Berg struct sta_info *sta = container_of(pubsta, struct sta_info, sta); 1714af818581SJohannes Berg 1715b5878a2dSJohannes Berg trace_api_sta_block_awake(sta->local, pubsta, block); 1716b5878a2dSJohannes Berg 17175ac2e350SJohannes Berg if (block) { 1718c2c98fdeSJohannes Berg set_sta_flag(sta, WLAN_STA_PS_DRIVER); 171917c18bf8SJohannes Berg ieee80211_clear_fast_xmit(sta); 17205ac2e350SJohannes Berg return; 17215ac2e350SJohannes Berg } 17225ac2e350SJohannes Berg 17235ac2e350SJohannes Berg if (!test_sta_flag(sta, WLAN_STA_PS_DRIVER)) 17245ac2e350SJohannes Berg return; 17255ac2e350SJohannes Berg 17265ac2e350SJohannes Berg if (!test_sta_flag(sta, WLAN_STA_PS_STA)) { 17275ac2e350SJohannes Berg set_sta_flag(sta, WLAN_STA_PS_DELIVER); 17285ac2e350SJohannes Berg clear_sta_flag(sta, WLAN_STA_PS_DRIVER); 17295ac2e350SJohannes Berg ieee80211_queue_work(hw, &sta->drv_deliver_wk); 17305ac2e350SJohannes Berg } else if (test_sta_flag(sta, WLAN_STA_PSPOLL) || 17315ac2e350SJohannes Berg test_sta_flag(sta, WLAN_STA_UAPSD)) { 17325ac2e350SJohannes Berg /* must be asleep in this case */ 17335ac2e350SJohannes Berg clear_sta_flag(sta, WLAN_STA_PS_DRIVER); 17345ac2e350SJohannes Berg ieee80211_queue_work(hw, &sta->drv_deliver_wk); 17355ac2e350SJohannes Berg } else { 17365ac2e350SJohannes Berg clear_sta_flag(sta, WLAN_STA_PS_DRIVER); 173717c18bf8SJohannes Berg ieee80211_check_fast_xmit(sta); 17385ac2e350SJohannes Berg } 1739af818581SJohannes Berg } 1740af818581SJohannes Berg EXPORT_SYMBOL(ieee80211_sta_block_awake); 1741dcf55fb5SFelix Fietkau 1742e943789eSJohannes Berg void ieee80211_sta_eosp(struct ieee80211_sta *pubsta) 174337fbd908SJohannes Berg { 174437fbd908SJohannes Berg struct sta_info *sta = container_of(pubsta, struct sta_info, sta); 174537fbd908SJohannes Berg struct ieee80211_local *local = sta->local; 174637fbd908SJohannes Berg 174737fbd908SJohannes Berg trace_api_eosp(local, pubsta); 174837fbd908SJohannes Berg 174937fbd908SJohannes Berg clear_sta_flag(sta, WLAN_STA_SP); 175037fbd908SJohannes Berg } 1751e943789eSJohannes Berg EXPORT_SYMBOL(ieee80211_sta_eosp); 175237fbd908SJohannes Berg 17530ead2510SEmmanuel Grumbach void ieee80211_send_eosp_nullfunc(struct ieee80211_sta *pubsta, int tid) 17540ead2510SEmmanuel Grumbach { 17550ead2510SEmmanuel Grumbach struct sta_info *sta = container_of(pubsta, struct sta_info, sta); 17560ead2510SEmmanuel Grumbach enum ieee80211_frame_release_type reason; 17570ead2510SEmmanuel Grumbach bool more_data; 17580ead2510SEmmanuel Grumbach 17590ead2510SEmmanuel Grumbach trace_api_send_eosp_nullfunc(sta->local, pubsta, tid); 17600ead2510SEmmanuel Grumbach 17610ead2510SEmmanuel Grumbach reason = IEEE80211_FRAME_RELEASE_UAPSD; 17620ead2510SEmmanuel Grumbach more_data = ieee80211_sta_ps_more_data(sta, ~sta->sta.uapsd_queues, 17630ead2510SEmmanuel Grumbach reason, 0); 17640ead2510SEmmanuel Grumbach 17650ead2510SEmmanuel Grumbach ieee80211_send_null_response(sta, tid, reason, false, more_data); 17660ead2510SEmmanuel Grumbach } 17670ead2510SEmmanuel Grumbach EXPORT_SYMBOL(ieee80211_send_eosp_nullfunc); 17680ead2510SEmmanuel Grumbach 1769042ec453SJohannes Berg void ieee80211_sta_set_buffered(struct ieee80211_sta *pubsta, 1770042ec453SJohannes Berg u8 tid, bool buffered) 1771dcf55fb5SFelix Fietkau { 1772dcf55fb5SFelix Fietkau struct sta_info *sta = container_of(pubsta, struct sta_info, sta); 1773dcf55fb5SFelix Fietkau 17745a306f58SJohannes Berg if (WARN_ON(tid >= IEEE80211_NUM_TIDS)) 1775042ec453SJohannes Berg return; 1776042ec453SJohannes Berg 17771b000789SJohannes Berg trace_api_sta_set_buffered(sta->local, pubsta, tid, buffered); 17781b000789SJohannes Berg 1779948d887dSJohannes Berg if (buffered) 1780948d887dSJohannes Berg set_bit(tid, &sta->driver_buffered_tids); 1781948d887dSJohannes Berg else 1782948d887dSJohannes Berg clear_bit(tid, &sta->driver_buffered_tids); 1783948d887dSJohannes Berg 1784c868cb35SJohannes Berg sta_info_recalc_tim(sta); 1785dcf55fb5SFelix Fietkau } 1786042ec453SJohannes Berg EXPORT_SYMBOL(ieee80211_sta_set_buffered); 1787d9a7ddb0SJohannes Berg 178852cfa1d6SAyala Beker static void 178952cfa1d6SAyala Beker ieee80211_recalc_p2p_go_ps_allowed(struct ieee80211_sub_if_data *sdata) 179052cfa1d6SAyala Beker { 179152cfa1d6SAyala Beker struct ieee80211_local *local = sdata->local; 179252cfa1d6SAyala Beker bool allow_p2p_go_ps = sdata->vif.p2p; 179352cfa1d6SAyala Beker struct sta_info *sta; 179452cfa1d6SAyala Beker 179552cfa1d6SAyala Beker rcu_read_lock(); 179652cfa1d6SAyala Beker list_for_each_entry_rcu(sta, &local->sta_list, list) { 179752cfa1d6SAyala Beker if (sdata != sta->sdata || 179852cfa1d6SAyala Beker !test_sta_flag(sta, WLAN_STA_ASSOC)) 179952cfa1d6SAyala Beker continue; 180052cfa1d6SAyala Beker if (!sta->sta.support_p2p_ps) { 180152cfa1d6SAyala Beker allow_p2p_go_ps = false; 180252cfa1d6SAyala Beker break; 180352cfa1d6SAyala Beker } 180452cfa1d6SAyala Beker } 180552cfa1d6SAyala Beker rcu_read_unlock(); 180652cfa1d6SAyala Beker 180752cfa1d6SAyala Beker if (allow_p2p_go_ps != sdata->vif.bss_conf.allow_p2p_go_ps) { 180852cfa1d6SAyala Beker sdata->vif.bss_conf.allow_p2p_go_ps = allow_p2p_go_ps; 180952cfa1d6SAyala Beker ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_P2P_PS); 181052cfa1d6SAyala Beker } 181152cfa1d6SAyala Beker } 181252cfa1d6SAyala Beker 181383d5cc01SJohannes Berg int sta_info_move_state(struct sta_info *sta, 1814d9a7ddb0SJohannes Berg enum ieee80211_sta_state new_state) 1815d9a7ddb0SJohannes Berg { 18168bf11d8dSJohannes Berg might_sleep(); 1817d9a7ddb0SJohannes Berg 1818d9a7ddb0SJohannes Berg if (sta->sta_state == new_state) 1819d9a7ddb0SJohannes Berg return 0; 1820d9a7ddb0SJohannes Berg 1821f09603a2SJohannes Berg /* check allowed transitions first */ 1822f09603a2SJohannes Berg 1823d9a7ddb0SJohannes Berg switch (new_state) { 1824d9a7ddb0SJohannes Berg case IEEE80211_STA_NONE: 1825f09603a2SJohannes Berg if (sta->sta_state != IEEE80211_STA_AUTH) 1826d9a7ddb0SJohannes Berg return -EINVAL; 1827d9a7ddb0SJohannes Berg break; 1828d9a7ddb0SJohannes Berg case IEEE80211_STA_AUTH: 1829f09603a2SJohannes Berg if (sta->sta_state != IEEE80211_STA_NONE && 1830f09603a2SJohannes Berg sta->sta_state != IEEE80211_STA_ASSOC) 1831d9a7ddb0SJohannes Berg return -EINVAL; 1832d9a7ddb0SJohannes Berg break; 1833d9a7ddb0SJohannes Berg case IEEE80211_STA_ASSOC: 1834f09603a2SJohannes Berg if (sta->sta_state != IEEE80211_STA_AUTH && 1835f09603a2SJohannes Berg sta->sta_state != IEEE80211_STA_AUTHORIZED) 1836d9a7ddb0SJohannes Berg return -EINVAL; 1837d9a7ddb0SJohannes Berg break; 1838d9a7ddb0SJohannes Berg case IEEE80211_STA_AUTHORIZED: 1839f09603a2SJohannes Berg if (sta->sta_state != IEEE80211_STA_ASSOC) 1840d9a7ddb0SJohannes Berg return -EINVAL; 1841d9a7ddb0SJohannes Berg break; 1842d9a7ddb0SJohannes Berg default: 1843d9a7ddb0SJohannes Berg WARN(1, "invalid state %d", new_state); 1844d9a7ddb0SJohannes Berg return -EINVAL; 1845d9a7ddb0SJohannes Berg } 1846d9a7ddb0SJohannes Berg 1847bdcbd8e0SJohannes Berg sta_dbg(sta->sdata, "moving STA %pM to state %d\n", 1848bdcbd8e0SJohannes Berg sta->sta.addr, new_state); 1849f09603a2SJohannes Berg 1850f09603a2SJohannes Berg /* 1851f09603a2SJohannes Berg * notify the driver before the actual changes so it can 1852f09603a2SJohannes Berg * fail the transition 1853f09603a2SJohannes Berg */ 1854f09603a2SJohannes Berg if (test_sta_flag(sta, WLAN_STA_INSERTED)) { 1855f09603a2SJohannes Berg int err = drv_sta_state(sta->local, sta->sdata, sta, 1856f09603a2SJohannes Berg sta->sta_state, new_state); 1857f09603a2SJohannes Berg if (err) 1858f09603a2SJohannes Berg return err; 1859f09603a2SJohannes Berg } 1860f09603a2SJohannes Berg 1861f09603a2SJohannes Berg /* reflect the change in all state variables */ 1862f09603a2SJohannes Berg 1863f09603a2SJohannes Berg switch (new_state) { 1864f09603a2SJohannes Berg case IEEE80211_STA_NONE: 1865f09603a2SJohannes Berg if (sta->sta_state == IEEE80211_STA_AUTH) 1866f09603a2SJohannes Berg clear_bit(WLAN_STA_AUTH, &sta->_flags); 1867f09603a2SJohannes Berg break; 1868f09603a2SJohannes Berg case IEEE80211_STA_AUTH: 1869a7201a6cSIlan Peer if (sta->sta_state == IEEE80211_STA_NONE) { 1870f09603a2SJohannes Berg set_bit(WLAN_STA_AUTH, &sta->_flags); 1871a7201a6cSIlan Peer } else if (sta->sta_state == IEEE80211_STA_ASSOC) { 1872f09603a2SJohannes Berg clear_bit(WLAN_STA_ASSOC, &sta->_flags); 1873a7201a6cSIlan Peer ieee80211_recalc_min_chandef(sta->sdata); 187452cfa1d6SAyala Beker if (!sta->sta.support_p2p_ps) 187552cfa1d6SAyala Beker ieee80211_recalc_p2p_go_ps_allowed(sta->sdata); 1876a7201a6cSIlan Peer } 1877f09603a2SJohannes Berg break; 1878f09603a2SJohannes Berg case IEEE80211_STA_ASSOC: 1879f09603a2SJohannes Berg if (sta->sta_state == IEEE80211_STA_AUTH) { 1880f09603a2SJohannes Berg set_bit(WLAN_STA_ASSOC, &sta->_flags); 1881a7201a6cSIlan Peer ieee80211_recalc_min_chandef(sta->sdata); 188252cfa1d6SAyala Beker if (!sta->sta.support_p2p_ps) 188352cfa1d6SAyala Beker ieee80211_recalc_p2p_go_ps_allowed(sta->sdata); 1884f09603a2SJohannes Berg } else if (sta->sta_state == IEEE80211_STA_AUTHORIZED) { 18857e3ed02cSFelix Fietkau if (sta->sdata->vif.type == NL80211_IFTYPE_AP || 18867e3ed02cSFelix Fietkau (sta->sdata->vif.type == NL80211_IFTYPE_AP_VLAN && 18877e3ed02cSFelix Fietkau !sta->sdata->u.vlan.sta)) 18887e3ed02cSFelix Fietkau atomic_dec(&sta->sdata->bss->num_mcast_sta); 1889f09603a2SJohannes Berg clear_bit(WLAN_STA_AUTHORIZED, &sta->_flags); 189017c18bf8SJohannes Berg ieee80211_clear_fast_xmit(sta); 189149ddf8e6SJohannes Berg ieee80211_clear_fast_rx(sta); 1892f09603a2SJohannes Berg } 1893f09603a2SJohannes Berg break; 1894f09603a2SJohannes Berg case IEEE80211_STA_AUTHORIZED: 1895f09603a2SJohannes Berg if (sta->sta_state == IEEE80211_STA_ASSOC) { 18967e3ed02cSFelix Fietkau if (sta->sdata->vif.type == NL80211_IFTYPE_AP || 18977e3ed02cSFelix Fietkau (sta->sdata->vif.type == NL80211_IFTYPE_AP_VLAN && 18987e3ed02cSFelix Fietkau !sta->sdata->u.vlan.sta)) 18997e3ed02cSFelix Fietkau atomic_inc(&sta->sdata->bss->num_mcast_sta); 1900f09603a2SJohannes Berg set_bit(WLAN_STA_AUTHORIZED, &sta->_flags); 190117c18bf8SJohannes Berg ieee80211_check_fast_xmit(sta); 190249ddf8e6SJohannes Berg ieee80211_check_fast_rx(sta); 1903f09603a2SJohannes Berg } 1904f09603a2SJohannes Berg break; 1905f09603a2SJohannes Berg default: 1906f09603a2SJohannes Berg break; 1907f09603a2SJohannes Berg } 1908f09603a2SJohannes Berg 1909d9a7ddb0SJohannes Berg sta->sta_state = new_state; 1910d9a7ddb0SJohannes Berg 1911d9a7ddb0SJohannes Berg return 0; 1912d9a7ddb0SJohannes Berg } 1913687da132SEmmanuel Grumbach 1914687da132SEmmanuel Grumbach u8 sta_info_tx_streams(struct sta_info *sta) 1915687da132SEmmanuel Grumbach { 1916687da132SEmmanuel Grumbach struct ieee80211_sta_ht_cap *ht_cap = &sta->sta.ht_cap; 1917687da132SEmmanuel Grumbach u8 rx_streams; 1918687da132SEmmanuel Grumbach 1919687da132SEmmanuel Grumbach if (!sta->sta.ht_cap.ht_supported) 1920687da132SEmmanuel Grumbach return 1; 1921687da132SEmmanuel Grumbach 1922687da132SEmmanuel Grumbach if (sta->sta.vht_cap.vht_supported) { 1923687da132SEmmanuel Grumbach int i; 1924687da132SEmmanuel Grumbach u16 tx_mcs_map = 1925687da132SEmmanuel Grumbach le16_to_cpu(sta->sta.vht_cap.vht_mcs.tx_mcs_map); 1926687da132SEmmanuel Grumbach 1927687da132SEmmanuel Grumbach for (i = 7; i >= 0; i--) 1928687da132SEmmanuel Grumbach if ((tx_mcs_map & (0x3 << (i * 2))) != 1929687da132SEmmanuel Grumbach IEEE80211_VHT_MCS_NOT_SUPPORTED) 1930687da132SEmmanuel Grumbach return i + 1; 1931687da132SEmmanuel Grumbach } 1932687da132SEmmanuel Grumbach 1933687da132SEmmanuel Grumbach if (ht_cap->mcs.rx_mask[3]) 1934687da132SEmmanuel Grumbach rx_streams = 4; 1935687da132SEmmanuel Grumbach else if (ht_cap->mcs.rx_mask[2]) 1936687da132SEmmanuel Grumbach rx_streams = 3; 1937687da132SEmmanuel Grumbach else if (ht_cap->mcs.rx_mask[1]) 1938687da132SEmmanuel Grumbach rx_streams = 2; 1939687da132SEmmanuel Grumbach else 1940687da132SEmmanuel Grumbach rx_streams = 1; 1941687da132SEmmanuel Grumbach 1942687da132SEmmanuel Grumbach if (!(ht_cap->mcs.tx_params & IEEE80211_HT_MCS_TX_RX_DIFF)) 1943687da132SEmmanuel Grumbach return rx_streams; 1944687da132SEmmanuel Grumbach 1945687da132SEmmanuel Grumbach return ((ht_cap->mcs.tx_params & IEEE80211_HT_MCS_TX_MAX_STREAMS_MASK) 1946687da132SEmmanuel Grumbach >> IEEE80211_HT_MCS_TX_MAX_STREAMS_SHIFT) + 1; 1947687da132SEmmanuel Grumbach } 1948b7ffbd7eSJohannes Berg 1949c9c5962bSJohannes Berg static struct ieee80211_sta_rx_stats * 1950c9c5962bSJohannes Berg sta_get_last_rx_stats(struct sta_info *sta) 1951c9c5962bSJohannes Berg { 1952c9c5962bSJohannes Berg struct ieee80211_sta_rx_stats *stats = &sta->rx_stats; 1953c9c5962bSJohannes Berg struct ieee80211_local *local = sta->local; 1954c9c5962bSJohannes Berg int cpu; 1955c9c5962bSJohannes Berg 1956c9c5962bSJohannes Berg if (!ieee80211_hw_check(&local->hw, USES_RSS)) 1957c9c5962bSJohannes Berg return stats; 1958c9c5962bSJohannes Berg 1959c9c5962bSJohannes Berg for_each_possible_cpu(cpu) { 1960c9c5962bSJohannes Berg struct ieee80211_sta_rx_stats *cpustats; 1961c9c5962bSJohannes Berg 1962c9c5962bSJohannes Berg cpustats = per_cpu_ptr(sta->pcpu_rx_stats, cpu); 1963c9c5962bSJohannes Berg 1964c9c5962bSJohannes Berg if (time_after(cpustats->last_rx, stats->last_rx)) 1965c9c5962bSJohannes Berg stats = cpustats; 1966c9c5962bSJohannes Berg } 1967c9c5962bSJohannes Berg 1968c9c5962bSJohannes Berg return stats; 1969c9c5962bSJohannes Berg } 1970c9c5962bSJohannes Berg 19714f6b1b3dSJohannes Berg static void sta_stats_decode_rate(struct ieee80211_local *local, u16 rate, 19724f6b1b3dSJohannes Berg struct rate_info *rinfo) 1973fbd6ff5cSJohannes Berg { 19744f6b1b3dSJohannes Berg rinfo->bw = (rate & STA_STATS_RATE_BW_MASK) >> 19754f6b1b3dSJohannes Berg STA_STATS_RATE_BW_SHIFT; 1976fbd6ff5cSJohannes Berg 19774f6b1b3dSJohannes Berg if (rate & STA_STATS_RATE_VHT) { 19784f6b1b3dSJohannes Berg rinfo->flags = RATE_INFO_FLAGS_VHT_MCS; 19794f6b1b3dSJohannes Berg rinfo->mcs = rate & 0xf; 19804f6b1b3dSJohannes Berg rinfo->nss = (rate & 0xf0) >> 4; 19814f6b1b3dSJohannes Berg } else if (rate & STA_STATS_RATE_HT) { 19824f6b1b3dSJohannes Berg rinfo->flags = RATE_INFO_FLAGS_MCS; 19834f6b1b3dSJohannes Berg rinfo->mcs = rate & 0xff; 19844f6b1b3dSJohannes Berg } else if (rate & STA_STATS_RATE_LEGACY) { 1985fbd6ff5cSJohannes Berg struct ieee80211_supported_band *sband; 1986fbd6ff5cSJohannes Berg u16 brate; 19874f6b1b3dSJohannes Berg unsigned int shift; 1988fbd6ff5cSJohannes Berg 19894f6b1b3dSJohannes Berg sband = local->hw.wiphy->bands[(rate >> 4) & 0xf]; 19904f6b1b3dSJohannes Berg brate = sband->bitrates[rate & 0xf].bitrate; 19914f6b1b3dSJohannes Berg if (rinfo->bw == RATE_INFO_BW_5) 19924f6b1b3dSJohannes Berg shift = 2; 19934f6b1b3dSJohannes Berg else if (rinfo->bw == RATE_INFO_BW_10) 19944f6b1b3dSJohannes Berg shift = 1; 19954f6b1b3dSJohannes Berg else 19964f6b1b3dSJohannes Berg shift = 0; 1997fbd6ff5cSJohannes Berg rinfo->legacy = DIV_ROUND_UP(brate, 1 << shift); 1998fbd6ff5cSJohannes Berg } 1999fbd6ff5cSJohannes Berg 20004f6b1b3dSJohannes Berg if (rate & STA_STATS_RATE_SGI) 2001fbd6ff5cSJohannes Berg rinfo->flags |= RATE_INFO_FLAGS_SHORT_GI; 20024f6b1b3dSJohannes Berg } 2003fbd6ff5cSJohannes Berg 20044f6b1b3dSJohannes Berg static void sta_set_rate_info_rx(struct sta_info *sta, struct rate_info *rinfo) 20054f6b1b3dSJohannes Berg { 2006c9c5962bSJohannes Berg u16 rate = ACCESS_ONCE(sta_get_last_rx_stats(sta)->last_rate); 20074f6b1b3dSJohannes Berg 20084f6b1b3dSJohannes Berg if (rate == STA_STATS_RATE_INVALID) 20094f6b1b3dSJohannes Berg rinfo->flags = 0; 2010fbd6ff5cSJohannes Berg else 20114f6b1b3dSJohannes Berg sta_stats_decode_rate(sta->local, rate, rinfo); 2012fbd6ff5cSJohannes Berg } 2013fbd6ff5cSJohannes Berg 20140f9c5a61SJohannes Berg static void sta_set_tidstats(struct sta_info *sta, 20150f9c5a61SJohannes Berg struct cfg80211_tid_stats *tidstats, 20160f9c5a61SJohannes Berg int tid) 20170f9c5a61SJohannes Berg { 20180f9c5a61SJohannes Berg struct ieee80211_local *local = sta->local; 20190f9c5a61SJohannes Berg 20200f9c5a61SJohannes Berg if (!(tidstats->filled & BIT(NL80211_TID_STATS_RX_MSDU))) { 20210f9c5a61SJohannes Berg unsigned int start; 20220f9c5a61SJohannes Berg 20230f9c5a61SJohannes Berg do { 20240f9c5a61SJohannes Berg start = u64_stats_fetch_begin(&sta->rx_stats.syncp); 20250f9c5a61SJohannes Berg tidstats->rx_msdu = sta->rx_stats.msdu[tid]; 20260f9c5a61SJohannes Berg } while (u64_stats_fetch_retry(&sta->rx_stats.syncp, start)); 20270f9c5a61SJohannes Berg 20280f9c5a61SJohannes Berg tidstats->filled |= BIT(NL80211_TID_STATS_RX_MSDU); 20290f9c5a61SJohannes Berg } 20300f9c5a61SJohannes Berg 20310f9c5a61SJohannes Berg if (!(tidstats->filled & BIT(NL80211_TID_STATS_TX_MSDU))) { 20320f9c5a61SJohannes Berg tidstats->filled |= BIT(NL80211_TID_STATS_TX_MSDU); 20330f9c5a61SJohannes Berg tidstats->tx_msdu = sta->tx_stats.msdu[tid]; 20340f9c5a61SJohannes Berg } 20350f9c5a61SJohannes Berg 20360f9c5a61SJohannes Berg if (!(tidstats->filled & BIT(NL80211_TID_STATS_TX_MSDU_RETRIES)) && 20370f9c5a61SJohannes Berg ieee80211_hw_check(&local->hw, REPORTS_TX_ACK_STATUS)) { 20380f9c5a61SJohannes Berg tidstats->filled |= BIT(NL80211_TID_STATS_TX_MSDU_RETRIES); 20390f9c5a61SJohannes Berg tidstats->tx_msdu_retries = sta->status_stats.msdu_retries[tid]; 20400f9c5a61SJohannes Berg } 20410f9c5a61SJohannes Berg 20420f9c5a61SJohannes Berg if (!(tidstats->filled & BIT(NL80211_TID_STATS_TX_MSDU_FAILED)) && 20430f9c5a61SJohannes Berg ieee80211_hw_check(&local->hw, REPORTS_TX_ACK_STATUS)) { 20440f9c5a61SJohannes Berg tidstats->filled |= BIT(NL80211_TID_STATS_TX_MSDU_FAILED); 20450f9c5a61SJohannes Berg tidstats->tx_msdu_failed = sta->status_stats.msdu_failed[tid]; 20460f9c5a61SJohannes Berg } 20470f9c5a61SJohannes Berg } 20480f9c5a61SJohannes Berg 2049c9c5962bSJohannes Berg static inline u64 sta_get_stats_bytes(struct ieee80211_sta_rx_stats *rxstats) 2050c9c5962bSJohannes Berg { 2051c9c5962bSJohannes Berg unsigned int start; 2052c9c5962bSJohannes Berg u64 value; 2053c9c5962bSJohannes Berg 2054c9c5962bSJohannes Berg do { 2055c9c5962bSJohannes Berg start = u64_stats_fetch_begin(&rxstats->syncp); 2056c9c5962bSJohannes Berg value = rxstats->bytes; 2057c9c5962bSJohannes Berg } while (u64_stats_fetch_retry(&rxstats->syncp, start)); 2058c9c5962bSJohannes Berg 2059c9c5962bSJohannes Berg return value; 2060c9c5962bSJohannes Berg } 2061c9c5962bSJohannes Berg 2062b7ffbd7eSJohannes Berg void sta_set_sinfo(struct sta_info *sta, struct station_info *sinfo) 2063b7ffbd7eSJohannes Berg { 2064b7ffbd7eSJohannes Berg struct ieee80211_sub_if_data *sdata = sta->sdata; 2065b7ffbd7eSJohannes Berg struct ieee80211_local *local = sdata->local; 20669a244409SJohn W. Linville struct rate_control_ref *ref = NULL; 2067b7ffbd7eSJohannes Berg u32 thr = 0; 2068c9c5962bSJohannes Berg int i, ac, cpu; 2069c9c5962bSJohannes Berg struct ieee80211_sta_rx_stats *last_rxstats; 2070c9c5962bSJohannes Berg 2071c9c5962bSJohannes Berg last_rxstats = sta_get_last_rx_stats(sta); 2072b7ffbd7eSJohannes Berg 20739a244409SJohn W. Linville if (test_sta_flag(sta, WLAN_STA_RATE_CONTROL)) 20749a244409SJohn W. Linville ref = local->rate_ctrl; 20759a244409SJohn W. Linville 2076b7ffbd7eSJohannes Berg sinfo->generation = sdata->local->sta_generation; 2077b7ffbd7eSJohannes Berg 2078225b8189SJohannes Berg /* do before driver, so beacon filtering drivers have a 2079225b8189SJohannes Berg * chance to e.g. just add the number of filtered beacons 2080225b8189SJohannes Berg * (or just modify the value entirely, of course) 2081225b8189SJohannes Berg */ 2082225b8189SJohannes Berg if (sdata->vif.type == NL80211_IFTYPE_STATION) 2083225b8189SJohannes Berg sinfo->rx_beacon = sdata->u.mgd.count_beacon_signal; 2084225b8189SJohannes Berg 20852b9a7e1bSJohannes Berg drv_sta_statistics(local, sdata, &sta->sta, sinfo); 20862b9a7e1bSJohannes Berg 2087319090bfSJohannes Berg sinfo->filled |= BIT(NL80211_STA_INFO_INACTIVE_TIME) | 2088319090bfSJohannes Berg BIT(NL80211_STA_INFO_STA_FLAGS) | 2089319090bfSJohannes Berg BIT(NL80211_STA_INFO_BSS_PARAM) | 2090319090bfSJohannes Berg BIT(NL80211_STA_INFO_CONNECTED_TIME) | 2091976bd9efSJohannes Berg BIT(NL80211_STA_INFO_RX_DROP_MISC); 2092976bd9efSJohannes Berg 2093976bd9efSJohannes Berg if (sdata->vif.type == NL80211_IFTYPE_STATION) { 2094976bd9efSJohannes Berg sinfo->beacon_loss_count = sdata->u.mgd.beacon_loss_count; 2095976bd9efSJohannes Berg sinfo->filled |= BIT(NL80211_STA_INFO_BEACON_LOSS); 2096976bd9efSJohannes Berg } 2097b7ffbd7eSJohannes Berg 209884b00607SArnd Bergmann sinfo->connected_time = ktime_get_seconds() - sta->last_connected; 2099e5a9f8d0SJohannes Berg sinfo->inactive_time = 2100b8da6b6aSJohannes Berg jiffies_to_msecs(jiffies - ieee80211_sta_last_active(sta)); 21012b9a7e1bSJohannes Berg 2102319090bfSJohannes Berg if (!(sinfo->filled & (BIT(NL80211_STA_INFO_TX_BYTES64) | 2103319090bfSJohannes Berg BIT(NL80211_STA_INFO_TX_BYTES)))) { 2104b7ffbd7eSJohannes Berg sinfo->tx_bytes = 0; 21052b9a7e1bSJohannes Berg for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) 2106e5a9f8d0SJohannes Berg sinfo->tx_bytes += sta->tx_stats.bytes[ac]; 2107319090bfSJohannes Berg sinfo->filled |= BIT(NL80211_STA_INFO_TX_BYTES64); 2108b7ffbd7eSJohannes Berg } 21092b9a7e1bSJohannes Berg 2110319090bfSJohannes Berg if (!(sinfo->filled & BIT(NL80211_STA_INFO_TX_PACKETS))) { 21112b9a7e1bSJohannes Berg sinfo->tx_packets = 0; 21122b9a7e1bSJohannes Berg for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) 2113e5a9f8d0SJohannes Berg sinfo->tx_packets += sta->tx_stats.packets[ac]; 2114319090bfSJohannes Berg sinfo->filled |= BIT(NL80211_STA_INFO_TX_PACKETS); 21152b9a7e1bSJohannes Berg } 21162b9a7e1bSJohannes Berg 2117319090bfSJohannes Berg if (!(sinfo->filled & (BIT(NL80211_STA_INFO_RX_BYTES64) | 2118319090bfSJohannes Berg BIT(NL80211_STA_INFO_RX_BYTES)))) { 2119c9c5962bSJohannes Berg sinfo->rx_bytes += sta_get_stats_bytes(&sta->rx_stats); 21200f9c5a61SJohannes Berg 2121c9c5962bSJohannes Berg if (sta->pcpu_rx_stats) { 2122c9c5962bSJohannes Berg for_each_possible_cpu(cpu) { 2123c9c5962bSJohannes Berg struct ieee80211_sta_rx_stats *cpurxs; 2124c9c5962bSJohannes Berg 2125c9c5962bSJohannes Berg cpurxs = per_cpu_ptr(sta->pcpu_rx_stats, cpu); 2126c9c5962bSJohannes Berg sinfo->rx_bytes += sta_get_stats_bytes(cpurxs); 2127c9c5962bSJohannes Berg } 2128c9c5962bSJohannes Berg } 2129c9c5962bSJohannes Berg 2130319090bfSJohannes Berg sinfo->filled |= BIT(NL80211_STA_INFO_RX_BYTES64); 21312b9a7e1bSJohannes Berg } 21322b9a7e1bSJohannes Berg 2133319090bfSJohannes Berg if (!(sinfo->filled & BIT(NL80211_STA_INFO_RX_PACKETS))) { 2134e5a9f8d0SJohannes Berg sinfo->rx_packets = sta->rx_stats.packets; 2135c9c5962bSJohannes Berg if (sta->pcpu_rx_stats) { 2136c9c5962bSJohannes Berg for_each_possible_cpu(cpu) { 2137c9c5962bSJohannes Berg struct ieee80211_sta_rx_stats *cpurxs; 2138c9c5962bSJohannes Berg 2139c9c5962bSJohannes Berg cpurxs = per_cpu_ptr(sta->pcpu_rx_stats, cpu); 2140c9c5962bSJohannes Berg sinfo->rx_packets += cpurxs->packets; 2141c9c5962bSJohannes Berg } 2142c9c5962bSJohannes Berg } 2143319090bfSJohannes Berg sinfo->filled |= BIT(NL80211_STA_INFO_RX_PACKETS); 21442b9a7e1bSJohannes Berg } 21452b9a7e1bSJohannes Berg 2146319090bfSJohannes Berg if (!(sinfo->filled & BIT(NL80211_STA_INFO_TX_RETRIES))) { 2147e5a9f8d0SJohannes Berg sinfo->tx_retries = sta->status_stats.retry_count; 2148319090bfSJohannes Berg sinfo->filled |= BIT(NL80211_STA_INFO_TX_RETRIES); 21492b9a7e1bSJohannes Berg } 21502b9a7e1bSJohannes Berg 2151319090bfSJohannes Berg if (!(sinfo->filled & BIT(NL80211_STA_INFO_TX_FAILED))) { 2152e5a9f8d0SJohannes Berg sinfo->tx_failed = sta->status_stats.retry_failed; 2153319090bfSJohannes Berg sinfo->filled |= BIT(NL80211_STA_INFO_TX_FAILED); 21542b9a7e1bSJohannes Berg } 21552b9a7e1bSJohannes Berg 2156e5a9f8d0SJohannes Berg sinfo->rx_dropped_misc = sta->rx_stats.dropped; 2157c9c5962bSJohannes Berg if (sta->pcpu_rx_stats) { 2158c9c5962bSJohannes Berg for_each_possible_cpu(cpu) { 2159c9c5962bSJohannes Berg struct ieee80211_sta_rx_stats *cpurxs; 2160c9c5962bSJohannes Berg 2161c9c5962bSJohannes Berg cpurxs = per_cpu_ptr(sta->pcpu_rx_stats, cpu); 2162c9c5962bSJohannes Berg sinfo->rx_packets += cpurxs->dropped; 2163c9c5962bSJohannes Berg } 2164c9c5962bSJohannes Berg } 2165b7ffbd7eSJohannes Berg 2166225b8189SJohannes Berg if (sdata->vif.type == NL80211_IFTYPE_STATION && 2167225b8189SJohannes Berg !(sdata->vif.driver_flags & IEEE80211_VIF_BEACON_FILTER)) { 2168225b8189SJohannes Berg sinfo->filled |= BIT(NL80211_STA_INFO_BEACON_RX) | 2169225b8189SJohannes Berg BIT(NL80211_STA_INFO_BEACON_SIGNAL_AVG); 2170225b8189SJohannes Berg sinfo->rx_beacon_signal_avg = ieee80211_ave_rssi(&sdata->vif); 2171225b8189SJohannes Berg } 2172225b8189SJohannes Berg 217330686bf7SJohannes Berg if (ieee80211_hw_check(&sta->local->hw, SIGNAL_DBM) || 217430686bf7SJohannes Berg ieee80211_hw_check(&sta->local->hw, SIGNAL_UNSPEC)) { 2175319090bfSJohannes Berg if (!(sinfo->filled & BIT(NL80211_STA_INFO_SIGNAL))) { 2176c9c5962bSJohannes Berg sinfo->signal = (s8)last_rxstats->last_signal; 2177319090bfSJohannes Berg sinfo->filled |= BIT(NL80211_STA_INFO_SIGNAL); 2178b7ffbd7eSJohannes Berg } 21792b9a7e1bSJohannes Berg 2180c9c5962bSJohannes Berg if (!sta->pcpu_rx_stats && 2181c9c5962bSJohannes Berg !(sinfo->filled & BIT(NL80211_STA_INFO_SIGNAL_AVG))) { 218240d9a38aSJohannes Berg sinfo->signal_avg = 21830be6ed13SJohannes Berg -ewma_signal_read(&sta->rx_stats_avg.signal); 2184319090bfSJohannes Berg sinfo->filled |= BIT(NL80211_STA_INFO_SIGNAL_AVG); 21852b9a7e1bSJohannes Berg } 21862b9a7e1bSJohannes Berg } 21872b9a7e1bSJohannes Berg 2188c9c5962bSJohannes Berg /* for the average - if pcpu_rx_stats isn't set - rxstats must point to 2189c9c5962bSJohannes Berg * the sta->rx_stats struct, so the check here is fine with and without 2190c9c5962bSJohannes Berg * pcpu statistics 2191c9c5962bSJohannes Berg */ 2192c9c5962bSJohannes Berg if (last_rxstats->chains && 2193319090bfSJohannes Berg !(sinfo->filled & (BIT(NL80211_STA_INFO_CHAIN_SIGNAL) | 2194319090bfSJohannes Berg BIT(NL80211_STA_INFO_CHAIN_SIGNAL_AVG)))) { 2195c9c5962bSJohannes Berg sinfo->filled |= BIT(NL80211_STA_INFO_CHAIN_SIGNAL); 2196c9c5962bSJohannes Berg if (!sta->pcpu_rx_stats) 2197c9c5962bSJohannes Berg sinfo->filled |= BIT(NL80211_STA_INFO_CHAIN_SIGNAL_AVG); 2198b7ffbd7eSJohannes Berg 2199c9c5962bSJohannes Berg sinfo->chains = last_rxstats->chains; 2200c9c5962bSJohannes Berg 2201b7ffbd7eSJohannes Berg for (i = 0; i < ARRAY_SIZE(sinfo->chain_signal); i++) { 2202e5a9f8d0SJohannes Berg sinfo->chain_signal[i] = 2203c9c5962bSJohannes Berg last_rxstats->chain_signal_last[i]; 2204b7ffbd7eSJohannes Berg sinfo->chain_signal_avg[i] = 22050be6ed13SJohannes Berg -ewma_signal_read(&sta->rx_stats_avg.chain_signal[i]); 2206b7ffbd7eSJohannes Berg } 2207b7ffbd7eSJohannes Berg } 2208b7ffbd7eSJohannes Berg 2209319090bfSJohannes Berg if (!(sinfo->filled & BIT(NL80211_STA_INFO_TX_BITRATE))) { 2210e5a9f8d0SJohannes Berg sta_set_rate_info_tx(sta, &sta->tx_stats.last_rate, 2211e5a9f8d0SJohannes Berg &sinfo->txrate); 2212319090bfSJohannes Berg sinfo->filled |= BIT(NL80211_STA_INFO_TX_BITRATE); 22132b9a7e1bSJohannes Berg } 22142b9a7e1bSJohannes Berg 2215319090bfSJohannes Berg if (!(sinfo->filled & BIT(NL80211_STA_INFO_RX_BITRATE))) { 2216b7ffbd7eSJohannes Berg sta_set_rate_info_rx(sta, &sinfo->rxrate); 2217319090bfSJohannes Berg sinfo->filled |= BIT(NL80211_STA_INFO_RX_BITRATE); 22182b9a7e1bSJohannes Berg } 2219b7ffbd7eSJohannes Berg 222079c892b8SJohannes Berg sinfo->filled |= BIT(NL80211_STA_INFO_TID_STATS); 222179c892b8SJohannes Berg for (i = 0; i < IEEE80211_NUM_TIDS + 1; i++) { 222279c892b8SJohannes Berg struct cfg80211_tid_stats *tidstats = &sinfo->pertid[i]; 222379c892b8SJohannes Berg 22240f9c5a61SJohannes Berg sta_set_tidstats(sta, tidstats, i); 222579c892b8SJohannes Berg } 222679c892b8SJohannes Berg 2227b7ffbd7eSJohannes Berg if (ieee80211_vif_is_mesh(&sdata->vif)) { 2228b7ffbd7eSJohannes Berg #ifdef CONFIG_MAC80211_MESH 2229319090bfSJohannes Berg sinfo->filled |= BIT(NL80211_STA_INFO_LLID) | 2230319090bfSJohannes Berg BIT(NL80211_STA_INFO_PLID) | 2231319090bfSJohannes Berg BIT(NL80211_STA_INFO_PLINK_STATE) | 2232319090bfSJohannes Berg BIT(NL80211_STA_INFO_LOCAL_PM) | 2233319090bfSJohannes Berg BIT(NL80211_STA_INFO_PEER_PM) | 2234319090bfSJohannes Berg BIT(NL80211_STA_INFO_NONPEER_PM); 2235b7ffbd7eSJohannes Berg 2236433f5bc1SJohannes Berg sinfo->llid = sta->mesh->llid; 2237433f5bc1SJohannes Berg sinfo->plid = sta->mesh->plid; 2238433f5bc1SJohannes Berg sinfo->plink_state = sta->mesh->plink_state; 2239b7ffbd7eSJohannes Berg if (test_sta_flag(sta, WLAN_STA_TOFFSET_KNOWN)) { 2240319090bfSJohannes Berg sinfo->filled |= BIT(NL80211_STA_INFO_T_OFFSET); 2241433f5bc1SJohannes Berg sinfo->t_offset = sta->mesh->t_offset; 2242b7ffbd7eSJohannes Berg } 2243433f5bc1SJohannes Berg sinfo->local_pm = sta->mesh->local_pm; 2244433f5bc1SJohannes Berg sinfo->peer_pm = sta->mesh->peer_pm; 2245433f5bc1SJohannes Berg sinfo->nonpeer_pm = sta->mesh->nonpeer_pm; 2246b7ffbd7eSJohannes Berg #endif 2247b7ffbd7eSJohannes Berg } 2248b7ffbd7eSJohannes Berg 2249b7ffbd7eSJohannes Berg sinfo->bss_param.flags = 0; 2250b7ffbd7eSJohannes Berg if (sdata->vif.bss_conf.use_cts_prot) 2251b7ffbd7eSJohannes Berg sinfo->bss_param.flags |= BSS_PARAM_FLAGS_CTS_PROT; 2252b7ffbd7eSJohannes Berg if (sdata->vif.bss_conf.use_short_preamble) 2253b7ffbd7eSJohannes Berg sinfo->bss_param.flags |= BSS_PARAM_FLAGS_SHORT_PREAMBLE; 2254b7ffbd7eSJohannes Berg if (sdata->vif.bss_conf.use_short_slot) 2255b7ffbd7eSJohannes Berg sinfo->bss_param.flags |= BSS_PARAM_FLAGS_SHORT_SLOT_TIME; 2256785e21a8SEmmanuel Grumbach sinfo->bss_param.dtim_period = sdata->vif.bss_conf.dtim_period; 2257b7ffbd7eSJohannes Berg sinfo->bss_param.beacon_interval = sdata->vif.bss_conf.beacon_int; 2258b7ffbd7eSJohannes Berg 2259b7ffbd7eSJohannes Berg sinfo->sta_flags.set = 0; 2260b7ffbd7eSJohannes Berg sinfo->sta_flags.mask = BIT(NL80211_STA_FLAG_AUTHORIZED) | 2261b7ffbd7eSJohannes Berg BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) | 2262b7ffbd7eSJohannes Berg BIT(NL80211_STA_FLAG_WME) | 2263b7ffbd7eSJohannes Berg BIT(NL80211_STA_FLAG_MFP) | 2264b7ffbd7eSJohannes Berg BIT(NL80211_STA_FLAG_AUTHENTICATED) | 2265b7ffbd7eSJohannes Berg BIT(NL80211_STA_FLAG_ASSOCIATED) | 2266b7ffbd7eSJohannes Berg BIT(NL80211_STA_FLAG_TDLS_PEER); 2267b7ffbd7eSJohannes Berg if (test_sta_flag(sta, WLAN_STA_AUTHORIZED)) 2268b7ffbd7eSJohannes Berg sinfo->sta_flags.set |= BIT(NL80211_STA_FLAG_AUTHORIZED); 2269b7ffbd7eSJohannes Berg if (test_sta_flag(sta, WLAN_STA_SHORT_PREAMBLE)) 2270b7ffbd7eSJohannes Berg sinfo->sta_flags.set |= BIT(NL80211_STA_FLAG_SHORT_PREAMBLE); 2271a74a8c84SJohannes Berg if (sta->sta.wme) 2272b7ffbd7eSJohannes Berg sinfo->sta_flags.set |= BIT(NL80211_STA_FLAG_WME); 2273b7ffbd7eSJohannes Berg if (test_sta_flag(sta, WLAN_STA_MFP)) 2274b7ffbd7eSJohannes Berg sinfo->sta_flags.set |= BIT(NL80211_STA_FLAG_MFP); 2275b7ffbd7eSJohannes Berg if (test_sta_flag(sta, WLAN_STA_AUTH)) 2276b7ffbd7eSJohannes Berg sinfo->sta_flags.set |= BIT(NL80211_STA_FLAG_AUTHENTICATED); 2277b7ffbd7eSJohannes Berg if (test_sta_flag(sta, WLAN_STA_ASSOC)) 2278b7ffbd7eSJohannes Berg sinfo->sta_flags.set |= BIT(NL80211_STA_FLAG_ASSOCIATED); 2279b7ffbd7eSJohannes Berg if (test_sta_flag(sta, WLAN_STA_TDLS_PEER)) 2280b7ffbd7eSJohannes Berg sinfo->sta_flags.set |= BIT(NL80211_STA_FLAG_TDLS_PEER); 2281b7ffbd7eSJohannes Berg 2282b7ffbd7eSJohannes Berg /* check if the driver has a SW RC implementation */ 2283b7ffbd7eSJohannes Berg if (ref && ref->ops->get_expected_throughput) 2284b7ffbd7eSJohannes Berg thr = ref->ops->get_expected_throughput(sta->rate_ctrl_priv); 2285b7ffbd7eSJohannes Berg else 2286b7ffbd7eSJohannes Berg thr = drv_get_expected_throughput(local, &sta->sta); 2287b7ffbd7eSJohannes Berg 2288b7ffbd7eSJohannes Berg if (thr != 0) { 2289319090bfSJohannes Berg sinfo->filled |= BIT(NL80211_STA_INFO_EXPECTED_THROUGHPUT); 2290b7ffbd7eSJohannes Berg sinfo->expected_throughput = thr; 2291b7ffbd7eSJohannes Berg } 2292b7ffbd7eSJohannes Berg } 2293b8da6b6aSJohannes Berg 2294b8da6b6aSJohannes Berg unsigned long ieee80211_sta_last_active(struct sta_info *sta) 2295b8da6b6aSJohannes Berg { 2296c9c5962bSJohannes Berg struct ieee80211_sta_rx_stats *stats = sta_get_last_rx_stats(sta); 2297c9c5962bSJohannes Berg 2298c9c5962bSJohannes Berg if (time_after(stats->last_rx, sta->status_stats.last_ack)) 2299c9c5962bSJohannes Berg return stats->last_rx; 2300b8da6b6aSJohannes Berg return sta->status_stats.last_ack; 2301b8da6b6aSJohannes Berg } 2302