mesh.c revision 97ad9139fd68b5c71f44d28d3f9788d89cfd4916
12e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo/* 2264d9b7d8a629620c8de84c614910c3164e935f8Rui Paulo * Copyright (c) 2008, 2009 open80211s Ltd. 32e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo * Authors: Luis Carlos Cobo <luisca@cozybit.com> 42e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo * Javier Cardona <javier@cozybit.com> 52e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo * 62e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo * This program is free software; you can redistribute it and/or modify 72e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo * it under the terms of the GNU General Public License version 2 as 82e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo * published by the Free Software Foundation. 92e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo */ 102e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo 1151ceddade0fb1e15f080b2555f3b3e1d68c6707eLuis Carlos Cobo#include <asm/unaligned.h> 122e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo#include "ieee80211_i.h" 132e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo#include "mesh.h" 142e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo 15472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg#define IEEE80211_MESH_PEER_INACTIVITY_LIMIT (1800 * HZ) 16472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg#define IEEE80211_MESH_HOUSEKEEPING_INTERVAL (60 * HZ) 17e304bfd30f356f7b75d30cad0029ecca705fd590Rui Paulo#define IEEE80211_MESH_RANN_INTERVAL (1 * HZ) 18472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg 193491707a070c1183c709516b2f876f798c7a9a84Rui Paulo#define MESHCONF_CAPAB_ACCEPT_PLINKS 0x01 203491707a070c1183c709516b2f876f798c7a9a84Rui Paulo#define MESHCONF_CAPAB_FORWARDING 0x08 212e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo 225bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg#define TMR_RUNNING_HK 0 235bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg#define TMR_RUNNING_MP 1 24e304bfd30f356f7b75d30cad0029ecca705fd590Rui Paulo#define TMR_RUNNING_MPR 2 255bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg 262e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Coboint mesh_allocated; 272e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobostatic struct kmem_cache *rm_cache; 282e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo 292e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobovoid ieee80211s_init(void) 302e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo{ 312e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo mesh_pathtbl_init(); 322e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo mesh_allocated = 1; 332e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo rm_cache = kmem_cache_create("mesh_rmc", sizeof(struct rmc_entry), 342e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo 0, 0, NULL); 352e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo} 362e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo 372e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobovoid ieee80211s_stop(void) 382e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo{ 392e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo mesh_pathtbl_unregister(); 402e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo kmem_cache_destroy(rm_cache); 412e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo} 422e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo 43472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Bergstatic void ieee80211_mesh_housekeeping_timer(unsigned long data) 44472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg{ 45472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg struct ieee80211_sub_if_data *sdata = (void *) data; 46472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg struct ieee80211_local *local = sdata->local; 47472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; 48472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg 496b9ac4425d6ec871faf54540e0f1c5ff420a8f29Rui Paulo set_bit(MESH_WORK_HOUSEKEEPING, &ifmsh->wrkq_flags); 505bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg 515bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg if (local->quiescing) { 525bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg set_bit(TMR_RUNNING_HK, &ifmsh->timers_running); 535bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg return; 545bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg } 555bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg 56c03e20fc9a6ec5741d9df561130ecba38ef50eb6Luis R. Rodriguez ieee80211_queue_work(&local->hw, &ifmsh->work); 57472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg} 58472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg 592e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo/** 602e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo * mesh_matches_local - check if the config of a mesh point matches ours 612e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo * 622e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo * @ie: information elements of a management frame from the mesh peer 63f698d856f65c3fea091cc303a135967965c5b880Jasper Bryant-Greene * @sdata: local mesh subif 642e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo * 652e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo * This function checks if the mesh configuration of a mesh point matches the 662e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo * local mesh configuration, i.e. if both nodes belong to the same mesh network. 672e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo */ 68f698d856f65c3fea091cc303a135967965c5b880Jasper Bryant-Greenebool mesh_matches_local(struct ieee802_11_elems *ie, struct ieee80211_sub_if_data *sdata) 692e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo{ 70472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; 712e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo 722e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo /* 732e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo * As support for each feature is added, check for matching 742e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo * - On mesh config capabilities 752e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo * - Power Save Support En 762e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo * - Sync support enabled 772e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo * - Sync support active 782e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo * - Sync support required from peer 792e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo * - MDA enabled 802e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo * - Power management control on fc 812e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo */ 82472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg if (ifmsh->mesh_id_len == ie->mesh_id_len && 83472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg memcmp(ifmsh->mesh_id, ie->mesh_id, ie->mesh_id_len) == 0 && 84136cfa28615ccce0f9374811480e0b81c4191ea5Rui Paulo (ifmsh->mesh_pp_id == ie->mesh_config->meshconf_psel) && 85136cfa28615ccce0f9374811480e0b81c4191ea5Rui Paulo (ifmsh->mesh_pm_id == ie->mesh_config->meshconf_pmetric) && 86136cfa28615ccce0f9374811480e0b81c4191ea5Rui Paulo (ifmsh->mesh_cc_id == ie->mesh_config->meshconf_congest) && 87136cfa28615ccce0f9374811480e0b81c4191ea5Rui Paulo (ifmsh->mesh_sp_id == ie->mesh_config->meshconf_synch) && 88136cfa28615ccce0f9374811480e0b81c4191ea5Rui Paulo (ifmsh->mesh_auth_id == ie->mesh_config->meshconf_auth)) 892e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo return true; 902e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo 912e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo return false; 922e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo} 932e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo 942e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo/** 952e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo * mesh_peer_accepts_plinks - check if an mp is willing to establish peer links 962e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo * 972e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo * @ie: information elements of a management frame from the mesh peer 982e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo */ 99f698d856f65c3fea091cc303a135967965c5b880Jasper Bryant-Greenebool mesh_peer_accepts_plinks(struct ieee802_11_elems *ie) 1002e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo{ 101136cfa28615ccce0f9374811480e0b81c4191ea5Rui Paulo return (ie->mesh_config->meshconf_cap & 1023491707a070c1183c709516b2f876f798c7a9a84Rui Paulo MESHCONF_CAPAB_ACCEPT_PLINKS) != 0; 1032e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo} 1042e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo 1052e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo/** 1062e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo * mesh_accept_plinks_update: update accepting_plink in local mesh beacons 1072e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo * 108d0709a65181beb787ef3f58cfe45536a2bb254c8Johannes Berg * @sdata: mesh interface in which mesh beacons are going to be updated 1092e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo */ 110d0709a65181beb787ef3f58cfe45536a2bb254c8Johannes Bergvoid mesh_accept_plinks_update(struct ieee80211_sub_if_data *sdata) 1112e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo{ 1122e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo bool free_plinks; 1132e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo 1142e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo /* In case mesh_plink_free_count > 0 and mesh_plinktbl_capacity == 0, 1152e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo * the mesh interface might be able to establish plinks with peers that 116b4e08ea141e6d663dec31b31d6289baeaaa2a3a2Luis Carlos Cobo * are already on the table but are not on PLINK_ESTAB state. However, 117b4e08ea141e6d663dec31b31d6289baeaaa2a3a2Luis Carlos Cobo * in general the mesh interface is not accepting peer link requests 118b4e08ea141e6d663dec31b31d6289baeaaa2a3a2Luis Carlos Cobo * from new peers, and that must be reflected in the beacon 1192e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo */ 1202e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo free_plinks = mesh_plink_availables(sdata); 1212e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo 122472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg if (free_plinks != sdata->u.mesh.accepting_plinks) 123472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg ieee80211_mesh_housekeeping_timer((unsigned long) sdata); 1242e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo} 1252e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo 126472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Bergvoid mesh_ids_set_default(struct ieee80211_if_mesh *sta) 1272e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo{ 1283491707a070c1183c709516b2f876f798c7a9a84Rui Paulo sta->mesh_pp_id = 0; /* HWMP */ 1293491707a070c1183c709516b2f876f798c7a9a84Rui Paulo sta->mesh_pm_id = 0; /* Airtime */ 1303491707a070c1183c709516b2f876f798c7a9a84Rui Paulo sta->mesh_cc_id = 0; /* Disabled */ 1313491707a070c1183c709516b2f876f798c7a9a84Rui Paulo sta->mesh_sp_id = 0; /* Neighbor Offset */ 1323491707a070c1183c709516b2f876f798c7a9a84Rui Paulo sta->mesh_auth_id = 0; /* Disabled */ 1332e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo} 1342e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo 135f698d856f65c3fea091cc303a135967965c5b880Jasper Bryant-Greeneint mesh_rmc_init(struct ieee80211_sub_if_data *sdata) 1362e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo{ 1372e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo int i; 1382e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo 139472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg sdata->u.mesh.rmc = kmalloc(sizeof(struct mesh_rmc), GFP_KERNEL); 140472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg if (!sdata->u.mesh.rmc) 1412e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo return -ENOMEM; 142472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg sdata->u.mesh.rmc->idx_mask = RMC_BUCKETS - 1; 1432e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo for (i = 0; i < RMC_BUCKETS; i++) 144472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg INIT_LIST_HEAD(&sdata->u.mesh.rmc->bucket[i].list); 1452e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo return 0; 1462e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo} 1472e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo 148f698d856f65c3fea091cc303a135967965c5b880Jasper Bryant-Greenevoid mesh_rmc_free(struct ieee80211_sub_if_data *sdata) 1492e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo{ 150472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg struct mesh_rmc *rmc = sdata->u.mesh.rmc; 1512e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo struct rmc_entry *p, *n; 1522e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo int i; 1532e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo 154472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg if (!sdata->u.mesh.rmc) 1552e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo return; 1562e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo 1572e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo for (i = 0; i < RMC_BUCKETS; i++) 1582e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo list_for_each_entry_safe(p, n, &rmc->bucket[i].list, list) { 1592e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo list_del(&p->list); 1602e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo kmem_cache_free(rm_cache, p); 1612e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo } 1622e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo 1632e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo kfree(rmc); 164472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg sdata->u.mesh.rmc = NULL; 1652e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo} 1662e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo 1672e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo/** 1682e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo * mesh_rmc_check - Check frame in recent multicast cache and add if absent. 1692e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo * 1702e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo * @sa: source address 1712e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo * @mesh_hdr: mesh_header 1722e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo * 1732e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo * Returns: 0 if the frame is not in the cache, nonzero otherwise. 1742e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo * 1752e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo * Checks using the source address and the mesh sequence number if we have 1762e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo * received this frame lately. If the frame is not in the cache, it is added to 1772e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo * it. 1782e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo */ 1792e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Coboint mesh_rmc_check(u8 *sa, struct ieee80211s_hdr *mesh_hdr, 180f698d856f65c3fea091cc303a135967965c5b880Jasper Bryant-Greene struct ieee80211_sub_if_data *sdata) 1812e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo{ 182472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg struct mesh_rmc *rmc = sdata->u.mesh.rmc; 1832e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo u32 seqnum = 0; 1842e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo int entries = 0; 1852e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo u8 idx; 1862e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo struct rmc_entry *p, *n; 1872e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo 1882e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo /* Don't care about endianness since only match matters */ 18951ceddade0fb1e15f080b2555f3b3e1d68c6707eLuis Carlos Cobo memcpy(&seqnum, &mesh_hdr->seqnum, sizeof(mesh_hdr->seqnum)); 19051ceddade0fb1e15f080b2555f3b3e1d68c6707eLuis Carlos Cobo idx = le32_to_cpu(mesh_hdr->seqnum) & rmc->idx_mask; 1912e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo list_for_each_entry_safe(p, n, &rmc->bucket[idx].list, list) { 1922e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo ++entries; 1932e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo if (time_after(jiffies, p->exp_time) || 1942e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo (entries == RMC_QUEUE_MAX_LEN)) { 1952e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo list_del(&p->list); 1962e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo kmem_cache_free(rm_cache, p); 1972e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo --entries; 198f64f9e719261a87818dd192a3a2352e5b20fbd0fJoe Perches } else if ((seqnum == p->seqnum) && 199f64f9e719261a87818dd192a3a2352e5b20fbd0fJoe Perches (memcmp(sa, p->sa, ETH_ALEN) == 0)) 2002e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo return -1; 2012e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo } 2022e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo 2032e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo p = kmem_cache_alloc(rm_cache, GFP_ATOMIC); 2042e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo if (!p) { 2052e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo printk(KERN_DEBUG "o11s: could not allocate RMC entry\n"); 2062e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo return 0; 2072e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo } 2082e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo p->seqnum = seqnum; 2092e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo p->exp_time = jiffies + RMC_TIMEOUT; 2102e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo memcpy(p->sa, sa, ETH_ALEN); 2112e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo list_add(&p->list, &rmc->bucket[idx].list); 2122e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo return 0; 2132e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo} 2142e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo 215f698d856f65c3fea091cc303a135967965c5b880Jasper Bryant-Greenevoid mesh_mgmt_ies_add(struct sk_buff *skb, struct ieee80211_sub_if_data *sdata) 2162e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo{ 217f698d856f65c3fea091cc303a135967965c5b880Jasper Bryant-Greene struct ieee80211_local *local = sdata->local; 2182e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo struct ieee80211_supported_band *sband; 2192e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo u8 *pos; 2202e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo int len, i, rate; 2218f2fda9594f083981ad54c1994863875fe680925Rui Paulo u8 neighbors; 2222e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo 2232e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo sband = local->hw.wiphy->bands[local->hw.conf.channel->band]; 2242e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo len = sband->n_bitrates; 2252e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo if (len > 8) 2262e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo len = 8; 2272e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo pos = skb_put(skb, len + 2); 2282e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo *pos++ = WLAN_EID_SUPP_RATES; 2292e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo *pos++ = len; 2302e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo for (i = 0; i < len; i++) { 2312e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo rate = sband->bitrates[i].bitrate; 2322e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo *pos++ = (u8) (rate / 5); 2332e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo } 2342e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo 2352e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo if (sband->n_bitrates > len) { 2362e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo pos = skb_put(skb, sband->n_bitrates - len + 2); 2372e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo *pos++ = WLAN_EID_EXT_SUPP_RATES; 2382e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo *pos++ = sband->n_bitrates - len; 2392e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo for (i = len; i < sband->n_bitrates; i++) { 2402e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo rate = sband->bitrates[i].bitrate; 2412e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo *pos++ = (u8) (rate / 5); 2422e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo } 2432e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo } 2442e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo 245be125c60e46e165fbfe33db36a4a9d943d560a5bRui Paulo if (sband->band == IEEE80211_BAND_2GHZ) { 246be125c60e46e165fbfe33db36a4a9d943d560a5bRui Paulo pos = skb_put(skb, 2 + 1); 247be125c60e46e165fbfe33db36a4a9d943d560a5bRui Paulo *pos++ = WLAN_EID_DS_PARAMS; 248be125c60e46e165fbfe33db36a4a9d943d560a5bRui Paulo *pos++ = 1; 249be125c60e46e165fbfe33db36a4a9d943d560a5bRui Paulo *pos++ = ieee80211_frequency_to_channel(local->hw.conf.channel->center_freq); 250be125c60e46e165fbfe33db36a4a9d943d560a5bRui Paulo } 251be125c60e46e165fbfe33db36a4a9d943d560a5bRui Paulo 252472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg pos = skb_put(skb, 2 + sdata->u.mesh.mesh_id_len); 2532e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo *pos++ = WLAN_EID_MESH_ID; 254472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg *pos++ = sdata->u.mesh.mesh_id_len; 255472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg if (sdata->u.mesh.mesh_id_len) 256472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg memcpy(pos, sdata->u.mesh.mesh_id, sdata->u.mesh.mesh_id_len); 2572e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo 258136cfa28615ccce0f9374811480e0b81c4191ea5Rui Paulo pos = skb_put(skb, 2 + sizeof(struct ieee80211_meshconf_ie)); 2592e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo *pos++ = WLAN_EID_MESH_CONFIG; 260136cfa28615ccce0f9374811480e0b81c4191ea5Rui Paulo *pos++ = sizeof(struct ieee80211_meshconf_ie); 2612e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo 2622e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo /* Active path selection protocol ID */ 2633491707a070c1183c709516b2f876f798c7a9a84Rui Paulo *pos++ = sdata->u.mesh.mesh_pp_id; 2642e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo 2652e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo /* Active path selection metric ID */ 2663491707a070c1183c709516b2f876f798c7a9a84Rui Paulo *pos++ = sdata->u.mesh.mesh_pm_id; 2672e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo 2682e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo /* Congestion control mode identifier */ 2693491707a070c1183c709516b2f876f798c7a9a84Rui Paulo *pos++ = sdata->u.mesh.mesh_cc_id; 2702e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo 2719e03fdfd05e733e1136d431973625b174029c5e6Javier Cardona /* Synchronization protocol identifier */ 2723491707a070c1183c709516b2f876f798c7a9a84Rui Paulo *pos++ = sdata->u.mesh.mesh_sp_id; 2732e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo 2749e03fdfd05e733e1136d431973625b174029c5e6Javier Cardona /* Authentication Protocol identifier */ 2753491707a070c1183c709516b2f876f798c7a9a84Rui Paulo *pos++ = sdata->u.mesh.mesh_auth_id; 2769e03fdfd05e733e1136d431973625b174029c5e6Javier Cardona 2778f2fda9594f083981ad54c1994863875fe680925Rui Paulo /* Mesh Formation Info - number of neighbors */ 2788f2fda9594f083981ad54c1994863875fe680925Rui Paulo neighbors = atomic_read(&sdata->u.mesh.mshstats.estab_plinks); 2798f2fda9594f083981ad54c1994863875fe680925Rui Paulo /* Number of neighbor mesh STAs or 15 whichever is smaller */ 2808f2fda9594f083981ad54c1994863875fe680925Rui Paulo neighbors = (neighbors > 15) ? 15 : neighbors; 2818f2fda9594f083981ad54c1994863875fe680925Rui Paulo *pos++ = neighbors << 1; 2829e03fdfd05e733e1136d431973625b174029c5e6Javier Cardona 2832e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo /* Mesh capability */ 284472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg sdata->u.mesh.accepting_plinks = mesh_plink_availables(sdata); 2853491707a070c1183c709516b2f876f798c7a9a84Rui Paulo *pos = MESHCONF_CAPAB_FORWARDING; 2863491707a070c1183c709516b2f876f798c7a9a84Rui Paulo *pos++ |= sdata->u.mesh.accepting_plinks ? 2873491707a070c1183c709516b2f876f798c7a9a84Rui Paulo MESHCONF_CAPAB_ACCEPT_PLINKS : 0x00; 2882e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo *pos++ = 0x00; 2892e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo 2902e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo return; 2912e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo} 2922e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo 293f698d856f65c3fea091cc303a135967965c5b880Jasper Bryant-Greeneu32 mesh_table_hash(u8 *addr, struct ieee80211_sub_if_data *sdata, struct mesh_table *tbl) 2942e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo{ 2952e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo /* Use last four bytes of hw addr and interface index as hash index */ 296f698d856f65c3fea091cc303a135967965c5b880Jasper Bryant-Greene return jhash_2words(*(u32 *)(addr+2), sdata->dev->ifindex, tbl->hash_rnd) 2972e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo & tbl->hash_mask; 2982e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo} 2992e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo 3002e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobostruct mesh_table *mesh_table_alloc(int size_order) 3012e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo{ 3022e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo int i; 3032e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo struct mesh_table *newtbl; 3042e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo 3052e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo newtbl = kmalloc(sizeof(struct mesh_table), GFP_KERNEL); 3062e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo if (!newtbl) 3072e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo return NULL; 3082e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo 3092e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo newtbl->hash_buckets = kzalloc(sizeof(struct hlist_head) * 3102e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo (1 << size_order), GFP_KERNEL); 3112e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo 3122e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo if (!newtbl->hash_buckets) { 3132e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo kfree(newtbl); 3142e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo return NULL; 3152e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo } 3162e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo 3172e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo newtbl->hashwlock = kmalloc(sizeof(spinlock_t) * 3182e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo (1 << size_order), GFP_KERNEL); 3192e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo if (!newtbl->hashwlock) { 3202e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo kfree(newtbl->hash_buckets); 3212e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo kfree(newtbl); 3222e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo return NULL; 3232e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo } 3242e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo 3252e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo newtbl->size_order = size_order; 3262e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo newtbl->hash_mask = (1 << size_order) - 1; 3272e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo atomic_set(&newtbl->entries, 0); 3282e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo get_random_bytes(&newtbl->hash_rnd, 3292e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo sizeof(newtbl->hash_rnd)); 3302e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo for (i = 0; i <= newtbl->hash_mask; i++) 3312e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo spin_lock_init(&newtbl->hashwlock[i]); 3322e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo 3332e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo return newtbl; 3342e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo} 3352e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo 3362e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo 3372e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobostatic void ieee80211_mesh_path_timer(unsigned long data) 3382e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo{ 3392e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo struct ieee80211_sub_if_data *sdata = 3402e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo (struct ieee80211_sub_if_data *) data; 341472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; 342133b822638ff01eb1e32e1917b197c40ed095dddJohannes Berg struct ieee80211_local *local = sdata->local; 3432e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo 3445bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg if (local->quiescing) { 3455bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg set_bit(TMR_RUNNING_MP, &ifmsh->timers_running); 3465bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg return; 3475bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg } 3485bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg 349c03e20fc9a6ec5741d9df561130ecba38ef50eb6Luis R. Rodriguez ieee80211_queue_work(&local->hw, &ifmsh->work); 3502e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo} 3512e3c8736820bf72a8ad10721c7e31d36d4fa7790Luis Carlos Cobo 352e304bfd30f356f7b75d30cad0029ecca705fd590Rui Paulostatic void ieee80211_mesh_path_root_timer(unsigned long data) 353e304bfd30f356f7b75d30cad0029ecca705fd590Rui Paulo{ 354e304bfd30f356f7b75d30cad0029ecca705fd590Rui Paulo struct ieee80211_sub_if_data *sdata = 355e304bfd30f356f7b75d30cad0029ecca705fd590Rui Paulo (struct ieee80211_sub_if_data *) data; 356e304bfd30f356f7b75d30cad0029ecca705fd590Rui Paulo struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; 357e304bfd30f356f7b75d30cad0029ecca705fd590Rui Paulo struct ieee80211_local *local = sdata->local; 358e304bfd30f356f7b75d30cad0029ecca705fd590Rui Paulo 359e304bfd30f356f7b75d30cad0029ecca705fd590Rui Paulo set_bit(MESH_WORK_ROOT, &ifmsh->wrkq_flags); 360e304bfd30f356f7b75d30cad0029ecca705fd590Rui Paulo 361e304bfd30f356f7b75d30cad0029ecca705fd590Rui Paulo if (local->quiescing) { 362e304bfd30f356f7b75d30cad0029ecca705fd590Rui Paulo set_bit(TMR_RUNNING_MPR, &ifmsh->timers_running); 363e304bfd30f356f7b75d30cad0029ecca705fd590Rui Paulo return; 364e304bfd30f356f7b75d30cad0029ecca705fd590Rui Paulo } 365e304bfd30f356f7b75d30cad0029ecca705fd590Rui Paulo 366e304bfd30f356f7b75d30cad0029ecca705fd590Rui Paulo ieee80211_queue_work(&local->hw, &ifmsh->work); 367e304bfd30f356f7b75d30cad0029ecca705fd590Rui Paulo} 368e304bfd30f356f7b75d30cad0029ecca705fd590Rui Paulo 36963c5723bc3af8d4e86984dd4ff0c78218de418d0Rui Paulovoid ieee80211_mesh_root_setup(struct ieee80211_if_mesh *ifmsh) 37063c5723bc3af8d4e86984dd4ff0c78218de418d0Rui Paulo{ 37163c5723bc3af8d4e86984dd4ff0c78218de418d0Rui Paulo if (ifmsh->mshcfg.dot11MeshHWMPRootMode) 37263c5723bc3af8d4e86984dd4ff0c78218de418d0Rui Paulo set_bit(MESH_WORK_ROOT, &ifmsh->wrkq_flags); 37363c5723bc3af8d4e86984dd4ff0c78218de418d0Rui Paulo else { 37463c5723bc3af8d4e86984dd4ff0c78218de418d0Rui Paulo clear_bit(MESH_WORK_ROOT, &ifmsh->wrkq_flags); 37563c5723bc3af8d4e86984dd4ff0c78218de418d0Rui Paulo /* stop running timer */ 37663c5723bc3af8d4e86984dd4ff0c78218de418d0Rui Paulo del_timer_sync(&ifmsh->mesh_path_root_timer); 37763c5723bc3af8d4e86984dd4ff0c78218de418d0Rui Paulo } 37863c5723bc3af8d4e86984dd4ff0c78218de418d0Rui Paulo} 37963c5723bc3af8d4e86984dd4ff0c78218de418d0Rui Paulo 380902acc7896d7649fb30e4b22bd4e643c7f34b02cJohannes Berg/** 3813c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona * ieee80211_fill_mesh_addresses - fill addresses of a locally originated mesh frame 3823c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona * @hdr: 802.11 frame header 3833c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona * @fc: frame control field 3843c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona * @meshda: destination address in the mesh 3853c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona * @meshsa: source address address in the mesh. Same as TA, as frame is 3863c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona * locally originated. 3873c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona * 3883c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona * Return the length of the 802.11 (does not include a mesh control header) 3893c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona */ 39015ff63653e507ec928a4a4386405a82446e096b1Johannes Bergint ieee80211_fill_mesh_addresses(struct ieee80211_hdr *hdr, __le16 *fc, 39115ff63653e507ec928a4a4386405a82446e096b1Johannes Berg const u8 *meshda, const u8 *meshsa) 39215ff63653e507ec928a4a4386405a82446e096b1Johannes Berg{ 3933c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona if (is_multicast_ether_addr(meshda)) { 3943c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona *fc |= cpu_to_le16(IEEE80211_FCTL_FROMDS); 3953c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona /* DA TA SA */ 3963c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona memcpy(hdr->addr1, meshda, ETH_ALEN); 3973c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona memcpy(hdr->addr2, meshsa, ETH_ALEN); 3983c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona memcpy(hdr->addr3, meshsa, ETH_ALEN); 3993c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona return 24; 4003c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona } else { 4013c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona *fc |= cpu_to_le16(IEEE80211_FCTL_FROMDS | 4023c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona IEEE80211_FCTL_TODS); 4033c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona /* RA TA DA SA */ 4043c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona memset(hdr->addr1, 0, ETH_ALEN); /* RA is resolved later */ 4053c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona memcpy(hdr->addr2, meshsa, ETH_ALEN); 4063c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona memcpy(hdr->addr3, meshda, ETH_ALEN); 4073c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona memcpy(hdr->addr4, meshsa, ETH_ALEN); 4083c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona return 30; 4093c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona } 4103c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona} 4113c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona 4123c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona/** 413902acc7896d7649fb30e4b22bd4e643c7f34b02cJohannes Berg * ieee80211_new_mesh_header - create a new mesh header 414902acc7896d7649fb30e4b22bd4e643c7f34b02cJohannes Berg * @meshhdr: uninitialized mesh header 415902acc7896d7649fb30e4b22bd4e643c7f34b02cJohannes Berg * @sdata: mesh interface to be used 4163c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona * @addr4: addr4 of the mesh frame (1st in ae header) 4173c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona * may be NULL 4183c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona * @addr5: addr5 of the mesh frame (1st or 2nd in ae header) 4193c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona * may be NULL unless addr6 is present 4203c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona * @addr6: addr6 of the mesh frame (2nd or 3rd in ae header) 4213c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona * may be NULL unless addr5 is present 422902acc7896d7649fb30e4b22bd4e643c7f34b02cJohannes Berg * 423902acc7896d7649fb30e4b22bd4e643c7f34b02cJohannes Berg * Return the header length. 424902acc7896d7649fb30e4b22bd4e643c7f34b02cJohannes Berg */ 425902acc7896d7649fb30e4b22bd4e643c7f34b02cJohannes Bergint ieee80211_new_mesh_header(struct ieee80211s_hdr *meshhdr, 4263c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona struct ieee80211_sub_if_data *sdata, char *addr4, 4273c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona char *addr5, char *addr6) 428902acc7896d7649fb30e4b22bd4e643c7f34b02cJohannes Berg{ 4293c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona int aelen = 0; 4300c3cee72a403e3b4992a5478c9c33d668c246c22Julia Lawall memset(meshhdr, 0, sizeof(*meshhdr)); 431472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg meshhdr->ttl = sdata->u.mesh.mshcfg.dot11MeshTTL; 432472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg put_unaligned(cpu_to_le32(sdata->u.mesh.mesh_seqnum), &meshhdr->seqnum); 433472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg sdata->u.mesh.mesh_seqnum++; 4343c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona if (addr4) { 4353c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona meshhdr->flags |= MESH_FLAGS_AE_A4; 4363c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona aelen += ETH_ALEN; 4373c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona memcpy(meshhdr->eaddr1, addr4, ETH_ALEN); 4383c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona } 4393c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona if (addr5 && addr6) { 4403c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona meshhdr->flags |= MESH_FLAGS_AE_A5_A6; 4413c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona aelen += 2 * ETH_ALEN; 4423c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona if (!addr4) { 4433c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona memcpy(meshhdr->eaddr1, addr5, ETH_ALEN); 4443c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona memcpy(meshhdr->eaddr2, addr6, ETH_ALEN); 4453c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona } else { 4463c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona memcpy(meshhdr->eaddr2, addr5, ETH_ALEN); 4473c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona memcpy(meshhdr->eaddr3, addr6, ETH_ALEN); 4483c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona } 4493c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona } 4503c5772a5279de9eadfff7adb5ddea08106495fffJavier Cardona return 6 + aelen; 451902acc7896d7649fb30e4b22bd4e643c7f34b02cJohannes Berg} 452902acc7896d7649fb30e4b22bd4e643c7f34b02cJohannes Berg 453472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Bergstatic void ieee80211_mesh_housekeeping(struct ieee80211_sub_if_data *sdata, 454472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg struct ieee80211_if_mesh *ifmsh) 455472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg{ 456472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg bool free_plinks; 457472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg 458472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg#ifdef CONFIG_MAC80211_VERBOSE_DEBUG 459472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg printk(KERN_DEBUG "%s: running mesh housekeeping\n", 46047846c9b0c10808d9337d2e7d09361f3e0a0a71aJohannes Berg sdata->name); 461472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg#endif 462472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg 463472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg ieee80211_sta_expire(sdata, IEEE80211_MESH_PEER_INACTIVITY_LIMIT); 464472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg mesh_path_expire(sdata); 465472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg 466472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg free_plinks = mesh_plink_availables(sdata); 467472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg if (free_plinks != sdata->u.mesh.accepting_plinks) 4682d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_BEACON); 469472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg 470472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg mod_timer(&ifmsh->housekeeping_timer, 471472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg round_jiffies(jiffies + IEEE80211_MESH_HOUSEKEEPING_INTERVAL)); 472472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg} 473472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg 474e304bfd30f356f7b75d30cad0029ecca705fd590Rui Paulostatic void ieee80211_mesh_rootpath(struct ieee80211_sub_if_data *sdata) 475e304bfd30f356f7b75d30cad0029ecca705fd590Rui Paulo{ 476e304bfd30f356f7b75d30cad0029ecca705fd590Rui Paulo struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; 477e304bfd30f356f7b75d30cad0029ecca705fd590Rui Paulo 478e304bfd30f356f7b75d30cad0029ecca705fd590Rui Paulo mesh_path_tx_root_frame(sdata); 479e304bfd30f356f7b75d30cad0029ecca705fd590Rui Paulo mod_timer(&ifmsh->mesh_path_root_timer, 480e304bfd30f356f7b75d30cad0029ecca705fd590Rui Paulo round_jiffies(jiffies + IEEE80211_MESH_RANN_INTERVAL)); 481e304bfd30f356f7b75d30cad0029ecca705fd590Rui Paulo} 482e304bfd30f356f7b75d30cad0029ecca705fd590Rui Paulo 4835bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg#ifdef CONFIG_PM 4845bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Bergvoid ieee80211_mesh_quiesce(struct ieee80211_sub_if_data *sdata) 4855bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg{ 4865bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; 4875bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg 4885bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg /* might restart the timer but that doesn't matter */ 4895bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg cancel_work_sync(&ifmsh->work); 4905bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg 4915bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg /* use atomic bitops in case both timers fire at the same time */ 4925bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg 4935bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg if (del_timer_sync(&ifmsh->housekeeping_timer)) 4945bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg set_bit(TMR_RUNNING_HK, &ifmsh->timers_running); 4955bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg if (del_timer_sync(&ifmsh->mesh_path_timer)) 4965bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg set_bit(TMR_RUNNING_MP, &ifmsh->timers_running); 497e304bfd30f356f7b75d30cad0029ecca705fd590Rui Paulo if (del_timer_sync(&ifmsh->mesh_path_root_timer)) 498e304bfd30f356f7b75d30cad0029ecca705fd590Rui Paulo set_bit(TMR_RUNNING_MPR, &ifmsh->timers_running); 4995bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg} 5005bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg 5015bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Bergvoid ieee80211_mesh_restart(struct ieee80211_sub_if_data *sdata) 5025bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg{ 5035bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; 5045bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg 5055bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg if (test_and_clear_bit(TMR_RUNNING_HK, &ifmsh->timers_running)) 5065bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg add_timer(&ifmsh->housekeeping_timer); 5075bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg if (test_and_clear_bit(TMR_RUNNING_MP, &ifmsh->timers_running)) 5085bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg add_timer(&ifmsh->mesh_path_timer); 509e304bfd30f356f7b75d30cad0029ecca705fd590Rui Paulo if (test_and_clear_bit(TMR_RUNNING_MPR, &ifmsh->timers_running)) 510e304bfd30f356f7b75d30cad0029ecca705fd590Rui Paulo add_timer(&ifmsh->mesh_path_root_timer); 51163c5723bc3af8d4e86984dd4ff0c78218de418d0Rui Paulo ieee80211_mesh_root_setup(ifmsh); 5125bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg} 5135bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg#endif 514472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg 515472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Bergvoid ieee80211_start_mesh(struct ieee80211_sub_if_data *sdata) 516472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg{ 517472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; 518472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg struct ieee80211_local *local = sdata->local; 519472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg 5206b9ac4425d6ec871faf54540e0f1c5ff420a8f29Rui Paulo set_bit(MESH_WORK_HOUSEKEEPING, &ifmsh->wrkq_flags); 52163c5723bc3af8d4e86984dd4ff0c78218de418d0Rui Paulo ieee80211_mesh_root_setup(ifmsh); 52218889231e4527dfe23145efe318e74744794a95dJavier Cardona ieee80211_queue_work(&local->hw, &ifmsh->work); 5235b365834255d7c90fc724b032c814dfa297aacf9Javier Cardona sdata->vif.bss_conf.beacon_int = MESH_DEFAULT_BEACON_INTERVAL; 5242d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_BEACON | 5255b365834255d7c90fc724b032c814dfa297aacf9Javier Cardona BSS_CHANGED_BEACON_ENABLED | 5265b365834255d7c90fc724b032c814dfa297aacf9Javier Cardona BSS_CHANGED_BEACON_INT); 527472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg} 528472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg 529472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Bergvoid ieee80211_stop_mesh(struct ieee80211_sub_if_data *sdata) 530472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg{ 531472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg del_timer_sync(&sdata->u.mesh.housekeeping_timer); 532e304bfd30f356f7b75d30cad0029ecca705fd590Rui Paulo del_timer_sync(&sdata->u.mesh.mesh_path_root_timer); 533472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg /* 534b7413430d4d2a6168e68231d9f93763047b6d60cJohannes Berg * If the timer fired while we waited for it, it will have 535b7413430d4d2a6168e68231d9f93763047b6d60cJohannes Berg * requeued the work. Now the work will be running again 536b7413430d4d2a6168e68231d9f93763047b6d60cJohannes Berg * but will not rearm the timer again because it checks 537b7413430d4d2a6168e68231d9f93763047b6d60cJohannes Berg * whether the interface is running, which, at this point, 538b7413430d4d2a6168e68231d9f93763047b6d60cJohannes Berg * it no longer is. 539b7413430d4d2a6168e68231d9f93763047b6d60cJohannes Berg */ 540b7413430d4d2a6168e68231d9f93763047b6d60cJohannes Berg cancel_work_sync(&sdata->u.mesh.work); 541b7413430d4d2a6168e68231d9f93763047b6d60cJohannes Berg 542b7413430d4d2a6168e68231d9f93763047b6d60cJohannes Berg /* 543472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg * When we get here, the interface is marked down. 544472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg * Call synchronize_rcu() to wait for the RX path 545472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg * should it be using the interface and enqueuing 546472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg * frames at this very time on another CPU. 547472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg */ 5484a27096bbe2cad4c6e78802a0d9dfe0e598a1129Jesper Dangaard Brouer rcu_barrier(); /* Wait for RX path and call_rcu()'s */ 549472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg skb_queue_purge(&sdata->u.mesh.skb_queue); 550472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg} 551472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg 552472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Bergstatic void ieee80211_mesh_rx_bcn_presp(struct ieee80211_sub_if_data *sdata, 553472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg u16 stype, 554472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg struct ieee80211_mgmt *mgmt, 555472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg size_t len, 556472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg struct ieee80211_rx_status *rx_status) 557472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg{ 558c6a1fa12d206882757264869f8e32d606b930e2aJohannes Berg struct ieee80211_local *local = sdata->local; 559472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg struct ieee802_11_elems elems; 560472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg struct ieee80211_channel *channel; 561881d948c23442173a011f1adcfe4c95bf7f27515Johannes Berg u32 supp_rates = 0; 562472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg size_t baselen; 563472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg int freq; 564472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg enum ieee80211_band band = rx_status->band; 565472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg 566472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg /* ignore ProbeResp to foreign address */ 567472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg if (stype == IEEE80211_STYPE_PROBE_RESP && 56847846c9b0c10808d9337d2e7d09361f3e0a0a71aJohannes Berg compare_ether_addr(mgmt->da, sdata->vif.addr)) 569472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg return; 570472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg 571472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg baselen = (u8 *) mgmt->u.probe_resp.variable - (u8 *) mgmt; 572472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg if (baselen > len) 573472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg return; 574472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg 575472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg ieee802_11_parse_elems(mgmt->u.probe_resp.variable, len - baselen, 576472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg &elems); 577472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg 578472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg if (elems.ds_params && elems.ds_params_len == 1) 579472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg freq = ieee80211_channel_to_frequency(elems.ds_params[0]); 580472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg else 581472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg freq = rx_status->freq; 582472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg 583472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg channel = ieee80211_get_channel(local->hw.wiphy, freq); 584472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg 585472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg if (!channel || channel->flags & IEEE80211_CHAN_DISABLED) 586472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg return; 587472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg 588472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg if (elems.mesh_id && elems.mesh_config && 589472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg mesh_matches_local(&elems, sdata)) { 590472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg supp_rates = ieee80211_sta_get_rates(local, &elems, band); 591472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg 592472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg mesh_neighbour_update(mgmt->sa, supp_rates, sdata, 593472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg mesh_peer_accepts_plinks(&elems)); 594472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg } 595472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg} 596472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg 597472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Bergstatic void ieee80211_mesh_rx_mgmt_action(struct ieee80211_sub_if_data *sdata, 598472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg struct ieee80211_mgmt *mgmt, 599472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg size_t len, 600472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg struct ieee80211_rx_status *rx_status) 601472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg{ 602472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg switch (mgmt->u.action.category) { 60397ad9139fd68b5c71f44d28d3f9788d89cfd4916Javier Cardona case WLAN_CATEGORY_MESH_PLINK: 604472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg mesh_rx_plink_frame(sdata, mgmt, len, rx_status); 605472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg break; 60697ad9139fd68b5c71f44d28d3f9788d89cfd4916Javier Cardona case WLAN_CATEGORY_MESH_PATH_SEL: 607472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg mesh_rx_path_sel_frame(sdata, mgmt, len); 608472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg break; 609472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg } 610472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg} 611472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg 612472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Bergstatic void ieee80211_mesh_rx_queued_mgmt(struct ieee80211_sub_if_data *sdata, 613472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg struct sk_buff *skb) 614472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg{ 615472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg struct ieee80211_rx_status *rx_status; 616472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg struct ieee80211_if_mesh *ifmsh; 617472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg struct ieee80211_mgmt *mgmt; 618472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg u16 stype; 619472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg 620472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg ifmsh = &sdata->u.mesh; 621472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg 622f1d58c2521eb160178b2151d6326d8dc5d7c8560Johannes Berg rx_status = IEEE80211_SKB_RXCB(skb); 623472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg mgmt = (struct ieee80211_mgmt *) skb->data; 624472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg stype = le16_to_cpu(mgmt->frame_control) & IEEE80211_FCTL_STYPE; 625472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg 626472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg switch (stype) { 627472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg case IEEE80211_STYPE_PROBE_RESP: 628472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg case IEEE80211_STYPE_BEACON: 629472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg ieee80211_mesh_rx_bcn_presp(sdata, stype, mgmt, skb->len, 630472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg rx_status); 631472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg break; 632472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg case IEEE80211_STYPE_ACTION: 633472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg ieee80211_mesh_rx_mgmt_action(sdata, mgmt, skb->len, rx_status); 634472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg break; 635472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg } 636472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg 637472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg kfree_skb(skb); 638472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg} 639472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg 640472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Bergstatic void ieee80211_mesh_work(struct work_struct *work) 641472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg{ 642472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg struct ieee80211_sub_if_data *sdata = 643472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg container_of(work, struct ieee80211_sub_if_data, u.mesh.work); 644472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg struct ieee80211_local *local = sdata->local; 645472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; 646472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg struct sk_buff *skb; 647472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg 6489607e6b66a0d25ca63b70d54a4283fa13d8f7c9dJohannes Berg if (!ieee80211_sdata_running(sdata)) 649472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg return; 650472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg 651fbe9c429f195111bbf7f1630efa19aee295fd8e7Helmut Schaa if (local->scanning) 652472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg return; 653472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg 654472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg while ((skb = skb_dequeue(&ifmsh->skb_queue))) 655472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg ieee80211_mesh_rx_queued_mgmt(sdata, skb); 656472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg 657472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg if (ifmsh->preq_queue_len && 658472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg time_after(jiffies, 659472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg ifmsh->last_preq + msecs_to_jiffies(ifmsh->mshcfg.dot11MeshHWMPpreqMinInterval))) 660472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg mesh_path_start_discovery(sdata); 661472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg 66218889231e4527dfe23145efe318e74744794a95dJavier Cardona if (test_and_clear_bit(MESH_WORK_GROW_MPATH_TABLE, &ifmsh->wrkq_flags)) 66318889231e4527dfe23145efe318e74744794a95dJavier Cardona mesh_mpath_table_grow(); 66418889231e4527dfe23145efe318e74744794a95dJavier Cardona 66518889231e4527dfe23145efe318e74744794a95dJavier Cardona if (test_and_clear_bit(MESH_WORK_GROW_MPATH_TABLE, &ifmsh->wrkq_flags)) 66618889231e4527dfe23145efe318e74744794a95dJavier Cardona mesh_mpp_table_grow(); 66718889231e4527dfe23145efe318e74744794a95dJavier Cardona 66818889231e4527dfe23145efe318e74744794a95dJavier Cardona if (test_and_clear_bit(MESH_WORK_HOUSEKEEPING, &ifmsh->wrkq_flags)) 669472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg ieee80211_mesh_housekeeping(sdata, ifmsh); 670e304bfd30f356f7b75d30cad0029ecca705fd590Rui Paulo 671e304bfd30f356f7b75d30cad0029ecca705fd590Rui Paulo if (test_and_clear_bit(MESH_WORK_ROOT, &ifmsh->wrkq_flags)) 672e304bfd30f356f7b75d30cad0029ecca705fd590Rui Paulo ieee80211_mesh_rootpath(sdata); 673472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg} 674472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg 675472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Bergvoid ieee80211_mesh_notify_scan_completed(struct ieee80211_local *local) 676472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg{ 677472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg struct ieee80211_sub_if_data *sdata; 678472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg 679472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg rcu_read_lock(); 680472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg list_for_each_entry_rcu(sdata, &local->interfaces, list) 681472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg if (ieee80211_vif_is_mesh(&sdata->vif)) 682c03e20fc9a6ec5741d9df561130ecba38ef50eb6Luis R. Rodriguez ieee80211_queue_work(&local->hw, &sdata->u.mesh.work); 683472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg rcu_read_unlock(); 684472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg} 685472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg 686902acc7896d7649fb30e4b22bd4e643c7f34b02cJohannes Bergvoid ieee80211_mesh_init_sdata(struct ieee80211_sub_if_data *sdata) 687902acc7896d7649fb30e4b22bd4e643c7f34b02cJohannes Berg{ 688472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; 689472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg 690472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg INIT_WORK(&ifmsh->work, ieee80211_mesh_work); 691472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg setup_timer(&ifmsh->housekeeping_timer, 692472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg ieee80211_mesh_housekeeping_timer, 693472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg (unsigned long) sdata); 694472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg skb_queue_head_init(&sdata->u.mesh.skb_queue); 695472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg 696472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg ifmsh->mshcfg.dot11MeshRetryTimeout = MESH_RET_T; 697472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg ifmsh->mshcfg.dot11MeshConfirmTimeout = MESH_CONF_T; 698472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg ifmsh->mshcfg.dot11MeshHoldingTimeout = MESH_HOLD_T; 699472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg ifmsh->mshcfg.dot11MeshMaxRetries = MESH_MAX_RETR; 700472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg ifmsh->mshcfg.dot11MeshTTL = MESH_TTL; 701472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg ifmsh->mshcfg.auto_open_plinks = true; 702472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg ifmsh->mshcfg.dot11MeshMaxPeerLinks = 703902acc7896d7649fb30e4b22bd4e643c7f34b02cJohannes Berg MESH_MAX_ESTAB_PLINKS; 704472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg ifmsh->mshcfg.dot11MeshHWMPactivePathTimeout = 705902acc7896d7649fb30e4b22bd4e643c7f34b02cJohannes Berg MESH_PATH_TIMEOUT; 706472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg ifmsh->mshcfg.dot11MeshHWMPpreqMinInterval = 707902acc7896d7649fb30e4b22bd4e643c7f34b02cJohannes Berg MESH_PREQ_MIN_INT; 708472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg ifmsh->mshcfg.dot11MeshHWMPnetDiameterTraversalTime = 709902acc7896d7649fb30e4b22bd4e643c7f34b02cJohannes Berg MESH_DIAM_TRAVERSAL_TIME; 710472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg ifmsh->mshcfg.dot11MeshHWMPmaxPREQretries = 711902acc7896d7649fb30e4b22bd4e643c7f34b02cJohannes Berg MESH_MAX_PREQ_RETRIES; 712472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg ifmsh->mshcfg.path_refresh_time = 713902acc7896d7649fb30e4b22bd4e643c7f34b02cJohannes Berg MESH_PATH_REFRESH_TIME; 714472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg ifmsh->mshcfg.min_discovery_timeout = 715902acc7896d7649fb30e4b22bd4e643c7f34b02cJohannes Berg MESH_MIN_DISCOVERY_TIMEOUT; 716472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg ifmsh->accepting_plinks = true; 717472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg ifmsh->preq_id = 0; 718d19b3bf6384e66ac6e11a61ee31ed2cfe149f4d8Rui Paulo ifmsh->sn = 0; 719472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg atomic_set(&ifmsh->mpaths, 0); 720f698d856f65c3fea091cc303a135967965c5b880Jasper Bryant-Greene mesh_rmc_init(sdata); 721472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg ifmsh->last_preq = jiffies; 722902acc7896d7649fb30e4b22bd4e643c7f34b02cJohannes Berg /* Allocate all mesh structures when creating the first mesh interface. */ 723902acc7896d7649fb30e4b22bd4e643c7f34b02cJohannes Berg if (!mesh_allocated) 724902acc7896d7649fb30e4b22bd4e643c7f34b02cJohannes Berg ieee80211s_init(); 725472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg mesh_ids_set_default(ifmsh); 726472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg setup_timer(&ifmsh->mesh_path_timer, 727902acc7896d7649fb30e4b22bd4e643c7f34b02cJohannes Berg ieee80211_mesh_path_timer, 728902acc7896d7649fb30e4b22bd4e643c7f34b02cJohannes Berg (unsigned long) sdata); 729e304bfd30f356f7b75d30cad0029ecca705fd590Rui Paulo setup_timer(&ifmsh->mesh_path_root_timer, 730e304bfd30f356f7b75d30cad0029ecca705fd590Rui Paulo ieee80211_mesh_path_root_timer, 731e304bfd30f356f7b75d30cad0029ecca705fd590Rui Paulo (unsigned long) sdata); 732472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg INIT_LIST_HEAD(&ifmsh->preq_queue.list); 733472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg spin_lock_init(&ifmsh->mesh_preq_queue_lock); 734472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg} 735472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg 736472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Bergieee80211_rx_result 737f1d58c2521eb160178b2151d6326d8dc5d7c8560Johannes Bergieee80211_mesh_rx_mgmt(struct ieee80211_sub_if_data *sdata, struct sk_buff *skb) 738472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg{ 739472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg struct ieee80211_local *local = sdata->local; 740472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; 741472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg struct ieee80211_mgmt *mgmt; 742472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg u16 fc; 743472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg 744472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg if (skb->len < 24) 745472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg return RX_DROP_MONITOR; 746472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg 747472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg mgmt = (struct ieee80211_mgmt *) skb->data; 748472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg fc = le16_to_cpu(mgmt->frame_control); 749472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg 750472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg switch (fc & IEEE80211_FCTL_STYPE) { 751a43816df2a1a61effcb701037bdf63621d066182Johannes Berg case IEEE80211_STYPE_ACTION: 752472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg case IEEE80211_STYPE_PROBE_RESP: 753472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg case IEEE80211_STYPE_BEACON: 754472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg skb_queue_tail(&ifmsh->skb_queue, skb); 755c03e20fc9a6ec5741d9df561130ecba38ef50eb6Luis R. Rodriguez ieee80211_queue_work(&local->hw, &ifmsh->work); 756472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg return RX_QUEUED; 757472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg } 758472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg 759472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg return RX_CONTINUE; 760902acc7896d7649fb30e4b22bd4e643c7f34b02cJohannes Berg} 761