|
@@ -27,6 +27,7 @@
|
|
#include <linux/rtnetlink.h>
|
|
#include <linux/rtnetlink.h>
|
|
#include <net/iw_handler.h>
|
|
#include <net/iw_handler.h>
|
|
#include <asm/types.h>
|
|
#include <asm/types.h>
|
|
|
|
+#include <asm/unaligned.h>
|
|
|
|
|
|
#include <net/mac80211.h>
|
|
#include <net/mac80211.h>
|
|
#include "ieee80211_i.h"
|
|
#include "ieee80211_i.h"
|
|
@@ -2123,6 +2124,11 @@ ieee80211_rx_bss_get(struct net_device *dev, u8 *bssid, int freq,
|
|
}
|
|
}
|
|
|
|
|
|
#ifdef CONFIG_MAC80211_MESH
|
|
#ifdef CONFIG_MAC80211_MESH
|
|
|
|
+static inline u32 bss_mesh_cfg_get(u8 *mesh_cfg, u8 offset)
|
|
|
|
+{
|
|
|
|
+ return be32_to_cpu(get_unaligned((__be32 *) (mesh_cfg + offset)));
|
|
|
|
+}
|
|
|
|
+
|
|
static struct ieee80211_sta_bss *
|
|
static struct ieee80211_sta_bss *
|
|
ieee80211_rx_mesh_bss_get(struct net_device *dev, u8 *mesh_id, int mesh_id_len,
|
|
ieee80211_rx_mesh_bss_get(struct net_device *dev, u8 *mesh_id, int mesh_id_len,
|
|
u8 *mesh_cfg, int freq)
|
|
u8 *mesh_cfg, int freq)
|
|
@@ -2162,7 +2168,7 @@ ieee80211_rx_mesh_bss_add(struct net_device *dev, u8 *mesh_id, int mesh_id_len,
|
|
if (!bss)
|
|
if (!bss)
|
|
return NULL;
|
|
return NULL;
|
|
|
|
|
|
- bss->mesh_cfg = kmalloc(MESH_CFG_CMP_LEN, GFP_ATOMIC);
|
|
|
|
|
|
+ bss->mesh_cfg = kmalloc(sizeof(struct bss_mesh_config), GFP_ATOMIC);
|
|
if (!bss->mesh_cfg) {
|
|
if (!bss->mesh_cfg) {
|
|
kfree(bss);
|
|
kfree(bss);
|
|
return NULL;
|
|
return NULL;
|
|
@@ -2180,7 +2186,12 @@ ieee80211_rx_mesh_bss_add(struct net_device *dev, u8 *mesh_id, int mesh_id_len,
|
|
|
|
|
|
atomic_inc(&bss->users);
|
|
atomic_inc(&bss->users);
|
|
atomic_inc(&bss->users);
|
|
atomic_inc(&bss->users);
|
|
- memcpy(bss->mesh_cfg, mesh_cfg, MESH_CFG_CMP_LEN);
|
|
|
|
|
|
+ bss->mesh_cfg->mesh_version = mesh_cfg[0];
|
|
|
|
+ bss->mesh_cfg->path_proto_id = bss_mesh_cfg_get(mesh_cfg, PP_OFFSET);
|
|
|
|
+ bss->mesh_cfg->path_metric_id = bss_mesh_cfg_get(mesh_cfg, PM_OFFSET);
|
|
|
|
+ bss->mesh_cfg->cong_control_id = bss_mesh_cfg_get(mesh_cfg, CC_OFFSET);
|
|
|
|
+ bss->mesh_cfg->channel_precedence = bss_mesh_cfg_get(mesh_cfg,
|
|
|
|
+ CP_OFFSET);
|
|
bss->mesh_id_len = mesh_id_len;
|
|
bss->mesh_id_len = mesh_id_len;
|
|
bss->freq = freq;
|
|
bss->freq = freq;
|
|
spin_lock_bh(&local->sta_bss_lock);
|
|
spin_lock_bh(&local->sta_bss_lock);
|
|
@@ -4057,36 +4068,33 @@ ieee80211_sta_scan_result(struct net_device *dev,
|
|
|
|
|
|
if (bss_mesh_cfg(bss)) {
|
|
if (bss_mesh_cfg(bss)) {
|
|
char *buf;
|
|
char *buf;
|
|
- u8 *cfg = bss_mesh_cfg(bss);
|
|
|
|
|
|
+ struct bss_mesh_config *cfg = bss_mesh_cfg(bss);
|
|
buf = kmalloc(50, GFP_ATOMIC);
|
|
buf = kmalloc(50, GFP_ATOMIC);
|
|
if (buf) {
|
|
if (buf) {
|
|
memset(&iwe, 0, sizeof(iwe));
|
|
memset(&iwe, 0, sizeof(iwe));
|
|
iwe.cmd = IWEVCUSTOM;
|
|
iwe.cmd = IWEVCUSTOM;
|
|
- sprintf(buf, "Mesh network (version %d)", cfg[0]);
|
|
|
|
|
|
+ sprintf(buf, "Mesh network (version %d)",
|
|
|
|
+ cfg->mesh_version);
|
|
iwe.u.data.length = strlen(buf);
|
|
iwe.u.data.length = strlen(buf);
|
|
current_ev = iwe_stream_add_point(current_ev, end_buf,
|
|
current_ev = iwe_stream_add_point(current_ev, end_buf,
|
|
&iwe, buf);
|
|
&iwe, buf);
|
|
sprintf(buf, "Path Selection Protocol ID: "
|
|
sprintf(buf, "Path Selection Protocol ID: "
|
|
- "0x%02X%02X%02X%02X", cfg[1], cfg[2], cfg[3],
|
|
|
|
- cfg[4]);
|
|
|
|
|
|
+ "0x%08X", cfg->path_proto_id);
|
|
iwe.u.data.length = strlen(buf);
|
|
iwe.u.data.length = strlen(buf);
|
|
current_ev = iwe_stream_add_point(current_ev, end_buf,
|
|
current_ev = iwe_stream_add_point(current_ev, end_buf,
|
|
&iwe, buf);
|
|
&iwe, buf);
|
|
sprintf(buf, "Path Selection Metric ID: "
|
|
sprintf(buf, "Path Selection Metric ID: "
|
|
- "0x%02X%02X%02X%02X", cfg[5], cfg[6], cfg[7],
|
|
|
|
- cfg[8]);
|
|
|
|
|
|
+ "0x%08X", cfg->path_metric_id);
|
|
iwe.u.data.length = strlen(buf);
|
|
iwe.u.data.length = strlen(buf);
|
|
current_ev = iwe_stream_add_point(current_ev, end_buf,
|
|
current_ev = iwe_stream_add_point(current_ev, end_buf,
|
|
&iwe, buf);
|
|
&iwe, buf);
|
|
sprintf(buf, "Congestion Control Mode ID: "
|
|
sprintf(buf, "Congestion Control Mode ID: "
|
|
- "0x%02X%02X%02X%02X", cfg[9], cfg[10],
|
|
|
|
- cfg[11], cfg[12]);
|
|
|
|
|
|
+ "0x%08X", cfg->cong_control_id);
|
|
iwe.u.data.length = strlen(buf);
|
|
iwe.u.data.length = strlen(buf);
|
|
current_ev = iwe_stream_add_point(current_ev, end_buf,
|
|
current_ev = iwe_stream_add_point(current_ev, end_buf,
|
|
&iwe, buf);
|
|
&iwe, buf);
|
|
sprintf(buf, "Channel Precedence: "
|
|
sprintf(buf, "Channel Precedence: "
|
|
- "0x%02X%02X%02X%02X", cfg[13], cfg[14],
|
|
|
|
- cfg[15], cfg[16]);
|
|
|
|
|
|
+ "0x%08X", cfg->channel_precedence);
|
|
iwe.u.data.length = strlen(buf);
|
|
iwe.u.data.length = strlen(buf);
|
|
current_ev = iwe_stream_add_point(current_ev, end_buf,
|
|
current_ev = iwe_stream_add_point(current_ev, end_buf,
|
|
&iwe, buf);
|
|
&iwe, buf);
|