@@ -412,6 +412,41 @@ static const struct file_operations force_tx_status_ops = {
.llseek = default_llseek,
};
+static ssize_t dbg_mask_read(struct file *file, char __user *user_buf,
+ size_t count, loff_t *ppos)
+{
+ struct ieee80211_local *local = file->private_data;
+ char buf[128];
+ int len;
+
+ len = scnprintf(buf, sizeof(buf), "0x%x\n", local->dbg_mask);
+
+ return simple_read_from_buffer(user_buf, count, ppos, buf, len);
+}
+
+static ssize_t dbg_mask_write(struct file *file, const char __user *user_buf,
+ size_t count, loff_t *ppos)
+{
+ struct ieee80211_local *local = file->private_data;
+ int ret;
+ u32 mask;
+
+ ret = kstrtou32_from_user(user_buf, count, 0, &mask);
+ if (ret || mask >= IEEE80211_HW_MAX_DBG_MASK)
+ return -EINVAL;
+
+ local->dbg_mask = mask;
+
+ return count;
+}
+
+static const struct file_operations dbg_mask_ops = {
+ .write = dbg_mask_write,
+ .read = dbg_mask_read,
+ .open = simple_open,
+ .llseek = default_llseek,
+};
+
#ifdef CONFIG_PM
static ssize_t reset_write(struct file *file, const char __user *user_buf,
size_t count, loff_t *ppos)
@@ -663,6 +698,7 @@ void debugfs_hw_add(struct ieee80211_local *local)
DEBUGFS_ADD_MODE(force_tx_status, 0600);
DEBUGFS_ADD_MODE(aql_enable, 0600);
DEBUGFS_ADD(aql_pending);
+ DEBUGFS_ADD_MODE(dbg_mask, 0600);
DEBUGFS_ADD_MODE(aqm, 0600);
DEBUGFS_ADD_MODE(airtime_flags, 0600);
@@ -297,6 +297,34 @@ static ssize_t ieee80211_if_parse_smps(struct ieee80211_sub_if_data *sdata,
}
IEEE80211_IF_FILE_RW(smps);
+static ssize_t
+ ieee80211_if_fmt_bmiss_threshold(const struct ieee80211_sub_if_data *sdata,
+ char *buf, int buflen)
+{
+ return snprintf(buf, buflen, "%u\n", sdata->bmiss_threshold);
+}
+
+static ssize_t
+ ieee80211_if_parse_bmiss_threshold(struct ieee80211_sub_if_data *sdata,
+ const char *buf, int buflen)
+{
+ int ret;
+ u8 val;
+
+ ret = kstrtou8(buf, 0, &val);
+ if (ret)
+ return ret;
+
+ if (!val)
+ return -EINVAL;
+
+ sdata->bmiss_threshold = val;
+
+ return buflen;
+}
+
+IEEE80211_IF_FILE_RW(bmiss_threshold);
+
static ssize_t ieee80211_if_parse_tkip_mic_test(
struct ieee80211_sub_if_data *sdata, const char *buf, int buflen)
{
@@ -704,6 +732,7 @@ static void add_ap_files(struct ieee80211_sub_if_data *sdata)
DEBUGFS_ADD(num_buffered_multicast);
DEBUGFS_ADD_MODE(tkip_mic_test, 0200);
DEBUGFS_ADD_MODE(multicast_to_unicast, 0600);
+ DEBUGFS_ADD_MODE(bmiss_threshold, 0600);
}
static void add_vlan_files(struct ieee80211_sub_if_data *sdata)
@@ -724,6 +753,7 @@ static void add_mesh_files(struct ieee80211_sub_if_data *sdata)
{
DEBUGFS_ADD_MODE(tsf, 0600);
DEBUGFS_ADD_MODE(estab_plinks, 0400);
+ DEBUGFS_ADD_MODE(bmiss_threshold, 0600);
}
static void add_mesh_stats(struct ieee80211_sub_if_data *sdata)
@@ -1098,6 +1098,10 @@ struct ieee80211_sub_if_data {
struct dentry *default_beacon_key;
} debugfs;
#endif
+ /* beacon miss threshold that is used to change the beacon miss
+ * timer value
+ */
+ u8 bmiss_threshold;
/* must be last, dynamically sized area in this! */
struct ieee80211_vif vif;
@@ -1269,6 +1273,19 @@ enum mac80211_scan_state {
DECLARE_STATIC_KEY_FALSE(aql_disable);
+/**
+ * enum ieee80211_dbg_mask - Debug mask to enable and disable logs
+ * in runtime
+ *
+ * @IEEE80211_HW_DBG_BMISS_LOG: To enable/disable mesh beacon miss logs
+ *
+ * @IEEE80211_HW_MAX_DBG_MASK: Max debug mask value
+ */
+enum ieee80211_dbg_mask {
+ IEEE80211_HW_DBG_BMISS_LOG = BIT(0),
+ IEEE80211_HW_MAX_DBG_MASK = BIT(1)
+};
+
struct ieee80211_local {
/* embed the driver visible part.
* don't cast (use the static inlines below), but we keep
@@ -1559,6 +1576,9 @@ struct ieee80211_local {
/* extended capabilities provided by mac80211 */
u8 ext_capa[8];
+
+ /* debug mask */
+ u32 dbg_mask;
};
static inline struct ieee80211_sub_if_data *
@@ -163,6 +163,8 @@ void mesh_sta_cleanup(struct sta_info *sta)
struct ieee80211_sub_if_data *sdata = sta->sdata;
u32 changed = mesh_plink_deactivate(sta);
+ del_timer_sync(&sta->mesh->bmiss_timer);
+
if (changed)
ieee80211_mbss_info_change_notify(sdata, changed);
}
@@ -1357,6 +1359,9 @@ static void ieee80211_mesh_rx_bcn_presp(struct ieee80211_sub_if_data *sdata,
if (ifmsh->csa_role != IEEE80211_MESH_CSA_ROLE_INIT &&
!sdata->vif.bss_conf.csa_active)
ieee80211_mesh_process_chnswitch(sdata, elems, true);
+
+ if (stype != IEEE80211_STYPE_PROBE_RESP)
+ mesh_bmiss_update(sdata, mgmt, elems, rx_status);
}
if (ifmsh->sync_ops)
@@ -263,6 +263,9 @@ int mesh_path_send_to_gates(struct mesh_path *mpath);
int mesh_gate_num(struct ieee80211_sub_if_data *sdata);
u32 airtime_link_metric_get(struct ieee80211_local *local,
struct sta_info *sta);
+void mesh_bmiss_update(struct ieee80211_sub_if_data *sdata,
+ struct ieee80211_mgmt *mgmt, struct ieee802_11_elems *ie,
+ struct ieee80211_rx_status *rx_status);
/* Mesh plinks */
void mesh_neighbour_update(struct ieee80211_sub_if_data *sdata,
@@ -298,6 +301,7 @@ void mesh_path_discard_frame(struct ieee80211_sub_if_data *sdata,
void mesh_path_tx_root_frame(struct ieee80211_sub_if_data *sdata);
bool mesh_action_is_path_sel(struct ieee80211_mgmt *mgmt);
+void mesh_bmiss_event(struct timer_list *t);
#ifdef CONFIG_MAC80211_MESH
static inline
@@ -594,6 +594,80 @@ mesh_sta_info_get(struct ieee80211_sub_if_data *sdata,
return sta;
}
+/**
+ * mesh_bmiss_update - update beacon miss parameters such as
+ * beacon count, beacon interval and timeout of beacon miss
+ * timer
+ *
+ * @sdata: local meshif
+ * @mgmt: mgmt frame info
+ * @elems: IEs from beacon or mesh peering frame.
+ * @rx_status: rx status for the frame for signal reporting
+ *
+ */
+
+void mesh_bmiss_update(struct ieee80211_sub_if_data *sdata,
+ struct ieee80211_mgmt *mgmt,
+ struct ieee802_11_elems *elems,
+ struct ieee80211_rx_status *rx_status)
+{
+ struct sta_info *sta;
+ u32 timeout;
+
+ /* mesh_sta_info_get api returns with rcu_read_lock */
+ sta = mesh_sta_info_get(sdata, mgmt->sa, elems, rx_status);
+ if (!sta)
+ goto unlock_rcu;
+
+ if (!(sta->local->dbg_mask & IEEE80211_HW_DBG_BMISS_LOG) ||
+ !sta->sdata->bmiss_threshold)
+ goto unlock_rcu;
+
+ sta->mesh->bmiss_count = 0;
+ sta->mesh->beacon_int = le16_to_cpu(mgmt->u.beacon.beacon_int);
+ timeout = sta->mesh->beacon_int * sta->sdata->bmiss_threshold;
+
+ mod_timer(&sta->mesh->bmiss_timer,
+ (jiffies + msecs_to_jiffies(timeout)));
+
+unlock_rcu:
+ rcu_read_unlock();
+}
+
+/**
+ * mesh_bmiss_event - counts the beacon miss events and updates
+ * beacon miss timer
+ *
+ * @timer: beacon miss timer
+ *
+ */
+
+void mesh_bmiss_event(struct timer_list *timer)
+{
+ struct mesh_sta *mesh = from_timer(mesh, timer, bmiss_timer);
+ struct sta_info *sta;
+ u32 timeout;
+
+ rcu_read_lock();
+ sta = mesh->plink_sta;
+
+ if (!(sta->local->dbg_mask & IEEE80211_HW_DBG_BMISS_LOG) ||
+ !sta->sdata->bmiss_threshold)
+ goto unlock_rcu;
+
+ mesh->bmiss_count++;
+ sdata_info(sta->sdata, "Beacon miss count %u from %pM\n",
+ mesh->bmiss_count, sta->sta.addr);
+
+ timeout = sta->mesh->beacon_int * sta->sdata->bmiss_threshold;
+
+ mod_timer(&sta->mesh->bmiss_timer,
+ (jiffies + msecs_to_jiffies(timeout)));
+
+unlock_rcu:
+ rcu_read_unlock();
+}
+
/*
* mesh_neighbour_update - update or initialize new mesh neighbor.
*
@@ -567,6 +567,7 @@ __sta_info_alloc(struct ieee80211_sub_if_data *sdata,
if (!sdata->u.mesh.user_mpm)
timer_setup(&sta->mesh->plink_timer, mesh_plink_timer,
0);
+ timer_setup(&sta->mesh->bmiss_timer, mesh_bmiss_event, 0);
sta->mesh->nonpeer_pm = NL80211_MESH_POWER_ACTIVE;
}
#endif
@@ -391,6 +391,9 @@ DECLARE_EWMA(mesh_tx_rate_avg, 8, 16)
* @connected_to_as: true if mesh STA has a path to a authentication server
* @fail_avg: moving percentage of failed MSDUs
* @tx_rate_avg: moving average of tx bitrate
+ * @bmiss_count: beacon miss count
+ * @bmiss_timer: timer to capture missed beacons
+ * @beacon_int: beacon interval
*/
struct mesh_sta {
struct timer_list plink_timer;
@@ -418,6 +421,10 @@ struct mesh_sta {
enum nl80211_mesh_power_mode peer_pm;
enum nl80211_mesh_power_mode nonpeer_pm;
+ struct timer_list bmiss_timer;
+ u32 bmiss_count;
+ u16 beacon_int;
+
/* moving percentage of failed MSDUs */
struct ewma_mesh_fail_avg fail_avg;
/* moving average of tx bitrate */