mac80211: factor peering frame processing into own function
Signed-off-by: Thomas Pedersen <thomas@cozybit.com> Signed-off-by: Johannes Berg <johannes.berg@intel.com>
This commit is contained in:
parent
2d7f65d6f1
commit
05a23ae927
@ -691,54 +691,29 @@ static u32 mesh_plink_establish(struct ieee80211_sub_if_data *sdata,
|
|||||||
return changed;
|
return changed;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static void
|
||||||
void mesh_rx_plink_frame(struct ieee80211_sub_if_data *sdata,
|
mesh_process_plink_frame(struct ieee80211_sub_if_data *sdata,
|
||||||
struct ieee80211_mgmt *mgmt, size_t len,
|
struct ieee80211_mgmt *mgmt,
|
||||||
struct ieee80211_rx_status *rx_status)
|
struct ieee802_11_elems *elems)
|
||||||
{
|
{
|
||||||
|
|
||||||
struct mesh_config *mshcfg = &sdata->u.mesh.mshcfg;
|
struct mesh_config *mshcfg = &sdata->u.mesh.mshcfg;
|
||||||
enum ieee80211_self_protected_actioncode action = 0;
|
enum ieee80211_self_protected_actioncode action = 0;
|
||||||
struct ieee802_11_elems elems;
|
|
||||||
struct sta_info *sta;
|
struct sta_info *sta;
|
||||||
enum plink_event event;
|
enum plink_event event;
|
||||||
enum ieee80211_self_protected_actioncode ftype;
|
enum ieee80211_self_protected_actioncode ftype;
|
||||||
size_t baselen;
|
|
||||||
bool matches_local;
|
bool matches_local;
|
||||||
u8 ie_len;
|
|
||||||
u8 *baseaddr;
|
|
||||||
u32 changed = 0;
|
u32 changed = 0;
|
||||||
|
u8 ie_len;
|
||||||
__le16 plid, llid;
|
__le16 plid, llid;
|
||||||
|
|
||||||
/* need action_code, aux */
|
if (!elems->peering) {
|
||||||
if (len < IEEE80211_MIN_ACTION_SIZE + 3)
|
|
||||||
return;
|
|
||||||
|
|
||||||
if (sdata->u.mesh.user_mpm)
|
|
||||||
/* userspace must register for these */
|
|
||||||
return;
|
|
||||||
|
|
||||||
if (is_multicast_ether_addr(mgmt->da)) {
|
|
||||||
mpl_dbg(sdata,
|
|
||||||
"Mesh plink: ignore frame from multicast address\n");
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
baseaddr = mgmt->u.action.u.self_prot.variable;
|
|
||||||
baselen = (u8 *) mgmt->u.action.u.self_prot.variable - (u8 *) mgmt;
|
|
||||||
if (mgmt->u.action.u.self_prot.action_code ==
|
|
||||||
WLAN_SP_MESH_PEERING_CONFIRM) {
|
|
||||||
baseaddr += 4;
|
|
||||||
baselen += 4;
|
|
||||||
}
|
|
||||||
ieee802_11_parse_elems(baseaddr, len - baselen, true, &elems);
|
|
||||||
|
|
||||||
if (!elems.peering) {
|
|
||||||
mpl_dbg(sdata,
|
mpl_dbg(sdata,
|
||||||
"Mesh plink: missing necessary peer link ie\n");
|
"Mesh plink: missing necessary peer link ie\n");
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (elems.rsn_len &&
|
if (elems->rsn_len &&
|
||||||
sdata->u.mesh.security == IEEE80211_MESH_SEC_NONE) {
|
sdata->u.mesh.security == IEEE80211_MESH_SEC_NONE) {
|
||||||
mpl_dbg(sdata,
|
mpl_dbg(sdata,
|
||||||
"Mesh plink: can't establish link with secure peer\n");
|
"Mesh plink: can't establish link with secure peer\n");
|
||||||
@ -746,7 +721,7 @@ void mesh_rx_plink_frame(struct ieee80211_sub_if_data *sdata,
|
|||||||
}
|
}
|
||||||
|
|
||||||
ftype = mgmt->u.action.u.self_prot.action_code;
|
ftype = mgmt->u.action.u.self_prot.action_code;
|
||||||
ie_len = elems.peering_len;
|
ie_len = elems->peering_len;
|
||||||
if ((ftype == WLAN_SP_MESH_PEERING_OPEN && ie_len != 4) ||
|
if ((ftype == WLAN_SP_MESH_PEERING_OPEN && ie_len != 4) ||
|
||||||
(ftype == WLAN_SP_MESH_PEERING_CONFIRM && ie_len != 6) ||
|
(ftype == WLAN_SP_MESH_PEERING_CONFIRM && ie_len != 6) ||
|
||||||
(ftype == WLAN_SP_MESH_PEERING_CLOSE && ie_len != 6
|
(ftype == WLAN_SP_MESH_PEERING_CLOSE && ie_len != 6
|
||||||
@ -758,25 +733,25 @@ void mesh_rx_plink_frame(struct ieee80211_sub_if_data *sdata,
|
|||||||
}
|
}
|
||||||
|
|
||||||
if (ftype != WLAN_SP_MESH_PEERING_CLOSE &&
|
if (ftype != WLAN_SP_MESH_PEERING_CLOSE &&
|
||||||
(!elems.mesh_id || !elems.mesh_config)) {
|
(!elems->mesh_id || !elems->mesh_config)) {
|
||||||
mpl_dbg(sdata, "Mesh plink: missing necessary ie\n");
|
mpl_dbg(sdata, "Mesh plink: missing necessary ie\n");
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
/* Note the lines below are correct, the llid in the frame is the plid
|
/* Note the lines below are correct, the llid in the frame is the plid
|
||||||
* from the point of view of this host.
|
* from the point of view of this host.
|
||||||
*/
|
*/
|
||||||
memcpy(&plid, PLINK_GET_LLID(elems.peering), 2);
|
memcpy(&plid, PLINK_GET_LLID(elems->peering), 2);
|
||||||
if (ftype == WLAN_SP_MESH_PEERING_CONFIRM ||
|
if (ftype == WLAN_SP_MESH_PEERING_CONFIRM ||
|
||||||
(ftype == WLAN_SP_MESH_PEERING_CLOSE && ie_len == 8))
|
(ftype == WLAN_SP_MESH_PEERING_CLOSE && ie_len == 8))
|
||||||
memcpy(&llid, PLINK_GET_PLID(elems.peering), 2);
|
memcpy(&llid, PLINK_GET_PLID(elems->peering), 2);
|
||||||
|
|
||||||
/* WARNING: Only for sta pointer, is dropped & re-acquired */
|
/* WARNING: Only for sta pointer, is dropped & re-acquired */
|
||||||
rcu_read_lock();
|
rcu_read_lock();
|
||||||
|
|
||||||
sta = sta_info_get(sdata, mgmt->sa);
|
sta = sta_info_get(sdata, mgmt->sa);
|
||||||
|
|
||||||
matches_local = ftype == WLAN_SP_MESH_PEERING_CLOSE ||
|
matches_local = (ftype == WLAN_SP_MESH_PEERING_CLOSE ||
|
||||||
mesh_matches_local(sdata, &elems);
|
mesh_matches_local(sdata, elems));
|
||||||
|
|
||||||
if (ftype == WLAN_SP_MESH_PEERING_OPEN &&
|
if (ftype == WLAN_SP_MESH_PEERING_OPEN &&
|
||||||
!rssi_threshold_check(sdata, sta)) {
|
!rssi_threshold_check(sdata, sta)) {
|
||||||
@ -872,7 +847,7 @@ void mesh_rx_plink_frame(struct ieee80211_sub_if_data *sdata,
|
|||||||
if (event == OPN_ACPT) {
|
if (event == OPN_ACPT) {
|
||||||
rcu_read_unlock();
|
rcu_read_unlock();
|
||||||
/* allocate sta entry if necessary and update info */
|
/* allocate sta entry if necessary and update info */
|
||||||
sta = mesh_sta_info_get(sdata, mgmt->sa, &elems);
|
sta = mesh_sta_info_get(sdata, mgmt->sa, elems);
|
||||||
if (!sta) {
|
if (!sta) {
|
||||||
mpl_dbg(sdata, "Mesh plink: failed to init peer!\n");
|
mpl_dbg(sdata, "Mesh plink: failed to init peer!\n");
|
||||||
rcu_read_unlock();
|
rcu_read_unlock();
|
||||||
@ -1028,3 +1003,36 @@ void mesh_rx_plink_frame(struct ieee80211_sub_if_data *sdata,
|
|||||||
if (changed)
|
if (changed)
|
||||||
ieee80211_mbss_info_change_notify(sdata, changed);
|
ieee80211_mbss_info_change_notify(sdata, changed);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
void mesh_rx_plink_frame(struct ieee80211_sub_if_data *sdata,
|
||||||
|
struct ieee80211_mgmt *mgmt, size_t len,
|
||||||
|
struct ieee80211_rx_status *rx_status)
|
||||||
|
{
|
||||||
|
struct ieee802_11_elems elems;
|
||||||
|
size_t baselen;
|
||||||
|
u8 *baseaddr;
|
||||||
|
|
||||||
|
/* need action_code, aux */
|
||||||
|
if (len < IEEE80211_MIN_ACTION_SIZE + 3)
|
||||||
|
return;
|
||||||
|
|
||||||
|
if (sdata->u.mesh.user_mpm)
|
||||||
|
/* userspace must register for these */
|
||||||
|
return;
|
||||||
|
|
||||||
|
if (is_multicast_ether_addr(mgmt->da)) {
|
||||||
|
mpl_dbg(sdata,
|
||||||
|
"Mesh plink: ignore frame from multicast address\n");
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
baseaddr = mgmt->u.action.u.self_prot.variable;
|
||||||
|
baselen = (u8 *) mgmt->u.action.u.self_prot.variable - (u8 *) mgmt;
|
||||||
|
if (mgmt->u.action.u.self_prot.action_code ==
|
||||||
|
WLAN_SP_MESH_PEERING_CONFIRM) {
|
||||||
|
baseaddr += 4;
|
||||||
|
baselen += 4;
|
||||||
|
}
|
||||||
|
ieee802_11_parse_elems(baseaddr, len - baselen, true, &elems);
|
||||||
|
mesh_process_plink_frame(sdata, mgmt, &elems);
|
||||||
|
}
|
||||||
|
Loading…
Reference in New Issue
Block a user