046d2e7c50
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>
199 lines
5.5 KiB
C
199 lines
5.5 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
/*
|
|
* S1G handling
|
|
* Copyright(c) 2020 Adapt-IP
|
|
*/
|
|
#include <linux/ieee80211.h>
|
|
#include <net/mac80211.h>
|
|
#include "ieee80211_i.h"
|
|
#include "driver-ops.h"
|
|
|
|
void ieee80211_s1g_sta_rate_init(struct sta_info *sta)
|
|
{
|
|
/* avoid indicating legacy bitrates for S1G STAs */
|
|
sta->deflink.tx_stats.last_rate.flags |= IEEE80211_TX_RC_S1G_MCS;
|
|
sta->deflink.rx_stats.last_rate =
|
|
STA_STATS_FIELD(TYPE, STA_STATS_RATE_TYPE_S1G);
|
|
}
|
|
|
|
bool ieee80211_s1g_is_twt_setup(struct sk_buff *skb)
|
|
{
|
|
struct ieee80211_mgmt *mgmt = (struct ieee80211_mgmt *)skb->data;
|
|
|
|
if (likely(!ieee80211_is_action(mgmt->frame_control)))
|
|
return false;
|
|
|
|
if (likely(mgmt->u.action.category != WLAN_CATEGORY_S1G))
|
|
return false;
|
|
|
|
return mgmt->u.action.u.s1g.action_code == WLAN_S1G_TWT_SETUP;
|
|
}
|
|
|
|
static void
|
|
ieee80211_s1g_send_twt_setup(struct ieee80211_sub_if_data *sdata, const u8 *da,
|
|
const u8 *bssid, struct ieee80211_twt_setup *twt)
|
|
{
|
|
int len = IEEE80211_MIN_ACTION_SIZE + 4 + twt->length;
|
|
struct ieee80211_local *local = sdata->local;
|
|
struct ieee80211_mgmt *mgmt;
|
|
struct sk_buff *skb;
|
|
|
|
skb = dev_alloc_skb(local->hw.extra_tx_headroom + len);
|
|
if (!skb)
|
|
return;
|
|
|
|
skb_reserve(skb, local->hw.extra_tx_headroom);
|
|
mgmt = skb_put_zero(skb, len);
|
|
mgmt->frame_control = cpu_to_le16(IEEE80211_FTYPE_MGMT |
|
|
IEEE80211_STYPE_ACTION);
|
|
memcpy(mgmt->da, da, ETH_ALEN);
|
|
memcpy(mgmt->sa, sdata->vif.addr, ETH_ALEN);
|
|
memcpy(mgmt->bssid, bssid, ETH_ALEN);
|
|
|
|
mgmt->u.action.category = WLAN_CATEGORY_S1G;
|
|
mgmt->u.action.u.s1g.action_code = WLAN_S1G_TWT_SETUP;
|
|
memcpy(mgmt->u.action.u.s1g.variable, twt, 3 + twt->length);
|
|
|
|
IEEE80211_SKB_CB(skb)->flags |= IEEE80211_TX_INTFL_DONT_ENCRYPT |
|
|
IEEE80211_TX_INTFL_MLME_CONN_TX |
|
|
IEEE80211_TX_CTL_REQ_TX_STATUS;
|
|
ieee80211_tx_skb(sdata, skb);
|
|
}
|
|
|
|
static void
|
|
ieee80211_s1g_send_twt_teardown(struct ieee80211_sub_if_data *sdata,
|
|
const u8 *da, const u8 *bssid, u8 flowid)
|
|
{
|
|
struct ieee80211_local *local = sdata->local;
|
|
struct ieee80211_mgmt *mgmt;
|
|
struct sk_buff *skb;
|
|
u8 *id;
|
|
|
|
skb = dev_alloc_skb(local->hw.extra_tx_headroom +
|
|
IEEE80211_MIN_ACTION_SIZE + 2);
|
|
if (!skb)
|
|
return;
|
|
|
|
skb_reserve(skb, local->hw.extra_tx_headroom);
|
|
mgmt = skb_put_zero(skb, IEEE80211_MIN_ACTION_SIZE + 2);
|
|
mgmt->frame_control = cpu_to_le16(IEEE80211_FTYPE_MGMT |
|
|
IEEE80211_STYPE_ACTION);
|
|
memcpy(mgmt->da, da, ETH_ALEN);
|
|
memcpy(mgmt->sa, sdata->vif.addr, ETH_ALEN);
|
|
memcpy(mgmt->bssid, bssid, ETH_ALEN);
|
|
|
|
mgmt->u.action.category = WLAN_CATEGORY_S1G;
|
|
mgmt->u.action.u.s1g.action_code = WLAN_S1G_TWT_TEARDOWN;
|
|
id = (u8 *)mgmt->u.action.u.s1g.variable;
|
|
*id = flowid;
|
|
|
|
IEEE80211_SKB_CB(skb)->flags |= IEEE80211_TX_INTFL_DONT_ENCRYPT |
|
|
IEEE80211_TX_CTL_REQ_TX_STATUS;
|
|
ieee80211_tx_skb(sdata, skb);
|
|
}
|
|
|
|
static void
|
|
ieee80211_s1g_rx_twt_setup(struct ieee80211_sub_if_data *sdata,
|
|
struct sta_info *sta, struct sk_buff *skb)
|
|
{
|
|
struct ieee80211_mgmt *mgmt = (void *)skb->data;
|
|
struct ieee80211_twt_setup *twt = (void *)mgmt->u.action.u.s1g.variable;
|
|
struct ieee80211_twt_params *twt_agrt = (void *)twt->params;
|
|
|
|
twt_agrt->req_type &= cpu_to_le16(~IEEE80211_TWT_REQTYPE_REQUEST);
|
|
|
|
/* broadcast TWT not supported yet */
|
|
if (twt->control & IEEE80211_TWT_CONTROL_NEG_TYPE_BROADCAST) {
|
|
twt_agrt->req_type &=
|
|
~cpu_to_le16(IEEE80211_TWT_REQTYPE_SETUP_CMD);
|
|
twt_agrt->req_type |=
|
|
le16_encode_bits(TWT_SETUP_CMD_REJECT,
|
|
IEEE80211_TWT_REQTYPE_SETUP_CMD);
|
|
goto out;
|
|
}
|
|
|
|
drv_add_twt_setup(sdata->local, sdata, &sta->sta, twt);
|
|
out:
|
|
ieee80211_s1g_send_twt_setup(sdata, mgmt->sa, sdata->vif.addr, twt);
|
|
}
|
|
|
|
static void
|
|
ieee80211_s1g_rx_twt_teardown(struct ieee80211_sub_if_data *sdata,
|
|
struct sta_info *sta, struct sk_buff *skb)
|
|
{
|
|
struct ieee80211_mgmt *mgmt = (struct ieee80211_mgmt *)skb->data;
|
|
|
|
drv_twt_teardown_request(sdata->local, sdata, &sta->sta,
|
|
mgmt->u.action.u.s1g.variable[0]);
|
|
}
|
|
|
|
static void
|
|
ieee80211_s1g_tx_twt_setup_fail(struct ieee80211_sub_if_data *sdata,
|
|
struct sta_info *sta, struct sk_buff *skb)
|
|
{
|
|
struct ieee80211_mgmt *mgmt = (struct ieee80211_mgmt *)skb->data;
|
|
struct ieee80211_twt_setup *twt = (void *)mgmt->u.action.u.s1g.variable;
|
|
struct ieee80211_twt_params *twt_agrt = (void *)twt->params;
|
|
u8 flowid = le16_get_bits(twt_agrt->req_type,
|
|
IEEE80211_TWT_REQTYPE_FLOWID);
|
|
|
|
drv_twt_teardown_request(sdata->local, sdata, &sta->sta, flowid);
|
|
|
|
ieee80211_s1g_send_twt_teardown(sdata, mgmt->sa, sdata->vif.addr,
|
|
flowid);
|
|
}
|
|
|
|
void ieee80211_s1g_rx_twt_action(struct ieee80211_sub_if_data *sdata,
|
|
struct sk_buff *skb)
|
|
{
|
|
struct ieee80211_mgmt *mgmt = (struct ieee80211_mgmt *)skb->data;
|
|
struct ieee80211_local *local = sdata->local;
|
|
struct sta_info *sta;
|
|
|
|
mutex_lock(&local->sta_mtx);
|
|
|
|
sta = sta_info_get_bss(sdata, mgmt->sa);
|
|
if (!sta)
|
|
goto out;
|
|
|
|
switch (mgmt->u.action.u.s1g.action_code) {
|
|
case WLAN_S1G_TWT_SETUP:
|
|
ieee80211_s1g_rx_twt_setup(sdata, sta, skb);
|
|
break;
|
|
case WLAN_S1G_TWT_TEARDOWN:
|
|
ieee80211_s1g_rx_twt_teardown(sdata, sta, skb);
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
|
|
out:
|
|
mutex_unlock(&local->sta_mtx);
|
|
}
|
|
|
|
void ieee80211_s1g_status_twt_action(struct ieee80211_sub_if_data *sdata,
|
|
struct sk_buff *skb)
|
|
{
|
|
struct ieee80211_mgmt *mgmt = (struct ieee80211_mgmt *)skb->data;
|
|
struct ieee80211_local *local = sdata->local;
|
|
struct sta_info *sta;
|
|
|
|
mutex_lock(&local->sta_mtx);
|
|
|
|
sta = sta_info_get_bss(sdata, mgmt->da);
|
|
if (!sta)
|
|
goto out;
|
|
|
|
switch (mgmt->u.action.u.s1g.action_code) {
|
|
case WLAN_S1G_TWT_SETUP:
|
|
/* process failed twt setup frames */
|
|
ieee80211_s1g_tx_twt_setup_fail(sdata, sta, skb);
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
|
|
out:
|
|
mutex_unlock(&local->sta_mtx);
|
|
}
|