korg/linux
0
0
Fork 0
mirror of https://mirrors.bfsu.edu.cn/git/linux.git synced 2024-11-26 21:54:11 +08:00
Code Issues Packages Projects Releases Wiki Activity
72c531f8ef
linux/net/mac80211/airtime.c
Sriram R 046d2e7c50 mac80211: prepare sta handling for MLO support 
Currently in mac80211 each STA object is represented
using sta_info datastructure with the associated
STA specific information and drivers access ieee80211_sta
part of it.

With MLO (Multi Link Operation) support being added
in 802.11be standard, though the association is logically
with a single Multi Link capable STA, at the physical level
communication can happen via different advertised
links (uniquely identified by Channel, operating class,
BSSID) and hence the need to handle multiple link
STA parameters within a composite sta_info object
called the MLD STA. The different link STA part of
MLD STA are identified using the link address which can
be same or different as the MLD STA address and unique
link id based on the link vif.

To support extension of such a model, the sta_info
datastructure is modified to hold multiple link STA
objects with link specific params currently within
sta_info moved to this new structure. Similarly this is
done for ieee80211_sta as well which will be accessed
within mac80211 as well as by drivers, hence trivial
driver changes are expected to support this.

For current non MLO supported drivers, only one link STA
is present and link information is accessed via 'deflink'
member.

For MLO drivers, we still need to define the APIs etc. to
get the correct link ID and access the correct part of
the station info.

Currently in mac80211, all link STA info are accessed directly
via deflink. These will be updated to access via link pointers
indexed by link id with MLO support patches, with link id
being 0 for non MLO supported cases.

Except for couple of macro related changes, below spatch takes
care of updating mac80211 and driver code to access to the
link STA info via deflink.

  @ieee80211_sta@
  struct ieee80211_sta *s;
  struct sta_info *si;
  identifier var = {supp_rates, ht_cap, vht_cap, he_cap, he_6ghz_capa, eht_cap, rx_nss, bandwidth, txpwr};
  @@

  (
    s->
  -    var
  +    deflink.var
  |
   si->sta.
  -    var
  +    deflink.var
  )

  @sta_info@
  struct sta_info *si;
  identifier var = {gtk, pcpu_rx_stats, rx_stats, rx_stats_avg, status_stats, tx_stats, cur_max_bandwidth};
  @@

  (
    si->
  -    var
  +    deflink.var
  )

Signed-off-by: Sriram R <quic_srirrama@quicinc.com>
Link: https://lore.kernel.org/r/1649086883-13246-1-git-send-email-quic_srirrama@quicinc.com
[remove MLO-drivers notes from commit message, not clear yet; run spatch]
Signed-off-by: Johannes Berg <johannes.berg@intel.com>
2022-04-11 16:42:03 +02:00

709 lines
19 KiB
C
Raw Blame History

