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