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 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; 120 mismatch: 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 */ 129 bool 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 */ 140 void 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 156 int 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 169 void 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 */ 200 int 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 235 int 236 mesh_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 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 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 368 int 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 389 int 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 } 412 static 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 427 static 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 444 void 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 */ 465 int 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 */ 498 int 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 521 static 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 537 static 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 554 void 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 568 void 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 582 void 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 614 void 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 del_timer_sync(&sdata->u.mesh.mesh_path_timer); 626 /* 627 * If the timer fired while we waited for it, it will have 628 * requeued the work. Now the work will be running again 629 * but will not rearm the timer again because it checks 630 * whether the interface is running, which, at this point, 631 * it no longer is. 632 */ 633 cancel_work_sync(&sdata->work); 634 635 local->fif_other_bss--; 636 atomic_dec(&local->iff_allmultis); 637 ieee80211_configure_filter(local); 638 639 sdata->u.mesh.timers_running = 0; 640 } 641 642 static void ieee80211_mesh_rx_bcn_presp(struct ieee80211_sub_if_data *sdata, 643 u16 stype, 644 struct ieee80211_mgmt *mgmt, 645 size_t len, 646 struct ieee80211_rx_status *rx_status) 647 { 648 struct ieee80211_local *local = sdata->local; 649 struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; 650 struct ieee802_11_elems elems; 651 struct ieee80211_channel *channel; 652 size_t baselen; 653 int freq; 654 enum ieee80211_band band = rx_status->band; 655 656 /* ignore ProbeResp to foreign address */ 657 if (stype == IEEE80211_STYPE_PROBE_RESP && 658 !ether_addr_equal(mgmt->da, sdata->vif.addr)) 659 return; 660 661 baselen = (u8 *) mgmt->u.probe_resp.variable - (u8 *) mgmt; 662 if (baselen > len) 663 return; 664 665 ieee802_11_parse_elems(mgmt->u.probe_resp.variable, len - baselen, 666 &elems); 667 668 /* ignore beacons from secure mesh peers if our security is off */ 669 if (elems.rsn_len && sdata->u.mesh.security == IEEE80211_MESH_SEC_NONE) 670 return; 671 672 if (elems.ds_params && elems.ds_params_len == 1) 673 freq = ieee80211_channel_to_frequency(elems.ds_params[0], band); 674 else 675 freq = rx_status->freq; 676 677 channel = ieee80211_get_channel(local->hw.wiphy, freq); 678 679 if (!channel || channel->flags & IEEE80211_CHAN_DISABLED) 680 return; 681 682 if (elems.mesh_id && elems.mesh_config && 683 mesh_matches_local(sdata, &elems)) 684 mesh_neighbour_update(sdata, mgmt->sa, &elems); 685 686 if (ifmsh->sync_ops) 687 ifmsh->sync_ops->rx_bcn_presp(sdata, 688 stype, mgmt, &elems, rx_status); 689 } 690 691 static void ieee80211_mesh_rx_mgmt_action(struct ieee80211_sub_if_data *sdata, 692 struct ieee80211_mgmt *mgmt, 693 size_t len, 694 struct ieee80211_rx_status *rx_status) 695 { 696 switch (mgmt->u.action.category) { 697 case WLAN_CATEGORY_SELF_PROTECTED: 698 switch (mgmt->u.action.u.self_prot.action_code) { 699 case WLAN_SP_MESH_PEERING_OPEN: 700 case WLAN_SP_MESH_PEERING_CLOSE: 701 case WLAN_SP_MESH_PEERING_CONFIRM: 702 mesh_rx_plink_frame(sdata, mgmt, len, rx_status); 703 break; 704 } 705 break; 706 case WLAN_CATEGORY_MESH_ACTION: 707 if (mesh_action_is_path_sel(mgmt)) 708 mesh_rx_path_sel_frame(sdata, mgmt, len); 709 break; 710 } 711 } 712 713 void ieee80211_mesh_rx_queued_mgmt(struct ieee80211_sub_if_data *sdata, 714 struct sk_buff *skb) 715 { 716 struct ieee80211_rx_status *rx_status; 717 struct ieee80211_mgmt *mgmt; 718 u16 stype; 719 720 rx_status = IEEE80211_SKB_RXCB(skb); 721 mgmt = (struct ieee80211_mgmt *) skb->data; 722 stype = le16_to_cpu(mgmt->frame_control) & IEEE80211_FCTL_STYPE; 723 724 switch (stype) { 725 case IEEE80211_STYPE_PROBE_RESP: 726 case IEEE80211_STYPE_BEACON: 727 ieee80211_mesh_rx_bcn_presp(sdata, stype, mgmt, skb->len, 728 rx_status); 729 break; 730 case IEEE80211_STYPE_ACTION: 731 ieee80211_mesh_rx_mgmt_action(sdata, mgmt, skb->len, rx_status); 732 break; 733 } 734 } 735 736 void ieee80211_mesh_work(struct ieee80211_sub_if_data *sdata) 737 { 738 struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; 739 740 if (ifmsh->preq_queue_len && 741 time_after(jiffies, 742 ifmsh->last_preq + msecs_to_jiffies(ifmsh->mshcfg.dot11MeshHWMPpreqMinInterval))) 743 mesh_path_start_discovery(sdata); 744 745 if (test_and_clear_bit(MESH_WORK_GROW_MPATH_TABLE, &ifmsh->wrkq_flags)) 746 mesh_mpath_table_grow(); 747 748 if (test_and_clear_bit(MESH_WORK_GROW_MPP_TABLE, &ifmsh->wrkq_flags)) 749 mesh_mpp_table_grow(); 750 751 if (test_and_clear_bit(MESH_WORK_HOUSEKEEPING, &ifmsh->wrkq_flags)) 752 ieee80211_mesh_housekeeping(sdata, ifmsh); 753 754 if (test_and_clear_bit(MESH_WORK_ROOT, &ifmsh->wrkq_flags)) 755 ieee80211_mesh_rootpath(sdata); 756 757 if (test_and_clear_bit(MESH_WORK_DRIFT_ADJUST, &ifmsh->wrkq_flags)) 758 mesh_sync_adjust_tbtt(sdata); 759 } 760 761 void ieee80211_mesh_notify_scan_completed(struct ieee80211_local *local) 762 { 763 struct ieee80211_sub_if_data *sdata; 764 765 rcu_read_lock(); 766 list_for_each_entry_rcu(sdata, &local->interfaces, list) 767 if (ieee80211_vif_is_mesh(&sdata->vif)) 768 ieee80211_queue_work(&local->hw, &sdata->work); 769 rcu_read_unlock(); 770 } 771 772 void ieee80211_mesh_init_sdata(struct ieee80211_sub_if_data *sdata) 773 { 774 struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; 775 776 setup_timer(&ifmsh->housekeeping_timer, 777 ieee80211_mesh_housekeeping_timer, 778 (unsigned long) sdata); 779 780 ifmsh->accepting_plinks = true; 781 ifmsh->preq_id = 0; 782 ifmsh->sn = 0; 783 ifmsh->num_gates = 0; 784 atomic_set(&ifmsh->mpaths, 0); 785 mesh_rmc_init(sdata); 786 ifmsh->last_preq = jiffies; 787 ifmsh->next_perr = jiffies; 788 /* Allocate all mesh structures when creating the first mesh interface. */ 789 if (!mesh_allocated) 790 ieee80211s_init(); 791 setup_timer(&ifmsh->mesh_path_timer, 792 ieee80211_mesh_path_timer, 793 (unsigned long) sdata); 794 setup_timer(&ifmsh->mesh_path_root_timer, 795 ieee80211_mesh_path_root_timer, 796 (unsigned long) sdata); 797 INIT_LIST_HEAD(&ifmsh->preq_queue.list); 798 spin_lock_init(&ifmsh->mesh_preq_queue_lock); 799 spin_lock_init(&ifmsh->sync_offset_lock); 800 } 801