mesh.c revision 2c53040f018b6c36a46eec75b9b937aaa5f78e6d
1/* 2 * Copyright (c) 2008, 2009 open80211s Ltd. 3 * Authors: Luis Carlos Cobo <luisca@cozybit.com> 4 * Javier Cardona <javier@cozybit.com> 5 * 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. 9 */ 10 11#include <linux/slab.h> 12#include <asm/unaligned.h> 13#include "ieee80211_i.h" 14#include "mesh.h" 15 16#define TMR_RUNNING_HK 0 17#define TMR_RUNNING_MP 1 18#define TMR_RUNNING_MPR 2 19 20int mesh_allocated; 21static struct kmem_cache *rm_cache; 22 23#ifdef CONFIG_MAC80211_MESH 24bool mesh_action_is_path_sel(struct ieee80211_mgmt *mgmt) 25{ 26 return (mgmt->u.action.u.mesh_action.action_code == 27 WLAN_MESH_ACTION_HWMP_PATH_SELECTION); 28} 29#else 30bool mesh_action_is_path_sel(struct ieee80211_mgmt *mgmt) 31{ return false; } 32#endif 33 34void ieee80211s_init(void) 35{ 36 mesh_pathtbl_init(); 37 mesh_allocated = 1; 38 rm_cache = kmem_cache_create("mesh_rmc", sizeof(struct rmc_entry), 39 0, 0, NULL); 40} 41 42void ieee80211s_stop(void) 43{ 44 mesh_pathtbl_unregister(); 45 kmem_cache_destroy(rm_cache); 46} 47 48static void ieee80211_mesh_housekeeping_timer(unsigned long data) 49{ 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; 53 54 set_bit(MESH_WORK_HOUSEKEEPING, &ifmsh->wrkq_flags); 55 56 if (local->quiescing) { 57 set_bit(TMR_RUNNING_HK, &ifmsh->timers_running); 58 return; 59 } 60 61 ieee80211_queue_work(&local->hw, &sdata->work); 62} 63 64/** 65 * mesh_matches_local - check if the config of a mesh point matches ours 66 * 67 * @sdata: local mesh subif 68 * @ie: information elements of a management frame from the mesh peer 69 * 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. 72 */ 73bool mesh_matches_local(struct ieee80211_sub_if_data *sdata, 74 struct ieee802_11_elems *ie) 75{ 76 struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; 77 struct ieee80211_local *local = sdata->local; 78 u32 basic_rates = 0; 79 enum nl80211_channel_type sta_channel_type = NL80211_CHAN_NO_HT; 80 81 /* 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 88 * - MDA enabled 89 * - Power management control on fc 90 */ 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))) 98 goto mismatch; 99 100 ieee80211_sta_get_rates(local, ie, local->oper_channel->band, 101 &basic_rates); 102 103 if (sdata->vif.bss_conf.basic_rates != basic_rates) 104 goto mismatch; 105 106 if (ie->ht_operation) 107 sta_channel_type = 108 ieee80211_ht_oper_to_channel_type(ie->ht_operation); 109 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) 117 goto mismatch; 118 119 return true; 120mismatch: 121 return false; 122} 123 124/** 125 * mesh_peer_accepts_plinks - check if an mp is willing to establish peer links 126 * 127 * @ie: information elements of a management frame from the mesh peer 128 */ 129bool mesh_peer_accepts_plinks(struct ieee802_11_elems *ie) 130{ 131 return (ie->mesh_config->meshconf_cap & 132 MESHCONF_CAPAB_ACCEPT_PLINKS) != 0; 133} 134 135/** 136 * mesh_accept_plinks_update - update accepting_plink in local mesh beacons 137 * 138 * @sdata: mesh interface in which mesh beacons are going to be updated 139 */ 140void mesh_accept_plinks_update(struct ieee80211_sub_if_data *sdata) 141{ 142 bool free_plinks; 143 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 149 */ 150 free_plinks = mesh_plink_availables(sdata); 151 152 if (free_plinks != sdata->u.mesh.accepting_plinks) 153 ieee80211_mesh_housekeeping_timer((unsigned long) sdata); 154} 155 156int mesh_rmc_init(struct ieee80211_sub_if_data *sdata) 157{ 158 int i; 159 160 sdata->u.mesh.rmc = kmalloc(sizeof(struct mesh_rmc), GFP_KERNEL); 161 if (!sdata->u.mesh.rmc) 162 return -ENOMEM; 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); 166 return 0; 167} 168 169void mesh_rmc_free(struct ieee80211_sub_if_data *sdata) 170{ 171 struct mesh_rmc *rmc = sdata->u.mesh.rmc; 172 struct rmc_entry *p, *n; 173 int i; 174 175 if (!sdata->u.mesh.rmc) 176 return; 177 178 for (i = 0; i < RMC_BUCKETS; i++) 179 list_for_each_entry_safe(p, n, &rmc->bucket[i].list, list) { 180 list_del(&p->list); 181 kmem_cache_free(rm_cache, p); 182 } 183 184 kfree(rmc); 185 sdata->u.mesh.rmc = NULL; 186} 187 188/** 189 * mesh_rmc_check - Check frame in recent multicast cache and add if absent. 190 * 191 * @sa: source address 192 * @mesh_hdr: mesh_header 193 * 194 * Returns: 0 if the frame is not in the cache, nonzero otherwise. 195 * 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 198 * it. 199 */ 200int mesh_rmc_check(u8 *sa, struct ieee80211s_hdr *mesh_hdr, 201 struct ieee80211_sub_if_data *sdata) 202{ 203 struct mesh_rmc *rmc = sdata->u.mesh.rmc; 204 u32 seqnum = 0; 205 int entries = 0; 206 u8 idx; 207 struct rmc_entry *p, *n; 208 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) { 213 ++entries; 214 if (time_after(jiffies, p->exp_time) || 215 (entries == RMC_QUEUE_MAX_LEN)) { 216 list_del(&p->list); 217 kmem_cache_free(rm_cache, p); 218 --entries; 219 } else if ((seqnum == p->seqnum) && 220 (ether_addr_equal(sa, p->sa))) 221 return -1; 222 } 223 224 p = kmem_cache_alloc(rm_cache, GFP_ATOMIC); 225 if (!p) 226 return 0; 227 228 p->seqnum = seqnum; 229 p->exp_time = jiffies + RMC_TIMEOUT; 230 memcpy(p->sa, sa, ETH_ALEN); 231 list_add(&p->list, &rmc->bucket[idx].list); 232 return 0; 233} 234 235int 236mesh_add_meshconf_ie(struct sk_buff *skb, struct ieee80211_sub_if_data *sdata) 237{ 238 struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; 239 u8 *pos, neighbors; 240 u8 meshconf_len = sizeof(struct ieee80211_meshconf_ie); 241 242 if (skb_tailroom(skb) < 2 + meshconf_len) 243 return -ENOMEM; 244 245 pos = skb_put(skb, 2 + meshconf_len); 246 *pos++ = WLAN_EID_MESH_CONFIG; 247 *pos++ = meshconf_len; 248 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; 271 *pos++ = 0x00; 272 273 return 0; 274} 275 276int 277mesh_add_meshid_ie(struct sk_buff *skb, struct ieee80211_sub_if_data *sdata) 278{ 279 struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; 280 u8 *pos; 281 282 if (skb_tailroom(skb) < 2 + ifmsh->mesh_id_len) 283 return -ENOMEM; 284 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); 290 291 return 0; 292} 293 294int 295mesh_add_vendor_ies(struct sk_buff *skb, struct ieee80211_sub_if_data *sdata) 296{ 297 struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; 298 u8 offset, len; 299 const u8 *data; 300 301 if (!ifmsh->ie || !ifmsh->ie_len) 302 return 0; 303 304 /* fast-forward to vendor IEs */ 305 offset = ieee80211_ie_split_vendor(ifmsh->ie, ifmsh->ie_len, 0); 306 307 if (offset) { 308 len = ifmsh->ie_len - offset; 309 data = ifmsh->ie + offset; 310 if (skb_tailroom(skb) < len) 311 return -ENOMEM; 312 memcpy(skb_put(skb, len), data, len); 313 } 314 315 return 0; 316} 317 318int 319mesh_add_rsn_ie(struct sk_buff *skb, struct ieee80211_sub_if_data *sdata) 320{ 321 struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; 322 u8 len = 0; 323 const u8 *data; 324 325 if (!ifmsh->ie || !ifmsh->ie_len) 326 return 0; 327 328 /* find RSN IE */ 329 data = ifmsh->ie; 330 while (data < ifmsh->ie + ifmsh->ie_len) { 331 if (*data == WLAN_EID_RSN) { 332 len = data[1] + 2; 333 break; 334 } 335 data++; 336 } 337 338 if (len) { 339 if (skb_tailroom(skb) < len) 340 return -ENOMEM; 341 memcpy(skb_put(skb, len), data, len); 342 } 343 344 return 0; 345} 346 347int mesh_add_ds_params_ie(struct sk_buff *skb, 348 struct ieee80211_sub_if_data *sdata) 349{ 350 struct ieee80211_local *local = sdata->local; 351 struct ieee80211_supported_band *sband; 352 u8 *pos; 353 354 if (skb_tailroom(skb) < 3) 355 return -ENOMEM; 356 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; 361 *pos++ = 1; 362 *pos++ = ieee80211_frequency_to_channel(local->hw.conf.channel->center_freq); 363 } 364 365 return 0; 366} 367 368int mesh_add_ht_cap_ie(struct sk_buff *skb, 369 struct ieee80211_sub_if_data *sdata) 370{ 371 struct ieee80211_local *local = sdata->local; 372 struct ieee80211_supported_band *sband; 373 u8 *pos; 374 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) 378 return 0; 379 380 if (skb_tailroom(skb) < 2 + sizeof(struct ieee80211_ht_cap)) 381 return -ENOMEM; 382 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); 385 386 return 0; 387} 388 389int mesh_add_ht_oper_ie(struct sk_buff *skb, 390 struct ieee80211_sub_if_data *sdata) 391{ 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; 398 u8 *pos; 399 400 if (!ht_cap->ht_supported || channel_type == NL80211_CHAN_NO_HT) 401 return 0; 402 403 if (skb_tailroom(skb) < 2 + sizeof(struct ieee80211_ht_operation)) 404 return -ENOMEM; 405 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); 409 410 return 0; 411} 412static void ieee80211_mesh_path_timer(unsigned long data) 413{ 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; 418 419 if (local->quiescing) { 420 set_bit(TMR_RUNNING_MP, &ifmsh->timers_running); 421 return; 422 } 423 424 ieee80211_queue_work(&local->hw, &sdata->work); 425} 426 427static void ieee80211_mesh_path_root_timer(unsigned long data) 428{ 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; 433 434 set_bit(MESH_WORK_ROOT, &ifmsh->wrkq_flags); 435 436 if (local->quiescing) { 437 set_bit(TMR_RUNNING_MPR, &ifmsh->timers_running); 438 return; 439 } 440 441 ieee80211_queue_work(&local->hw, &sdata->work); 442} 443 444void ieee80211_mesh_root_setup(struct ieee80211_if_mesh *ifmsh) 445{ 446 if (ifmsh->mshcfg.dot11MeshHWMPRootMode > IEEE80211_ROOTMODE_ROOT) 447 set_bit(MESH_WORK_ROOT, &ifmsh->wrkq_flags); 448 else { 449 clear_bit(MESH_WORK_ROOT, &ifmsh->wrkq_flags); 450 /* stop running timer */ 451 del_timer_sync(&ifmsh->mesh_path_root_timer); 452 } 453} 454 455/** 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. 462 * 463 * Return the length of the 802.11 (does not include a mesh control header) 464 */ 465int ieee80211_fill_mesh_addresses(struct ieee80211_hdr *hdr, __le16 *fc, 466 const u8 *meshda, const u8 *meshsa) 467{ 468 if (is_multicast_ether_addr(meshda)) { 469 *fc |= cpu_to_le16(IEEE80211_FCTL_FROMDS); 470 /* DA TA SA */ 471 memcpy(hdr->addr1, meshda, ETH_ALEN); 472 memcpy(hdr->addr2, meshsa, ETH_ALEN); 473 memcpy(hdr->addr3, meshsa, ETH_ALEN); 474 return 24; 475 } else { 476 *fc |= cpu_to_le16(IEEE80211_FCTL_FROMDS | IEEE80211_FCTL_TODS); 477 /* RA TA DA SA */ 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); 482 return 30; 483 } 484} 485 486/** 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 492 * be NULL. 493 * @addr6: 2nd address in the ae header, which corresponds to addr6 of the 494 * mesh frame 495 * 496 * Return the header length. 497 */ 498int ieee80211_new_mesh_header(struct ieee80211s_hdr *meshhdr, 499 struct ieee80211_sub_if_data *sdata, char *addr4or5, 500 char *addr6) 501{ 502 int aelen = 0; 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; 510 aelen += ETH_ALEN; 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); 517 } 518 return 6 + aelen; 519} 520 521static void ieee80211_mesh_housekeeping(struct ieee80211_sub_if_data *sdata, 522 struct ieee80211_if_mesh *ifmsh) 523{ 524 bool free_plinks; 525 526 ieee80211_sta_expire(sdata, IEEE80211_MESH_PEER_INACTIVITY_LIMIT); 527 mesh_path_expire(sdata); 528 529 free_plinks = mesh_plink_availables(sdata); 530 if (free_plinks != sdata->u.mesh.accepting_plinks) 531 ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_BEACON); 532 533 mod_timer(&ifmsh->housekeeping_timer, 534 round_jiffies(jiffies + IEEE80211_MESH_HOUSEKEEPING_INTERVAL)); 535} 536 537static void ieee80211_mesh_rootpath(struct ieee80211_sub_if_data *sdata) 538{ 539 struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; 540 u32 interval; 541 542 mesh_path_tx_root_frame(sdata); 543 544 if (ifmsh->mshcfg.dot11MeshHWMPRootMode == IEEE80211_PROACTIVE_RANN) 545 interval = ifmsh->mshcfg.dot11MeshHWMPRannInterval; 546 else 547 interval = ifmsh->mshcfg.dot11MeshHWMProotInterval; 548 549 mod_timer(&ifmsh->mesh_path_root_timer, 550 round_jiffies(TU_TO_EXP_TIME(interval))); 551} 552 553#ifdef CONFIG_PM 554void ieee80211_mesh_quiesce(struct ieee80211_sub_if_data *sdata) 555{ 556 struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; 557 558 /* use atomic bitops in case all timers fire at the same time */ 559 560 if (del_timer_sync(&ifmsh->housekeeping_timer)) 561 set_bit(TMR_RUNNING_HK, &ifmsh->timers_running); 562 if (del_timer_sync(&ifmsh->mesh_path_timer)) 563 set_bit(TMR_RUNNING_MP, &ifmsh->timers_running); 564 if (del_timer_sync(&ifmsh->mesh_path_root_timer)) 565 set_bit(TMR_RUNNING_MPR, &ifmsh->timers_running); 566} 567 568void ieee80211_mesh_restart(struct ieee80211_sub_if_data *sdata) 569{ 570 struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; 571 572 if (test_and_clear_bit(TMR_RUNNING_HK, &ifmsh->timers_running)) 573 add_timer(&ifmsh->housekeeping_timer); 574 if (test_and_clear_bit(TMR_RUNNING_MP, &ifmsh->timers_running)) 575 add_timer(&ifmsh->mesh_path_timer); 576 if (test_and_clear_bit(TMR_RUNNING_MPR, &ifmsh->timers_running)) 577 add_timer(&ifmsh->mesh_path_root_timer); 578 ieee80211_mesh_root_setup(ifmsh); 579} 580#endif 581 582void ieee80211_start_mesh(struct ieee80211_sub_if_data *sdata) 583{ 584 struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; 585 struct ieee80211_local *local = sdata->local; 586 587 local->fif_other_bss++; 588 /* mesh ifaces must set allmulti to forward mcast traffic */ 589 atomic_inc(&local->iff_allmultis); 590 ieee80211_configure_filter(local); 591 592 ifmsh->mesh_cc_id = 0; /* Disabled */ 593 ifmsh->mesh_auth_id = 0; /* Disabled */ 594 /* register sync ops from extensible synchronization framework */ 595 ifmsh->sync_ops = ieee80211_mesh_sync_ops_get(ifmsh->mesh_sp_id); 596 ifmsh->adjusting_tbtt = false; 597 ifmsh->sync_offset_clockdrift_max = 0; 598 set_bit(MESH_WORK_HOUSEKEEPING, &ifmsh->wrkq_flags); 599 ieee80211_mesh_root_setup(ifmsh); 600 ieee80211_queue_work(&local->hw, &sdata->work); 601 sdata->vif.bss_conf.ht_operation_mode = 602 ifmsh->mshcfg.ht_opmode; 603 sdata->vif.bss_conf.beacon_int = MESH_DEFAULT_BEACON_INTERVAL; 604 sdata->vif.bss_conf.basic_rates = 605 ieee80211_mandatory_rates(sdata->local, 606 sdata->local->hw.conf.channel->band); 607 ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_BEACON | 608 BSS_CHANGED_BEACON_ENABLED | 609 BSS_CHANGED_HT | 610 BSS_CHANGED_BASIC_RATES | 611 BSS_CHANGED_BEACON_INT); 612} 613 614void ieee80211_stop_mesh(struct ieee80211_sub_if_data *sdata) 615{ 616 struct ieee80211_local *local = sdata->local; 617 struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; 618 619 ifmsh->mesh_id_len = 0; 620 ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_BEACON_ENABLED); 621 sta_info_flush(local, NULL); 622 623 del_timer_sync(&sdata->u.mesh.housekeeping_timer); 624 del_timer_sync(&sdata->u.mesh.mesh_path_root_timer); 625 /* 626 * If the timer fired while we waited for it, it will have 627 * requeued the work. Now the work will be running again 628 * but will not rearm the timer again because it checks 629 * whether the interface is running, which, at this point, 630 * it no longer is. 631 */ 632 cancel_work_sync(&sdata->work); 633 634 local->fif_other_bss--; 635 atomic_dec(&local->iff_allmultis); 636 ieee80211_configure_filter(local); 637} 638 639static void ieee80211_mesh_rx_bcn_presp(struct ieee80211_sub_if_data *sdata, 640 u16 stype, 641 struct ieee80211_mgmt *mgmt, 642 size_t len, 643 struct ieee80211_rx_status *rx_status) 644{ 645 struct ieee80211_local *local = sdata->local; 646 struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; 647 struct ieee802_11_elems elems; 648 struct ieee80211_channel *channel; 649 size_t baselen; 650 int freq; 651 enum ieee80211_band band = rx_status->band; 652 653 /* ignore ProbeResp to foreign address */ 654 if (stype == IEEE80211_STYPE_PROBE_RESP && 655 !ether_addr_equal(mgmt->da, sdata->vif.addr)) 656 return; 657 658 baselen = (u8 *) mgmt->u.probe_resp.variable - (u8 *) mgmt; 659 if (baselen > len) 660 return; 661 662 ieee802_11_parse_elems(mgmt->u.probe_resp.variable, len - baselen, 663 &elems); 664 665 /* ignore beacons from secure mesh peers if our security is off */ 666 if (elems.rsn_len && sdata->u.mesh.security == IEEE80211_MESH_SEC_NONE) 667 return; 668 669 if (elems.ds_params && elems.ds_params_len == 1) 670 freq = ieee80211_channel_to_frequency(elems.ds_params[0], band); 671 else 672 freq = rx_status->freq; 673 674 channel = ieee80211_get_channel(local->hw.wiphy, freq); 675 676 if (!channel || channel->flags & IEEE80211_CHAN_DISABLED) 677 return; 678 679 if (elems.mesh_id && elems.mesh_config && 680 mesh_matches_local(sdata, &elems)) 681 mesh_neighbour_update(sdata, mgmt->sa, &elems); 682 683 if (ifmsh->sync_ops) 684 ifmsh->sync_ops->rx_bcn_presp(sdata, 685 stype, mgmt, &elems, rx_status); 686} 687 688static void ieee80211_mesh_rx_mgmt_action(struct ieee80211_sub_if_data *sdata, 689 struct ieee80211_mgmt *mgmt, 690 size_t len, 691 struct ieee80211_rx_status *rx_status) 692{ 693 switch (mgmt->u.action.category) { 694 case WLAN_CATEGORY_SELF_PROTECTED: 695 switch (mgmt->u.action.u.self_prot.action_code) { 696 case WLAN_SP_MESH_PEERING_OPEN: 697 case WLAN_SP_MESH_PEERING_CLOSE: 698 case WLAN_SP_MESH_PEERING_CONFIRM: 699 mesh_rx_plink_frame(sdata, mgmt, len, rx_status); 700 break; 701 } 702 break; 703 case WLAN_CATEGORY_MESH_ACTION: 704 if (mesh_action_is_path_sel(mgmt)) 705 mesh_rx_path_sel_frame(sdata, mgmt, len); 706 break; 707 } 708} 709 710void ieee80211_mesh_rx_queued_mgmt(struct ieee80211_sub_if_data *sdata, 711 struct sk_buff *skb) 712{ 713 struct ieee80211_rx_status *rx_status; 714 struct ieee80211_mgmt *mgmt; 715 u16 stype; 716 717 rx_status = IEEE80211_SKB_RXCB(skb); 718 mgmt = (struct ieee80211_mgmt *) skb->data; 719 stype = le16_to_cpu(mgmt->frame_control) & IEEE80211_FCTL_STYPE; 720 721 switch (stype) { 722 case IEEE80211_STYPE_PROBE_RESP: 723 case IEEE80211_STYPE_BEACON: 724 ieee80211_mesh_rx_bcn_presp(sdata, stype, mgmt, skb->len, 725 rx_status); 726 break; 727 case IEEE80211_STYPE_ACTION: 728 ieee80211_mesh_rx_mgmt_action(sdata, mgmt, skb->len, rx_status); 729 break; 730 } 731} 732 733void ieee80211_mesh_work(struct ieee80211_sub_if_data *sdata) 734{ 735 struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; 736 737 if (ifmsh->preq_queue_len && 738 time_after(jiffies, 739 ifmsh->last_preq + msecs_to_jiffies(ifmsh->mshcfg.dot11MeshHWMPpreqMinInterval))) 740 mesh_path_start_discovery(sdata); 741 742 if (test_and_clear_bit(MESH_WORK_GROW_MPATH_TABLE, &ifmsh->wrkq_flags)) 743 mesh_mpath_table_grow(); 744 745 if (test_and_clear_bit(MESH_WORK_GROW_MPP_TABLE, &ifmsh->wrkq_flags)) 746 mesh_mpp_table_grow(); 747 748 if (test_and_clear_bit(MESH_WORK_HOUSEKEEPING, &ifmsh->wrkq_flags)) 749 ieee80211_mesh_housekeeping(sdata, ifmsh); 750 751 if (test_and_clear_bit(MESH_WORK_ROOT, &ifmsh->wrkq_flags)) 752 ieee80211_mesh_rootpath(sdata); 753 754 if (test_and_clear_bit(MESH_WORK_DRIFT_ADJUST, &ifmsh->wrkq_flags)) 755 mesh_sync_adjust_tbtt(sdata); 756} 757 758void ieee80211_mesh_notify_scan_completed(struct ieee80211_local *local) 759{ 760 struct ieee80211_sub_if_data *sdata; 761 762 rcu_read_lock(); 763 list_for_each_entry_rcu(sdata, &local->interfaces, list) 764 if (ieee80211_vif_is_mesh(&sdata->vif)) 765 ieee80211_queue_work(&local->hw, &sdata->work); 766 rcu_read_unlock(); 767} 768 769void ieee80211_mesh_init_sdata(struct ieee80211_sub_if_data *sdata) 770{ 771 struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; 772 773 setup_timer(&ifmsh->housekeeping_timer, 774 ieee80211_mesh_housekeeping_timer, 775 (unsigned long) sdata); 776 777 ifmsh->accepting_plinks = true; 778 ifmsh->preq_id = 0; 779 ifmsh->sn = 0; 780 ifmsh->num_gates = 0; 781 atomic_set(&ifmsh->mpaths, 0); 782 mesh_rmc_init(sdata); 783 ifmsh->last_preq = jiffies; 784 ifmsh->next_perr = jiffies; 785 /* Allocate all mesh structures when creating the first mesh interface. */ 786 if (!mesh_allocated) 787 ieee80211s_init(); 788 setup_timer(&ifmsh->mesh_path_timer, 789 ieee80211_mesh_path_timer, 790 (unsigned long) sdata); 791 setup_timer(&ifmsh->mesh_path_root_timer, 792 ieee80211_mesh_path_root_timer, 793 (unsigned long) sdata); 794 INIT_LIST_HEAD(&ifmsh->preq_queue.list); 795 spin_lock_init(&ifmsh->mesh_preq_queue_lock); 796 spin_lock_init(&ifmsh->sync_offset_lock); 797} 798