// SPDX-License-Identifier: ISC
/*
* Copyright (C) 2019 Felix Fietkau <nbd@nbd.name>
* Copyright (C) 2021 Intel Corporation
*/
#include <net/mac80211.h>
#include "ieee80211_i.h"
#include "sta_info.h"
#define AVG_PKT_SIZE 1024
/* Number of bits for an average sized packet */
#define MCS_NBITS (AVG_PKT_SIZE << 3)
/* Number of kilo-symbols (symbols * 1024) for a packet with (bps) bits per
* symbol. We use k-symbols to avoid rounding in the _TIME macros below.
*/
#define MCS_N_KSYMS(bps) DIV_ROUND_UP(MCS_NBITS << 10, (bps))
/* Transmission time (in 1024 * usec) for a packet containing (ksyms) * 1024
* symbols.
*/
#define MCS_SYMBOL_TIME(sgi, ksyms) \
(sgi ? \
((ksyms) * 4 * 18) / 20 : /* 3.6 us per sym */ \
((ksyms) * 4) /* 4.0 us per sym */ \
)
/* Transmit duration for the raw data part of an average sized packet */
#define MCS_DURATION(streams, sgi, bps) \
((u32)MCS_SYMBOL_TIME(sgi, MCS_N_KSYMS((streams) * (bps))))
#define MCS_DURATION_S(shift, streams, sgi, bps) \
((u16)((MCS_DURATION(streams, sgi, bps) >> shift)))
/* These should match the values in enum nl80211_he_gi */
#define HE_GI_08 0
#define HE_GI_16 1
#define HE_GI_32 2
/* Transmission time (1024 usec) for a packet containing (ksyms) * k-symbols */
#define HE_SYMBOL_TIME(gi, ksyms) \
(gi == HE_GI_08 ? \
((ksyms) * 16 * 17) / 20 : /* 13.6 us per sym */ \
(gi == HE_GI_16 ? \
((ksyms) * 16 * 18) / 20 : /* 14.4 us per sym */ \
((ksyms) * 16) /* 16.0 us per sym */ \
))
/* Transmit duration for the raw data part of an average sized packet */
#define HE_DURATION(streams, gi, bps) \
((u32)HE_SYMBOL_TIME(gi, MCS_N_KSYMS((streams) * (bps))))
#define HE_DURATION_S(shift, streams, gi, bps) \
(HE_DURATION(streams, gi, bps) >> shift)
#define BW_20 0
#define BW_40 1
#define BW_80 2
#define BW_160 3
/*
* Define group sort order: HT40 -> SGI -> #streams
*/
#define IEEE80211_MAX_STREAMS 4
#define IEEE80211_HT_STREAM_GROUPS 4 /* BW(=2) * SGI(=2) */
#define IEEE80211_VHT_STREAM_GROUPS 8 /* BW(=4) * SGI(=2) */
#define IEEE80211_HE_MAX_STREAMS 8
#define IEEE80211_HT_GROUPS_NB (IEEE80211_MAX_STREAMS * \
IEEE80211_HT_STREAM_GROUPS)
#define IEEE80211_VHT_GROUPS_NB (IEEE80211_MAX_STREAMS * \
IEEE80211_VHT_STREAM_GROUPS)
#define IEEE80211_HT_GROUP_0 0
#define IEEE80211_VHT_GROUP_0 (IEEE80211_HT_GROUP_0 + IEEE80211_HT_GROUPS_NB)
#define IEEE80211_HE_GROUP_0 (IEEE80211_VHT_GROUP_0 + IEEE80211_VHT_GROUPS_NB)
#define MCS_GROUP_RATES 12
#define HT_GROUP_IDX(_streams, _sgi, _ht40) \
IEEE80211_HT_GROUP_0 + \
IEEE80211_MAX_STREAMS * 2 * _ht40 + \
IEEE80211_MAX_STREAMS * _sgi + \
_streams - 1
#define _MAX(a, b) (((a)>(b))?(a):(b))
#define GROUP_SHIFT(duration) \
_MAX(0, 16 - __builtin_clz(duration))
/* MCS rate information for an MCS group */
#define __MCS_GROUP(_streams, _sgi, _ht40, _s) \
[HT_GROUP_IDX(_streams, _sgi, _ht40)] = { \
.shift = _s, \
.duration = { \
MCS_DURATION_S(_s, _streams, _sgi, _ht40 ? 54 : 26), \
MCS_DURATION_S(_s, _streams, _sgi, _ht40 ? 108 : 52), \
MCS_DURATION_S(_s, _streams, _sgi, _ht40 ? 162 : 78), \
MCS_DURATION_S(_s, _streams, _sgi, _ht40 ? 216 : 104), \
MCS_DURATION_S(_s, _streams, _sgi, _ht40 ? 324 : 156), \
MCS_DURATION_S(_s, _streams, _sgi, _ht40 ? 432 : 208), \
MCS_DURATION_S(_s, _streams, _sgi, _ht40 ? 486 : 234), \
MCS_DURATION_S(_s, _streams, _sgi, _ht40 ? 540 : 260) \
} \
}
#define MCS_GROUP_SHIFT(_streams, _sgi, _ht40) \
GROUP_SHIFT(MCS_DURATION(_streams, _sgi, _ht40 ? 54 : 26))
#define MCS_GROUP(_streams, _sgi, _ht40) \
__MCS_GROUP(_streams, _sgi, _ht40, \
MCS_GROUP_SHIFT(_streams, _sgi, _ht40))
#define VHT_GROUP_IDX(_streams, _sgi, _bw) \
(IEEE80211_VHT_GROUP_0 + \
IEEE80211_MAX_STREAMS * 2 * (_bw) + \
IEEE80211_MAX_STREAMS * (_sgi) + \
(_streams) - 1)
#define BW2VBPS(_bw, r4, r3, r2, r1) \
(_bw == BW_160 ? r4 : _bw == BW_80 ? r3 : _bw == BW_40 ? r2 : r1)
#define __VHT_GROUP(_streams, _sgi, _bw, _s) \
[VHT_GROUP_IDX(_streams, _sgi, _bw)] = { \
.shift = _s, \
.duration = { \
MCS_DURATION_S(_s, _streams, _sgi, \
BW2VBPS(_bw, 234, 117, 54, 26)), \
MCS_DURATION_S(_s, _streams, _sgi, \
BW2VBPS(_bw, 468, 234, 108, 52)), \
MCS_DURATION_S(_s, _streams, _sgi, \
BW2VBPS(_bw, 702, 351, 162, 78)), \
MCS_DURATION_S(_s, _streams, _sgi, \
BW2VBPS(_bw, 936, 468, 216, 104)), \
MCS_DURATION_S(_s, _streams, _sgi, \
BW2VBPS(_bw, 1404, 702, 324, 156)), \
MCS_DURATION_S(_s, _streams, _sgi, \
BW2VBPS(_bw, 1872, 936, 432, 208)), \
MCS_DURATION_S(_s, _streams, _sgi, \
BW2VBPS(_bw, 2106, 1053, 486, 234)), \
MCS_DURATION_S(_s, _streams, _sgi, \
BW2VBPS(_bw, 2340, 1170, 540, 260)), \
MCS_DURATION_S(_s, _streams, _sgi, \
BW2VBPS(_bw, 2808, 1404, 648, 312)), \
MCS_DURATION_S(_s, _streams, _sgi, \
BW2VBPS(_bw, 3120, 1560, 720, 346)) \
} \
}
#define VHT_GROUP_SHIFT(_streams, _sgi, _bw) \
GROUP_SHIFT(MCS_DURATION(_streams, _sgi, \
BW2VBPS(_bw, 243, 117, 54, 26)))
#define VHT_GROUP(_streams, _sgi, _bw) \
__VHT_GROUP(_streams, _sgi, _bw, \
VHT_GROUP_SHIFT(_streams, _sgi, _bw))
#define HE_GROUP_IDX(_streams, _gi, _bw) \
(IEEE80211_HE_GROUP_0 + \
IEEE80211_HE_MAX_STREAMS * 3 * (_bw) + \
IEEE80211_HE_MAX_STREAMS * (_gi) + \
(_streams) - 1)
#define __HE_GROUP(_streams, _gi, _bw, _s) \
[HE_GROUP_IDX(_streams, _gi, _bw)] = { \
.shift = _s, \
.duration = { \
HE_DURATION_S(_s, _streams, _gi, \
BW2VBPS(_bw, 979, 489, 230, 115)), \
HE_DURATION_S(_s, _streams, _gi, \
BW2VBPS(_bw, 1958, 979, 475, 230)), \
HE_DURATION_S(_s, _streams, _gi, \
BW2VBPS(_bw, 2937, 1468, 705, 345)), \
HE_DURATION_S(_s, _streams, _gi, \
BW2VBPS(_bw, 3916, 1958, 936, 475)), \
HE_DURATION_S(_s, _streams, _gi, \
BW2VBPS(_bw, 5875, 2937, 1411, 705)), \
HE_DURATION_S(_s, _streams, _gi, \
BW2VBPS(_bw, 7833, 3916, 1872, 936)), \
HE_DURATION_S(_s, _streams, _gi, \
BW2VBPS(_bw, 8827, 4406, 2102, 1051)), \
HE_DURATION_S(_s, _streams, _gi, \
BW2VBPS(_bw, 9806, 4896, 2347, 1166)), \
HE_DURATION_S(_s, _streams, _gi, \
BW2VBPS(_bw, 11764, 5875, 2808, 1411)), \
HE_DURATION_S(_s, _streams, _gi, \
BW2VBPS(_bw, 13060, 6523, 3124, 1555)), \
HE_DURATION_S(_s, _streams, _gi, \
BW2VBPS(_bw, 14702, 7344, 3513, 1756)), \
HE_DURATION_S(_s, _streams, _gi, \
BW2VBPS(_bw, 16329, 8164, 3902, 1944)) \
} \
}
#define HE_GROUP_SHIFT(_streams, _gi, _bw) \
GROUP_SHIFT(HE_DURATION(_streams, _gi, \
BW2VBPS(_bw, 979, 489, 230, 115)))
#define HE_GROUP(_streams, _gi, _bw) \
__HE_GROUP(_streams, _gi, _bw, \
HE_GROUP_SHIFT(_streams, _gi, _bw))
struct mcs_group {
u8 shift;
u16 duration[MCS_GROUP_RATES];
};
static const struct mcs_group airtime_mcs_groups[] = {
MCS_GROUP(1, 0, BW_20),
MCS_GROUP(2, 0, BW_20),
MCS_GROUP(3, 0, BW_20),
MCS_GROUP(4, 0, BW_20),
MCS_GROUP(1, 1, BW_20),
MCS_GROUP(2, 1, BW_20),
MCS_GROUP(3, 1, BW_20),
MCS_GROUP(4, 1, BW_20),
MCS_GROUP(1, 0, BW_40),
MCS_GROUP(2, 0, BW_40),
MCS_GROUP(3, 0, BW_40),
MCS_GROUP(4, 0, BW_40),
MCS_GROUP(1, 1, BW_40),
MCS_GROUP(2, 1, BW_40),
MCS_GROUP(3, 1, BW_40),
MCS_GROUP(4, 1, BW_40),
VHT_GROUP(1, 0, BW_20),
VHT_GROUP(2, 0, BW_20),
VHT_GROUP(3, 0, BW_20),
VHT_GROUP(4, 0, BW_20),
VHT_GROUP(1, 1, BW_20),
VHT_GROUP(2, 1, BW_20),
VHT_GROUP(3, 1, BW_20),
VHT_GROUP(4, 1, BW_20),
VHT_GROUP(1, 0, BW_40),
VHT_GROUP(2, 0, BW_40),
VHT_GROUP(3, 0, BW_40),
VHT_GROUP(4, 0, BW_40),
VHT_GROUP(1, 1, BW_40),
VHT_GROUP(2, 1, BW_40),
VHT_GROUP(3, 1, BW_40),
VHT_GROUP(4, 1, BW_40),
VHT_GROUP(1, 0, BW_80),
VHT_GROUP(2, 0, BW_80),
VHT_GROUP(3, 0, BW_80),
VHT_GROUP(4, 0, BW_80),
VHT_GROUP(1, 1, BW_80),
VHT_GROUP(2, 1, BW_80),
VHT_GROUP(3, 1, BW_80),
VHT_GROUP(4, 1, BW_80),
VHT_GROUP(1, 0, BW_160),
VHT_GROUP(2, 0, BW_160),
VHT_GROUP(3, 0, BW_160),
VHT_GROUP(4, 0, BW_160),
VHT_GROUP(1, 1, BW_160),
VHT_GROUP(2, 1, BW_160),
VHT_GROUP(3, 1, BW_160),
VHT_GROUP(4, 1, BW_160),
HE_GROUP(1, HE_GI_08, BW_20),
HE_GROUP(2, HE_GI_08, BW_20),
HE_GROUP(3, HE_GI_08, BW_20),
HE_GROUP(4, HE_GI_08, BW_20),
HE_GROUP(5, HE_GI_08, BW_20),
HE_GROUP(6, HE_GI_08, BW_20),
HE_GROUP(7, HE_GI_08, BW_20),
HE_GROUP(8, HE_GI_08, BW_20),
HE_GROUP(1, HE_GI_16, BW_20),
HE_GROUP(2, HE_GI_16, BW_20),
HE_GROUP(3, HE_GI_16, BW_20),
HE_GROUP(4, HE_GI_16, BW_20),
HE_GROUP(5, HE_GI_16, BW_20),
HE_GROUP(6, HE_GI_16, BW_20),
HE_GROUP(7, HE_GI_16, BW_20),
HE_GROUP(8, HE_GI_16, BW_20),
HE_GROUP(1, HE_GI_32, BW_20),
HE_GROUP(2, HE_GI_32, BW_20),
HE_GROUP(3, HE_GI_32, BW_20),
HE_GROUP(4, HE_GI_32, BW_20),
HE_GROUP(5, HE_GI_32, BW_20),
HE_GROUP(6, HE_GI_32, BW_20),
HE_GROUP(7, HE_GI_32, BW_20),
HE_GROUP(8, HE_GI_32, BW_20),
HE_GROUP(1, HE_GI_08, BW_40),
HE_GROUP(2, HE_GI_08, BW_40),
HE_GROUP(3, HE_GI_08, BW_40),
HE_GROUP(4, HE_GI_08, BW_40),
HE_GROUP(5, HE_GI_08, BW_40),
HE_GROUP(6, HE_GI_08, BW_40),
HE_GROUP(7, HE_GI_08, BW_40),
HE_GROUP(8, HE_GI_08, BW_40),
HE_GROUP(1, HE_GI_16, BW_40),
HE_GROUP(2, HE_GI_16, BW_40),
HE_GROUP(3, HE_GI_16, BW_40),
HE_GROUP(4, HE_GI_16, BW_40),
HE_GROUP(5, HE_GI_16, BW_40),
HE_GROUP(6, HE_GI_16, BW_40),
HE_GROUP(7, HE_GI_16, BW_40),
HE_GROUP(8, HE_GI_16, BW_40),
HE_GROUP(1, HE_GI_32, BW_40),
HE_GROUP(2, HE_GI_32, BW_40),
HE_GROUP(3, HE_GI_32, BW_40),
HE_GROUP(4, HE_GI_32, BW_40),
HE_GROUP(5, HE_GI_32, BW_40),
HE_GROUP(6, HE_GI_32, BW_40),
HE_GROUP(7, HE_GI_32, BW_40),
HE_GROUP(8, HE_GI_32, BW_40),
HE_GROUP(1, HE_GI_08, BW_80),
HE_GROUP(2, HE_GI_08, BW_80),
HE_GROUP(3, HE_GI_08, BW_80),
HE_GROUP(4, HE_GI_08, BW_80),
HE_GROUP(5, HE_GI_08, BW_80),
HE_GROUP(6, HE_GI_08, BW_80),
HE_GROUP(7, HE_GI_08, BW_80),
HE_GROUP(8, HE_GI_08, BW_80),
HE_GROUP(1, HE_GI_16, BW_80),
HE_GROUP(2, HE_GI_16, BW_80),
HE_GROUP(3, HE_GI_16, BW_80),
HE_GROUP(4, HE_GI_16, BW_80),
HE_GROUP(5, HE_GI_16, BW_80),
HE_GROUP(6, HE_GI_16, BW_80),
HE_GROUP(7, HE_GI_16, BW_80),
HE_GROUP(8, HE_GI_16, BW_80),
HE_GROUP(1, HE_GI_32, BW_80),
HE_GROUP(2, HE_GI_32, BW_80),
HE_GROUP(3, HE_GI_32, BW_80),
HE_GROUP(4, HE_GI_32, BW_80),
HE_GROUP(5, HE_GI_32, BW_80),
HE_GROUP(6, HE_GI_32, BW_80),
HE_GROUP(7, HE_GI_32, BW_80),
HE_GROUP(8, HE_GI_32, BW_80),
HE_GROUP(1, HE_GI_08, BW_160),
HE_GROUP(2, HE_GI_08, BW_160),
HE_GROUP(3, HE_GI_08, BW_160),
HE_GROUP(4, HE_GI_08, BW_160),
HE_GROUP(5, HE_GI_08, BW_160),
HE_GROUP(6, HE_GI_08, BW_160),
HE_GROUP(7, HE_GI_08, BW_160),
HE_GROUP(8, HE_GI_08, BW_160),
HE_GROUP(1, HE_GI_16, BW_160),
HE_GROUP(2, HE_GI_16, BW_160),
HE_GROUP(3, HE_GI_16, BW_160),
HE_GROUP(4, HE_GI_16, BW_160),
HE_GROUP(5, HE_GI_16, BW_160),
HE_GROUP(6, HE_GI_16, BW_160),
HE_GROUP(7, HE_GI_16, BW_160),
HE_GROUP(8, HE_GI_16, BW_160),
HE_GROUP(1, HE_GI_32, BW_160),
HE_GROUP(2, HE_GI_32, BW_160),
HE_GROUP(3, HE_GI_32, BW_160),
HE_GROUP(4, HE_GI_32, BW_160),
HE_GROUP(5, HE_GI_32, BW_160),
HE_GROUP(6, HE_GI_32, BW_160),
HE_GROUP(7, HE_GI_32, BW_160),
HE_GROUP(8, HE_GI_32, BW_160),
};
static u32
ieee80211_calc_legacy_rate_duration(u16 bitrate, bool short_pre,
bool cck, int len)
{
u32 duration;
if (cck) {
duration = 144 + 48; /* preamble + PLCP */
if (short_pre)
duration >>= 1;
duration += 10; /* SIFS */
} else {
duration = 20 + 16; /* premable + SIFS */
}
len <<= 3;
duration += (len * 10) / bitrate;
return duration;
}
static u32 ieee80211_get_rate_duration(struct ieee80211_hw *hw,
struct ieee80211_rx_status *status,
u32 *overhead)
{
bool sgi = status->enc_flags & RX_ENC_FLAG_SHORT_GI;
int bw, streams;
int group, idx;
u32 duration;
switch (status->bw) {
case RATE_INFO_BW_20:
bw = BW_20;
break;
case RATE_INFO_BW_40:
bw = BW_40;
break;
case RATE_INFO_BW_80:
bw = BW_80;
break;
case RATE_INFO_BW_160:
bw = BW_160;
break;
default:
WARN_ON_ONCE(1);
return 0;
}
switch (status->encoding) {
case RX_ENC_VHT:
streams = status->nss;
idx = status->rate_idx;
group = VHT_GROUP_IDX(streams, sgi, bw);
break;
case RX_ENC_HT:
streams = ((status->rate_idx >> 3) & 3) + 1;
idx = status->rate_idx & 7;
group = HT_GROUP_IDX(streams, sgi, bw);
break;
case RX_ENC_HE:
streams = status->nss;
idx = status->rate_idx;
group = HE_GROUP_IDX(streams, status->he_gi, bw);
break;
default:
WARN_ON_ONCE(1);
return 0;
}
if (WARN_ON_ONCE((status->encoding != RX_ENC_HE && streams > 4) ||
(status->encoding == RX_ENC_HE && streams > 8)))
return 0;
duration = airtime_mcs_groups[group].duration[idx];
duration <<= airtime_mcs_groups[group].shift;
*overhead = 36 + (streams << 2);
return duration;
}
u32 ieee80211_calc_rx_airtime(struct ieee80211_hw *hw,
struct ieee80211_rx_status *status,
int len)
{
struct ieee80211_supported_band *sband;
u32 duration, overhead = 0;
if (status->encoding == RX_ENC_LEGACY) {
const struct ieee80211_rate *rate;
bool sp = status->enc_flags & RX_ENC_FLAG_SHORTPRE;
bool cck;
/* on 60GHz or sub-1GHz band, there are no legacy rates */
if (WARN_ON_ONCE(status->band == NL80211_BAND_60GHZ ||
status->band == NL80211_BAND_S1GHZ))
return 0;
sband = hw->wiphy->bands[status->band];
if (!sband || status->rate_idx >= sband->n_bitrates)
return 0;
rate = &sband->bitrates[status->rate_idx];
cck = rate->flags & IEEE80211_RATE_MANDATORY_B;
return ieee80211_calc_legacy_rate_duration(rate->bitrate, sp,
cck, len);
}
duration = ieee80211_get_rate_duration(hw, status, &overhead);
if (!duration)
return 0;
duration *= len;
duration /= AVG_PKT_SIZE;
duration /= 1024;
return duration + overhead;
}
EXPORT_SYMBOL_GPL(ieee80211_calc_rx_airtime);
static bool ieee80211_fill_rate_info(struct ieee80211_hw *hw,
struct ieee80211_rx_status *stat, u8 band,
struct rate_info *ri)
{
struct ieee80211_supported_band *sband = hw->wiphy->bands[band];
int i;
if (!ri || !sband)
return false;
stat->bw = ri->bw;
stat->nss = ri->nss;
stat->rate_idx = ri->mcs;
if (ri->flags & RATE_INFO_FLAGS_HE_MCS)
stat->encoding = RX_ENC_HE;
else if (ri->flags & RATE_INFO_FLAGS_VHT_MCS)
stat->encoding = RX_ENC_VHT;
else if (ri->flags & RATE_INFO_FLAGS_MCS)
stat->encoding = RX_ENC_HT;
else
stat->encoding = RX_ENC_LEGACY;
if (ri->flags & RATE_INFO_FLAGS_SHORT_GI)
stat->enc_flags |= RX_ENC_FLAG_SHORT_GI;
stat->he_gi = ri->he_gi;
if (stat->encoding != RX_ENC_LEGACY)
return true;
stat->rate_idx = 0;
for (i = 0; i < sband->n_bitrates; i++) {
if (ri->legacy != sband->bitrates[i].bitrate)
continue;
stat->rate_idx = i;
return true;
}
return false;
}
static int ieee80211_fill_rx_status(struct ieee80211_rx_status *stat,
struct ieee80211_hw *hw,
struct ieee80211_tx_rate *rate,
struct rate_info *ri, u8 band, int len)
{
memset(stat, 0, sizeof(*stat));
stat->band = band;
if (ieee80211_fill_rate_info(hw, stat, band, ri))
return 0;
if (rate->idx < 0 || !rate->count)
return -1;
if (rate->flags & IEEE80211_TX_RC_160_MHZ_WIDTH)
stat->bw = RATE_INFO_BW_160;
else if (rate->flags & IEEE80211_TX_RC_80_MHZ_WIDTH)
stat->bw = RATE_INFO_BW_80;
else if (rate->flags & IEEE80211_TX_RC_40_MHZ_WIDTH)
stat->bw = RATE_INFO_BW_40;
else
stat->bw = RATE_INFO_BW_20;
stat->enc_flags = 0;
if (rate->flags & IEEE80211_TX_RC_USE_SHORT_PREAMBLE)
stat->enc_flags |= RX_ENC_FLAG_SHORTPRE;
if (rate->flags & IEEE80211_TX_RC_SHORT_GI)
stat->enc_flags |= RX_ENC_FLAG_SHORT_GI;
stat->rate_idx = rate->idx;
if (rate->flags & IEEE80211_TX_RC_VHT_MCS) {
stat->encoding = RX_ENC_VHT;
stat->rate_idx = ieee80211_rate_get_vht_mcs(rate);
stat->nss = ieee80211_rate_get_vht_nss(rate);
} else if (rate->flags & IEEE80211_TX_RC_MCS) {
stat->encoding = RX_ENC_HT;
} else {
stat->encoding = RX_ENC_LEGACY;
}
return 0;
}
static u32 ieee80211_calc_tx_airtime_rate(struct ieee80211_hw *hw,
struct ieee80211_tx_rate *rate,
struct rate_info *ri,
u8 band, int len)
{
struct ieee80211_rx_status stat;
if (ieee80211_fill_rx_status(&stat, hw, rate, ri, band, len))
return 0;
return ieee80211_calc_rx_airtime(hw, &stat, len);
}
u32 ieee80211_calc_tx_airtime(struct ieee80211_hw *hw,
struct ieee80211_tx_info *info,
int len)
{
u32 duration = 0;
int i;
for (i = 0; i < ARRAY_SIZE(info->status.rates); i++) {
struct ieee80211_tx_rate *rate = &info->status.rates[i];
u32 cur_duration;
cur_duration = ieee80211_calc_tx_airtime_rate(hw, rate, NULL,
info->band, len);
if (!cur_duration)
break;
duration += cur_duration * rate->count;
}
return duration;
}
EXPORT_SYMBOL_GPL(ieee80211_calc_tx_airtime);
u32 ieee80211_calc_expected_tx_airtime(struct ieee80211_hw *hw,
struct ieee80211_vif *vif,
struct ieee80211_sta *pubsta,
int len, bool ampdu)
{
struct ieee80211_supported_band *sband;
struct ieee80211_chanctx_conf *conf;
int rateidx, shift = 0;
bool cck, short_pream;
u32 basic_rates;
u8 band = 0;
u16 rate;
len += 38; /* Ethernet header length */
conf = rcu_dereference(vif->chanctx_conf);
if (conf) {
band = conf->def.chan->band;
shift = ieee80211_chandef_get_shift(&conf->def);
}
if (pubsta) {
struct sta_info *sta = container_of(pubsta, struct sta_info,
sta);
struct ieee80211_rx_status stat;
struct ieee80211_tx_rate *tx_rate = &sta->deflink.tx_stats.last_rate;
struct rate_info *ri = &sta->deflink.tx_stats.last_rate_info;
u32 duration, overhead;
u8 agg_shift;
if (ieee80211_fill_rx_status(&stat, hw, tx_rate, ri, band, len))
return 0;
if (stat.encoding == RX_ENC_LEGACY || !ampdu)
return ieee80211_calc_rx_airtime(hw, &stat, len);
duration = ieee80211_get_rate_duration(hw, &stat, &overhead);
/*
* Assume that HT/VHT transmission on any AC except VO will
* use aggregation. Since we don't have reliable reporting
* of aggregation length, assume an average size based on the
* tx rate.
* This will not be very accurate, but much better than simply
* assuming un-aggregated tx in all cases.
*/
if (duration > 400 * 1024) /* <= VHT20 MCS2 1S */
agg_shift = 1;
else if (duration > 250 * 1024) /* <= VHT20 MCS3 1S or MCS1 2S */
agg_shift = 2;
else if (duration > 150 * 1024) /* <= VHT20 MCS5 1S or MCS2 2S */
agg_shift = 3;
else if (duration > 70 * 1024) /* <= VHT20 MCS5 2S */
agg_shift = 4;
else if (stat.encoding != RX_ENC_HE ||
duration > 20 * 1024) /* <= HE40 MCS6 2S */
agg_shift = 5;
else
agg_shift = 6;
duration *= len;
duration /= AVG_PKT_SIZE;
duration /= 1024;
duration += (overhead >> agg_shift);
return max_t(u32, duration, 4);
}
if (!conf)
return 0;
/* No station to get latest rate from, so calculate the worst-case
* duration using the lowest configured basic rate.
*/
sband = hw->wiphy->bands[band];
basic_rates = vif->bss_conf.basic_rates;
short_pream = vif->bss_conf.use_short_preamble;
rateidx = basic_rates ? ffs(basic_rates) - 1 : 0;
rate = sband->bitrates[rateidx].bitrate << shift;
cck = sband->bitrates[rateidx].flags & IEEE80211_RATE_MANDATORY_B;
return ieee80211_calc_legacy_rate_duration(rate, short_pream, cck, len);
}
Reference in New Issue View Git Blame Copy Permalink