1f0706e82SJiri Benc /* 2f0706e82SJiri Benc * Copyright 2002-2005, Instant802 Networks, Inc. 3f0706e82SJiri Benc * Copyright 2006-2007 Jiri Benc <jbenc@suse.cz> 4f0706e82SJiri Benc * 5f0706e82SJiri Benc * This program is free software; you can redistribute it and/or modify 6f0706e82SJiri Benc * it under the terms of the GNU General Public License version 2 as 7f0706e82SJiri Benc * published by the Free Software Foundation. 8f0706e82SJiri Benc */ 9f0706e82SJiri Benc 10f0706e82SJiri Benc #include <linux/module.h> 11f0706e82SJiri Benc #include <linux/init.h> 12f0706e82SJiri Benc #include <linux/netdevice.h> 13f0706e82SJiri Benc #include <linux/types.h> 14f0706e82SJiri Benc #include <linux/slab.h> 15f0706e82SJiri Benc #include <linux/skbuff.h> 16f0706e82SJiri Benc #include <linux/if_arp.h> 170d174406SJohannes Berg #include <linux/timer.h> 18d0709a65SJohannes Berg #include <linux/rtnetlink.h> 19f0706e82SJiri Benc 20f0706e82SJiri Benc #include <net/mac80211.h> 21f0706e82SJiri Benc #include "ieee80211_i.h" 2224487981SJohannes Berg #include "driver-ops.h" 232c8dccc7SJohannes Berg #include "rate.h" 24f0706e82SJiri Benc #include "sta_info.h" 25e9f207f0SJiri Benc #include "debugfs_sta.h" 26ee385855SLuis Carlos Cobo #include "mesh.h" 27ce662b44SJohannes Berg #include "wme.h" 28f0706e82SJiri Benc 29d0709a65SJohannes Berg /** 30d0709a65SJohannes Berg * DOC: STA information lifetime rules 31d0709a65SJohannes Berg * 32d0709a65SJohannes Berg * STA info structures (&struct sta_info) are managed in a hash table 33d0709a65SJohannes Berg * for faster lookup and a list for iteration. They are managed using 34d0709a65SJohannes Berg * RCU, i.e. access to the list and hash table is protected by RCU. 35d0709a65SJohannes Berg * 3634e89507SJohannes Berg * Upon allocating a STA info structure with sta_info_alloc(), the caller 3734e89507SJohannes Berg * owns that structure. It must then insert it into the hash table using 3834e89507SJohannes Berg * either sta_info_insert() or sta_info_insert_rcu(); only in the latter 3934e89507SJohannes Berg * case (which acquires an rcu read section but must not be called from 4034e89507SJohannes Berg * within one) will the pointer still be valid after the call. Note that 4134e89507SJohannes Berg * the caller may not do much with the STA info before inserting it, in 4234e89507SJohannes Berg * particular, it may not start any mesh peer link management or add 4334e89507SJohannes Berg * encryption keys. 4493e5deb1SJohannes Berg * 4593e5deb1SJohannes Berg * When the insertion fails (sta_info_insert()) returns non-zero), the 4693e5deb1SJohannes Berg * structure will have been freed by sta_info_insert()! 47d0709a65SJohannes Berg * 4834e89507SJohannes Berg * Station entries are added by mac80211 when you establish a link with a 497e189a12SLuis R. Rodriguez * peer. This means different things for the different type of interfaces 507e189a12SLuis R. Rodriguez * we support. For a regular station this mean we add the AP sta when we 5125985edcSLucas De Marchi * receive an association response from the AP. For IBSS this occurs when 5234e89507SJohannes Berg * get to know about a peer on the same IBSS. For WDS we add the sta for 5325985edcSLucas De Marchi * the peer immediately upon device open. When using AP mode we add stations 5434e89507SJohannes Berg * for each respective station upon request from userspace through nl80211. 557e189a12SLuis R. Rodriguez * 5634e89507SJohannes Berg * In order to remove a STA info structure, various sta_info_destroy_*() 5734e89507SJohannes Berg * calls are available. 58d0709a65SJohannes Berg * 5934e89507SJohannes Berg * There is no concept of ownership on a STA entry, each structure is 6034e89507SJohannes Berg * owned by the global hash table/list until it is removed. All users of 6134e89507SJohannes Berg * the structure need to be RCU protected so that the structure won't be 6234e89507SJohannes Berg * freed before they are done using it. 63d0709a65SJohannes Berg */ 64f0706e82SJiri Benc 65f0706e82SJiri Benc /* Caller must hold local->sta_lock */ 66be8755e1SMichael Wu static int sta_info_hash_del(struct ieee80211_local *local, 67f0706e82SJiri Benc struct sta_info *sta) 68f0706e82SJiri Benc { 69f0706e82SJiri Benc struct sta_info *s; 70f0706e82SJiri Benc 7140b275b6SJohannes Berg s = rcu_dereference_protected(local->sta_hash[STA_HASH(sta->sta.addr)], 7240b275b6SJohannes Berg lockdep_is_held(&local->sta_lock)); 73f0706e82SJiri Benc if (!s) 74be8755e1SMichael Wu return -ENOENT; 75be8755e1SMichael Wu if (s == sta) { 76a9b3cd7fSStephen Hemminger RCU_INIT_POINTER(local->sta_hash[STA_HASH(sta->sta.addr)], 77d0709a65SJohannes Berg s->hnext); 78be8755e1SMichael Wu return 0; 79f0706e82SJiri Benc } 80f0706e82SJiri Benc 8140b275b6SJohannes Berg while (rcu_access_pointer(s->hnext) && 8240b275b6SJohannes Berg rcu_access_pointer(s->hnext) != sta) 8340b275b6SJohannes Berg s = rcu_dereference_protected(s->hnext, 8440b275b6SJohannes Berg lockdep_is_held(&local->sta_lock)); 8540b275b6SJohannes Berg if (rcu_access_pointer(s->hnext)) { 86a9b3cd7fSStephen Hemminger RCU_INIT_POINTER(s->hnext, sta->hnext); 87be8755e1SMichael Wu return 0; 88f0706e82SJiri Benc } 89f0706e82SJiri Benc 90be8755e1SMichael Wu return -ENOENT; 91f0706e82SJiri Benc } 92f0706e82SJiri Benc 93d0709a65SJohannes Berg /* protected by RCU */ 94abe60632SJohannes Berg struct sta_info *sta_info_get(struct ieee80211_sub_if_data *sdata, 95abe60632SJohannes Berg const u8 *addr) 9643ba7e95SJohannes Berg { 97abe60632SJohannes Berg struct ieee80211_local *local = sdata->local; 9843ba7e95SJohannes Berg struct sta_info *sta; 9943ba7e95SJohannes Berg 1000379185bSJohannes Berg sta = rcu_dereference_check(local->sta_hash[STA_HASH(addr)], 1010379185bSJohannes Berg lockdep_is_held(&local->sta_lock) || 1020379185bSJohannes Berg lockdep_is_held(&local->sta_mtx)); 10343ba7e95SJohannes Berg while (sta) { 1042a33bee2SGuy Eilam if (sta->sdata == sdata && !sta->dummy && 1052a33bee2SGuy Eilam memcmp(sta->sta.addr, addr, ETH_ALEN) == 0) 1062a33bee2SGuy Eilam break; 1072a33bee2SGuy Eilam sta = rcu_dereference_check(sta->hnext, 1082a33bee2SGuy Eilam lockdep_is_held(&local->sta_lock) || 1092a33bee2SGuy Eilam lockdep_is_held(&local->sta_mtx)); 1102a33bee2SGuy Eilam } 1112a33bee2SGuy Eilam return sta; 1122a33bee2SGuy Eilam } 1132a33bee2SGuy Eilam 1142a33bee2SGuy Eilam /* get a station info entry even if it is a dummy station*/ 1152a33bee2SGuy Eilam struct sta_info *sta_info_get_rx(struct ieee80211_sub_if_data *sdata, 1162a33bee2SGuy Eilam const u8 *addr) 1172a33bee2SGuy Eilam { 1182a33bee2SGuy Eilam struct ieee80211_local *local = sdata->local; 1192a33bee2SGuy Eilam struct sta_info *sta; 1202a33bee2SGuy Eilam 1212a33bee2SGuy Eilam sta = rcu_dereference_check(local->sta_hash[STA_HASH(addr)], 1222a33bee2SGuy Eilam lockdep_is_held(&local->sta_lock) || 1232a33bee2SGuy Eilam lockdep_is_held(&local->sta_mtx)); 1242a33bee2SGuy Eilam while (sta) { 125abe60632SJohannes Berg if (sta->sdata == sdata && 126abe60632SJohannes Berg memcmp(sta->sta.addr, addr, ETH_ALEN) == 0) 12743ba7e95SJohannes Berg break; 1280379185bSJohannes Berg sta = rcu_dereference_check(sta->hnext, 1290379185bSJohannes Berg lockdep_is_held(&local->sta_lock) || 1300379185bSJohannes Berg lockdep_is_held(&local->sta_mtx)); 13143ba7e95SJohannes Berg } 13243ba7e95SJohannes Berg return sta; 13343ba7e95SJohannes Berg } 13443ba7e95SJohannes Berg 1350e5ded5aSFelix Fietkau /* 1360e5ded5aSFelix Fietkau * Get sta info either from the specified interface 1370e5ded5aSFelix Fietkau * or from one of its vlans 1380e5ded5aSFelix Fietkau */ 1390e5ded5aSFelix Fietkau struct sta_info *sta_info_get_bss(struct ieee80211_sub_if_data *sdata, 1400e5ded5aSFelix Fietkau const u8 *addr) 1410e5ded5aSFelix Fietkau { 1420e5ded5aSFelix Fietkau struct ieee80211_local *local = sdata->local; 1430e5ded5aSFelix Fietkau struct sta_info *sta; 1440e5ded5aSFelix Fietkau 1450379185bSJohannes Berg sta = rcu_dereference_check(local->sta_hash[STA_HASH(addr)], 1460379185bSJohannes Berg lockdep_is_held(&local->sta_lock) || 1470379185bSJohannes Berg lockdep_is_held(&local->sta_mtx)); 1480e5ded5aSFelix Fietkau while (sta) { 1490e5ded5aSFelix Fietkau if ((sta->sdata == sdata || 150a2c1e3daSJohannes Berg (sta->sdata->bss && sta->sdata->bss == sdata->bss)) && 1512a33bee2SGuy Eilam !sta->dummy && 1522a33bee2SGuy Eilam memcmp(sta->sta.addr, addr, ETH_ALEN) == 0) 1532a33bee2SGuy Eilam break; 1542a33bee2SGuy Eilam sta = rcu_dereference_check(sta->hnext, 1552a33bee2SGuy Eilam lockdep_is_held(&local->sta_lock) || 1562a33bee2SGuy Eilam lockdep_is_held(&local->sta_mtx)); 1572a33bee2SGuy Eilam } 1582a33bee2SGuy Eilam return sta; 1592a33bee2SGuy Eilam } 1602a33bee2SGuy Eilam 1612a33bee2SGuy Eilam /* 1622a33bee2SGuy Eilam * Get sta info either from the specified interface 1632a33bee2SGuy Eilam * or from one of its vlans (including dummy stations) 1642a33bee2SGuy Eilam */ 1652a33bee2SGuy Eilam struct sta_info *sta_info_get_bss_rx(struct ieee80211_sub_if_data *sdata, 1662a33bee2SGuy Eilam const u8 *addr) 1672a33bee2SGuy Eilam { 1682a33bee2SGuy Eilam struct ieee80211_local *local = sdata->local; 1692a33bee2SGuy Eilam struct sta_info *sta; 1702a33bee2SGuy Eilam 1712a33bee2SGuy Eilam sta = rcu_dereference_check(local->sta_hash[STA_HASH(addr)], 1722a33bee2SGuy Eilam lockdep_is_held(&local->sta_lock) || 1732a33bee2SGuy Eilam lockdep_is_held(&local->sta_mtx)); 1742a33bee2SGuy Eilam while (sta) { 1752a33bee2SGuy Eilam if ((sta->sdata == sdata || 1762a33bee2SGuy Eilam (sta->sdata->bss && sta->sdata->bss == sdata->bss)) && 1770e5ded5aSFelix Fietkau memcmp(sta->sta.addr, addr, ETH_ALEN) == 0) 1780e5ded5aSFelix Fietkau break; 1790379185bSJohannes Berg sta = rcu_dereference_check(sta->hnext, 1800379185bSJohannes Berg lockdep_is_held(&local->sta_lock) || 1810379185bSJohannes Berg lockdep_is_held(&local->sta_mtx)); 1820e5ded5aSFelix Fietkau } 1830e5ded5aSFelix Fietkau return sta; 1840e5ded5aSFelix Fietkau } 1850e5ded5aSFelix Fietkau 1863b53fde8SJohannes Berg struct sta_info *sta_info_get_by_idx(struct ieee80211_sub_if_data *sdata, 1873b53fde8SJohannes Berg int idx) 188ee385855SLuis Carlos Cobo { 1893b53fde8SJohannes Berg struct ieee80211_local *local = sdata->local; 190ee385855SLuis Carlos Cobo struct sta_info *sta; 191ee385855SLuis Carlos Cobo int i = 0; 192ee385855SLuis Carlos Cobo 193d0709a65SJohannes Berg list_for_each_entry_rcu(sta, &local->sta_list, list) { 1943b53fde8SJohannes Berg if (sdata != sta->sdata) 1952a8ca29aSLuis Carlos Cobo continue; 196ee385855SLuis Carlos Cobo if (i < idx) { 197ee385855SLuis Carlos Cobo ++i; 198ee385855SLuis Carlos Cobo continue; 199ee385855SLuis Carlos Cobo } 2002a8ca29aSLuis Carlos Cobo return sta; 201ee385855SLuis Carlos Cobo } 202ee385855SLuis Carlos Cobo 203ee385855SLuis Carlos Cobo return NULL; 204ee385855SLuis Carlos Cobo } 205f0706e82SJiri Benc 20693e5deb1SJohannes Berg /** 207d9a7ddb0SJohannes Berg * sta_info_free - free STA 20893e5deb1SJohannes Berg * 2096ef307bcSRandy Dunlap * @local: pointer to the global information 21093e5deb1SJohannes Berg * @sta: STA info to free 21193e5deb1SJohannes Berg * 21293e5deb1SJohannes Berg * This function must undo everything done by sta_info_alloc() 213d9a7ddb0SJohannes Berg * that may happen before sta_info_insert(). It may only be 214d9a7ddb0SJohannes Berg * called when sta_info_insert() has not been attempted (and 215d9a7ddb0SJohannes Berg * if that fails, the station is freed anyway.) 21693e5deb1SJohannes Berg */ 217d9a7ddb0SJohannes Berg void sta_info_free(struct ieee80211_local *local, struct sta_info *sta) 21893e5deb1SJohannes Berg { 219af65cd96SJohannes Berg if (sta->rate_ctrl) { 2204b7679a5SJohannes Berg rate_control_free_sta(sta); 22193e5deb1SJohannes Berg rate_control_put(sta->rate_ctrl); 222af65cd96SJohannes Berg } 22393e5deb1SJohannes Berg 22493e5deb1SJohannes Berg #ifdef CONFIG_MAC80211_VERBOSE_DEBUG 2250fb9a9ecSJoe Perches wiphy_debug(local->hw.wiphy, "Destroyed STA %pM\n", sta->sta.addr); 22693e5deb1SJohannes Berg #endif /* CONFIG_MAC80211_VERBOSE_DEBUG */ 22793e5deb1SJohannes Berg 22893e5deb1SJohannes Berg kfree(sta); 22993e5deb1SJohannes Berg } 23093e5deb1SJohannes Berg 231d0709a65SJohannes Berg /* Caller must hold local->sta_lock */ 232d0709a65SJohannes Berg static void sta_info_hash_add(struct ieee80211_local *local, 233d0709a65SJohannes Berg struct sta_info *sta) 234f0706e82SJiri Benc { 23517741cdcSJohannes Berg sta->hnext = local->sta_hash[STA_HASH(sta->sta.addr)]; 236a9b3cd7fSStephen Hemminger RCU_INIT_POINTER(local->sta_hash[STA_HASH(sta->sta.addr)], sta); 237f0706e82SJiri Benc } 238f0706e82SJiri Benc 239af818581SJohannes Berg static void sta_unblock(struct work_struct *wk) 240af818581SJohannes Berg { 241af818581SJohannes Berg struct sta_info *sta; 242af818581SJohannes Berg 243af818581SJohannes Berg sta = container_of(wk, struct sta_info, drv_unblock_wk); 244af818581SJohannes Berg 245af818581SJohannes Berg if (sta->dead) 246af818581SJohannes Berg return; 247af818581SJohannes Berg 248c2c98fdeSJohannes Berg if (!test_sta_flag(sta, WLAN_STA_PS_STA)) 249af818581SJohannes Berg ieee80211_sta_ps_deliver_wakeup(sta); 250c2c98fdeSJohannes Berg else if (test_and_clear_sta_flag(sta, WLAN_STA_PSPOLL)) { 251c2c98fdeSJohannes Berg clear_sta_flag(sta, WLAN_STA_PS_DRIVER); 252ce662b44SJohannes Berg 253ce662b44SJohannes Berg local_bh_disable(); 254af818581SJohannes Berg ieee80211_sta_ps_deliver_poll_response(sta); 255ce662b44SJohannes Berg local_bh_enable(); 256c2c98fdeSJohannes Berg } else if (test_and_clear_sta_flag(sta, WLAN_STA_UAPSD)) { 257c2c98fdeSJohannes Berg clear_sta_flag(sta, WLAN_STA_PS_DRIVER); 258ce662b44SJohannes Berg 259ce662b44SJohannes Berg local_bh_disable(); 26047086fc5SJohannes Berg ieee80211_sta_ps_deliver_uapsd(sta); 261ce662b44SJohannes Berg local_bh_enable(); 26250a9432dSJohannes Berg } else 263c2c98fdeSJohannes Berg clear_sta_flag(sta, WLAN_STA_PS_DRIVER); 264af818581SJohannes Berg } 265af818581SJohannes Berg 266af65cd96SJohannes Berg static int sta_prepare_rate_control(struct ieee80211_local *local, 267af65cd96SJohannes Berg struct sta_info *sta, gfp_t gfp) 268af65cd96SJohannes Berg { 269af65cd96SJohannes Berg if (local->hw.flags & IEEE80211_HW_HAS_RATE_CONTROL) 270af65cd96SJohannes Berg return 0; 271af65cd96SJohannes Berg 272af65cd96SJohannes Berg sta->rate_ctrl = rate_control_get(local->rate_ctrl); 273af65cd96SJohannes Berg sta->rate_ctrl_priv = rate_control_alloc_sta(sta->rate_ctrl, 274af65cd96SJohannes Berg &sta->sta, gfp); 275af65cd96SJohannes Berg if (!sta->rate_ctrl_priv) { 276af65cd96SJohannes Berg rate_control_put(sta->rate_ctrl); 277af65cd96SJohannes Berg return -ENOMEM; 278af65cd96SJohannes Berg } 279af65cd96SJohannes Berg 280af65cd96SJohannes Berg return 0; 281af65cd96SJohannes Berg } 282af65cd96SJohannes Berg 28373651ee6SJohannes Berg struct sta_info *sta_info_alloc(struct ieee80211_sub_if_data *sdata, 28456544160SJohannes Berg const u8 *addr, gfp_t gfp) 285f0706e82SJiri Benc { 286d0709a65SJohannes Berg struct ieee80211_local *local = sdata->local; 287f0706e82SJiri Benc struct sta_info *sta; 288ebe27c91SMohammed Shafi Shajakhan struct timespec uptime; 28916c5f15cSRon Rindjunsky int i; 290f0706e82SJiri Benc 29117741cdcSJohannes Berg sta = kzalloc(sizeof(*sta) + local->hw.sta_data_size, gfp); 292f0706e82SJiri Benc if (!sta) 29373651ee6SJohannes Berg return NULL; 294f0706e82SJiri Benc 29507346f81SJohannes Berg spin_lock_init(&sta->lock); 296af818581SJohannes Berg INIT_WORK(&sta->drv_unblock_wk, sta_unblock); 29767c282c0SJohannes Berg INIT_WORK(&sta->ampdu_mlme.work, ieee80211_ba_session_work); 298a93e3644SJohannes Berg mutex_init(&sta->ampdu_mlme.mtx); 29907346f81SJohannes Berg 30017741cdcSJohannes Berg memcpy(sta->sta.addr, addr, ETH_ALEN); 301d0709a65SJohannes Berg sta->local = local; 302d0709a65SJohannes Berg sta->sdata = sdata; 3038bc8aecdSFelix Fietkau sta->last_rx = jiffies; 304f0706e82SJiri Benc 305ebe27c91SMohammed Shafi Shajakhan do_posix_clock_monotonic_gettime(&uptime); 306ebe27c91SMohammed Shafi Shajakhan sta->last_connected = uptime.tv_sec; 307541a45a1SBruno Randolf ewma_init(&sta->avg_signal, 1024, 8); 308541a45a1SBruno Randolf 309af65cd96SJohannes Berg if (sta_prepare_rate_control(local, sta, gfp)) { 310f0706e82SJiri Benc kfree(sta); 31173651ee6SJohannes Berg return NULL; 312f0706e82SJiri Benc } 313f0706e82SJiri Benc 31416c5f15cSRon Rindjunsky for (i = 0; i < STA_TID_NUM; i++) { 315a622ab72SJohannes Berg /* 316a622ab72SJohannes Berg * timer_to_tid must be initialized with identity mapping 317a622ab72SJohannes Berg * to enable session_timer's data differentiation. See 318a622ab72SJohannes Berg * sta_rx_agg_session_timer_expired for usage. 319a622ab72SJohannes Berg */ 32016c5f15cSRon Rindjunsky sta->timer_to_tid[i] = i; 32116c5f15cSRon Rindjunsky } 322948d887dSJohannes Berg for (i = 0; i < IEEE80211_NUM_ACS; i++) { 323948d887dSJohannes Berg skb_queue_head_init(&sta->ps_tx_buf[i]); 324948d887dSJohannes Berg skb_queue_head_init(&sta->tx_filtered[i]); 325948d887dSJohannes Berg } 32673651ee6SJohannes Berg 327cccaec98SSenthil Balasubramanian for (i = 0; i < NUM_RX_DATA_QUEUES; i++) 3284be929beSAlexey Dobriyan sta->last_seq_ctrl[i] = cpu_to_le16(USHRT_MAX); 329cccaec98SSenthil Balasubramanian 33073651ee6SJohannes Berg #ifdef CONFIG_MAC80211_VERBOSE_DEBUG 3310fb9a9ecSJoe Perches wiphy_debug(local->hw.wiphy, "Allocated STA %pM\n", sta->sta.addr); 33273651ee6SJohannes Berg #endif /* CONFIG_MAC80211_VERBOSE_DEBUG */ 33373651ee6SJohannes Berg 33403e4497eSJohannes Berg #ifdef CONFIG_MAC80211_MESH 33557cf8043SJavier Cardona sta->plink_state = NL80211_PLINK_LISTEN; 33603e4497eSJohannes Berg init_timer(&sta->plink_timer); 33703e4497eSJohannes Berg #endif 33803e4497eSJohannes Berg 33973651ee6SJohannes Berg return sta; 34073651ee6SJohannes Berg } 34173651ee6SJohannes Berg 3422a33bee2SGuy Eilam static int sta_info_finish_insert(struct sta_info *sta, 3432a33bee2SGuy Eilam bool async, bool dummy_reinsert) 34473651ee6SJohannes Berg { 34573651ee6SJohannes Berg struct ieee80211_local *local = sta->local; 34673651ee6SJohannes Berg struct ieee80211_sub_if_data *sdata = sta->sdata; 34798b62183SJohannes Berg struct station_info sinfo; 34873651ee6SJohannes Berg unsigned long flags; 34993e5deb1SJohannes Berg int err = 0; 35073651ee6SJohannes Berg 35146a5ebafSJohannes Berg lockdep_assert_held(&local->sta_mtx); 35234e89507SJohannes Berg 3532a33bee2SGuy Eilam if (!sta->dummy || dummy_reinsert) { 35434e89507SJohannes Berg /* notify driver */ 35534e89507SJohannes Berg err = drv_sta_add(local, sdata, &sta->sta); 35634e89507SJohannes Berg if (err) { 357*8bf11d8dSJohannes Berg if (sdata->vif.type != NL80211_IFTYPE_ADHOC) 35834e89507SJohannes Berg return err; 3592a33bee2SGuy Eilam printk(KERN_DEBUG "%s: failed to add IBSS STA %pM to " 3602a33bee2SGuy Eilam "driver (%d) - keeping it anyway.\n", 36134e89507SJohannes Berg sdata->name, sta->sta.addr, err); 362*8bf11d8dSJohannes Berg } else 36334e89507SJohannes Berg sta->uploaded = true; 36434e89507SJohannes Berg 36534e89507SJohannes Berg sdata = sta->sdata; 3662a33bee2SGuy Eilam } 36734e89507SJohannes Berg 3682a33bee2SGuy Eilam if (!dummy_reinsert) { 36934e89507SJohannes Berg local->num_sta++; 37034e89507SJohannes Berg local->sta_generation++; 37134e89507SJohannes Berg smp_mb(); 37234e89507SJohannes Berg 37334e89507SJohannes Berg /* make the station visible */ 37434e89507SJohannes Berg spin_lock_irqsave(&local->sta_lock, flags); 37534e89507SJohannes Berg sta_info_hash_add(local, sta); 37634e89507SJohannes Berg spin_unlock_irqrestore(&local->sta_lock, flags); 37734e89507SJohannes Berg 37834e89507SJohannes Berg list_add(&sta->list, &local->sta_list); 3792a33bee2SGuy Eilam } else { 3802a33bee2SGuy Eilam sta->dummy = false; 3812a33bee2SGuy Eilam } 38234e89507SJohannes Berg 3832a33bee2SGuy Eilam if (!sta->dummy) { 38434e89507SJohannes Berg ieee80211_sta_debugfs_add(sta); 38534e89507SJohannes Berg rate_control_add_sta_debugfs(sta); 38634e89507SJohannes Berg 387f612cedfSJouni Malinen memset(&sinfo, 0, sizeof(sinfo)); 38834e89507SJohannes Berg sinfo.filled = 0; 38934e89507SJohannes Berg sinfo.generation = local->sta_generation; 39034e89507SJohannes Berg cfg80211_new_sta(sdata->dev, sta->sta.addr, &sinfo, GFP_KERNEL); 3912a33bee2SGuy Eilam } 39234e89507SJohannes Berg 39334e89507SJohannes Berg return 0; 39434e89507SJohannes Berg } 39534e89507SJohannes Berg 39634e89507SJohannes Berg static void sta_info_finish_pending(struct ieee80211_local *local) 39734e89507SJohannes Berg { 39834e89507SJohannes Berg struct sta_info *sta; 39934e89507SJohannes Berg unsigned long flags; 40034e89507SJohannes Berg 40134e89507SJohannes Berg spin_lock_irqsave(&local->sta_lock, flags); 40234e89507SJohannes Berg while (!list_empty(&local->sta_pending_list)) { 40334e89507SJohannes Berg sta = list_first_entry(&local->sta_pending_list, 40434e89507SJohannes Berg struct sta_info, list); 40534e89507SJohannes Berg list_del(&sta->list); 40634e89507SJohannes Berg spin_unlock_irqrestore(&local->sta_lock, flags); 40734e89507SJohannes Berg 4082a33bee2SGuy Eilam sta_info_finish_insert(sta, true, false); 40934e89507SJohannes Berg 41034e89507SJohannes Berg spin_lock_irqsave(&local->sta_lock, flags); 41134e89507SJohannes Berg } 41234e89507SJohannes Berg spin_unlock_irqrestore(&local->sta_lock, flags); 41334e89507SJohannes Berg } 41434e89507SJohannes Berg 41534e89507SJohannes Berg static void sta_info_finish_work(struct work_struct *work) 41634e89507SJohannes Berg { 41734e89507SJohannes Berg struct ieee80211_local *local = 41834e89507SJohannes Berg container_of(work, struct ieee80211_local, sta_finish_work); 41934e89507SJohannes Berg 42034e89507SJohannes Berg mutex_lock(&local->sta_mtx); 42134e89507SJohannes Berg sta_info_finish_pending(local); 42234e89507SJohannes Berg mutex_unlock(&local->sta_mtx); 42334e89507SJohannes Berg } 42434e89507SJohannes Berg 4258c71df7aSGuy Eilam static int sta_info_insert_check(struct sta_info *sta) 42634e89507SJohannes Berg { 42734e89507SJohannes Berg struct ieee80211_sub_if_data *sdata = sta->sdata; 42834e89507SJohannes Berg 42903e4497eSJohannes Berg /* 43003e4497eSJohannes Berg * Can't be a WARN_ON because it can be triggered through a race: 43103e4497eSJohannes Berg * something inserts a STA (on one CPU) without holding the RTNL 43203e4497eSJohannes Berg * and another CPU turns off the net device. 43303e4497eSJohannes Berg */ 4348c71df7aSGuy Eilam if (unlikely(!ieee80211_sdata_running(sdata))) 4358c71df7aSGuy Eilam return -ENETDOWN; 43603e4497eSJohannes Berg 43747846c9bSJohannes Berg if (WARN_ON(compare_ether_addr(sta->sta.addr, sdata->vif.addr) == 0 || 4388c71df7aSGuy Eilam is_multicast_ether_addr(sta->sta.addr))) 4398c71df7aSGuy Eilam return -EINVAL; 4408c71df7aSGuy Eilam 4418c71df7aSGuy Eilam return 0; 44293e5deb1SJohannes Berg } 44344213b5eSJohannes Berg 4448c71df7aSGuy Eilam static int sta_info_insert_ibss(struct sta_info *sta) __acquires(RCU) 4458c71df7aSGuy Eilam { 4468c71df7aSGuy Eilam struct ieee80211_local *local = sta->local; 4478c71df7aSGuy Eilam struct ieee80211_sub_if_data *sdata = sta->sdata; 4488c71df7aSGuy Eilam unsigned long flags; 4498c71df7aSGuy Eilam 450d0709a65SJohannes Berg spin_lock_irqsave(&local->sta_lock, flags); 45143ba7e95SJohannes Berg /* check if STA exists already */ 4522a33bee2SGuy Eilam if (sta_info_get_bss_rx(sdata, sta->sta.addr)) { 453d0709a65SJohannes Berg spin_unlock_irqrestore(&local->sta_lock, flags); 45434e89507SJohannes Berg rcu_read_lock(); 4558c71df7aSGuy Eilam return -EEXIST; 45643ba7e95SJohannes Berg } 45734e89507SJohannes Berg 458f0706e82SJiri Benc local->num_sta++; 45934e89507SJohannes Berg local->sta_generation++; 46034e89507SJohannes Berg smp_mb(); 461f0706e82SJiri Benc sta_info_hash_add(local, sta); 46232bfd35dSJohannes Berg 46334e89507SJohannes Berg list_add_tail(&sta->list, &local->sta_pending_list); 46432bfd35dSJohannes Berg 46534e89507SJohannes Berg rcu_read_lock(); 46634e89507SJohannes Berg spin_unlock_irqrestore(&local->sta_lock, flags); 46734e89507SJohannes Berg 46834e89507SJohannes Berg #ifdef CONFIG_MAC80211_VERBOSE_DEBUG 4690fb9a9ecSJoe Perches wiphy_debug(local->hw.wiphy, "Added IBSS STA %pM\n", 4700fb9a9ecSJoe Perches sta->sta.addr); 47134e89507SJohannes Berg #endif /* CONFIG_MAC80211_VERBOSE_DEBUG */ 47234e89507SJohannes Berg 47334e89507SJohannes Berg ieee80211_queue_work(&local->hw, &local->sta_finish_work); 47434e89507SJohannes Berg 47534e89507SJohannes Berg return 0; 47634e89507SJohannes Berg } 47734e89507SJohannes Berg 47834e89507SJohannes Berg /* 4798c71df7aSGuy Eilam * should be called with sta_mtx locked 4808c71df7aSGuy Eilam * this function replaces the mutex lock 4818c71df7aSGuy Eilam * with a RCU lock 4828c71df7aSGuy Eilam */ 4838c71df7aSGuy Eilam static int sta_info_insert_non_ibss(struct sta_info *sta) __acquires(RCU) 4848c71df7aSGuy Eilam { 4858c71df7aSGuy Eilam struct ieee80211_local *local = sta->local; 4868c71df7aSGuy Eilam struct ieee80211_sub_if_data *sdata = sta->sdata; 4878c71df7aSGuy Eilam unsigned long flags; 4882a33bee2SGuy Eilam struct sta_info *exist_sta; 4892a33bee2SGuy Eilam bool dummy_reinsert = false; 4908c71df7aSGuy Eilam int err = 0; 4918c71df7aSGuy Eilam 4928c71df7aSGuy Eilam lockdep_assert_held(&local->sta_mtx); 4938c71df7aSGuy Eilam 4948c71df7aSGuy Eilam /* 49534e89507SJohannes Berg * On first glance, this will look racy, because the code 4968c71df7aSGuy Eilam * in this function, which inserts a station with sleeping, 49734e89507SJohannes Berg * unlocks the sta_lock between checking existence in the 49834e89507SJohannes Berg * hash table and inserting into it. 49934e89507SJohannes Berg * 50034e89507SJohannes Berg * However, it is not racy against itself because it keeps 5018c71df7aSGuy Eilam * the mutex locked. 50234e89507SJohannes Berg */ 50334e89507SJohannes Berg 50434e89507SJohannes Berg spin_lock_irqsave(&local->sta_lock, flags); 5052a33bee2SGuy Eilam /* 5062a33bee2SGuy Eilam * check if STA exists already. 5072a33bee2SGuy Eilam * only accept a scenario of a second call to sta_info_insert_non_ibss 5082a33bee2SGuy Eilam * with a dummy station entry that was inserted earlier 5092a33bee2SGuy Eilam * in that case - assume that the dummy station flag should 5102a33bee2SGuy Eilam * be removed. 5112a33bee2SGuy Eilam */ 5122a33bee2SGuy Eilam exist_sta = sta_info_get_bss_rx(sdata, sta->sta.addr); 5132a33bee2SGuy Eilam if (exist_sta) { 5142a33bee2SGuy Eilam if (exist_sta == sta && sta->dummy) { 5152a33bee2SGuy Eilam dummy_reinsert = true; 5162a33bee2SGuy Eilam } else { 51734e89507SJohannes Berg spin_unlock_irqrestore(&local->sta_lock, flags); 51838a679a5SJouni Malinen mutex_unlock(&local->sta_mtx); 51934e89507SJohannes Berg rcu_read_lock(); 5208c71df7aSGuy Eilam return -EEXIST; 52134e89507SJohannes Berg } 5222a33bee2SGuy Eilam } 52334e89507SJohannes Berg 52434e89507SJohannes Berg spin_unlock_irqrestore(&local->sta_lock, flags); 52534e89507SJohannes Berg 5262a33bee2SGuy Eilam err = sta_info_finish_insert(sta, false, dummy_reinsert); 52734e89507SJohannes Berg if (err) { 52834e89507SJohannes Berg mutex_unlock(&local->sta_mtx); 52934e89507SJohannes Berg rcu_read_lock(); 5308c71df7aSGuy Eilam return err; 53132bfd35dSJohannes Berg } 532d0709a65SJohannes Berg 533f0706e82SJiri Benc #ifdef CONFIG_MAC80211_VERBOSE_DEBUG 5342a33bee2SGuy Eilam wiphy_debug(local->hw.wiphy, "Inserted %sSTA %pM\n", 5352a33bee2SGuy Eilam sta->dummy ? "dummy " : "", sta->sta.addr); 536f0706e82SJiri Benc #endif /* CONFIG_MAC80211_VERBOSE_DEBUG */ 537f0706e82SJiri Benc 53834e89507SJohannes Berg /* move reference to rcu-protected */ 53934e89507SJohannes Berg rcu_read_lock(); 54034e89507SJohannes Berg mutex_unlock(&local->sta_mtx); 541e9f207f0SJiri Benc 54273651ee6SJohannes Berg if (ieee80211_vif_is_mesh(&sdata->vif)) 54373651ee6SJohannes Berg mesh_accept_plinks_update(sdata); 54473651ee6SJohannes Berg 54573651ee6SJohannes Berg return 0; 5468c71df7aSGuy Eilam } 5478c71df7aSGuy Eilam 5488c71df7aSGuy Eilam int sta_info_insert_rcu(struct sta_info *sta) __acquires(RCU) 5498c71df7aSGuy Eilam { 5508c71df7aSGuy Eilam struct ieee80211_local *local = sta->local; 5518c71df7aSGuy Eilam struct ieee80211_sub_if_data *sdata = sta->sdata; 5528c71df7aSGuy Eilam int err = 0; 5538c71df7aSGuy Eilam 5548c71df7aSGuy Eilam err = sta_info_insert_check(sta); 5558c71df7aSGuy Eilam if (err) { 5568c71df7aSGuy Eilam rcu_read_lock(); 5578c71df7aSGuy Eilam goto out_free; 5588c71df7aSGuy Eilam } 5598c71df7aSGuy Eilam 5608c71df7aSGuy Eilam /* 5618c71df7aSGuy Eilam * In ad-hoc mode, we sometimes need to insert stations 5628c71df7aSGuy Eilam * from tasklet context from the RX path. To avoid races, 5638c71df7aSGuy Eilam * always do so in that case -- see the comment below. 5648c71df7aSGuy Eilam */ 5658c71df7aSGuy Eilam if (sdata->vif.type == NL80211_IFTYPE_ADHOC) { 5668c71df7aSGuy Eilam err = sta_info_insert_ibss(sta); 5678c71df7aSGuy Eilam if (err) 5688c71df7aSGuy Eilam goto out_free; 5698c71df7aSGuy Eilam 5708c71df7aSGuy Eilam return 0; 5718c71df7aSGuy Eilam } 5728c71df7aSGuy Eilam 5738c71df7aSGuy Eilam /* 5748c71df7aSGuy Eilam * It might seem that the function called below is in race against 5758c71df7aSGuy Eilam * the function call above that atomically inserts the station... That, 576004c872eSJohannes Berg * however, is not true because the above code can only 577004c872eSJohannes Berg * be invoked for IBSS interfaces, and the below code will 578004c872eSJohannes Berg * not be -- and the two do not race against each other as 579004c872eSJohannes Berg * the hash table also keys off the interface. 580004c872eSJohannes Berg */ 581004c872eSJohannes Berg 582004c872eSJohannes Berg might_sleep(); 583004c872eSJohannes Berg 584004c872eSJohannes Berg mutex_lock(&local->sta_mtx); 585004c872eSJohannes Berg 5868c71df7aSGuy Eilam err = sta_info_insert_non_ibss(sta); 5878c71df7aSGuy Eilam if (err) 588004c872eSJohannes Berg goto out_free; 589d0709a65SJohannes Berg 590004c872eSJohannes Berg return 0; 59193e5deb1SJohannes Berg out_free: 59293e5deb1SJohannes Berg BUG_ON(!err); 593d9a7ddb0SJohannes Berg sta_info_free(local, sta); 59493e5deb1SJohannes Berg return err; 595f0706e82SJiri Benc } 596f0706e82SJiri Benc 59734e89507SJohannes Berg int sta_info_insert(struct sta_info *sta) 59834e89507SJohannes Berg { 59934e89507SJohannes Berg int err = sta_info_insert_rcu(sta); 60034e89507SJohannes Berg 60134e89507SJohannes Berg rcu_read_unlock(); 60234e89507SJohannes Berg 60334e89507SJohannes Berg return err; 60434e89507SJohannes Berg } 60534e89507SJohannes Berg 6062a33bee2SGuy Eilam /* Caller must hold sta->local->sta_mtx */ 6072a33bee2SGuy Eilam int sta_info_reinsert(struct sta_info *sta) 6082a33bee2SGuy Eilam { 6092a33bee2SGuy Eilam struct ieee80211_local *local = sta->local; 6102a33bee2SGuy Eilam int err = 0; 6112a33bee2SGuy Eilam 6122a33bee2SGuy Eilam err = sta_info_insert_check(sta); 6132a33bee2SGuy Eilam if (err) { 6142a33bee2SGuy Eilam mutex_unlock(&local->sta_mtx); 6152a33bee2SGuy Eilam return err; 6162a33bee2SGuy Eilam } 6172a33bee2SGuy Eilam 6182a33bee2SGuy Eilam might_sleep(); 6192a33bee2SGuy Eilam 6202a33bee2SGuy Eilam err = sta_info_insert_non_ibss(sta); 6212a33bee2SGuy Eilam rcu_read_unlock(); 6222a33bee2SGuy Eilam return err; 6232a33bee2SGuy Eilam } 6242a33bee2SGuy Eilam 625f0706e82SJiri Benc static inline void __bss_tim_set(struct ieee80211_if_ap *bss, u16 aid) 626004c872eSJohannes Berg { 627004c872eSJohannes Berg /* 628004c872eSJohannes Berg * This format has been mandated by the IEEE specifications, 629004c872eSJohannes Berg * so this line may not be changed to use the __set_bit() format. 630004c872eSJohannes Berg */ 631004c872eSJohannes Berg bss->tim[aid / 8] |= (1 << (aid % 8)); 632004c872eSJohannes Berg } 633004c872eSJohannes Berg 634004c872eSJohannes Berg static inline void __bss_tim_clear(struct ieee80211_if_ap *bss, u16 aid) 635004c872eSJohannes Berg { 636004c872eSJohannes Berg /* 637004c872eSJohannes Berg * This format has been mandated by the IEEE specifications, 638004c872eSJohannes Berg * so this line may not be changed to use the __clear_bit() format. 639004c872eSJohannes Berg */ 640004c872eSJohannes Berg bss->tim[aid / 8] &= ~(1 << (aid % 8)); 641004c872eSJohannes Berg } 642004c872eSJohannes Berg 643948d887dSJohannes Berg static unsigned long ieee80211_tids_for_ac(int ac) 644004c872eSJohannes Berg { 645948d887dSJohannes Berg /* If we ever support TIDs > 7, this obviously needs to be adjusted */ 646948d887dSJohannes Berg switch (ac) { 647948d887dSJohannes Berg case IEEE80211_AC_VO: 648948d887dSJohannes Berg return BIT(6) | BIT(7); 649948d887dSJohannes Berg case IEEE80211_AC_VI: 650948d887dSJohannes Berg return BIT(4) | BIT(5); 651948d887dSJohannes Berg case IEEE80211_AC_BE: 652948d887dSJohannes Berg return BIT(0) | BIT(3); 653948d887dSJohannes Berg case IEEE80211_AC_BK: 654948d887dSJohannes Berg return BIT(1) | BIT(2); 655948d887dSJohannes Berg default: 656948d887dSJohannes Berg WARN_ON(1); 657948d887dSJohannes Berg return 0; 658d0709a65SJohannes Berg } 659004c872eSJohannes Berg } 660004c872eSJohannes Berg 661c868cb35SJohannes Berg void sta_info_recalc_tim(struct sta_info *sta) 662004c872eSJohannes Berg { 663c868cb35SJohannes Berg struct ieee80211_local *local = sta->local; 664c868cb35SJohannes Berg struct ieee80211_if_ap *bss = sta->sdata->bss; 665d0709a65SJohannes Berg unsigned long flags; 666948d887dSJohannes Berg bool indicate_tim = false; 667948d887dSJohannes Berg u8 ignore_for_tim = sta->sta.uapsd_queues; 668948d887dSJohannes Berg int ac; 669004c872eSJohannes Berg 670c868cb35SJohannes Berg if (WARN_ON_ONCE(!sta->sdata->bss)) 671c868cb35SJohannes Berg return; 6723e122be0SJohannes Berg 673c868cb35SJohannes Berg /* No need to do anything if the driver does all */ 674c868cb35SJohannes Berg if (local->hw.flags & IEEE80211_HW_AP_LINK_PS) 675c868cb35SJohannes Berg return; 676004c872eSJohannes Berg 677c868cb35SJohannes Berg if (sta->dead) 678c868cb35SJohannes Berg goto done; 6793e122be0SJohannes Berg 680948d887dSJohannes Berg /* 681948d887dSJohannes Berg * If all ACs are delivery-enabled then we should build 682948d887dSJohannes Berg * the TIM bit for all ACs anyway; if only some are then 683948d887dSJohannes Berg * we ignore those and build the TIM bit using only the 684948d887dSJohannes Berg * non-enabled ones. 685948d887dSJohannes Berg */ 686948d887dSJohannes Berg if (ignore_for_tim == BIT(IEEE80211_NUM_ACS) - 1) 687948d887dSJohannes Berg ignore_for_tim = 0; 688948d887dSJohannes Berg 689948d887dSJohannes Berg for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) { 690948d887dSJohannes Berg unsigned long tids; 691948d887dSJohannes Berg 692948d887dSJohannes Berg if (ignore_for_tim & BIT(ac)) 693948d887dSJohannes Berg continue; 694948d887dSJohannes Berg 695948d887dSJohannes Berg indicate_tim |= !skb_queue_empty(&sta->tx_filtered[ac]) || 696948d887dSJohannes Berg !skb_queue_empty(&sta->ps_tx_buf[ac]); 697948d887dSJohannes Berg if (indicate_tim) 698948d887dSJohannes Berg break; 699948d887dSJohannes Berg 700948d887dSJohannes Berg tids = ieee80211_tids_for_ac(ac); 701948d887dSJohannes Berg 702948d887dSJohannes Berg indicate_tim |= 703948d887dSJohannes Berg sta->driver_buffered_tids & tids; 704004c872eSJohannes Berg } 705004c872eSJohannes Berg 706c868cb35SJohannes Berg done: 707c868cb35SJohannes Berg spin_lock_irqsave(&local->sta_lock, flags); 708004c872eSJohannes Berg 709948d887dSJohannes Berg if (indicate_tim) 710c868cb35SJohannes Berg __bss_tim_set(bss, sta->sta.aid); 711c868cb35SJohannes Berg else 71217741cdcSJohannes Berg __bss_tim_clear(bss, sta->sta.aid); 7133e122be0SJohannes Berg 714c868cb35SJohannes Berg if (local->ops->set_tim) { 715c868cb35SJohannes Berg local->tim_in_locked_section = true; 716948d887dSJohannes Berg drv_set_tim(local, &sta->sta, indicate_tim); 717c868cb35SJohannes Berg local->tim_in_locked_section = false; 718004c872eSJohannes Berg } 719004c872eSJohannes Berg 720c868cb35SJohannes Berg spin_unlock_irqrestore(&local->sta_lock, flags); 721004c872eSJohannes Berg } 722004c872eSJohannes Berg 723cd0b8d89SJohannes Berg static bool sta_info_buffer_expired(struct sta_info *sta, struct sk_buff *skb) 724f0706e82SJiri Benc { 725e039fa4aSJohannes Berg struct ieee80211_tx_info *info; 726f0706e82SJiri Benc int timeout; 727f0706e82SJiri Benc 728f0706e82SJiri Benc if (!skb) 729cd0b8d89SJohannes Berg return false; 730f0706e82SJiri Benc 731e039fa4aSJohannes Berg info = IEEE80211_SKB_CB(skb); 732f0706e82SJiri Benc 733f0706e82SJiri Benc /* Timeout: (2 * listen_interval * beacon_int * 1024 / 1000000) sec */ 73457c4d7b4SJohannes Berg timeout = (sta->listen_interval * 73557c4d7b4SJohannes Berg sta->sdata->vif.bss_conf.beacon_int * 73657c4d7b4SJohannes Berg 32 / 15625) * HZ; 737f0706e82SJiri Benc if (timeout < STA_TX_BUFFER_EXPIRE) 738f0706e82SJiri Benc timeout = STA_TX_BUFFER_EXPIRE; 739e039fa4aSJohannes Berg return time_after(jiffies, info->control.jiffies + timeout); 740f0706e82SJiri Benc } 741f0706e82SJiri Benc 742f0706e82SJiri Benc 743948d887dSJohannes Berg static bool sta_info_cleanup_expire_buffered_ac(struct ieee80211_local *local, 744948d887dSJohannes Berg struct sta_info *sta, int ac) 745f0706e82SJiri Benc { 746f0706e82SJiri Benc unsigned long flags; 747f0706e82SJiri Benc struct sk_buff *skb; 748f0706e82SJiri Benc 74960750397SJohannes Berg /* 75060750397SJohannes Berg * First check for frames that should expire on the filtered 75160750397SJohannes Berg * queue. Frames here were rejected by the driver and are on 75260750397SJohannes Berg * a separate queue to avoid reordering with normal PS-buffered 75360750397SJohannes Berg * frames. They also aren't accounted for right now in the 75460750397SJohannes Berg * total_ps_buffered counter. 75560750397SJohannes Berg */ 756f0706e82SJiri Benc for (;;) { 757948d887dSJohannes Berg spin_lock_irqsave(&sta->tx_filtered[ac].lock, flags); 758948d887dSJohannes Berg skb = skb_peek(&sta->tx_filtered[ac]); 75957c4d7b4SJohannes Berg if (sta_info_buffer_expired(sta, skb)) 760948d887dSJohannes Berg skb = __skb_dequeue(&sta->tx_filtered[ac]); 761836341a7SJohannes Berg else 762f0706e82SJiri Benc skb = NULL; 763948d887dSJohannes Berg spin_unlock_irqrestore(&sta->tx_filtered[ac].lock, flags); 764f0706e82SJiri Benc 76560750397SJohannes Berg /* 76660750397SJohannes Berg * Frames are queued in order, so if this one 76760750397SJohannes Berg * hasn't expired yet we can stop testing. If 76860750397SJohannes Berg * we actually reached the end of the queue we 76960750397SJohannes Berg * also need to stop, of course. 77060750397SJohannes Berg */ 77160750397SJohannes Berg if (!skb) 77260750397SJohannes Berg break; 77360750397SJohannes Berg dev_kfree_skb(skb); 77460750397SJohannes Berg } 77560750397SJohannes Berg 77660750397SJohannes Berg /* 77760750397SJohannes Berg * Now also check the normal PS-buffered queue, this will 77860750397SJohannes Berg * only find something if the filtered queue was emptied 77960750397SJohannes Berg * since the filtered frames are all before the normal PS 78060750397SJohannes Berg * buffered frames. 78160750397SJohannes Berg */ 782f0706e82SJiri Benc for (;;) { 783948d887dSJohannes Berg spin_lock_irqsave(&sta->ps_tx_buf[ac].lock, flags); 784948d887dSJohannes Berg skb = skb_peek(&sta->ps_tx_buf[ac]); 785f0706e82SJiri Benc if (sta_info_buffer_expired(sta, skb)) 786948d887dSJohannes Berg skb = __skb_dequeue(&sta->ps_tx_buf[ac]); 787f0706e82SJiri Benc else 788f0706e82SJiri Benc skb = NULL; 789948d887dSJohannes Berg spin_unlock_irqrestore(&sta->ps_tx_buf[ac].lock, flags); 790f0706e82SJiri Benc 79160750397SJohannes Berg /* 79260750397SJohannes Berg * frames are queued in order, so if this one 79360750397SJohannes Berg * hasn't expired yet (or we reached the end of 79460750397SJohannes Berg * the queue) we can stop testing 79560750397SJohannes Berg */ 796836341a7SJohannes Berg if (!skb) 797836341a7SJohannes Berg break; 798836341a7SJohannes Berg 799f0706e82SJiri Benc local->total_ps_buffered--; 800f4ea83ddSJohannes Berg #ifdef CONFIG_MAC80211_VERBOSE_PS_DEBUG 8010c68ae26SJohannes Berg printk(KERN_DEBUG "Buffered frame expired (STA %pM)\n", 8020c68ae26SJohannes Berg sta->sta.addr); 803f4ea83ddSJohannes Berg #endif 804f0706e82SJiri Benc dev_kfree_skb(skb); 805f0706e82SJiri Benc } 8063393a608SJuuso Oikarinen 80760750397SJohannes Berg /* 80860750397SJohannes Berg * Finally, recalculate the TIM bit for this station -- it might 80960750397SJohannes Berg * now be clear because the station was too slow to retrieve its 81060750397SJohannes Berg * frames. 81160750397SJohannes Berg */ 81260750397SJohannes Berg sta_info_recalc_tim(sta); 81360750397SJohannes Berg 81460750397SJohannes Berg /* 81560750397SJohannes Berg * Return whether there are any frames still buffered, this is 81660750397SJohannes Berg * used to check whether the cleanup timer still needs to run, 81760750397SJohannes Berg * if there are no frames we don't need to rearm the timer. 81860750397SJohannes Berg */ 819948d887dSJohannes Berg return !(skb_queue_empty(&sta->ps_tx_buf[ac]) && 820948d887dSJohannes Berg skb_queue_empty(&sta->tx_filtered[ac])); 821948d887dSJohannes Berg } 822948d887dSJohannes Berg 823948d887dSJohannes Berg static bool sta_info_cleanup_expire_buffered(struct ieee80211_local *local, 824948d887dSJohannes Berg struct sta_info *sta) 825948d887dSJohannes Berg { 826948d887dSJohannes Berg bool have_buffered = false; 827948d887dSJohannes Berg int ac; 828948d887dSJohannes Berg 829948d887dSJohannes Berg /* This is only necessary for stations on BSS interfaces */ 830948d887dSJohannes Berg if (!sta->sdata->bss) 831948d887dSJohannes Berg return false; 832948d887dSJohannes Berg 833948d887dSJohannes Berg for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) 834948d887dSJohannes Berg have_buffered |= 835948d887dSJohannes Berg sta_info_cleanup_expire_buffered_ac(local, sta, ac); 836948d887dSJohannes Berg 837948d887dSJohannes Berg return have_buffered; 838f0706e82SJiri Benc } 839f0706e82SJiri Benc 84034e89507SJohannes Berg static int __must_check __sta_info_destroy(struct sta_info *sta) 84134e89507SJohannes Berg { 84234e89507SJohannes Berg struct ieee80211_local *local; 84334e89507SJohannes Berg struct ieee80211_sub_if_data *sdata; 84434e89507SJohannes Berg unsigned long flags; 845948d887dSJohannes Berg int ret, i, ac; 84642624d49SYogesh Ashok Powar struct tid_ampdu_tx *tid_tx; 84734e89507SJohannes Berg 84834e89507SJohannes Berg might_sleep(); 84934e89507SJohannes Berg 85034e89507SJohannes Berg if (!sta) 85134e89507SJohannes Berg return -ENOENT; 85234e89507SJohannes Berg 85334e89507SJohannes Berg local = sta->local; 85434e89507SJohannes Berg sdata = sta->sdata; 85534e89507SJohannes Berg 856098a6070SJohannes Berg /* 857098a6070SJohannes Berg * Before removing the station from the driver and 858098a6070SJohannes Berg * rate control, it might still start new aggregation 859098a6070SJohannes Berg * sessions -- block that to make sure the tear-down 860098a6070SJohannes Berg * will be sufficient. 861098a6070SJohannes Berg */ 862c2c98fdeSJohannes Berg set_sta_flag(sta, WLAN_STA_BLOCK_BA); 86353f73c09SJohannes Berg ieee80211_sta_tear_down_BA_sessions(sta, true); 864098a6070SJohannes Berg 86534e89507SJohannes Berg spin_lock_irqsave(&local->sta_lock, flags); 86634e89507SJohannes Berg ret = sta_info_hash_del(local, sta); 86734e89507SJohannes Berg /* this might still be the pending list ... which is fine */ 86834e89507SJohannes Berg if (!ret) 86934e89507SJohannes Berg list_del(&sta->list); 87034e89507SJohannes Berg spin_unlock_irqrestore(&local->sta_lock, flags); 87134e89507SJohannes Berg if (ret) 87234e89507SJohannes Berg return ret; 87334e89507SJohannes Berg 8748cb23153SJohannes Berg mutex_lock(&local->key_mtx); 875e31b8213SJohannes Berg for (i = 0; i < NUM_DEFAULT_KEYS; i++) 87640b275b6SJohannes Berg __ieee80211_key_free(key_mtx_dereference(local, sta->gtk[i])); 877e31b8213SJohannes Berg if (sta->ptk) 87840b275b6SJohannes Berg __ieee80211_key_free(key_mtx_dereference(local, sta->ptk)); 8798cb23153SJohannes Berg mutex_unlock(&local->key_mtx); 88034e89507SJohannes Berg 88134e89507SJohannes Berg sta->dead = true; 88234e89507SJohannes Berg 883c2c98fdeSJohannes Berg if (test_sta_flag(sta, WLAN_STA_PS_STA) || 884c2c98fdeSJohannes Berg test_sta_flag(sta, WLAN_STA_PS_DRIVER)) { 88534e89507SJohannes Berg BUG_ON(!sdata->bss); 88634e89507SJohannes Berg 887c2c98fdeSJohannes Berg clear_sta_flag(sta, WLAN_STA_PS_STA); 888c2c98fdeSJohannes Berg clear_sta_flag(sta, WLAN_STA_PS_DRIVER); 889c2c98fdeSJohannes Berg 89034e89507SJohannes Berg atomic_dec(&sdata->bss->num_sta_ps); 891c868cb35SJohannes Berg sta_info_recalc_tim(sta); 89234e89507SJohannes Berg } 89334e89507SJohannes Berg 89434e89507SJohannes Berg local->num_sta--; 89534e89507SJohannes Berg local->sta_generation++; 89634e89507SJohannes Berg 89734e89507SJohannes Berg if (sdata->vif.type == NL80211_IFTYPE_AP_VLAN) 898a9b3cd7fSStephen Hemminger RCU_INIT_POINTER(sdata->u.vlan.sta, NULL); 89934e89507SJohannes Berg 900d9a7ddb0SJohannes Berg while (sta->sta_state > IEEE80211_STA_NONE) 901d9a7ddb0SJohannes Berg sta_info_move_state(sta, sta->sta_state - 1); 902d9a7ddb0SJohannes Berg 90334e89507SJohannes Berg if (sta->uploaded) { 90434e89507SJohannes Berg if (sdata->vif.type == NL80211_IFTYPE_AP_VLAN) 90534e89507SJohannes Berg sdata = container_of(sdata->bss, 90634e89507SJohannes Berg struct ieee80211_sub_if_data, 90734e89507SJohannes Berg u.ap); 90834e89507SJohannes Berg drv_sta_remove(local, sdata, &sta->sta); 90934e89507SJohannes Berg sdata = sta->sdata; 91034e89507SJohannes Berg } 91134e89507SJohannes Berg 912e64b3795SJohannes Berg /* 913e64b3795SJohannes Berg * At this point, after we wait for an RCU grace period, 914e64b3795SJohannes Berg * neither mac80211 nor the driver can reference this 915e64b3795SJohannes Berg * sta struct any more except by still existing timers 916e64b3795SJohannes Berg * associated with this station that we clean up below. 917e64b3795SJohannes Berg */ 918e64b3795SJohannes Berg synchronize_rcu(); 919e64b3795SJohannes Berg 920948d887dSJohannes Berg for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) { 921948d887dSJohannes Berg local->total_ps_buffered -= skb_queue_len(&sta->ps_tx_buf[ac]); 922948d887dSJohannes Berg __skb_queue_purge(&sta->ps_tx_buf[ac]); 923948d887dSJohannes Berg __skb_queue_purge(&sta->tx_filtered[ac]); 924948d887dSJohannes Berg } 925c868cb35SJohannes Berg 92634e89507SJohannes Berg #ifdef CONFIG_MAC80211_MESH 927e64b3795SJohannes Berg if (ieee80211_vif_is_mesh(&sdata->vif)) 92834e89507SJohannes Berg mesh_accept_plinks_update(sdata); 92934e89507SJohannes Berg #endif 93034e89507SJohannes Berg 93134e89507SJohannes Berg #ifdef CONFIG_MAC80211_VERBOSE_DEBUG 9320fb9a9ecSJoe Perches wiphy_debug(local->hw.wiphy, "Removed STA %pM\n", sta->sta.addr); 93334e89507SJohannes Berg #endif /* CONFIG_MAC80211_VERBOSE_DEBUG */ 93434e89507SJohannes Berg cancel_work_sync(&sta->drv_unblock_wk); 93534e89507SJohannes Berg 936ec15e68bSJouni Malinen cfg80211_del_sta(sdata->dev, sta->sta.addr, GFP_KERNEL); 937ec15e68bSJouni Malinen 93834e89507SJohannes Berg rate_control_remove_sta_debugfs(sta); 93934e89507SJohannes Berg ieee80211_sta_debugfs_remove(sta); 94034e89507SJohannes Berg 94134e89507SJohannes Berg #ifdef CONFIG_MAC80211_MESH 94234e89507SJohannes Berg if (ieee80211_vif_is_mesh(&sta->sdata->vif)) { 94334e89507SJohannes Berg mesh_plink_deactivate(sta); 94434e89507SJohannes Berg del_timer_sync(&sta->plink_timer); 94534e89507SJohannes Berg } 94634e89507SJohannes Berg #endif 94734e89507SJohannes Berg 94842624d49SYogesh Ashok Powar /* There could be some memory leaks because of ampdu tx pending queue 94942624d49SYogesh Ashok Powar * not being freed before destroying the station info. 95042624d49SYogesh Ashok Powar * 95142624d49SYogesh Ashok Powar * Make sure that such queues are purged before freeing the station 95242624d49SYogesh Ashok Powar * info. 95342624d49SYogesh Ashok Powar * TODO: We have to somehow postpone the full destruction 95442624d49SYogesh Ashok Powar * until the aggregation stop completes. Refer 95542624d49SYogesh Ashok Powar * http://thread.gmane.org/gmane.linux.kernel.wireless.general/81936 95642624d49SYogesh Ashok Powar */ 95742624d49SYogesh Ashok Powar for (i = 0; i < STA_TID_NUM; i++) { 95842624d49SYogesh Ashok Powar if (!sta->ampdu_mlme.tid_tx[i]) 95942624d49SYogesh Ashok Powar continue; 96042624d49SYogesh Ashok Powar tid_tx = sta->ampdu_mlme.tid_tx[i]; 96142624d49SYogesh Ashok Powar if (skb_queue_len(&tid_tx->pending)) { 96242624d49SYogesh Ashok Powar #ifdef CONFIG_MAC80211_HT_DEBUG 96342624d49SYogesh Ashok Powar wiphy_debug(local->hw.wiphy, "TX A-MPDU purging %d " 96442624d49SYogesh Ashok Powar "packets for tid=%d\n", 96542624d49SYogesh Ashok Powar skb_queue_len(&tid_tx->pending), i); 96642624d49SYogesh Ashok Powar #endif /* CONFIG_MAC80211_HT_DEBUG */ 96742624d49SYogesh Ashok Powar __skb_queue_purge(&tid_tx->pending); 96842624d49SYogesh Ashok Powar } 96942624d49SYogesh Ashok Powar kfree_rcu(tid_tx, rcu_head); 97042624d49SYogesh Ashok Powar } 97142624d49SYogesh Ashok Powar 972d9a7ddb0SJohannes Berg sta_info_free(local, sta); 97334e89507SJohannes Berg 97434e89507SJohannes Berg return 0; 97534e89507SJohannes Berg } 97634e89507SJohannes Berg 97734e89507SJohannes Berg int sta_info_destroy_addr(struct ieee80211_sub_if_data *sdata, const u8 *addr) 97834e89507SJohannes Berg { 97934e89507SJohannes Berg struct sta_info *sta; 98034e89507SJohannes Berg int ret; 98134e89507SJohannes Berg 98234e89507SJohannes Berg mutex_lock(&sdata->local->sta_mtx); 9832a33bee2SGuy Eilam sta = sta_info_get_rx(sdata, addr); 98434e89507SJohannes Berg ret = __sta_info_destroy(sta); 98534e89507SJohannes Berg mutex_unlock(&sdata->local->sta_mtx); 98634e89507SJohannes Berg 98734e89507SJohannes Berg return ret; 98834e89507SJohannes Berg } 98934e89507SJohannes Berg 99034e89507SJohannes Berg int sta_info_destroy_addr_bss(struct ieee80211_sub_if_data *sdata, 99134e89507SJohannes Berg const u8 *addr) 99234e89507SJohannes Berg { 99334e89507SJohannes Berg struct sta_info *sta; 99434e89507SJohannes Berg int ret; 99534e89507SJohannes Berg 99634e89507SJohannes Berg mutex_lock(&sdata->local->sta_mtx); 9972a33bee2SGuy Eilam sta = sta_info_get_bss_rx(sdata, addr); 99834e89507SJohannes Berg ret = __sta_info_destroy(sta); 99934e89507SJohannes Berg mutex_unlock(&sdata->local->sta_mtx); 100034e89507SJohannes Berg 100134e89507SJohannes Berg return ret; 100234e89507SJohannes Berg } 1003f0706e82SJiri Benc 1004f0706e82SJiri Benc static void sta_info_cleanup(unsigned long data) 1005f0706e82SJiri Benc { 1006f0706e82SJiri Benc struct ieee80211_local *local = (struct ieee80211_local *) data; 1007f0706e82SJiri Benc struct sta_info *sta; 10083393a608SJuuso Oikarinen bool timer_needed = false; 1009f0706e82SJiri Benc 1010d0709a65SJohannes Berg rcu_read_lock(); 1011d0709a65SJohannes Berg list_for_each_entry_rcu(sta, &local->sta_list, list) 10123393a608SJuuso Oikarinen if (sta_info_cleanup_expire_buffered(local, sta)) 10133393a608SJuuso Oikarinen timer_needed = true; 1014d0709a65SJohannes Berg rcu_read_unlock(); 1015f0706e82SJiri Benc 10165bb644a0SJohannes Berg if (local->quiescing) 10175bb644a0SJohannes Berg return; 10185bb644a0SJohannes Berg 10193393a608SJuuso Oikarinen if (!timer_needed) 10203393a608SJuuso Oikarinen return; 10213393a608SJuuso Oikarinen 102226d59535SJohannes Berg mod_timer(&local->sta_cleanup, 102326d59535SJohannes Berg round_jiffies(jiffies + STA_INFO_CLEANUP_INTERVAL)); 1024f0706e82SJiri Benc } 1025f0706e82SJiri Benc 1026f0706e82SJiri Benc void sta_info_init(struct ieee80211_local *local) 1027f0706e82SJiri Benc { 1028d0709a65SJohannes Berg spin_lock_init(&local->sta_lock); 102934e89507SJohannes Berg mutex_init(&local->sta_mtx); 1030f0706e82SJiri Benc INIT_LIST_HEAD(&local->sta_list); 103134e89507SJohannes Berg INIT_LIST_HEAD(&local->sta_pending_list); 103234e89507SJohannes Berg INIT_WORK(&local->sta_finish_work, sta_info_finish_work); 1033f0706e82SJiri Benc 1034b24b8a24SPavel Emelyanov setup_timer(&local->sta_cleanup, sta_info_cleanup, 1035b24b8a24SPavel Emelyanov (unsigned long)local); 1036f0706e82SJiri Benc } 1037f0706e82SJiri Benc 1038f0706e82SJiri Benc void sta_info_stop(struct ieee80211_local *local) 1039f0706e82SJiri Benc { 1040f0706e82SJiri Benc del_timer(&local->sta_cleanup); 1041be8755e1SMichael Wu sta_info_flush(local, NULL); 1042f0706e82SJiri Benc } 1043f0706e82SJiri Benc 1044f0706e82SJiri Benc /** 1045f0706e82SJiri Benc * sta_info_flush - flush matching STA entries from the STA table 104644213b5eSJohannes Berg * 104744213b5eSJohannes Berg * Returns the number of removed STA entries. 104844213b5eSJohannes Berg * 1049f0706e82SJiri Benc * @local: local interface data 1050d0709a65SJohannes Berg * @sdata: matching rule for the net device (sta->dev) or %NULL to match all STAs 1051f0706e82SJiri Benc */ 105244213b5eSJohannes Berg int sta_info_flush(struct ieee80211_local *local, 1053d0709a65SJohannes Berg struct ieee80211_sub_if_data *sdata) 1054f0706e82SJiri Benc { 1055f0706e82SJiri Benc struct sta_info *sta, *tmp; 105644213b5eSJohannes Berg int ret = 0; 1057f0706e82SJiri Benc 1058d0709a65SJohannes Berg might_sleep(); 1059d0709a65SJohannes Berg 106034e89507SJohannes Berg mutex_lock(&local->sta_mtx); 1061d0709a65SJohannes Berg 106234e89507SJohannes Berg sta_info_finish_pending(local); 106334e89507SJohannes Berg 106434e89507SJohannes Berg list_for_each_entry_safe(sta, tmp, &local->sta_list, list) { 106534e89507SJohannes Berg if (!sdata || sdata == sta->sdata) 106634e89507SJohannes Berg WARN_ON(__sta_info_destroy(sta)); 106734e89507SJohannes Berg } 106834e89507SJohannes Berg mutex_unlock(&local->sta_mtx); 106944213b5eSJohannes Berg 107044213b5eSJohannes Berg return ret; 1071f0706e82SJiri Benc } 1072dc6676b7SJohannes Berg 107324723d1bSJohannes Berg void ieee80211_sta_expire(struct ieee80211_sub_if_data *sdata, 107424723d1bSJohannes Berg unsigned long exp_time) 107524723d1bSJohannes Berg { 107624723d1bSJohannes Berg struct ieee80211_local *local = sdata->local; 107724723d1bSJohannes Berg struct sta_info *sta, *tmp; 107824723d1bSJohannes Berg 107934e89507SJohannes Berg mutex_lock(&local->sta_mtx); 108024723d1bSJohannes Berg list_for_each_entry_safe(sta, tmp, &local->sta_list, list) 108124723d1bSJohannes Berg if (time_after(jiffies, sta->last_rx + exp_time)) { 108224723d1bSJohannes Berg #ifdef CONFIG_MAC80211_IBSS_DEBUG 10830c68ae26SJohannes Berg printk(KERN_DEBUG "%s: expiring inactive STA %pM\n", 108447846c9bSJohannes Berg sdata->name, sta->sta.addr); 108524723d1bSJohannes Berg #endif 108634e89507SJohannes Berg WARN_ON(__sta_info_destroy(sta)); 108724723d1bSJohannes Berg } 108834e89507SJohannes Berg mutex_unlock(&local->sta_mtx); 108924723d1bSJohannes Berg } 109017741cdcSJohannes Berg 1091686b9cb9SBen Greear struct ieee80211_sta *ieee80211_find_sta_by_ifaddr(struct ieee80211_hw *hw, 1092686b9cb9SBen Greear const u8 *addr, 1093686b9cb9SBen Greear const u8 *localaddr) 109417741cdcSJohannes Berg { 1095abe60632SJohannes Berg struct sta_info *sta, *nxt; 109617741cdcSJohannes Berg 1097686b9cb9SBen Greear /* 1098686b9cb9SBen Greear * Just return a random station if localaddr is NULL 1099686b9cb9SBen Greear * ... first in list. 1100686b9cb9SBen Greear */ 1101f7c65594SJohannes Berg for_each_sta_info(hw_to_local(hw), addr, sta, nxt) { 1102686b9cb9SBen Greear if (localaddr && 1103686b9cb9SBen Greear compare_ether_addr(sta->sdata->vif.addr, localaddr) != 0) 1104686b9cb9SBen Greear continue; 1105f7c65594SJohannes Berg if (!sta->uploaded) 1106f7c65594SJohannes Berg return NULL; 110717741cdcSJohannes Berg return &sta->sta; 1108f7c65594SJohannes Berg } 1109f7c65594SJohannes Berg 1110abe60632SJohannes Berg return NULL; 111117741cdcSJohannes Berg } 1112686b9cb9SBen Greear EXPORT_SYMBOL_GPL(ieee80211_find_sta_by_ifaddr); 11135ed176e1SJohannes Berg 11145ed176e1SJohannes Berg struct ieee80211_sta *ieee80211_find_sta(struct ieee80211_vif *vif, 11155ed176e1SJohannes Berg const u8 *addr) 11165ed176e1SJohannes Berg { 1117f7c65594SJohannes Berg struct sta_info *sta; 11185ed176e1SJohannes Berg 11195ed176e1SJohannes Berg if (!vif) 11205ed176e1SJohannes Berg return NULL; 11215ed176e1SJohannes Berg 1122f7c65594SJohannes Berg sta = sta_info_get_bss(vif_to_sdata(vif), addr); 1123f7c65594SJohannes Berg if (!sta) 1124f7c65594SJohannes Berg return NULL; 11255ed176e1SJohannes Berg 1126f7c65594SJohannes Berg if (!sta->uploaded) 1127f7c65594SJohannes Berg return NULL; 1128f7c65594SJohannes Berg 1129f7c65594SJohannes Berg return &sta->sta; 11305ed176e1SJohannes Berg } 113117741cdcSJohannes Berg EXPORT_SYMBOL(ieee80211_find_sta); 1132af818581SJohannes Berg 113350a9432dSJohannes Berg static void clear_sta_ps_flags(void *_sta) 113450a9432dSJohannes Berg { 113550a9432dSJohannes Berg struct sta_info *sta = _sta; 113650a9432dSJohannes Berg 1137c2c98fdeSJohannes Berg clear_sta_flag(sta, WLAN_STA_PS_DRIVER); 1138c2c98fdeSJohannes Berg clear_sta_flag(sta, WLAN_STA_PS_STA); 113950a9432dSJohannes Berg } 114050a9432dSJohannes Berg 1141af818581SJohannes Berg /* powersave support code */ 1142af818581SJohannes Berg void ieee80211_sta_ps_deliver_wakeup(struct sta_info *sta) 1143af818581SJohannes Berg { 1144af818581SJohannes Berg struct ieee80211_sub_if_data *sdata = sta->sdata; 1145af818581SJohannes Berg struct ieee80211_local *local = sdata->local; 1146948d887dSJohannes Berg struct sk_buff_head pending; 1147948d887dSJohannes Berg int filtered = 0, buffered = 0, ac; 1148af818581SJohannes Berg 1149c2c98fdeSJohannes Berg clear_sta_flag(sta, WLAN_STA_SP); 115047086fc5SJohannes Berg 1151948d887dSJohannes Berg BUILD_BUG_ON(BITS_TO_LONGS(STA_TID_NUM) > 1); 1152948d887dSJohannes Berg sta->driver_buffered_tids = 0; 1153948d887dSJohannes Berg 1154d057e5a3SArik Nemtsov if (!(local->hw.flags & IEEE80211_HW_AP_LINK_PS)) 115512375ef9SJohannes Berg drv_sta_notify(local, sdata, STA_NOTIFY_AWAKE, &sta->sta); 1156af818581SJohannes Berg 1157948d887dSJohannes Berg skb_queue_head_init(&pending); 1158af818581SJohannes Berg 1159af818581SJohannes Berg /* Send all buffered frames to the station */ 1160948d887dSJohannes Berg for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) { 1161948d887dSJohannes Berg int count = skb_queue_len(&pending), tmp; 1162948d887dSJohannes Berg 1163948d887dSJohannes Berg skb_queue_splice_tail_init(&sta->tx_filtered[ac], &pending); 1164948d887dSJohannes Berg tmp = skb_queue_len(&pending); 1165948d887dSJohannes Berg filtered += tmp - count; 1166948d887dSJohannes Berg count = tmp; 1167948d887dSJohannes Berg 1168948d887dSJohannes Berg skb_queue_splice_tail_init(&sta->ps_tx_buf[ac], &pending); 1169948d887dSJohannes Berg tmp = skb_queue_len(&pending); 1170948d887dSJohannes Berg buffered += tmp - count; 1171948d887dSJohannes Berg } 1172948d887dSJohannes Berg 1173948d887dSJohannes Berg ieee80211_add_pending_skbs_fn(local, &pending, clear_sta_ps_flags, sta); 1174948d887dSJohannes Berg 1175af818581SJohannes Berg local->total_ps_buffered -= buffered; 1176af818581SJohannes Berg 1177c868cb35SJohannes Berg sta_info_recalc_tim(sta); 1178c868cb35SJohannes Berg 1179af818581SJohannes Berg #ifdef CONFIG_MAC80211_VERBOSE_PS_DEBUG 1180af818581SJohannes Berg printk(KERN_DEBUG "%s: STA %pM aid %d sending %d filtered/%d PS frames " 118147846c9bSJohannes Berg "since STA not sleeping anymore\n", sdata->name, 1182948d887dSJohannes Berg sta->sta.addr, sta->sta.aid, filtered, buffered); 1183af818581SJohannes Berg #endif /* CONFIG_MAC80211_VERBOSE_PS_DEBUG */ 1184af818581SJohannes Berg } 1185af818581SJohannes Berg 1186ce662b44SJohannes Berg static void ieee80211_send_null_response(struct ieee80211_sub_if_data *sdata, 1187ce662b44SJohannes Berg struct sta_info *sta, int tid, 118840b96408SJohannes Berg enum ieee80211_frame_release_type reason) 1189ce662b44SJohannes Berg { 1190ce662b44SJohannes Berg struct ieee80211_local *local = sdata->local; 1191ce662b44SJohannes Berg struct ieee80211_qos_hdr *nullfunc; 1192ce662b44SJohannes Berg struct sk_buff *skb; 1193ce662b44SJohannes Berg int size = sizeof(*nullfunc); 1194ce662b44SJohannes Berg __le16 fc; 1195c2c98fdeSJohannes Berg bool qos = test_sta_flag(sta, WLAN_STA_WME); 1196ce662b44SJohannes Berg struct ieee80211_tx_info *info; 1197ce662b44SJohannes Berg 1198ce662b44SJohannes Berg if (qos) { 1199ce662b44SJohannes Berg fc = cpu_to_le16(IEEE80211_FTYPE_DATA | 1200ce662b44SJohannes Berg IEEE80211_STYPE_QOS_NULLFUNC | 1201ce662b44SJohannes Berg IEEE80211_FCTL_FROMDS); 1202ce662b44SJohannes Berg } else { 1203ce662b44SJohannes Berg size -= 2; 1204ce662b44SJohannes Berg fc = cpu_to_le16(IEEE80211_FTYPE_DATA | 1205ce662b44SJohannes Berg IEEE80211_STYPE_NULLFUNC | 1206ce662b44SJohannes Berg IEEE80211_FCTL_FROMDS); 1207ce662b44SJohannes Berg } 1208ce662b44SJohannes Berg 1209ce662b44SJohannes Berg skb = dev_alloc_skb(local->hw.extra_tx_headroom + size); 1210ce662b44SJohannes Berg if (!skb) 1211ce662b44SJohannes Berg return; 1212ce662b44SJohannes Berg 1213ce662b44SJohannes Berg skb_reserve(skb, local->hw.extra_tx_headroom); 1214ce662b44SJohannes Berg 1215ce662b44SJohannes Berg nullfunc = (void *) skb_put(skb, size); 1216ce662b44SJohannes Berg nullfunc->frame_control = fc; 1217ce662b44SJohannes Berg nullfunc->duration_id = 0; 1218ce662b44SJohannes Berg memcpy(nullfunc->addr1, sta->sta.addr, ETH_ALEN); 1219ce662b44SJohannes Berg memcpy(nullfunc->addr2, sdata->vif.addr, ETH_ALEN); 1220ce662b44SJohannes Berg memcpy(nullfunc->addr3, sdata->vif.addr, ETH_ALEN); 1221ce662b44SJohannes Berg 1222ce662b44SJohannes Berg skb->priority = tid; 1223ce662b44SJohannes Berg skb_set_queue_mapping(skb, ieee802_1d_to_ac[tid]); 122459b66255SJohannes Berg if (qos) { 1225ce662b44SJohannes Berg nullfunc->qos_ctrl = cpu_to_le16(tid); 1226ce662b44SJohannes Berg 122740b96408SJohannes Berg if (reason == IEEE80211_FRAME_RELEASE_UAPSD) 1228ce662b44SJohannes Berg nullfunc->qos_ctrl |= 1229ce662b44SJohannes Berg cpu_to_le16(IEEE80211_QOS_CTL_EOSP); 1230ce662b44SJohannes Berg } 1231ce662b44SJohannes Berg 1232ce662b44SJohannes Berg info = IEEE80211_SKB_CB(skb); 1233ce662b44SJohannes Berg 1234ce662b44SJohannes Berg /* 1235ce662b44SJohannes Berg * Tell TX path to send this frame even though the 1236ce662b44SJohannes Berg * STA may still remain is PS mode after this frame 1237deeaee19SJohannes Berg * exchange. Also set EOSP to indicate this packet 1238deeaee19SJohannes Berg * ends the poll/service period. 1239ce662b44SJohannes Berg */ 1240deeaee19SJohannes Berg info->flags |= IEEE80211_TX_CTL_POLL_RESPONSE | 1241deeaee19SJohannes Berg IEEE80211_TX_STATUS_EOSP | 1242ce662b44SJohannes Berg IEEE80211_TX_CTL_REQ_TX_STATUS; 1243ce662b44SJohannes Berg 124440b96408SJohannes Berg drv_allow_buffered_frames(local, sta, BIT(tid), 1, reason, false); 124540b96408SJohannes Berg 1246ce662b44SJohannes Berg ieee80211_xmit(sdata, skb); 1247ce662b44SJohannes Berg } 1248ce662b44SJohannes Berg 124947086fc5SJohannes Berg static void 125047086fc5SJohannes Berg ieee80211_sta_ps_deliver_response(struct sta_info *sta, 125147086fc5SJohannes Berg int n_frames, u8 ignored_acs, 125247086fc5SJohannes Berg enum ieee80211_frame_release_type reason) 1253af818581SJohannes Berg { 1254af818581SJohannes Berg struct ieee80211_sub_if_data *sdata = sta->sdata; 1255af818581SJohannes Berg struct ieee80211_local *local = sdata->local; 12564049e09aSJohannes Berg bool found = false; 1257948d887dSJohannes Berg bool more_data = false; 1258948d887dSJohannes Berg int ac; 12594049e09aSJohannes Berg unsigned long driver_release_tids = 0; 126047086fc5SJohannes Berg struct sk_buff_head frames; 126147086fc5SJohannes Berg 1262deeaee19SJohannes Berg /* Service or PS-Poll period starts */ 1263c2c98fdeSJohannes Berg set_sta_flag(sta, WLAN_STA_SP); 1264deeaee19SJohannes Berg 126547086fc5SJohannes Berg __skb_queue_head_init(&frames); 1266af818581SJohannes Berg 1267948d887dSJohannes Berg /* 126847086fc5SJohannes Berg * Get response frame(s) and more data bit for it. 1269948d887dSJohannes Berg */ 1270948d887dSJohannes Berg for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) { 12714049e09aSJohannes Berg unsigned long tids; 12724049e09aSJohannes Berg 127347086fc5SJohannes Berg if (ignored_acs & BIT(ac)) 1274948d887dSJohannes Berg continue; 1275948d887dSJohannes Berg 12764049e09aSJohannes Berg tids = ieee80211_tids_for_ac(ac); 12774049e09aSJohannes Berg 12784049e09aSJohannes Berg if (!found) { 12794049e09aSJohannes Berg driver_release_tids = sta->driver_buffered_tids & tids; 12804049e09aSJohannes Berg if (driver_release_tids) { 12814049e09aSJohannes Berg found = true; 12824049e09aSJohannes Berg } else { 128347086fc5SJohannes Berg struct sk_buff *skb; 128447086fc5SJohannes Berg 128547086fc5SJohannes Berg while (n_frames > 0) { 1286948d887dSJohannes Berg skb = skb_dequeue(&sta->tx_filtered[ac]); 1287948d887dSJohannes Berg if (!skb) { 128847086fc5SJohannes Berg skb = skb_dequeue( 128947086fc5SJohannes Berg &sta->ps_tx_buf[ac]); 1290af818581SJohannes Berg if (skb) 1291af818581SJohannes Berg local->total_ps_buffered--; 1292af818581SJohannes Berg } 129347086fc5SJohannes Berg if (!skb) 129447086fc5SJohannes Berg break; 129547086fc5SJohannes Berg n_frames--; 12964049e09aSJohannes Berg found = true; 129747086fc5SJohannes Berg __skb_queue_tail(&frames, skb); 129847086fc5SJohannes Berg } 1299948d887dSJohannes Berg } 1300948d887dSJohannes Berg 13014049e09aSJohannes Berg /* 13024049e09aSJohannes Berg * If the driver has data on more than one TID then 13034049e09aSJohannes Berg * certainly there's more data if we release just a 13044049e09aSJohannes Berg * single frame now (from a single TID). 13054049e09aSJohannes Berg */ 130647086fc5SJohannes Berg if (reason == IEEE80211_FRAME_RELEASE_PSPOLL && 130747086fc5SJohannes Berg hweight16(driver_release_tids) > 1) { 13084049e09aSJohannes Berg more_data = true; 13094049e09aSJohannes Berg driver_release_tids = 13104049e09aSJohannes Berg BIT(ffs(driver_release_tids) - 1); 13114049e09aSJohannes Berg break; 13124049e09aSJohannes Berg } 13134049e09aSJohannes Berg } 1314948d887dSJohannes Berg 1315948d887dSJohannes Berg if (!skb_queue_empty(&sta->tx_filtered[ac]) || 1316948d887dSJohannes Berg !skb_queue_empty(&sta->ps_tx_buf[ac])) { 1317948d887dSJohannes Berg more_data = true; 1318948d887dSJohannes Berg break; 1319948d887dSJohannes Berg } 1320948d887dSJohannes Berg } 1321af818581SJohannes Berg 13224049e09aSJohannes Berg if (!found) { 1323ce662b44SJohannes Berg int tid; 13244049e09aSJohannes Berg 1325ce662b44SJohannes Berg /* 1326ce662b44SJohannes Berg * For PS-Poll, this can only happen due to a race condition 1327ce662b44SJohannes Berg * when we set the TIM bit and the station notices it, but 1328ce662b44SJohannes Berg * before it can poll for the frame we expire it. 1329ce662b44SJohannes Berg * 1330ce662b44SJohannes Berg * For uAPSD, this is said in the standard (11.2.1.5 h): 1331ce662b44SJohannes Berg * At each unscheduled SP for a non-AP STA, the AP shall 1332ce662b44SJohannes Berg * attempt to transmit at least one MSDU or MMPDU, but no 1333ce662b44SJohannes Berg * more than the value specified in the Max SP Length field 1334ce662b44SJohannes Berg * in the QoS Capability element from delivery-enabled ACs, 1335ce662b44SJohannes Berg * that are destined for the non-AP STA. 1336ce662b44SJohannes Berg * 1337ce662b44SJohannes Berg * Since we have no other MSDU/MMPDU, transmit a QoS null frame. 1338ce662b44SJohannes Berg */ 1339ce662b44SJohannes Berg 1340ce662b44SJohannes Berg /* This will evaluate to 1, 3, 5 or 7. */ 1341ce662b44SJohannes Berg tid = 7 - ((ffs(~ignored_acs) - 1) << 1); 1342ce662b44SJohannes Berg 134340b96408SJohannes Berg ieee80211_send_null_response(sdata, sta, tid, reason); 13444049e09aSJohannes Berg return; 13454049e09aSJohannes Berg } 13464049e09aSJohannes Berg 134747086fc5SJohannes Berg if (!driver_release_tids) { 134847086fc5SJohannes Berg struct sk_buff_head pending; 134947086fc5SJohannes Berg struct sk_buff *skb; 135040b96408SJohannes Berg int num = 0; 135140b96408SJohannes Berg u16 tids = 0; 135247086fc5SJohannes Berg 135347086fc5SJohannes Berg skb_queue_head_init(&pending); 135447086fc5SJohannes Berg 135547086fc5SJohannes Berg while ((skb = __skb_dequeue(&frames))) { 1356af818581SJohannes Berg struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb); 135747086fc5SJohannes Berg struct ieee80211_hdr *hdr = (void *) skb->data; 135840b96408SJohannes Berg u8 *qoshdr = NULL; 135940b96408SJohannes Berg 136040b96408SJohannes Berg num++; 1361af818581SJohannes Berg 1362af818581SJohannes Berg /* 136347086fc5SJohannes Berg * Tell TX path to send this frame even though the 136447086fc5SJohannes Berg * STA may still remain is PS mode after this frame 136547086fc5SJohannes Berg * exchange. 1366af818581SJohannes Berg */ 136747086fc5SJohannes Berg info->flags |= IEEE80211_TX_CTL_POLL_RESPONSE; 1368af818581SJohannes Berg 136947086fc5SJohannes Berg /* 137047086fc5SJohannes Berg * Use MoreData flag to indicate whether there are 137147086fc5SJohannes Berg * more buffered frames for this STA 137247086fc5SJohannes Berg */ 137324b9c373SJanusz.Dziedzic@tieto.com if (more_data || !skb_queue_empty(&frames)) 137447086fc5SJohannes Berg hdr->frame_control |= 137547086fc5SJohannes Berg cpu_to_le16(IEEE80211_FCTL_MOREDATA); 137624b9c373SJanusz.Dziedzic@tieto.com else 137724b9c373SJanusz.Dziedzic@tieto.com hdr->frame_control &= 137824b9c373SJanusz.Dziedzic@tieto.com cpu_to_le16(~IEEE80211_FCTL_MOREDATA); 1379af818581SJohannes Berg 138040b96408SJohannes Berg if (ieee80211_is_data_qos(hdr->frame_control) || 138140b96408SJohannes Berg ieee80211_is_qos_nullfunc(hdr->frame_control)) 138240b96408SJohannes Berg qoshdr = ieee80211_get_qos_ctl(hdr); 138340b96408SJohannes Berg 138447086fc5SJohannes Berg /* set EOSP for the frame */ 138540b96408SJohannes Berg if (reason == IEEE80211_FRAME_RELEASE_UAPSD && 138640b96408SJohannes Berg qoshdr && skb_queue_empty(&frames)) 138740b96408SJohannes Berg *qoshdr |= IEEE80211_QOS_CTL_EOSP; 1388deeaee19SJohannes Berg 138947086fc5SJohannes Berg info->flags |= IEEE80211_TX_STATUS_EOSP | 139047086fc5SJohannes Berg IEEE80211_TX_CTL_REQ_TX_STATUS; 139147086fc5SJohannes Berg 139240b96408SJohannes Berg if (qoshdr) 139340b96408SJohannes Berg tids |= BIT(*qoshdr & IEEE80211_QOS_CTL_TID_MASK); 139440b96408SJohannes Berg else 139540b96408SJohannes Berg tids |= BIT(0); 139640b96408SJohannes Berg 139747086fc5SJohannes Berg __skb_queue_tail(&pending, skb); 139847086fc5SJohannes Berg } 139947086fc5SJohannes Berg 140040b96408SJohannes Berg drv_allow_buffered_frames(local, sta, tids, num, 140140b96408SJohannes Berg reason, more_data); 140240b96408SJohannes Berg 140347086fc5SJohannes Berg ieee80211_add_pending_skbs(local, &pending); 1404af818581SJohannes Berg 1405c868cb35SJohannes Berg sta_info_recalc_tim(sta); 1406af818581SJohannes Berg } else { 1407af818581SJohannes Berg /* 14084049e09aSJohannes Berg * We need to release a frame that is buffered somewhere in the 14094049e09aSJohannes Berg * driver ... it'll have to handle that. 14104049e09aSJohannes Berg * Note that, as per the comment above, it'll also have to see 14114049e09aSJohannes Berg * if there is more than just one frame on the specific TID that 14124049e09aSJohannes Berg * we're releasing from, and it needs to set the more-data bit 14134049e09aSJohannes Berg * accordingly if we tell it that there's no more data. If we do 14144049e09aSJohannes Berg * tell it there's more data, then of course the more-data bit 14154049e09aSJohannes Berg * needs to be set anyway. 1416af818581SJohannes Berg */ 14174049e09aSJohannes Berg drv_release_buffered_frames(local, sta, driver_release_tids, 141847086fc5SJohannes Berg n_frames, reason, more_data); 14194049e09aSJohannes Berg 14204049e09aSJohannes Berg /* 14214049e09aSJohannes Berg * Note that we don't recalculate the TIM bit here as it would 14224049e09aSJohannes Berg * most likely have no effect at all unless the driver told us 14234049e09aSJohannes Berg * that the TID became empty before returning here from the 14244049e09aSJohannes Berg * release function. 14254049e09aSJohannes Berg * Either way, however, when the driver tells us that the TID 14264049e09aSJohannes Berg * became empty we'll do the TIM recalculation. 14274049e09aSJohannes Berg */ 1428af818581SJohannes Berg } 1429af818581SJohannes Berg } 1430af818581SJohannes Berg 1431af818581SJohannes Berg void ieee80211_sta_ps_deliver_poll_response(struct sta_info *sta) 1432af818581SJohannes Berg { 143347086fc5SJohannes Berg u8 ignore_for_response = sta->sta.uapsd_queues; 1434af818581SJohannes Berg 1435af818581SJohannes Berg /* 143647086fc5SJohannes Berg * If all ACs are delivery-enabled then we should reply 143747086fc5SJohannes Berg * from any of them, if only some are enabled we reply 143847086fc5SJohannes Berg * only from the non-enabled ones. 1439af818581SJohannes Berg */ 144047086fc5SJohannes Berg if (ignore_for_response == BIT(IEEE80211_NUM_ACS) - 1) 144147086fc5SJohannes Berg ignore_for_response = 0; 1442af818581SJohannes Berg 144347086fc5SJohannes Berg ieee80211_sta_ps_deliver_response(sta, 1, ignore_for_response, 144447086fc5SJohannes Berg IEEE80211_FRAME_RELEASE_PSPOLL); 1445af818581SJohannes Berg } 144647086fc5SJohannes Berg 144747086fc5SJohannes Berg void ieee80211_sta_ps_deliver_uapsd(struct sta_info *sta) 144847086fc5SJohannes Berg { 144947086fc5SJohannes Berg int n_frames = sta->sta.max_sp; 145047086fc5SJohannes Berg u8 delivery_enabled = sta->sta.uapsd_queues; 145147086fc5SJohannes Berg 145247086fc5SJohannes Berg /* 145347086fc5SJohannes Berg * If we ever grow support for TSPEC this might happen if 145447086fc5SJohannes Berg * the TSPEC update from hostapd comes in between a trigger 145547086fc5SJohannes Berg * frame setting WLAN_STA_UAPSD in the RX path and this 145647086fc5SJohannes Berg * actually getting called. 145747086fc5SJohannes Berg */ 145847086fc5SJohannes Berg if (!delivery_enabled) 145947086fc5SJohannes Berg return; 146047086fc5SJohannes Berg 146147086fc5SJohannes Berg switch (sta->sta.max_sp) { 146247086fc5SJohannes Berg case 1: 146347086fc5SJohannes Berg n_frames = 2; 146447086fc5SJohannes Berg break; 146547086fc5SJohannes Berg case 2: 146647086fc5SJohannes Berg n_frames = 4; 146747086fc5SJohannes Berg break; 146847086fc5SJohannes Berg case 3: 146947086fc5SJohannes Berg n_frames = 6; 147047086fc5SJohannes Berg break; 147147086fc5SJohannes Berg case 0: 147247086fc5SJohannes Berg /* XXX: what is a good value? */ 147347086fc5SJohannes Berg n_frames = 8; 147447086fc5SJohannes Berg break; 147547086fc5SJohannes Berg } 147647086fc5SJohannes Berg 147747086fc5SJohannes Berg ieee80211_sta_ps_deliver_response(sta, n_frames, ~delivery_enabled, 147847086fc5SJohannes Berg IEEE80211_FRAME_RELEASE_UAPSD); 1479af818581SJohannes Berg } 1480af818581SJohannes Berg 1481af818581SJohannes Berg void ieee80211_sta_block_awake(struct ieee80211_hw *hw, 1482af818581SJohannes Berg struct ieee80211_sta *pubsta, bool block) 1483af818581SJohannes Berg { 1484af818581SJohannes Berg struct sta_info *sta = container_of(pubsta, struct sta_info, sta); 1485af818581SJohannes Berg 1486b5878a2dSJohannes Berg trace_api_sta_block_awake(sta->local, pubsta, block); 1487b5878a2dSJohannes Berg 1488af818581SJohannes Berg if (block) 1489c2c98fdeSJohannes Berg set_sta_flag(sta, WLAN_STA_PS_DRIVER); 1490c2c98fdeSJohannes Berg else if (test_sta_flag(sta, WLAN_STA_PS_DRIVER)) 1491af818581SJohannes Berg ieee80211_queue_work(hw, &sta->drv_unblock_wk); 1492af818581SJohannes Berg } 1493af818581SJohannes Berg EXPORT_SYMBOL(ieee80211_sta_block_awake); 1494dcf55fb5SFelix Fietkau 149537fbd908SJohannes Berg void ieee80211_sta_eosp_irqsafe(struct ieee80211_sta *pubsta) 149637fbd908SJohannes Berg { 149737fbd908SJohannes Berg struct sta_info *sta = container_of(pubsta, struct sta_info, sta); 149837fbd908SJohannes Berg struct ieee80211_local *local = sta->local; 149937fbd908SJohannes Berg struct sk_buff *skb; 150037fbd908SJohannes Berg struct skb_eosp_msg_data *data; 150137fbd908SJohannes Berg 150237fbd908SJohannes Berg trace_api_eosp(local, pubsta); 150337fbd908SJohannes Berg 150437fbd908SJohannes Berg skb = alloc_skb(0, GFP_ATOMIC); 150537fbd908SJohannes Berg if (!skb) { 150637fbd908SJohannes Berg /* too bad ... but race is better than loss */ 150737fbd908SJohannes Berg clear_sta_flag(sta, WLAN_STA_SP); 150837fbd908SJohannes Berg return; 150937fbd908SJohannes Berg } 151037fbd908SJohannes Berg 151137fbd908SJohannes Berg data = (void *)skb->cb; 151237fbd908SJohannes Berg memcpy(data->sta, pubsta->addr, ETH_ALEN); 151337fbd908SJohannes Berg memcpy(data->iface, sta->sdata->vif.addr, ETH_ALEN); 151437fbd908SJohannes Berg skb->pkt_type = IEEE80211_EOSP_MSG; 151537fbd908SJohannes Berg skb_queue_tail(&local->skb_queue, skb); 151637fbd908SJohannes Berg tasklet_schedule(&local->tasklet); 151737fbd908SJohannes Berg } 151837fbd908SJohannes Berg EXPORT_SYMBOL(ieee80211_sta_eosp_irqsafe); 151937fbd908SJohannes Berg 1520042ec453SJohannes Berg void ieee80211_sta_set_buffered(struct ieee80211_sta *pubsta, 1521042ec453SJohannes Berg u8 tid, bool buffered) 1522dcf55fb5SFelix Fietkau { 1523dcf55fb5SFelix Fietkau struct sta_info *sta = container_of(pubsta, struct sta_info, sta); 1524dcf55fb5SFelix Fietkau 1525948d887dSJohannes Berg if (WARN_ON(tid >= STA_TID_NUM)) 1526042ec453SJohannes Berg return; 1527042ec453SJohannes Berg 1528948d887dSJohannes Berg if (buffered) 1529948d887dSJohannes Berg set_bit(tid, &sta->driver_buffered_tids); 1530948d887dSJohannes Berg else 1531948d887dSJohannes Berg clear_bit(tid, &sta->driver_buffered_tids); 1532948d887dSJohannes Berg 1533c868cb35SJohannes Berg sta_info_recalc_tim(sta); 1534dcf55fb5SFelix Fietkau } 1535042ec453SJohannes Berg EXPORT_SYMBOL(ieee80211_sta_set_buffered); 1536d9a7ddb0SJohannes Berg 1537d9a7ddb0SJohannes Berg int sta_info_move_state_checked(struct sta_info *sta, 1538d9a7ddb0SJohannes Berg enum ieee80211_sta_state new_state) 1539d9a7ddb0SJohannes Berg { 1540*8bf11d8dSJohannes Berg might_sleep(); 1541d9a7ddb0SJohannes Berg 1542d9a7ddb0SJohannes Berg if (sta->sta_state == new_state) 1543d9a7ddb0SJohannes Berg return 0; 1544d9a7ddb0SJohannes Berg 1545d9a7ddb0SJohannes Berg switch (new_state) { 1546d9a7ddb0SJohannes Berg case IEEE80211_STA_NONE: 1547d9a7ddb0SJohannes Berg if (sta->sta_state == IEEE80211_STA_AUTH) 1548d9a7ddb0SJohannes Berg clear_bit(WLAN_STA_AUTH, &sta->_flags); 1549d9a7ddb0SJohannes Berg else 1550d9a7ddb0SJohannes Berg return -EINVAL; 1551d9a7ddb0SJohannes Berg break; 1552d9a7ddb0SJohannes Berg case IEEE80211_STA_AUTH: 1553d9a7ddb0SJohannes Berg if (sta->sta_state == IEEE80211_STA_NONE) 1554d9a7ddb0SJohannes Berg set_bit(WLAN_STA_AUTH, &sta->_flags); 1555d9a7ddb0SJohannes Berg else if (sta->sta_state == IEEE80211_STA_ASSOC) 1556d9a7ddb0SJohannes Berg clear_bit(WLAN_STA_ASSOC, &sta->_flags); 1557d9a7ddb0SJohannes Berg else 1558d9a7ddb0SJohannes Berg return -EINVAL; 1559d9a7ddb0SJohannes Berg break; 1560d9a7ddb0SJohannes Berg case IEEE80211_STA_ASSOC: 156129623892SJohannes Berg if (sta->sta_state == IEEE80211_STA_AUTH) { 1562d9a7ddb0SJohannes Berg set_bit(WLAN_STA_ASSOC, &sta->_flags); 156329623892SJohannes Berg } else if (sta->sta_state == IEEE80211_STA_AUTHORIZED) { 156429623892SJohannes Berg if (sta->sdata->vif.type == NL80211_IFTYPE_AP) 156529623892SJohannes Berg atomic_dec(&sta->sdata->u.ap.num_sta_authorized); 1566d9a7ddb0SJohannes Berg clear_bit(WLAN_STA_AUTHORIZED, &sta->_flags); 156729623892SJohannes Berg } else 1568d9a7ddb0SJohannes Berg return -EINVAL; 1569d9a7ddb0SJohannes Berg break; 1570d9a7ddb0SJohannes Berg case IEEE80211_STA_AUTHORIZED: 157129623892SJohannes Berg if (sta->sta_state == IEEE80211_STA_ASSOC) { 157229623892SJohannes Berg if (sta->sdata->vif.type == NL80211_IFTYPE_AP) 157329623892SJohannes Berg atomic_inc(&sta->sdata->u.ap.num_sta_authorized); 1574d9a7ddb0SJohannes Berg set_bit(WLAN_STA_AUTHORIZED, &sta->_flags); 157529623892SJohannes Berg } else 1576d9a7ddb0SJohannes Berg return -EINVAL; 1577d9a7ddb0SJohannes Berg break; 1578d9a7ddb0SJohannes Berg default: 1579d9a7ddb0SJohannes Berg WARN(1, "invalid state %d", new_state); 1580d9a7ddb0SJohannes Berg return -EINVAL; 1581d9a7ddb0SJohannes Berg } 1582d9a7ddb0SJohannes Berg 1583d9a7ddb0SJohannes Berg printk(KERN_DEBUG "%s: moving STA %pM to state %d\n", 1584d9a7ddb0SJohannes Berg sta->sdata->name, sta->sta.addr, new_state); 1585d9a7ddb0SJohannes Berg sta->sta_state = new_state; 1586d9a7ddb0SJohannes Berg 1587d9a7ddb0SJohannes Berg return 0; 1588d9a7ddb0SJohannes Berg } 1589