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 20 int mesh_allocated; 21 static struct kmem_cache *rm_cache; 22 23 #ifdef CONFIG_MAC80211_MESH 24 bool 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 30 bool mesh_action_is_path_sel(struct ieee80211_mgmt *mgmt) 31 { return false; } 32 #endif 33 34 void 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 42 void ieee80211s_stop(void) 43 { 44 mesh_pathtbl_unregister(); 45 kmem_cache_destroy(rm_cache); 46 } 47 48 static 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 */ 73 bool 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 struct cfg80211_chan_def sta_chan_def; 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, ieee80211_get_sdata_band(sdata), 101 &basic_rates); 102 103 if (sdata->vif.bss_conf.basic_rates != basic_rates) 104 goto mismatch; 105 106 ieee80211_ht_oper_to_chandef(sdata->vif.bss_conf.chandef.chan, 107 ie->ht_operation, &sta_chan_def); 108 109 if (!cfg80211_chandef_compatible(&sdata->vif.bss_conf.chandef, 110 &sta_chan_def)) 111 goto mismatch; 112 113 return true; 114 mismatch: 115 return false; 116 } 117 118 /** 119 * mesh_peer_accepts_plinks - check if an mp is willing to establish peer links 120 * 121 * @ie: information elements of a management frame from the mesh peer 122 */ 123 bool mesh_peer_accepts_plinks(struct ieee802_11_elems *ie) 124 { 125 return (ie->mesh_config->meshconf_cap & 126 IEEE80211_MESHCONF_CAPAB_ACCEPT_PLINKS) != 0; 127 } 128 129 /** 130 * mesh_accept_plinks_update - update accepting_plink in local mesh beacons 131 * 132 * @sdata: mesh interface in which mesh beacons are going to be updated 133 * 134 * Returns: beacon changed flag if the beacon content changed. 135 */ 136 u32 mesh_accept_plinks_update(struct ieee80211_sub_if_data *sdata) 137 { 138 bool free_plinks; 139 u32 changed = 0; 140 141 /* In case mesh_plink_free_count > 0 and mesh_plinktbl_capacity == 0, 142 * the mesh interface might be able to establish plinks with peers that 143 * are already on the table but are not on PLINK_ESTAB state. However, 144 * in general the mesh interface is not accepting peer link requests 145 * from new peers, and that must be reflected in the beacon 146 */ 147 free_plinks = mesh_plink_availables(sdata); 148 149 if (free_plinks != sdata->u.mesh.accepting_plinks) { 150 sdata->u.mesh.accepting_plinks = free_plinks; 151 changed = BSS_CHANGED_BEACON; 152 } 153 154 return changed; 155 } 156 157 int mesh_rmc_init(struct ieee80211_sub_if_data *sdata) 158 { 159 int i; 160 161 sdata->u.mesh.rmc = kmalloc(sizeof(struct mesh_rmc), GFP_KERNEL); 162 if (!sdata->u.mesh.rmc) 163 return -ENOMEM; 164 sdata->u.mesh.rmc->idx_mask = RMC_BUCKETS - 1; 165 for (i = 0; i < RMC_BUCKETS; i++) 166 INIT_LIST_HEAD(&sdata->u.mesh.rmc->bucket[i]); 167 return 0; 168 } 169 170 void mesh_rmc_free(struct ieee80211_sub_if_data *sdata) 171 { 172 struct mesh_rmc *rmc = sdata->u.mesh.rmc; 173 struct rmc_entry *p, *n; 174 int i; 175 176 if (!sdata->u.mesh.rmc) 177 return; 178 179 for (i = 0; i < RMC_BUCKETS; i++) 180 list_for_each_entry_safe(p, n, &rmc->bucket[i], list) { 181 list_del(&p->list); 182 kmem_cache_free(rm_cache, p); 183 } 184 185 kfree(rmc); 186 sdata->u.mesh.rmc = NULL; 187 } 188 189 /** 190 * mesh_rmc_check - Check frame in recent multicast cache and add if absent. 191 * 192 * @sa: source address 193 * @mesh_hdr: mesh_header 194 * 195 * Returns: 0 if the frame is not in the cache, nonzero otherwise. 196 * 197 * Checks using the source address and the mesh sequence number if we have 198 * received this frame lately. If the frame is not in the cache, it is added to 199 * it. 200 */ 201 int mesh_rmc_check(u8 *sa, struct ieee80211s_hdr *mesh_hdr, 202 struct ieee80211_sub_if_data *sdata) 203 { 204 struct mesh_rmc *rmc = sdata->u.mesh.rmc; 205 u32 seqnum = 0; 206 int entries = 0; 207 u8 idx; 208 struct rmc_entry *p, *n; 209 210 /* Don't care about endianness since only match matters */ 211 memcpy(&seqnum, &mesh_hdr->seqnum, sizeof(mesh_hdr->seqnum)); 212 idx = le32_to_cpu(mesh_hdr->seqnum) & rmc->idx_mask; 213 list_for_each_entry_safe(p, n, &rmc->bucket[idx], list) { 214 ++entries; 215 if (time_after(jiffies, p->exp_time) || 216 (entries == RMC_QUEUE_MAX_LEN)) { 217 list_del(&p->list); 218 kmem_cache_free(rm_cache, p); 219 --entries; 220 } else if ((seqnum == p->seqnum) && 221 (ether_addr_equal(sa, p->sa))) 222 return -1; 223 } 224 225 p = kmem_cache_alloc(rm_cache, GFP_ATOMIC); 226 if (!p) 227 return 0; 228 229 p->seqnum = seqnum; 230 p->exp_time = jiffies + RMC_TIMEOUT; 231 memcpy(p->sa, sa, ETH_ALEN); 232 list_add(&p->list, &rmc->bucket[idx]); 233 return 0; 234 } 235 236 int 237 mesh_add_meshconf_ie(struct sk_buff *skb, struct ieee80211_sub_if_data *sdata) 238 { 239 struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; 240 u8 *pos, neighbors; 241 u8 meshconf_len = sizeof(struct ieee80211_meshconf_ie); 242 243 if (skb_tailroom(skb) < 2 + meshconf_len) 244 return -ENOMEM; 245 246 pos = skb_put(skb, 2 + meshconf_len); 247 *pos++ = WLAN_EID_MESH_CONFIG; 248 *pos++ = meshconf_len; 249 250 /* Active path selection protocol ID */ 251 *pos++ = ifmsh->mesh_pp_id; 252 /* Active path selection metric ID */ 253 *pos++ = ifmsh->mesh_pm_id; 254 /* Congestion control mode identifier */ 255 *pos++ = ifmsh->mesh_cc_id; 256 /* Synchronization protocol identifier */ 257 *pos++ = ifmsh->mesh_sp_id; 258 /* Authentication Protocol identifier */ 259 *pos++ = ifmsh->mesh_auth_id; 260 /* Mesh Formation Info - number of neighbors */ 261 neighbors = atomic_read(&ifmsh->estab_plinks); 262 /* Number of neighbor mesh STAs or 15 whichever is smaller */ 263 neighbors = (neighbors > 15) ? 15 : neighbors; 264 *pos++ = neighbors << 1; 265 /* Mesh capability */ 266 *pos = IEEE80211_MESHCONF_CAPAB_FORWARDING; 267 *pos |= ifmsh->accepting_plinks ? 268 IEEE80211_MESHCONF_CAPAB_ACCEPT_PLINKS : 0x00; 269 *pos++ |= ifmsh->adjusting_tbtt ? 270 IEEE80211_MESHCONF_CAPAB_TBTT_ADJUSTING : 0x00; 271 *pos++ = 0x00; 272 273 return 0; 274 } 275 276 int 277 mesh_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 294 int 295 mesh_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 318 int 319 mesh_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 347 int 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 struct ieee80211_chanctx_conf *chanctx_conf; 353 struct ieee80211_channel *chan; 354 u8 *pos; 355 356 if (skb_tailroom(skb) < 3) 357 return -ENOMEM; 358 359 rcu_read_lock(); 360 chanctx_conf = rcu_dereference(sdata->vif.chanctx_conf); 361 if (WARN_ON(!chanctx_conf)) { 362 rcu_read_unlock(); 363 return -EINVAL; 364 } 365 chan = chanctx_conf->def.chan; 366 rcu_read_unlock(); 367 368 sband = local->hw.wiphy->bands[chan->band]; 369 if (sband->band == IEEE80211_BAND_2GHZ) { 370 pos = skb_put(skb, 2 + 1); 371 *pos++ = WLAN_EID_DS_PARAMS; 372 *pos++ = 1; 373 *pos++ = ieee80211_frequency_to_channel(chan->center_freq); 374 } 375 376 return 0; 377 } 378 379 int mesh_add_ht_cap_ie(struct sk_buff *skb, 380 struct ieee80211_sub_if_data *sdata) 381 { 382 struct ieee80211_local *local = sdata->local; 383 enum ieee80211_band band = ieee80211_get_sdata_band(sdata); 384 struct ieee80211_supported_band *sband; 385 u8 *pos; 386 387 sband = local->hw.wiphy->bands[band]; 388 if (!sband->ht_cap.ht_supported || 389 sdata->vif.bss_conf.chandef.width == NL80211_CHAN_WIDTH_20_NOHT) 390 return 0; 391 392 if (skb_tailroom(skb) < 2 + sizeof(struct ieee80211_ht_cap)) 393 return -ENOMEM; 394 395 pos = skb_put(skb, 2 + sizeof(struct ieee80211_ht_cap)); 396 ieee80211_ie_build_ht_cap(pos, &sband->ht_cap, sband->ht_cap.cap); 397 398 return 0; 399 } 400 401 int mesh_add_ht_oper_ie(struct sk_buff *skb, 402 struct ieee80211_sub_if_data *sdata) 403 { 404 struct ieee80211_local *local = sdata->local; 405 struct ieee80211_chanctx_conf *chanctx_conf; 406 struct ieee80211_channel *channel; 407 enum nl80211_channel_type channel_type = 408 cfg80211_get_chandef_type(&sdata->vif.bss_conf.chandef); 409 struct ieee80211_supported_band *sband; 410 struct ieee80211_sta_ht_cap *ht_cap; 411 u8 *pos; 412 413 rcu_read_lock(); 414 chanctx_conf = rcu_dereference(sdata->vif.chanctx_conf); 415 if (WARN_ON(!chanctx_conf)) { 416 rcu_read_unlock(); 417 return -EINVAL; 418 } 419 channel = chanctx_conf->def.chan; 420 rcu_read_unlock(); 421 422 sband = local->hw.wiphy->bands[channel->band]; 423 ht_cap = &sband->ht_cap; 424 425 if (!ht_cap->ht_supported || channel_type == NL80211_CHAN_NO_HT) 426 return 0; 427 428 if (skb_tailroom(skb) < 2 + sizeof(struct ieee80211_ht_operation)) 429 return -ENOMEM; 430 431 pos = skb_put(skb, 2 + sizeof(struct ieee80211_ht_operation)); 432 ieee80211_ie_build_ht_oper(pos, ht_cap, &sdata->vif.bss_conf.chandef, 433 sdata->vif.bss_conf.ht_operation_mode); 434 435 return 0; 436 } 437 static void ieee80211_mesh_path_timer(unsigned long data) 438 { 439 struct ieee80211_sub_if_data *sdata = 440 (struct ieee80211_sub_if_data *) data; 441 struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; 442 struct ieee80211_local *local = sdata->local; 443 444 if (local->quiescing) { 445 set_bit(TMR_RUNNING_MP, &ifmsh->timers_running); 446 return; 447 } 448 449 ieee80211_queue_work(&local->hw, &sdata->work); 450 } 451 452 static void ieee80211_mesh_path_root_timer(unsigned long data) 453 { 454 struct ieee80211_sub_if_data *sdata = 455 (struct ieee80211_sub_if_data *) data; 456 struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; 457 struct ieee80211_local *local = sdata->local; 458 459 set_bit(MESH_WORK_ROOT, &ifmsh->wrkq_flags); 460 461 if (local->quiescing) { 462 set_bit(TMR_RUNNING_MPR, &ifmsh->timers_running); 463 return; 464 } 465 466 ieee80211_queue_work(&local->hw, &sdata->work); 467 } 468 469 void ieee80211_mesh_root_setup(struct ieee80211_if_mesh *ifmsh) 470 { 471 if (ifmsh->mshcfg.dot11MeshHWMPRootMode > IEEE80211_ROOTMODE_ROOT) 472 set_bit(MESH_WORK_ROOT, &ifmsh->wrkq_flags); 473 else { 474 clear_bit(MESH_WORK_ROOT, &ifmsh->wrkq_flags); 475 /* stop running timer */ 476 del_timer_sync(&ifmsh->mesh_path_root_timer); 477 } 478 } 479 480 /** 481 * ieee80211_fill_mesh_addresses - fill addresses of a locally originated mesh frame 482 * @hdr: 802.11 frame header 483 * @fc: frame control field 484 * @meshda: destination address in the mesh 485 * @meshsa: source address address in the mesh. Same as TA, as frame is 486 * locally originated. 487 * 488 * Return the length of the 802.11 (does not include a mesh control header) 489 */ 490 int ieee80211_fill_mesh_addresses(struct ieee80211_hdr *hdr, __le16 *fc, 491 const u8 *meshda, const u8 *meshsa) 492 { 493 if (is_multicast_ether_addr(meshda)) { 494 *fc |= cpu_to_le16(IEEE80211_FCTL_FROMDS); 495 /* DA TA SA */ 496 memcpy(hdr->addr1, meshda, ETH_ALEN); 497 memcpy(hdr->addr2, meshsa, ETH_ALEN); 498 memcpy(hdr->addr3, meshsa, ETH_ALEN); 499 return 24; 500 } else { 501 *fc |= cpu_to_le16(IEEE80211_FCTL_FROMDS | IEEE80211_FCTL_TODS); 502 /* RA TA DA SA */ 503 memset(hdr->addr1, 0, ETH_ALEN); /* RA is resolved later */ 504 memcpy(hdr->addr2, meshsa, ETH_ALEN); 505 memcpy(hdr->addr3, meshda, ETH_ALEN); 506 memcpy(hdr->addr4, meshsa, ETH_ALEN); 507 return 30; 508 } 509 } 510 511 /** 512 * ieee80211_new_mesh_header - create a new mesh header 513 * @meshhdr: uninitialized mesh header 514 * @sdata: mesh interface to be used 515 * @addr4or5: 1st address in the ae header, which may correspond to address 4 516 * (if addr6 is NULL) or address 5 (if addr6 is present). It may 517 * be NULL. 518 * @addr6: 2nd address in the ae header, which corresponds to addr6 of the 519 * mesh frame 520 * 521 * Return the header length. 522 */ 523 int ieee80211_new_mesh_header(struct ieee80211s_hdr *meshhdr, 524 struct ieee80211_sub_if_data *sdata, char *addr4or5, 525 char *addr6) 526 { 527 int aelen = 0; 528 BUG_ON(!addr4or5 && addr6); 529 memset(meshhdr, 0, sizeof(*meshhdr)); 530 meshhdr->ttl = sdata->u.mesh.mshcfg.dot11MeshTTL; 531 put_unaligned(cpu_to_le32(sdata->u.mesh.mesh_seqnum), &meshhdr->seqnum); 532 sdata->u.mesh.mesh_seqnum++; 533 if (addr4or5 && !addr6) { 534 meshhdr->flags |= MESH_FLAGS_AE_A4; 535 aelen += ETH_ALEN; 536 memcpy(meshhdr->eaddr1, addr4or5, ETH_ALEN); 537 } else if (addr4or5 && addr6) { 538 meshhdr->flags |= MESH_FLAGS_AE_A5_A6; 539 aelen += 2 * ETH_ALEN; 540 memcpy(meshhdr->eaddr1, addr4or5, ETH_ALEN); 541 memcpy(meshhdr->eaddr2, addr6, ETH_ALEN); 542 } 543 return 6 + aelen; 544 } 545 546 static void ieee80211_mesh_housekeeping(struct ieee80211_sub_if_data *sdata, 547 struct ieee80211_if_mesh *ifmsh) 548 { 549 u32 changed; 550 551 ieee80211_sta_expire(sdata, IEEE80211_MESH_PEER_INACTIVITY_LIMIT); 552 mesh_path_expire(sdata); 553 554 changed = mesh_accept_plinks_update(sdata); 555 ieee80211_bss_info_change_notify(sdata, changed); 556 557 mod_timer(&ifmsh->housekeeping_timer, 558 round_jiffies(jiffies + IEEE80211_MESH_HOUSEKEEPING_INTERVAL)); 559 } 560 561 static void ieee80211_mesh_rootpath(struct ieee80211_sub_if_data *sdata) 562 { 563 struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; 564 u32 interval; 565 566 mesh_path_tx_root_frame(sdata); 567 568 if (ifmsh->mshcfg.dot11MeshHWMPRootMode == IEEE80211_PROACTIVE_RANN) 569 interval = ifmsh->mshcfg.dot11MeshHWMPRannInterval; 570 else 571 interval = ifmsh->mshcfg.dot11MeshHWMProotInterval; 572 573 mod_timer(&ifmsh->mesh_path_root_timer, 574 round_jiffies(TU_TO_EXP_TIME(interval))); 575 } 576 577 #ifdef CONFIG_PM 578 void ieee80211_mesh_quiesce(struct ieee80211_sub_if_data *sdata) 579 { 580 struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; 581 582 /* use atomic bitops in case all timers fire at the same time */ 583 584 if (del_timer_sync(&ifmsh->housekeeping_timer)) 585 set_bit(TMR_RUNNING_HK, &ifmsh->timers_running); 586 if (del_timer_sync(&ifmsh->mesh_path_timer)) 587 set_bit(TMR_RUNNING_MP, &ifmsh->timers_running); 588 if (del_timer_sync(&ifmsh->mesh_path_root_timer)) 589 set_bit(TMR_RUNNING_MPR, &ifmsh->timers_running); 590 } 591 592 void ieee80211_mesh_restart(struct ieee80211_sub_if_data *sdata) 593 { 594 struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; 595 596 if (test_and_clear_bit(TMR_RUNNING_HK, &ifmsh->timers_running)) 597 add_timer(&ifmsh->housekeeping_timer); 598 if (test_and_clear_bit(TMR_RUNNING_MP, &ifmsh->timers_running)) 599 add_timer(&ifmsh->mesh_path_timer); 600 if (test_and_clear_bit(TMR_RUNNING_MPR, &ifmsh->timers_running)) 601 add_timer(&ifmsh->mesh_path_root_timer); 602 ieee80211_mesh_root_setup(ifmsh); 603 } 604 #endif 605 606 void ieee80211_start_mesh(struct ieee80211_sub_if_data *sdata) 607 { 608 struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; 609 struct ieee80211_local *local = sdata->local; 610 611 local->fif_other_bss++; 612 /* mesh ifaces must set allmulti to forward mcast traffic */ 613 atomic_inc(&local->iff_allmultis); 614 ieee80211_configure_filter(local); 615 616 ifmsh->mesh_cc_id = 0; /* Disabled */ 617 ifmsh->mesh_auth_id = 0; /* Disabled */ 618 /* register sync ops from extensible synchronization framework */ 619 ifmsh->sync_ops = ieee80211_mesh_sync_ops_get(ifmsh->mesh_sp_id); 620 ifmsh->adjusting_tbtt = false; 621 ifmsh->sync_offset_clockdrift_max = 0; 622 set_bit(MESH_WORK_HOUSEKEEPING, &ifmsh->wrkq_flags); 623 ieee80211_mesh_root_setup(ifmsh); 624 ieee80211_queue_work(&local->hw, &sdata->work); 625 sdata->vif.bss_conf.ht_operation_mode = 626 ifmsh->mshcfg.ht_opmode; 627 sdata->vif.bss_conf.beacon_int = MESH_DEFAULT_BEACON_INTERVAL; 628 sdata->vif.bss_conf.basic_rates = 629 ieee80211_mandatory_rates(sdata->local, 630 ieee80211_get_sdata_band(sdata)); 631 ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_BEACON | 632 BSS_CHANGED_BEACON_ENABLED | 633 BSS_CHANGED_HT | 634 BSS_CHANGED_BASIC_RATES | 635 BSS_CHANGED_BEACON_INT); 636 637 netif_carrier_on(sdata->dev); 638 } 639 640 void ieee80211_stop_mesh(struct ieee80211_sub_if_data *sdata) 641 { 642 struct ieee80211_local *local = sdata->local; 643 struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; 644 645 netif_carrier_off(sdata->dev); 646 647 /* stop the beacon */ 648 ifmsh->mesh_id_len = 0; 649 ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_BEACON_ENABLED); 650 651 /* flush STAs and mpaths on this iface */ 652 sta_info_flush(sdata->local, sdata); 653 mesh_path_flush_by_iface(sdata); 654 655 del_timer_sync(&sdata->u.mesh.housekeeping_timer); 656 del_timer_sync(&sdata->u.mesh.mesh_path_root_timer); 657 del_timer_sync(&sdata->u.mesh.mesh_path_timer); 658 /* 659 * If the timer fired while we waited for it, it will have 660 * requeued the work. Now the work will be running again 661 * but will not rearm the timer again because it checks 662 * whether the interface is running, which, at this point, 663 * it no longer is. 664 */ 665 cancel_work_sync(&sdata->work); 666 667 local->fif_other_bss--; 668 atomic_dec(&local->iff_allmultis); 669 ieee80211_configure_filter(local); 670 671 sdata->u.mesh.timers_running = 0; 672 } 673 674 static void ieee80211_mesh_rx_bcn_presp(struct ieee80211_sub_if_data *sdata, 675 u16 stype, 676 struct ieee80211_mgmt *mgmt, 677 size_t len, 678 struct ieee80211_rx_status *rx_status) 679 { 680 struct ieee80211_local *local = sdata->local; 681 struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; 682 struct ieee802_11_elems elems; 683 struct ieee80211_channel *channel; 684 size_t baselen; 685 int freq; 686 enum ieee80211_band band = rx_status->band; 687 688 /* ignore ProbeResp to foreign address */ 689 if (stype == IEEE80211_STYPE_PROBE_RESP && 690 !ether_addr_equal(mgmt->da, sdata->vif.addr)) 691 return; 692 693 baselen = (u8 *) mgmt->u.probe_resp.variable - (u8 *) mgmt; 694 if (baselen > len) 695 return; 696 697 ieee802_11_parse_elems(mgmt->u.probe_resp.variable, len - baselen, 698 &elems); 699 700 /* ignore non-mesh or secure / unsecure mismatch */ 701 if ((!elems.mesh_id || !elems.mesh_config) || 702 (elems.rsn && sdata->u.mesh.security == IEEE80211_MESH_SEC_NONE) || 703 (!elems.rsn && sdata->u.mesh.security != IEEE80211_MESH_SEC_NONE)) 704 return; 705 706 if (elems.ds_params && elems.ds_params_len == 1) 707 freq = ieee80211_channel_to_frequency(elems.ds_params[0], band); 708 else 709 freq = rx_status->freq; 710 711 channel = ieee80211_get_channel(local->hw.wiphy, freq); 712 713 if (!channel || channel->flags & IEEE80211_CHAN_DISABLED) 714 return; 715 716 if (mesh_matches_local(sdata, &elems)) 717 mesh_neighbour_update(sdata, mgmt->sa, &elems); 718 719 if (ifmsh->sync_ops) 720 ifmsh->sync_ops->rx_bcn_presp(sdata, 721 stype, mgmt, &elems, rx_status); 722 } 723 724 static void ieee80211_mesh_rx_mgmt_action(struct ieee80211_sub_if_data *sdata, 725 struct ieee80211_mgmt *mgmt, 726 size_t len, 727 struct ieee80211_rx_status *rx_status) 728 { 729 switch (mgmt->u.action.category) { 730 case WLAN_CATEGORY_SELF_PROTECTED: 731 switch (mgmt->u.action.u.self_prot.action_code) { 732 case WLAN_SP_MESH_PEERING_OPEN: 733 case WLAN_SP_MESH_PEERING_CLOSE: 734 case WLAN_SP_MESH_PEERING_CONFIRM: 735 mesh_rx_plink_frame(sdata, mgmt, len, rx_status); 736 break; 737 } 738 break; 739 case WLAN_CATEGORY_MESH_ACTION: 740 if (mesh_action_is_path_sel(mgmt)) 741 mesh_rx_path_sel_frame(sdata, mgmt, len); 742 break; 743 } 744 } 745 746 void ieee80211_mesh_rx_queued_mgmt(struct ieee80211_sub_if_data *sdata, 747 struct sk_buff *skb) 748 { 749 struct ieee80211_rx_status *rx_status; 750 struct ieee80211_mgmt *mgmt; 751 u16 stype; 752 753 rx_status = IEEE80211_SKB_RXCB(skb); 754 mgmt = (struct ieee80211_mgmt *) skb->data; 755 stype = le16_to_cpu(mgmt->frame_control) & IEEE80211_FCTL_STYPE; 756 757 switch (stype) { 758 case IEEE80211_STYPE_PROBE_RESP: 759 case IEEE80211_STYPE_BEACON: 760 ieee80211_mesh_rx_bcn_presp(sdata, stype, mgmt, skb->len, 761 rx_status); 762 break; 763 case IEEE80211_STYPE_ACTION: 764 ieee80211_mesh_rx_mgmt_action(sdata, mgmt, skb->len, rx_status); 765 break; 766 } 767 } 768 769 void ieee80211_mesh_work(struct ieee80211_sub_if_data *sdata) 770 { 771 struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; 772 773 if (ifmsh->preq_queue_len && 774 time_after(jiffies, 775 ifmsh->last_preq + msecs_to_jiffies(ifmsh->mshcfg.dot11MeshHWMPpreqMinInterval))) 776 mesh_path_start_discovery(sdata); 777 778 if (test_and_clear_bit(MESH_WORK_GROW_MPATH_TABLE, &ifmsh->wrkq_flags)) 779 mesh_mpath_table_grow(); 780 781 if (test_and_clear_bit(MESH_WORK_GROW_MPP_TABLE, &ifmsh->wrkq_flags)) 782 mesh_mpp_table_grow(); 783 784 if (test_and_clear_bit(MESH_WORK_HOUSEKEEPING, &ifmsh->wrkq_flags)) 785 ieee80211_mesh_housekeeping(sdata, ifmsh); 786 787 if (test_and_clear_bit(MESH_WORK_ROOT, &ifmsh->wrkq_flags)) 788 ieee80211_mesh_rootpath(sdata); 789 790 if (test_and_clear_bit(MESH_WORK_DRIFT_ADJUST, &ifmsh->wrkq_flags)) 791 mesh_sync_adjust_tbtt(sdata); 792 } 793 794 void ieee80211_mesh_notify_scan_completed(struct ieee80211_local *local) 795 { 796 struct ieee80211_sub_if_data *sdata; 797 798 rcu_read_lock(); 799 list_for_each_entry_rcu(sdata, &local->interfaces, list) 800 if (ieee80211_vif_is_mesh(&sdata->vif)) 801 ieee80211_queue_work(&local->hw, &sdata->work); 802 rcu_read_unlock(); 803 } 804 805 void ieee80211_mesh_init_sdata(struct ieee80211_sub_if_data *sdata) 806 { 807 struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; 808 809 setup_timer(&ifmsh->housekeeping_timer, 810 ieee80211_mesh_housekeeping_timer, 811 (unsigned long) sdata); 812 813 ifmsh->accepting_plinks = true; 814 ifmsh->preq_id = 0; 815 ifmsh->sn = 0; 816 ifmsh->num_gates = 0; 817 atomic_set(&ifmsh->mpaths, 0); 818 mesh_rmc_init(sdata); 819 ifmsh->last_preq = jiffies; 820 ifmsh->next_perr = jiffies; 821 /* Allocate all mesh structures when creating the first mesh interface. */ 822 if (!mesh_allocated) 823 ieee80211s_init(); 824 setup_timer(&ifmsh->mesh_path_timer, 825 ieee80211_mesh_path_timer, 826 (unsigned long) sdata); 827 setup_timer(&ifmsh->mesh_path_root_timer, 828 ieee80211_mesh_path_root_timer, 829 (unsigned long) sdata); 830 INIT_LIST_HEAD(&ifmsh->preq_queue.list); 831 spin_lock_init(&ifmsh->mesh_preq_queue_lock); 832 spin_lock_init(&ifmsh->sync_offset_lock); 833 } 834