@@ -238,6 +238,32 @@ static struct station *get_station_by_addr(struct wmediumd *ctx, u8 *addr)
return NULL;
}
+static bool station_has_addr(struct station *station, const u8 *addr)
+{
+ unsigned int i;
+
+ if (memcmp(station->addr, addr, ETH_ALEN) == 0)
+ return true;
+
+ for (i = 0; i < station->n_addrs; i++) {
+ if (memcmp(station->addrs[i].addr, addr, ETH_ALEN) == 0)
+ return true;
+ }
+
+ return false;
+}
+
+static struct station *get_station_by_used_addr(struct wmediumd *ctx, u8 *addr)
+{
+ struct station *station;
+
+ list_for_each_entry(station, &ctx->stations, list) {
+ if (station_has_addr(station, addr))
+ return station;
+ }
+ return NULL;
+}
+
static void queue_frame(struct wmediumd *ctx, struct station *station,
struct frame *frame)
{
@@ -285,7 +311,7 @@ static void queue_frame(struct wmediumd *ctx, struct station *station,
if (is_multicast_ether_addr(dest)) {
deststa = NULL;
} else {
- deststa = get_station_by_addr(ctx, dest);
+ deststa = get_station_by_used_addr(ctx, dest);
if (deststa) {
snr = ctx->get_link_snr(ctx, station, deststa) -
get_signal_offset_by_interference(ctx,
@@ -586,7 +612,7 @@ static void wmediumd_deliver_frame(struct usfstl_job *job)
1, signal,
frame->freq);
- } else if (memcmp(dest, station->addr, ETH_ALEN) == 0) {
+ } else if (station_has_addr(station, dest)) {
if (set_interference_duration(ctx,
frame->sender->index, frame->duration,
frame->signal))
@@ -657,13 +683,16 @@ static void _process_messages(struct nl_msg *msg,
struct station *sender;
struct frame *frame;
struct ieee80211_hdr *hdr;
- u8 *src;
+ u8 *src, *hwaddr, *addr;
+ void *new;
+ unsigned int i;
+
+ genlmsg_parse(nlh, 0, attrs, HWSIM_ATTR_MAX, NULL);
- if (gnlh->cmd == HWSIM_CMD_FRAME) {
- /* we get the attributes*/
- genlmsg_parse(nlh, 0, attrs, HWSIM_ATTR_MAX, NULL);
+ switch (gnlh->cmd) {
+ case HWSIM_CMD_FRAME:
if (attrs[HWSIM_ATTR_ADDR_TRANSMITTER]) {
- u8 *hwaddr = (u8 *)nla_data(attrs[HWSIM_ATTR_ADDR_TRANSMITTER]);
+ hwaddr = (u8 *)nla_data(attrs[HWSIM_ATTR_ADDR_TRANSMITTER]);
unsigned int data_len =
nla_len(attrs[HWSIM_ATTR_FRAME]);
@@ -687,12 +716,18 @@ static void _process_messages(struct nl_msg *msg,
if (data_len < 6 + 6 + 4)
return;
- sender = get_station_by_addr(ctx, src);
+ sender = get_station_by_addr(ctx, hwaddr);
if (!sender) {
- w_flogf(ctx, LOG_ERR, stderr, "Unable to find sender station " MAC_FMT "\n", MAC_ARGS(src));
- return;
+ sender = get_station_by_used_addr(ctx, src);
+ if (!sender) {
+ w_flogf(ctx, LOG_ERR, stderr,
+ "Unable to find sender station by src=" MAC_FMT " nor hwaddr=" MAC_FMT "\n",
+ MAC_ARGS(src), MAC_ARGS(hwaddr));
+ return;
+ }
+ memcpy(sender->hwaddr, hwaddr, ETH_ALEN);
}
- memcpy(sender->hwaddr, hwaddr, ETH_ALEN);
+
if (!sender->client)
sender->client = client;
@@ -712,6 +747,46 @@ static void _process_messages(struct nl_msg *msg,
min(tx_rates_len, sizeof(frame->tx_rates)));
queue_frame(ctx, sender, frame);
}
+ break;
+ case HWSIM_CMD_ADD_MAC_ADDR:
+ if (!attrs[HWSIM_ATTR_ADDR_TRANSMITTER] ||
+ !attrs[HWSIM_ATTR_ADDR_RECEIVER])
+ break;
+ hwaddr = (u8 *)nla_data(attrs[HWSIM_ATTR_ADDR_TRANSMITTER]);
+ addr = (u8 *)nla_data(attrs[HWSIM_ATTR_ADDR_RECEIVER]);
+ sender = get_station_by_addr(ctx, hwaddr);
+ if (!sender)
+ break;
+ for (i = 0; i < sender->n_addrs; i++) {
+ if (memcmp(sender->addrs[i].addr, addr, ETH_ALEN) == 0)
+ return;
+ }
+ new = realloc(sender->addrs, ETH_ALEN * (sender->n_addrs + 1));
+ if (!new)
+ break;
+ sender->addrs = new;
+ memcpy(sender->addrs[sender->n_addrs].addr, addr, ETH_ALEN);
+ sender->n_addrs += 1;
+ break;
+ case HWSIM_CMD_DEL_MAC_ADDR:
+ if (!attrs[HWSIM_ATTR_ADDR_TRANSMITTER] ||
+ !attrs[HWSIM_ATTR_ADDR_RECEIVER])
+ break;
+ hwaddr = (u8 *)nla_data(attrs[HWSIM_ATTR_ADDR_TRANSMITTER]);
+ addr = (u8 *)nla_data(attrs[HWSIM_ATTR_ADDR_RECEIVER]);
+ sender = get_station_by_addr(ctx, hwaddr);
+ if (!sender)
+ break;
+ for (i = 0; i < sender->n_addrs; i++) {
+ if (memcmp(sender->addrs[i].addr, addr, ETH_ALEN))
+ continue;
+ sender->n_addrs -= 1;
+ memmove(sender->addrs[i].addr,
+ sender->addrs[sender->n_addrs].addr,
+ ETH_ALEN);
+ break;
+ }
+ break;
}
}
@@ -29,9 +29,19 @@
#define HWSIM_TX_CTL_NO_ACK (1 << 1)
#define HWSIM_TX_STAT_ACK (1 << 2)
-#define HWSIM_CMD_REGISTER 1
-#define HWSIM_CMD_FRAME 2
-#define HWSIM_CMD_TX_INFO_FRAME 3
+enum {
+ HWSIM_CMD_UNSPEC,
+ HWSIM_CMD_REGISTER,
+ HWSIM_CMD_FRAME,
+ HWSIM_CMD_TX_INFO_FRAME,
+ HWSIM_CMD_NEW_RADIO,
+ HWSIM_CMD_DEL_RADIO,
+ HWSIM_CMD_GET_RADIO,
+ HWSIM_CMD_ADD_MAC_ADDR,
+ HWSIM_CMD_DEL_MAC_ADDR,
+ __HWSIM_CMD_MAX,
+};
+#define HWSIM_CMD_MAX (_HWSIM_CMD_MAX - 1)
/**
* enum hwsim_attrs - hwsim netlink attributes
@@ -135,6 +145,10 @@ struct wqueue {
int cw_max;
};
+struct addr {
+ u8 addr[ETH_ALEN];
+};
+
struct station {
int index;
u8 addr[ETH_ALEN]; /* virtual interface mac address */
@@ -145,6 +159,8 @@ struct station {
struct wqueue queues[IEEE80211_NUM_ACS];
struct list_head list;
struct client *client;
+ unsigned int n_addrs;
+ struct addr *addrs;
};
enum client_type {
From: Johannes Berg <johannes.berg@intel.com> With newer kernels, mac80211_hwsim indicates to us when it starts and stops using a certain MAC address on a certain radio. Without that, there's a need to configure each MAC address as a station, which is not only incorrect (a station can have multiple addresses and wouldn't have a different position or different frame loss probabilities between them) but also impractical, e.g. for random scanning. Add the necessary code to track and use this information, and look up sender station by the HW address and destination by any of the used addresses. Still keep looking up by source address as well to not break any existing use cases. --- wmediumd/wmediumd.c | 97 ++++++++++++++++++++++++++++++++++++++++----- wmediumd/wmediumd.h | 22 ++++++++-- 2 files changed, 105 insertions(+), 14 deletions(-)