Luis Carlos Cobo | 2e3c873 | 2008-02-23 15:17:09 +0100 | [diff] [blame] | 1 | /* |
Rui Paulo | 264d9b7 | 2009-11-09 23:46:58 +0000 | [diff] [blame] | 2 | * Copyright (c) 2008, 2009 open80211s Ltd. |
Luis Carlos Cobo | 2e3c873 | 2008-02-23 15:17:09 +0100 | [diff] [blame] | 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 | |
Tejun Heo | 5a0e3ad | 2010-03-24 17:04:11 +0900 | [diff] [blame] | 11 | #include <linux/slab.h> |
Luis Carlos Cobo | 51cedda | 2008-04-23 12:15:29 -0700 | [diff] [blame] | 12 | #include <asm/unaligned.h> |
Luis Carlos Cobo | 2e3c873 | 2008-02-23 15:17:09 +0100 | [diff] [blame] | 13 | #include "ieee80211_i.h" |
| 14 | #include "mesh.h" |
Chun-Yeow Yeoh | b8456a1 | 2013-10-17 15:55:02 -0700 | [diff] [blame] | 15 | #include "driver-ops.h" |
Luis Carlos Cobo | 2e3c873 | 2008-02-23 15:17:09 +0100 | [diff] [blame] | 16 | |
Johannes Berg | bf7cd94 | 2013-02-15 14:40:31 +0100 | [diff] [blame] | 17 | static int mesh_allocated; |
Luis Carlos Cobo | 2e3c873 | 2008-02-23 15:17:09 +0100 | [diff] [blame] | 18 | static struct kmem_cache *rm_cache; |
| 19 | |
Thomas Pedersen | 25d49e4 | 2011-08-11 19:35:15 -0700 | [diff] [blame] | 20 | bool mesh_action_is_path_sel(struct ieee80211_mgmt *mgmt) |
| 21 | { |
| 22 | return (mgmt->u.action.u.mesh_action.action_code == |
| 23 | WLAN_MESH_ACTION_HWMP_PATH_SELECTION); |
| 24 | } |
Thomas Pedersen | 25d49e4 | 2011-08-11 19:35:15 -0700 | [diff] [blame] | 25 | |
Luis Carlos Cobo | 2e3c873 | 2008-02-23 15:17:09 +0100 | [diff] [blame] | 26 | void ieee80211s_init(void) |
| 27 | { |
| 28 | mesh_pathtbl_init(); |
| 29 | mesh_allocated = 1; |
| 30 | rm_cache = kmem_cache_create("mesh_rmc", sizeof(struct rmc_entry), |
| 31 | 0, 0, NULL); |
| 32 | } |
| 33 | |
| 34 | void ieee80211s_stop(void) |
| 35 | { |
Johannes Berg | bf7cd94 | 2013-02-15 14:40:31 +0100 | [diff] [blame] | 36 | if (!mesh_allocated) |
| 37 | return; |
Luis Carlos Cobo | 2e3c873 | 2008-02-23 15:17:09 +0100 | [diff] [blame] | 38 | mesh_pathtbl_unregister(); |
| 39 | kmem_cache_destroy(rm_cache); |
| 40 | } |
| 41 | |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 42 | static void ieee80211_mesh_housekeeping_timer(unsigned long data) |
| 43 | { |
| 44 | struct ieee80211_sub_if_data *sdata = (void *) data; |
| 45 | struct ieee80211_local *local = sdata->local; |
| 46 | struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; |
| 47 | |
Rui Paulo | 6b9ac44 | 2009-10-20 21:21:48 +0100 | [diff] [blame] | 48 | set_bit(MESH_WORK_HOUSEKEEPING, &ifmsh->wrkq_flags); |
Johannes Berg | 5bb644a | 2009-05-17 11:40:42 +0200 | [diff] [blame] | 49 | |
Johannes Berg | 64592c8 | 2010-06-10 10:21:31 +0200 | [diff] [blame] | 50 | ieee80211_queue_work(&local->hw, &sdata->work); |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 51 | } |
| 52 | |
Luis Carlos Cobo | 2e3c873 | 2008-02-23 15:17:09 +0100 | [diff] [blame] | 53 | /** |
| 54 | * mesh_matches_local - check if the config of a mesh point matches ours |
| 55 | * |
Jasper Bryant-Greene | f698d85 | 2008-08-03 12:04:37 +1200 | [diff] [blame] | 56 | * @sdata: local mesh subif |
Thomas Pedersen | f743ff4 | 2012-04-18 19:23:43 -0700 | [diff] [blame] | 57 | * @ie: information elements of a management frame from the mesh peer |
Luis Carlos Cobo | 2e3c873 | 2008-02-23 15:17:09 +0100 | [diff] [blame] | 58 | * |
| 59 | * This function checks if the mesh configuration of a mesh point matches the |
| 60 | * local mesh configuration, i.e. if both nodes belong to the same mesh network. |
| 61 | */ |
Thomas Pedersen | f743ff4 | 2012-04-18 19:23:43 -0700 | [diff] [blame] | 62 | bool mesh_matches_local(struct ieee80211_sub_if_data *sdata, |
| 63 | struct ieee802_11_elems *ie) |
Luis Carlos Cobo | 2e3c873 | 2008-02-23 15:17:09 +0100 | [diff] [blame] | 64 | { |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 65 | struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; |
Thomas Pedersen | f743ff4 | 2012-04-18 19:23:43 -0700 | [diff] [blame] | 66 | u32 basic_rates = 0; |
Johannes Berg | 4bf8853 | 2012-11-09 11:39:59 +0100 | [diff] [blame] | 67 | struct cfg80211_chan_def sta_chan_def; |
Luis Carlos Cobo | 2e3c873 | 2008-02-23 15:17:09 +0100 | [diff] [blame] | 68 | |
Luis Carlos Cobo | 2e3c873 | 2008-02-23 15:17:09 +0100 | [diff] [blame] | 69 | /* |
| 70 | * As support for each feature is added, check for matching |
| 71 | * - On mesh config capabilities |
| 72 | * - Power Save Support En |
| 73 | * - Sync support enabled |
| 74 | * - Sync support active |
| 75 | * - Sync support required from peer |
| 76 | * - MDA enabled |
| 77 | * - Power management control on fc |
| 78 | */ |
Thomas Pedersen | 739522b | 2011-10-26 14:47:28 -0700 | [diff] [blame] | 79 | if (!(ifmsh->mesh_id_len == ie->mesh_id_len && |
| 80 | memcmp(ifmsh->mesh_id, ie->mesh_id, ie->mesh_id_len) == 0 && |
| 81 | (ifmsh->mesh_pp_id == ie->mesh_config->meshconf_psel) && |
| 82 | (ifmsh->mesh_pm_id == ie->mesh_config->meshconf_pmetric) && |
| 83 | (ifmsh->mesh_cc_id == ie->mesh_config->meshconf_congest) && |
| 84 | (ifmsh->mesh_sp_id == ie->mesh_config->meshconf_synch) && |
| 85 | (ifmsh->mesh_auth_id == ie->mesh_config->meshconf_auth))) |
Johannes Berg | bf7cd94 | 2013-02-15 14:40:31 +0100 | [diff] [blame] | 86 | return false; |
Luis Carlos Cobo | 2e3c873 | 2008-02-23 15:17:09 +0100 | [diff] [blame] | 87 | |
Simon Wunderlich | 2103dec | 2013-07-08 16:55:53 +0200 | [diff] [blame] | 88 | ieee80211_sta_get_rates(sdata, ie, ieee80211_get_sdata_band(sdata), |
Thomas Pedersen | f743ff4 | 2012-04-18 19:23:43 -0700 | [diff] [blame] | 89 | &basic_rates); |
| 90 | |
Ashok Nagarajan | fe40cb6 | 2012-04-02 21:21:22 -0700 | [diff] [blame] | 91 | if (sdata->vif.bss_conf.basic_rates != basic_rates) |
Johannes Berg | bf7cd94 | 2013-02-15 14:40:31 +0100 | [diff] [blame] | 92 | return false; |
Ashok Nagarajan | fe40cb6 | 2012-04-02 21:21:22 -0700 | [diff] [blame] | 93 | |
Johannes Berg | 4bf8853 | 2012-11-09 11:39:59 +0100 | [diff] [blame] | 94 | ieee80211_ht_oper_to_chandef(sdata->vif.bss_conf.chandef.chan, |
| 95 | ie->ht_operation, &sta_chan_def); |
Ashok Nagarajan | b91e64a | 2012-04-30 14:20:31 -0700 | [diff] [blame] | 96 | |
Johannes Berg | 4bf8853 | 2012-11-09 11:39:59 +0100 | [diff] [blame] | 97 | if (!cfg80211_chandef_compatible(&sdata->vif.bss_conf.chandef, |
| 98 | &sta_chan_def)) |
Johannes Berg | bf7cd94 | 2013-02-15 14:40:31 +0100 | [diff] [blame] | 99 | return false; |
Thomas Pedersen | 739522b | 2011-10-26 14:47:28 -0700 | [diff] [blame] | 100 | |
| 101 | return true; |
Luis Carlos Cobo | 2e3c873 | 2008-02-23 15:17:09 +0100 | [diff] [blame] | 102 | } |
| 103 | |
| 104 | /** |
| 105 | * mesh_peer_accepts_plinks - check if an mp is willing to establish peer links |
| 106 | * |
| 107 | * @ie: information elements of a management frame from the mesh peer |
Luis Carlos Cobo | 2e3c873 | 2008-02-23 15:17:09 +0100 | [diff] [blame] | 108 | */ |
Jasper Bryant-Greene | f698d85 | 2008-08-03 12:04:37 +1200 | [diff] [blame] | 109 | bool mesh_peer_accepts_plinks(struct ieee802_11_elems *ie) |
Luis Carlos Cobo | 2e3c873 | 2008-02-23 15:17:09 +0100 | [diff] [blame] | 110 | { |
Rui Paulo | 136cfa2 | 2009-11-18 18:40:00 +0000 | [diff] [blame] | 111 | return (ie->mesh_config->meshconf_cap & |
Johannes Berg | bf7cd94 | 2013-02-15 14:40:31 +0100 | [diff] [blame] | 112 | IEEE80211_MESHCONF_CAPAB_ACCEPT_PLINKS) != 0; |
Luis Carlos Cobo | 2e3c873 | 2008-02-23 15:17:09 +0100 | [diff] [blame] | 113 | } |
| 114 | |
| 115 | /** |
Ben Hutchings | 2c53040 | 2012-07-10 10:55:09 +0000 | [diff] [blame] | 116 | * mesh_accept_plinks_update - update accepting_plink in local mesh beacons |
Luis Carlos Cobo | 2e3c873 | 2008-02-23 15:17:09 +0100 | [diff] [blame] | 117 | * |
Johannes Berg | d0709a6 | 2008-02-25 16:27:46 +0100 | [diff] [blame] | 118 | * @sdata: mesh interface in which mesh beacons are going to be updated |
Marco Porsch | df32381 | 2012-08-08 07:58:43 +0200 | [diff] [blame] | 119 | * |
| 120 | * Returns: beacon changed flag if the beacon content changed. |
Luis Carlos Cobo | 2e3c873 | 2008-02-23 15:17:09 +0100 | [diff] [blame] | 121 | */ |
Marco Porsch | df32381 | 2012-08-08 07:58:43 +0200 | [diff] [blame] | 122 | u32 mesh_accept_plinks_update(struct ieee80211_sub_if_data *sdata) |
Luis Carlos Cobo | 2e3c873 | 2008-02-23 15:17:09 +0100 | [diff] [blame] | 123 | { |
Luis Carlos Cobo | 2e3c873 | 2008-02-23 15:17:09 +0100 | [diff] [blame] | 124 | bool free_plinks; |
Marco Porsch | df32381 | 2012-08-08 07:58:43 +0200 | [diff] [blame] | 125 | u32 changed = 0; |
Luis Carlos Cobo | 2e3c873 | 2008-02-23 15:17:09 +0100 | [diff] [blame] | 126 | |
| 127 | /* In case mesh_plink_free_count > 0 and mesh_plinktbl_capacity == 0, |
| 128 | * the mesh interface might be able to establish plinks with peers that |
Luis Carlos Cobo | b4e08ea | 2008-02-29 15:46:08 -0800 | [diff] [blame] | 129 | * are already on the table but are not on PLINK_ESTAB state. However, |
| 130 | * in general the mesh interface is not accepting peer link requests |
| 131 | * from new peers, and that must be reflected in the beacon |
Luis Carlos Cobo | 2e3c873 | 2008-02-23 15:17:09 +0100 | [diff] [blame] | 132 | */ |
| 133 | free_plinks = mesh_plink_availables(sdata); |
| 134 | |
Marco Porsch | df32381 | 2012-08-08 07:58:43 +0200 | [diff] [blame] | 135 | if (free_plinks != sdata->u.mesh.accepting_plinks) { |
| 136 | sdata->u.mesh.accepting_plinks = free_plinks; |
| 137 | changed = BSS_CHANGED_BEACON; |
| 138 | } |
| 139 | |
| 140 | return changed; |
Luis Carlos Cobo | 2e3c873 | 2008-02-23 15:17:09 +0100 | [diff] [blame] | 141 | } |
| 142 | |
Thomas Pedersen | 45b5028 | 2013-02-06 10:17:21 -0800 | [diff] [blame] | 143 | /* |
| 144 | * mesh_sta_cleanup - clean up any mesh sta state |
| 145 | * |
| 146 | * @sta: mesh sta to clean up. |
| 147 | */ |
| 148 | void mesh_sta_cleanup(struct sta_info *sta) |
| 149 | { |
| 150 | struct ieee80211_sub_if_data *sdata = sta->sdata; |
| 151 | u32 changed; |
| 152 | |
| 153 | /* |
| 154 | * maybe userspace handles peer allocation and peering, but in either |
| 155 | * case the beacon is still generated by the kernel and we might need |
| 156 | * an update. |
| 157 | */ |
| 158 | changed = mesh_accept_plinks_update(sdata); |
Thomas Pedersen | a6dad6a | 2013-03-04 13:06:12 -0800 | [diff] [blame] | 159 | if (!sdata->u.mesh.user_mpm) { |
Thomas Pedersen | 45b5028 | 2013-02-06 10:17:21 -0800 | [diff] [blame] | 160 | changed |= mesh_plink_deactivate(sta); |
| 161 | del_timer_sync(&sta->plink_timer); |
| 162 | } |
| 163 | |
Thomas Pedersen | f81a9de | 2013-06-13 15:54:41 -0700 | [diff] [blame] | 164 | if (changed) |
Thomas Pedersen | 2b5e196 | 2013-02-14 11:20:13 -0800 | [diff] [blame] | 165 | ieee80211_mbss_info_change_notify(sdata, changed); |
Thomas Pedersen | 45b5028 | 2013-02-06 10:17:21 -0800 | [diff] [blame] | 166 | } |
| 167 | |
Jasper Bryant-Greene | f698d85 | 2008-08-03 12:04:37 +1200 | [diff] [blame] | 168 | int mesh_rmc_init(struct ieee80211_sub_if_data *sdata) |
Luis Carlos Cobo | 2e3c873 | 2008-02-23 15:17:09 +0100 | [diff] [blame] | 169 | { |
Luis Carlos Cobo | 2e3c873 | 2008-02-23 15:17:09 +0100 | [diff] [blame] | 170 | int i; |
| 171 | |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 172 | sdata->u.mesh.rmc = kmalloc(sizeof(struct mesh_rmc), GFP_KERNEL); |
| 173 | if (!sdata->u.mesh.rmc) |
Luis Carlos Cobo | 2e3c873 | 2008-02-23 15:17:09 +0100 | [diff] [blame] | 174 | return -ENOMEM; |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 175 | sdata->u.mesh.rmc->idx_mask = RMC_BUCKETS - 1; |
Luis Carlos Cobo | 2e3c873 | 2008-02-23 15:17:09 +0100 | [diff] [blame] | 176 | for (i = 0; i < RMC_BUCKETS; i++) |
Thomas Pedersen | b7cfcd1 | 2012-12-17 18:41:57 -0800 | [diff] [blame] | 177 | INIT_LIST_HEAD(&sdata->u.mesh.rmc->bucket[i]); |
Luis Carlos Cobo | 2e3c873 | 2008-02-23 15:17:09 +0100 | [diff] [blame] | 178 | return 0; |
| 179 | } |
| 180 | |
Jasper Bryant-Greene | f698d85 | 2008-08-03 12:04:37 +1200 | [diff] [blame] | 181 | void mesh_rmc_free(struct ieee80211_sub_if_data *sdata) |
Luis Carlos Cobo | 2e3c873 | 2008-02-23 15:17:09 +0100 | [diff] [blame] | 182 | { |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 183 | struct mesh_rmc *rmc = sdata->u.mesh.rmc; |
Luis Carlos Cobo | 2e3c873 | 2008-02-23 15:17:09 +0100 | [diff] [blame] | 184 | struct rmc_entry *p, *n; |
| 185 | int i; |
| 186 | |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 187 | if (!sdata->u.mesh.rmc) |
Luis Carlos Cobo | 2e3c873 | 2008-02-23 15:17:09 +0100 | [diff] [blame] | 188 | return; |
| 189 | |
Johannes Berg | bf7cd94 | 2013-02-15 14:40:31 +0100 | [diff] [blame] | 190 | for (i = 0; i < RMC_BUCKETS; i++) { |
Thomas Pedersen | b7cfcd1 | 2012-12-17 18:41:57 -0800 | [diff] [blame] | 191 | list_for_each_entry_safe(p, n, &rmc->bucket[i], list) { |
Luis Carlos Cobo | 2e3c873 | 2008-02-23 15:17:09 +0100 | [diff] [blame] | 192 | list_del(&p->list); |
| 193 | kmem_cache_free(rm_cache, p); |
| 194 | } |
Johannes Berg | bf7cd94 | 2013-02-15 14:40:31 +0100 | [diff] [blame] | 195 | } |
Luis Carlos Cobo | 2e3c873 | 2008-02-23 15:17:09 +0100 | [diff] [blame] | 196 | |
| 197 | kfree(rmc); |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 198 | sdata->u.mesh.rmc = NULL; |
Luis Carlos Cobo | 2e3c873 | 2008-02-23 15:17:09 +0100 | [diff] [blame] | 199 | } |
| 200 | |
| 201 | /** |
| 202 | * mesh_rmc_check - Check frame in recent multicast cache and add if absent. |
| 203 | * |
Johannes Berg | bf7cd94 | 2013-02-15 14:40:31 +0100 | [diff] [blame] | 204 | * @sdata: interface |
Luis Carlos Cobo | 2e3c873 | 2008-02-23 15:17:09 +0100 | [diff] [blame] | 205 | * @sa: source address |
| 206 | * @mesh_hdr: mesh_header |
| 207 | * |
| 208 | * Returns: 0 if the frame is not in the cache, nonzero otherwise. |
| 209 | * |
| 210 | * Checks using the source address and the mesh sequence number if we have |
| 211 | * received this frame lately. If the frame is not in the cache, it is added to |
| 212 | * it. |
| 213 | */ |
Johannes Berg | bf7cd94 | 2013-02-15 14:40:31 +0100 | [diff] [blame] | 214 | int mesh_rmc_check(struct ieee80211_sub_if_data *sdata, |
| 215 | const u8 *sa, struct ieee80211s_hdr *mesh_hdr) |
Luis Carlos Cobo | 2e3c873 | 2008-02-23 15:17:09 +0100 | [diff] [blame] | 216 | { |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 217 | struct mesh_rmc *rmc = sdata->u.mesh.rmc; |
Luis Carlos Cobo | 2e3c873 | 2008-02-23 15:17:09 +0100 | [diff] [blame] | 218 | u32 seqnum = 0; |
| 219 | int entries = 0; |
| 220 | u8 idx; |
| 221 | struct rmc_entry *p, *n; |
| 222 | |
| 223 | /* Don't care about endianness since only match matters */ |
Luis Carlos Cobo | 51cedda | 2008-04-23 12:15:29 -0700 | [diff] [blame] | 224 | memcpy(&seqnum, &mesh_hdr->seqnum, sizeof(mesh_hdr->seqnum)); |
| 225 | idx = le32_to_cpu(mesh_hdr->seqnum) & rmc->idx_mask; |
Thomas Pedersen | b7cfcd1 | 2012-12-17 18:41:57 -0800 | [diff] [blame] | 226 | list_for_each_entry_safe(p, n, &rmc->bucket[idx], list) { |
Luis Carlos Cobo | 2e3c873 | 2008-02-23 15:17:09 +0100 | [diff] [blame] | 227 | ++entries; |
| 228 | if (time_after(jiffies, p->exp_time) || |
Johannes Berg | bf7cd94 | 2013-02-15 14:40:31 +0100 | [diff] [blame] | 229 | entries == RMC_QUEUE_MAX_LEN) { |
Luis Carlos Cobo | 2e3c873 | 2008-02-23 15:17:09 +0100 | [diff] [blame] | 230 | list_del(&p->list); |
| 231 | kmem_cache_free(rm_cache, p); |
| 232 | --entries; |
Johannes Berg | bf7cd94 | 2013-02-15 14:40:31 +0100 | [diff] [blame] | 233 | } else if ((seqnum == p->seqnum) && ether_addr_equal(sa, p->sa)) |
Luis Carlos Cobo | 2e3c873 | 2008-02-23 15:17:09 +0100 | [diff] [blame] | 234 | return -1; |
| 235 | } |
| 236 | |
| 237 | p = kmem_cache_alloc(rm_cache, GFP_ATOMIC); |
Joe Perches | d15b845 | 2011-08-29 14:17:31 -0700 | [diff] [blame] | 238 | if (!p) |
Luis Carlos Cobo | 2e3c873 | 2008-02-23 15:17:09 +0100 | [diff] [blame] | 239 | return 0; |
Joe Perches | d15b845 | 2011-08-29 14:17:31 -0700 | [diff] [blame] | 240 | |
Luis Carlos Cobo | 2e3c873 | 2008-02-23 15:17:09 +0100 | [diff] [blame] | 241 | p->seqnum = seqnum; |
| 242 | p->exp_time = jiffies + RMC_TIMEOUT; |
| 243 | memcpy(p->sa, sa, ETH_ALEN); |
Thomas Pedersen | b7cfcd1 | 2012-12-17 18:41:57 -0800 | [diff] [blame] | 244 | list_add(&p->list, &rmc->bucket[idx]); |
Luis Carlos Cobo | 2e3c873 | 2008-02-23 15:17:09 +0100 | [diff] [blame] | 245 | return 0; |
| 246 | } |
| 247 | |
Johannes Berg | bf7cd94 | 2013-02-15 14:40:31 +0100 | [diff] [blame] | 248 | int mesh_add_meshconf_ie(struct ieee80211_sub_if_data *sdata, |
| 249 | struct sk_buff *skb) |
Thomas Pedersen | 082ebb0 | 2011-08-11 19:35:10 -0700 | [diff] [blame] | 250 | { |
| 251 | struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; |
| 252 | u8 *pos, neighbors; |
| 253 | u8 meshconf_len = sizeof(struct ieee80211_meshconf_ie); |
| 254 | |
| 255 | if (skb_tailroom(skb) < 2 + meshconf_len) |
| 256 | return -ENOMEM; |
| 257 | |
| 258 | pos = skb_put(skb, 2 + meshconf_len); |
| 259 | *pos++ = WLAN_EID_MESH_CONFIG; |
| 260 | *pos++ = meshconf_len; |
| 261 | |
Thomas Pedersen | 43552be | 2013-12-15 13:14:16 -0800 | [diff] [blame] | 262 | /* save a pointer for quick updates in pre-tbtt */ |
| 263 | ifmsh->meshconf_offset = pos - skb->data; |
| 264 | |
Thomas Pedersen | 082ebb0 | 2011-08-11 19:35:10 -0700 | [diff] [blame] | 265 | /* Active path selection protocol ID */ |
| 266 | *pos++ = ifmsh->mesh_pp_id; |
| 267 | /* Active path selection metric ID */ |
| 268 | *pos++ = ifmsh->mesh_pm_id; |
| 269 | /* Congestion control mode identifier */ |
| 270 | *pos++ = ifmsh->mesh_cc_id; |
| 271 | /* Synchronization protocol identifier */ |
| 272 | *pos++ = ifmsh->mesh_sp_id; |
| 273 | /* Authentication Protocol identifier */ |
| 274 | *pos++ = ifmsh->mesh_auth_id; |
| 275 | /* Mesh Formation Info - number of neighbors */ |
Ashok Nagarajan | 1258d97 | 2012-10-09 13:27:47 -0700 | [diff] [blame] | 276 | neighbors = atomic_read(&ifmsh->estab_plinks); |
Jacob Minshall | e05eccc | 2013-05-29 14:32:36 -0700 | [diff] [blame] | 277 | neighbors = min_t(int, neighbors, IEEE80211_MAX_MESH_PEERINGS); |
Thomas Pedersen | 082ebb0 | 2011-08-11 19:35:10 -0700 | [diff] [blame] | 278 | *pos++ = neighbors << 1; |
| 279 | /* Mesh capability */ |
Chun-Yeow Yeoh | b60e527 | 2013-07-12 18:55:22 +0800 | [diff] [blame] | 280 | *pos = 0x00; |
| 281 | *pos |= ifmsh->mshcfg.dot11MeshForwarding ? |
| 282 | IEEE80211_MESHCONF_CAPAB_FORWARDING : 0x00; |
Javier Cardona | dbf498f | 2012-03-31 11:31:32 -0700 | [diff] [blame] | 283 | *pos |= ifmsh->accepting_plinks ? |
Johannes Berg | bf7cd94 | 2013-02-15 14:40:31 +0100 | [diff] [blame] | 284 | IEEE80211_MESHCONF_CAPAB_ACCEPT_PLINKS : 0x00; |
Marco Porsch | 3f52b7e | 2013-01-30 18:14:08 +0100 | [diff] [blame] | 285 | /* Mesh PS mode. See IEEE802.11-2012 8.4.2.100.8 */ |
| 286 | *pos |= ifmsh->ps_peers_deep_sleep ? |
Johannes Berg | bf7cd94 | 2013-02-15 14:40:31 +0100 | [diff] [blame] | 287 | IEEE80211_MESHCONF_CAPAB_POWER_SAVE_LEVEL : 0x00; |
Javier Cardona | dbf498f | 2012-03-31 11:31:32 -0700 | [diff] [blame] | 288 | *pos++ |= ifmsh->adjusting_tbtt ? |
Johannes Berg | bf7cd94 | 2013-02-15 14:40:31 +0100 | [diff] [blame] | 289 | IEEE80211_MESHCONF_CAPAB_TBTT_ADJUSTING : 0x00; |
Thomas Pedersen | 082ebb0 | 2011-08-11 19:35:10 -0700 | [diff] [blame] | 290 | *pos++ = 0x00; |
| 291 | |
| 292 | return 0; |
| 293 | } |
| 294 | |
Johannes Berg | bf7cd94 | 2013-02-15 14:40:31 +0100 | [diff] [blame] | 295 | int mesh_add_meshid_ie(struct ieee80211_sub_if_data *sdata, struct sk_buff *skb) |
Thomas Pedersen | 082ebb0 | 2011-08-11 19:35:10 -0700 | [diff] [blame] | 296 | { |
| 297 | struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; |
| 298 | u8 *pos; |
| 299 | |
| 300 | if (skb_tailroom(skb) < 2 + ifmsh->mesh_id_len) |
| 301 | return -ENOMEM; |
| 302 | |
| 303 | pos = skb_put(skb, 2 + ifmsh->mesh_id_len); |
| 304 | *pos++ = WLAN_EID_MESH_ID; |
| 305 | *pos++ = ifmsh->mesh_id_len; |
| 306 | if (ifmsh->mesh_id_len) |
| 307 | memcpy(pos, ifmsh->mesh_id, ifmsh->mesh_id_len); |
| 308 | |
| 309 | return 0; |
| 310 | } |
| 311 | |
Johannes Berg | bf7cd94 | 2013-02-15 14:40:31 +0100 | [diff] [blame] | 312 | static int mesh_add_awake_window_ie(struct ieee80211_sub_if_data *sdata, |
| 313 | struct sk_buff *skb) |
Marco Porsch | 3f52b7e | 2013-01-30 18:14:08 +0100 | [diff] [blame] | 314 | { |
| 315 | struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; |
| 316 | u8 *pos; |
| 317 | |
| 318 | /* see IEEE802.11-2012 13.14.6 */ |
| 319 | if (ifmsh->ps_peers_light_sleep == 0 && |
| 320 | ifmsh->ps_peers_deep_sleep == 0 && |
| 321 | ifmsh->nonpeer_pm == NL80211_MESH_POWER_ACTIVE) |
| 322 | return 0; |
| 323 | |
| 324 | if (skb_tailroom(skb) < 4) |
| 325 | return -ENOMEM; |
| 326 | |
| 327 | pos = skb_put(skb, 2 + 2); |
| 328 | *pos++ = WLAN_EID_MESH_AWAKE_WINDOW; |
| 329 | *pos++ = 2; |
| 330 | put_unaligned_le16(ifmsh->mshcfg.dot11MeshAwakeWindowDuration, pos); |
| 331 | |
| 332 | return 0; |
| 333 | } |
| 334 | |
Johannes Berg | bf7cd94 | 2013-02-15 14:40:31 +0100 | [diff] [blame] | 335 | int mesh_add_vendor_ies(struct ieee80211_sub_if_data *sdata, |
| 336 | struct sk_buff *skb) |
Thomas Pedersen | 082ebb0 | 2011-08-11 19:35:10 -0700 | [diff] [blame] | 337 | { |
| 338 | struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; |
| 339 | u8 offset, len; |
| 340 | const u8 *data; |
| 341 | |
| 342 | if (!ifmsh->ie || !ifmsh->ie_len) |
| 343 | return 0; |
| 344 | |
| 345 | /* fast-forward to vendor IEs */ |
| 346 | offset = ieee80211_ie_split_vendor(ifmsh->ie, ifmsh->ie_len, 0); |
| 347 | |
| 348 | if (offset) { |
| 349 | len = ifmsh->ie_len - offset; |
| 350 | data = ifmsh->ie + offset; |
| 351 | if (skb_tailroom(skb) < len) |
| 352 | return -ENOMEM; |
| 353 | memcpy(skb_put(skb, len), data, len); |
| 354 | } |
| 355 | |
| 356 | return 0; |
| 357 | } |
| 358 | |
Johannes Berg | bf7cd94 | 2013-02-15 14:40:31 +0100 | [diff] [blame] | 359 | int mesh_add_rsn_ie(struct ieee80211_sub_if_data *sdata, struct sk_buff *skb) |
Thomas Pedersen | 082ebb0 | 2011-08-11 19:35:10 -0700 | [diff] [blame] | 360 | { |
| 361 | struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; |
| 362 | u8 len = 0; |
| 363 | const u8 *data; |
| 364 | |
| 365 | if (!ifmsh->ie || !ifmsh->ie_len) |
| 366 | return 0; |
| 367 | |
| 368 | /* find RSN IE */ |
Bob Copeland | a40a8c1 | 2014-04-15 10:43:07 -0400 | [diff] [blame] | 369 | data = cfg80211_find_ie(WLAN_EID_RSN, ifmsh->ie, ifmsh->ie_len); |
| 370 | if (!data) |
| 371 | return 0; |
Thomas Pedersen | 082ebb0 | 2011-08-11 19:35:10 -0700 | [diff] [blame] | 372 | |
Bob Copeland | a40a8c1 | 2014-04-15 10:43:07 -0400 | [diff] [blame] | 373 | len = data[1] + 2; |
| 374 | |
| 375 | if (skb_tailroom(skb) < len) |
| 376 | return -ENOMEM; |
| 377 | memcpy(skb_put(skb, len), data, len); |
Thomas Pedersen | 082ebb0 | 2011-08-11 19:35:10 -0700 | [diff] [blame] | 378 | |
| 379 | return 0; |
| 380 | } |
| 381 | |
Johannes Berg | bf7cd94 | 2013-02-15 14:40:31 +0100 | [diff] [blame] | 382 | static int mesh_add_ds_params_ie(struct ieee80211_sub_if_data *sdata, |
| 383 | struct sk_buff *skb) |
Thomas Pedersen | 082ebb0 | 2011-08-11 19:35:10 -0700 | [diff] [blame] | 384 | { |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 385 | struct ieee80211_chanctx_conf *chanctx_conf; |
| 386 | struct ieee80211_channel *chan; |
Thomas Pedersen | 082ebb0 | 2011-08-11 19:35:10 -0700 | [diff] [blame] | 387 | u8 *pos; |
| 388 | |
| 389 | if (skb_tailroom(skb) < 3) |
| 390 | return -ENOMEM; |
| 391 | |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 392 | rcu_read_lock(); |
| 393 | chanctx_conf = rcu_dereference(sdata->vif.chanctx_conf); |
| 394 | if (WARN_ON(!chanctx_conf)) { |
| 395 | rcu_read_unlock(); |
| 396 | return -EINVAL; |
| 397 | } |
Johannes Berg | 4bf8853 | 2012-11-09 11:39:59 +0100 | [diff] [blame] | 398 | chan = chanctx_conf->def.chan; |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 399 | rcu_read_unlock(); |
| 400 | |
Emanuel Taube | 601513a | 2013-02-06 14:17:17 +0100 | [diff] [blame] | 401 | pos = skb_put(skb, 2 + 1); |
| 402 | *pos++ = WLAN_EID_DS_PARAMS; |
| 403 | *pos++ = 1; |
| 404 | *pos++ = ieee80211_frequency_to_channel(chan->center_freq); |
Rui Paulo | be125c6 | 2009-11-09 23:46:54 +0000 | [diff] [blame] | 405 | |
Thomas Pedersen | 082ebb0 | 2011-08-11 19:35:10 -0700 | [diff] [blame] | 406 | return 0; |
Luis Carlos Cobo | 2e3c873 | 2008-02-23 15:17:09 +0100 | [diff] [blame] | 407 | } |
| 408 | |
Johannes Berg | bf7cd94 | 2013-02-15 14:40:31 +0100 | [diff] [blame] | 409 | int mesh_add_ht_cap_ie(struct ieee80211_sub_if_data *sdata, |
| 410 | struct sk_buff *skb) |
Thomas Pedersen | 176f360 | 2011-10-26 14:47:27 -0700 | [diff] [blame] | 411 | { |
| 412 | struct ieee80211_local *local = sdata->local; |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 413 | enum ieee80211_band band = ieee80211_get_sdata_band(sdata); |
Thomas Pedersen | 176f360 | 2011-10-26 14:47:27 -0700 | [diff] [blame] | 414 | struct ieee80211_supported_band *sband; |
| 415 | u8 *pos; |
| 416 | |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 417 | sband = local->hw.wiphy->bands[band]; |
Thomas Pedersen | 176f360 | 2011-10-26 14:47:27 -0700 | [diff] [blame] | 418 | if (!sband->ht_cap.ht_supported || |
Simon Wunderlich | 0418a44 | 2013-05-16 13:00:31 +0200 | [diff] [blame] | 419 | sdata->vif.bss_conf.chandef.width == NL80211_CHAN_WIDTH_20_NOHT || |
| 420 | sdata->vif.bss_conf.chandef.width == NL80211_CHAN_WIDTH_5 || |
| 421 | sdata->vif.bss_conf.chandef.width == NL80211_CHAN_WIDTH_10) |
Thomas Pedersen | 176f360 | 2011-10-26 14:47:27 -0700 | [diff] [blame] | 422 | return 0; |
| 423 | |
| 424 | if (skb_tailroom(skb) < 2 + sizeof(struct ieee80211_ht_cap)) |
| 425 | return -ENOMEM; |
| 426 | |
| 427 | pos = skb_put(skb, 2 + sizeof(struct ieee80211_ht_cap)); |
Ben Greear | ef96a842 | 2011-11-18 11:32:00 -0800 | [diff] [blame] | 428 | ieee80211_ie_build_ht_cap(pos, &sband->ht_cap, sband->ht_cap.cap); |
Thomas Pedersen | 176f360 | 2011-10-26 14:47:27 -0700 | [diff] [blame] | 429 | |
| 430 | return 0; |
| 431 | } |
| 432 | |
Johannes Berg | bf7cd94 | 2013-02-15 14:40:31 +0100 | [diff] [blame] | 433 | int mesh_add_ht_oper_ie(struct ieee80211_sub_if_data *sdata, |
| 434 | struct sk_buff *skb) |
Thomas Pedersen | 176f360 | 2011-10-26 14:47:27 -0700 | [diff] [blame] | 435 | { |
| 436 | struct ieee80211_local *local = sdata->local; |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 437 | struct ieee80211_chanctx_conf *chanctx_conf; |
| 438 | struct ieee80211_channel *channel; |
Johannes Berg | 466f310 | 2012-07-25 13:51:49 +0200 | [diff] [blame] | 439 | enum nl80211_channel_type channel_type = |
Johannes Berg | 4bf8853 | 2012-11-09 11:39:59 +0100 | [diff] [blame] | 440 | cfg80211_get_chandef_type(&sdata->vif.bss_conf.chandef); |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 441 | struct ieee80211_supported_band *sband; |
| 442 | struct ieee80211_sta_ht_cap *ht_cap; |
Thomas Pedersen | 176f360 | 2011-10-26 14:47:27 -0700 | [diff] [blame] | 443 | u8 *pos; |
| 444 | |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 445 | rcu_read_lock(); |
| 446 | chanctx_conf = rcu_dereference(sdata->vif.chanctx_conf); |
| 447 | if (WARN_ON(!chanctx_conf)) { |
| 448 | rcu_read_unlock(); |
| 449 | return -EINVAL; |
| 450 | } |
Johannes Berg | 4bf8853 | 2012-11-09 11:39:59 +0100 | [diff] [blame] | 451 | channel = chanctx_conf->def.chan; |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 452 | rcu_read_unlock(); |
| 453 | |
| 454 | sband = local->hw.wiphy->bands[channel->band]; |
| 455 | ht_cap = &sband->ht_cap; |
| 456 | |
Thomas Pedersen | 176f360 | 2011-10-26 14:47:27 -0700 | [diff] [blame] | 457 | if (!ht_cap->ht_supported || channel_type == NL80211_CHAN_NO_HT) |
| 458 | return 0; |
| 459 | |
Johannes Berg | 074d46d | 2012-03-15 19:45:16 +0100 | [diff] [blame] | 460 | if (skb_tailroom(skb) < 2 + sizeof(struct ieee80211_ht_operation)) |
Thomas Pedersen | 176f360 | 2011-10-26 14:47:27 -0700 | [diff] [blame] | 461 | return -ENOMEM; |
| 462 | |
Johannes Berg | 074d46d | 2012-03-15 19:45:16 +0100 | [diff] [blame] | 463 | pos = skb_put(skb, 2 + sizeof(struct ieee80211_ht_operation)); |
Johannes Berg | 4bf8853 | 2012-11-09 11:39:59 +0100 | [diff] [blame] | 464 | ieee80211_ie_build_ht_oper(pos, ht_cap, &sdata->vif.bss_conf.chandef, |
Ashok Nagarajan | 431e315 | 2012-04-30 14:20:29 -0700 | [diff] [blame] | 465 | sdata->vif.bss_conf.ht_operation_mode); |
Thomas Pedersen | 176f360 | 2011-10-26 14:47:27 -0700 | [diff] [blame] | 466 | |
| 467 | return 0; |
| 468 | } |
Johannes Berg | bf7cd94 | 2013-02-15 14:40:31 +0100 | [diff] [blame] | 469 | |
Luis Carlos Cobo | 2e3c873 | 2008-02-23 15:17:09 +0100 | [diff] [blame] | 470 | static void ieee80211_mesh_path_timer(unsigned long data) |
| 471 | { |
| 472 | struct ieee80211_sub_if_data *sdata = |
| 473 | (struct ieee80211_sub_if_data *) data; |
Luis Carlos Cobo | 2e3c873 | 2008-02-23 15:17:09 +0100 | [diff] [blame] | 474 | |
Stanislaw Gruszka | 690205f | 2013-02-28 10:55:29 +0100 | [diff] [blame] | 475 | ieee80211_queue_work(&sdata->local->hw, &sdata->work); |
Luis Carlos Cobo | 2e3c873 | 2008-02-23 15:17:09 +0100 | [diff] [blame] | 476 | } |
| 477 | |
Rui Paulo | e304bfd | 2009-11-09 23:46:56 +0000 | [diff] [blame] | 478 | static void ieee80211_mesh_path_root_timer(unsigned long data) |
| 479 | { |
| 480 | struct ieee80211_sub_if_data *sdata = |
| 481 | (struct ieee80211_sub_if_data *) data; |
| 482 | struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; |
Rui Paulo | e304bfd | 2009-11-09 23:46:56 +0000 | [diff] [blame] | 483 | |
| 484 | set_bit(MESH_WORK_ROOT, &ifmsh->wrkq_flags); |
| 485 | |
Stanislaw Gruszka | 690205f | 2013-02-28 10:55:29 +0100 | [diff] [blame] | 486 | ieee80211_queue_work(&sdata->local->hw, &sdata->work); |
Rui Paulo | e304bfd | 2009-11-09 23:46:56 +0000 | [diff] [blame] | 487 | } |
| 488 | |
Rui Paulo | 63c5723 | 2009-11-09 23:46:57 +0000 | [diff] [blame] | 489 | void ieee80211_mesh_root_setup(struct ieee80211_if_mesh *ifmsh) |
| 490 | { |
Chun-Yeow Yeoh | dbb912c | 2012-06-14 02:06:09 +0800 | [diff] [blame] | 491 | if (ifmsh->mshcfg.dot11MeshHWMPRootMode > IEEE80211_ROOTMODE_ROOT) |
Rui Paulo | 63c5723 | 2009-11-09 23:46:57 +0000 | [diff] [blame] | 492 | set_bit(MESH_WORK_ROOT, &ifmsh->wrkq_flags); |
| 493 | else { |
| 494 | clear_bit(MESH_WORK_ROOT, &ifmsh->wrkq_flags); |
| 495 | /* stop running timer */ |
| 496 | del_timer_sync(&ifmsh->mesh_path_root_timer); |
| 497 | } |
| 498 | } |
| 499 | |
Johannes Berg | 902acc7 | 2008-02-23 15:17:19 +0100 | [diff] [blame] | 500 | /** |
Javier Cardona | 3c5772a | 2009-08-10 12:15:48 -0700 | [diff] [blame] | 501 | * ieee80211_fill_mesh_addresses - fill addresses of a locally originated mesh frame |
Johannes Berg | bf7cd94 | 2013-02-15 14:40:31 +0100 | [diff] [blame] | 502 | * @hdr: 802.11 frame header |
Javier Cardona | 3c5772a | 2009-08-10 12:15:48 -0700 | [diff] [blame] | 503 | * @fc: frame control field |
| 504 | * @meshda: destination address in the mesh |
| 505 | * @meshsa: source address address in the mesh. Same as TA, as frame is |
| 506 | * locally originated. |
| 507 | * |
| 508 | * Return the length of the 802.11 (does not include a mesh control header) |
| 509 | */ |
Johannes Berg | 15ff636 | 2009-11-17 13:34:04 +0100 | [diff] [blame] | 510 | int ieee80211_fill_mesh_addresses(struct ieee80211_hdr *hdr, __le16 *fc, |
| 511 | const u8 *meshda, const u8 *meshsa) |
| 512 | { |
Javier Cardona | 3c5772a | 2009-08-10 12:15:48 -0700 | [diff] [blame] | 513 | if (is_multicast_ether_addr(meshda)) { |
| 514 | *fc |= cpu_to_le16(IEEE80211_FCTL_FROMDS); |
| 515 | /* DA TA SA */ |
| 516 | memcpy(hdr->addr1, meshda, ETH_ALEN); |
| 517 | memcpy(hdr->addr2, meshsa, ETH_ALEN); |
| 518 | memcpy(hdr->addr3, meshsa, ETH_ALEN); |
| 519 | return 24; |
| 520 | } else { |
Javier Cardona | 2154c81 | 2011-09-07 17:49:53 -0700 | [diff] [blame] | 521 | *fc |= cpu_to_le16(IEEE80211_FCTL_FROMDS | IEEE80211_FCTL_TODS); |
Javier Cardona | 3c5772a | 2009-08-10 12:15:48 -0700 | [diff] [blame] | 522 | /* RA TA DA SA */ |
Joe Perches | c84a67a | 2015-03-02 19:54:57 -0800 | [diff] [blame] | 523 | eth_zero_addr(hdr->addr1); /* RA is resolved later */ |
Javier Cardona | 3c5772a | 2009-08-10 12:15:48 -0700 | [diff] [blame] | 524 | memcpy(hdr->addr2, meshsa, ETH_ALEN); |
| 525 | memcpy(hdr->addr3, meshda, ETH_ALEN); |
| 526 | memcpy(hdr->addr4, meshsa, ETH_ALEN); |
| 527 | return 30; |
| 528 | } |
| 529 | } |
| 530 | |
| 531 | /** |
Johannes Berg | 902acc7 | 2008-02-23 15:17:19 +0100 | [diff] [blame] | 532 | * ieee80211_new_mesh_header - create a new mesh header |
Johannes Berg | 902acc7 | 2008-02-23 15:17:19 +0100 | [diff] [blame] | 533 | * @sdata: mesh interface to be used |
Johannes Berg | bf7cd94 | 2013-02-15 14:40:31 +0100 | [diff] [blame] | 534 | * @meshhdr: uninitialized mesh header |
Javier Cardona | 61ad539 | 2010-12-16 17:23:34 -0800 | [diff] [blame] | 535 | * @addr4or5: 1st address in the ae header, which may correspond to address 4 |
| 536 | * (if addr6 is NULL) or address 5 (if addr6 is present). It may |
| 537 | * be NULL. |
| 538 | * @addr6: 2nd address in the ae header, which corresponds to addr6 of the |
| 539 | * mesh frame |
Johannes Berg | 902acc7 | 2008-02-23 15:17:19 +0100 | [diff] [blame] | 540 | * |
| 541 | * Return the header length. |
| 542 | */ |
Johannes Berg | bf7cd94 | 2013-02-15 14:40:31 +0100 | [diff] [blame] | 543 | int ieee80211_new_mesh_header(struct ieee80211_sub_if_data *sdata, |
| 544 | struct ieee80211s_hdr *meshhdr, |
| 545 | const char *addr4or5, const char *addr6) |
Johannes Berg | 902acc7 | 2008-02-23 15:17:19 +0100 | [diff] [blame] | 546 | { |
Johannes Berg | bf7cd94 | 2013-02-15 14:40:31 +0100 | [diff] [blame] | 547 | if (WARN_ON(!addr4or5 && addr6)) |
| 548 | return 0; |
| 549 | |
Julia Lawall | 0c3cee7 | 2009-12-09 20:25:59 +0100 | [diff] [blame] | 550 | memset(meshhdr, 0, sizeof(*meshhdr)); |
Johannes Berg | bf7cd94 | 2013-02-15 14:40:31 +0100 | [diff] [blame] | 551 | |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 552 | meshhdr->ttl = sdata->u.mesh.mshcfg.dot11MeshTTL; |
Johannes Berg | bf7cd94 | 2013-02-15 14:40:31 +0100 | [diff] [blame] | 553 | |
| 554 | /* FIXME: racy -- TX on multiple queues can be concurrent */ |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 555 | put_unaligned(cpu_to_le32(sdata->u.mesh.mesh_seqnum), &meshhdr->seqnum); |
| 556 | sdata->u.mesh.mesh_seqnum++; |
Johannes Berg | bf7cd94 | 2013-02-15 14:40:31 +0100 | [diff] [blame] | 557 | |
Javier Cardona | 61ad539 | 2010-12-16 17:23:34 -0800 | [diff] [blame] | 558 | if (addr4or5 && !addr6) { |
Javier Cardona | 3c5772a | 2009-08-10 12:15:48 -0700 | [diff] [blame] | 559 | meshhdr->flags |= MESH_FLAGS_AE_A4; |
Javier Cardona | 61ad539 | 2010-12-16 17:23:34 -0800 | [diff] [blame] | 560 | memcpy(meshhdr->eaddr1, addr4or5, ETH_ALEN); |
Johannes Berg | bf7cd94 | 2013-02-15 14:40:31 +0100 | [diff] [blame] | 561 | return 2 * ETH_ALEN; |
Javier Cardona | 61ad539 | 2010-12-16 17:23:34 -0800 | [diff] [blame] | 562 | } else if (addr4or5 && addr6) { |
Javier Cardona | 3c5772a | 2009-08-10 12:15:48 -0700 | [diff] [blame] | 563 | meshhdr->flags |= MESH_FLAGS_AE_A5_A6; |
Javier Cardona | 61ad539 | 2010-12-16 17:23:34 -0800 | [diff] [blame] | 564 | memcpy(meshhdr->eaddr1, addr4or5, ETH_ALEN); |
| 565 | memcpy(meshhdr->eaddr2, addr6, ETH_ALEN); |
Johannes Berg | bf7cd94 | 2013-02-15 14:40:31 +0100 | [diff] [blame] | 566 | return 3 * ETH_ALEN; |
Javier Cardona | 3c5772a | 2009-08-10 12:15:48 -0700 | [diff] [blame] | 567 | } |
Johannes Berg | bf7cd94 | 2013-02-15 14:40:31 +0100 | [diff] [blame] | 568 | |
| 569 | return ETH_ALEN; |
Johannes Berg | 902acc7 | 2008-02-23 15:17:19 +0100 | [diff] [blame] | 570 | } |
| 571 | |
Johannes Berg | bf7cd94 | 2013-02-15 14:40:31 +0100 | [diff] [blame] | 572 | static void ieee80211_mesh_housekeeping(struct ieee80211_sub_if_data *sdata) |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 573 | { |
Johannes Berg | bf7cd94 | 2013-02-15 14:40:31 +0100 | [diff] [blame] | 574 | struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; |
Marco Porsch | df32381 | 2012-08-08 07:58:43 +0200 | [diff] [blame] | 575 | u32 changed; |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 576 | |
Colleen Twitty | 66de671 | 2013-06-03 09:53:40 -0700 | [diff] [blame] | 577 | ieee80211_sta_expire(sdata, ifmsh->mshcfg.plink_timeout * HZ); |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 578 | mesh_path_expire(sdata); |
| 579 | |
Marco Porsch | df32381 | 2012-08-08 07:58:43 +0200 | [diff] [blame] | 580 | changed = mesh_accept_plinks_update(sdata); |
Thomas Pedersen | 2b5e196 | 2013-02-14 11:20:13 -0800 | [diff] [blame] | 581 | ieee80211_mbss_info_change_notify(sdata, changed); |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 582 | |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 583 | mod_timer(&ifmsh->housekeeping_timer, |
Johannes Berg | bf7cd94 | 2013-02-15 14:40:31 +0100 | [diff] [blame] | 584 | round_jiffies(jiffies + |
| 585 | IEEE80211_MESH_HOUSEKEEPING_INTERVAL)); |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 586 | } |
| 587 | |
Rui Paulo | e304bfd | 2009-11-09 23:46:56 +0000 | [diff] [blame] | 588 | static void ieee80211_mesh_rootpath(struct ieee80211_sub_if_data *sdata) |
| 589 | { |
| 590 | struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; |
Chun-Yeow Yeoh | a69cc44 | 2012-06-14 02:06:07 +0800 | [diff] [blame] | 591 | u32 interval; |
Rui Paulo | e304bfd | 2009-11-09 23:46:56 +0000 | [diff] [blame] | 592 | |
| 593 | mesh_path_tx_root_frame(sdata); |
Chun-Yeow Yeoh | a69cc44 | 2012-06-14 02:06:07 +0800 | [diff] [blame] | 594 | |
| 595 | if (ifmsh->mshcfg.dot11MeshHWMPRootMode == IEEE80211_PROACTIVE_RANN) |
| 596 | interval = ifmsh->mshcfg.dot11MeshHWMPRannInterval; |
| 597 | else |
| 598 | interval = ifmsh->mshcfg.dot11MeshHWMProotInterval; |
| 599 | |
Rui Paulo | e304bfd | 2009-11-09 23:46:56 +0000 | [diff] [blame] | 600 | mod_timer(&ifmsh->mesh_path_root_timer, |
Chun-Yeow Yeoh | a69cc44 | 2012-06-14 02:06:07 +0800 | [diff] [blame] | 601 | round_jiffies(TU_TO_EXP_TIME(interval))); |
Rui Paulo | e304bfd | 2009-11-09 23:46:56 +0000 | [diff] [blame] | 602 | } |
| 603 | |
Thomas Pedersen | 2b5e196 | 2013-02-14 11:20:13 -0800 | [diff] [blame] | 604 | static int |
| 605 | ieee80211_mesh_build_beacon(struct ieee80211_if_mesh *ifmsh) |
| 606 | { |
| 607 | struct beacon_data *bcn; |
| 608 | int head_len, tail_len; |
| 609 | struct sk_buff *skb; |
| 610 | struct ieee80211_mgmt *mgmt; |
| 611 | struct ieee80211_chanctx_conf *chanctx_conf; |
Chun-Yeow Yeoh | b8456a1 | 2013-10-17 15:55:02 -0700 | [diff] [blame] | 612 | struct mesh_csa_settings *csa; |
Thomas Pedersen | 2b5e196 | 2013-02-14 11:20:13 -0800 | [diff] [blame] | 613 | enum ieee80211_band band; |
| 614 | u8 *pos; |
| 615 | struct ieee80211_sub_if_data *sdata; |
| 616 | int hdr_len = offsetof(struct ieee80211_mgmt, u.beacon) + |
| 617 | sizeof(mgmt->u.beacon); |
| 618 | |
| 619 | sdata = container_of(ifmsh, struct ieee80211_sub_if_data, u.mesh); |
| 620 | rcu_read_lock(); |
| 621 | chanctx_conf = rcu_dereference(sdata->vif.chanctx_conf); |
| 622 | band = chanctx_conf->def.chan->band; |
| 623 | rcu_read_unlock(); |
| 624 | |
| 625 | head_len = hdr_len + |
| 626 | 2 + /* NULL SSID */ |
Chun-Yeow Yeoh | b8456a1 | 2013-10-17 15:55:02 -0700 | [diff] [blame] | 627 | /* Channel Switch Announcement */ |
| 628 | 2 + sizeof(struct ieee80211_channel_sw_ie) + |
| 629 | /* Mesh Channel Swith Parameters */ |
| 630 | 2 + sizeof(struct ieee80211_mesh_chansw_params_ie) + |
Thomas Pedersen | 2b5e196 | 2013-02-14 11:20:13 -0800 | [diff] [blame] | 631 | 2 + 8 + /* supported rates */ |
| 632 | 2 + 3; /* DS params */ |
| 633 | tail_len = 2 + (IEEE80211_MAX_SUPP_RATES - 8) + |
| 634 | 2 + sizeof(struct ieee80211_ht_cap) + |
| 635 | 2 + sizeof(struct ieee80211_ht_operation) + |
| 636 | 2 + ifmsh->mesh_id_len + |
| 637 | 2 + sizeof(struct ieee80211_meshconf_ie) + |
| 638 | 2 + sizeof(__le16) + /* awake window */ |
| 639 | ifmsh->ie_len; |
| 640 | |
| 641 | bcn = kzalloc(sizeof(*bcn) + head_len + tail_len, GFP_KERNEL); |
| 642 | /* need an skb for IE builders to operate on */ |
| 643 | skb = dev_alloc_skb(max(head_len, tail_len)); |
| 644 | |
| 645 | if (!bcn || !skb) |
| 646 | goto out_free; |
| 647 | |
| 648 | /* |
| 649 | * pointers go into the block we allocated, |
| 650 | * memory is | beacon_data | head | tail | |
| 651 | */ |
| 652 | bcn->head = ((u8 *) bcn) + sizeof(*bcn); |
| 653 | |
| 654 | /* fill in the head */ |
| 655 | mgmt = (struct ieee80211_mgmt *) skb_put(skb, hdr_len); |
| 656 | memset(mgmt, 0, hdr_len); |
| 657 | mgmt->frame_control = cpu_to_le16(IEEE80211_FTYPE_MGMT | |
| 658 | IEEE80211_STYPE_BEACON); |
| 659 | eth_broadcast_addr(mgmt->da); |
| 660 | memcpy(mgmt->sa, sdata->vif.addr, ETH_ALEN); |
| 661 | memcpy(mgmt->bssid, sdata->vif.addr, ETH_ALEN); |
| 662 | ieee80211_mps_set_frame_flags(sdata, NULL, (void *) mgmt); |
| 663 | mgmt->u.beacon.beacon_int = |
| 664 | cpu_to_le16(sdata->vif.bss_conf.beacon_int); |
| 665 | mgmt->u.beacon.capab_info |= cpu_to_le16( |
| 666 | sdata->u.mesh.security ? WLAN_CAPABILITY_PRIVACY : 0); |
| 667 | |
| 668 | pos = skb_put(skb, 2); |
| 669 | *pos++ = WLAN_EID_SSID; |
| 670 | *pos++ = 0x0; |
| 671 | |
Chun-Yeow Yeoh | b8456a1 | 2013-10-17 15:55:02 -0700 | [diff] [blame] | 672 | rcu_read_lock(); |
| 673 | csa = rcu_dereference(ifmsh->csa); |
| 674 | if (csa) { |
Chun-Yeow Yeoh | b8456a1 | 2013-10-17 15:55:02 -0700 | [diff] [blame] | 675 | pos = skb_put(skb, 13); |
| 676 | memset(pos, 0, 13); |
| 677 | *pos++ = WLAN_EID_CHANNEL_SWITCH; |
| 678 | *pos++ = 3; |
| 679 | *pos++ = 0x0; |
| 680 | *pos++ = ieee80211_frequency_to_channel( |
| 681 | csa->settings.chandef.chan->center_freq); |
Michal Kazior | af296bd | 2014-06-05 14:21:36 +0200 | [diff] [blame] | 682 | bcn->csa_counter_offsets[0] = hdr_len + 6; |
Chun-Yeow Yeoh | b8456a1 | 2013-10-17 15:55:02 -0700 | [diff] [blame] | 683 | *pos++ = csa->settings.count; |
| 684 | *pos++ = WLAN_EID_CHAN_SWITCH_PARAM; |
| 685 | *pos++ = 6; |
Luciano Coelho | 0cb4d4d | 2014-01-13 19:42:58 +0200 | [diff] [blame] | 686 | if (ifmsh->csa_role == IEEE80211_MESH_CSA_ROLE_INIT) { |
Chun-Yeow Yeoh | b8456a1 | 2013-10-17 15:55:02 -0700 | [diff] [blame] | 687 | *pos++ = ifmsh->mshcfg.dot11MeshTTL; |
| 688 | *pos |= WLAN_EID_CHAN_SWITCH_PARAM_INITIATOR; |
| 689 | } else { |
| 690 | *pos++ = ifmsh->chsw_ttl; |
| 691 | } |
| 692 | *pos++ |= csa->settings.block_tx ? |
| 693 | WLAN_EID_CHAN_SWITCH_PARAM_TX_RESTRICT : 0x00; |
| 694 | put_unaligned_le16(WLAN_REASON_MESH_CHAN, pos); |
| 695 | pos += 2; |
Chun-Yeow Yeoh | ca91dc9 | 2013-11-12 10:31:48 +0800 | [diff] [blame] | 696 | put_unaligned_le16(ifmsh->pre_value, pos); |
Chun-Yeow Yeoh | b8456a1 | 2013-10-17 15:55:02 -0700 | [diff] [blame] | 697 | pos += 2; |
| 698 | } |
| 699 | rcu_read_unlock(); |
| 700 | |
Thomas Pedersen | 2b5e196 | 2013-02-14 11:20:13 -0800 | [diff] [blame] | 701 | if (ieee80211_add_srates_ie(sdata, skb, true, band) || |
Johannes Berg | bf7cd94 | 2013-02-15 14:40:31 +0100 | [diff] [blame] | 702 | mesh_add_ds_params_ie(sdata, skb)) |
Thomas Pedersen | 2b5e196 | 2013-02-14 11:20:13 -0800 | [diff] [blame] | 703 | goto out_free; |
| 704 | |
| 705 | bcn->head_len = skb->len; |
| 706 | memcpy(bcn->head, skb->data, bcn->head_len); |
| 707 | |
| 708 | /* now the tail */ |
| 709 | skb_trim(skb, 0); |
| 710 | bcn->tail = bcn->head + bcn->head_len; |
| 711 | |
| 712 | if (ieee80211_add_ext_srates_ie(sdata, skb, true, band) || |
Johannes Berg | bf7cd94 | 2013-02-15 14:40:31 +0100 | [diff] [blame] | 713 | mesh_add_rsn_ie(sdata, skb) || |
| 714 | mesh_add_ht_cap_ie(sdata, skb) || |
| 715 | mesh_add_ht_oper_ie(sdata, skb) || |
| 716 | mesh_add_meshid_ie(sdata, skb) || |
| 717 | mesh_add_meshconf_ie(sdata, skb) || |
| 718 | mesh_add_awake_window_ie(sdata, skb) || |
| 719 | mesh_add_vendor_ies(sdata, skb)) |
Thomas Pedersen | 2b5e196 | 2013-02-14 11:20:13 -0800 | [diff] [blame] | 720 | goto out_free; |
| 721 | |
| 722 | bcn->tail_len = skb->len; |
| 723 | memcpy(bcn->tail, skb->data, bcn->tail_len); |
Thomas Pedersen | 43552be | 2013-12-15 13:14:16 -0800 | [diff] [blame] | 724 | bcn->meshconf = (struct ieee80211_meshconf_ie *) |
| 725 | (bcn->tail + ifmsh->meshconf_offset); |
Thomas Pedersen | 2b5e196 | 2013-02-14 11:20:13 -0800 | [diff] [blame] | 726 | |
| 727 | dev_kfree_skb(skb); |
| 728 | rcu_assign_pointer(ifmsh->beacon, bcn); |
| 729 | return 0; |
| 730 | out_free: |
| 731 | kfree(bcn); |
| 732 | dev_kfree_skb(skb); |
| 733 | return -ENOMEM; |
| 734 | } |
| 735 | |
| 736 | static int |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 737 | ieee80211_mesh_rebuild_beacon(struct ieee80211_sub_if_data *sdata) |
Thomas Pedersen | 2b5e196 | 2013-02-14 11:20:13 -0800 | [diff] [blame] | 738 | { |
Thomas Pedersen | 2b5e196 | 2013-02-14 11:20:13 -0800 | [diff] [blame] | 739 | struct beacon_data *old_bcn; |
| 740 | int ret; |
Thomas Pedersen | 2b5e196 | 2013-02-14 11:20:13 -0800 | [diff] [blame] | 741 | |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 742 | old_bcn = rcu_dereference_protected(sdata->u.mesh.beacon, |
| 743 | lockdep_is_held(&sdata->wdev.mtx)); |
| 744 | ret = ieee80211_mesh_build_beacon(&sdata->u.mesh); |
Thomas Pedersen | 2b5e196 | 2013-02-14 11:20:13 -0800 | [diff] [blame] | 745 | if (ret) |
| 746 | /* just reuse old beacon */ |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 747 | return ret; |
Thomas Pedersen | 2b5e196 | 2013-02-14 11:20:13 -0800 | [diff] [blame] | 748 | |
| 749 | if (old_bcn) |
| 750 | kfree_rcu(old_bcn, rcu_head); |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 751 | return 0; |
Thomas Pedersen | 2b5e196 | 2013-02-14 11:20:13 -0800 | [diff] [blame] | 752 | } |
| 753 | |
| 754 | void ieee80211_mbss_info_change_notify(struct ieee80211_sub_if_data *sdata, |
| 755 | u32 changed) |
| 756 | { |
Thomas Pedersen | f81a9de | 2013-06-13 15:54:41 -0700 | [diff] [blame] | 757 | struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; |
| 758 | unsigned long bits = changed; |
| 759 | u32 bit; |
| 760 | |
| 761 | if (!bits) |
| 762 | return; |
| 763 | |
| 764 | /* if we race with running work, worst case this work becomes a noop */ |
| 765 | for_each_set_bit(bit, &bits, sizeof(changed) * BITS_PER_BYTE) |
| 766 | set_bit(bit, &ifmsh->mbss_changed); |
| 767 | set_bit(MESH_WORK_MBSS_CHANGED, &ifmsh->wrkq_flags); |
| 768 | ieee80211_queue_work(&sdata->local->hw, &sdata->work); |
Thomas Pedersen | 2b5e196 | 2013-02-14 11:20:13 -0800 | [diff] [blame] | 769 | } |
| 770 | |
| 771 | int ieee80211_start_mesh(struct ieee80211_sub_if_data *sdata) |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 772 | { |
| 773 | struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; |
| 774 | struct ieee80211_local *local = sdata->local; |
Chun-Yeow Yeoh | f4eabc9 | 2012-12-13 18:59:57 +0800 | [diff] [blame] | 775 | u32 changed = BSS_CHANGED_BEACON | |
| 776 | BSS_CHANGED_BEACON_ENABLED | |
| 777 | BSS_CHANGED_HT | |
| 778 | BSS_CHANGED_BASIC_RATES | |
| 779 | BSS_CHANGED_BEACON_INT; |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 780 | |
Johannes Berg | 09b1747 | 2010-12-03 09:20:41 +0100 | [diff] [blame] | 781 | local->fif_other_bss++; |
| 782 | /* mesh ifaces must set allmulti to forward mcast traffic */ |
| 783 | atomic_inc(&local->iff_allmultis); |
| 784 | ieee80211_configure_filter(local); |
| 785 | |
Javier Cardona | c7108a7 | 2010-12-16 17:37:50 -0800 | [diff] [blame] | 786 | ifmsh->mesh_cc_id = 0; /* Disabled */ |
Javier Cardona | dbf498f | 2012-03-31 11:31:32 -0700 | [diff] [blame] | 787 | /* register sync ops from extensible synchronization framework */ |
| 788 | ifmsh->sync_ops = ieee80211_mesh_sync_ops_get(ifmsh->mesh_sp_id); |
| 789 | ifmsh->adjusting_tbtt = false; |
| 790 | ifmsh->sync_offset_clockdrift_max = 0; |
Rui Paulo | 6b9ac44 | 2009-10-20 21:21:48 +0100 | [diff] [blame] | 791 | set_bit(MESH_WORK_HOUSEKEEPING, &ifmsh->wrkq_flags); |
Rui Paulo | 63c5723 | 2009-11-09 23:46:57 +0000 | [diff] [blame] | 792 | ieee80211_mesh_root_setup(ifmsh); |
Johannes Berg | 64592c8 | 2010-06-10 10:21:31 +0200 | [diff] [blame] | 793 | ieee80211_queue_work(&local->hw, &sdata->work); |
Ashok Nagarajan | 70c33ea | 2012-04-30 14:20:32 -0700 | [diff] [blame] | 794 | sdata->vif.bss_conf.ht_operation_mode = |
| 795 | ifmsh->mshcfg.ht_opmode; |
Johannes Berg | d6a8322 | 2012-12-14 14:06:28 +0100 | [diff] [blame] | 796 | sdata->vif.bss_conf.enable_beacon = true; |
Chun-Yeow Yeoh | f4eabc9 | 2012-12-13 18:59:57 +0800 | [diff] [blame] | 797 | |
Thomas Pedersen | 39886b6 | 2013-02-13 12:14:19 -0800 | [diff] [blame] | 798 | changed |= ieee80211_mps_local_status_update(sdata); |
Marco Porsch | 3f52b7e | 2013-01-30 18:14:08 +0100 | [diff] [blame] | 799 | |
Thomas Pedersen | 2b5e196 | 2013-02-14 11:20:13 -0800 | [diff] [blame] | 800 | if (ieee80211_mesh_build_beacon(ifmsh)) { |
| 801 | ieee80211_stop_mesh(sdata); |
| 802 | return -ENOMEM; |
| 803 | } |
| 804 | |
Thomas Pedersen | 057d5f4 | 2013-12-19 10:25:15 -0800 | [diff] [blame] | 805 | ieee80211_recalc_dtim(local, sdata); |
Chun-Yeow Yeoh | f4eabc9 | 2012-12-13 18:59:57 +0800 | [diff] [blame] | 806 | ieee80211_bss_info_change_notify(sdata, changed); |
Johannes Berg | c405c62 | 2012-07-30 19:44:12 +0200 | [diff] [blame] | 807 | |
| 808 | netif_carrier_on(sdata->dev); |
Thomas Pedersen | 2b5e196 | 2013-02-14 11:20:13 -0800 | [diff] [blame] | 809 | return 0; |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 810 | } |
| 811 | |
| 812 | void ieee80211_stop_mesh(struct ieee80211_sub_if_data *sdata) |
| 813 | { |
Johannes Berg | 09b1747 | 2010-12-03 09:20:41 +0100 | [diff] [blame] | 814 | struct ieee80211_local *local = sdata->local; |
Johannes Berg | 29cbe68 | 2010-12-03 09:20:44 +0100 | [diff] [blame] | 815 | struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; |
Thomas Pedersen | 2b5e196 | 2013-02-14 11:20:13 -0800 | [diff] [blame] | 816 | struct beacon_data *bcn; |
Johannes Berg | 29cbe68 | 2010-12-03 09:20:44 +0100 | [diff] [blame] | 817 | |
Johannes Berg | c405c62 | 2012-07-30 19:44:12 +0200 | [diff] [blame] | 818 | netif_carrier_off(sdata->dev); |
| 819 | |
Thomas Pedersen | 0d466b9c | 2012-08-03 12:21:32 -0700 | [diff] [blame] | 820 | /* stop the beacon */ |
Johannes Berg | 29cbe68 | 2010-12-03 09:20:44 +0100 | [diff] [blame] | 821 | ifmsh->mesh_id_len = 0; |
Johannes Berg | d6a8322 | 2012-12-14 14:06:28 +0100 | [diff] [blame] | 822 | sdata->vif.bss_conf.enable_beacon = false; |
| 823 | clear_bit(SDATA_STATE_OFFCHANNEL_BEACON_STOPPED, &sdata->state); |
Johannes Berg | 29cbe68 | 2010-12-03 09:20:44 +0100 | [diff] [blame] | 824 | ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_BEACON_ENABLED); |
Thomas Pedersen | 2b5e196 | 2013-02-14 11:20:13 -0800 | [diff] [blame] | 825 | bcn = rcu_dereference_protected(ifmsh->beacon, |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 826 | lockdep_is_held(&sdata->wdev.mtx)); |
Monam Agarwal | 0c2bef46 | 2014-03-24 00:51:43 +0530 | [diff] [blame] | 827 | RCU_INIT_POINTER(ifmsh->beacon, NULL); |
Thomas Pedersen | 2b5e196 | 2013-02-14 11:20:13 -0800 | [diff] [blame] | 828 | kfree_rcu(bcn, rcu_head); |
Thomas Pedersen | 0d466b9c | 2012-08-03 12:21:32 -0700 | [diff] [blame] | 829 | |
| 830 | /* flush STAs and mpaths on this iface */ |
Johannes Berg | b998e8b | 2012-12-13 23:07:46 +0100 | [diff] [blame] | 831 | sta_info_flush(sdata); |
Thomas Pedersen | 0d466b9c | 2012-08-03 12:21:32 -0700 | [diff] [blame] | 832 | mesh_path_flush_by_iface(sdata); |
Johannes Berg | 09b1747 | 2010-12-03 09:20:41 +0100 | [diff] [blame] | 833 | |
Marco Porsch | 3f52b7e | 2013-01-30 18:14:08 +0100 | [diff] [blame] | 834 | /* free all potentially still buffered group-addressed frames */ |
| 835 | local->total_ps_buffered -= skb_queue_len(&ifmsh->ps.bc_buf); |
| 836 | skb_queue_purge(&ifmsh->ps.bc_buf); |
| 837 | |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 838 | del_timer_sync(&sdata->u.mesh.housekeeping_timer); |
Rui Paulo | e304bfd | 2009-11-09 23:46:56 +0000 | [diff] [blame] | 839 | del_timer_sync(&sdata->u.mesh.mesh_path_root_timer); |
Johannes Berg | dd4c926 | 2012-08-01 21:03:21 +0200 | [diff] [blame] | 840 | del_timer_sync(&sdata->u.mesh.mesh_path_timer); |
Johannes Berg | 09b1747 | 2010-12-03 09:20:41 +0100 | [diff] [blame] | 841 | |
Thomas Pedersen | f81a9de | 2013-06-13 15:54:41 -0700 | [diff] [blame] | 842 | /* clear any mesh work (for next join) we may have accrued */ |
| 843 | ifmsh->wrkq_flags = 0; |
| 844 | ifmsh->mbss_changed = 0; |
| 845 | |
Johannes Berg | 09b1747 | 2010-12-03 09:20:41 +0100 | [diff] [blame] | 846 | local->fif_other_bss--; |
| 847 | atomic_dec(&local->iff_allmultis); |
| 848 | ieee80211_configure_filter(local); |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 849 | } |
| 850 | |
Chun-Yeow Yeoh | 33a4586 | 2013-10-17 15:55:18 -0700 | [diff] [blame] | 851 | static bool |
| 852 | ieee80211_mesh_process_chnswitch(struct ieee80211_sub_if_data *sdata, |
| 853 | struct ieee802_11_elems *elems, bool beacon) |
| 854 | { |
| 855 | struct cfg80211_csa_settings params; |
| 856 | struct ieee80211_csa_ie csa_ie; |
Chun-Yeow Yeoh | 33a4586 | 2013-10-17 15:55:18 -0700 | [diff] [blame] | 857 | struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; |
| 858 | enum ieee80211_band band = ieee80211_get_sdata_band(sdata); |
Luciano Coelho | 0cb4d4d | 2014-01-13 19:42:58 +0200 | [diff] [blame] | 859 | int err; |
Chun-Yeow Yeoh | 33a4586 | 2013-10-17 15:55:18 -0700 | [diff] [blame] | 860 | u32 sta_flags; |
| 861 | |
Michal Kazior | dbd7285 | 2014-01-29 07:56:21 +0100 | [diff] [blame] | 862 | sdata_assert_lock(sdata); |
| 863 | |
Chun-Yeow Yeoh | 33a4586 | 2013-10-17 15:55:18 -0700 | [diff] [blame] | 864 | sta_flags = IEEE80211_STA_DISABLE_VHT; |
| 865 | switch (sdata->vif.bss_conf.chandef.width) { |
| 866 | case NL80211_CHAN_WIDTH_20_NOHT: |
| 867 | sta_flags |= IEEE80211_STA_DISABLE_HT; |
| 868 | case NL80211_CHAN_WIDTH_20: |
| 869 | sta_flags |= IEEE80211_STA_DISABLE_40MHZ; |
| 870 | break; |
| 871 | default: |
| 872 | break; |
| 873 | } |
| 874 | |
| 875 | memset(¶ms, 0, sizeof(params)); |
| 876 | memset(&csa_ie, 0, sizeof(csa_ie)); |
Luciano Coelho | 84469a4 | 2014-10-28 13:33:04 +0200 | [diff] [blame] | 877 | err = ieee80211_parse_ch_switch_ie(sdata, elems, band, |
Chun-Yeow Yeoh | 33a4586 | 2013-10-17 15:55:18 -0700 | [diff] [blame] | 878 | sta_flags, sdata->vif.addr, |
| 879 | &csa_ie); |
| 880 | if (err < 0) |
| 881 | return false; |
| 882 | if (err) |
| 883 | return false; |
| 884 | |
| 885 | params.chandef = csa_ie.chandef; |
| 886 | params.count = csa_ie.count; |
| 887 | |
Chun-Yeow Yeoh | 33a4586 | 2013-10-17 15:55:18 -0700 | [diff] [blame] | 888 | if (!cfg80211_chandef_usable(sdata->local->hw.wiphy, ¶ms.chandef, |
| 889 | IEEE80211_CHAN_DISABLED)) { |
| 890 | sdata_info(sdata, |
| 891 | "mesh STA %pM switches to unsupported channel (%d MHz, width:%d, CF1/2: %d/%d MHz), aborting\n", |
| 892 | sdata->vif.addr, |
| 893 | params.chandef.chan->center_freq, |
| 894 | params.chandef.width, |
| 895 | params.chandef.center_freq1, |
| 896 | params.chandef.center_freq2); |
| 897 | return false; |
| 898 | } |
| 899 | |
| 900 | err = cfg80211_chandef_dfs_required(sdata->local->hw.wiphy, |
Luciano Coelho | 2beb6dab | 2014-02-18 11:40:36 +0200 | [diff] [blame] | 901 | ¶ms.chandef, |
| 902 | NL80211_IFTYPE_MESH_POINT); |
Chun-Yeow Yeoh | 33a4586 | 2013-10-17 15:55:18 -0700 | [diff] [blame] | 903 | if (err < 0) |
| 904 | return false; |
Luciano Coelho | 2beb6dab | 2014-02-18 11:40:36 +0200 | [diff] [blame] | 905 | if (err > 0) |
Chun-Yeow Yeoh | 33a4586 | 2013-10-17 15:55:18 -0700 | [diff] [blame] | 906 | /* TODO: DFS not (yet) supported */ |
| 907 | return false; |
Luciano Coelho | 2beb6dab | 2014-02-18 11:40:36 +0200 | [diff] [blame] | 908 | |
| 909 | params.radar_required = err; |
Chun-Yeow Yeoh | 33a4586 | 2013-10-17 15:55:18 -0700 | [diff] [blame] | 910 | |
Luciano Coelho | 0cb4d4d | 2014-01-13 19:42:58 +0200 | [diff] [blame] | 911 | if (cfg80211_chandef_identical(¶ms.chandef, |
| 912 | &sdata->vif.bss_conf.chandef)) { |
| 913 | mcsa_dbg(sdata, |
| 914 | "received csa with an identical chandef, ignoring\n"); |
| 915 | return true; |
| 916 | } |
Chun-Yeow Yeoh | 33a4586 | 2013-10-17 15:55:18 -0700 | [diff] [blame] | 917 | |
| 918 | mcsa_dbg(sdata, |
| 919 | "received channel switch announcement to go to channel %d MHz\n", |
| 920 | params.chandef.chan->center_freq); |
| 921 | |
| 922 | params.block_tx = csa_ie.mode & WLAN_EID_CHAN_SWITCH_PARAM_TX_RESTRICT; |
Chun-Yeow Yeoh | 3f718fd | 2013-11-08 15:09:43 +0800 | [diff] [blame] | 923 | if (beacon) { |
Chun-Yeow Yeoh | 33a4586 | 2013-10-17 15:55:18 -0700 | [diff] [blame] | 924 | ifmsh->chsw_ttl = csa_ie.ttl - 1; |
Chun-Yeow Yeoh | 3f718fd | 2013-11-08 15:09:43 +0800 | [diff] [blame] | 925 | if (ifmsh->pre_value >= csa_ie.pre_value) |
| 926 | return false; |
| 927 | ifmsh->pre_value = csa_ie.pre_value; |
| 928 | } |
Chun-Yeow Yeoh | 33a4586 | 2013-10-17 15:55:18 -0700 | [diff] [blame] | 929 | |
Luciano Coelho | 0cb4d4d | 2014-01-13 19:42:58 +0200 | [diff] [blame] | 930 | if (ifmsh->chsw_ttl >= ifmsh->mshcfg.dot11MeshTTL) |
Chun-Yeow Yeoh | 3f718fd | 2013-11-08 15:09:43 +0800 | [diff] [blame] | 931 | return false; |
Chun-Yeow Yeoh | 33a4586 | 2013-10-17 15:55:18 -0700 | [diff] [blame] | 932 | |
Luciano Coelho | 0cb4d4d | 2014-01-13 19:42:58 +0200 | [diff] [blame] | 933 | ifmsh->csa_role = IEEE80211_MESH_CSA_ROLE_REPEATER; |
Chun-Yeow Yeoh | 33a4586 | 2013-10-17 15:55:18 -0700 | [diff] [blame] | 934 | |
Luciano Coelho | 0cb4d4d | 2014-01-13 19:42:58 +0200 | [diff] [blame] | 935 | if (ieee80211_channel_switch(sdata->local->hw.wiphy, sdata->dev, |
| 936 | ¶ms) < 0) |
| 937 | return false; |
Chun-Yeow Yeoh | 33a4586 | 2013-10-17 15:55:18 -0700 | [diff] [blame] | 938 | |
| 939 | return true; |
Chun-Yeow Yeoh | 33a4586 | 2013-10-17 15:55:18 -0700 | [diff] [blame] | 940 | } |
| 941 | |
Thomas Pedersen | 9fb04b5 | 2013-02-14 11:20:14 -0800 | [diff] [blame] | 942 | static void |
| 943 | ieee80211_mesh_rx_probe_req(struct ieee80211_sub_if_data *sdata, |
| 944 | struct ieee80211_mgmt *mgmt, size_t len) |
| 945 | { |
| 946 | struct ieee80211_local *local = sdata->local; |
| 947 | struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; |
| 948 | struct sk_buff *presp; |
| 949 | struct beacon_data *bcn; |
| 950 | struct ieee80211_mgmt *hdr; |
| 951 | struct ieee802_11_elems elems; |
| 952 | size_t baselen; |
Johannes Berg | 511044e | 2013-03-07 22:47:00 +0100 | [diff] [blame] | 953 | u8 *pos; |
Thomas Pedersen | 9fb04b5 | 2013-02-14 11:20:14 -0800 | [diff] [blame] | 954 | |
Thomas Pedersen | 9fb04b5 | 2013-02-14 11:20:14 -0800 | [diff] [blame] | 955 | pos = mgmt->u.probe_req.variable; |
| 956 | baselen = (u8 *) pos - (u8 *) mgmt; |
| 957 | if (baselen > len) |
| 958 | return; |
| 959 | |
Johannes Berg | b2e506b | 2013-03-26 14:54:16 +0100 | [diff] [blame] | 960 | ieee802_11_parse_elems(pos, len - baselen, false, &elems); |
Thomas Pedersen | 9fb04b5 | 2013-02-14 11:20:14 -0800 | [diff] [blame] | 961 | |
Chun-Yeow Yeoh | a4ef66a | 2013-08-22 10:28:58 -0700 | [diff] [blame] | 962 | if (!elems.mesh_id) |
| 963 | return; |
| 964 | |
Thomas Pedersen | 9fb04b5 | 2013-02-14 11:20:14 -0800 | [diff] [blame] | 965 | /* 802.11-2012 10.1.4.3.2 */ |
| 966 | if ((!ether_addr_equal(mgmt->da, sdata->vif.addr) && |
| 967 | !is_broadcast_ether_addr(mgmt->da)) || |
| 968 | elems.ssid_len != 0) |
| 969 | return; |
| 970 | |
| 971 | if (elems.mesh_id_len != 0 && |
| 972 | (elems.mesh_id_len != ifmsh->mesh_id_len || |
| 973 | memcmp(elems.mesh_id, ifmsh->mesh_id, ifmsh->mesh_id_len))) |
| 974 | return; |
| 975 | |
| 976 | rcu_read_lock(); |
| 977 | bcn = rcu_dereference(ifmsh->beacon); |
| 978 | |
| 979 | if (!bcn) |
| 980 | goto out; |
| 981 | |
| 982 | presp = dev_alloc_skb(local->tx_headroom + |
| 983 | bcn->head_len + bcn->tail_len); |
| 984 | if (!presp) |
| 985 | goto out; |
| 986 | |
| 987 | skb_reserve(presp, local->tx_headroom); |
| 988 | memcpy(skb_put(presp, bcn->head_len), bcn->head, bcn->head_len); |
| 989 | memcpy(skb_put(presp, bcn->tail_len), bcn->tail, bcn->tail_len); |
| 990 | hdr = (struct ieee80211_mgmt *) presp->data; |
| 991 | hdr->frame_control = cpu_to_le16(IEEE80211_FTYPE_MGMT | |
| 992 | IEEE80211_STYPE_PROBE_RESP); |
| 993 | memcpy(hdr->da, mgmt->sa, ETH_ALEN); |
Thomas Pedersen | 9fb04b5 | 2013-02-14 11:20:14 -0800 | [diff] [blame] | 994 | IEEE80211_SKB_CB(presp)->flags |= IEEE80211_TX_INTFL_DONT_ENCRYPT; |
| 995 | ieee80211_tx_skb(sdata, presp); |
| 996 | out: |
| 997 | rcu_read_unlock(); |
| 998 | } |
| 999 | |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 1000 | static void ieee80211_mesh_rx_bcn_presp(struct ieee80211_sub_if_data *sdata, |
| 1001 | u16 stype, |
| 1002 | struct ieee80211_mgmt *mgmt, |
| 1003 | size_t len, |
| 1004 | struct ieee80211_rx_status *rx_status) |
| 1005 | { |
Johannes Berg | c6a1fa1 | 2008-10-07 12:04:32 +0200 | [diff] [blame] | 1006 | struct ieee80211_local *local = sdata->local; |
Javier Cardona | dbf498f | 2012-03-31 11:31:32 -0700 | [diff] [blame] | 1007 | struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 1008 | struct ieee802_11_elems elems; |
| 1009 | struct ieee80211_channel *channel; |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 1010 | size_t baselen; |
| 1011 | int freq; |
| 1012 | enum ieee80211_band band = rx_status->band; |
| 1013 | |
| 1014 | /* ignore ProbeResp to foreign address */ |
| 1015 | if (stype == IEEE80211_STYPE_PROBE_RESP && |
Joe Perches | b203ca3 | 2012-05-08 18:56:52 +0000 | [diff] [blame] | 1016 | !ether_addr_equal(mgmt->da, sdata->vif.addr)) |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 1017 | return; |
| 1018 | |
| 1019 | baselen = (u8 *) mgmt->u.probe_resp.variable - (u8 *) mgmt; |
| 1020 | if (baselen > len) |
| 1021 | return; |
| 1022 | |
| 1023 | ieee802_11_parse_elems(mgmt->u.probe_resp.variable, len - baselen, |
Johannes Berg | b2e506b | 2013-03-26 14:54:16 +0100 | [diff] [blame] | 1024 | false, &elems); |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 1025 | |
Thomas Pedersen | 9a90bc8 | 2012-10-20 19:03:10 -0700 | [diff] [blame] | 1026 | /* ignore non-mesh or secure / unsecure mismatch */ |
| 1027 | if ((!elems.mesh_id || !elems.mesh_config) || |
| 1028 | (elems.rsn && sdata->u.mesh.security == IEEE80211_MESH_SEC_NONE) || |
| 1029 | (!elems.rsn && sdata->u.mesh.security != IEEE80211_MESH_SEC_NONE)) |
Javier Cardona | 5cff5e0 | 2011-04-07 15:08:29 -0700 | [diff] [blame] | 1030 | return; |
| 1031 | |
Johannes Berg | 1cd8e88 | 2013-03-27 14:30:12 +0100 | [diff] [blame] | 1032 | if (elems.ds_params) |
Bruno Randolf | 59eb21a | 2011-01-17 13:37:28 +0900 | [diff] [blame] | 1033 | freq = ieee80211_channel_to_frequency(elems.ds_params[0], band); |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 1034 | else |
| 1035 | freq = rx_status->freq; |
| 1036 | |
| 1037 | channel = ieee80211_get_channel(local->hw.wiphy, freq); |
| 1038 | |
| 1039 | if (!channel || channel->flags & IEEE80211_CHAN_DISABLED) |
| 1040 | return; |
| 1041 | |
Thomas Pedersen | 9a90bc8 | 2012-10-20 19:03:10 -0700 | [diff] [blame] | 1042 | if (mesh_matches_local(sdata, &elems)) |
Thomas Pedersen | f743ff4 | 2012-04-18 19:23:43 -0700 | [diff] [blame] | 1043 | mesh_neighbour_update(sdata, mgmt->sa, &elems); |
Javier Cardona | dbf498f | 2012-03-31 11:31:32 -0700 | [diff] [blame] | 1044 | |
| 1045 | if (ifmsh->sync_ops) |
| 1046 | ifmsh->sync_ops->rx_bcn_presp(sdata, |
| 1047 | stype, mgmt, &elems, rx_status); |
Chun-Yeow Yeoh | 33a4586 | 2013-10-17 15:55:18 -0700 | [diff] [blame] | 1048 | |
Luciano Coelho | 0cb4d4d | 2014-01-13 19:42:58 +0200 | [diff] [blame] | 1049 | if (ifmsh->csa_role != IEEE80211_MESH_CSA_ROLE_INIT && |
| 1050 | !sdata->vif.csa_active) |
Chun-Yeow Yeoh | 33a4586 | 2013-10-17 15:55:18 -0700 | [diff] [blame] | 1051 | ieee80211_mesh_process_chnswitch(sdata, &elems, true); |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 1052 | } |
| 1053 | |
Chun-Yeow Yeoh | b8456a1 | 2013-10-17 15:55:02 -0700 | [diff] [blame] | 1054 | int ieee80211_mesh_finish_csa(struct ieee80211_sub_if_data *sdata) |
| 1055 | { |
| 1056 | struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; |
| 1057 | struct mesh_csa_settings *tmp_csa_settings; |
| 1058 | int ret = 0; |
Michal Kazior | faf046e | 2014-01-29 07:56:17 +0100 | [diff] [blame] | 1059 | int changed = 0; |
Chun-Yeow Yeoh | b8456a1 | 2013-10-17 15:55:02 -0700 | [diff] [blame] | 1060 | |
| 1061 | /* Reset the TTL value and Initiator flag */ |
Luciano Coelho | 0cb4d4d | 2014-01-13 19:42:58 +0200 | [diff] [blame] | 1062 | ifmsh->csa_role = IEEE80211_MESH_CSA_ROLE_NONE; |
Chun-Yeow Yeoh | b8456a1 | 2013-10-17 15:55:02 -0700 | [diff] [blame] | 1063 | ifmsh->chsw_ttl = 0; |
| 1064 | |
| 1065 | /* Remove the CSA and MCSP elements from the beacon */ |
| 1066 | tmp_csa_settings = rcu_dereference(ifmsh->csa); |
Monam Agarwal | 0c2bef46 | 2014-03-24 00:51:43 +0530 | [diff] [blame] | 1067 | RCU_INIT_POINTER(ifmsh->csa, NULL); |
Luciano Coelho | 66e01cf | 2014-01-13 19:43:00 +0200 | [diff] [blame] | 1068 | if (tmp_csa_settings) |
| 1069 | kfree_rcu(tmp_csa_settings, rcu_head); |
Chun-Yeow Yeoh | b8456a1 | 2013-10-17 15:55:02 -0700 | [diff] [blame] | 1070 | ret = ieee80211_mesh_rebuild_beacon(sdata); |
| 1071 | if (ret) |
| 1072 | return -EINVAL; |
| 1073 | |
Michal Kazior | faf046e | 2014-01-29 07:56:17 +0100 | [diff] [blame] | 1074 | changed |= BSS_CHANGED_BEACON; |
Chun-Yeow Yeoh | b8456a1 | 2013-10-17 15:55:02 -0700 | [diff] [blame] | 1075 | |
| 1076 | mcsa_dbg(sdata, "complete switching to center freq %d MHz", |
| 1077 | sdata->vif.bss_conf.chandef.chan->center_freq); |
Michal Kazior | faf046e | 2014-01-29 07:56:17 +0100 | [diff] [blame] | 1078 | return changed; |
Chun-Yeow Yeoh | b8456a1 | 2013-10-17 15:55:02 -0700 | [diff] [blame] | 1079 | } |
| 1080 | |
| 1081 | int ieee80211_mesh_csa_beacon(struct ieee80211_sub_if_data *sdata, |
Luciano Coelho | 66e01cf | 2014-01-13 19:43:00 +0200 | [diff] [blame] | 1082 | struct cfg80211_csa_settings *csa_settings) |
Chun-Yeow Yeoh | b8456a1 | 2013-10-17 15:55:02 -0700 | [diff] [blame] | 1083 | { |
| 1084 | struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; |
| 1085 | struct mesh_csa_settings *tmp_csa_settings; |
| 1086 | int ret = 0; |
| 1087 | |
| 1088 | tmp_csa_settings = kmalloc(sizeof(*tmp_csa_settings), |
| 1089 | GFP_ATOMIC); |
| 1090 | if (!tmp_csa_settings) |
| 1091 | return -ENOMEM; |
| 1092 | |
| 1093 | memcpy(&tmp_csa_settings->settings, csa_settings, |
| 1094 | sizeof(struct cfg80211_csa_settings)); |
| 1095 | |
| 1096 | rcu_assign_pointer(ifmsh->csa, tmp_csa_settings); |
| 1097 | |
| 1098 | ret = ieee80211_mesh_rebuild_beacon(sdata); |
| 1099 | if (ret) { |
| 1100 | tmp_csa_settings = rcu_dereference(ifmsh->csa); |
Monam Agarwal | 0c2bef46 | 2014-03-24 00:51:43 +0530 | [diff] [blame] | 1101 | RCU_INIT_POINTER(ifmsh->csa, NULL); |
Chun-Yeow Yeoh | b8456a1 | 2013-10-17 15:55:02 -0700 | [diff] [blame] | 1102 | kfree_rcu(tmp_csa_settings, rcu_head); |
| 1103 | return ret; |
| 1104 | } |
| 1105 | |
Luciano Coelho | b58e81e | 2014-01-13 19:42:59 +0200 | [diff] [blame] | 1106 | return BSS_CHANGED_BEACON; |
Chun-Yeow Yeoh | b8456a1 | 2013-10-17 15:55:02 -0700 | [diff] [blame] | 1107 | } |
| 1108 | |
Chun-Yeow Yeoh | 8f2535b | 2013-10-14 19:08:27 -0700 | [diff] [blame] | 1109 | static int mesh_fwd_csa_frame(struct ieee80211_sub_if_data *sdata, |
| 1110 | struct ieee80211_mgmt *mgmt, size_t len) |
| 1111 | { |
| 1112 | struct ieee80211_mgmt *mgmt_fwd; |
| 1113 | struct sk_buff *skb; |
| 1114 | struct ieee80211_local *local = sdata->local; |
| 1115 | u8 *pos = mgmt->u.action.u.chan_switch.variable; |
| 1116 | size_t offset_ttl; |
| 1117 | |
| 1118 | skb = dev_alloc_skb(local->tx_headroom + len); |
| 1119 | if (!skb) |
| 1120 | return -ENOMEM; |
| 1121 | skb_reserve(skb, local->tx_headroom); |
| 1122 | mgmt_fwd = (struct ieee80211_mgmt *) skb_put(skb, len); |
| 1123 | |
| 1124 | /* offset_ttl is based on whether the secondary channel |
Antonio Ospite | b314c66 | 2014-06-04 14:03:49 +0200 | [diff] [blame] | 1125 | * offset is available or not. Subtract 1 from the mesh TTL |
Chun-Yeow Yeoh | 8f2535b | 2013-10-14 19:08:27 -0700 | [diff] [blame] | 1126 | * and disable the initiator flag before forwarding. |
| 1127 | */ |
| 1128 | offset_ttl = (len < 42) ? 7 : 10; |
| 1129 | *(pos + offset_ttl) -= 1; |
| 1130 | *(pos + offset_ttl + 1) &= ~WLAN_EID_CHAN_SWITCH_PARAM_INITIATOR; |
| 1131 | |
| 1132 | memcpy(mgmt_fwd, mgmt, len); |
| 1133 | eth_broadcast_addr(mgmt_fwd->da); |
| 1134 | memcpy(mgmt_fwd->sa, sdata->vif.addr, ETH_ALEN); |
| 1135 | memcpy(mgmt_fwd->bssid, sdata->vif.addr, ETH_ALEN); |
| 1136 | |
| 1137 | ieee80211_tx_skb(sdata, skb); |
| 1138 | return 0; |
| 1139 | } |
| 1140 | |
| 1141 | static void mesh_rx_csa_frame(struct ieee80211_sub_if_data *sdata, |
| 1142 | struct ieee80211_mgmt *mgmt, size_t len) |
| 1143 | { |
| 1144 | struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; |
| 1145 | struct ieee802_11_elems elems; |
| 1146 | u16 pre_value; |
Chun-Yeow Yeoh | 33a4586 | 2013-10-17 15:55:18 -0700 | [diff] [blame] | 1147 | bool fwd_csa = true; |
Chun-Yeow Yeoh | 8f2535b | 2013-10-14 19:08:27 -0700 | [diff] [blame] | 1148 | size_t baselen; |
Chun-Yeow Yeoh | 3f718fd | 2013-11-08 15:09:43 +0800 | [diff] [blame] | 1149 | u8 *pos; |
Chun-Yeow Yeoh | 8f2535b | 2013-10-14 19:08:27 -0700 | [diff] [blame] | 1150 | |
| 1151 | if (mgmt->u.action.u.measurement.action_code != |
| 1152 | WLAN_ACTION_SPCT_CHL_SWITCH) |
| 1153 | return; |
| 1154 | |
| 1155 | pos = mgmt->u.action.u.chan_switch.variable; |
| 1156 | baselen = offsetof(struct ieee80211_mgmt, |
| 1157 | u.action.u.chan_switch.variable); |
| 1158 | ieee802_11_parse_elems(pos, len - baselen, false, &elems); |
| 1159 | |
Chun-Yeow Yeoh | 3f718fd | 2013-11-08 15:09:43 +0800 | [diff] [blame] | 1160 | ifmsh->chsw_ttl = elems.mesh_chansw_params_ie->mesh_ttl; |
| 1161 | if (!--ifmsh->chsw_ttl) |
Chun-Yeow Yeoh | 8f2535b | 2013-10-14 19:08:27 -0700 | [diff] [blame] | 1162 | fwd_csa = false; |
| 1163 | |
| 1164 | pre_value = le16_to_cpu(elems.mesh_chansw_params_ie->mesh_pre_value); |
| 1165 | if (ifmsh->pre_value >= pre_value) |
| 1166 | return; |
| 1167 | |
| 1168 | ifmsh->pre_value = pre_value; |
| 1169 | |
Luciano Coelho | 0cb4d4d | 2014-01-13 19:42:58 +0200 | [diff] [blame] | 1170 | if (!sdata->vif.csa_active && |
| 1171 | !ieee80211_mesh_process_chnswitch(sdata, &elems, false)) { |
Chun-Yeow Yeoh | 33a4586 | 2013-10-17 15:55:18 -0700 | [diff] [blame] | 1172 | mcsa_dbg(sdata, "Failed to process CSA action frame"); |
| 1173 | return; |
| 1174 | } |
| 1175 | |
Chun-Yeow Yeoh | 8f2535b | 2013-10-14 19:08:27 -0700 | [diff] [blame] | 1176 | /* forward or re-broadcast the CSA frame */ |
| 1177 | if (fwd_csa) { |
| 1178 | if (mesh_fwd_csa_frame(sdata, mgmt, len) < 0) |
| 1179 | mcsa_dbg(sdata, "Failed to forward the CSA frame"); |
| 1180 | } |
Chun-Yeow Yeoh | 8f2535b | 2013-10-14 19:08:27 -0700 | [diff] [blame] | 1181 | } |
| 1182 | |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 1183 | static void ieee80211_mesh_rx_mgmt_action(struct ieee80211_sub_if_data *sdata, |
| 1184 | struct ieee80211_mgmt *mgmt, |
| 1185 | size_t len, |
| 1186 | struct ieee80211_rx_status *rx_status) |
| 1187 | { |
| 1188 | switch (mgmt->u.action.category) { |
Thomas Pedersen | 8db0985 | 2011-08-12 20:01:00 -0700 | [diff] [blame] | 1189 | case WLAN_CATEGORY_SELF_PROTECTED: |
| 1190 | switch (mgmt->u.action.u.self_prot.action_code) { |
| 1191 | case WLAN_SP_MESH_PEERING_OPEN: |
| 1192 | case WLAN_SP_MESH_PEERING_CLOSE: |
| 1193 | case WLAN_SP_MESH_PEERING_CONFIRM: |
| 1194 | mesh_rx_plink_frame(sdata, mgmt, len, rx_status); |
| 1195 | break; |
| 1196 | } |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 1197 | break; |
Thomas Pedersen | 25d49e4 | 2011-08-11 19:35:15 -0700 | [diff] [blame] | 1198 | case WLAN_CATEGORY_MESH_ACTION: |
| 1199 | if (mesh_action_is_path_sel(mgmt)) |
| 1200 | mesh_rx_path_sel_frame(sdata, mgmt, len); |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 1201 | break; |
Chun-Yeow Yeoh | 8f2535b | 2013-10-14 19:08:27 -0700 | [diff] [blame] | 1202 | case WLAN_CATEGORY_SPECTRUM_MGMT: |
| 1203 | mesh_rx_csa_frame(sdata, mgmt, len); |
| 1204 | break; |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 1205 | } |
| 1206 | } |
| 1207 | |
Johannes Berg | 1fa57d0 | 2010-06-10 10:21:32 +0200 | [diff] [blame] | 1208 | void ieee80211_mesh_rx_queued_mgmt(struct ieee80211_sub_if_data *sdata, |
| 1209 | struct sk_buff *skb) |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 1210 | { |
| 1211 | struct ieee80211_rx_status *rx_status; |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 1212 | struct ieee80211_mgmt *mgmt; |
| 1213 | u16 stype; |
| 1214 | |
Thomas Pedersen | ecccd07 | 2013-06-10 13:17:21 -0700 | [diff] [blame] | 1215 | sdata_lock(sdata); |
| 1216 | |
| 1217 | /* mesh already went down */ |
Johannes Berg | 1693d34 | 2014-01-22 10:08:57 +0100 | [diff] [blame] | 1218 | if (!sdata->u.mesh.mesh_id_len) |
Thomas Pedersen | ecccd07 | 2013-06-10 13:17:21 -0700 | [diff] [blame] | 1219 | goto out; |
| 1220 | |
Johannes Berg | f1d58c2 | 2009-06-17 13:13:00 +0200 | [diff] [blame] | 1221 | rx_status = IEEE80211_SKB_RXCB(skb); |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 1222 | mgmt = (struct ieee80211_mgmt *) skb->data; |
| 1223 | stype = le16_to_cpu(mgmt->frame_control) & IEEE80211_FCTL_STYPE; |
| 1224 | |
| 1225 | switch (stype) { |
| 1226 | case IEEE80211_STYPE_PROBE_RESP: |
| 1227 | case IEEE80211_STYPE_BEACON: |
| 1228 | ieee80211_mesh_rx_bcn_presp(sdata, stype, mgmt, skb->len, |
| 1229 | rx_status); |
| 1230 | break; |
Thomas Pedersen | 9fb04b5 | 2013-02-14 11:20:14 -0800 | [diff] [blame] | 1231 | case IEEE80211_STYPE_PROBE_REQ: |
| 1232 | ieee80211_mesh_rx_probe_req(sdata, mgmt, skb->len); |
| 1233 | break; |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 1234 | case IEEE80211_STYPE_ACTION: |
| 1235 | ieee80211_mesh_rx_mgmt_action(sdata, mgmt, skb->len, rx_status); |
| 1236 | break; |
| 1237 | } |
Thomas Pedersen | ecccd07 | 2013-06-10 13:17:21 -0700 | [diff] [blame] | 1238 | out: |
| 1239 | sdata_unlock(sdata); |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 1240 | } |
| 1241 | |
Thomas Pedersen | f81a9de | 2013-06-13 15:54:41 -0700 | [diff] [blame] | 1242 | static void mesh_bss_info_changed(struct ieee80211_sub_if_data *sdata) |
| 1243 | { |
| 1244 | struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; |
| 1245 | u32 bit, changed = 0; |
| 1246 | |
| 1247 | for_each_set_bit(bit, &ifmsh->mbss_changed, |
| 1248 | sizeof(changed) * BITS_PER_BYTE) { |
| 1249 | clear_bit(bit, &ifmsh->mbss_changed); |
| 1250 | changed |= BIT(bit); |
| 1251 | } |
| 1252 | |
| 1253 | if (sdata->vif.bss_conf.enable_beacon && |
| 1254 | (changed & (BSS_CHANGED_BEACON | |
| 1255 | BSS_CHANGED_HT | |
| 1256 | BSS_CHANGED_BASIC_RATES | |
| 1257 | BSS_CHANGED_BEACON_INT))) |
| 1258 | if (ieee80211_mesh_rebuild_beacon(sdata)) |
| 1259 | return; |
| 1260 | |
| 1261 | ieee80211_bss_info_change_notify(sdata, changed); |
| 1262 | } |
| 1263 | |
Johannes Berg | 1fa57d0 | 2010-06-10 10:21:32 +0200 | [diff] [blame] | 1264 | void ieee80211_mesh_work(struct ieee80211_sub_if_data *sdata) |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 1265 | { |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 1266 | struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 1267 | |
Thomas Pedersen | ecccd07 | 2013-06-10 13:17:21 -0700 | [diff] [blame] | 1268 | sdata_lock(sdata); |
| 1269 | |
| 1270 | /* mesh already went down */ |
Johannes Berg | 1693d34 | 2014-01-22 10:08:57 +0100 | [diff] [blame] | 1271 | if (!sdata->u.mesh.mesh_id_len) |
Thomas Pedersen | ecccd07 | 2013-06-10 13:17:21 -0700 | [diff] [blame] | 1272 | goto out; |
| 1273 | |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 1274 | if (ifmsh->preq_queue_len && |
| 1275 | time_after(jiffies, |
| 1276 | ifmsh->last_preq + msecs_to_jiffies(ifmsh->mshcfg.dot11MeshHWMPpreqMinInterval))) |
| 1277 | mesh_path_start_discovery(sdata); |
| 1278 | |
Javier Cardona | 1888923 | 2009-08-10 12:15:52 -0700 | [diff] [blame] | 1279 | if (test_and_clear_bit(MESH_WORK_GROW_MPATH_TABLE, &ifmsh->wrkq_flags)) |
| 1280 | mesh_mpath_table_grow(); |
| 1281 | |
Nick Ledovskikh | dcac908 | 2011-01-11 14:35:12 +0000 | [diff] [blame] | 1282 | if (test_and_clear_bit(MESH_WORK_GROW_MPP_TABLE, &ifmsh->wrkq_flags)) |
Javier Cardona | 1888923 | 2009-08-10 12:15:52 -0700 | [diff] [blame] | 1283 | mesh_mpp_table_grow(); |
| 1284 | |
| 1285 | if (test_and_clear_bit(MESH_WORK_HOUSEKEEPING, &ifmsh->wrkq_flags)) |
Johannes Berg | bf7cd94 | 2013-02-15 14:40:31 +0100 | [diff] [blame] | 1286 | ieee80211_mesh_housekeeping(sdata); |
Rui Paulo | e304bfd | 2009-11-09 23:46:56 +0000 | [diff] [blame] | 1287 | |
| 1288 | if (test_and_clear_bit(MESH_WORK_ROOT, &ifmsh->wrkq_flags)) |
| 1289 | ieee80211_mesh_rootpath(sdata); |
Javier Cardona | dbf498f | 2012-03-31 11:31:32 -0700 | [diff] [blame] | 1290 | |
| 1291 | if (test_and_clear_bit(MESH_WORK_DRIFT_ADJUST, &ifmsh->wrkq_flags)) |
| 1292 | mesh_sync_adjust_tbtt(sdata); |
Thomas Pedersen | ecccd07 | 2013-06-10 13:17:21 -0700 | [diff] [blame] | 1293 | |
Thomas Pedersen | f81a9de | 2013-06-13 15:54:41 -0700 | [diff] [blame] | 1294 | if (test_and_clear_bit(MESH_WORK_MBSS_CHANGED, &ifmsh->wrkq_flags)) |
| 1295 | mesh_bss_info_changed(sdata); |
Thomas Pedersen | ecccd07 | 2013-06-10 13:17:21 -0700 | [diff] [blame] | 1296 | out: |
| 1297 | sdata_unlock(sdata); |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 1298 | } |
| 1299 | |
| 1300 | void ieee80211_mesh_notify_scan_completed(struct ieee80211_local *local) |
| 1301 | { |
| 1302 | struct ieee80211_sub_if_data *sdata; |
| 1303 | |
| 1304 | rcu_read_lock(); |
| 1305 | list_for_each_entry_rcu(sdata, &local->interfaces, list) |
Ben Greear | 370bd00 | 2013-03-19 17:50:50 -0700 | [diff] [blame] | 1306 | if (ieee80211_vif_is_mesh(&sdata->vif) && |
| 1307 | ieee80211_sdata_running(sdata)) |
Johannes Berg | 64592c8 | 2010-06-10 10:21:31 +0200 | [diff] [blame] | 1308 | ieee80211_queue_work(&local->hw, &sdata->work); |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 1309 | rcu_read_unlock(); |
| 1310 | } |
| 1311 | |
Johannes Berg | 902acc7 | 2008-02-23 15:17:19 +0100 | [diff] [blame] | 1312 | void ieee80211_mesh_init_sdata(struct ieee80211_sub_if_data *sdata) |
| 1313 | { |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 1314 | struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; |
Johannes Berg | ad2d223 | 2012-12-14 14:34:25 +0100 | [diff] [blame] | 1315 | static u8 zero_addr[ETH_ALEN] = {}; |
Johannes Berg | 902acc7 | 2008-02-23 15:17:19 +0100 | [diff] [blame] | 1316 | |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 1317 | setup_timer(&ifmsh->housekeeping_timer, |
| 1318 | ieee80211_mesh_housekeeping_timer, |
| 1319 | (unsigned long) sdata); |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 1320 | |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 1321 | ifmsh->accepting_plinks = true; |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 1322 | atomic_set(&ifmsh->mpaths, 0); |
Jasper Bryant-Greene | f698d85 | 2008-08-03 12:04:37 +1200 | [diff] [blame] | 1323 | mesh_rmc_init(sdata); |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 1324 | ifmsh->last_preq = jiffies; |
Thomas Pedersen | dca7e94 | 2011-11-24 17:15:24 -0800 | [diff] [blame] | 1325 | ifmsh->next_perr = jiffies; |
Luciano Coelho | 0cb4d4d | 2014-01-13 19:42:58 +0200 | [diff] [blame] | 1326 | ifmsh->csa_role = IEEE80211_MESH_CSA_ROLE_NONE; |
Johannes Berg | 902acc7 | 2008-02-23 15:17:19 +0100 | [diff] [blame] | 1327 | /* Allocate all mesh structures when creating the first mesh interface. */ |
| 1328 | if (!mesh_allocated) |
| 1329 | ieee80211s_init(); |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 1330 | setup_timer(&ifmsh->mesh_path_timer, |
Johannes Berg | 902acc7 | 2008-02-23 15:17:19 +0100 | [diff] [blame] | 1331 | ieee80211_mesh_path_timer, |
| 1332 | (unsigned long) sdata); |
Rui Paulo | e304bfd | 2009-11-09 23:46:56 +0000 | [diff] [blame] | 1333 | setup_timer(&ifmsh->mesh_path_root_timer, |
| 1334 | ieee80211_mesh_path_root_timer, |
| 1335 | (unsigned long) sdata); |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 1336 | INIT_LIST_HEAD(&ifmsh->preq_queue.list); |
Marco Porsch | 3f52b7e | 2013-01-30 18:14:08 +0100 | [diff] [blame] | 1337 | skb_queue_head_init(&ifmsh->ps.bc_buf); |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 1338 | spin_lock_init(&ifmsh->mesh_preq_queue_lock); |
Javier Cardona | dbf498f | 2012-03-31 11:31:32 -0700 | [diff] [blame] | 1339 | spin_lock_init(&ifmsh->sync_offset_lock); |
Thomas Pedersen | 2b5e196 | 2013-02-14 11:20:13 -0800 | [diff] [blame] | 1340 | RCU_INIT_POINTER(ifmsh->beacon, NULL); |
Johannes Berg | ad2d223 | 2012-12-14 14:34:25 +0100 | [diff] [blame] | 1341 | |
| 1342 | sdata->vif.bss_conf.bssid = zero_addr; |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 1343 | } |