// SPDX-License-Identifier: GPL-2.0-only /* * mac80211_hwsim - software simulator of 802.11 radio(s) for mac80211 * Copyright (c) 2008, Jouni Malinen <j@w1.fi> * Copyright (c) 2011, Javier Lopez <jlopex@gmail.com> * Copyright (c) 2016 - 2017 Intel Deutschland GmbH * Copyright (C) 2018 - 2025 Intel Corporation /* * TODO: * - Add TSF sync and fix IBSS beacon transmission by adding * competition for "air time" at TBTT * - RX filtering based on filter configuration (data->rx_filter) #include <linux/list.h>#include <linux/slab.h>#include <linux/spinlock.h>#include <net/dst.h>#include <net/xfrm.h>#include <net/mac80211.h>#include <net/ieee80211_radiotap.h>#include <linux/if_arp.h>#include <linux/rtnetlink.h>#include <linux/etherdevice.h>#include <linux/platform_device.h>#include <linux/debugfs.h>#include <linux/module.h>#include <linux/ktime.h>#include <net/genetlink.h>#include <net/net_namespace.h>#include <net/netns/generic.h>#include <linux/rhashtable.h>#include <linux/nospec.h>#include <linux/virtio.h>#include <linux/virtio_ids.h>#include <linux/virtio_config.h>#include "mac80211_hwsim.h" #define WARN_QUEUE 100#define MAX_QUEUE 200"Jouni Malinen" );"Software simulator of 802.11 radio(s) for mac80211" );"GPL" );static int radios = 2;int , 0444);"Number of simulated radios" );static int channels = 1;int , 0444);"Number of concurrent channels" );static bool paged_rx = false ;bool , 0644);"Use paged SKBs for RX instead of linear ones" );static bool rctbl = false ;bool , 0444);"Handle rate control table" );static bool support_p2p_device = true ;bool , 0444);"Support P2P-Device interface type" );static bool mlo;bool , 0444);"Support MLO" );static bool multi_radio;bool , 0444);"Support Multiple Radios per wiphy" );/** * enum hwsim_regtest - the type of regulatory tests we offer * * @HWSIM_REGTEST_DISABLED: No regulatory tests are performed, * this is the default value. * @HWSIM_REGTEST_DRIVER_REG_FOLLOW: Used for testing the driver regulatory * hint, only one driver regulatory hint will be sent as such the * secondary radios are expected to follow. * @HWSIM_REGTEST_DRIVER_REG_ALL: Used for testing the driver regulatory * request with all radios reporting the same regulatory domain. * @HWSIM_REGTEST_DIFF_COUNTRY: Used for testing the drivers calling * different regulatory domains requests. Expected behaviour is for * an intersection to occur but each device will still use their * respective regulatory requested domains. Subsequent radios will * use the resulting intersection. * @HWSIM_REGTEST_WORLD_ROAM: Used for testing the world roaming. We accomplish * this by using a custom beacon-capable regulatory domain for the first * radio. All other device world roam. * @HWSIM_REGTEST_CUSTOM_WORLD: Used for testing the custom world regulatory * domain requests. All radios will adhere to this custom world regulatory * domain. * @HWSIM_REGTEST_CUSTOM_WORLD_2: Used for testing 2 custom world regulatory * domain requests. The first radio will adhere to the first custom world * regulatory domain, the second one to the second custom world regulatory * domain. All other devices will world roam. * @HWSIM_REGTEST_STRICT_FOLLOW: Used for testing strict regulatory domain * settings, only the first radio will send a regulatory domain request * and use strict settings. The rest of the radios are expected to follow. * @HWSIM_REGTEST_STRICT_ALL: Used for testing strict regulatory domain * settings. All radios will adhere to this. * @HWSIM_REGTEST_STRICT_AND_DRIVER_REG: Used for testing strict regulatory * domain settings, combined with secondary driver regulatory domain * settings. The first radio will get a strict regulatory domain setting * using the first driver regulatory request and the second radio will use * non-strict settings using the second driver regulatory request. All * other devices should follow the intersection created between the * first two. * @HWSIM_REGTEST_ALL: Used for testing every possible mix. You will need * at least 6 radios for a complete test. We will test in this order: * 1 - driver custom world regulatory domain * 2 - second custom world regulatory domain * 3 - first driver regulatory domain request * 4 - second driver regulatory domain request * 5 - strict regulatory domain settings using the third driver regulatory * domain request * 6 and on - should follow the intersection of the 3rd, 4rth and 5th radio * regulatory requests. * * These are the different values you can use for the regtest * module parameter. This is useful to help test world roaming * and the driver regulatory_hint() call and combinations of these. * If you want to do specific alpha2 regulatory domain tests simply * use the userspace regulatory request as that will be respected as * well without the need of this module parameter. This is designed * only for testing the driver regulatory request, world roaming * and all possible combinations. enum hwsim_regtest {/* Set to one of the HWSIM_REGTEST_* values above */ static int regtest = HWSIM_REGTEST_DISABLED;int , 0444);"The type of regulatory test we want to run" );static const char *hwsim_alpha2s[] = {"FI" ,"AL" ,"US" ,"DE" ,"JP" ,"AL" ,static const struct ieee80211_regdomain hwsim_world_regdom_custom_01 = {"99" ,static const struct ieee80211_regdomain hwsim_world_regdom_custom_02 = {"99" ,static const struct ieee80211_regdomain hwsim_world_regdom_custom_03 = {"99" ,static const struct ieee80211_regdomain hwsim_world_regdom_custom_04 = {"99" ,static const struct ieee80211_regdomain *hwsim_world_regdom_custom[] = {struct hwsim_vif_priv {bool assoc;bool bcn_en;#define HWSIM_VIF_MAGIC 0x69537748static inline void hwsim_check_magic(struct ieee80211_vif *vif)struct hwsim_vif_priv *vp = (void *)vif->drv_priv;"Invalid VIF (%p) magic %#x, %pM, %d/%d\n" ,static inline void hwsim_set_magic(struct ieee80211_vif *vif)struct hwsim_vif_priv *vp = (void *)vif->drv_priv;static inline void hwsim_clear_magic(struct ieee80211_vif *vif)struct hwsim_vif_priv *vp = (void *)vif->drv_priv;struct hwsim_sta_priv {unsigned int last_link;#define HWSIM_STA_MAGIC 0x6d537749static inline void hwsim_check_sta_magic(struct ieee80211_sta *sta)struct hwsim_sta_priv *sp = (void *)sta->drv_priv;static inline void hwsim_set_sta_magic(struct ieee80211_sta *sta)struct hwsim_sta_priv *sp = (void *)sta->drv_priv;static inline void hwsim_clear_sta_magic(struct ieee80211_sta *sta)struct hwsim_sta_priv *sp = (void *)sta->drv_priv;struct hwsim_chanctx_priv {#define HWSIM_CHANCTX_MAGIC 0x6d53774astatic inline void hwsim_check_chanctx_magic(struct ieee80211_chanctx_conf *c)struct hwsim_chanctx_priv *cp = (void *)c->drv_priv;static inline void hwsim_set_chanctx_magic(struct ieee80211_chanctx_conf *c)struct hwsim_chanctx_priv *cp = (void *)c->drv_priv;static inline void hwsim_clear_chanctx_magic(struct ieee80211_chanctx_conf *c)struct hwsim_chanctx_priv *cp = (void *)c->drv_priv;static unsigned int hwsim_net_id;static DEFINE_IDA(hwsim_netgroup_ida);struct hwsim_net {int netgroup;static inline int hwsim_net_get_netgroup(struct net *net)struct hwsim_net *hwsim_net = net_generic(net, hwsim_net_id);return hwsim_net->netgroup;static inline int hwsim_net_set_netgroup(struct net *net)struct hwsim_net *hwsim_net = net_generic(net, hwsim_net_id);return hwsim_net->netgroup >= 0 ? 0 : -ENOMEM;static inline u32 hwsim_net_get_wmediumd(struct net *net)struct hwsim_net *hwsim_net = net_generic(net, hwsim_net_id);return hwsim_net->wmediumd;static inline void hwsim_net_set_wmediumd(struct net *net, u32 portid)struct hwsim_net *hwsim_net = net_generic(net, hwsim_net_id);static struct class *hwsim_class;static struct net_device *hwsim_mon; /* global monitor netdev */ #define CHAN2G(_freq) { \#define CHAN5G(_freq) { \#define CHAN6G(_freq) { \static const struct ieee80211_channel hwsim_channels_2ghz[] = {/* Channel 1 */ /* Channel 2 */ /* Channel 3 */ /* Channel 4 */ /* Channel 5 */ /* Channel 6 */ /* Channel 7 */ /* Channel 8 */ /* Channel 9 */ /* Channel 10 */ /* Channel 11 */ /* Channel 12 */ /* Channel 13 */ /* Channel 14 */ static const struct ieee80211_channel hwsim_channels_5ghz[] = {/* Channel 36 */ /* Channel 40 */ /* Channel 44 */ /* Channel 48 */ /* Channel 52 */ /* Channel 56 */ /* Channel 60 */ /* Channel 64 */ /* Channel 100 */ /* Channel 104 */ /* Channel 108 */ /* Channel 112 */ /* Channel 116 */ /* Channel 120 */ /* Channel 124 */ /* Channel 128 */ /* Channel 132 */ /* Channel 136 */ /* Channel 140 */ /* Channel 149 */ /* Channel 153 */ /* Channel 157 */ /* Channel 161 */ /* Channel 165 */ /* Channel 169 */ /* Channel 171 */ /* Channel 172 */ /* Channel 173 */ /* Channel 174 */ /* Channel 175 */ /* Channel 176 */ /* Channel 177 */ /* Channel 178 */ /* Channel 179 */ /* Channel 180 */ /* Channel 181 */ /* Channel 182 */ /* Channel 183 */ /* Channel 184 */ /* Channel 185 */ static const struct ieee80211_channel hwsim_channels_6ghz[] = {/* Channel 1 */ /* Channel 5 */ /* Channel 9 */ /* Channel 13 */ /* Channel 17 */ /* Channel 21 */ /* Channel 25 */ /* Channel 29 */ /* Channel 33 */ /* Channel 37 */ /* Channel 41 */ /* Channel 45 */ /* Channel 49 */ /* Channel 53 */ /* Channel 57 */ /* Channel 61 */ /* Channel 65 */ /* Channel 69 */ /* Channel 73 */ /* Channel 77 */ /* Channel 81 */ /* Channel 85 */ /* Channel 89 */ /* Channel 93 */ /* Channel 97 */ /* Channel 181 */ /* Channel 105 */ /* Channel 109 */ /* Channel 113 */ /* Channel 117 */ /* Channel 121 */ /* Channel 125 */ /* Channel 129 */ /* Channel 133 */ /* Channel 137 */ /* Channel 141 */ /* Channel 145 */ /* Channel 149 */ /* Channel 153 */ /* Channel 157 */ /* Channel 161 */ /* Channel 165 */ /* Channel 169 */ /* Channel 173 */ /* Channel 177 */ /* Channel 181 */ /* Channel 185 */ /* Channel 189 */ /* Channel 193 */ /* Channel 197 */ /* Channel 201 */ /* Channel 205 */ /* Channel 209 */ /* Channel 213 */ /* Channel 217 */ /* Channel 221 */ /* Channel 225 */ /* Channel 229 */ /* Channel 233 */ #define NUM_S1G_CHANS_US 51static struct ieee80211_channel hwsim_channels_s1g[NUM_S1G_CHANS_US];static const struct ieee80211_sta_s1g_cap hwsim_s1g_cap = {true ,/* MCS 7 for 1 SS */ /* RX Highest Supported Long GI Data Rate 0:7 */ /* RX Highest Supported Long GI Data Rate 0:7 */ /* TX S1G MCS Map 0:6 */ /* TX S1G MCS Map :7 */ /* TX Highest Supported Long GI Data Rate 0:6 */ /* TX Highest Supported Long GI Data Rate 7:8 */ /* Rx Single spatial stream and S1G-MCS Map for 1MHz */ /* Tx Single spatial stream and S1G-MCS Map for 1MHz */ static void hwsim_init_s1g_channels(struct ieee80211_channel *chans)int ch, freq;for (ch = 0; ch < NUM_S1G_CHANS_US; ch++) {static const struct ieee80211_rate hwsim_rates[] = {#define DEFAULT_RX_RSSI -50static const u32 hwsim_ciphers[] = {#define OUI_QCA 0x001374#define QCA_NL80211_SUBCMD_TEST 1enum qca_nl80211_vendor_subcmds {static const struct nla_policystatic int mac80211_hwsim_vendor_cmd_test(struct wiphy *wiphy,struct wireless_dev *wdev,const void *data, int data_len)struct sk_buff *skb;struct nlattr *tb[QCA_WLAN_VENDOR_ATTR_MAX + 1];int err;if (err)return err;if (!tb[QCA_WLAN_VENDOR_ATTR_TEST])return -EINVAL;"%s: test=%u\n" , __func__, val);/* Send a vendor event as a test. Note that this would not normally be * done within a command handler, but rather, based on some other * trigger. For simplicity, this command is used to trigger the event * here. * * event_idx = 0 (index in mac80211_hwsim_vendor_commands) if (skb) {/* skb_put() or nla_put() will fill up data within * NL80211_ATTR_VENDOR_DATA. /* Add vendor data */ /* Send the event - this will call nla_nest_end() */ /* Send a response to the command */ if (!skb)return -ENOMEM;/* skb_put() or nla_put() will fill up data within * NL80211_ATTR_VENDOR_DATA return cfg80211_vendor_cmd_reply(skb);static struct wiphy_vendor_command mac80211_hwsim_vendor_commands[] = {/* Advertise support vendor specific events */ static const struct nl80211_vendor_cmd_info mac80211_hwsim_vendor_events[] = {static DEFINE_SPINLOCK(hwsim_radio_lock);static LIST_HEAD(hwsim_radios);static struct rhashtable hwsim_radios_rht;static int hwsim_radio_idx;static int hwsim_radios_generation = 1;static struct platform_driver mac80211_hwsim_driver = {"mac80211_hwsim" ,struct mac80211_hwsim_link_data {/* beacon interval in us */; struct hrtimer beacon_timer;struct mac80211_hwsim_data {struct list_head list;struct rhash_head rht;struct ieee80211_hw *hw;struct device *dev;struct ieee80211_supported_band bands[NUM_NL80211_BANDS];struct ieee80211_channel channels_2ghz[ARRAY_SIZE(hwsim_channels_2ghz)];struct ieee80211_channel channels_5ghz[ARRAY_SIZE(hwsim_channels_5ghz)];struct ieee80211_channel channels_6ghz[ARRAY_SIZE(hwsim_channels_6ghz)];struct ieee80211_channel channels_s1g[ARRAY_SIZE(hwsim_channels_s1g)];struct ieee80211_rate rates[ARRAY_SIZE(hwsim_rates)];struct ieee80211_iface_combination if_combination;struct ieee80211_iface_limit if_limits[3];int n_if_limits;struct ieee80211_iface_combination if_combination_radio;struct wiphy_radio_freq_range radio_range[NUM_NL80211_BANDS];struct wiphy_radio radio[NUM_NL80211_BANDS];struct mac_address addresses[2];int channels, idx;bool use_chanctx;bool destroy_on_close;char alpha2[2];const struct ieee80211_regdomain *regd;struct ieee80211_channel *tmp_chan;struct ieee80211_channel *roc_chan;struct delayed_work roc_start;struct delayed_work roc_done;struct delayed_work hw_scan;struct cfg80211_scan_request *hw_scan_request;struct ieee80211_vif *hw_scan_vif;int scan_chan_idx;struct {struct ieee80211_channel *channel;unsigned long next_start, start, end;struct ieee80211_channel *channel;enum nl80211_chan_width bw;unsigned int rx_filter;bool started, idle, scanning;struct mutex mutex;enum ps_mode {bool ps_poll_pending;struct dentry *debugfs;struct sk_buff_head pending; /* packets pending */ /* * Only radios in the same group can communicate together (the * channel has to match too). Each bit represents a group. A * radio can be in more than one group. /* group shared by radios created in the same netns */ int netgroup;/* wmediumd portid responsible for netgroup of this radio */ /* difference between this hw's clock and the real clock, in usecs */ /* absolute beacon transmission time. Used to cover up "tx" delay. */ /* Stats */ /* RSSI in rx status of the receiver */ int rx_rssi;/* only used when pmsr capability is supplied */ struct cfg80211_pmsr_capabilities pmsr_capa;struct cfg80211_pmsr_request *pmsr_request;struct wireless_dev *pmsr_request_wdev;struct mac80211_hwsim_link_data link_data[IEEE80211_MLD_MAX_NUM_LINKS];static const struct rhashtable_params hwsim_rht_params = {true ,struct mac80211_hwsim_data, addresses[1]),struct mac80211_hwsim_data, rht),struct hwsim_radiotap_hdr {struct ieee80211_radiotap_header_fixed hdr;struct hwsim_radiotap_ack_hdr {struct ieee80211_radiotap_header_fixed hdr;static struct mac80211_hwsim_data *get_hwsim_data_ref_from_addr(const u8 *addr)return rhashtable_lookup_fast(&hwsim_radios_rht, addr, hwsim_rht_params);/* MAC80211_HWSIM netlink family */ static struct genl_family hwsim_genl_family;enum hwsim_multicast_groups {static const struct genl_multicast_group hwsim_mcgrps[] = {"config" , },/* MAC80211_HWSIM netlink policy */ static const struct nla_policystatic const struct nla_policystatic const struct nla_policystatic const struct nla_policystatic const struct nla_policystatic const struct nla_policy,static const struct nla_policystatic const struct nla_policystatic const struct nla_policy// only for request. static const struct nla_policy hwsim_genl_policy[HWSIM_ATTR_MAX + 1] = {sizeof (struct hwsim_tx_rate)},#if IS_REACHABLE(CONFIG_VIRTIO)/* MAC80211_HWSIM virtio queues */ static struct virtqueue *hwsim_vqs[HWSIM_NUM_VQS];static bool hwsim_virtio_enabled;static DEFINE_SPINLOCK(hwsim_virtio_lock);static void hwsim_virtio_rx_work(struct work_struct *work);static DECLARE_WORK(hwsim_virtio_rx, hwsim_virtio_rx_work);static int hwsim_tx_virtio(struct mac80211_hwsim_data *data,struct sk_buff *skb)struct scatterlist sg[1];unsigned long flags;int err;if (!hwsim_virtio_enabled) {goto out_free;if (err)goto out_free;return 0;return err;#else /* cause a linker error if this ends up being needed */ extern int hwsim_tx_virtio(struct mac80211_hwsim_data *data,struct sk_buff *skb);#define hwsim_virtio_enabled false #endif static int hwsim_get_chanwidth(enum nl80211_chan_width bw)switch (bw) {case NL80211_CHAN_WIDTH_20_NOHT:case NL80211_CHAN_WIDTH_20:return 20;case NL80211_CHAN_WIDTH_40:return 40;case NL80211_CHAN_WIDTH_80:return 80;case NL80211_CHAN_WIDTH_80P80:case NL80211_CHAN_WIDTH_160:return 160;case NL80211_CHAN_WIDTH_320:return 320;case NL80211_CHAN_WIDTH_5:return 5;case NL80211_CHAN_WIDTH_10:return 10;case NL80211_CHAN_WIDTH_1:return 1;case NL80211_CHAN_WIDTH_2:return 2;case NL80211_CHAN_WIDTH_4:return 4;case NL80211_CHAN_WIDTH_8:return 8;case NL80211_CHAN_WIDTH_16:return 16;return INT_MAX;static void mac80211_hwsim_tx_frame(struct ieee80211_hw *hw,struct sk_buff *skb,struct ieee80211_channel *chan);/* sysfs attributes */ static void hwsim_send_ps_poll(void *dat, u8 *mac, struct ieee80211_vif *vif)struct mac80211_hwsim_data *data = dat;struct hwsim_vif_priv *vp = (void *)vif->drv_priv;struct sk_buff *skb;struct ieee80211_pspoll *pspoll;if (!vp->assoc)return ;"%s: send PS-Poll to %pM for aid %d\n" ,sizeof (*pspoll));if (!skb)return ;sizeof (*pspoll));static void hwsim_send_nullfunc(struct mac80211_hwsim_data *data, u8 *mac,struct ieee80211_vif *vif, int ps)struct hwsim_vif_priv *vp = (void *)vif->drv_priv;struct sk_buff *skb;struct ieee80211_hdr *hdr;struct ieee80211_tx_info *cb;if (!vp->assoc)return ;"%s: send data::nullfunc to %pM ps=%d\n" ,sizeof (*hdr));if (!skb)return ;sizeof (*hdr) - ETH_ALEN);static void hwsim_send_nullfunc_ps(void *dat, u8 *mac,struct ieee80211_vif *vif)struct mac80211_hwsim_data *data = dat;static void hwsim_send_nullfunc_no_ps(void *dat, u8 *mac,struct ieee80211_vif *vif)struct mac80211_hwsim_data *data = dat;static int hwsim_fops_ps_read(void *dat, u64 *val)struct mac80211_hwsim_data *data = dat;return 0;static int hwsim_fops_ps_write(void *dat, u64 val)struct mac80211_hwsim_data *data = dat;enum ps_mode old_ps;if (val != PS_DISABLED && val != PS_ENABLED && val != PS_AUTO_POLL &&return -EINVAL;if (val == PS_MANUAL_POLL) {if (data->ps != PS_ENABLED)return -EINVAL;return 0;if (old_ps == PS_DISABLED && val != PS_DISABLED) {else if (old_ps != PS_DISABLED && val == PS_DISABLED) {return 0;"%llu\n" );static int hwsim_write_simulate_radar(void *dat, u64 val)struct mac80211_hwsim_data *data = dat;return 0;"%llu\n" );static int hwsim_fops_group_read(void *dat, u64 *val)struct mac80211_hwsim_data *data = dat;return 0;static int hwsim_fops_group_write(void *dat, u64 val)struct mac80211_hwsim_data *data = dat;return 0;"%llx\n" );static int hwsim_fops_rx_rssi_read(void *dat, u64 *val)struct mac80211_hwsim_data *data = dat;return 0;static int hwsim_fops_rx_rssi_write(void *dat, u64 val)struct mac80211_hwsim_data *data = dat;int rssi = (int )val;if (rssi >= 0 || rssi < -100)return -EINVAL;return 0;"%lld\n" );static netdev_tx_t hwsim_mon_xmit(struct sk_buff *skb,struct net_device *dev)/* TODO: allow packet injection */ return NETDEV_TX_OK;static inline u64 mac80211_hwsim_get_tsf_raw(void )return ktime_to_us(ktime_get_real());static __le64 __mac80211_hwsim_get_tsf(struct mac80211_hwsim_data *data)return cpu_to_le64(now + data->tsf_offset);static u64 mac80211_hwsim_get_tsf(struct ieee80211_hw *hw,struct ieee80211_vif *vif)struct mac80211_hwsim_data *data = hw->priv;return le64_to_cpu(__mac80211_hwsim_get_tsf(data));static void mac80211_hwsim_set_tsf(struct ieee80211_hw *hw,struct ieee80211_vif *vif, u64 tsf)struct mac80211_hwsim_data *data = hw->priv;/* MLD not supported here */ struct ieee80211_bss_conf *conf;if (conf && !conf->enable_beacon)return ;/* adjust after beaconing with new timestamp at old TBTT */ if (tsf > now) {else {static void mac80211_hwsim_monitor_rx(struct ieee80211_hw *hw,struct sk_buff *tx_skb,struct ieee80211_channel *chan)struct mac80211_hwsim_data *data = hw->priv;struct sk_buff *skb;struct hwsim_radiotap_hdr *hdr;struct ieee80211_tx_info *info = IEEE80211_SKB_CB(tx_skb);struct ieee80211_rate *txrate = ieee80211_get_tx_rate(hw, info);if (!txrate)else if (!netif_running(hwsim_mon))return ;sizeof (*hdr), 0, GFP_ATOMIC);if (skb == NULL)return ;sizeof (*hdr));sizeof (*hdr));if (txrate && txrate->flags & IEEE80211_RATE_ERP_G)else sizeof (skb->cb));static void mac80211_hwsim_monitor_ack(struct ieee80211_channel *chan,const u8 *addr)struct sk_buff *skb;struct hwsim_radiotap_ack_hdr *hdr;struct ieee80211_hdr *hdr11;if (!netif_running(hwsim_mon))return ;if (skb == NULL)return ;sizeof (*hdr));sizeof (*hdr));sizeof (skb->cb));struct mac80211_hwsim_addr_match_data {bool ret;static void mac80211_hwsim_addr_iter(void *data, u8 *mac,struct ieee80211_vif *vif)int i;struct mac80211_hwsim_addr_match_data *md = data;if (memcmp(mac, md->addr, ETH_ALEN) == 0) {true ;return ;/* Match the link address */ for (i = 0; i < ARRAY_SIZE(vif->link_conf); i++) {struct ieee80211_bss_conf *conf;if (!conf)continue ;if (memcmp(conf->addr, md->addr, ETH_ALEN) == 0) {true ;return ;static bool mac80211_hwsim_addr_match(struct mac80211_hwsim_data *data,const u8 *addr)struct mac80211_hwsim_addr_match_data md = {false ,if (data->scanning && memcmp(addr, data->scan_addr, ETH_ALEN) == 0)return true ;return md.ret;static bool hwsim_ps_rx_ok(struct mac80211_hwsim_data *data,struct sk_buff *skb)switch (data->ps) {case PS_DISABLED:return true ;case PS_ENABLED:return false ;case PS_AUTO_POLL:/* TODO: accept (some) Beacons by default and other frames only return true ;case PS_MANUAL_POLL:/* Allow unicast frames to own address if there is a pending if (data->ps_poll_pending &&false ;return true ;return false ;return true ;static int hwsim_unicast_netgroup(struct mac80211_hwsim_data *data,struct sk_buff *skb, int portid)struct net *net;bool found = false ;int res = -ENOENT;if (data->netgroup == hwsim_net_get_netgroup(net)) {true ;break ;if (!found)return res;static void mac80211_hwsim_config_mac_nl(struct ieee80211_hw *hw,const u8 *addr, bool add)struct mac80211_hwsim_data *data = hw->priv;struct sk_buff *skb;void *msg_head;if (!_portid && !hwsim_virtio_enabled)return ;if (!skb)return ;if (!msg_head) {"mac80211_hwsim: problem with msg_head\n" );goto nla_put_failure;if (nla_put(skb, HWSIM_ATTR_ADDR_TRANSMITTER,goto nla_put_failure;if (nla_put(skb, HWSIM_ATTR_ADDR_RECEIVER, ETH_ALEN, addr))goto nla_put_failure;if (hwsim_virtio_enabled)else return ;static inline u16 trans_tx_rate_flags_ieee2hwsim(struct ieee80211_tx_rate *rate)if (rate->flags & IEEE80211_TX_RC_USE_RTS_CTS)if (rate->flags & IEEE80211_TX_RC_USE_CTS_PROTECT)if (rate->flags & IEEE80211_TX_RC_USE_SHORT_PREAMBLE)if (rate->flags & IEEE80211_TX_RC_MCS)if (rate->flags & IEEE80211_TX_RC_GREEN_FIELD)if (rate->flags & IEEE80211_TX_RC_40_MHZ_WIDTH)if (rate->flags & IEEE80211_TX_RC_DUP_DATA)if (rate->flags & IEEE80211_TX_RC_SHORT_GI)if (rate->flags & IEEE80211_TX_RC_VHT_MCS)if (rate->flags & IEEE80211_TX_RC_80_MHZ_WIDTH)if (rate->flags & IEEE80211_TX_RC_160_MHZ_WIDTH)return result;static void mac80211_hwsim_tx_frame_nl(struct ieee80211_hw *hw,struct sk_buff *my_skb,int dst_portid,struct ieee80211_channel *channel)struct sk_buff *skb;struct mac80211_hwsim_data *data = hw->priv;struct ieee80211_hdr *hdr = (struct ieee80211_hdr *) my_skb->data;struct ieee80211_tx_info *info = IEEE80211_SKB_CB(my_skb);void *msg_head;unsigned int hwsim_flags = 0;int i;struct hwsim_tx_rate tx_attempts[IEEE80211_TX_MAX_RATES];struct hwsim_tx_rate_flag tx_attempts_flags[IEEE80211_TX_MAX_RATES];if (data->ps != PS_DISABLED)/* If the queue contains MAX_QUEUE skb's drop some */ if (skb_queue_len(&data->pending) >= MAX_QUEUE) {/* Dropping until WARN_QUEUE level */ while (skb_queue_len(&data->pending) >= WARN_QUEUE) {if (skb == NULL)goto nla_put_failure;if (msg_head == NULL) {"mac80211_hwsim: problem with msg_head\n" );goto nla_put_failure;if (nla_put(skb, HWSIM_ATTR_ADDR_TRANSMITTER,goto nla_put_failure;/* We get the skb->data */ if (nla_put(skb, HWSIM_ATTR_FRAME, my_skb->len, my_skb->data))goto nla_put_failure;/* We get the flags for this transmission, and we translate them to if (info->flags & IEEE80211_TX_CTL_REQ_TX_STATUS)if (info->flags & IEEE80211_TX_CTL_NO_ACK)if (nla_put_u32(skb, HWSIM_ATTR_FLAGS, hwsim_flags))goto nla_put_failure;if (nla_put_u32(skb, HWSIM_ATTR_FREQ, channel->center_freq))goto nla_put_failure;/* We get the tx control (rate and retries) info*/ for (i = 0; i < IEEE80211_TX_MAX_RATES; i++) {if (nla_put(skb, HWSIM_ATTR_TX_INFO,sizeof (struct hwsim_tx_rate)*IEEE80211_TX_MAX_RATES,goto nla_put_failure;if (nla_put(skb, HWSIM_ATTR_TX_INFO_FLAGS,sizeof (struct hwsim_tx_rate_flag) * IEEE80211_TX_MAX_RATES,goto nla_put_failure;/* We create a cookie to identify this skb */ void *)cookie;if (nla_put_u64_64bit(skb, HWSIM_ATTR_COOKIE, cookie, HWSIM_ATTR_PAD))goto nla_put_failure;if (hwsim_virtio_enabled) {if (hwsim_tx_virtio(data, skb))goto err_free_txskb;else {if (hwsim_unicast_netgroup(data, skb, dst_portid))goto err_free_txskb;/* Enqueue the packet */ return ;"mac80211_hwsim: error occurred in %s\n" , __func__);static bool hwsim_chans_compat(struct ieee80211_channel *c1,struct ieee80211_channel *c2)if (!c1 || !c2)return false ;return c1->center_freq == c2->center_freq;struct tx_iter_data {struct ieee80211_channel *channel;bool receive;static void mac80211_hwsim_tx_iter(void *_data, u8 *addr,struct ieee80211_vif *vif)struct tx_iter_data *data = _data;int i;for (i = 0; i < ARRAY_SIZE(vif->link_conf); i++) {struct ieee80211_bss_conf *conf;struct ieee80211_chanctx_conf *chanctx;if (!conf)continue ;if (!chanctx)continue ;if (!hwsim_chans_compat(data->channel, chanctx->def.chan))continue ;true ;return ;static void mac80211_hwsim_add_vendor_rtap(struct sk_buff *skb)/* * To enable this code, #define the HWSIM_RADIOTAP_OUI, * e.g. like this: * #define HWSIM_RADIOTAP_OUI "\x02\x00\x00" * (but you should use a valid OUI, not that) * * If anyone wants to 'donate' a radiotap OUI/subns code * please send a patch removing this #ifdef and changing * the values accordingly. #ifdef HWSIM_RADIOTAP_OUIstruct ieee80211_radiotap_vendor_tlv *rtap;static const char vendor_data[8] = "ABCDEFGH" ;// Make sure no padding is needed sizeof (vendor_data) % 4);/* this is last radiotap info before the mac header, so * skb_reset_mac_header for mac8022 to know the end of * the radiotap TLV/beginning of the 802.11 header /* * Note that this code requires the headroom in the SKB * that was allocated earlier. sizeof (*rtap) + sizeof (vendor_data));sizeof (*rtap) -sizeof (struct ieee80211_radiotap_tlv) +sizeof (vendor_data));/* clear reserved field */ sizeof (vendor_data));#endif static void mac80211_hwsim_rx(struct mac80211_hwsim_data *data,struct ieee80211_rx_status *rx_status,struct sk_buff *skb)struct ieee80211_hdr *hdr = (void *)skb->data;if (!ieee80211_has_morefrags(hdr->frame_control) &&struct ieee80211_sta *sta;unsigned int link_id;if (sta) {struct hwsim_sta_priv *sp = (void *)sta->drv_priv;if (ieee80211_has_pm(hdr->frame_control))else true ;sizeof (*rx_status));static bool mac80211_hwsim_tx_frame_no_nl(struct ieee80211_hw *hw,struct sk_buff *skb,struct ieee80211_channel *chan)struct mac80211_hwsim_data *data = hw->priv, *data2;bool ack = false ;struct ieee80211_hdr *hdr = (struct ieee80211_hdr *) skb->data;struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);struct ieee80211_rx_status rx_status;sizeof (rx_status));if (info->control.rates[0].flags & IEEE80211_TX_RC_VHT_MCS) {else {if (info->control.rates[0].flags & IEEE80211_TX_RC_MCS)if (info->control.rates[0].flags & IEEE80211_TX_RC_40_MHZ_WIDTH)else if (info->control.rates[0].flags & IEEE80211_TX_RC_80_MHZ_WIDTH)else if (info->control.rates[0].flags & IEEE80211_TX_RC_160_MHZ_WIDTH)else if (info->control.rates[0].flags & IEEE80211_TX_RC_SHORT_GI)/* TODO: simulate optional packet loss */ if (info->control.vif)if (data->ps != PS_DISABLED)/* release the skb's source info */ /* * Get absolute mactime here so all HWs RX at the "same time", and * absolute TX time for beacon mactime so the timestamp matches. * Giving beacons a different mactime than non-beacons looks messy, but * it helps the Toffset be exact and a ~10us mactime discrepancy * probably doesn't really matter. if (ieee80211_is_beacon(hdr->frame_control) ||else {/* Copy skb to all enabled radios that are on the current frequency */ struct sk_buff *nskb;struct tx_iter_data tx_iter_data = {false ,if (data == data2)continue ;if (!data2->started || (data2->idle && !data2->tmp_chan) ||continue ;if (!(data->group & data2->group))continue ;if (data->netgroup != data2->netgroup)continue ;if (!hwsim_chans_compat(chan, data2->tmp_chan) &&if (!tx_iter_data.receive)continue ;/* * reserve some space for our vendor and the normal * radiotap header, since we're copying anyway if (skb->len < PAGE_SIZE && paged_rx) {struct page *page = alloc_page(GFP_ATOMIC);if (!page)continue ;if (!nskb) {continue ;else {if (!nskb)continue ;if (mac80211_hwsim_addr_match(data2, hdr->addr1))true ;return ack;static struct ieee80211_bss_conf *struct mac80211_hwsim_data *data,struct ieee80211_vif *vif,struct ieee80211_sta *sta,struct ieee80211_hdr *hdr,struct ieee80211_link_sta **link_sta)struct hwsim_sta_priv *sp = (void *)sta->drv_priv;int i;if (!ieee80211_vif_is_mld(vif))return &vif->bss_conf;if (WARN_ON_ONCE(!sta || !sta->valid_links))return &vif->bss_conf;for (i = 0; i < ARRAY_SIZE(vif->link_conf); i++) {struct ieee80211_bss_conf *bss_conf;unsigned int link_id;/* round-robin the available link IDs */ if (!(vif->active_links & BIT(link_id)))continue ;if (!(sp->active_links_rx & BIT(link_id)))continue ;if (!*link_sta)continue ;if (WARN_ON_ONCE(!bss_conf))continue ;/* can happen while switching links */ if (!rcu_access_pointer(bss_conf->chanctx_conf))continue ;return bss_conf;return NULL;static void mac80211_hwsim_tx(struct ieee80211_hw *hw,struct ieee80211_tx_control *control,struct sk_buff *skb)struct mac80211_hwsim_data *data = hw->priv;struct ieee80211_tx_info *txi = IEEE80211_SKB_CB(skb);struct ieee80211_hdr *hdr = (void *)skb->data;struct ieee80211_chanctx_conf *chanctx_conf;struct ieee80211_channel *channel;bool ack;enum nl80211_chan_width confbw = NL80211_CHAN_WIDTH_20_NOHT;if (WARN_ON(skb->len < 10)) {/* Should not happen; just a sanity check for addr1 use */ return ;if (!data->use_chanctx) {else if (txi->hw_queue == 4) {else {struct ieee80211_vif *vif = txi->control.vif;struct ieee80211_link_sta *link_sta = NULL;struct ieee80211_sta *sta = control->sta;struct ieee80211_bss_conf *bss_conf;if (link != IEEE80211_LINK_UNSPECIFIED) {if (sta)else {if (unlikely(!bss_conf)) {/* if it's an MLO STA, it might have deactivated all * links temporarily - but we don't handle real PS in * this code yet, so just drop the frame in that case "link:%d, sta:%pM, sta->mlo:%d\n" ,return ;/* Do address translations only between shared links. It is * possible that while an non-AP MLD station and an AP MLD * station have shared links, the frame is intended to be sent * on a link which is not shared (for example when sending a * probe response). if (sta && sta->mlo && link_sta) {/* address translation to link addresses on TX */ /* translate A3 only if it's the BSSID */ if (!ieee80211_has_tods(hdr->frame_control) &&if (ether_addr_equal(hdr->addr3, sta->addr))else if (ether_addr_equal(hdr->addr3, vif->addr))/* no need to look at A4, if present it's SA */ if (chanctx_conf) {else {if (WARN(!channel, "TX w/o channel - queue = %d\n" , txi->hw_queue)) {return ;if (data->idle && !data->tmp_chan) {"Trying to TX when idle - reject\n" );return ;if (txi->control.vif)if (control->sta)if (ieee80211_hw_check(hw, SUPPORTS_RC_TABLE))for (i = 0; i < ARRAY_SIZE(txi->control.rates); i++) {/* initialize to data->bw for 5/10 MHz handling */ enum nl80211_chan_width bw = data->bw;if (txi->control.rates[i].idx == -1)break ;if (rflags & IEEE80211_TX_RC_40_MHZ_WIDTH)else if (rflags & IEEE80211_TX_RC_80_MHZ_WIDTH)else if (rflags & IEEE80211_TX_RC_160_MHZ_WIDTH)if (WARN_ON(hwsim_get_chanwidth(bw) > hwsim_get_chanwidth(confbw)))return ;if (skb->len >= 24 + 8 &&/* fake header transmission time */ struct ieee80211_mgmt *mgmt;struct ieee80211_rate *txrate;/* TODO: get MCS */ int bitrate = 100;struct ieee80211_mgmt *)skb->data;if (txrate)/* wmediumd mode check */ if (_portid || hwsim_virtio_enabled)return mac80211_hwsim_tx_frame_nl(hw, skb, _portid, channel);/* NO wmediumd detected, perfect medium simulation */ if (ack && skb->len >= 16)/* frame was transmitted at most favorable rate at first attempt */ if (!(txi->flags & IEEE80211_TX_CTL_NO_ACK) && ack)static int mac80211_hwsim_start(struct ieee80211_hw *hw)struct mac80211_hwsim_data *data = hw->priv;"%s\n" , __func__);true ;return 0;static void mac80211_hwsim_stop(struct ieee80211_hw *hw, bool suspend)struct mac80211_hwsim_data *data = hw->priv;int i;false ;for (i = 0; i < ARRAY_SIZE(data->link_data); i++)while (!skb_queue_empty(&data->pending))"%s\n" , __func__);static int mac80211_hwsim_add_interface(struct ieee80211_hw *hw,struct ieee80211_vif *vif)"%s (type=%d mac_addr=%pM)\n" ,if (vif->type != NL80211_IFTYPE_MONITOR)true );return 0;#ifdef CONFIG_MAC80211_DEBUGFSstatic void struct ieee80211_hw *hw,struct ieee80211_vif *vif,struct ieee80211_bss_conf *link_conf,struct dentry *dir)struct hwsim_vif_priv *vp = (void *)vif->drv_priv;"skip_beacons" , 0600, dir,#endif static int mac80211_hwsim_change_interface(struct ieee80211_hw *hw,struct ieee80211_vif *vif,enum nl80211_iftype newtype,bool newp2p)"%s (old type=%d, new type=%d, mac_addr=%pM)\n" ,/* * interface may change from non-AP to AP in * which case this needs to be set up again return 0;static void mac80211_hwsim_remove_interface(struct ieee80211_hw *hw, struct ieee80211_vif *vif)"%s (type=%d mac_addr=%pM)\n" ,if (vif->type != NL80211_IFTYPE_MONITOR)false );static void mac80211_hwsim_tx_frame(struct ieee80211_hw *hw,struct sk_buff *skb,struct ieee80211_channel *chan)struct mac80211_hwsim_data *data = hw->priv;if (ieee80211_hw_check(hw, SUPPORTS_RC_TABLE)) {struct ieee80211_tx_info *txi = IEEE80211_SKB_CB(skb);if (_portid || hwsim_virtio_enabled)return mac80211_hwsim_tx_frame_nl(hw, skb, _portid, chan);static void __mac80211_hwsim_beacon_tx(struct ieee80211_bss_conf *link_conf,struct mac80211_hwsim_data *data,struct ieee80211_hw *hw,struct ieee80211_vif *vif,struct sk_buff *skb)struct hwsim_vif_priv *vp = (void *)vif->drv_priv;struct ieee80211_tx_info *info;struct ieee80211_rate *txrate;struct ieee80211_mgmt *mgmt;/* TODO: get MCS */ int bitrate = 100;if (vp->skip_beacons[link_conf->link_id]) {return ;if (ieee80211_hw_check(hw, SUPPORTS_RC_TABLE))
Messung V0.5 C=92 H=95 G=93
¤ Dauer der Verarbeitung: 0.27 Sekunden
(vorverarbeitet)
¤ *© Formatika GbR, Deutschland
