2 * Copyright (c) 2008, 2009 open80211s Ltd.
3 * Authors: Luis Carlos Cobo <luisca@cozybit.com>
4 * Javier Cardona <javier@cozybit.com>
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License version 2 as
8 * published by the Free Software Foundation.
11 #include <linux/slab.h>
12 #include <asm/unaligned.h>
13 #include "ieee80211_i.h"
16 #define TMR_RUNNING_HK 0
17 #define TMR_RUNNING_MP 1
18 #define TMR_RUNNING_MPR 2
21 static struct kmem_cache
*rm_cache
;
23 #ifdef CONFIG_MAC80211_MESH
24 bool mesh_action_is_path_sel(struct ieee80211_mgmt
*mgmt
)
26 return (mgmt
->u
.action
.u
.mesh_action
.action_code
==
27 WLAN_MESH_ACTION_HWMP_PATH_SELECTION
);
30 bool mesh_action_is_path_sel(struct ieee80211_mgmt
*mgmt
)
34 void ieee80211s_init(void)
38 rm_cache
= kmem_cache_create("mesh_rmc", sizeof(struct rmc_entry
),
42 void ieee80211s_stop(void)
44 mesh_pathtbl_unregister();
45 kmem_cache_destroy(rm_cache
);
48 static void ieee80211_mesh_housekeeping_timer(unsigned long data
)
50 struct ieee80211_sub_if_data
*sdata
= (void *) data
;
51 struct ieee80211_local
*local
= sdata
->local
;
52 struct ieee80211_if_mesh
*ifmsh
= &sdata
->u
.mesh
;
54 set_bit(MESH_WORK_HOUSEKEEPING
, &ifmsh
->wrkq_flags
);
56 if (local
->quiescing
) {
57 set_bit(TMR_RUNNING_HK
, &ifmsh
->timers_running
);
61 ieee80211_queue_work(&local
->hw
, &sdata
->work
);
65 * mesh_matches_local - check if the config of a mesh point matches ours
67 * @sdata: local mesh subif
68 * @ie: information elements of a management frame from the mesh peer
70 * This function checks if the mesh configuration of a mesh point matches the
71 * local mesh configuration, i.e. if both nodes belong to the same mesh network.
73 bool mesh_matches_local(struct ieee80211_sub_if_data
*sdata
,
74 struct ieee802_11_elems
*ie
)
76 struct ieee80211_if_mesh
*ifmsh
= &sdata
->u
.mesh
;
77 struct ieee80211_local
*local
= sdata
->local
;
79 enum nl80211_channel_type sta_channel_type
= NL80211_CHAN_NO_HT
;
82 * As support for each feature is added, check for matching
83 * - On mesh config capabilities
84 * - Power Save Support En
85 * - Sync support enabled
86 * - Sync support active
87 * - Sync support required from peer
89 * - Power management control on fc
91 if (!(ifmsh
->mesh_id_len
== ie
->mesh_id_len
&&
92 memcmp(ifmsh
->mesh_id
, ie
->mesh_id
, ie
->mesh_id_len
) == 0 &&
93 (ifmsh
->mesh_pp_id
== ie
->mesh_config
->meshconf_psel
) &&
94 (ifmsh
->mesh_pm_id
== ie
->mesh_config
->meshconf_pmetric
) &&
95 (ifmsh
->mesh_cc_id
== ie
->mesh_config
->meshconf_congest
) &&
96 (ifmsh
->mesh_sp_id
== ie
->mesh_config
->meshconf_synch
) &&
97 (ifmsh
->mesh_auth_id
== ie
->mesh_config
->meshconf_auth
)))
100 ieee80211_sta_get_rates(local
, ie
, local
->oper_channel
->band
,
103 if (sdata
->vif
.bss_conf
.basic_rates
!= basic_rates
)
106 if (ie
->ht_operation
)
108 ieee80211_ht_oper_to_channel_type(ie
->ht_operation
);
110 /* Disallow HT40+/- mismatch */
111 if (ie
->ht_operation
&&
112 (local
->_oper_channel_type
== NL80211_CHAN_HT40MINUS
||
113 local
->_oper_channel_type
== NL80211_CHAN_HT40PLUS
) &&
114 (sta_channel_type
== NL80211_CHAN_HT40MINUS
||
115 sta_channel_type
== NL80211_CHAN_HT40PLUS
) &&
116 local
->_oper_channel_type
!= sta_channel_type
)
125 * mesh_peer_accepts_plinks - check if an mp is willing to establish peer links
127 * @ie: information elements of a management frame from the mesh peer
129 bool mesh_peer_accepts_plinks(struct ieee802_11_elems
*ie
)
131 return (ie
->mesh_config
->meshconf_cap
&
132 MESHCONF_CAPAB_ACCEPT_PLINKS
) != 0;
136 * mesh_accept_plinks_update: update accepting_plink in local mesh beacons
138 * @sdata: mesh interface in which mesh beacons are going to be updated
140 void mesh_accept_plinks_update(struct ieee80211_sub_if_data
*sdata
)
144 /* In case mesh_plink_free_count > 0 and mesh_plinktbl_capacity == 0,
145 * the mesh interface might be able to establish plinks with peers that
146 * are already on the table but are not on PLINK_ESTAB state. However,
147 * in general the mesh interface is not accepting peer link requests
148 * from new peers, and that must be reflected in the beacon
150 free_plinks
= mesh_plink_availables(sdata
);
152 if (free_plinks
!= sdata
->u
.mesh
.accepting_plinks
)
153 ieee80211_mesh_housekeeping_timer((unsigned long) sdata
);
156 int mesh_rmc_init(struct ieee80211_sub_if_data
*sdata
)
160 sdata
->u
.mesh
.rmc
= kmalloc(sizeof(struct mesh_rmc
), GFP_KERNEL
);
161 if (!sdata
->u
.mesh
.rmc
)
163 sdata
->u
.mesh
.rmc
->idx_mask
= RMC_BUCKETS
- 1;
164 for (i
= 0; i
< RMC_BUCKETS
; i
++)
165 INIT_LIST_HEAD(&sdata
->u
.mesh
.rmc
->bucket
[i
].list
);
169 void mesh_rmc_free(struct ieee80211_sub_if_data
*sdata
)
171 struct mesh_rmc
*rmc
= sdata
->u
.mesh
.rmc
;
172 struct rmc_entry
*p
, *n
;
175 if (!sdata
->u
.mesh
.rmc
)
178 for (i
= 0; i
< RMC_BUCKETS
; i
++)
179 list_for_each_entry_safe(p
, n
, &rmc
->bucket
[i
].list
, list
) {
181 kmem_cache_free(rm_cache
, p
);
185 sdata
->u
.mesh
.rmc
= NULL
;
189 * mesh_rmc_check - Check frame in recent multicast cache and add if absent.
191 * @sa: source address
192 * @mesh_hdr: mesh_header
194 * Returns: 0 if the frame is not in the cache, nonzero otherwise.
196 * Checks using the source address and the mesh sequence number if we have
197 * received this frame lately. If the frame is not in the cache, it is added to
200 int mesh_rmc_check(u8
*sa
, struct ieee80211s_hdr
*mesh_hdr
,
201 struct ieee80211_sub_if_data
*sdata
)
203 struct mesh_rmc
*rmc
= sdata
->u
.mesh
.rmc
;
207 struct rmc_entry
*p
, *n
;
209 /* Don't care about endianness since only match matters */
210 memcpy(&seqnum
, &mesh_hdr
->seqnum
, sizeof(mesh_hdr
->seqnum
));
211 idx
= le32_to_cpu(mesh_hdr
->seqnum
) & rmc
->idx_mask
;
212 list_for_each_entry_safe(p
, n
, &rmc
->bucket
[idx
].list
, list
) {
214 if (time_after(jiffies
, p
->exp_time
) ||
215 (entries
== RMC_QUEUE_MAX_LEN
)) {
217 kmem_cache_free(rm_cache
, p
);
219 } else if ((seqnum
== p
->seqnum
) &&
220 (ether_addr_equal(sa
, p
->sa
)))
224 p
= kmem_cache_alloc(rm_cache
, GFP_ATOMIC
);
229 p
->exp_time
= jiffies
+ RMC_TIMEOUT
;
230 memcpy(p
->sa
, sa
, ETH_ALEN
);
231 list_add(&p
->list
, &rmc
->bucket
[idx
].list
);
236 mesh_add_meshconf_ie(struct sk_buff
*skb
, struct ieee80211_sub_if_data
*sdata
)
238 struct ieee80211_if_mesh
*ifmsh
= &sdata
->u
.mesh
;
240 u8 meshconf_len
= sizeof(struct ieee80211_meshconf_ie
);
242 if (skb_tailroom(skb
) < 2 + meshconf_len
)
245 pos
= skb_put(skb
, 2 + meshconf_len
);
246 *pos
++ = WLAN_EID_MESH_CONFIG
;
247 *pos
++ = meshconf_len
;
249 /* Active path selection protocol ID */
250 *pos
++ = ifmsh
->mesh_pp_id
;
251 /* Active path selection metric ID */
252 *pos
++ = ifmsh
->mesh_pm_id
;
253 /* Congestion control mode identifier */
254 *pos
++ = ifmsh
->mesh_cc_id
;
255 /* Synchronization protocol identifier */
256 *pos
++ = ifmsh
->mesh_sp_id
;
257 /* Authentication Protocol identifier */
258 *pos
++ = ifmsh
->mesh_auth_id
;
259 /* Mesh Formation Info - number of neighbors */
260 neighbors
= atomic_read(&ifmsh
->mshstats
.estab_plinks
);
261 /* Number of neighbor mesh STAs or 15 whichever is smaller */
262 neighbors
= (neighbors
> 15) ? 15 : neighbors
;
263 *pos
++ = neighbors
<< 1;
264 /* Mesh capability */
265 ifmsh
->accepting_plinks
= mesh_plink_availables(sdata
);
266 *pos
= MESHCONF_CAPAB_FORWARDING
;
267 *pos
|= ifmsh
->accepting_plinks
?
268 MESHCONF_CAPAB_ACCEPT_PLINKS
: 0x00;
269 *pos
++ |= ifmsh
->adjusting_tbtt
?
270 MESHCONF_CAPAB_TBTT_ADJUSTING
: 0x00;
277 mesh_add_meshid_ie(struct sk_buff
*skb
, struct ieee80211_sub_if_data
*sdata
)
279 struct ieee80211_if_mesh
*ifmsh
= &sdata
->u
.mesh
;
282 if (skb_tailroom(skb
) < 2 + ifmsh
->mesh_id_len
)
285 pos
= skb_put(skb
, 2 + ifmsh
->mesh_id_len
);
286 *pos
++ = WLAN_EID_MESH_ID
;
287 *pos
++ = ifmsh
->mesh_id_len
;
288 if (ifmsh
->mesh_id_len
)
289 memcpy(pos
, ifmsh
->mesh_id
, ifmsh
->mesh_id_len
);
295 mesh_add_vendor_ies(struct sk_buff
*skb
, struct ieee80211_sub_if_data
*sdata
)
297 struct ieee80211_if_mesh
*ifmsh
= &sdata
->u
.mesh
;
301 if (!ifmsh
->ie
|| !ifmsh
->ie_len
)
304 /* fast-forward to vendor IEs */
305 offset
= ieee80211_ie_split_vendor(ifmsh
->ie
, ifmsh
->ie_len
, 0);
308 len
= ifmsh
->ie_len
- offset
;
309 data
= ifmsh
->ie
+ offset
;
310 if (skb_tailroom(skb
) < len
)
312 memcpy(skb_put(skb
, len
), data
, len
);
319 mesh_add_rsn_ie(struct sk_buff
*skb
, struct ieee80211_sub_if_data
*sdata
)
321 struct ieee80211_if_mesh
*ifmsh
= &sdata
->u
.mesh
;
325 if (!ifmsh
->ie
|| !ifmsh
->ie_len
)
330 while (data
< ifmsh
->ie
+ ifmsh
->ie_len
) {
331 if (*data
== WLAN_EID_RSN
) {
339 if (skb_tailroom(skb
) < len
)
341 memcpy(skb_put(skb
, len
), data
, len
);
347 int mesh_add_ds_params_ie(struct sk_buff
*skb
,
348 struct ieee80211_sub_if_data
*sdata
)
350 struct ieee80211_local
*local
= sdata
->local
;
351 struct ieee80211_supported_band
*sband
;
354 if (skb_tailroom(skb
) < 3)
357 sband
= local
->hw
.wiphy
->bands
[local
->hw
.conf
.channel
->band
];
358 if (sband
->band
== IEEE80211_BAND_2GHZ
) {
359 pos
= skb_put(skb
, 2 + 1);
360 *pos
++ = WLAN_EID_DS_PARAMS
;
362 *pos
++ = ieee80211_frequency_to_channel(local
->hw
.conf
.channel
->center_freq
);
368 int mesh_add_ht_cap_ie(struct sk_buff
*skb
,
369 struct ieee80211_sub_if_data
*sdata
)
371 struct ieee80211_local
*local
= sdata
->local
;
372 struct ieee80211_supported_band
*sband
;
375 sband
= local
->hw
.wiphy
->bands
[local
->oper_channel
->band
];
376 if (!sband
->ht_cap
.ht_supported
||
377 local
->_oper_channel_type
== NL80211_CHAN_NO_HT
)
380 if (skb_tailroom(skb
) < 2 + sizeof(struct ieee80211_ht_cap
))
383 pos
= skb_put(skb
, 2 + sizeof(struct ieee80211_ht_cap
));
384 ieee80211_ie_build_ht_cap(pos
, &sband
->ht_cap
, sband
->ht_cap
.cap
);
389 int mesh_add_ht_oper_ie(struct sk_buff
*skb
,
390 struct ieee80211_sub_if_data
*sdata
)
392 struct ieee80211_local
*local
= sdata
->local
;
393 struct ieee80211_channel
*channel
= local
->oper_channel
;
394 enum nl80211_channel_type channel_type
= local
->_oper_channel_type
;
395 struct ieee80211_supported_band
*sband
=
396 local
->hw
.wiphy
->bands
[channel
->band
];
397 struct ieee80211_sta_ht_cap
*ht_cap
= &sband
->ht_cap
;
400 if (!ht_cap
->ht_supported
|| channel_type
== NL80211_CHAN_NO_HT
)
403 if (skb_tailroom(skb
) < 2 + sizeof(struct ieee80211_ht_operation
))
406 pos
= skb_put(skb
, 2 + sizeof(struct ieee80211_ht_operation
));
407 ieee80211_ie_build_ht_oper(pos
, ht_cap
, channel
, channel_type
,
408 sdata
->vif
.bss_conf
.ht_operation_mode
);
412 static void ieee80211_mesh_path_timer(unsigned long data
)
414 struct ieee80211_sub_if_data
*sdata
=
415 (struct ieee80211_sub_if_data
*) data
;
416 struct ieee80211_if_mesh
*ifmsh
= &sdata
->u
.mesh
;
417 struct ieee80211_local
*local
= sdata
->local
;
419 if (local
->quiescing
) {
420 set_bit(TMR_RUNNING_MP
, &ifmsh
->timers_running
);
424 ieee80211_queue_work(&local
->hw
, &sdata
->work
);
427 static void ieee80211_mesh_path_root_timer(unsigned long data
)
429 struct ieee80211_sub_if_data
*sdata
=
430 (struct ieee80211_sub_if_data
*) data
;
431 struct ieee80211_if_mesh
*ifmsh
= &sdata
->u
.mesh
;
432 struct ieee80211_local
*local
= sdata
->local
;
434 set_bit(MESH_WORK_ROOT
, &ifmsh
->wrkq_flags
);
436 if (local
->quiescing
) {
437 set_bit(TMR_RUNNING_MPR
, &ifmsh
->timers_running
);
441 ieee80211_queue_work(&local
->hw
, &sdata
->work
);
444 void ieee80211_mesh_root_setup(struct ieee80211_if_mesh
*ifmsh
)
446 if (ifmsh
->mshcfg
.dot11MeshHWMPRootMode
)
447 set_bit(MESH_WORK_ROOT
, &ifmsh
->wrkq_flags
);
449 clear_bit(MESH_WORK_ROOT
, &ifmsh
->wrkq_flags
);
450 /* stop running timer */
451 del_timer_sync(&ifmsh
->mesh_path_root_timer
);
456 * ieee80211_fill_mesh_addresses - fill addresses of a locally originated mesh frame
457 * @hdr: 802.11 frame header
458 * @fc: frame control field
459 * @meshda: destination address in the mesh
460 * @meshsa: source address address in the mesh. Same as TA, as frame is
461 * locally originated.
463 * Return the length of the 802.11 (does not include a mesh control header)
465 int ieee80211_fill_mesh_addresses(struct ieee80211_hdr
*hdr
, __le16
*fc
,
466 const u8
*meshda
, const u8
*meshsa
)
468 if (is_multicast_ether_addr(meshda
)) {
469 *fc
|= cpu_to_le16(IEEE80211_FCTL_FROMDS
);
471 memcpy(hdr
->addr1
, meshda
, ETH_ALEN
);
472 memcpy(hdr
->addr2
, meshsa
, ETH_ALEN
);
473 memcpy(hdr
->addr3
, meshsa
, ETH_ALEN
);
476 *fc
|= cpu_to_le16(IEEE80211_FCTL_FROMDS
| IEEE80211_FCTL_TODS
);
478 memset(hdr
->addr1
, 0, ETH_ALEN
); /* RA is resolved later */
479 memcpy(hdr
->addr2
, meshsa
, ETH_ALEN
);
480 memcpy(hdr
->addr3
, meshda
, ETH_ALEN
);
481 memcpy(hdr
->addr4
, meshsa
, ETH_ALEN
);
487 * ieee80211_new_mesh_header - create a new mesh header
488 * @meshhdr: uninitialized mesh header
489 * @sdata: mesh interface to be used
490 * @addr4or5: 1st address in the ae header, which may correspond to address 4
491 * (if addr6 is NULL) or address 5 (if addr6 is present). It may
493 * @addr6: 2nd address in the ae header, which corresponds to addr6 of the
496 * Return the header length.
498 int ieee80211_new_mesh_header(struct ieee80211s_hdr
*meshhdr
,
499 struct ieee80211_sub_if_data
*sdata
, char *addr4or5
,
503 BUG_ON(!addr4or5
&& addr6
);
504 memset(meshhdr
, 0, sizeof(*meshhdr
));
505 meshhdr
->ttl
= sdata
->u
.mesh
.mshcfg
.dot11MeshTTL
;
506 put_unaligned(cpu_to_le32(sdata
->u
.mesh
.mesh_seqnum
), &meshhdr
->seqnum
);
507 sdata
->u
.mesh
.mesh_seqnum
++;
508 if (addr4or5
&& !addr6
) {
509 meshhdr
->flags
|= MESH_FLAGS_AE_A4
;
511 memcpy(meshhdr
->eaddr1
, addr4or5
, ETH_ALEN
);
512 } else if (addr4or5
&& addr6
) {
513 meshhdr
->flags
|= MESH_FLAGS_AE_A5_A6
;
514 aelen
+= 2 * ETH_ALEN
;
515 memcpy(meshhdr
->eaddr1
, addr4or5
, ETH_ALEN
);
516 memcpy(meshhdr
->eaddr2
, addr6
, ETH_ALEN
);
521 static void ieee80211_mesh_housekeeping(struct ieee80211_sub_if_data
*sdata
,
522 struct ieee80211_if_mesh
*ifmsh
)
526 #ifdef CONFIG_MAC80211_VERBOSE_DEBUG
527 pr_debug("%s: running mesh housekeeping\n", sdata
->name
);
530 ieee80211_sta_expire(sdata
, IEEE80211_MESH_PEER_INACTIVITY_LIMIT
);
531 mesh_path_expire(sdata
);
533 free_plinks
= mesh_plink_availables(sdata
);
534 if (free_plinks
!= sdata
->u
.mesh
.accepting_plinks
)
535 ieee80211_bss_info_change_notify(sdata
, BSS_CHANGED_BEACON
);
537 mod_timer(&ifmsh
->housekeeping_timer
,
538 round_jiffies(jiffies
+ IEEE80211_MESH_HOUSEKEEPING_INTERVAL
));
541 static void ieee80211_mesh_rootpath(struct ieee80211_sub_if_data
*sdata
)
543 struct ieee80211_if_mesh
*ifmsh
= &sdata
->u
.mesh
;
545 mesh_path_tx_root_frame(sdata
);
546 mod_timer(&ifmsh
->mesh_path_root_timer
,
547 round_jiffies(TU_TO_EXP_TIME(
548 ifmsh
->mshcfg
.dot11MeshHWMPRannInterval
)));
552 void ieee80211_mesh_quiesce(struct ieee80211_sub_if_data
*sdata
)
554 struct ieee80211_if_mesh
*ifmsh
= &sdata
->u
.mesh
;
556 /* use atomic bitops in case all timers fire at the same time */
558 if (del_timer_sync(&ifmsh
->housekeeping_timer
))
559 set_bit(TMR_RUNNING_HK
, &ifmsh
->timers_running
);
560 if (del_timer_sync(&ifmsh
->mesh_path_timer
))
561 set_bit(TMR_RUNNING_MP
, &ifmsh
->timers_running
);
562 if (del_timer_sync(&ifmsh
->mesh_path_root_timer
))
563 set_bit(TMR_RUNNING_MPR
, &ifmsh
->timers_running
);
566 void ieee80211_mesh_restart(struct ieee80211_sub_if_data
*sdata
)
568 struct ieee80211_if_mesh
*ifmsh
= &sdata
->u
.mesh
;
570 if (test_and_clear_bit(TMR_RUNNING_HK
, &ifmsh
->timers_running
))
571 add_timer(&ifmsh
->housekeeping_timer
);
572 if (test_and_clear_bit(TMR_RUNNING_MP
, &ifmsh
->timers_running
))
573 add_timer(&ifmsh
->mesh_path_timer
);
574 if (test_and_clear_bit(TMR_RUNNING_MPR
, &ifmsh
->timers_running
))
575 add_timer(&ifmsh
->mesh_path_root_timer
);
576 ieee80211_mesh_root_setup(ifmsh
);
580 void ieee80211_start_mesh(struct ieee80211_sub_if_data
*sdata
)
582 struct ieee80211_if_mesh
*ifmsh
= &sdata
->u
.mesh
;
583 struct ieee80211_local
*local
= sdata
->local
;
585 local
->fif_other_bss
++;
586 /* mesh ifaces must set allmulti to forward mcast traffic */
587 atomic_inc(&local
->iff_allmultis
);
588 ieee80211_configure_filter(local
);
590 ifmsh
->mesh_cc_id
= 0; /* Disabled */
591 ifmsh
->mesh_auth_id
= 0; /* Disabled */
592 /* register sync ops from extensible synchronization framework */
593 ifmsh
->sync_ops
= ieee80211_mesh_sync_ops_get(ifmsh
->mesh_sp_id
);
594 ifmsh
->adjusting_tbtt
= false;
595 ifmsh
->sync_offset_clockdrift_max
= 0;
596 set_bit(MESH_WORK_HOUSEKEEPING
, &ifmsh
->wrkq_flags
);
597 ieee80211_mesh_root_setup(ifmsh
);
598 ieee80211_queue_work(&local
->hw
, &sdata
->work
);
599 sdata
->vif
.bss_conf
.ht_operation_mode
=
600 ifmsh
->mshcfg
.ht_opmode
;
601 sdata
->vif
.bss_conf
.beacon_int
= MESH_DEFAULT_BEACON_INTERVAL
;
602 sdata
->vif
.bss_conf
.basic_rates
=
603 ieee80211_mandatory_rates(sdata
->local
,
604 sdata
->local
->hw
.conf
.channel
->band
);
605 ieee80211_bss_info_change_notify(sdata
, BSS_CHANGED_BEACON
|
606 BSS_CHANGED_BEACON_ENABLED
|
608 BSS_CHANGED_BASIC_RATES
|
609 BSS_CHANGED_BEACON_INT
);
612 void ieee80211_stop_mesh(struct ieee80211_sub_if_data
*sdata
)
614 struct ieee80211_local
*local
= sdata
->local
;
615 struct ieee80211_if_mesh
*ifmsh
= &sdata
->u
.mesh
;
617 ifmsh
->mesh_id_len
= 0;
618 ieee80211_bss_info_change_notify(sdata
, BSS_CHANGED_BEACON_ENABLED
);
619 sta_info_flush(local
, NULL
);
621 del_timer_sync(&sdata
->u
.mesh
.housekeeping_timer
);
622 del_timer_sync(&sdata
->u
.mesh
.mesh_path_root_timer
);
624 * If the timer fired while we waited for it, it will have
625 * requeued the work. Now the work will be running again
626 * but will not rearm the timer again because it checks
627 * whether the interface is running, which, at this point,
630 cancel_work_sync(&sdata
->work
);
632 local
->fif_other_bss
--;
633 atomic_dec(&local
->iff_allmultis
);
634 ieee80211_configure_filter(local
);
637 static void ieee80211_mesh_rx_bcn_presp(struct ieee80211_sub_if_data
*sdata
,
639 struct ieee80211_mgmt
*mgmt
,
641 struct ieee80211_rx_status
*rx_status
)
643 struct ieee80211_local
*local
= sdata
->local
;
644 struct ieee80211_if_mesh
*ifmsh
= &sdata
->u
.mesh
;
645 struct ieee802_11_elems elems
;
646 struct ieee80211_channel
*channel
;
649 enum ieee80211_band band
= rx_status
->band
;
651 /* ignore ProbeResp to foreign address */
652 if (stype
== IEEE80211_STYPE_PROBE_RESP
&&
653 !ether_addr_equal(mgmt
->da
, sdata
->vif
.addr
))
656 baselen
= (u8
*) mgmt
->u
.probe_resp
.variable
- (u8
*) mgmt
;
660 ieee802_11_parse_elems(mgmt
->u
.probe_resp
.variable
, len
- baselen
,
663 /* ignore beacons from secure mesh peers if our security is off */
664 if (elems
.rsn_len
&& sdata
->u
.mesh
.security
== IEEE80211_MESH_SEC_NONE
)
667 if (elems
.ds_params
&& elems
.ds_params_len
== 1)
668 freq
= ieee80211_channel_to_frequency(elems
.ds_params
[0], band
);
670 freq
= rx_status
->freq
;
672 channel
= ieee80211_get_channel(local
->hw
.wiphy
, freq
);
674 if (!channel
|| channel
->flags
& IEEE80211_CHAN_DISABLED
)
677 if (elems
.mesh_id
&& elems
.mesh_config
&&
678 mesh_matches_local(sdata
, &elems
))
679 mesh_neighbour_update(sdata
, mgmt
->sa
, &elems
);
682 ifmsh
->sync_ops
->rx_bcn_presp(sdata
,
683 stype
, mgmt
, &elems
, rx_status
);
686 static void ieee80211_mesh_rx_mgmt_action(struct ieee80211_sub_if_data
*sdata
,
687 struct ieee80211_mgmt
*mgmt
,
689 struct ieee80211_rx_status
*rx_status
)
691 switch (mgmt
->u
.action
.category
) {
692 case WLAN_CATEGORY_SELF_PROTECTED
:
693 switch (mgmt
->u
.action
.u
.self_prot
.action_code
) {
694 case WLAN_SP_MESH_PEERING_OPEN
:
695 case WLAN_SP_MESH_PEERING_CLOSE
:
696 case WLAN_SP_MESH_PEERING_CONFIRM
:
697 mesh_rx_plink_frame(sdata
, mgmt
, len
, rx_status
);
701 case WLAN_CATEGORY_MESH_ACTION
:
702 if (mesh_action_is_path_sel(mgmt
))
703 mesh_rx_path_sel_frame(sdata
, mgmt
, len
);
708 void ieee80211_mesh_rx_queued_mgmt(struct ieee80211_sub_if_data
*sdata
,
711 struct ieee80211_rx_status
*rx_status
;
712 struct ieee80211_mgmt
*mgmt
;
715 rx_status
= IEEE80211_SKB_RXCB(skb
);
716 mgmt
= (struct ieee80211_mgmt
*) skb
->data
;
717 stype
= le16_to_cpu(mgmt
->frame_control
) & IEEE80211_FCTL_STYPE
;
720 case IEEE80211_STYPE_PROBE_RESP
:
721 case IEEE80211_STYPE_BEACON
:
722 ieee80211_mesh_rx_bcn_presp(sdata
, stype
, mgmt
, skb
->len
,
725 case IEEE80211_STYPE_ACTION
:
726 ieee80211_mesh_rx_mgmt_action(sdata
, mgmt
, skb
->len
, rx_status
);
731 void ieee80211_mesh_work(struct ieee80211_sub_if_data
*sdata
)
733 struct ieee80211_if_mesh
*ifmsh
= &sdata
->u
.mesh
;
735 if (ifmsh
->preq_queue_len
&&
737 ifmsh
->last_preq
+ msecs_to_jiffies(ifmsh
->mshcfg
.dot11MeshHWMPpreqMinInterval
)))
738 mesh_path_start_discovery(sdata
);
740 if (test_and_clear_bit(MESH_WORK_GROW_MPATH_TABLE
, &ifmsh
->wrkq_flags
))
741 mesh_mpath_table_grow();
743 if (test_and_clear_bit(MESH_WORK_GROW_MPP_TABLE
, &ifmsh
->wrkq_flags
))
744 mesh_mpp_table_grow();
746 if (test_and_clear_bit(MESH_WORK_HOUSEKEEPING
, &ifmsh
->wrkq_flags
))
747 ieee80211_mesh_housekeeping(sdata
, ifmsh
);
749 if (test_and_clear_bit(MESH_WORK_ROOT
, &ifmsh
->wrkq_flags
))
750 ieee80211_mesh_rootpath(sdata
);
752 if (test_and_clear_bit(MESH_WORK_DRIFT_ADJUST
, &ifmsh
->wrkq_flags
))
753 mesh_sync_adjust_tbtt(sdata
);
756 void ieee80211_mesh_notify_scan_completed(struct ieee80211_local
*local
)
758 struct ieee80211_sub_if_data
*sdata
;
761 list_for_each_entry_rcu(sdata
, &local
->interfaces
, list
)
762 if (ieee80211_vif_is_mesh(&sdata
->vif
))
763 ieee80211_queue_work(&local
->hw
, &sdata
->work
);
767 void ieee80211_mesh_init_sdata(struct ieee80211_sub_if_data
*sdata
)
769 struct ieee80211_if_mesh
*ifmsh
= &sdata
->u
.mesh
;
771 setup_timer(&ifmsh
->housekeeping_timer
,
772 ieee80211_mesh_housekeeping_timer
,
773 (unsigned long) sdata
);
775 ifmsh
->accepting_plinks
= true;
778 ifmsh
->num_gates
= 0;
779 atomic_set(&ifmsh
->mpaths
, 0);
780 mesh_rmc_init(sdata
);
781 ifmsh
->last_preq
= jiffies
;
782 ifmsh
->next_perr
= jiffies
;
783 /* Allocate all mesh structures when creating the first mesh interface. */
786 setup_timer(&ifmsh
->mesh_path_timer
,
787 ieee80211_mesh_path_timer
,
788 (unsigned long) sdata
);
789 setup_timer(&ifmsh
->mesh_path_root_timer
,
790 ieee80211_mesh_path_root_timer
,
791 (unsigned long) sdata
);
792 INIT_LIST_HEAD(&ifmsh
->preq_queue
.list
);
793 spin_lock_init(&ifmsh
->mesh_preq_queue_lock
);
794 spin_lock_init(&ifmsh
->sync_offset_lock
);