ieee80211_input.c revision 1.95 1 1.95 maxv /* $NetBSD: ieee80211_input.c,v 1.95 2018/01/16 14:01:13 maxv Exp $ */
2 1.92 maxv
3 1.92 maxv /*
4 1.1 dyoung * Copyright (c) 2001 Atsushi Onoe
5 1.40 dyoung * Copyright (c) 2002-2005 Sam Leffler, Errno Consulting
6 1.1 dyoung * All rights reserved.
7 1.1 dyoung *
8 1.1 dyoung * Redistribution and use in source and binary forms, with or without
9 1.1 dyoung * modification, are permitted provided that the following conditions
10 1.1 dyoung * are met:
11 1.1 dyoung * 1. Redistributions of source code must retain the above copyright
12 1.1 dyoung * notice, this list of conditions and the following disclaimer.
13 1.1 dyoung * 2. Redistributions in binary form must reproduce the above copyright
14 1.1 dyoung * notice, this list of conditions and the following disclaimer in the
15 1.1 dyoung * documentation and/or other materials provided with the distribution.
16 1.1 dyoung * 3. The name of the author may not be used to endorse or promote products
17 1.1 dyoung * derived from this software without specific prior written permission.
18 1.1 dyoung *
19 1.1 dyoung * Alternatively, this software may be distributed under the terms of the
20 1.1 dyoung * GNU General Public License ("GPL") version 2 as published by the Free
21 1.1 dyoung * Software Foundation.
22 1.1 dyoung *
23 1.1 dyoung * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
24 1.1 dyoung * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
25 1.1 dyoung * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
26 1.1 dyoung * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
27 1.1 dyoung * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
28 1.1 dyoung * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
29 1.1 dyoung * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
30 1.1 dyoung * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
31 1.1 dyoung * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
32 1.1 dyoung * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
33 1.1 dyoung */
34 1.1 dyoung
35 1.1 dyoung #include <sys/cdefs.h>
36 1.3 dyoung #ifdef __FreeBSD__
37 1.47 skrll __FBSDID("$FreeBSD: src/sys/net80211/ieee80211_input.c,v 1.81 2005/08/10 16:22:29 sam Exp $");
38 1.40 dyoung #endif
39 1.40 dyoung #ifdef __NetBSD__
40 1.95 maxv __KERNEL_RCSID(0, "$NetBSD: ieee80211_input.c,v 1.95 2018/01/16 14:01:13 maxv Exp $");
41 1.3 dyoung #endif
42 1.1 dyoung
43 1.79 pooka #ifdef _KERNEL_OPT
44 1.1 dyoung #include "opt_inet.h"
45 1.79 pooka #endif
46 1.1 dyoung
47 1.1 dyoung #include <sys/param.h>
48 1.38 perry #include <sys/systm.h>
49 1.85 christos #include <sys/mbuf.h>
50 1.1 dyoung #include <sys/malloc.h>
51 1.40 dyoung #include <sys/endian.h>
52 1.1 dyoung #include <sys/kernel.h>
53 1.74 christos
54 1.1 dyoung #include <sys/socket.h>
55 1.1 dyoung #include <sys/sockio.h>
56 1.1 dyoung #include <sys/endian.h>
57 1.1 dyoung #include <sys/errno.h>
58 1.1 dyoung #include <sys/proc.h>
59 1.1 dyoung #include <sys/sysctl.h>
60 1.87 nonaka #include <sys/cpu.h>
61 1.1 dyoung
62 1.1 dyoung #include <net/if.h>
63 1.1 dyoung #include <net/if_media.h>
64 1.1 dyoung #include <net/if_arp.h>
65 1.4 dyoung #include <net/if_ether.h>
66 1.1 dyoung #include <net/if_llc.h>
67 1.1 dyoung
68 1.1 dyoung #include <net80211/ieee80211_var.h>
69 1.1 dyoung
70 1.1 dyoung #include <net/bpf.h>
71 1.1 dyoung
72 1.1 dyoung #ifdef INET
73 1.74 christos #include <netinet/in.h>
74 1.4 dyoung #include <net/if_ether.h>
75 1.4 dyoung #endif
76 1.1 dyoung
77 1.31 dyoung const struct timeval ieee80211_merge_print_intvl = {.tv_sec = 1, .tv_usec = 0};
78 1.31 dyoung
79 1.40 dyoung #ifdef IEEE80211_DEBUG
80 1.5 dyoung
81 1.26 mycroft /*
82 1.26 mycroft * Decide if a received management frame should be
83 1.26 mycroft * printed when debugging is enabled. This filters some
84 1.26 mycroft * of the less interesting frames that come frequently
85 1.26 mycroft * (e.g. beacons).
86 1.26 mycroft */
87 1.26 mycroft static __inline int
88 1.26 mycroft doprint(struct ieee80211com *ic, int subtype)
89 1.26 mycroft {
90 1.26 mycroft switch (subtype) {
91 1.26 mycroft case IEEE80211_FC0_SUBTYPE_BEACON:
92 1.40 dyoung return (ic->ic_flags & IEEE80211_F_SCAN);
93 1.26 mycroft case IEEE80211_FC0_SUBTYPE_PROBE_REQ:
94 1.26 mycroft return (ic->ic_opmode == IEEE80211_M_IBSS);
95 1.26 mycroft }
96 1.26 mycroft return 1;
97 1.26 mycroft }
98 1.40 dyoung
99 1.40 dyoung /*
100 1.40 dyoung * Emit a debug message about discarding a frame or information
101 1.40 dyoung * element. One format is for extracting the mac address from
102 1.40 dyoung * the frame header; the other is for when a header is not
103 1.40 dyoung * available or otherwise appropriate.
104 1.40 dyoung */
105 1.40 dyoung #define IEEE80211_DISCARD(_ic, _m, _wh, _type, _fmt, ...) do { \
106 1.40 dyoung if ((_ic)->ic_debug & (_m)) \
107 1.40 dyoung ieee80211_discard_frame(_ic, _wh, _type, _fmt, __VA_ARGS__);\
108 1.40 dyoung } while (0)
109 1.40 dyoung #define IEEE80211_DISCARD_IE(_ic, _m, _wh, _type, _fmt, ...) do { \
110 1.40 dyoung if ((_ic)->ic_debug & (_m)) \
111 1.40 dyoung ieee80211_discard_ie(_ic, _wh, _type, _fmt, __VA_ARGS__);\
112 1.40 dyoung } while (0)
113 1.40 dyoung #define IEEE80211_DISCARD_MAC(_ic, _m, _mac, _type, _fmt, ...) do { \
114 1.40 dyoung if ((_ic)->ic_debug & (_m)) \
115 1.40 dyoung ieee80211_discard_mac(_ic, _mac, _type, _fmt, __VA_ARGS__);\
116 1.40 dyoung } while (0)
117 1.85 christos #define IEEE80211_DEBUGVAR(a) a
118 1.40 dyoung
119 1.40 dyoung static const u_int8_t *ieee80211_getbssid(struct ieee80211com *,
120 1.40 dyoung const struct ieee80211_frame *);
121 1.40 dyoung static void ieee80211_discard_frame(struct ieee80211com *,
122 1.40 dyoung const struct ieee80211_frame *, const char *type, const char *fmt, ...);
123 1.40 dyoung static void ieee80211_discard_ie(struct ieee80211com *,
124 1.40 dyoung const struct ieee80211_frame *, const char *type, const char *fmt, ...);
125 1.40 dyoung static void ieee80211_discard_mac(struct ieee80211com *,
126 1.40 dyoung const u_int8_t mac[IEEE80211_ADDR_LEN], const char *type,
127 1.40 dyoung const char *fmt, ...);
128 1.40 dyoung #else
129 1.40 dyoung #define IEEE80211_DISCARD(_ic, _m, _wh, _type, _fmt, ...)
130 1.40 dyoung #define IEEE80211_DISCARD_IE(_ic, _m, _wh, _type, _fmt, ...)
131 1.40 dyoung #define IEEE80211_DISCARD_MAC(_ic, _m, _mac, _type, _fmt, ...)
132 1.85 christos #define IEEE80211_DEBUGVAR(a)
133 1.40 dyoung #endif /* IEEE80211_DEBUG */
134 1.40 dyoung
135 1.40 dyoung static struct mbuf *ieee80211_defrag(struct ieee80211com *,
136 1.44 dyoung struct ieee80211_node *, struct mbuf *, int);
137 1.44 dyoung static struct mbuf *ieee80211_decap(struct ieee80211com *, struct mbuf *, int);
138 1.44 dyoung static void ieee80211_send_error(struct ieee80211com *, struct ieee80211_node *,
139 1.92 maxv const u_int8_t *mac, int subtype, int arg);
140 1.47 skrll static void ieee80211_deliver_data(struct ieee80211com *,
141 1.47 skrll struct ieee80211_node *, struct mbuf *);
142 1.57 dyoung #ifndef IEEE80211_NO_HOSTAP
143 1.40 dyoung static void ieee80211_node_pwrsave(struct ieee80211_node *, int enable);
144 1.40 dyoung static void ieee80211_recv_pspoll(struct ieee80211com *,
145 1.40 dyoung struct ieee80211_node *, struct mbuf *);
146 1.41 dyoung #endif /* !IEEE80211_NO_HOSTAP */
147 1.56 dyoung static void ieee80211_update_adhoc_node(struct ieee80211com *,
148 1.56 dyoung struct ieee80211_node *, struct ieee80211_frame *,
149 1.56 dyoung struct ieee80211_scanparams *, int, u_int32_t);
150 1.26 mycroft
151 1.93 maxv /* -------------------------------------------------------------------------- */
152 1.93 maxv
153 1.93 maxv /*
154 1.93 maxv * Input code for a DATA frame.
155 1.93 maxv */
156 1.93 maxv static int
157 1.93 maxv ieee80211_input_data(struct ieee80211com *ic, struct mbuf **mp,
158 1.93 maxv struct ieee80211_node *ni)
159 1.93 maxv {
160 1.93 maxv struct ifnet *ifp = ic->ic_ifp;
161 1.93 maxv struct ieee80211_key *key;
162 1.93 maxv struct ieee80211_frame *wh;
163 1.93 maxv u_int8_t dir, subtype;
164 1.93 maxv struct ether_header *eh;
165 1.93 maxv struct mbuf *m = *mp;
166 1.93 maxv int hdrspace;
167 1.93 maxv
168 1.93 maxv wh = mtod(m, struct ieee80211_frame *);
169 1.93 maxv dir = wh->i_fc[1] & IEEE80211_FC1_DIR_MASK;
170 1.93 maxv subtype = wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK;
171 1.93 maxv
172 1.93 maxv hdrspace = ieee80211_hdrspace(ic, wh);
173 1.93 maxv
174 1.93 maxv if (m->m_len < hdrspace &&
175 1.93 maxv (m = m_pullup(m, hdrspace)) == NULL) {
176 1.93 maxv IEEE80211_DISCARD_MAC(ic, IEEE80211_MSG_ANY,
177 1.93 maxv ni->ni_macaddr, NULL,
178 1.93 maxv "data too short: expecting %u", hdrspace);
179 1.93 maxv ic->ic_stats.is_rx_tooshort++;
180 1.94 maxv goto out;
181 1.93 maxv }
182 1.93 maxv wh = mtod(m, struct ieee80211_frame *);
183 1.93 maxv
184 1.93 maxv switch (ic->ic_opmode) {
185 1.93 maxv case IEEE80211_M_STA:
186 1.93 maxv if (dir != IEEE80211_FC1_DIR_FROMDS) {
187 1.93 maxv IEEE80211_DISCARD(ic, IEEE80211_MSG_INPUT,
188 1.93 maxv wh, "data", "%s", "unknown dir 0x%x", dir);
189 1.93 maxv ic->ic_stats.is_rx_wrongdir++;
190 1.93 maxv goto out;
191 1.93 maxv }
192 1.93 maxv if ((ifp->if_flags & IFF_SIMPLEX) &&
193 1.93 maxv IEEE80211_IS_MULTICAST(wh->i_addr1) &&
194 1.93 maxv IEEE80211_ADDR_EQ(wh->i_addr3, ic->ic_myaddr)) {
195 1.93 maxv /*
196 1.93 maxv * In IEEE802.11 network, multicast packet
197 1.93 maxv * sent from me is broadcast from AP.
198 1.93 maxv * It should be silently discarded for
199 1.93 maxv * SIMPLEX interface.
200 1.93 maxv */
201 1.93 maxv IEEE80211_DISCARD(ic, IEEE80211_MSG_INPUT,
202 1.93 maxv wh, NULL, "%s", "multicast echo");
203 1.93 maxv ic->ic_stats.is_rx_mcastecho++;
204 1.93 maxv goto out;
205 1.93 maxv }
206 1.93 maxv break;
207 1.93 maxv
208 1.93 maxv case IEEE80211_M_IBSS:
209 1.93 maxv case IEEE80211_M_AHDEMO:
210 1.93 maxv if (dir != IEEE80211_FC1_DIR_NODS) {
211 1.93 maxv IEEE80211_DISCARD(ic, IEEE80211_MSG_INPUT,
212 1.93 maxv wh, "data", "%s", "unknown dir 0x%x", dir);
213 1.93 maxv ic->ic_stats.is_rx_wrongdir++;
214 1.93 maxv goto out;
215 1.93 maxv }
216 1.93 maxv /* XXX no power-save support */
217 1.93 maxv break;
218 1.93 maxv
219 1.93 maxv case IEEE80211_M_HOSTAP:
220 1.93 maxv #ifndef IEEE80211_NO_HOSTAP
221 1.93 maxv if (dir != IEEE80211_FC1_DIR_TODS) {
222 1.93 maxv IEEE80211_DISCARD(ic, IEEE80211_MSG_INPUT,
223 1.93 maxv wh, "data", "%s", "unknown dir 0x%x", dir);
224 1.93 maxv ic->ic_stats.is_rx_wrongdir++;
225 1.93 maxv goto out;
226 1.93 maxv }
227 1.93 maxv /* check if source STA is associated */
228 1.93 maxv if (ni == ic->ic_bss) {
229 1.93 maxv IEEE80211_DISCARD(ic, IEEE80211_MSG_INPUT,
230 1.93 maxv wh, "data", "%s", "unknown src");
231 1.93 maxv ieee80211_send_error(ic, ni, wh->i_addr2,
232 1.93 maxv IEEE80211_FC0_SUBTYPE_DEAUTH,
233 1.93 maxv IEEE80211_REASON_NOT_AUTHED);
234 1.93 maxv ic->ic_stats.is_rx_notassoc++;
235 1.93 maxv goto err;
236 1.93 maxv }
237 1.93 maxv if (ni->ni_associd == 0) {
238 1.93 maxv IEEE80211_DISCARD(ic, IEEE80211_MSG_INPUT,
239 1.93 maxv wh, "data", "%s", "unassoc src");
240 1.93 maxv IEEE80211_SEND_MGMT(ic, ni,
241 1.93 maxv IEEE80211_FC0_SUBTYPE_DISASSOC,
242 1.93 maxv IEEE80211_REASON_NOT_ASSOCED);
243 1.93 maxv ic->ic_stats.is_rx_notassoc++;
244 1.93 maxv goto err;
245 1.93 maxv }
246 1.93 maxv
247 1.93 maxv /*
248 1.93 maxv * Check for power save state change.
249 1.93 maxv */
250 1.93 maxv if (((wh->i_fc[1] & IEEE80211_FC1_PWR_MGT) ^
251 1.93 maxv (ni->ni_flags & IEEE80211_NODE_PWR_MGT)))
252 1.93 maxv ieee80211_node_pwrsave(ni,
253 1.93 maxv wh->i_fc[1] & IEEE80211_FC1_PWR_MGT);
254 1.93 maxv #endif /* !IEEE80211_NO_HOSTAP */
255 1.93 maxv break;
256 1.93 maxv
257 1.93 maxv default:
258 1.93 maxv /* XXX here to keep compiler happy */
259 1.93 maxv goto out;
260 1.93 maxv }
261 1.93 maxv
262 1.93 maxv /*
263 1.93 maxv * Handle privacy requirements. Note that we
264 1.93 maxv * must not be preempted from here until after
265 1.93 maxv * we (potentially) call ieee80211_crypto_demic;
266 1.93 maxv * otherwise we may violate assumptions in the
267 1.93 maxv * crypto cipher modules used to do delayed update
268 1.93 maxv * of replay sequence numbers.
269 1.93 maxv */
270 1.93 maxv if (wh->i_fc[1] & IEEE80211_FC1_WEP) {
271 1.93 maxv if ((ic->ic_flags & IEEE80211_F_PRIVACY) == 0) {
272 1.93 maxv /*
273 1.93 maxv * Discard encrypted frames when privacy is off.
274 1.93 maxv */
275 1.93 maxv IEEE80211_DISCARD(ic, IEEE80211_MSG_INPUT,
276 1.93 maxv wh, "WEP", "%s", "PRIVACY off");
277 1.93 maxv ic->ic_stats.is_rx_noprivacy++;
278 1.93 maxv IEEE80211_NODE_STAT(ni, rx_noprivacy);
279 1.93 maxv goto out;
280 1.93 maxv }
281 1.93 maxv key = ieee80211_crypto_decap(ic, ni, &m, hdrspace);
282 1.93 maxv if (key == NULL) {
283 1.93 maxv /* NB: stats+msgs handled in crypto_decap */
284 1.93 maxv IEEE80211_NODE_STAT(ni, rx_wepfail);
285 1.93 maxv goto out;
286 1.93 maxv }
287 1.93 maxv wh = mtod(m, struct ieee80211_frame *);
288 1.93 maxv wh->i_fc[1] &= ~IEEE80211_FC1_WEP;
289 1.93 maxv } else {
290 1.93 maxv key = NULL;
291 1.93 maxv }
292 1.93 maxv
293 1.93 maxv /*
294 1.93 maxv * Next up, any fragmentation.
295 1.93 maxv */
296 1.93 maxv if (!IEEE80211_IS_MULTICAST(wh->i_addr1)) {
297 1.93 maxv m = ieee80211_defrag(ic, ni, m, hdrspace);
298 1.93 maxv if (m == NULL) {
299 1.93 maxv /* Fragment dropped or frame not complete yet */
300 1.93 maxv goto out;
301 1.93 maxv }
302 1.93 maxv }
303 1.93 maxv
304 1.93 maxv /*
305 1.94 maxv * Next, strip any MSDU crypto bits.
306 1.93 maxv */
307 1.93 maxv if (key != NULL && !ieee80211_crypto_demic(ic, key, m, 0)) {
308 1.93 maxv IEEE80211_DISCARD_MAC(ic, IEEE80211_MSG_INPUT,
309 1.93 maxv ni->ni_macaddr, "data", "%s", "demic error");
310 1.93 maxv IEEE80211_NODE_STAT(ni, rx_demicfail);
311 1.93 maxv goto out;
312 1.93 maxv }
313 1.93 maxv
314 1.93 maxv /* copy to listener after decrypt */
315 1.93 maxv bpf_mtap3(ic->ic_rawbpf, m);
316 1.93 maxv
317 1.93 maxv /*
318 1.93 maxv * Finally, strip the 802.11 header.
319 1.93 maxv */
320 1.93 maxv m = ieee80211_decap(ic, m, hdrspace);
321 1.93 maxv if (m == NULL) {
322 1.93 maxv /* don't count Null data frames as errors */
323 1.93 maxv if (subtype == IEEE80211_FC0_SUBTYPE_NODATA)
324 1.93 maxv goto out;
325 1.93 maxv IEEE80211_DISCARD_MAC(ic, IEEE80211_MSG_INPUT,
326 1.93 maxv ni->ni_macaddr, "data", "%s", "decap error");
327 1.93 maxv ic->ic_stats.is_rx_decap++;
328 1.93 maxv IEEE80211_NODE_STAT(ni, rx_decap);
329 1.93 maxv goto err;
330 1.93 maxv }
331 1.93 maxv
332 1.93 maxv eh = mtod(m, struct ether_header *);
333 1.93 maxv if (!ieee80211_node_is_authorized(ni)) {
334 1.93 maxv /*
335 1.93 maxv * Deny any non-PAE frames received prior to
336 1.93 maxv * authorization. For open/shared-key
337 1.93 maxv * authentication the port is mark authorized
338 1.93 maxv * after authentication completes. For 802.1x
339 1.93 maxv * the port is not marked authorized by the
340 1.93 maxv * authenticator until the handshake has completed.
341 1.93 maxv */
342 1.93 maxv if (eh->ether_type != htons(ETHERTYPE_PAE)) {
343 1.93 maxv IEEE80211_DISCARD_MAC(ic, IEEE80211_MSG_INPUT,
344 1.93 maxv eh->ether_shost, "data",
345 1.93 maxv "unauthorized port: ether type 0x%x len %u",
346 1.93 maxv eh->ether_type, m->m_pkthdr.len);
347 1.93 maxv ic->ic_stats.is_rx_unauth++;
348 1.93 maxv IEEE80211_NODE_STAT(ni, rx_unauth);
349 1.93 maxv goto err;
350 1.93 maxv }
351 1.93 maxv } else {
352 1.93 maxv /*
353 1.93 maxv * When denying unencrypted frames, discard
354 1.93 maxv * any non-PAE frames received without encryption.
355 1.93 maxv */
356 1.93 maxv if ((ic->ic_flags & IEEE80211_F_DROPUNENC) &&
357 1.93 maxv key == NULL &&
358 1.93 maxv eh->ether_type != htons(ETHERTYPE_PAE)) {
359 1.93 maxv /*
360 1.93 maxv * Drop unencrypted frames.
361 1.93 maxv */
362 1.93 maxv ic->ic_stats.is_rx_unencrypted++;
363 1.93 maxv IEEE80211_NODE_STAT(ni, rx_unencrypted);
364 1.93 maxv goto out;
365 1.93 maxv }
366 1.93 maxv }
367 1.93 maxv
368 1.93 maxv ifp->if_ipackets++;
369 1.93 maxv IEEE80211_NODE_STAT(ni, rx_data);
370 1.93 maxv IEEE80211_NODE_STAT_ADD(ni, rx_bytes, m->m_pkthdr.len);
371 1.93 maxv
372 1.93 maxv ieee80211_deliver_data(ic, ni, m);
373 1.93 maxv
374 1.93 maxv *mp = NULL;
375 1.93 maxv return 0;
376 1.93 maxv
377 1.93 maxv err:
378 1.93 maxv ifp->if_ierrors++;
379 1.93 maxv out:
380 1.93 maxv *mp = m;
381 1.93 maxv return -1;
382 1.93 maxv }
383 1.93 maxv
384 1.93 maxv /*
385 1.93 maxv * Input code for a MANAGEMENT frame.
386 1.93 maxv */
387 1.93 maxv static int
388 1.93 maxv ieee80211_input_management(struct ieee80211com *ic, struct mbuf **mp,
389 1.93 maxv struct ieee80211_node *ni, int rssi, u_int32_t rstamp)
390 1.93 maxv {
391 1.93 maxv IEEE80211_DEBUGVAR(char ebuf[3 * ETHER_ADDR_LEN]);
392 1.93 maxv struct ifnet *ifp = ic->ic_ifp;
393 1.93 maxv struct ieee80211_key *key;
394 1.93 maxv struct ieee80211_frame *wh;
395 1.93 maxv u_int8_t dir, subtype;
396 1.93 maxv struct mbuf *m = *mp;
397 1.93 maxv int hdrspace;
398 1.93 maxv
399 1.93 maxv wh = mtod(m, struct ieee80211_frame *);
400 1.93 maxv dir = wh->i_fc[1] & IEEE80211_FC1_DIR_MASK;
401 1.93 maxv subtype = wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK;
402 1.93 maxv
403 1.93 maxv IEEE80211_NODE_STAT(ni, rx_mgmt);
404 1.93 maxv if (dir != IEEE80211_FC1_DIR_NODS) {
405 1.93 maxv IEEE80211_DISCARD(ic, IEEE80211_MSG_INPUT,
406 1.93 maxv wh, "data", "%s", "unknown dir 0x%x", dir);
407 1.93 maxv ic->ic_stats.is_rx_wrongdir++;
408 1.93 maxv goto err;
409 1.93 maxv }
410 1.93 maxv if (m->m_pkthdr.len < sizeof(struct ieee80211_frame)) {
411 1.93 maxv IEEE80211_DISCARD_MAC(ic, IEEE80211_MSG_ANY,
412 1.93 maxv ni->ni_macaddr, "mgt", "too short: len %u",
413 1.93 maxv m->m_pkthdr.len);
414 1.93 maxv ic->ic_stats.is_rx_tooshort++;
415 1.93 maxv goto out;
416 1.93 maxv }
417 1.93 maxv #ifdef IEEE80211_DEBUG
418 1.93 maxv if ((ieee80211_msg_debug(ic) && doprint(ic, subtype)) ||
419 1.93 maxv ieee80211_msg_dumppkts(ic)) {
420 1.93 maxv if_printf(ic->ic_ifp, "received %s from %s rssi %d\n",
421 1.93 maxv ieee80211_mgt_subtype_name[subtype >>
422 1.93 maxv IEEE80211_FC0_SUBTYPE_SHIFT],
423 1.93 maxv ether_snprintf(ebuf, sizeof(ebuf), wh->i_addr2),
424 1.93 maxv rssi);
425 1.93 maxv }
426 1.93 maxv #endif
427 1.93 maxv
428 1.93 maxv if (wh->i_fc[1] & IEEE80211_FC1_WEP) {
429 1.93 maxv if (subtype != IEEE80211_FC0_SUBTYPE_AUTH) {
430 1.93 maxv /*
431 1.93 maxv * Only shared key auth frames with a challenge
432 1.93 maxv * should be encrypted, discard all others.
433 1.93 maxv */
434 1.93 maxv IEEE80211_DISCARD(ic, IEEE80211_MSG_INPUT,
435 1.93 maxv wh, ieee80211_mgt_subtype_name[subtype >>
436 1.93 maxv IEEE80211_FC0_SUBTYPE_SHIFT],
437 1.93 maxv "%s", "WEP set but not permitted");
438 1.93 maxv ic->ic_stats.is_rx_mgtdiscard++; /* XXX */
439 1.93 maxv goto out;
440 1.93 maxv }
441 1.93 maxv if ((ic->ic_flags & IEEE80211_F_PRIVACY) == 0) {
442 1.93 maxv /*
443 1.93 maxv * Discard encrypted frames when privacy is off.
444 1.93 maxv */
445 1.93 maxv IEEE80211_DISCARD(ic, IEEE80211_MSG_INPUT,
446 1.93 maxv wh, "mgt", "%s", "WEP set but PRIVACY off");
447 1.93 maxv ic->ic_stats.is_rx_noprivacy++;
448 1.93 maxv goto out;
449 1.93 maxv }
450 1.93 maxv hdrspace = ieee80211_hdrspace(ic, wh);
451 1.93 maxv key = ieee80211_crypto_decap(ic, ni, &m, hdrspace);
452 1.93 maxv if (key == NULL) {
453 1.93 maxv /* NB: stats+msgs handled in crypto_decap */
454 1.93 maxv goto out;
455 1.93 maxv }
456 1.93 maxv wh = mtod(m, struct ieee80211_frame *);
457 1.93 maxv wh->i_fc[1] &= ~IEEE80211_FC1_WEP;
458 1.93 maxv }
459 1.93 maxv
460 1.93 maxv bpf_mtap3(ic->ic_rawbpf, m);
461 1.93 maxv (*ic->ic_recv_mgmt)(ic, m, ni, subtype, rssi, rstamp);
462 1.93 maxv m_freem(m);
463 1.93 maxv
464 1.93 maxv *mp = NULL;
465 1.93 maxv return 0;
466 1.93 maxv
467 1.93 maxv err:
468 1.93 maxv ifp->if_ierrors++;
469 1.93 maxv out:
470 1.93 maxv *mp = m;
471 1.93 maxv return -1;
472 1.93 maxv }
473 1.93 maxv
474 1.93 maxv /*
475 1.93 maxv * Input code for a CONTROL frame.
476 1.93 maxv */
477 1.93 maxv static void
478 1.93 maxv ieee80211_input_control(struct ieee80211com *ic, struct mbuf *m,
479 1.93 maxv struct ieee80211_node *ni)
480 1.93 maxv {
481 1.93 maxv IEEE80211_NODE_STAT(ni, rx_ctrl);
482 1.93 maxv ic->ic_stats.is_rx_ctl++;
483 1.93 maxv
484 1.93 maxv #ifndef IEEE80211_NO_HOSTAP
485 1.93 maxv if (ic->ic_opmode == IEEE80211_M_HOSTAP) {
486 1.93 maxv struct ieee80211_frame *wh;
487 1.93 maxv u_int8_t subtype;
488 1.93 maxv
489 1.93 maxv wh = mtod(m, struct ieee80211_frame *);
490 1.93 maxv subtype = wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK;
491 1.93 maxv
492 1.93 maxv switch (subtype) {
493 1.93 maxv case IEEE80211_FC0_SUBTYPE_PS_POLL:
494 1.93 maxv ieee80211_recv_pspoll(ic, ni, m);
495 1.93 maxv break;
496 1.93 maxv }
497 1.93 maxv }
498 1.93 maxv #endif
499 1.93 maxv }
500 1.93 maxv
501 1.93 maxv /* -------------------------------------------------------------------------- */
502 1.93 maxv
503 1.1 dyoung /*
504 1.1 dyoung * Process a received frame. The node associated with the sender
505 1.1 dyoung * should be supplied. If nothing was found in the node table then
506 1.1 dyoung * the caller is assumed to supply a reference to ic_bss instead.
507 1.1 dyoung * The RSSI and a timestamp are also supplied. The RSSI data is used
508 1.1 dyoung * during AP scanning to select a AP to associate with; it can have
509 1.1 dyoung * any units so long as values have consistent units and higher values
510 1.1 dyoung * mean ``better signal''. The receive timestamp is currently not used
511 1.1 dyoung * by the 802.11 layer.
512 1.1 dyoung */
513 1.40 dyoung int
514 1.40 dyoung ieee80211_input(struct ieee80211com *ic, struct mbuf *m,
515 1.40 dyoung struct ieee80211_node *ni, int rssi, u_int32_t rstamp)
516 1.1 dyoung {
517 1.40 dyoung #define SEQ_LEQ(a,b) ((int)((a)-(b)) <= 0)
518 1.40 dyoung #define HAS_SEQ(type) ((type & 0x4) == 0)
519 1.40 dyoung struct ifnet *ifp = ic->ic_ifp;
520 1.1 dyoung struct ieee80211_frame *wh;
521 1.93 maxv u_int8_t dir, type;
522 1.1 dyoung u_int16_t rxseq;
523 1.85 christos IEEE80211_DEBUGVAR(char ebuf[3 * ETHER_ADDR_LEN]);
524 1.93 maxv int ret;
525 1.1 dyoung
526 1.87 nonaka KASSERT(!cpu_intr_p());
527 1.87 nonaka
528 1.17 dyoung IASSERT(ni != NULL, ("null node"));
529 1.40 dyoung ni->ni_inact = ni->ni_inact_reload;
530 1.1 dyoung
531 1.16 dyoung /* trim CRC here so WEP can find its own CRC at the end of packet. */
532 1.1 dyoung if (m->m_flags & M_HASFCS) {
533 1.1 dyoung m_adj(m, -IEEE80211_CRC_LEN);
534 1.1 dyoung m->m_flags &= ~M_HASFCS;
535 1.1 dyoung }
536 1.40 dyoung type = -1; /* undefined */
537 1.92 maxv
538 1.16 dyoung /*
539 1.16 dyoung * In monitor mode, send everything directly to bpf.
540 1.16 dyoung * XXX may want to include the CRC
541 1.16 dyoung */
542 1.40 dyoung if (ic->ic_opmode == IEEE80211_M_MONITOR)
543 1.16 dyoung goto out;
544 1.1 dyoung
545 1.40 dyoung if (m->m_pkthdr.len < sizeof(struct ieee80211_frame_min)) {
546 1.40 dyoung IEEE80211_DISCARD_MAC(ic, IEEE80211_MSG_ANY,
547 1.40 dyoung ni->ni_macaddr, NULL,
548 1.40 dyoung "too short (1): len %u", m->m_pkthdr.len);
549 1.40 dyoung ic->ic_stats.is_rx_tooshort++;
550 1.40 dyoung goto out;
551 1.40 dyoung }
552 1.92 maxv
553 1.40 dyoung /*
554 1.40 dyoung * Bit of a cheat here, we use a pointer for a 3-address
555 1.40 dyoung * frame format but don't reference fields past outside
556 1.40 dyoung * ieee80211_frame_min w/o first validating the data is
557 1.40 dyoung * present.
558 1.40 dyoung */
559 1.1 dyoung wh = mtod(m, struct ieee80211_frame *);
560 1.40 dyoung
561 1.1 dyoung if ((wh->i_fc[0] & IEEE80211_FC0_VERSION_MASK) !=
562 1.1 dyoung IEEE80211_FC0_VERSION_0) {
563 1.40 dyoung IEEE80211_DISCARD_MAC(ic, IEEE80211_MSG_ANY,
564 1.40 dyoung ni->ni_macaddr, NULL, "wrong version %x", wh->i_fc[0]);
565 1.16 dyoung ic->ic_stats.is_rx_badversion++;
566 1.1 dyoung goto err;
567 1.1 dyoung }
568 1.1 dyoung
569 1.1 dyoung dir = wh->i_fc[1] & IEEE80211_FC1_DIR_MASK;
570 1.16 dyoung type = wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK;
571 1.92 maxv
572 1.40 dyoung if ((ic->ic_flags & IEEE80211_F_SCAN) == 0) {
573 1.92 maxv u_int8_t *bssid;
574 1.92 maxv
575 1.40 dyoung switch (ic->ic_opmode) {
576 1.40 dyoung case IEEE80211_M_STA:
577 1.40 dyoung bssid = wh->i_addr2;
578 1.40 dyoung if (!IEEE80211_ADDR_EQ(bssid, ni->ni_bssid)) {
579 1.40 dyoung /* not interested in */
580 1.40 dyoung IEEE80211_DISCARD_MAC(ic, IEEE80211_MSG_INPUT,
581 1.85 christos bssid, NULL, "node %s, %s",
582 1.85 christos ether_snprintf(ebuf, sizeof(ebuf),
583 1.85 christos ni->ni_bssid), "not to bss");
584 1.40 dyoung ic->ic_stats.is_rx_wrongbss++;
585 1.40 dyoung goto out;
586 1.40 dyoung }
587 1.84 mlelstv
588 1.92 maxv /*
589 1.92 maxv * Filter out packets not directed to us in case the
590 1.92 maxv * device is in promiscuous mode
591 1.84 mlelstv */
592 1.92 maxv if (!IEEE80211_IS_MULTICAST(wh->i_addr1) &&
593 1.92 maxv !IEEE80211_ADDR_EQ(wh->i_addr1, ic->ic_myaddr)) {
594 1.84 mlelstv IEEE80211_DISCARD_MAC(ic, IEEE80211_MSG_INPUT,
595 1.84 mlelstv bssid, NULL, "not to cur sta: lladdr=%6D, addr1=%6D",
596 1.84 mlelstv ic->ic_myaddr, ":", wh->i_addr1, ":");
597 1.84 mlelstv ic->ic_stats.is_rx_wrongbss++;
598 1.84 mlelstv goto out;
599 1.84 mlelstv }
600 1.40 dyoung break;
601 1.92 maxv
602 1.40 dyoung case IEEE80211_M_IBSS:
603 1.40 dyoung case IEEE80211_M_AHDEMO:
604 1.40 dyoung case IEEE80211_M_HOSTAP:
605 1.40 dyoung if (dir != IEEE80211_FC1_DIR_NODS)
606 1.40 dyoung bssid = wh->i_addr1;
607 1.40 dyoung else if (type == IEEE80211_FC0_TYPE_CTL)
608 1.40 dyoung bssid = wh->i_addr1;
609 1.40 dyoung else {
610 1.40 dyoung if (m->m_pkthdr.len < sizeof(struct ieee80211_frame)) {
611 1.40 dyoung IEEE80211_DISCARD_MAC(ic,
612 1.40 dyoung IEEE80211_MSG_ANY, ni->ni_macaddr,
613 1.40 dyoung NULL, "too short (2): len %u",
614 1.40 dyoung m->m_pkthdr.len);
615 1.40 dyoung ic->ic_stats.is_rx_tooshort++;
616 1.40 dyoung goto out;
617 1.40 dyoung }
618 1.40 dyoung bssid = wh->i_addr3;
619 1.40 dyoung }
620 1.40 dyoung if (type != IEEE80211_FC0_TYPE_DATA)
621 1.40 dyoung break;
622 1.92 maxv
623 1.40 dyoung /*
624 1.40 dyoung * Data frame, validate the bssid.
625 1.40 dyoung */
626 1.40 dyoung if (!IEEE80211_ADDR_EQ(bssid, ic->ic_bss->ni_bssid) &&
627 1.40 dyoung !IEEE80211_ADDR_EQ(bssid, ifp->if_broadcastaddr)) {
628 1.40 dyoung /* not interested in */
629 1.85 christos IEEE80211_DEBUGVAR(
630 1.85 christos char bbuf[3 * ETHER_ADDR_LEN]);
631 1.40 dyoung IEEE80211_DISCARD_MAC(ic, IEEE80211_MSG_INPUT,
632 1.85 christos bssid, NULL, "bss %s, broadcast %s, %s",
633 1.85 christos ether_snprintf(ebuf, sizeof(ebuf),
634 1.85 christos ic->ic_bss->ni_bssid),
635 1.85 christos ether_snprintf(bbuf, sizeof(bbuf),
636 1.85 christos ifp->if_broadcastaddr), "not to bss");
637 1.40 dyoung ic->ic_stats.is_rx_wrongbss++;
638 1.40 dyoung goto out;
639 1.40 dyoung }
640 1.92 maxv
641 1.40 dyoung /*
642 1.40 dyoung * For adhoc mode we cons up a node when it doesn't
643 1.92 maxv * exist. This should probably be done after an ACL
644 1.92 maxv * check.
645 1.40 dyoung */
646 1.40 dyoung if (ni == ic->ic_bss &&
647 1.50 dyoung ic->ic_opmode != IEEE80211_M_HOSTAP &&
648 1.50 dyoung !IEEE80211_ADDR_EQ(wh->i_addr2, ni->ni_macaddr)) {
649 1.40 dyoung /*
650 1.40 dyoung * Fake up a node for this newly
651 1.40 dyoung * discovered member of the IBSS.
652 1.40 dyoung */
653 1.40 dyoung ni = ieee80211_fakeup_adhoc_node(&ic->ic_sta,
654 1.92 maxv wh->i_addr2);
655 1.40 dyoung if (ni == NULL) {
656 1.40 dyoung /* NB: stat kept for alloc failure */
657 1.40 dyoung goto err;
658 1.40 dyoung }
659 1.40 dyoung }
660 1.40 dyoung break;
661 1.92 maxv
662 1.40 dyoung default:
663 1.40 dyoung goto out;
664 1.40 dyoung }
665 1.92 maxv
666 1.1 dyoung ni->ni_rssi = rssi;
667 1.1 dyoung ni->ni_rstamp = rstamp;
668 1.92 maxv
669 1.83 mlelstv if (HAS_SEQ(type) && (ic->ic_opmode != IEEE80211_M_STA ||
670 1.83 mlelstv !IEEE80211_IS_MULTICAST(wh->i_addr1))) {
671 1.83 mlelstv u_int8_t tid, retry;
672 1.83 mlelstv u_int16_t rxno, orxno;
673 1.83 mlelstv
674 1.75 christos if (ieee80211_has_qos(wh)) {
675 1.92 maxv struct ieee80211_qosframe *qosf;
676 1.92 maxv
677 1.92 maxv /* XXX mbuf length check */
678 1.92 maxv qosf = mtod(m, struct ieee80211_qosframe *);
679 1.92 maxv
680 1.92 maxv tid = qosf->i_qos[0] & IEEE80211_QOS_TID;
681 1.44 dyoung if (TID_TO_WME_AC(tid) >= WME_AC_VI)
682 1.40 dyoung ic->ic_wme.wme_hipri_traffic++;
683 1.40 dyoung tid++;
684 1.92 maxv } else {
685 1.40 dyoung tid = 0;
686 1.92 maxv }
687 1.92 maxv
688 1.40 dyoung rxseq = le16toh(*(u_int16_t *)wh->i_seq);
689 1.83 mlelstv retry = wh->i_fc[1] & IEEE80211_FC1_RETRY;
690 1.83 mlelstv rxno = rxseq >> IEEE80211_SEQ_SEQ_SHIFT;
691 1.83 mlelstv orxno = ni->ni_rxseqs[tid] >> IEEE80211_SEQ_SEQ_SHIFT;
692 1.92 maxv
693 1.83 mlelstv if (retry && (
694 1.83 mlelstv (orxno == 4095 && rxno == orxno) ||
695 1.83 mlelstv (orxno != 4095 &&
696 1.83 mlelstv SEQ_LEQ(rxseq, ni->ni_rxseqs[tid]))
697 1.83 mlelstv )) {
698 1.40 dyoung /* duplicate, discard */
699 1.40 dyoung IEEE80211_DISCARD_MAC(ic, IEEE80211_MSG_INPUT,
700 1.40 dyoung bssid, "duplicate",
701 1.40 dyoung "seqno <%u,%u> fragno <%u,%u> tid %u",
702 1.83 mlelstv rxno,
703 1.83 mlelstv orxno,
704 1.40 dyoung rxseq & IEEE80211_SEQ_FRAG_MASK,
705 1.40 dyoung ni->ni_rxseqs[tid] &
706 1.40 dyoung IEEE80211_SEQ_FRAG_MASK,
707 1.40 dyoung tid);
708 1.40 dyoung ic->ic_stats.is_rx_dup++;
709 1.40 dyoung IEEE80211_NODE_STAT(ni, rx_dup);
710 1.40 dyoung goto out;
711 1.40 dyoung }
712 1.40 dyoung ni->ni_rxseqs[tid] = rxseq;
713 1.5 dyoung }
714 1.5 dyoung }
715 1.5 dyoung
716 1.16 dyoung switch (type) {
717 1.1 dyoung case IEEE80211_FC0_TYPE_DATA:
718 1.93 maxv ret = ieee80211_input_data(ic, &m, ni);
719 1.93 maxv if (ret == -1) {
720 1.40 dyoung goto out;
721 1.40 dyoung }
722 1.40 dyoung return IEEE80211_FC0_TYPE_DATA;
723 1.1 dyoung
724 1.1 dyoung case IEEE80211_FC0_TYPE_MGT:
725 1.93 maxv ret = ieee80211_input_management(ic, &m, ni, rssi, rstamp);
726 1.93 maxv if (ret == -1) {
727 1.1 dyoung goto out;
728 1.16 dyoung }
729 1.93 maxv return IEEE80211_FC0_TYPE_MGT;
730 1.1 dyoung
731 1.1 dyoung case IEEE80211_FC0_TYPE_CTL:
732 1.93 maxv ieee80211_input_control(ic, m, ni);
733 1.5 dyoung goto out;
734 1.93 maxv
735 1.1 dyoung default:
736 1.40 dyoung IEEE80211_DISCARD(ic, IEEE80211_MSG_ANY,
737 1.40 dyoung wh, NULL, "bad frame type 0x%x", type);
738 1.1 dyoung /* should not come here */
739 1.1 dyoung break;
740 1.1 dyoung }
741 1.92 maxv
742 1.40 dyoung err:
743 1.1 dyoung ifp->if_ierrors++;
744 1.92 maxv
745 1.40 dyoung out:
746 1.1 dyoung if (m != NULL) {
747 1.70 joerg bpf_mtap3(ic->ic_rawbpf, m);
748 1.1 dyoung m_freem(m);
749 1.1 dyoung }
750 1.40 dyoung return type;
751 1.40 dyoung #undef SEQ_LEQ
752 1.40 dyoung }
753 1.40 dyoung
754 1.40 dyoung /*
755 1.92 maxv * This function reassembles fragments.
756 1.40 dyoung */
757 1.40 dyoung static struct mbuf *
758 1.64 christos ieee80211_defrag(struct ieee80211com *ic, struct ieee80211_node *ni,
759 1.44 dyoung struct mbuf *m, int hdrspace)
760 1.40 dyoung {
761 1.40 dyoung struct ieee80211_frame *wh = mtod(m, struct ieee80211_frame *);
762 1.40 dyoung struct ieee80211_frame *lwh;
763 1.40 dyoung u_int16_t rxseq;
764 1.40 dyoung u_int8_t fragno;
765 1.94 maxv const u_int8_t more_frag = wh->i_fc[1] & IEEE80211_FC1_MORE_FRAG;
766 1.40 dyoung struct mbuf *mfrag;
767 1.40 dyoung
768 1.40 dyoung IASSERT(!IEEE80211_IS_MULTICAST(wh->i_addr1), ("multicast fragm?"));
769 1.40 dyoung
770 1.40 dyoung rxseq = le16toh(*(u_int16_t *)wh->i_seq);
771 1.40 dyoung fragno = rxseq & IEEE80211_SEQ_FRAG_MASK;
772 1.40 dyoung
773 1.40 dyoung /* Quick way out, if there's nothing to defragment */
774 1.40 dyoung if (!more_frag && fragno == 0 && ni->ni_rxfrag[0] == NULL)
775 1.40 dyoung return m;
776 1.40 dyoung
777 1.40 dyoung /*
778 1.40 dyoung * Remove frag to insure it doesn't get reaped by timer.
779 1.40 dyoung */
780 1.40 dyoung if (ni->ni_table == NULL) {
781 1.40 dyoung /*
782 1.40 dyoung * Should never happen. If the node is orphaned (not in
783 1.40 dyoung * the table) then input packets should not reach here.
784 1.40 dyoung * Otherwise, a concurrent request that yanks the table
785 1.40 dyoung * should be blocked by other interlocking and/or by first
786 1.40 dyoung * shutting the driver down. Regardless, be defensive
787 1.40 dyoung * here and just bail
788 1.40 dyoung */
789 1.40 dyoung /* XXX need msg+stat */
790 1.40 dyoung m_freem(m);
791 1.40 dyoung return NULL;
792 1.40 dyoung }
793 1.40 dyoung IEEE80211_NODE_LOCK(ni->ni_table);
794 1.40 dyoung mfrag = ni->ni_rxfrag[0];
795 1.40 dyoung ni->ni_rxfrag[0] = NULL;
796 1.40 dyoung IEEE80211_NODE_UNLOCK(ni->ni_table);
797 1.40 dyoung
798 1.40 dyoung /*
799 1.40 dyoung * Validate new fragment is in order and
800 1.40 dyoung * related to the previous ones.
801 1.40 dyoung */
802 1.40 dyoung if (mfrag != NULL) {
803 1.40 dyoung u_int16_t last_rxseq;
804 1.40 dyoung
805 1.40 dyoung lwh = mtod(mfrag, struct ieee80211_frame *);
806 1.40 dyoung last_rxseq = le16toh(*(u_int16_t *)lwh->i_seq);
807 1.40 dyoung /* NB: check seq # and frag together */
808 1.40 dyoung if (rxseq != last_rxseq+1 ||
809 1.40 dyoung !IEEE80211_ADDR_EQ(wh->i_addr1, lwh->i_addr1) ||
810 1.40 dyoung !IEEE80211_ADDR_EQ(wh->i_addr2, lwh->i_addr2)) {
811 1.40 dyoung /*
812 1.40 dyoung * Unrelated fragment or no space for it,
813 1.40 dyoung * clear current fragments.
814 1.40 dyoung */
815 1.40 dyoung m_freem(mfrag);
816 1.40 dyoung mfrag = NULL;
817 1.40 dyoung }
818 1.40 dyoung }
819 1.40 dyoung
820 1.94 maxv if (mfrag == NULL) {
821 1.40 dyoung if (fragno != 0) { /* !first fragment, discard */
822 1.40 dyoung IEEE80211_NODE_STAT(ni, rx_defrag);
823 1.40 dyoung m_freem(m);
824 1.40 dyoung return NULL;
825 1.40 dyoung }
826 1.40 dyoung mfrag = m;
827 1.94 maxv } else {
828 1.94 maxv /* Strip header and concatenate */
829 1.94 maxv m_adj(m, hdrspace);
830 1.40 dyoung m_cat(mfrag, m);
831 1.94 maxv
832 1.40 dyoung /* NB: m_cat doesn't update the packet header */
833 1.40 dyoung mfrag->m_pkthdr.len += m->m_pkthdr.len;
834 1.94 maxv
835 1.40 dyoung /* track last seqnum and fragno */
836 1.40 dyoung lwh = mtod(mfrag, struct ieee80211_frame *);
837 1.94 maxv *(u_int16_t *)lwh->i_seq = *(u_int16_t *)wh->i_seq;
838 1.40 dyoung }
839 1.94 maxv
840 1.94 maxv if (more_frag) {
841 1.94 maxv /* more to come, save */
842 1.40 dyoung ni->ni_rxfragstamp = ticks;
843 1.40 dyoung ni->ni_rxfrag[0] = mfrag;
844 1.40 dyoung mfrag = NULL;
845 1.40 dyoung }
846 1.94 maxv
847 1.40 dyoung return mfrag;
848 1.1 dyoung }
849 1.1 dyoung
850 1.47 skrll static void
851 1.47 skrll ieee80211_deliver_data(struct ieee80211com *ic,
852 1.47 skrll struct ieee80211_node *ni, struct mbuf *m)
853 1.47 skrll {
854 1.47 skrll struct ether_header *eh = mtod(m, struct ether_header *);
855 1.47 skrll struct ifnet *ifp = ic->ic_ifp;
856 1.68 joerg int error;
857 1.47 skrll
858 1.47 skrll /* perform as a bridge within the AP */
859 1.47 skrll if (ic->ic_opmode == IEEE80211_M_HOSTAP &&
860 1.47 skrll (ic->ic_flags & IEEE80211_F_NOBRIDGE) == 0) {
861 1.47 skrll struct mbuf *m1 = NULL;
862 1.47 skrll
863 1.47 skrll if (ETHER_IS_MULTICAST(eh->ether_dhost)) {
864 1.47 skrll m1 = m_copypacket(m, M_DONTWAIT);
865 1.47 skrll if (m1 == NULL)
866 1.47 skrll ifp->if_oerrors++;
867 1.47 skrll else
868 1.47 skrll m1->m_flags |= M_MCAST;
869 1.47 skrll } else {
870 1.47 skrll /*
871 1.47 skrll * Check if the destination is known; if so
872 1.47 skrll * and the port is authorized dispatch directly.
873 1.47 skrll */
874 1.47 skrll struct ieee80211_node *sta =
875 1.47 skrll ieee80211_find_node(&ic->ic_sta, eh->ether_dhost);
876 1.47 skrll if (sta != NULL) {
877 1.47 skrll if (ieee80211_node_is_authorized(sta)) {
878 1.47 skrll /*
879 1.47 skrll * Beware of sending to ourself; this
880 1.47 skrll * needs to happen via the normal
881 1.47 skrll * input path.
882 1.47 skrll */
883 1.47 skrll if (sta != ic->ic_bss) {
884 1.47 skrll m1 = m;
885 1.47 skrll m = NULL;
886 1.47 skrll }
887 1.47 skrll } else {
888 1.47 skrll ic->ic_stats.is_rx_unauth++;
889 1.47 skrll IEEE80211_NODE_STAT(sta, rx_unauth);
890 1.47 skrll }
891 1.47 skrll ieee80211_free_node(sta);
892 1.47 skrll }
893 1.47 skrll }
894 1.95 maxv
895 1.47 skrll if (m1 != NULL) {
896 1.47 skrll int len;
897 1.47 skrll #ifdef ALTQ
898 1.47 skrll if (ALTQ_IS_ENABLED(&ifp->if_snd)) {
899 1.81 knakahar altq_etherclassify(&ifp->if_snd, m1);
900 1.47 skrll }
901 1.47 skrll #endif
902 1.47 skrll len = m1->m_pkthdr.len;
903 1.82 knakahar IFQ_ENQUEUE(&ifp->if_snd, m1, error);
904 1.68 joerg if (error) {
905 1.88 ozaki ifp->if_oerrors++;
906 1.95 maxv m_freem(m);
907 1.68 joerg m = NULL;
908 1.68 joerg }
909 1.47 skrll ifp->if_obytes += len;
910 1.47 skrll }
911 1.47 skrll }
912 1.95 maxv
913 1.47 skrll if (m != NULL) {
914 1.89 knakahar if (ni->ni_vlan != 0)
915 1.89 knakahar vlan_set_tag(m, ni->ni_vlan);
916 1.80 ozaki
917 1.80 ozaki /*
918 1.80 ozaki * XXX once ieee80211_input (or rxintr itself) runs in softint
919 1.80 ozaki * we have to change here too to use if_input.
920 1.80 ozaki */
921 1.80 ozaki KASSERT(ifp->if_percpuq);
922 1.80 ozaki if_percpuq_enqueue(ifp->if_percpuq, m);
923 1.47 skrll }
924 1.95 maxv
925 1.47 skrll return;
926 1.47 skrll }
927 1.47 skrll
928 1.40 dyoung static struct mbuf *
929 1.64 christos ieee80211_decap(struct ieee80211com *ic, struct mbuf *m, int hdrlen)
930 1.1 dyoung {
931 1.94 maxv struct ieee80211_qosframe_addr4 wh; /* Max size address frames */
932 1.1 dyoung struct ether_header *eh;
933 1.1 dyoung struct llc *llc;
934 1.1 dyoung
935 1.44 dyoung if (m->m_len < hdrlen + sizeof(*llc) &&
936 1.44 dyoung (m = m_pullup(m, hdrlen + sizeof(*llc))) == NULL) {
937 1.40 dyoung return NULL;
938 1.1 dyoung }
939 1.94 maxv
940 1.65 christos memcpy(&wh, mtod(m, void *), hdrlen);
941 1.94 maxv
942 1.65 christos llc = (struct llc *)(mtod(m, char *) + hdrlen);
943 1.94 maxv if (llc->llc_dsap == LLC_SNAP_LSAP &&
944 1.94 maxv llc->llc_ssap == LLC_SNAP_LSAP &&
945 1.94 maxv llc->llc_control == LLC_UI &&
946 1.94 maxv llc->llc_snap.org_code[0] == 0 &&
947 1.94 maxv llc->llc_snap.org_code[1] == 0 &&
948 1.94 maxv llc->llc_snap.org_code[2] == 0) {
949 1.44 dyoung m_adj(m, hdrlen + sizeof(struct llc) - sizeof(*eh));
950 1.1 dyoung llc = NULL;
951 1.1 dyoung } else {
952 1.94 maxv /* Keep the LLC after the Ethernet header. */
953 1.44 dyoung m_adj(m, hdrlen - sizeof(*eh));
954 1.1 dyoung }
955 1.94 maxv
956 1.1 dyoung eh = mtod(m, struct ether_header *);
957 1.94 maxv
958 1.1 dyoung switch (wh.i_fc[1] & IEEE80211_FC1_DIR_MASK) {
959 1.1 dyoung case IEEE80211_FC1_DIR_NODS:
960 1.1 dyoung IEEE80211_ADDR_COPY(eh->ether_dhost, wh.i_addr1);
961 1.1 dyoung IEEE80211_ADDR_COPY(eh->ether_shost, wh.i_addr2);
962 1.1 dyoung break;
963 1.1 dyoung case IEEE80211_FC1_DIR_TODS:
964 1.1 dyoung IEEE80211_ADDR_COPY(eh->ether_dhost, wh.i_addr3);
965 1.1 dyoung IEEE80211_ADDR_COPY(eh->ether_shost, wh.i_addr2);
966 1.1 dyoung break;
967 1.1 dyoung case IEEE80211_FC1_DIR_FROMDS:
968 1.1 dyoung IEEE80211_ADDR_COPY(eh->ether_dhost, wh.i_addr1);
969 1.1 dyoung IEEE80211_ADDR_COPY(eh->ether_shost, wh.i_addr3);
970 1.1 dyoung break;
971 1.1 dyoung case IEEE80211_FC1_DIR_DSTODS:
972 1.44 dyoung IEEE80211_ADDR_COPY(eh->ether_dhost, wh.i_addr3);
973 1.44 dyoung IEEE80211_ADDR_COPY(eh->ether_shost, wh.i_addr4);
974 1.44 dyoung break;
975 1.1 dyoung }
976 1.94 maxv
977 1.1 dyoung #ifdef ALIGNED_POINTER
978 1.66 christos if (!ALIGNED_POINTER(mtod(m, char *) + sizeof(*eh), u_int32_t)) {
979 1.1 dyoung struct mbuf *n, *n0, **np;
980 1.65 christos char *newdata;
981 1.1 dyoung int off, pktlen;
982 1.1 dyoung
983 1.1 dyoung n0 = NULL;
984 1.1 dyoung np = &n0;
985 1.1 dyoung off = 0;
986 1.1 dyoung pktlen = m->m_pkthdr.len;
987 1.1 dyoung while (pktlen > off) {
988 1.1 dyoung if (n0 == NULL) {
989 1.1 dyoung MGETHDR(n, M_DONTWAIT, MT_DATA);
990 1.1 dyoung if (n == NULL) {
991 1.1 dyoung m_freem(m);
992 1.1 dyoung return NULL;
993 1.1 dyoung }
994 1.45 yamt M_MOVE_PKTHDR(n, m);
995 1.1 dyoung n->m_len = MHLEN;
996 1.1 dyoung } else {
997 1.1 dyoung MGET(n, M_DONTWAIT, MT_DATA);
998 1.1 dyoung if (n == NULL) {
999 1.1 dyoung m_freem(m);
1000 1.1 dyoung m_freem(n0);
1001 1.1 dyoung return NULL;
1002 1.1 dyoung }
1003 1.1 dyoung n->m_len = MLEN;
1004 1.1 dyoung }
1005 1.1 dyoung if (pktlen - off >= MINCLSIZE) {
1006 1.1 dyoung MCLGET(n, M_DONTWAIT);
1007 1.1 dyoung if (n->m_flags & M_EXT)
1008 1.1 dyoung n->m_len = n->m_ext.ext_size;
1009 1.1 dyoung }
1010 1.1 dyoung if (n0 == NULL) {
1011 1.1 dyoung newdata =
1012 1.65 christos (char *)ALIGN(n->m_data + sizeof(*eh)) -
1013 1.1 dyoung sizeof(*eh);
1014 1.1 dyoung n->m_len -= newdata - n->m_data;
1015 1.1 dyoung n->m_data = newdata;
1016 1.1 dyoung }
1017 1.1 dyoung if (n->m_len > pktlen - off)
1018 1.1 dyoung n->m_len = pktlen - off;
1019 1.65 christos m_copydata(m, off, n->m_len, mtod(n, void *));
1020 1.1 dyoung off += n->m_len;
1021 1.1 dyoung *np = n;
1022 1.1 dyoung np = &n->m_next;
1023 1.1 dyoung }
1024 1.1 dyoung m_freem(m);
1025 1.1 dyoung m = n0;
1026 1.1 dyoung }
1027 1.1 dyoung #endif /* ALIGNED_POINTER */
1028 1.94 maxv
1029 1.1 dyoung if (llc != NULL) {
1030 1.1 dyoung eh = mtod(m, struct ether_header *);
1031 1.1 dyoung eh->ether_type = htons(m->m_pkthdr.len - sizeof(*eh));
1032 1.1 dyoung }
1033 1.94 maxv
1034 1.1 dyoung return m;
1035 1.1 dyoung }
1036 1.1 dyoung
1037 1.1 dyoung /*
1038 1.1 dyoung * Install received rate set information in the node's state block.
1039 1.1 dyoung */
1040 1.47 skrll int
1041 1.47 skrll ieee80211_setup_rates(struct ieee80211_node *ni,
1042 1.47 skrll const u_int8_t *rates, const u_int8_t *xrates, int flags)
1043 1.1 dyoung {
1044 1.47 skrll struct ieee80211com *ic = ni->ni_ic;
1045 1.1 dyoung struct ieee80211_rateset *rs = &ni->ni_rates;
1046 1.1 dyoung
1047 1.1 dyoung memset(rs, 0, sizeof(*rs));
1048 1.1 dyoung rs->rs_nrates = rates[1];
1049 1.1 dyoung memcpy(rs->rs_rates, rates + 2, rs->rs_nrates);
1050 1.1 dyoung if (xrates != NULL) {
1051 1.1 dyoung u_int8_t nxrates;
1052 1.1 dyoung /*
1053 1.1 dyoung * Tack on 11g extended supported rate element.
1054 1.1 dyoung */
1055 1.1 dyoung nxrates = xrates[1];
1056 1.1 dyoung if (rs->rs_nrates + nxrates > IEEE80211_RATE_MAXSIZE) {
1057 1.85 christos IEEE80211_DEBUGVAR(char ebuf[3 * ETHER_ADDR_LEN]);
1058 1.1 dyoung nxrates = IEEE80211_RATE_MAXSIZE - rs->rs_nrates;
1059 1.25 mycroft IEEE80211_DPRINTF(ic, IEEE80211_MSG_XRATE,
1060 1.40 dyoung "[%s] extended rate set too large;"
1061 1.40 dyoung " only using %u of %u rates\n",
1062 1.85 christos ether_snprintf(ebuf, sizeof(ebuf), ni->ni_macaddr),
1063 1.85 christos nxrates, xrates[1]);
1064 1.16 dyoung ic->ic_stats.is_rx_rstoobig++;
1065 1.1 dyoung }
1066 1.1 dyoung memcpy(rs->rs_rates + rs->rs_nrates, xrates+2, nxrates);
1067 1.1 dyoung rs->rs_nrates += nxrates;
1068 1.1 dyoung }
1069 1.47 skrll return ieee80211_fix_rate(ni, flags);
1070 1.1 dyoung }
1071 1.1 dyoung
1072 1.7 dyoung static void
1073 1.7 dyoung ieee80211_auth_open(struct ieee80211com *ic, struct ieee80211_frame *wh,
1074 1.64 christos struct ieee80211_node *ni, int rssi, u_int32_t rstamp,
1075 1.63 christos u_int16_t seq, u_int16_t status)
1076 1.7 dyoung {
1077 1.85 christos IEEE80211_DEBUGVAR(char ebuf[3 * ETHER_ADDR_LEN]);
1078 1.40 dyoung
1079 1.44 dyoung if (ni->ni_authmode == IEEE80211_AUTH_SHARED) {
1080 1.44 dyoung IEEE80211_DISCARD_MAC(ic, IEEE80211_MSG_AUTH,
1081 1.44 dyoung ni->ni_macaddr, "open auth",
1082 1.44 dyoung "bad sta auth mode %u", ni->ni_authmode);
1083 1.44 dyoung ic->ic_stats.is_rx_bad_auth++; /* XXX */
1084 1.44 dyoung if (ic->ic_opmode == IEEE80211_M_HOSTAP) {
1085 1.44 dyoung /* XXX hack to workaround calling convention */
1086 1.74 christos ieee80211_send_error(ic, ni, wh->i_addr2,
1087 1.44 dyoung IEEE80211_FC0_SUBTYPE_AUTH,
1088 1.44 dyoung (seq + 1) | (IEEE80211_STATUS_ALG<<16));
1089 1.44 dyoung }
1090 1.44 dyoung return;
1091 1.44 dyoung }
1092 1.7 dyoung switch (ic->ic_opmode) {
1093 1.7 dyoung case IEEE80211_M_IBSS:
1094 1.7 dyoung case IEEE80211_M_AHDEMO:
1095 1.44 dyoung case IEEE80211_M_MONITOR:
1096 1.7 dyoung /* should not come here */
1097 1.44 dyoung IEEE80211_DISCARD_MAC(ic, IEEE80211_MSG_AUTH,
1098 1.44 dyoung ni->ni_macaddr, "open auth",
1099 1.44 dyoung "bad operating mode %u", ic->ic_opmode);
1100 1.7 dyoung break;
1101 1.7 dyoung
1102 1.7 dyoung case IEEE80211_M_HOSTAP:
1103 1.41 dyoung #ifndef IEEE80211_NO_HOSTAP
1104 1.11 mycroft if (ic->ic_state != IEEE80211_S_RUN ||
1105 1.16 dyoung seq != IEEE80211_AUTH_OPEN_REQUEST) {
1106 1.16 dyoung ic->ic_stats.is_rx_bad_auth++;
1107 1.7 dyoung return;
1108 1.16 dyoung }
1109 1.40 dyoung /* always accept open authentication requests */
1110 1.7 dyoung if (ni == ic->ic_bss) {
1111 1.40 dyoung ni = ieee80211_dup_bss(&ic->ic_sta, wh->i_addr2);
1112 1.40 dyoung if (ni == NULL)
1113 1.7 dyoung return;
1114 1.44 dyoung } else if ((ni->ni_flags & IEEE80211_NODE_AREF) == 0)
1115 1.40 dyoung (void) ieee80211_ref_node(ni);
1116 1.44 dyoung /*
1117 1.78 snj * Mark the node as referenced to reflect that its
1118 1.44 dyoung * reference count has been bumped to insure it remains
1119 1.44 dyoung * after the transaction completes.
1120 1.44 dyoung */
1121 1.44 dyoung ni->ni_flags |= IEEE80211_NODE_AREF;
1122 1.44 dyoung
1123 1.7 dyoung IEEE80211_SEND_MGMT(ic, ni,
1124 1.7 dyoung IEEE80211_FC0_SUBTYPE_AUTH, seq + 1);
1125 1.26 mycroft IEEE80211_DPRINTF(ic, IEEE80211_MSG_DEBUG | IEEE80211_MSG_AUTH,
1126 1.40 dyoung "[%s] station authenticated (open)\n",
1127 1.85 christos ether_snprintf(ebuf, sizeof(ebuf), ni->ni_macaddr));
1128 1.44 dyoung /*
1129 1.44 dyoung * When 802.1x is not in use mark the port
1130 1.44 dyoung * authorized at this point so traffic can flow.
1131 1.44 dyoung */
1132 1.44 dyoung if (ni->ni_authmode != IEEE80211_AUTH_8021X)
1133 1.47 skrll ieee80211_node_authorize(ni);
1134 1.41 dyoung #endif /* !IEEE80211_NO_HOSTAP */
1135 1.7 dyoung break;
1136 1.26 mycroft
1137 1.7 dyoung case IEEE80211_M_STA:
1138 1.7 dyoung if (ic->ic_state != IEEE80211_S_AUTH ||
1139 1.16 dyoung seq != IEEE80211_AUTH_OPEN_RESPONSE) {
1140 1.16 dyoung ic->ic_stats.is_rx_bad_auth++;
1141 1.7 dyoung return;
1142 1.16 dyoung }
1143 1.7 dyoung if (status != 0) {
1144 1.85 christos
1145 1.26 mycroft IEEE80211_DPRINTF(ic,
1146 1.26 mycroft IEEE80211_MSG_DEBUG | IEEE80211_MSG_AUTH,
1147 1.40 dyoung "[%s] open auth failed (reason %d)\n",
1148 1.85 christos ether_snprintf(ebuf, sizeof(ebuf), ni->ni_macaddr),
1149 1.85 christos status);
1150 1.40 dyoung /* XXX can this happen? */
1151 1.7 dyoung if (ni != ic->ic_bss)
1152 1.7 dyoung ni->ni_fails++;
1153 1.16 dyoung ic->ic_stats.is_rx_auth_fail++;
1154 1.44 dyoung ieee80211_new_state(ic, IEEE80211_S_SCAN, 0);
1155 1.44 dyoung } else
1156 1.44 dyoung ieee80211_new_state(ic, IEEE80211_S_ASSOC,
1157 1.44 dyoung wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK);
1158 1.7 dyoung break;
1159 1.7 dyoung }
1160 1.7 dyoung }
1161 1.7 dyoung
1162 1.44 dyoung /*
1163 1.44 dyoung * Send a management frame error response to the specified
1164 1.44 dyoung * station. If ni is associated with the station then use
1165 1.44 dyoung * it; otherwise allocate a temporary node suitable for
1166 1.44 dyoung * transmitting the frame and then free the reference so
1167 1.44 dyoung * it will go away as soon as the frame has been transmitted.
1168 1.44 dyoung */
1169 1.44 dyoung static void
1170 1.44 dyoung ieee80211_send_error(struct ieee80211com *ic, struct ieee80211_node *ni,
1171 1.44 dyoung const u_int8_t *mac, int subtype, int arg)
1172 1.44 dyoung {
1173 1.44 dyoung int istmp;
1174 1.44 dyoung
1175 1.44 dyoung if (ni == ic->ic_bss) {
1176 1.47 skrll ni = ieee80211_tmp_node(ic, mac);
1177 1.44 dyoung if (ni == NULL) {
1178 1.44 dyoung /* XXX msg */
1179 1.44 dyoung return;
1180 1.44 dyoung }
1181 1.44 dyoung istmp = 1;
1182 1.44 dyoung } else
1183 1.44 dyoung istmp = 0;
1184 1.44 dyoung IEEE80211_SEND_MGMT(ic, ni, subtype, arg);
1185 1.44 dyoung if (istmp)
1186 1.44 dyoung ieee80211_free_node(ni);
1187 1.44 dyoung }
1188 1.44 dyoung
1189 1.40 dyoung static int
1190 1.40 dyoung alloc_challenge(struct ieee80211com *ic, struct ieee80211_node *ni)
1191 1.40 dyoung {
1192 1.40 dyoung if (ni->ni_challenge == NULL)
1193 1.67 cegger ni->ni_challenge = malloc(IEEE80211_CHALLENGE_LEN,
1194 1.40 dyoung M_DEVBUF, M_NOWAIT);
1195 1.40 dyoung if (ni->ni_challenge == NULL) {
1196 1.85 christos IEEE80211_DEBUGVAR(char ebuf[3 * ETHER_ADDR_LEN]);
1197 1.85 christos
1198 1.40 dyoung IEEE80211_DPRINTF(ic, IEEE80211_MSG_DEBUG | IEEE80211_MSG_AUTH,
1199 1.40 dyoung "[%s] shared key challenge alloc failed\n",
1200 1.85 christos ether_snprintf(ebuf, sizeof(ebuf), ni->ni_macaddr));
1201 1.40 dyoung /* XXX statistic */
1202 1.40 dyoung }
1203 1.40 dyoung return (ni->ni_challenge != NULL);
1204 1.40 dyoung }
1205 1.40 dyoung
1206 1.40 dyoung /* XXX TODO: add statistics */
1207 1.7 dyoung static void
1208 1.7 dyoung ieee80211_auth_shared(struct ieee80211com *ic, struct ieee80211_frame *wh,
1209 1.7 dyoung u_int8_t *frm, u_int8_t *efrm, struct ieee80211_node *ni, int rssi,
1210 1.7 dyoung u_int32_t rstamp, u_int16_t seq, u_int16_t status)
1211 1.7 dyoung {
1212 1.40 dyoung u_int8_t *challenge;
1213 1.41 dyoung int estatus;
1214 1.85 christos IEEE80211_DEBUGVAR(char ebuf[3 * ETHER_ADDR_LEN]);
1215 1.7 dyoung
1216 1.40 dyoung /*
1217 1.40 dyoung * NB: this can happen as we allow pre-shared key
1218 1.40 dyoung * authentication to be enabled w/o wep being turned
1219 1.40 dyoung * on so that configuration of these can be done
1220 1.40 dyoung * in any order. It may be better to enforce the
1221 1.40 dyoung * ordering in which case this check would just be
1222 1.40 dyoung * for sanity/consistency.
1223 1.40 dyoung */
1224 1.28 mycroft if ((ic->ic_flags & IEEE80211_F_PRIVACY) == 0) {
1225 1.40 dyoung IEEE80211_DISCARD_MAC(ic, IEEE80211_MSG_AUTH,
1226 1.40 dyoung ni->ni_macaddr, "shared key auth",
1227 1.40 dyoung "%s", " PRIVACY is disabled");
1228 1.40 dyoung estatus = IEEE80211_STATUS_ALG;
1229 1.40 dyoung goto bad;
1230 1.40 dyoung }
1231 1.40 dyoung /*
1232 1.40 dyoung * Pre-shared key authentication is evil; accept
1233 1.40 dyoung * it only if explicitly configured (it is supported
1234 1.40 dyoung * mainly for compatibility with clients like OS X).
1235 1.40 dyoung */
1236 1.40 dyoung if (ni->ni_authmode != IEEE80211_AUTH_AUTO &&
1237 1.40 dyoung ni->ni_authmode != IEEE80211_AUTH_SHARED) {
1238 1.40 dyoung IEEE80211_DISCARD_MAC(ic, IEEE80211_MSG_AUTH,
1239 1.40 dyoung ni->ni_macaddr, "shared key auth",
1240 1.40 dyoung "bad sta auth mode %u", ni->ni_authmode);
1241 1.40 dyoung ic->ic_stats.is_rx_bad_auth++; /* XXX maybe a unique error? */
1242 1.40 dyoung estatus = IEEE80211_STATUS_ALG;
1243 1.40 dyoung goto bad;
1244 1.7 dyoung }
1245 1.7 dyoung
1246 1.40 dyoung challenge = NULL;
1247 1.7 dyoung if (frm + 1 < efrm) {
1248 1.40 dyoung if ((frm[1] + 2) > (efrm - frm)) {
1249 1.40 dyoung IEEE80211_DISCARD_MAC(ic, IEEE80211_MSG_AUTH,
1250 1.40 dyoung ni->ni_macaddr, "shared key auth",
1251 1.40 dyoung "ie %d/%d too long",
1252 1.40 dyoung frm[0], (frm[1] + 2) - (efrm - frm));
1253 1.16 dyoung ic->ic_stats.is_rx_bad_auth++;
1254 1.40 dyoung estatus = IEEE80211_STATUS_CHALLENGE;
1255 1.40 dyoung goto bad;
1256 1.7 dyoung }
1257 1.7 dyoung if (*frm == IEEE80211_ELEMID_CHALLENGE)
1258 1.7 dyoung challenge = frm;
1259 1.7 dyoung frm += frm[1] + 2;
1260 1.7 dyoung }
1261 1.7 dyoung switch (seq) {
1262 1.7 dyoung case IEEE80211_AUTH_SHARED_CHALLENGE:
1263 1.7 dyoung case IEEE80211_AUTH_SHARED_RESPONSE:
1264 1.7 dyoung if (challenge == NULL) {
1265 1.40 dyoung IEEE80211_DISCARD_MAC(ic, IEEE80211_MSG_AUTH,
1266 1.40 dyoung ni->ni_macaddr, "shared key auth",
1267 1.40 dyoung "%s", "no challenge");
1268 1.16 dyoung ic->ic_stats.is_rx_bad_auth++;
1269 1.40 dyoung estatus = IEEE80211_STATUS_CHALLENGE;
1270 1.40 dyoung goto bad;
1271 1.7 dyoung }
1272 1.7 dyoung if (challenge[1] != IEEE80211_CHALLENGE_LEN) {
1273 1.40 dyoung IEEE80211_DISCARD_MAC(ic, IEEE80211_MSG_AUTH,
1274 1.40 dyoung ni->ni_macaddr, "shared key auth",
1275 1.40 dyoung "bad challenge len %d", challenge[1]);
1276 1.16 dyoung ic->ic_stats.is_rx_bad_auth++;
1277 1.40 dyoung estatus = IEEE80211_STATUS_CHALLENGE;
1278 1.40 dyoung goto bad;
1279 1.7 dyoung }
1280 1.7 dyoung default:
1281 1.7 dyoung break;
1282 1.7 dyoung }
1283 1.7 dyoung switch (ic->ic_opmode) {
1284 1.7 dyoung case IEEE80211_M_MONITOR:
1285 1.7 dyoung case IEEE80211_M_AHDEMO:
1286 1.7 dyoung case IEEE80211_M_IBSS:
1287 1.40 dyoung IEEE80211_DISCARD_MAC(ic, IEEE80211_MSG_AUTH,
1288 1.40 dyoung ni->ni_macaddr, "shared key auth",
1289 1.40 dyoung "bad operating mode %u", ic->ic_opmode);
1290 1.7 dyoung return;
1291 1.7 dyoung case IEEE80211_M_HOSTAP:
1292 1.41 dyoung #ifndef IEEE80211_NO_HOSTAP
1293 1.41 dyoung {
1294 1.41 dyoung int allocbs;
1295 1.7 dyoung if (ic->ic_state != IEEE80211_S_RUN) {
1296 1.40 dyoung IEEE80211_DISCARD_MAC(ic, IEEE80211_MSG_AUTH,
1297 1.40 dyoung ni->ni_macaddr, "shared key auth",
1298 1.40 dyoung "bad state %u", ic->ic_state);
1299 1.40 dyoung estatus = IEEE80211_STATUS_ALG; /* XXX */
1300 1.40 dyoung goto bad;
1301 1.7 dyoung }
1302 1.7 dyoung switch (seq) {
1303 1.7 dyoung case IEEE80211_AUTH_SHARED_REQUEST:
1304 1.7 dyoung if (ni == ic->ic_bss) {
1305 1.40 dyoung ni = ieee80211_dup_bss(&ic->ic_sta, wh->i_addr2);
1306 1.16 dyoung if (ni == NULL) {
1307 1.40 dyoung /* NB: no way to return an error */
1308 1.7 dyoung return;
1309 1.16 dyoung }
1310 1.40 dyoung allocbs = 1;
1311 1.40 dyoung } else {
1312 1.44 dyoung if ((ni->ni_flags & IEEE80211_NODE_AREF) == 0)
1313 1.44 dyoung (void) ieee80211_ref_node(ni);
1314 1.40 dyoung allocbs = 0;
1315 1.40 dyoung }
1316 1.85 christos __USE(allocbs);
1317 1.44 dyoung /*
1318 1.78 snj * Mark the node as referenced to reflect that its
1319 1.44 dyoung * reference count has been bumped to insure it remains
1320 1.44 dyoung * after the transaction completes.
1321 1.44 dyoung */
1322 1.44 dyoung ni->ni_flags |= IEEE80211_NODE_AREF;
1323 1.40 dyoung ni->ni_rssi = rssi;
1324 1.40 dyoung ni->ni_rstamp = rstamp;
1325 1.40 dyoung if (!alloc_challenge(ic, ni)) {
1326 1.40 dyoung /* NB: don't return error so they rexmit */
1327 1.40 dyoung return;
1328 1.40 dyoung }
1329 1.40 dyoung get_random_bytes(ni->ni_challenge,
1330 1.40 dyoung IEEE80211_CHALLENGE_LEN);
1331 1.40 dyoung IEEE80211_DPRINTF(ic,
1332 1.40 dyoung IEEE80211_MSG_DEBUG | IEEE80211_MSG_AUTH,
1333 1.40 dyoung "[%s] shared key %sauth request\n",
1334 1.85 christos ether_snprintf(ebuf, sizeof(ebuf),
1335 1.85 christos ni->ni_macaddr),
1336 1.40 dyoung allocbs ? "" : "re");
1337 1.40 dyoung break;
1338 1.40 dyoung case IEEE80211_AUTH_SHARED_RESPONSE:
1339 1.40 dyoung if (ni == ic->ic_bss) {
1340 1.40 dyoung IEEE80211_DISCARD_MAC(ic, IEEE80211_MSG_AUTH,
1341 1.40 dyoung ni->ni_macaddr, "shared key response",
1342 1.40 dyoung "%s", "unknown station");
1343 1.40 dyoung /* NB: don't send a response */
1344 1.40 dyoung return;
1345 1.40 dyoung }
1346 1.7 dyoung if (ni->ni_challenge == NULL) {
1347 1.40 dyoung IEEE80211_DISCARD_MAC(ic, IEEE80211_MSG_AUTH,
1348 1.40 dyoung ni->ni_macaddr, "shared key response",
1349 1.40 dyoung "%s", "no challenge recorded");
1350 1.40 dyoung ic->ic_stats.is_rx_bad_auth++;
1351 1.40 dyoung estatus = IEEE80211_STATUS_CHALLENGE;
1352 1.40 dyoung goto bad;
1353 1.40 dyoung }
1354 1.40 dyoung if (memcmp(ni->ni_challenge, &challenge[2],
1355 1.40 dyoung challenge[1]) != 0) {
1356 1.40 dyoung IEEE80211_DISCARD_MAC(ic, IEEE80211_MSG_AUTH,
1357 1.40 dyoung ni->ni_macaddr, "shared key response",
1358 1.40 dyoung "%s", "challenge mismatch");
1359 1.40 dyoung ic->ic_stats.is_rx_auth_fail++;
1360 1.40 dyoung estatus = IEEE80211_STATUS_CHALLENGE;
1361 1.40 dyoung goto bad;
1362 1.40 dyoung }
1363 1.40 dyoung IEEE80211_DPRINTF(ic,
1364 1.40 dyoung IEEE80211_MSG_DEBUG | IEEE80211_MSG_AUTH,
1365 1.40 dyoung "[%s] station authenticated (shared key)\n",
1366 1.85 christos ether_snprintf(ebuf, sizeof(ebuf), ni->ni_macaddr));
1367 1.47 skrll ieee80211_node_authorize(ni);
1368 1.40 dyoung break;
1369 1.40 dyoung default:
1370 1.40 dyoung IEEE80211_DISCARD_MAC(ic, IEEE80211_MSG_AUTH,
1371 1.40 dyoung ni->ni_macaddr, "shared key auth",
1372 1.40 dyoung "bad seq %d", seq);
1373 1.40 dyoung ic->ic_stats.is_rx_bad_auth++;
1374 1.40 dyoung estatus = IEEE80211_STATUS_SEQUENCE;
1375 1.40 dyoung goto bad;
1376 1.40 dyoung }
1377 1.40 dyoung IEEE80211_SEND_MGMT(ic, ni,
1378 1.40 dyoung IEEE80211_FC0_SUBTYPE_AUTH, seq + 1);
1379 1.41 dyoung }
1380 1.41 dyoung #endif /* !IEEE80211_NO_HOSTAP */
1381 1.40 dyoung break;
1382 1.40 dyoung
1383 1.40 dyoung case IEEE80211_M_STA:
1384 1.40 dyoung if (ic->ic_state != IEEE80211_S_AUTH)
1385 1.40 dyoung return;
1386 1.40 dyoung switch (seq) {
1387 1.40 dyoung case IEEE80211_AUTH_SHARED_PASS:
1388 1.40 dyoung if (ni->ni_challenge != NULL) {
1389 1.67 cegger free(ni->ni_challenge, M_DEVBUF);
1390 1.40 dyoung ni->ni_challenge = NULL;
1391 1.40 dyoung }
1392 1.40 dyoung if (status != 0) {
1393 1.40 dyoung IEEE80211_DPRINTF(ic,
1394 1.40 dyoung IEEE80211_MSG_DEBUG | IEEE80211_MSG_AUTH,
1395 1.40 dyoung "[%s] shared key auth failed (reason %d)\n",
1396 1.85 christos ether_snprintf(ebuf, sizeof(ebuf),
1397 1.85 christos ieee80211_getbssid(ic, wh)),
1398 1.40 dyoung status);
1399 1.40 dyoung /* XXX can this happen? */
1400 1.40 dyoung if (ni != ic->ic_bss)
1401 1.40 dyoung ni->ni_fails++;
1402 1.40 dyoung ic->ic_stats.is_rx_auth_fail++;
1403 1.7 dyoung return;
1404 1.7 dyoung }
1405 1.40 dyoung ieee80211_new_state(ic, IEEE80211_S_ASSOC,
1406 1.40 dyoung wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK);
1407 1.40 dyoung break;
1408 1.40 dyoung case IEEE80211_AUTH_SHARED_CHALLENGE:
1409 1.40 dyoung if (!alloc_challenge(ic, ni))
1410 1.40 dyoung return;
1411 1.40 dyoung /* XXX could optimize by passing recvd challenge */
1412 1.40 dyoung memcpy(ni->ni_challenge, &challenge[2], challenge[1]);
1413 1.40 dyoung IEEE80211_SEND_MGMT(ic, ni,
1414 1.40 dyoung IEEE80211_FC0_SUBTYPE_AUTH, seq + 1);
1415 1.40 dyoung break;
1416 1.40 dyoung default:
1417 1.40 dyoung IEEE80211_DISCARD(ic, IEEE80211_MSG_AUTH,
1418 1.40 dyoung wh, "shared key auth", "bad seq %d", seq);
1419 1.40 dyoung ic->ic_stats.is_rx_bad_auth++;
1420 1.40 dyoung return;
1421 1.40 dyoung }
1422 1.40 dyoung break;
1423 1.40 dyoung }
1424 1.40 dyoung return;
1425 1.40 dyoung bad:
1426 1.41 dyoung #ifndef IEEE80211_NO_HOSTAP
1427 1.40 dyoung /*
1428 1.40 dyoung * Send an error response; but only when operating as an AP.
1429 1.40 dyoung */
1430 1.40 dyoung if (ic->ic_opmode == IEEE80211_M_HOSTAP) {
1431 1.40 dyoung /* XXX hack to workaround calling convention */
1432 1.44 dyoung ieee80211_send_error(ic, ni, wh->i_addr2,
1433 1.44 dyoung IEEE80211_FC0_SUBTYPE_AUTH,
1434 1.44 dyoung (seq + 1) | (estatus<<16));
1435 1.44 dyoung } else if (ic->ic_opmode == IEEE80211_M_STA) {
1436 1.44 dyoung /*
1437 1.44 dyoung * Kick the state machine. This short-circuits
1438 1.44 dyoung * using the mgt frame timeout to trigger the
1439 1.44 dyoung * state transition.
1440 1.44 dyoung */
1441 1.44 dyoung if (ic->ic_state == IEEE80211_S_AUTH)
1442 1.44 dyoung ieee80211_new_state(ic, IEEE80211_S_SCAN, 0);
1443 1.40 dyoung }
1444 1.41 dyoung #else
1445 1.41 dyoung ;
1446 1.41 dyoung #endif /* !IEEE80211_NO_HOSTAP */
1447 1.40 dyoung }
1448 1.40 dyoung
1449 1.40 dyoung /* Verify the existence and length of __elem or get out. */
1450 1.40 dyoung #define IEEE80211_VERIFY_ELEMENT(__elem, __maxlen) do { \
1451 1.40 dyoung if ((__elem) == NULL) { \
1452 1.40 dyoung IEEE80211_DISCARD(ic, IEEE80211_MSG_ELEMID, \
1453 1.40 dyoung wh, ieee80211_mgt_subtype_name[subtype >> \
1454 1.40 dyoung IEEE80211_FC0_SUBTYPE_SHIFT], \
1455 1.40 dyoung "%s", "no " #__elem ); \
1456 1.40 dyoung ic->ic_stats.is_rx_elem_missing++; \
1457 1.40 dyoung return; \
1458 1.40 dyoung } \
1459 1.40 dyoung if ((__elem)[1] > (__maxlen)) { \
1460 1.40 dyoung IEEE80211_DISCARD(ic, IEEE80211_MSG_ELEMID, \
1461 1.40 dyoung wh, ieee80211_mgt_subtype_name[subtype >> \
1462 1.40 dyoung IEEE80211_FC0_SUBTYPE_SHIFT], \
1463 1.40 dyoung "bad " #__elem " len %d", (__elem)[1]); \
1464 1.40 dyoung ic->ic_stats.is_rx_elem_toobig++; \
1465 1.40 dyoung return; \
1466 1.40 dyoung } \
1467 1.40 dyoung } while (0)
1468 1.40 dyoung
1469 1.40 dyoung #define IEEE80211_VERIFY_LENGTH(_len, _minlen) do { \
1470 1.40 dyoung if ((_len) < (_minlen)) { \
1471 1.40 dyoung IEEE80211_DISCARD(ic, IEEE80211_MSG_ELEMID, \
1472 1.40 dyoung wh, ieee80211_mgt_subtype_name[subtype >> \
1473 1.40 dyoung IEEE80211_FC0_SUBTYPE_SHIFT], \
1474 1.40 dyoung "%s", "ie too short"); \
1475 1.40 dyoung ic->ic_stats.is_rx_elem_toosmall++; \
1476 1.40 dyoung return; \
1477 1.40 dyoung } \
1478 1.40 dyoung } while (0)
1479 1.40 dyoung
1480 1.40 dyoung #ifdef IEEE80211_DEBUG
1481 1.40 dyoung static void
1482 1.64 christos ieee80211_ssid_mismatch(struct ieee80211com *ic, const char *tag,
1483 1.40 dyoung u_int8_t mac[IEEE80211_ADDR_LEN], u_int8_t *ssid)
1484 1.40 dyoung {
1485 1.85 christos char ebuf[3 * ETHER_ADDR_LEN];
1486 1.85 christos
1487 1.40 dyoung printf("[%s] discard %s frame, ssid mismatch: ",
1488 1.85 christos ether_snprintf(ebuf, sizeof(ebuf), mac), tag);
1489 1.40 dyoung ieee80211_print_essid(ssid + 2, ssid[1]);
1490 1.40 dyoung printf("\n");
1491 1.40 dyoung }
1492 1.40 dyoung
1493 1.40 dyoung #define IEEE80211_VERIFY_SSID(_ni, _ssid) do { \
1494 1.40 dyoung if ((_ssid)[1] != 0 && \
1495 1.40 dyoung ((_ssid)[1] != (_ni)->ni_esslen || \
1496 1.40 dyoung memcmp((_ssid) + 2, (_ni)->ni_essid, (_ssid)[1]) != 0)) { \
1497 1.40 dyoung if (ieee80211_msg_input(ic)) \
1498 1.40 dyoung ieee80211_ssid_mismatch(ic, \
1499 1.40 dyoung ieee80211_mgt_subtype_name[subtype >> \
1500 1.40 dyoung IEEE80211_FC0_SUBTYPE_SHIFT], \
1501 1.40 dyoung wh->i_addr2, _ssid); \
1502 1.40 dyoung ic->ic_stats.is_rx_ssidmismatch++; \
1503 1.40 dyoung return; \
1504 1.40 dyoung } \
1505 1.40 dyoung } while (0)
1506 1.40 dyoung #else /* !IEEE80211_DEBUG */
1507 1.40 dyoung #define IEEE80211_VERIFY_SSID(_ni, _ssid) do { \
1508 1.40 dyoung if ((_ssid)[1] != 0 && \
1509 1.40 dyoung ((_ssid)[1] != (_ni)->ni_esslen || \
1510 1.40 dyoung memcmp((_ssid) + 2, (_ni)->ni_essid, (_ssid)[1]) != 0)) { \
1511 1.40 dyoung ic->ic_stats.is_rx_ssidmismatch++; \
1512 1.40 dyoung return; \
1513 1.40 dyoung } \
1514 1.40 dyoung } while (0)
1515 1.40 dyoung #endif /* !IEEE80211_DEBUG */
1516 1.40 dyoung
1517 1.76 christos /* unaligned little endian access */
1518 1.40 dyoung #define LE_READ_2(p) \
1519 1.40 dyoung ((u_int16_t) \
1520 1.40 dyoung ((((const u_int8_t *)(p))[0] ) | \
1521 1.40 dyoung (((const u_int8_t *)(p))[1] << 8)))
1522 1.40 dyoung #define LE_READ_4(p) \
1523 1.40 dyoung ((u_int32_t) \
1524 1.40 dyoung ((((const u_int8_t *)(p))[0] ) | \
1525 1.40 dyoung (((const u_int8_t *)(p))[1] << 8) | \
1526 1.40 dyoung (((const u_int8_t *)(p))[2] << 16) | \
1527 1.40 dyoung (((const u_int8_t *)(p))[3] << 24)))
1528 1.40 dyoung
1529 1.62 christos static __inline int
1530 1.40 dyoung iswpaoui(const u_int8_t *frm)
1531 1.40 dyoung {
1532 1.40 dyoung return frm[1] > 3 && LE_READ_4(frm+2) == ((WPA_OUI_TYPE<<24)|WPA_OUI);
1533 1.40 dyoung }
1534 1.40 dyoung
1535 1.62 christos static __inline int
1536 1.40 dyoung iswmeoui(const u_int8_t *frm)
1537 1.40 dyoung {
1538 1.40 dyoung return frm[1] > 3 && LE_READ_4(frm+2) == ((WME_OUI_TYPE<<24)|WME_OUI);
1539 1.40 dyoung }
1540 1.40 dyoung
1541 1.62 christos static __inline int
1542 1.40 dyoung iswmeparam(const u_int8_t *frm)
1543 1.40 dyoung {
1544 1.40 dyoung return frm[1] > 5 && LE_READ_4(frm+2) == ((WME_OUI_TYPE<<24)|WME_OUI) &&
1545 1.40 dyoung frm[6] == WME_PARAM_OUI_SUBTYPE;
1546 1.40 dyoung }
1547 1.40 dyoung
1548 1.62 christos static __inline int
1549 1.40 dyoung iswmeinfo(const u_int8_t *frm)
1550 1.40 dyoung {
1551 1.40 dyoung return frm[1] > 5 && LE_READ_4(frm+2) == ((WME_OUI_TYPE<<24)|WME_OUI) &&
1552 1.40 dyoung frm[6] == WME_INFO_OUI_SUBTYPE;
1553 1.40 dyoung }
1554 1.40 dyoung
1555 1.40 dyoung /*
1556 1.40 dyoung * Convert a WPA cipher selector OUI to an internal
1557 1.40 dyoung * cipher algorithm. Where appropriate we also
1558 1.40 dyoung * record any key length.
1559 1.40 dyoung */
1560 1.40 dyoung static int
1561 1.40 dyoung wpa_cipher(u_int8_t *sel, u_int8_t *keylen)
1562 1.40 dyoung {
1563 1.40 dyoung #define WPA_SEL(x) (((x)<<24)|WPA_OUI)
1564 1.40 dyoung u_int32_t w = LE_READ_4(sel);
1565 1.40 dyoung
1566 1.40 dyoung switch (w) {
1567 1.40 dyoung case WPA_SEL(WPA_CSE_NULL):
1568 1.40 dyoung return IEEE80211_CIPHER_NONE;
1569 1.40 dyoung case WPA_SEL(WPA_CSE_WEP40):
1570 1.40 dyoung if (keylen)
1571 1.40 dyoung *keylen = 40 / NBBY;
1572 1.40 dyoung return IEEE80211_CIPHER_WEP;
1573 1.40 dyoung case WPA_SEL(WPA_CSE_WEP104):
1574 1.40 dyoung if (keylen)
1575 1.40 dyoung *keylen = 104 / NBBY;
1576 1.40 dyoung return IEEE80211_CIPHER_WEP;
1577 1.40 dyoung case WPA_SEL(WPA_CSE_TKIP):
1578 1.40 dyoung return IEEE80211_CIPHER_TKIP;
1579 1.40 dyoung case WPA_SEL(WPA_CSE_CCMP):
1580 1.40 dyoung return IEEE80211_CIPHER_AES_CCM;
1581 1.40 dyoung }
1582 1.40 dyoung return 32; /* NB: so 1<< is discarded */
1583 1.40 dyoung #undef WPA_SEL
1584 1.40 dyoung }
1585 1.40 dyoung
1586 1.40 dyoung /*
1587 1.40 dyoung * Convert a WPA key management/authentication algorithm
1588 1.40 dyoung * to an internal code.
1589 1.40 dyoung */
1590 1.40 dyoung static int
1591 1.40 dyoung wpa_keymgmt(u_int8_t *sel)
1592 1.40 dyoung {
1593 1.40 dyoung #define WPA_SEL(x) (((x)<<24)|WPA_OUI)
1594 1.40 dyoung u_int32_t w = LE_READ_4(sel);
1595 1.40 dyoung
1596 1.40 dyoung switch (w) {
1597 1.40 dyoung case WPA_SEL(WPA_ASE_8021X_UNSPEC):
1598 1.40 dyoung return WPA_ASE_8021X_UNSPEC;
1599 1.40 dyoung case WPA_SEL(WPA_ASE_8021X_PSK):
1600 1.40 dyoung return WPA_ASE_8021X_PSK;
1601 1.40 dyoung case WPA_SEL(WPA_ASE_NONE):
1602 1.40 dyoung return WPA_ASE_NONE;
1603 1.40 dyoung }
1604 1.40 dyoung return 0; /* NB: so is discarded */
1605 1.40 dyoung #undef WPA_SEL
1606 1.40 dyoung }
1607 1.40 dyoung
1608 1.40 dyoung /*
1609 1.40 dyoung * Parse a WPA information element to collect parameters
1610 1.40 dyoung * and validate the parameters against what has been
1611 1.40 dyoung * configured for the system.
1612 1.40 dyoung */
1613 1.40 dyoung static int
1614 1.40 dyoung ieee80211_parse_wpa(struct ieee80211com *ic, u_int8_t *frm,
1615 1.40 dyoung struct ieee80211_rsnparms *rsn, const struct ieee80211_frame *wh)
1616 1.40 dyoung {
1617 1.40 dyoung u_int8_t len = frm[1];
1618 1.40 dyoung u_int32_t w;
1619 1.40 dyoung int n;
1620 1.40 dyoung
1621 1.40 dyoung /*
1622 1.40 dyoung * Check the length once for fixed parts: OUI, type,
1623 1.40 dyoung * version, mcast cipher, and 2 selector counts.
1624 1.40 dyoung * Other, variable-length data, must be checked separately.
1625 1.40 dyoung */
1626 1.47 skrll if ((ic->ic_flags & IEEE80211_F_WPA1) == 0) {
1627 1.47 skrll IEEE80211_DISCARD_IE(ic,
1628 1.47 skrll IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA,
1629 1.47 skrll wh, "WPA", "not WPA, flags 0x%x", ic->ic_flags);
1630 1.47 skrll return IEEE80211_REASON_IE_INVALID;
1631 1.47 skrll }
1632 1.40 dyoung if (len < 14) {
1633 1.40 dyoung IEEE80211_DISCARD_IE(ic,
1634 1.40 dyoung IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA,
1635 1.40 dyoung wh, "WPA", "too short, len %u", len);
1636 1.40 dyoung return IEEE80211_REASON_IE_INVALID;
1637 1.40 dyoung }
1638 1.40 dyoung frm += 6, len -= 4; /* NB: len is payload only */
1639 1.40 dyoung /* NB: iswapoui already validated the OUI and type */
1640 1.40 dyoung w = LE_READ_2(frm);
1641 1.40 dyoung if (w != WPA_VERSION) {
1642 1.40 dyoung IEEE80211_DISCARD_IE(ic,
1643 1.40 dyoung IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA,
1644 1.40 dyoung wh, "WPA", "bad version %u", w);
1645 1.40 dyoung return IEEE80211_REASON_IE_INVALID;
1646 1.40 dyoung }
1647 1.40 dyoung frm += 2, len -= 2;
1648 1.40 dyoung
1649 1.40 dyoung /* multicast/group cipher */
1650 1.40 dyoung w = wpa_cipher(frm, &rsn->rsn_mcastkeylen);
1651 1.40 dyoung if (w != rsn->rsn_mcastcipher) {
1652 1.40 dyoung IEEE80211_DISCARD_IE(ic,
1653 1.40 dyoung IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA,
1654 1.40 dyoung wh, "WPA", "mcast cipher mismatch; got %u, expected %u",
1655 1.40 dyoung w, rsn->rsn_mcastcipher);
1656 1.40 dyoung return IEEE80211_REASON_IE_INVALID;
1657 1.40 dyoung }
1658 1.40 dyoung frm += 4, len -= 4;
1659 1.40 dyoung
1660 1.40 dyoung /* unicast ciphers */
1661 1.40 dyoung n = LE_READ_2(frm);
1662 1.40 dyoung frm += 2, len -= 2;
1663 1.40 dyoung if (len < n*4+2) {
1664 1.40 dyoung IEEE80211_DISCARD_IE(ic,
1665 1.40 dyoung IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA,
1666 1.40 dyoung wh, "WPA", "ucast cipher data too short; len %u, n %u",
1667 1.40 dyoung len, n);
1668 1.40 dyoung return IEEE80211_REASON_IE_INVALID;
1669 1.40 dyoung }
1670 1.40 dyoung w = 0;
1671 1.40 dyoung for (; n > 0; n--) {
1672 1.40 dyoung w |= 1<<wpa_cipher(frm, &rsn->rsn_ucastkeylen);
1673 1.40 dyoung frm += 4, len -= 4;
1674 1.40 dyoung }
1675 1.40 dyoung w &= rsn->rsn_ucastcipherset;
1676 1.40 dyoung if (w == 0) {
1677 1.40 dyoung IEEE80211_DISCARD_IE(ic,
1678 1.40 dyoung IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA,
1679 1.40 dyoung wh, "WPA", "%s", "ucast cipher set empty");
1680 1.40 dyoung return IEEE80211_REASON_IE_INVALID;
1681 1.40 dyoung }
1682 1.40 dyoung if (w & (1<<IEEE80211_CIPHER_TKIP))
1683 1.40 dyoung rsn->rsn_ucastcipher = IEEE80211_CIPHER_TKIP;
1684 1.40 dyoung else
1685 1.40 dyoung rsn->rsn_ucastcipher = IEEE80211_CIPHER_AES_CCM;
1686 1.40 dyoung
1687 1.40 dyoung /* key management algorithms */
1688 1.40 dyoung n = LE_READ_2(frm);
1689 1.40 dyoung frm += 2, len -= 2;
1690 1.40 dyoung if (len < n*4) {
1691 1.40 dyoung IEEE80211_DISCARD_IE(ic,
1692 1.40 dyoung IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA,
1693 1.40 dyoung wh, "WPA", "key mgmt alg data too short; len %u, n %u",
1694 1.40 dyoung len, n);
1695 1.40 dyoung return IEEE80211_REASON_IE_INVALID;
1696 1.40 dyoung }
1697 1.40 dyoung w = 0;
1698 1.40 dyoung for (; n > 0; n--) {
1699 1.40 dyoung w |= wpa_keymgmt(frm);
1700 1.40 dyoung frm += 4, len -= 4;
1701 1.40 dyoung }
1702 1.40 dyoung w &= rsn->rsn_keymgmtset;
1703 1.40 dyoung if (w == 0) {
1704 1.40 dyoung IEEE80211_DISCARD_IE(ic,
1705 1.40 dyoung IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA,
1706 1.40 dyoung wh, "WPA", "%s", "no acceptable key mgmt alg");
1707 1.40 dyoung return IEEE80211_REASON_IE_INVALID;
1708 1.40 dyoung }
1709 1.40 dyoung if (w & WPA_ASE_8021X_UNSPEC)
1710 1.40 dyoung rsn->rsn_keymgmt = WPA_ASE_8021X_UNSPEC;
1711 1.40 dyoung else
1712 1.40 dyoung rsn->rsn_keymgmt = WPA_ASE_8021X_PSK;
1713 1.40 dyoung
1714 1.40 dyoung if (len > 2) /* optional capabilities */
1715 1.40 dyoung rsn->rsn_caps = LE_READ_2(frm);
1716 1.40 dyoung
1717 1.40 dyoung return 0;
1718 1.40 dyoung }
1719 1.40 dyoung
1720 1.40 dyoung /*
1721 1.40 dyoung * Convert an RSN cipher selector OUI to an internal
1722 1.40 dyoung * cipher algorithm. Where appropriate we also
1723 1.40 dyoung * record any key length.
1724 1.40 dyoung */
1725 1.40 dyoung static int
1726 1.40 dyoung rsn_cipher(u_int8_t *sel, u_int8_t *keylen)
1727 1.40 dyoung {
1728 1.40 dyoung #define RSN_SEL(x) (((x)<<24)|RSN_OUI)
1729 1.40 dyoung u_int32_t w = LE_READ_4(sel);
1730 1.40 dyoung
1731 1.40 dyoung switch (w) {
1732 1.40 dyoung case RSN_SEL(RSN_CSE_NULL):
1733 1.40 dyoung return IEEE80211_CIPHER_NONE;
1734 1.40 dyoung case RSN_SEL(RSN_CSE_WEP40):
1735 1.40 dyoung if (keylen)
1736 1.40 dyoung *keylen = 40 / NBBY;
1737 1.40 dyoung return IEEE80211_CIPHER_WEP;
1738 1.40 dyoung case RSN_SEL(RSN_CSE_WEP104):
1739 1.40 dyoung if (keylen)
1740 1.40 dyoung *keylen = 104 / NBBY;
1741 1.40 dyoung return IEEE80211_CIPHER_WEP;
1742 1.40 dyoung case RSN_SEL(RSN_CSE_TKIP):
1743 1.40 dyoung return IEEE80211_CIPHER_TKIP;
1744 1.40 dyoung case RSN_SEL(RSN_CSE_CCMP):
1745 1.40 dyoung return IEEE80211_CIPHER_AES_CCM;
1746 1.40 dyoung case RSN_SEL(RSN_CSE_WRAP):
1747 1.40 dyoung return IEEE80211_CIPHER_AES_OCB;
1748 1.40 dyoung }
1749 1.40 dyoung return 32; /* NB: so 1<< is discarded */
1750 1.40 dyoung #undef WPA_SEL
1751 1.40 dyoung }
1752 1.40 dyoung
1753 1.40 dyoung /*
1754 1.40 dyoung * Convert an RSN key management/authentication algorithm
1755 1.40 dyoung * to an internal code.
1756 1.40 dyoung */
1757 1.40 dyoung static int
1758 1.40 dyoung rsn_keymgmt(u_int8_t *sel)
1759 1.40 dyoung {
1760 1.40 dyoung #define RSN_SEL(x) (((x)<<24)|RSN_OUI)
1761 1.40 dyoung u_int32_t w = LE_READ_4(sel);
1762 1.40 dyoung
1763 1.40 dyoung switch (w) {
1764 1.40 dyoung case RSN_SEL(RSN_ASE_8021X_UNSPEC):
1765 1.40 dyoung return RSN_ASE_8021X_UNSPEC;
1766 1.40 dyoung case RSN_SEL(RSN_ASE_8021X_PSK):
1767 1.40 dyoung return RSN_ASE_8021X_PSK;
1768 1.40 dyoung case RSN_SEL(RSN_ASE_NONE):
1769 1.40 dyoung return RSN_ASE_NONE;
1770 1.40 dyoung }
1771 1.40 dyoung return 0; /* NB: so is discarded */
1772 1.40 dyoung #undef RSN_SEL
1773 1.40 dyoung }
1774 1.40 dyoung
1775 1.40 dyoung /*
1776 1.40 dyoung * Parse a WPA/RSN information element to collect parameters
1777 1.40 dyoung * and validate the parameters against what has been
1778 1.40 dyoung * configured for the system.
1779 1.40 dyoung */
1780 1.40 dyoung static int
1781 1.40 dyoung ieee80211_parse_rsn(struct ieee80211com *ic, u_int8_t *frm,
1782 1.40 dyoung struct ieee80211_rsnparms *rsn, const struct ieee80211_frame *wh)
1783 1.40 dyoung {
1784 1.40 dyoung u_int8_t len = frm[1];
1785 1.40 dyoung u_int32_t w;
1786 1.40 dyoung int n;
1787 1.40 dyoung
1788 1.40 dyoung /*
1789 1.74 christos * Check the length once for fixed parts:
1790 1.40 dyoung * version, mcast cipher, and 2 selector counts.
1791 1.40 dyoung * Other, variable-length data, must be checked separately.
1792 1.40 dyoung */
1793 1.47 skrll if ((ic->ic_flags & IEEE80211_F_WPA2) == 0) {
1794 1.47 skrll IEEE80211_DISCARD_IE(ic,
1795 1.47 skrll IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA,
1796 1.47 skrll wh, "WPA", "not RSN, flags 0x%x", ic->ic_flags);
1797 1.47 skrll return IEEE80211_REASON_IE_INVALID;
1798 1.47 skrll }
1799 1.40 dyoung if (len < 10) {
1800 1.40 dyoung IEEE80211_DISCARD_IE(ic,
1801 1.40 dyoung IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA,
1802 1.40 dyoung wh, "RSN", "too short, len %u", len);
1803 1.40 dyoung return IEEE80211_REASON_IE_INVALID;
1804 1.40 dyoung }
1805 1.40 dyoung frm += 2;
1806 1.40 dyoung w = LE_READ_2(frm);
1807 1.40 dyoung if (w != RSN_VERSION) {
1808 1.40 dyoung IEEE80211_DISCARD_IE(ic,
1809 1.40 dyoung IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA,
1810 1.40 dyoung wh, "RSN", "bad version %u", w);
1811 1.40 dyoung return IEEE80211_REASON_IE_INVALID;
1812 1.40 dyoung }
1813 1.40 dyoung frm += 2, len -= 2;
1814 1.40 dyoung
1815 1.40 dyoung /* multicast/group cipher */
1816 1.40 dyoung w = rsn_cipher(frm, &rsn->rsn_mcastkeylen);
1817 1.40 dyoung if (w != rsn->rsn_mcastcipher) {
1818 1.40 dyoung IEEE80211_DISCARD_IE(ic,
1819 1.40 dyoung IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA,
1820 1.40 dyoung wh, "RSN", "mcast cipher mismatch; got %u, expected %u",
1821 1.40 dyoung w, rsn->rsn_mcastcipher);
1822 1.40 dyoung return IEEE80211_REASON_IE_INVALID;
1823 1.40 dyoung }
1824 1.40 dyoung frm += 4, len -= 4;
1825 1.40 dyoung
1826 1.40 dyoung /* unicast ciphers */
1827 1.40 dyoung n = LE_READ_2(frm);
1828 1.40 dyoung frm += 2, len -= 2;
1829 1.40 dyoung if (len < n*4+2) {
1830 1.40 dyoung IEEE80211_DISCARD_IE(ic,
1831 1.40 dyoung IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA,
1832 1.40 dyoung wh, "RSN", "ucast cipher data too short; len %u, n %u",
1833 1.40 dyoung len, n);
1834 1.40 dyoung return IEEE80211_REASON_IE_INVALID;
1835 1.40 dyoung }
1836 1.40 dyoung w = 0;
1837 1.40 dyoung for (; n > 0; n--) {
1838 1.40 dyoung w |= 1<<rsn_cipher(frm, &rsn->rsn_ucastkeylen);
1839 1.40 dyoung frm += 4, len -= 4;
1840 1.40 dyoung }
1841 1.40 dyoung w &= rsn->rsn_ucastcipherset;
1842 1.40 dyoung if (w == 0) {
1843 1.40 dyoung IEEE80211_DISCARD_IE(ic,
1844 1.40 dyoung IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA,
1845 1.40 dyoung wh, "RSN", "%s", "ucast cipher set empty");
1846 1.40 dyoung return IEEE80211_REASON_IE_INVALID;
1847 1.40 dyoung }
1848 1.40 dyoung if (w & (1<<IEEE80211_CIPHER_TKIP))
1849 1.40 dyoung rsn->rsn_ucastcipher = IEEE80211_CIPHER_TKIP;
1850 1.40 dyoung else
1851 1.40 dyoung rsn->rsn_ucastcipher = IEEE80211_CIPHER_AES_CCM;
1852 1.40 dyoung
1853 1.40 dyoung /* key management algorithms */
1854 1.40 dyoung n = LE_READ_2(frm);
1855 1.40 dyoung frm += 2, len -= 2;
1856 1.40 dyoung if (len < n*4) {
1857 1.74 christos IEEE80211_DISCARD_IE(ic,
1858 1.40 dyoung IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA,
1859 1.40 dyoung wh, "RSN", "key mgmt alg data too short; len %u, n %u",
1860 1.40 dyoung len, n);
1861 1.40 dyoung return IEEE80211_REASON_IE_INVALID;
1862 1.40 dyoung }
1863 1.40 dyoung w = 0;
1864 1.40 dyoung for (; n > 0; n--) {
1865 1.40 dyoung w |= rsn_keymgmt(frm);
1866 1.40 dyoung frm += 4, len -= 4;
1867 1.40 dyoung }
1868 1.40 dyoung w &= rsn->rsn_keymgmtset;
1869 1.40 dyoung if (w == 0) {
1870 1.40 dyoung IEEE80211_DISCARD_IE(ic,
1871 1.40 dyoung IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA,
1872 1.40 dyoung wh, "RSN", "%s", "no acceptable key mgmt alg");
1873 1.40 dyoung return IEEE80211_REASON_IE_INVALID;
1874 1.40 dyoung }
1875 1.40 dyoung if (w & RSN_ASE_8021X_UNSPEC)
1876 1.40 dyoung rsn->rsn_keymgmt = RSN_ASE_8021X_UNSPEC;
1877 1.40 dyoung else
1878 1.40 dyoung rsn->rsn_keymgmt = RSN_ASE_8021X_PSK;
1879 1.40 dyoung
1880 1.40 dyoung /* optional RSN capabilities */
1881 1.40 dyoung if (len > 2)
1882 1.40 dyoung rsn->rsn_caps = LE_READ_2(frm);
1883 1.40 dyoung /* XXXPMKID */
1884 1.40 dyoung
1885 1.40 dyoung return 0;
1886 1.40 dyoung }
1887 1.40 dyoung
1888 1.40 dyoung static int
1889 1.40 dyoung ieee80211_parse_wmeparams(struct ieee80211com *ic, u_int8_t *frm,
1890 1.40 dyoung const struct ieee80211_frame *wh)
1891 1.40 dyoung {
1892 1.40 dyoung #define MS(_v, _f) (((_v) & _f) >> _f##_S)
1893 1.40 dyoung struct ieee80211_wme_state *wme = &ic->ic_wme;
1894 1.40 dyoung u_int len = frm[1], qosinfo;
1895 1.40 dyoung int i;
1896 1.40 dyoung
1897 1.40 dyoung if (len < sizeof(struct ieee80211_wme_param)-2) {
1898 1.40 dyoung IEEE80211_DISCARD_IE(ic,
1899 1.40 dyoung IEEE80211_MSG_ELEMID | IEEE80211_MSG_WME,
1900 1.40 dyoung wh, "WME", "too short, len %u", len);
1901 1.40 dyoung return -1;
1902 1.40 dyoung }
1903 1.72 christos qosinfo = frm[offsetof(struct ieee80211_wme_param, param_qosInfo)];
1904 1.40 dyoung qosinfo &= WME_QOSINFO_COUNT;
1905 1.40 dyoung /* XXX do proper check for wraparound */
1906 1.40 dyoung if (qosinfo == wme->wme_wmeChanParams.cap_info)
1907 1.40 dyoung return 0;
1908 1.72 christos frm += offsetof(struct ieee80211_wme_param, params_acParams);
1909 1.40 dyoung for (i = 0; i < WME_NUM_AC; i++) {
1910 1.40 dyoung struct wmeParams *wmep =
1911 1.40 dyoung &wme->wme_wmeChanParams.cap_wmeParams[i];
1912 1.40 dyoung /* NB: ACI not used */
1913 1.40 dyoung wmep->wmep_acm = MS(frm[0], WME_PARAM_ACM);
1914 1.40 dyoung wmep->wmep_aifsn = MS(frm[0], WME_PARAM_AIFSN);
1915 1.40 dyoung wmep->wmep_logcwmin = MS(frm[1], WME_PARAM_LOGCWMIN);
1916 1.40 dyoung wmep->wmep_logcwmax = MS(frm[1], WME_PARAM_LOGCWMAX);
1917 1.40 dyoung wmep->wmep_txopLimit = LE_READ_2(frm+2);
1918 1.40 dyoung frm += 4;
1919 1.40 dyoung }
1920 1.40 dyoung wme->wme_wmeChanParams.cap_info = qosinfo;
1921 1.40 dyoung return 1;
1922 1.40 dyoung #undef MS
1923 1.40 dyoung }
1924 1.40 dyoung
1925 1.47 skrll void
1926 1.40 dyoung ieee80211_saveie(u_int8_t **iep, const u_int8_t *ie)
1927 1.40 dyoung {
1928 1.40 dyoung u_int ielen = ie[1]+2;
1929 1.40 dyoung /*
1930 1.40 dyoung * Record information element for later use.
1931 1.40 dyoung */
1932 1.40 dyoung if (*iep == NULL || (*iep)[1] != ie[1]) {
1933 1.40 dyoung if (*iep != NULL)
1934 1.67 cegger free(*iep, M_DEVBUF);
1935 1.58 christos *iep = malloc(ielen, M_DEVBUF, M_NOWAIT);
1936 1.40 dyoung }
1937 1.40 dyoung if (*iep != NULL)
1938 1.40 dyoung memcpy(*iep, ie, ielen);
1939 1.40 dyoung /* XXX note failure */
1940 1.40 dyoung }
1941 1.40 dyoung
1942 1.56 dyoung static void
1943 1.56 dyoung ieee80211_update_adhoc_node(struct ieee80211com *ic, struct ieee80211_node *ni,
1944 1.56 dyoung struct ieee80211_frame *wh, struct ieee80211_scanparams *scan, int rssi,
1945 1.56 dyoung u_int32_t rstamp)
1946 1.56 dyoung {
1947 1.56 dyoung if (!IEEE80211_ADDR_EQ(wh->i_addr2, ni->ni_macaddr)) {
1948 1.56 dyoung /*
1949 1.56 dyoung * Create a new entry in the neighbor table.
1950 1.56 dyoung * Records the TSF.
1951 1.56 dyoung */
1952 1.56 dyoung if ((ni = ieee80211_add_neighbor(ic, wh, scan)) == NULL)
1953 1.56 dyoung return;
1954 1.56 dyoung } else if (ni->ni_capinfo == 0) {
1955 1.56 dyoung /*
1956 1.56 dyoung * Initialize a node that was "faked up." Records
1957 1.56 dyoung * the TSF.
1958 1.56 dyoung *
1959 1.56 dyoung * No need to check for a change of BSSID: ni could
1960 1.56 dyoung * not have been the IBSS (ic_bss)
1961 1.56 dyoung */
1962 1.56 dyoung ieee80211_init_neighbor(ic, ni, wh, scan, 0);
1963 1.56 dyoung } else {
1964 1.56 dyoung /* Record TSF for potential resync. */
1965 1.56 dyoung memcpy(ni->ni_tstamp.data, scan->tstamp, sizeof(ni->ni_tstamp));
1966 1.56 dyoung }
1967 1.56 dyoung
1968 1.56 dyoung ni->ni_rssi = rssi;
1969 1.56 dyoung ni->ni_rstamp = rstamp;
1970 1.56 dyoung
1971 1.56 dyoung /* Mark a neighbor's change of BSSID. */
1972 1.56 dyoung if (IEEE80211_ADDR_EQ(wh->i_addr3, ni->ni_bssid))
1973 1.56 dyoung return;
1974 1.56 dyoung
1975 1.56 dyoung IEEE80211_ADDR_COPY(ni->ni_bssid, wh->i_addr3);
1976 1.56 dyoung
1977 1.56 dyoung if (ni != ic->ic_bss)
1978 1.56 dyoung return;
1979 1.56 dyoung else if (ic->ic_flags & IEEE80211_F_DESBSSID) {
1980 1.56 dyoung /*
1981 1.56 dyoung * Now, ni does not represent a network we
1982 1.56 dyoung * want to belong to, so start a scan.
1983 1.56 dyoung */
1984 1.56 dyoung ieee80211_new_state(ic, IEEE80211_S_SCAN, 0);
1985 1.56 dyoung return;
1986 1.56 dyoung } else {
1987 1.56 dyoung /*
1988 1.56 dyoung * A RUN->RUN transition lets the driver
1989 1.56 dyoung * reprogram its BSSID filter.
1990 1.56 dyoung *
1991 1.56 dyoung * No need to SCAN, we already belong to
1992 1.56 dyoung * an IBSS that meets our criteria: channel,
1993 1.56 dyoung * SSID, etc. It could be harmful to scan,
1994 1.56 dyoung * too: if a scan does not detect nodes
1995 1.56 dyoung * belonging to my current IBSS, then we
1996 1.56 dyoung * will create a new IBSS at the end of
1997 1.56 dyoung * the scan, needlessly splitting the
1998 1.56 dyoung * network.
1999 1.56 dyoung */
2000 1.56 dyoung ieee80211_new_state(ic, IEEE80211_S_RUN, 0);
2001 1.56 dyoung }
2002 1.56 dyoung }
2003 1.56 dyoung
2004 1.1 dyoung void
2005 1.1 dyoung ieee80211_recv_mgmt(struct ieee80211com *ic, struct mbuf *m0,
2006 1.1 dyoung struct ieee80211_node *ni,
2007 1.1 dyoung int subtype, int rssi, u_int32_t rstamp)
2008 1.1 dyoung {
2009 1.26 mycroft #define ISPROBE(_st) ((_st) == IEEE80211_FC0_SUBTYPE_PROBE_RESP)
2010 1.26 mycroft #define ISREASSOC(_st) ((_st) == IEEE80211_FC0_SUBTYPE_REASSOC_RESP)
2011 1.1 dyoung struct ieee80211_frame *wh;
2012 1.1 dyoung u_int8_t *frm, *efrm;
2013 1.40 dyoung u_int8_t *ssid, *rates, *xrates, *wpa, *wme;
2014 1.40 dyoung int reassoc, resp, allocbs;
2015 1.44 dyoung u_int8_t rate;
2016 1.85 christos IEEE80211_DEBUGVAR(char ebuf[3 * ETHER_ADDR_LEN]);
2017 1.1 dyoung
2018 1.1 dyoung wh = mtod(m0, struct ieee80211_frame *);
2019 1.1 dyoung frm = (u_int8_t *)&wh[1];
2020 1.1 dyoung efrm = mtod(m0, u_int8_t *) + m0->m_len;
2021 1.1 dyoung switch (subtype) {
2022 1.1 dyoung case IEEE80211_FC0_SUBTYPE_PROBE_RESP:
2023 1.1 dyoung case IEEE80211_FC0_SUBTYPE_BEACON: {
2024 1.47 skrll struct ieee80211_scanparams scan;
2025 1.1 dyoung
2026 1.33 mycroft /*
2027 1.40 dyoung * We process beacon/probe response frames:
2028 1.40 dyoung * o when scanning, or
2029 1.40 dyoung * o station mode when associated (to collect state
2030 1.40 dyoung * updates such as 802.11g slot time), or
2031 1.40 dyoung * o adhoc mode (to discover neighbors)
2032 1.40 dyoung * Frames otherwise received are discarded.
2033 1.74 christos */
2034 1.40 dyoung if (!((ic->ic_flags & IEEE80211_F_SCAN) ||
2035 1.40 dyoung (ic->ic_opmode == IEEE80211_M_STA && ni->ni_associd) ||
2036 1.40 dyoung ic->ic_opmode == IEEE80211_M_IBSS)) {
2037 1.40 dyoung ic->ic_stats.is_rx_mgtdiscard++;
2038 1.40 dyoung return;
2039 1.1 dyoung }
2040 1.1 dyoung /*
2041 1.1 dyoung * beacon/probe response frame format
2042 1.1 dyoung * [8] time stamp
2043 1.1 dyoung * [2] beacon interval
2044 1.1 dyoung * [2] capability information
2045 1.1 dyoung * [tlv] ssid
2046 1.1 dyoung * [tlv] supported rates
2047 1.1 dyoung * [tlv] country information
2048 1.1 dyoung * [tlv] parameter set (FH/DS)
2049 1.1 dyoung * [tlv] erp information
2050 1.1 dyoung * [tlv] extended supported rates
2051 1.40 dyoung * [tlv] WME
2052 1.40 dyoung * [tlv] WPA or RSN
2053 1.1 dyoung */
2054 1.1 dyoung IEEE80211_VERIFY_LENGTH(efrm - frm, 12);
2055 1.47 skrll memset(&scan, 0, sizeof(scan));
2056 1.47 skrll scan.tstamp = frm; frm += 8;
2057 1.47 skrll scan.bintval = le16toh(*(u_int16_t *)frm); frm += 2;
2058 1.47 skrll scan.capinfo = le16toh(*(u_int16_t *)frm); frm += 2;
2059 1.47 skrll scan.bchan = ieee80211_chan2ieee(ic, ic->ic_curchan);
2060 1.47 skrll scan.chan = scan.bchan;
2061 1.47 skrll
2062 1.1 dyoung while (frm < efrm) {
2063 1.1 dyoung switch (*frm) {
2064 1.1 dyoung case IEEE80211_ELEMID_SSID:
2065 1.47 skrll scan.ssid = frm;
2066 1.1 dyoung break;
2067 1.1 dyoung case IEEE80211_ELEMID_RATES:
2068 1.47 skrll scan.rates = frm;
2069 1.1 dyoung break;
2070 1.1 dyoung case IEEE80211_ELEMID_COUNTRY:
2071 1.47 skrll scan.country = frm;
2072 1.1 dyoung break;
2073 1.1 dyoung case IEEE80211_ELEMID_FHPARMS:
2074 1.1 dyoung if (ic->ic_phytype == IEEE80211_T_FH) {
2075 1.47 skrll scan.fhdwell = LE_READ_2(&frm[2]);
2076 1.47 skrll scan.chan = IEEE80211_FH_CHAN(frm[4], frm[5]);
2077 1.47 skrll scan.fhindex = frm[6];
2078 1.1 dyoung }
2079 1.1 dyoung break;
2080 1.1 dyoung case IEEE80211_ELEMID_DSPARMS:
2081 1.1 dyoung /*
2082 1.1 dyoung * XXX hack this since depending on phytype
2083 1.1 dyoung * is problematic for multi-mode devices.
2084 1.1 dyoung */
2085 1.1 dyoung if (ic->ic_phytype != IEEE80211_T_FH)
2086 1.47 skrll scan.chan = frm[2];
2087 1.1 dyoung break;
2088 1.1 dyoung case IEEE80211_ELEMID_TIM:
2089 1.40 dyoung /* XXX ATIM? */
2090 1.47 skrll scan.tim = frm;
2091 1.47 skrll scan.timoff = frm - mtod(m0, u_int8_t *);
2092 1.1 dyoung break;
2093 1.22 dyoung case IEEE80211_ELEMID_IBSSPARMS:
2094 1.22 dyoung break;
2095 1.1 dyoung case IEEE80211_ELEMID_XRATES:
2096 1.47 skrll scan.xrates = frm;
2097 1.1 dyoung break;
2098 1.1 dyoung case IEEE80211_ELEMID_ERP:
2099 1.1 dyoung if (frm[1] != 1) {
2100 1.40 dyoung IEEE80211_DISCARD_IE(ic,
2101 1.40 dyoung IEEE80211_MSG_ELEMID, wh, "ERP",
2102 1.40 dyoung "bad len %u", frm[1]);
2103 1.16 dyoung ic->ic_stats.is_rx_elem_toobig++;
2104 1.1 dyoung break;
2105 1.1 dyoung }
2106 1.47 skrll scan.erp = frm[2];
2107 1.1 dyoung break;
2108 1.40 dyoung case IEEE80211_ELEMID_RSN:
2109 1.47 skrll scan.wpa = frm;
2110 1.40 dyoung break;
2111 1.40 dyoung case IEEE80211_ELEMID_VENDOR:
2112 1.40 dyoung if (iswpaoui(frm))
2113 1.47 skrll scan.wpa = frm;
2114 1.40 dyoung else if (iswmeparam(frm) || iswmeinfo(frm))
2115 1.47 skrll scan.wme = frm;
2116 1.40 dyoung /* XXX Atheros OUI support */
2117 1.40 dyoung break;
2118 1.1 dyoung default:
2119 1.40 dyoung IEEE80211_DISCARD_IE(ic, IEEE80211_MSG_ELEMID,
2120 1.40 dyoung wh, "unhandled",
2121 1.40 dyoung "id %u, len %u", *frm, frm[1]);
2122 1.16 dyoung ic->ic_stats.is_rx_elem_unknown++;
2123 1.1 dyoung break;
2124 1.1 dyoung }
2125 1.1 dyoung frm += frm[1] + 2;
2126 1.1 dyoung }
2127 1.47 skrll IEEE80211_VERIFY_ELEMENT(scan.rates, IEEE80211_RATE_MAXSIZE);
2128 1.47 skrll IEEE80211_VERIFY_ELEMENT(scan.ssid, IEEE80211_NWID_LEN);
2129 1.1 dyoung if (
2130 1.1 dyoung #if IEEE80211_CHAN_MAX < 255
2131 1.47 skrll scan.chan > IEEE80211_CHAN_MAX ||
2132 1.1 dyoung #endif
2133 1.47 skrll isclr(ic->ic_chan_active, scan.chan)) {
2134 1.47 skrll IEEE80211_DISCARD(ic,
2135 1.47 skrll IEEE80211_MSG_ELEMID | IEEE80211_MSG_INPUT,
2136 1.40 dyoung wh, ieee80211_mgt_subtype_name[subtype >>
2137 1.40 dyoung IEEE80211_FC0_SUBTYPE_SHIFT],
2138 1.47 skrll "invalid channel %u", scan.chan);
2139 1.16 dyoung ic->ic_stats.is_rx_badchan++;
2140 1.1 dyoung return;
2141 1.1 dyoung }
2142 1.47 skrll if (scan.chan != scan.bchan &&
2143 1.47 skrll ic->ic_phytype != IEEE80211_T_FH) {
2144 1.1 dyoung /*
2145 1.1 dyoung * Frame was received on a channel different from the
2146 1.19 onoe * one indicated in the DS params element id;
2147 1.1 dyoung * silently discard it.
2148 1.1 dyoung *
2149 1.1 dyoung * NB: this can happen due to signal leakage.
2150 1.19 onoe * But we should take it for FH phy because
2151 1.19 onoe * the rssi value should be correct even for
2152 1.19 onoe * different hop pattern in FH.
2153 1.1 dyoung */
2154 1.47 skrll IEEE80211_DISCARD(ic,
2155 1.47 skrll IEEE80211_MSG_ELEMID | IEEE80211_MSG_INPUT,
2156 1.40 dyoung wh, ieee80211_mgt_subtype_name[subtype >>
2157 1.40 dyoung IEEE80211_FC0_SUBTYPE_SHIFT],
2158 1.47 skrll "for off-channel %u", scan.chan);
2159 1.16 dyoung ic->ic_stats.is_rx_chanmismatch++;
2160 1.1 dyoung return;
2161 1.1 dyoung }
2162 1.47 skrll if (!(IEEE80211_BINTVAL_MIN <= scan.bintval &&
2163 1.47 skrll scan.bintval <= IEEE80211_BINTVAL_MAX)) {
2164 1.47 skrll IEEE80211_DISCARD(ic,
2165 1.47 skrll IEEE80211_MSG_ELEMID | IEEE80211_MSG_INPUT,
2166 1.47 skrll wh, ieee80211_mgt_subtype_name[subtype >>
2167 1.47 skrll IEEE80211_FC0_SUBTYPE_SHIFT],
2168 1.47 skrll "bogus beacon interval", scan.bintval);
2169 1.47 skrll ic->ic_stats.is_rx_badbintval++;
2170 1.47 skrll return;
2171 1.47 skrll }
2172 1.1 dyoung
2173 1.42 dyoung if (ni != ic->ic_bss) {
2174 1.42 dyoung ni = ieee80211_refine_node_for_beacon(ic, ni,
2175 1.47 skrll &ic->ic_channels[scan.chan], scan.ssid);
2176 1.42 dyoung }
2177 1.1 dyoung /*
2178 1.40 dyoung * Count frame now that we know it's to be processed.
2179 1.40 dyoung */
2180 1.40 dyoung if (subtype == IEEE80211_FC0_SUBTYPE_BEACON) {
2181 1.40 dyoung ic->ic_stats.is_rx_beacon++; /* XXX remove */
2182 1.40 dyoung IEEE80211_NODE_STAT(ni, rx_beacons);
2183 1.40 dyoung } else
2184 1.40 dyoung IEEE80211_NODE_STAT(ni, rx_proberesp);
2185 1.40 dyoung
2186 1.40 dyoung /*
2187 1.40 dyoung * When operating in station mode, check for state updates.
2188 1.40 dyoung * Be careful to ignore beacons received while doing a
2189 1.40 dyoung * background scan. We consider only 11g/WMM stuff right now.
2190 1.1 dyoung */
2191 1.40 dyoung if (ic->ic_opmode == IEEE80211_M_STA &&
2192 1.40 dyoung ni->ni_associd != 0 &&
2193 1.40 dyoung ((ic->ic_flags & IEEE80211_F_SCAN) == 0 ||
2194 1.40 dyoung IEEE80211_ADDR_EQ(wh->i_addr2, ni->ni_bssid))) {
2195 1.44 dyoung /* record tsf of last beacon */
2196 1.47 skrll memcpy(ni->ni_tstamp.data, scan.tstamp,
2197 1.44 dyoung sizeof(ni->ni_tstamp));
2198 1.47 skrll if (ni->ni_erp != scan.erp) {
2199 1.40 dyoung IEEE80211_DPRINTF(ic, IEEE80211_MSG_ASSOC,
2200 1.40 dyoung "[%s] erp change: was 0x%x, now 0x%x\n",
2201 1.85 christos ether_snprintf(ebuf, sizeof(ebuf),
2202 1.85 christos wh->i_addr2), ni->ni_erp, scan.erp);
2203 1.44 dyoung if (ic->ic_curmode == IEEE80211_MODE_11G &&
2204 1.44 dyoung (ni->ni_erp & IEEE80211_ERP_USE_PROTECTION))
2205 1.40 dyoung ic->ic_flags |= IEEE80211_F_USEPROT;
2206 1.40 dyoung else
2207 1.40 dyoung ic->ic_flags &= ~IEEE80211_F_USEPROT;
2208 1.47 skrll ni->ni_erp = scan.erp;
2209 1.40 dyoung /* XXX statistic */
2210 1.40 dyoung }
2211 1.47 skrll if ((ni->ni_capinfo ^ scan.capinfo) & IEEE80211_CAPINFO_SHORT_SLOTTIME) {
2212 1.40 dyoung IEEE80211_DPRINTF(ic, IEEE80211_MSG_ASSOC,
2213 1.40 dyoung "[%s] capabilities change: before 0x%x,"
2214 1.40 dyoung " now 0x%x\n",
2215 1.85 christos ether_snprintf(ebuf, sizeof(ebuf),
2216 1.85 christos wh->i_addr2),
2217 1.47 skrll ni->ni_capinfo, scan.capinfo);
2218 1.40 dyoung /*
2219 1.40 dyoung * NB: we assume short preamble doesn't
2220 1.40 dyoung * change dynamically
2221 1.40 dyoung */
2222 1.40 dyoung ieee80211_set_shortslottime(ic,
2223 1.40 dyoung ic->ic_curmode == IEEE80211_MODE_11A ||
2224 1.40 dyoung (ni->ni_capinfo & IEEE80211_CAPINFO_SHORT_SLOTTIME));
2225 1.47 skrll ni->ni_capinfo = scan.capinfo;
2226 1.40 dyoung /* XXX statistic */
2227 1.4 dyoung }
2228 1.47 skrll if (scan.wme != NULL &&
2229 1.44 dyoung (ni->ni_flags & IEEE80211_NODE_QOS) &&
2230 1.47 skrll ieee80211_parse_wmeparams(ic, scan.wme, wh) > 0)
2231 1.40 dyoung ieee80211_wme_updateparams(ic);
2232 1.47 skrll if (scan.tim != NULL) {
2233 1.44 dyoung struct ieee80211_tim_ie *ie =
2234 1.47 skrll (struct ieee80211_tim_ie *) scan.tim;
2235 1.44 dyoung
2236 1.44 dyoung ni->ni_dtim_count = ie->tim_count;
2237 1.44 dyoung ni->ni_dtim_period = ie->tim_period;
2238 1.44 dyoung }
2239 1.47 skrll if (ic->ic_flags & IEEE80211_F_SCAN)
2240 1.47 skrll ieee80211_add_scan(ic, &scan, wh,
2241 1.47 skrll subtype, rssi, rstamp);
2242 1.57 dyoung ic->ic_bmiss_count = 0;
2243 1.47 skrll return;
2244 1.1 dyoung }
2245 1.47 skrll /*
2246 1.47 skrll * If scanning, just pass information to the scan module.
2247 1.47 skrll */
2248 1.47 skrll if (ic->ic_flags & IEEE80211_F_SCAN) {
2249 1.60 tacha if (ic->ic_flags_ext & IEEE80211_FEXT_PROBECHAN) {
2250 1.60 tacha /*
2251 1.60 tacha * Actively scanning a channel marked passive;
2252 1.60 tacha * send a probe request now that we know there
2253 1.60 tacha * is 802.11 traffic present.
2254 1.60 tacha *
2255 1.60 tacha * XXX check if the beacon we recv'd gives
2256 1.60 tacha * us what we need and suppress the probe req
2257 1.60 tacha */
2258 1.60 tacha ieee80211_probe_curchan(ic, 1);
2259 1.60 tacha ic->ic_flags_ext &= ~IEEE80211_FEXT_PROBECHAN;
2260 1.60 tacha }
2261 1.47 skrll ieee80211_add_scan(ic, &scan, wh,
2262 1.47 skrll subtype, rssi, rstamp);
2263 1.47 skrll return;
2264 1.33 mycroft }
2265 1.56 dyoung if (scan.capinfo & IEEE80211_CAPINFO_IBSS)
2266 1.56 dyoung ieee80211_update_adhoc_node(ic, ni, wh, &scan, rssi,
2267 1.56 dyoung rstamp);
2268 1.1 dyoung break;
2269 1.1 dyoung }
2270 1.1 dyoung
2271 1.44 dyoung case IEEE80211_FC0_SUBTYPE_PROBE_REQ:
2272 1.40 dyoung if (ic->ic_opmode == IEEE80211_M_STA ||
2273 1.40 dyoung ic->ic_state != IEEE80211_S_RUN) {
2274 1.40 dyoung ic->ic_stats.is_rx_mgtdiscard++;
2275 1.1 dyoung return;
2276 1.40 dyoung }
2277 1.40 dyoung if (IEEE80211_IS_MULTICAST(wh->i_addr2)) {
2278 1.40 dyoung /* frame must be directed */
2279 1.40 dyoung ic->ic_stats.is_rx_mgtdiscard++; /* XXX stat */
2280 1.1 dyoung return;
2281 1.40 dyoung }
2282 1.1 dyoung
2283 1.1 dyoung /*
2284 1.1 dyoung * prreq frame format
2285 1.1 dyoung * [tlv] ssid
2286 1.1 dyoung * [tlv] supported rates
2287 1.1 dyoung * [tlv] extended supported rates
2288 1.1 dyoung */
2289 1.1 dyoung ssid = rates = xrates = NULL;
2290 1.1 dyoung while (frm < efrm) {
2291 1.1 dyoung switch (*frm) {
2292 1.1 dyoung case IEEE80211_ELEMID_SSID:
2293 1.1 dyoung ssid = frm;
2294 1.1 dyoung break;
2295 1.1 dyoung case IEEE80211_ELEMID_RATES:
2296 1.1 dyoung rates = frm;
2297 1.1 dyoung break;
2298 1.1 dyoung case IEEE80211_ELEMID_XRATES:
2299 1.1 dyoung xrates = frm;
2300 1.1 dyoung break;
2301 1.1 dyoung }
2302 1.1 dyoung frm += frm[1] + 2;
2303 1.1 dyoung }
2304 1.1 dyoung IEEE80211_VERIFY_ELEMENT(rates, IEEE80211_RATE_MAXSIZE);
2305 1.1 dyoung IEEE80211_VERIFY_ELEMENT(ssid, IEEE80211_NWID_LEN);
2306 1.40 dyoung IEEE80211_VERIFY_SSID(ic->ic_bss, ssid);
2307 1.40 dyoung if ((ic->ic_flags & IEEE80211_F_HIDESSID) && ssid[1] == 0) {
2308 1.40 dyoung IEEE80211_DISCARD(ic, IEEE80211_MSG_INPUT,
2309 1.40 dyoung wh, ieee80211_mgt_subtype_name[subtype >>
2310 1.40 dyoung IEEE80211_FC0_SUBTYPE_SHIFT],
2311 1.40 dyoung "%s", "no ssid with ssid suppression enabled");
2312 1.40 dyoung ic->ic_stats.is_rx_ssidmismatch++; /*XXX*/
2313 1.40 dyoung return;
2314 1.40 dyoung }
2315 1.1 dyoung
2316 1.1 dyoung if (ni == ic->ic_bss) {
2317 1.50 dyoung if (ic->ic_opmode != IEEE80211_M_IBSS)
2318 1.50 dyoung ni = ieee80211_tmp_node(ic, wh->i_addr2);
2319 1.50 dyoung else if (IEEE80211_ADDR_EQ(wh->i_addr2, ni->ni_macaddr))
2320 1.50 dyoung ;
2321 1.50 dyoung else {
2322 1.40 dyoung /*
2323 1.40 dyoung * XXX Cannot tell if the sender is operating
2324 1.40 dyoung * in ibss mode. But we need a new node to
2325 1.40 dyoung * send the response so blindly add them to the
2326 1.40 dyoung * neighbor table.
2327 1.40 dyoung */
2328 1.40 dyoung ni = ieee80211_fakeup_adhoc_node(&ic->ic_sta,
2329 1.40 dyoung wh->i_addr2);
2330 1.50 dyoung }
2331 1.22 dyoung if (ni == NULL)
2332 1.1 dyoung return;
2333 1.40 dyoung allocbs = 1;
2334 1.40 dyoung } else
2335 1.40 dyoung allocbs = 0;
2336 1.40 dyoung IEEE80211_DPRINTF(ic, IEEE80211_MSG_ASSOC,
2337 1.85 christos "[%s] recv probe req\n", ether_snprintf(
2338 1.85 christos ebuf, sizeof(ebuf), wh->i_addr2));
2339 1.1 dyoung ni->ni_rssi = rssi;
2340 1.1 dyoung ni->ni_rstamp = rstamp;
2341 1.47 skrll rate = ieee80211_setup_rates(ni, rates, xrates,
2342 1.73 christos IEEE80211_R_DOSORT | IEEE80211_R_DOFRATE
2343 1.73 christos | IEEE80211_R_DONEGO | IEEE80211_R_DODEL);
2344 1.1 dyoung if (rate & IEEE80211_RATE_BASIC) {
2345 1.40 dyoung IEEE80211_DISCARD(ic, IEEE80211_MSG_XRATE,
2346 1.40 dyoung wh, ieee80211_mgt_subtype_name[subtype >>
2347 1.40 dyoung IEEE80211_FC0_SUBTYPE_SHIFT],
2348 1.40 dyoung "%s", "recv'd rate set invalid");
2349 1.1 dyoung } else {
2350 1.1 dyoung IEEE80211_SEND_MGMT(ic, ni,
2351 1.1 dyoung IEEE80211_FC0_SUBTYPE_PROBE_RESP, 0);
2352 1.1 dyoung }
2353 1.40 dyoung if (allocbs && ic->ic_opmode != IEEE80211_M_IBSS) {
2354 1.40 dyoung /* reclaim immediately */
2355 1.40 dyoung ieee80211_free_node(ni);
2356 1.40 dyoung }
2357 1.1 dyoung break;
2358 1.1 dyoung
2359 1.1 dyoung case IEEE80211_FC0_SUBTYPE_AUTH: {
2360 1.1 dyoung u_int16_t algo, seq, status;
2361 1.1 dyoung /*
2362 1.1 dyoung * auth frame format
2363 1.1 dyoung * [2] algorithm
2364 1.1 dyoung * [2] sequence
2365 1.1 dyoung * [2] status
2366 1.1 dyoung * [tlv*] challenge
2367 1.1 dyoung */
2368 1.1 dyoung IEEE80211_VERIFY_LENGTH(efrm - frm, 6);
2369 1.1 dyoung algo = le16toh(*(u_int16_t *)frm);
2370 1.1 dyoung seq = le16toh(*(u_int16_t *)(frm + 2));
2371 1.1 dyoung status = le16toh(*(u_int16_t *)(frm + 4));
2372 1.25 mycroft IEEE80211_DPRINTF(ic, IEEE80211_MSG_AUTH,
2373 1.40 dyoung "[%s] recv auth frame with algorithm %d seq %d\n",
2374 1.85 christos ether_snprintf(ebuf, sizeof(ebuf), wh->i_addr2), algo, seq);
2375 1.40 dyoung /*
2376 1.40 dyoung * Consult the ACL policy module if setup.
2377 1.40 dyoung */
2378 1.40 dyoung if (ic->ic_acl != NULL &&
2379 1.40 dyoung !ic->ic_acl->iac_check(ic, wh->i_addr2)) {
2380 1.40 dyoung IEEE80211_DISCARD(ic, IEEE80211_MSG_ACL,
2381 1.40 dyoung wh, "auth", "%s", "disallowed by ACL");
2382 1.40 dyoung ic->ic_stats.is_rx_acl++;
2383 1.47 skrll if (ic->ic_opmode == IEEE80211_M_HOSTAP) {
2384 1.47 skrll IEEE80211_SEND_MGMT(ic, ni,
2385 1.47 skrll IEEE80211_FC0_SUBTYPE_AUTH,
2386 1.47 skrll (seq+1) | (IEEE80211_STATUS_UNSPECIFIED<<16));
2387 1.47 skrll }
2388 1.40 dyoung return;
2389 1.40 dyoung }
2390 1.40 dyoung if (ic->ic_flags & IEEE80211_F_COUNTERM) {
2391 1.40 dyoung IEEE80211_DISCARD(ic,
2392 1.40 dyoung IEEE80211_MSG_AUTH | IEEE80211_MSG_CRYPTO,
2393 1.40 dyoung wh, "auth", "%s", "TKIP countermeasures enabled");
2394 1.40 dyoung ic->ic_stats.is_rx_auth_countermeasures++;
2395 1.41 dyoung #ifndef IEEE80211_NO_HOSTAP
2396 1.40 dyoung if (ic->ic_opmode == IEEE80211_M_HOSTAP) {
2397 1.40 dyoung IEEE80211_SEND_MGMT(ic, ni,
2398 1.40 dyoung IEEE80211_FC0_SUBTYPE_AUTH,
2399 1.40 dyoung IEEE80211_REASON_MIC_FAILURE);
2400 1.40 dyoung }
2401 1.41 dyoung #endif /* !IEEE80211_NO_HOSTAP */
2402 1.40 dyoung return;
2403 1.40 dyoung }
2404 1.7 dyoung if (algo == IEEE80211_AUTH_ALG_SHARED)
2405 1.7 dyoung ieee80211_auth_shared(ic, wh, frm + 6, efrm, ni, rssi,
2406 1.7 dyoung rstamp, seq, status);
2407 1.7 dyoung else if (algo == IEEE80211_AUTH_ALG_OPEN)
2408 1.7 dyoung ieee80211_auth_open(ic, wh, ni, rssi, rstamp, seq,
2409 1.7 dyoung status);
2410 1.7 dyoung else {
2411 1.40 dyoung IEEE80211_DISCARD(ic, IEEE80211_MSG_ANY,
2412 1.40 dyoung wh, "auth", "unsupported alg %d", algo);
2413 1.16 dyoung ic->ic_stats.is_rx_auth_unsupported++;
2414 1.41 dyoung #ifndef IEEE80211_NO_HOSTAP
2415 1.40 dyoung if (ic->ic_opmode == IEEE80211_M_HOSTAP) {
2416 1.40 dyoung /* XXX not right */
2417 1.40 dyoung IEEE80211_SEND_MGMT(ic, ni,
2418 1.40 dyoung IEEE80211_FC0_SUBTYPE_AUTH,
2419 1.40 dyoung (seq+1) | (IEEE80211_STATUS_ALG<<16));
2420 1.40 dyoung }
2421 1.41 dyoung #endif /* !IEEE80211_NO_HOSTAP */
2422 1.1 dyoung return;
2423 1.74 christos }
2424 1.1 dyoung break;
2425 1.1 dyoung }
2426 1.1 dyoung
2427 1.1 dyoung case IEEE80211_FC0_SUBTYPE_ASSOC_REQ:
2428 1.1 dyoung case IEEE80211_FC0_SUBTYPE_REASSOC_REQ: {
2429 1.47 skrll u_int16_t capinfo, lintval;
2430 1.40 dyoung struct ieee80211_rsnparms rsn;
2431 1.40 dyoung u_int8_t reason;
2432 1.1 dyoung
2433 1.1 dyoung if (ic->ic_opmode != IEEE80211_M_HOSTAP ||
2434 1.40 dyoung ic->ic_state != IEEE80211_S_RUN) {
2435 1.40 dyoung ic->ic_stats.is_rx_mgtdiscard++;
2436 1.1 dyoung return;
2437 1.40 dyoung }
2438 1.1 dyoung
2439 1.1 dyoung if (subtype == IEEE80211_FC0_SUBTYPE_REASSOC_REQ) {
2440 1.1 dyoung reassoc = 1;
2441 1.1 dyoung resp = IEEE80211_FC0_SUBTYPE_REASSOC_RESP;
2442 1.1 dyoung } else {
2443 1.1 dyoung reassoc = 0;
2444 1.1 dyoung resp = IEEE80211_FC0_SUBTYPE_ASSOC_RESP;
2445 1.1 dyoung }
2446 1.1 dyoung /*
2447 1.1 dyoung * asreq frame format
2448 1.1 dyoung * [2] capability information
2449 1.1 dyoung * [2] listen interval
2450 1.1 dyoung * [6*] current AP address (reassoc only)
2451 1.1 dyoung * [tlv] ssid
2452 1.1 dyoung * [tlv] supported rates
2453 1.1 dyoung * [tlv] extended supported rates
2454 1.40 dyoung * [tlv] WPA or RSN
2455 1.1 dyoung */
2456 1.1 dyoung IEEE80211_VERIFY_LENGTH(efrm - frm, (reassoc ? 10 : 4));
2457 1.1 dyoung if (!IEEE80211_ADDR_EQ(wh->i_addr3, ic->ic_bss->ni_bssid)) {
2458 1.40 dyoung IEEE80211_DISCARD(ic, IEEE80211_MSG_ANY,
2459 1.40 dyoung wh, ieee80211_mgt_subtype_name[subtype >>
2460 1.40 dyoung IEEE80211_FC0_SUBTYPE_SHIFT],
2461 1.40 dyoung "%s", "wrong bssid");
2462 1.16 dyoung ic->ic_stats.is_rx_assoc_bss++;
2463 1.1 dyoung return;
2464 1.1 dyoung }
2465 1.1 dyoung capinfo = le16toh(*(u_int16_t *)frm); frm += 2;
2466 1.47 skrll lintval = le16toh(*(u_int16_t *)frm); frm += 2;
2467 1.1 dyoung if (reassoc)
2468 1.1 dyoung frm += 6; /* ignore current AP info */
2469 1.40 dyoung ssid = rates = xrates = wpa = wme = NULL;
2470 1.1 dyoung while (frm < efrm) {
2471 1.1 dyoung switch (*frm) {
2472 1.1 dyoung case IEEE80211_ELEMID_SSID:
2473 1.1 dyoung ssid = frm;
2474 1.1 dyoung break;
2475 1.1 dyoung case IEEE80211_ELEMID_RATES:
2476 1.1 dyoung rates = frm;
2477 1.1 dyoung break;
2478 1.1 dyoung case IEEE80211_ELEMID_XRATES:
2479 1.1 dyoung xrates = frm;
2480 1.1 dyoung break;
2481 1.40 dyoung /* XXX verify only one of RSN and WPA ie's? */
2482 1.40 dyoung case IEEE80211_ELEMID_RSN:
2483 1.40 dyoung wpa = frm;
2484 1.40 dyoung break;
2485 1.40 dyoung case IEEE80211_ELEMID_VENDOR:
2486 1.47 skrll if (iswpaoui(frm))
2487 1.47 skrll wpa = frm;
2488 1.47 skrll else if (iswmeinfo(frm))
2489 1.40 dyoung wme = frm;
2490 1.40 dyoung /* XXX Atheros OUI support */
2491 1.40 dyoung break;
2492 1.1 dyoung }
2493 1.1 dyoung frm += frm[1] + 2;
2494 1.1 dyoung }
2495 1.1 dyoung IEEE80211_VERIFY_ELEMENT(rates, IEEE80211_RATE_MAXSIZE);
2496 1.1 dyoung IEEE80211_VERIFY_ELEMENT(ssid, IEEE80211_NWID_LEN);
2497 1.40 dyoung IEEE80211_VERIFY_SSID(ic->ic_bss, ssid);
2498 1.27 mycroft
2499 1.40 dyoung if (ni == ic->ic_bss) {
2500 1.25 mycroft IEEE80211_DPRINTF(ic, IEEE80211_MSG_ANY,
2501 1.40 dyoung "[%s] deny %s request, sta not authenticated\n",
2502 1.85 christos ether_snprintf(ebuf, sizeof(ebuf), wh->i_addr2),
2503 1.40 dyoung reassoc ? "reassoc" : "assoc");
2504 1.44 dyoung ieee80211_send_error(ic, ni, wh->i_addr2,
2505 1.44 dyoung IEEE80211_FC0_SUBTYPE_DEAUTH,
2506 1.44 dyoung IEEE80211_REASON_ASSOC_NOT_AUTHED);
2507 1.16 dyoung ic->ic_stats.is_rx_assoc_notauth++;
2508 1.1 dyoung return;
2509 1.7 dyoung }
2510 1.40 dyoung /* assert right associstion security credentials */
2511 1.40 dyoung if (wpa == NULL && (ic->ic_flags & IEEE80211_F_WPA)) {
2512 1.40 dyoung IEEE80211_DPRINTF(ic,
2513 1.40 dyoung IEEE80211_MSG_ASSOC | IEEE80211_MSG_WPA,
2514 1.40 dyoung "[%s] no WPA/RSN IE in association request\n",
2515 1.85 christos ether_snprintf(ebuf, sizeof(ebuf), wh->i_addr2));
2516 1.40 dyoung IEEE80211_SEND_MGMT(ic, ni,
2517 1.40 dyoung IEEE80211_FC0_SUBTYPE_DEAUTH,
2518 1.40 dyoung IEEE80211_REASON_RSN_REQUIRED);
2519 1.40 dyoung ieee80211_node_leave(ic, ni);
2520 1.40 dyoung /* XXX distinguish WPA/RSN? */
2521 1.40 dyoung ic->ic_stats.is_rx_assoc_badwpaie++;
2522 1.74 christos return;
2523 1.40 dyoung }
2524 1.40 dyoung if (wpa != NULL) {
2525 1.40 dyoung /*
2526 1.40 dyoung * Parse WPA information element. Note that
2527 1.40 dyoung * we initialize the param block from the node
2528 1.40 dyoung * state so that information in the IE overrides
2529 1.40 dyoung * our defaults. The resulting parameters are
2530 1.40 dyoung * installed below after the association is assured.
2531 1.40 dyoung */
2532 1.40 dyoung rsn = ni->ni_rsn;
2533 1.40 dyoung if (wpa[0] != IEEE80211_ELEMID_RSN)
2534 1.40 dyoung reason = ieee80211_parse_wpa(ic, wpa, &rsn, wh);
2535 1.40 dyoung else
2536 1.40 dyoung reason = ieee80211_parse_rsn(ic, wpa, &rsn, wh);
2537 1.40 dyoung if (reason != 0) {
2538 1.40 dyoung IEEE80211_SEND_MGMT(ic, ni,
2539 1.40 dyoung IEEE80211_FC0_SUBTYPE_DEAUTH, reason);
2540 1.40 dyoung ieee80211_node_leave(ic, ni);
2541 1.40 dyoung /* XXX distinguish WPA/RSN? */
2542 1.40 dyoung ic->ic_stats.is_rx_assoc_badwpaie++;
2543 1.40 dyoung return;
2544 1.40 dyoung }
2545 1.40 dyoung IEEE80211_DPRINTF(ic,
2546 1.40 dyoung IEEE80211_MSG_ASSOC | IEEE80211_MSG_WPA,
2547 1.40 dyoung "[%s] %s ie: mc %u/%u uc %u/%u key %u caps 0x%x\n",
2548 1.85 christos ether_snprintf(ebuf, sizeof(ebuf), wh->i_addr2),
2549 1.40 dyoung wpa[0] != IEEE80211_ELEMID_RSN ? "WPA" : "RSN",
2550 1.40 dyoung rsn.rsn_mcastcipher, rsn.rsn_mcastkeylen,
2551 1.40 dyoung rsn.rsn_ucastcipher, rsn.rsn_ucastkeylen,
2552 1.40 dyoung rsn.rsn_keymgmt, rsn.rsn_caps);
2553 1.40 dyoung }
2554 1.7 dyoung /* discard challenge after association */
2555 1.7 dyoung if (ni->ni_challenge != NULL) {
2556 1.67 cegger free(ni->ni_challenge, M_DEVBUF);
2557 1.7 dyoung ni->ni_challenge = NULL;
2558 1.1 dyoung }
2559 1.44 dyoung /* NB: 802.11 spec says to ignore station's privacy bit */
2560 1.44 dyoung if ((capinfo & IEEE80211_CAPINFO_ESS) == 0) {
2561 1.25 mycroft IEEE80211_DPRINTF(ic, IEEE80211_MSG_ANY,
2562 1.40 dyoung "[%s] deny %s request, capability mismatch 0x%x\n",
2563 1.85 christos ether_snprintf(ebuf, sizeof(ebuf), wh->i_addr2),
2564 1.40 dyoung reassoc ? "reassoc" : "assoc", capinfo);
2565 1.1 dyoung IEEE80211_SEND_MGMT(ic, ni, resp,
2566 1.1 dyoung IEEE80211_STATUS_CAPINFO);
2567 1.29 mycroft ieee80211_node_leave(ic, ni);
2568 1.16 dyoung ic->ic_stats.is_rx_assoc_capmismatch++;
2569 1.1 dyoung return;
2570 1.1 dyoung }
2571 1.47 skrll rate = ieee80211_setup_rates(ni, rates, xrates,
2572 1.73 christos IEEE80211_R_DOSORT | IEEE80211_R_DOFRATE |
2573 1.73 christos IEEE80211_R_DONEGO | IEEE80211_R_DODEL);
2574 1.44 dyoung /*
2575 1.44 dyoung * If constrained to 11g-only stations reject an
2576 1.44 dyoung * 11b-only station. We cheat a bit here by looking
2577 1.44 dyoung * at the max negotiated xmit rate and assuming anyone
2578 1.44 dyoung * with a best rate <24Mb/s is an 11b station.
2579 1.44 dyoung */
2580 1.44 dyoung if ((rate & IEEE80211_RATE_BASIC) ||
2581 1.44 dyoung ((ic->ic_flags & IEEE80211_F_PUREG) && rate < 48)) {
2582 1.25 mycroft IEEE80211_DPRINTF(ic, IEEE80211_MSG_ANY,
2583 1.40 dyoung "[%s] deny %s request, rate set mismatch\n",
2584 1.85 christos ether_snprintf(ebuf, sizeof(ebuf), wh->i_addr2),
2585 1.40 dyoung reassoc ? "reassoc" : "assoc");
2586 1.1 dyoung IEEE80211_SEND_MGMT(ic, ni, resp,
2587 1.1 dyoung IEEE80211_STATUS_BASIC_RATE);
2588 1.29 mycroft ieee80211_node_leave(ic, ni);
2589 1.16 dyoung ic->ic_stats.is_rx_assoc_norate++;
2590 1.1 dyoung return;
2591 1.1 dyoung }
2592 1.1 dyoung ni->ni_rssi = rssi;
2593 1.1 dyoung ni->ni_rstamp = rstamp;
2594 1.47 skrll ni->ni_intval = lintval;
2595 1.1 dyoung ni->ni_capinfo = capinfo;
2596 1.1 dyoung ni->ni_chan = ic->ic_bss->ni_chan;
2597 1.1 dyoung ni->ni_fhdwell = ic->ic_bss->ni_fhdwell;
2598 1.1 dyoung ni->ni_fhindex = ic->ic_bss->ni_fhindex;
2599 1.40 dyoung if (wpa != NULL) {
2600 1.40 dyoung /*
2601 1.40 dyoung * Record WPA/RSN parameters for station, mark
2602 1.40 dyoung * node as using WPA and record information element
2603 1.40 dyoung * for applications that require it.
2604 1.40 dyoung */
2605 1.40 dyoung ni->ni_rsn = rsn;
2606 1.40 dyoung ieee80211_saveie(&ni->ni_wpa_ie, wpa);
2607 1.40 dyoung } else if (ni->ni_wpa_ie != NULL) {
2608 1.40 dyoung /*
2609 1.40 dyoung * Flush any state from a previous association.
2610 1.40 dyoung */
2611 1.67 cegger free(ni->ni_wpa_ie, M_DEVBUF);
2612 1.40 dyoung ni->ni_wpa_ie = NULL;
2613 1.40 dyoung }
2614 1.40 dyoung if (wme != NULL) {
2615 1.40 dyoung /*
2616 1.40 dyoung * Record WME parameters for station, mark node
2617 1.40 dyoung * as capable of QoS and record information
2618 1.40 dyoung * element for applications that require it.
2619 1.40 dyoung */
2620 1.40 dyoung ieee80211_saveie(&ni->ni_wme_ie, wme);
2621 1.40 dyoung ni->ni_flags |= IEEE80211_NODE_QOS;
2622 1.40 dyoung } else if (ni->ni_wme_ie != NULL) {
2623 1.40 dyoung /*
2624 1.40 dyoung * Flush any state from a previous association.
2625 1.40 dyoung */
2626 1.67 cegger free(ni->ni_wme_ie, M_DEVBUF);
2627 1.40 dyoung ni->ni_wme_ie = NULL;
2628 1.40 dyoung ni->ni_flags &= ~IEEE80211_NODE_QOS;
2629 1.40 dyoung }
2630 1.29 mycroft ieee80211_node_join(ic, ni, resp);
2631 1.1 dyoung break;
2632 1.1 dyoung }
2633 1.1 dyoung
2634 1.1 dyoung case IEEE80211_FC0_SUBTYPE_ASSOC_RESP:
2635 1.1 dyoung case IEEE80211_FC0_SUBTYPE_REASSOC_RESP: {
2636 1.40 dyoung u_int16_t capinfo, associd;
2637 1.1 dyoung u_int16_t status;
2638 1.1 dyoung
2639 1.1 dyoung if (ic->ic_opmode != IEEE80211_M_STA ||
2640 1.26 mycroft ic->ic_state != IEEE80211_S_ASSOC) {
2641 1.26 mycroft ic->ic_stats.is_rx_mgtdiscard++;
2642 1.1 dyoung return;
2643 1.26 mycroft }
2644 1.1 dyoung
2645 1.1 dyoung /*
2646 1.1 dyoung * asresp frame format
2647 1.1 dyoung * [2] capability information
2648 1.1 dyoung * [2] status
2649 1.1 dyoung * [2] association ID
2650 1.1 dyoung * [tlv] supported rates
2651 1.1 dyoung * [tlv] extended supported rates
2652 1.40 dyoung * [tlv] WME
2653 1.1 dyoung */
2654 1.1 dyoung IEEE80211_VERIFY_LENGTH(efrm - frm, 6);
2655 1.1 dyoung ni = ic->ic_bss;
2656 1.40 dyoung capinfo = le16toh(*(u_int16_t *)frm);
2657 1.1 dyoung frm += 2;
2658 1.1 dyoung status = le16toh(*(u_int16_t *)frm);
2659 1.1 dyoung frm += 2;
2660 1.1 dyoung if (status != 0) {
2661 1.26 mycroft IEEE80211_DPRINTF(ic, IEEE80211_MSG_ASSOC,
2662 1.40 dyoung "[%s] %sassoc failed (reason %d)\n",
2663 1.85 christos ether_snprintf(ebuf, sizeof(ebuf), wh->i_addr2),
2664 1.40 dyoung ISREASSOC(subtype) ? "re" : "", status);
2665 1.40 dyoung if (ni != ic->ic_bss) /* XXX never true? */
2666 1.1 dyoung ni->ni_fails++;
2667 1.40 dyoung ic->ic_stats.is_rx_auth_fail++; /* XXX */
2668 1.1 dyoung return;
2669 1.1 dyoung }
2670 1.40 dyoung associd = le16toh(*(u_int16_t *)frm);
2671 1.1 dyoung frm += 2;
2672 1.1 dyoung
2673 1.40 dyoung rates = xrates = wpa = wme = NULL;
2674 1.1 dyoung while (frm < efrm) {
2675 1.1 dyoung switch (*frm) {
2676 1.1 dyoung case IEEE80211_ELEMID_RATES:
2677 1.1 dyoung rates = frm;
2678 1.1 dyoung break;
2679 1.1 dyoung case IEEE80211_ELEMID_XRATES:
2680 1.1 dyoung xrates = frm;
2681 1.1 dyoung break;
2682 1.40 dyoung case IEEE80211_ELEMID_VENDOR:
2683 1.40 dyoung if (iswmeoui(frm))
2684 1.40 dyoung wme = frm;
2685 1.40 dyoung /* XXX Atheros OUI support */
2686 1.40 dyoung break;
2687 1.1 dyoung }
2688 1.1 dyoung frm += frm[1] + 2;
2689 1.1 dyoung }
2690 1.1 dyoung
2691 1.1 dyoung IEEE80211_VERIFY_ELEMENT(rates, IEEE80211_RATE_MAXSIZE);
2692 1.47 skrll rate = ieee80211_setup_rates(ni, rates, xrates,
2693 1.73 christos IEEE80211_R_DOSORT | IEEE80211_R_DOFRATE |
2694 1.73 christos IEEE80211_R_DONEGO | IEEE80211_R_DODEL);
2695 1.44 dyoung if (rate & IEEE80211_RATE_BASIC) {
2696 1.40 dyoung IEEE80211_DPRINTF(ic, IEEE80211_MSG_ASSOC,
2697 1.40 dyoung "[%s] %sassoc failed (rate set mismatch)\n",
2698 1.85 christos ether_snprintf(ebuf, sizeof(ebuf), wh->i_addr2),
2699 1.40 dyoung ISREASSOC(subtype) ? "re" : "");
2700 1.40 dyoung if (ni != ic->ic_bss) /* XXX never true? */
2701 1.40 dyoung ni->ni_fails++;
2702 1.40 dyoung ic->ic_stats.is_rx_assoc_norate++;
2703 1.44 dyoung ieee80211_new_state(ic, IEEE80211_S_SCAN, 0);
2704 1.40 dyoung return;
2705 1.40 dyoung }
2706 1.40 dyoung
2707 1.40 dyoung ni->ni_capinfo = capinfo;
2708 1.40 dyoung ni->ni_associd = associd;
2709 1.40 dyoung if (wme != NULL &&
2710 1.40 dyoung ieee80211_parse_wmeparams(ic, wme, wh) >= 0) {
2711 1.40 dyoung ni->ni_flags |= IEEE80211_NODE_QOS;
2712 1.40 dyoung ieee80211_wme_updateparams(ic);
2713 1.40 dyoung } else
2714 1.40 dyoung ni->ni_flags &= ~IEEE80211_NODE_QOS;
2715 1.40 dyoung /*
2716 1.40 dyoung * Configure state now that we are associated.
2717 1.40 dyoung *
2718 1.40 dyoung * XXX may need different/additional driver callbacks?
2719 1.40 dyoung */
2720 1.40 dyoung if (ic->ic_curmode == IEEE80211_MODE_11A ||
2721 1.40 dyoung (ni->ni_capinfo & IEEE80211_CAPINFO_SHORT_PREAMBLE)) {
2722 1.40 dyoung ic->ic_flags |= IEEE80211_F_SHPREAMBLE;
2723 1.40 dyoung ic->ic_flags &= ~IEEE80211_F_USEBARKER;
2724 1.40 dyoung } else {
2725 1.40 dyoung ic->ic_flags &= ~IEEE80211_F_SHPREAMBLE;
2726 1.40 dyoung ic->ic_flags |= IEEE80211_F_USEBARKER;
2727 1.40 dyoung }
2728 1.40 dyoung ieee80211_set_shortslottime(ic,
2729 1.40 dyoung ic->ic_curmode == IEEE80211_MODE_11A ||
2730 1.40 dyoung (ni->ni_capinfo & IEEE80211_CAPINFO_SHORT_SLOTTIME));
2731 1.40 dyoung /*
2732 1.40 dyoung * Honor ERP protection.
2733 1.40 dyoung *
2734 1.40 dyoung * NB: ni_erp should zero for non-11g operation.
2735 1.40 dyoung * XXX check ic_curmode anyway?
2736 1.40 dyoung */
2737 1.44 dyoung if (ic->ic_curmode == IEEE80211_MODE_11G &&
2738 1.44 dyoung (ni->ni_erp & IEEE80211_ERP_USE_PROTECTION))
2739 1.40 dyoung ic->ic_flags |= IEEE80211_F_USEPROT;
2740 1.40 dyoung else
2741 1.40 dyoung ic->ic_flags &= ~IEEE80211_F_USEPROT;
2742 1.40 dyoung IEEE80211_DPRINTF(ic, IEEE80211_MSG_ASSOC,
2743 1.40 dyoung "[%s] %sassoc success: %s preamble, %s slot time%s%s\n",
2744 1.85 christos ether_snprintf(ebuf, sizeof(ebuf), wh->i_addr2),
2745 1.40 dyoung ISREASSOC(subtype) ? "re" : "",
2746 1.40 dyoung ic->ic_flags&IEEE80211_F_SHPREAMBLE ? "short" : "long",
2747 1.40 dyoung ic->ic_flags&IEEE80211_F_SHSLOT ? "short" : "long",
2748 1.40 dyoung ic->ic_flags&IEEE80211_F_USEPROT ? ", protection" : "",
2749 1.40 dyoung ni->ni_flags & IEEE80211_NODE_QOS ? ", QoS" : ""
2750 1.40 dyoung );
2751 1.40 dyoung ieee80211_new_state(ic, IEEE80211_S_RUN, subtype);
2752 1.1 dyoung break;
2753 1.1 dyoung }
2754 1.1 dyoung
2755 1.1 dyoung case IEEE80211_FC0_SUBTYPE_DEAUTH: {
2756 1.1 dyoung u_int16_t reason;
2757 1.40 dyoung
2758 1.40 dyoung if (ic->ic_state == IEEE80211_S_SCAN) {
2759 1.40 dyoung ic->ic_stats.is_rx_mgtdiscard++;
2760 1.40 dyoung return;
2761 1.40 dyoung }
2762 1.1 dyoung /*
2763 1.1 dyoung * deauth frame format
2764 1.1 dyoung * [2] reason
2765 1.1 dyoung */
2766 1.1 dyoung IEEE80211_VERIFY_LENGTH(efrm - frm, 2);
2767 1.1 dyoung reason = le16toh(*(u_int16_t *)frm);
2768 1.85 christos __USE(reason);
2769 1.16 dyoung ic->ic_stats.is_rx_deauth++;
2770 1.40 dyoung IEEE80211_NODE_STAT(ni, rx_deauth);
2771 1.44 dyoung
2772 1.61 dyoung if (!IEEE80211_ADDR_EQ(wh->i_addr1, ic->ic_myaddr)) {
2773 1.61 dyoung /* Not intended for this station. */
2774 1.61 dyoung ic->ic_stats.is_rx_mgtdiscard++;
2775 1.61 dyoung break;
2776 1.61 dyoung }
2777 1.44 dyoung IEEE80211_DPRINTF(ic, IEEE80211_MSG_AUTH,
2778 1.44 dyoung "[%s] recv deauthenticate (reason %d)\n",
2779 1.85 christos ether_snprintf(ebuf, sizeof(ebuf), ni->ni_macaddr), reason);
2780 1.1 dyoung switch (ic->ic_opmode) {
2781 1.1 dyoung case IEEE80211_M_STA:
2782 1.1 dyoung ieee80211_new_state(ic, IEEE80211_S_AUTH,
2783 1.1 dyoung wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK);
2784 1.1 dyoung break;
2785 1.1 dyoung case IEEE80211_M_HOSTAP:
2786 1.41 dyoung #ifndef IEEE80211_NO_HOSTAP
2787 1.44 dyoung if (ni != ic->ic_bss)
2788 1.29 mycroft ieee80211_node_leave(ic, ni);
2789 1.41 dyoung #endif /* !IEEE80211_NO_HOSTAP */
2790 1.1 dyoung break;
2791 1.1 dyoung default:
2792 1.40 dyoung ic->ic_stats.is_rx_mgtdiscard++;
2793 1.1 dyoung break;
2794 1.1 dyoung }
2795 1.1 dyoung break;
2796 1.1 dyoung }
2797 1.1 dyoung
2798 1.1 dyoung case IEEE80211_FC0_SUBTYPE_DISASSOC: {
2799 1.1 dyoung u_int16_t reason;
2800 1.40 dyoung
2801 1.40 dyoung if (ic->ic_state != IEEE80211_S_RUN &&
2802 1.44 dyoung ic->ic_state != IEEE80211_S_ASSOC &&
2803 1.40 dyoung ic->ic_state != IEEE80211_S_AUTH) {
2804 1.40 dyoung ic->ic_stats.is_rx_mgtdiscard++;
2805 1.40 dyoung return;
2806 1.40 dyoung }
2807 1.1 dyoung /*
2808 1.1 dyoung * disassoc frame format
2809 1.1 dyoung * [2] reason
2810 1.1 dyoung */
2811 1.1 dyoung IEEE80211_VERIFY_LENGTH(efrm - frm, 2);
2812 1.1 dyoung reason = le16toh(*(u_int16_t *)frm);
2813 1.85 christos __USE(reason);
2814 1.16 dyoung ic->ic_stats.is_rx_disassoc++;
2815 1.40 dyoung IEEE80211_NODE_STAT(ni, rx_disassoc);
2816 1.44 dyoung
2817 1.61 dyoung if (!IEEE80211_ADDR_EQ(wh->i_addr1, ic->ic_myaddr)) {
2818 1.61 dyoung /* Not intended for this station. */
2819 1.61 dyoung ic->ic_stats.is_rx_mgtdiscard++;
2820 1.61 dyoung break;
2821 1.61 dyoung }
2822 1.44 dyoung IEEE80211_DPRINTF(ic, IEEE80211_MSG_ASSOC,
2823 1.47 skrll "[%s] recv disassociate (reason %d)\n",
2824 1.85 christos ether_snprintf(ebuf, sizeof(ebuf), ni->ni_macaddr), reason);
2825 1.1 dyoung switch (ic->ic_opmode) {
2826 1.1 dyoung case IEEE80211_M_STA:
2827 1.1 dyoung ieee80211_new_state(ic, IEEE80211_S_ASSOC,
2828 1.1 dyoung wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK);
2829 1.1 dyoung break;
2830 1.1 dyoung case IEEE80211_M_HOSTAP:
2831 1.41 dyoung #ifndef IEEE80211_NO_HOSTAP
2832 1.44 dyoung if (ni != ic->ic_bss)
2833 1.29 mycroft ieee80211_node_leave(ic, ni);
2834 1.41 dyoung #endif /* !IEEE80211_NO_HOSTAP */
2835 1.1 dyoung break;
2836 1.1 dyoung default:
2837 1.40 dyoung ic->ic_stats.is_rx_mgtdiscard++;
2838 1.1 dyoung break;
2839 1.1 dyoung }
2840 1.1 dyoung break;
2841 1.1 dyoung }
2842 1.1 dyoung default:
2843 1.40 dyoung IEEE80211_DISCARD(ic, IEEE80211_MSG_ANY,
2844 1.40 dyoung wh, "mgt", "subtype 0x%x not handled", subtype);
2845 1.16 dyoung ic->ic_stats.is_rx_badsubtype++;
2846 1.1 dyoung break;
2847 1.1 dyoung }
2848 1.40 dyoung #undef ISREASSOC
2849 1.40 dyoung #undef ISPROBE
2850 1.5 dyoung }
2851 1.40 dyoung #undef IEEE80211_VERIFY_LENGTH
2852 1.40 dyoung #undef IEEE80211_VERIFY_ELEMENT
2853 1.5 dyoung
2854 1.41 dyoung #ifndef IEEE80211_NO_HOSTAP
2855 1.40 dyoung /*
2856 1.40 dyoung * Handle station power-save state change.
2857 1.40 dyoung */
2858 1.5 dyoung static void
2859 1.40 dyoung ieee80211_node_pwrsave(struct ieee80211_node *ni, int enable)
2860 1.5 dyoung {
2861 1.40 dyoung struct ieee80211com *ic = ni->ni_ic;
2862 1.5 dyoung struct mbuf *m;
2863 1.85 christos IEEE80211_DEBUGVAR(char ebuf[3 * ETHER_ADDR_LEN]);
2864 1.5 dyoung
2865 1.40 dyoung if (enable) {
2866 1.40 dyoung if ((ni->ni_flags & IEEE80211_NODE_PWR_MGT) == 0)
2867 1.40 dyoung ic->ic_ps_sta++;
2868 1.40 dyoung ni->ni_flags |= IEEE80211_NODE_PWR_MGT;
2869 1.40 dyoung IEEE80211_DPRINTF(ic, IEEE80211_MSG_POWER,
2870 1.40 dyoung "[%s] power save mode on, %u sta's in ps mode\n",
2871 1.85 christos ether_snprintf(ebuf, sizeof(ebuf), ni->ni_macaddr),
2872 1.85 christos ic->ic_ps_sta);
2873 1.5 dyoung return;
2874 1.40 dyoung }
2875 1.5 dyoung
2876 1.40 dyoung if (ni->ni_flags & IEEE80211_NODE_PWR_MGT)
2877 1.40 dyoung ic->ic_ps_sta--;
2878 1.40 dyoung ni->ni_flags &= ~IEEE80211_NODE_PWR_MGT;
2879 1.40 dyoung IEEE80211_DPRINTF(ic, IEEE80211_MSG_POWER,
2880 1.40 dyoung "[%s] power save mode off, %u sta's in ps mode\n",
2881 1.85 christos ether_snprintf(ebuf, sizeof(ebuf), ni->ni_macaddr), ic->ic_ps_sta);
2882 1.40 dyoung /* XXX if no stations in ps mode, flush mc frames */
2883 1.5 dyoung
2884 1.40 dyoung /*
2885 1.40 dyoung * Flush queued unicast frames.
2886 1.40 dyoung */
2887 1.40 dyoung if (IEEE80211_NODE_SAVEQ_QLEN(ni) == 0) {
2888 1.44 dyoung if (ic->ic_set_tim != NULL)
2889 1.47 skrll ic->ic_set_tim(ni, 0); /* just in case */
2890 1.5 dyoung return;
2891 1.5 dyoung }
2892 1.40 dyoung IEEE80211_DPRINTF(ic, IEEE80211_MSG_POWER,
2893 1.40 dyoung "[%s] flush ps queue, %u packets queued\n",
2894 1.85 christos ether_snprintf(ebuf, sizeof(ebuf), ni->ni_macaddr),
2895 1.85 christos IEEE80211_NODE_SAVEQ_QLEN(ni));
2896 1.40 dyoung for (;;) {
2897 1.40 dyoung int qlen;
2898 1.40 dyoung
2899 1.40 dyoung IEEE80211_NODE_SAVEQ_DEQUEUE(ni, m, qlen);
2900 1.40 dyoung if (m == NULL)
2901 1.40 dyoung break;
2902 1.74 christos /*
2903 1.40 dyoung * If this is the last packet, turn off the TIM bit.
2904 1.40 dyoung * If there are more packets, set the more packets bit
2905 1.44 dyoung * in the mbuf so ieee80211_encap will mark the 802.11
2906 1.44 dyoung * head to indicate more data frames will follow.
2907 1.40 dyoung */
2908 1.44 dyoung if (qlen != 0)
2909 1.44 dyoung m->m_flags |= M_MORE_DATA;
2910 1.40 dyoung /* XXX need different driver interface */
2911 1.40 dyoung /* XXX bypasses q max */
2912 1.40 dyoung IF_ENQUEUE(&ic->ic_ifp->if_snd, m);
2913 1.40 dyoung }
2914 1.44 dyoung if (ic->ic_set_tim != NULL)
2915 1.47 skrll ic->ic_set_tim(ni, 0);
2916 1.40 dyoung }
2917 1.5 dyoung
2918 1.40 dyoung /*
2919 1.40 dyoung * Process a received ps-poll frame.
2920 1.40 dyoung */
2921 1.40 dyoung static void
2922 1.40 dyoung ieee80211_recv_pspoll(struct ieee80211com *ic,
2923 1.40 dyoung struct ieee80211_node *ni, struct mbuf *m0)
2924 1.40 dyoung {
2925 1.40 dyoung struct ieee80211_frame_min *wh;
2926 1.40 dyoung struct mbuf *m;
2927 1.40 dyoung u_int16_t aid;
2928 1.40 dyoung int qlen;
2929 1.85 christos IEEE80211_DEBUGVAR(char ebuf[3 * ETHER_ADDR_LEN]);
2930 1.40 dyoung
2931 1.40 dyoung wh = mtod(m0, struct ieee80211_frame_min *);
2932 1.40 dyoung if (ni->ni_associd == 0) {
2933 1.40 dyoung IEEE80211_DISCARD(ic, IEEE80211_MSG_POWER | IEEE80211_MSG_DEBUG,
2934 1.40 dyoung (struct ieee80211_frame *) wh, "ps-poll",
2935 1.40 dyoung "%s", "unassociated station");
2936 1.40 dyoung ic->ic_stats.is_ps_unassoc++;
2937 1.40 dyoung IEEE80211_SEND_MGMT(ic, ni, IEEE80211_FC0_SUBTYPE_DEAUTH,
2938 1.40 dyoung IEEE80211_REASON_NOT_ASSOCED);
2939 1.5 dyoung return;
2940 1.5 dyoung }
2941 1.5 dyoung
2942 1.40 dyoung aid = le16toh(*(u_int16_t *)wh->i_dur);
2943 1.5 dyoung if (aid != ni->ni_associd) {
2944 1.40 dyoung IEEE80211_DISCARD(ic, IEEE80211_MSG_POWER | IEEE80211_MSG_DEBUG,
2945 1.40 dyoung (struct ieee80211_frame *) wh, "ps-poll",
2946 1.40 dyoung "aid mismatch: sta aid 0x%x poll aid 0x%x",
2947 1.40 dyoung ni->ni_associd, aid);
2948 1.40 dyoung ic->ic_stats.is_ps_badaid++;
2949 1.40 dyoung IEEE80211_SEND_MGMT(ic, ni, IEEE80211_FC0_SUBTYPE_DEAUTH,
2950 1.40 dyoung IEEE80211_REASON_NOT_ASSOCED);
2951 1.5 dyoung return;
2952 1.5 dyoung }
2953 1.5 dyoung
2954 1.5 dyoung /* Okay, take the first queued packet and put it out... */
2955 1.40 dyoung IEEE80211_NODE_SAVEQ_DEQUEUE(ni, m, qlen);
2956 1.5 dyoung if (m == NULL) {
2957 1.40 dyoung IEEE80211_DPRINTF(ic, IEEE80211_MSG_POWER,
2958 1.40 dyoung "[%s] recv ps-poll, but queue empty\n",
2959 1.85 christos ether_snprintf(ebuf, sizeof(ebuf), wh->i_addr2));
2960 1.47 skrll ieee80211_send_nulldata(ieee80211_ref_node(ni));
2961 1.40 dyoung ic->ic_stats.is_ps_qempty++; /* XXX node stat */
2962 1.44 dyoung if (ic->ic_set_tim != NULL)
2963 1.47 skrll ic->ic_set_tim(ni, 0); /* just in case */
2964 1.5 dyoung return;
2965 1.5 dyoung }
2966 1.74 christos /*
2967 1.40 dyoung * If there are more packets, set the more packets bit
2968 1.40 dyoung * in the packet dispatched to the station; otherwise
2969 1.40 dyoung * turn off the TIM bit.
2970 1.5 dyoung */
2971 1.40 dyoung if (qlen != 0) {
2972 1.40 dyoung IEEE80211_DPRINTF(ic, IEEE80211_MSG_POWER,
2973 1.40 dyoung "[%s] recv ps-poll, send packet, %u still queued\n",
2974 1.85 christos ether_snprintf(ebuf, sizeof(ebuf), ni->ni_macaddr), qlen);
2975 1.44 dyoung m->m_flags |= M_MORE_DATA;
2976 1.5 dyoung } else {
2977 1.40 dyoung IEEE80211_DPRINTF(ic, IEEE80211_MSG_POWER,
2978 1.40 dyoung "[%s] recv ps-poll, send packet, queue empty\n",
2979 1.85 christos ether_snprintf(ebuf, sizeof(ebuf), ni->ni_macaddr));
2980 1.44 dyoung if (ic->ic_set_tim != NULL)
2981 1.47 skrll ic->ic_set_tim(ni, 0);
2982 1.5 dyoung }
2983 1.40 dyoung m->m_flags |= M_PWR_SAV; /* bypass PS handling */
2984 1.40 dyoung IF_ENQUEUE(&ic->ic_ifp->if_snd, m);
2985 1.40 dyoung }
2986 1.41 dyoung #endif /* !IEEE80211_NO_HOSTAP */
2987 1.5 dyoung
2988 1.40 dyoung #ifdef IEEE80211_DEBUG
2989 1.40 dyoung /*
2990 1.40 dyoung * Debugging support.
2991 1.40 dyoung */
2992 1.5 dyoung
2993 1.40 dyoung /*
2994 1.40 dyoung * Return the bssid of a frame.
2995 1.40 dyoung */
2996 1.40 dyoung static const u_int8_t *
2997 1.40 dyoung ieee80211_getbssid(struct ieee80211com *ic, const struct ieee80211_frame *wh)
2998 1.40 dyoung {
2999 1.40 dyoung if (ic->ic_opmode == IEEE80211_M_STA)
3000 1.40 dyoung return wh->i_addr2;
3001 1.40 dyoung if ((wh->i_fc[1] & IEEE80211_FC1_DIR_MASK) != IEEE80211_FC1_DIR_NODS)
3002 1.40 dyoung return wh->i_addr1;
3003 1.40 dyoung if ((wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK) == IEEE80211_FC0_SUBTYPE_PS_POLL)
3004 1.40 dyoung return wh->i_addr1;
3005 1.40 dyoung return wh->i_addr3;
3006 1.1 dyoung }
3007 1.31 dyoung
3008 1.47 skrll void
3009 1.47 skrll ieee80211_note(struct ieee80211com *ic, const char *fmt, ...)
3010 1.47 skrll {
3011 1.47 skrll char buf[128]; /* XXX */
3012 1.47 skrll va_list ap;
3013 1.47 skrll
3014 1.47 skrll va_start(ap, fmt);
3015 1.47 skrll vsnprintf(buf, sizeof(buf), fmt, ap);
3016 1.47 skrll va_end(ap);
3017 1.47 skrll
3018 1.47 skrll if_printf(ic->ic_ifp, "%s", buf); /* NB: no \n */
3019 1.47 skrll }
3020 1.47 skrll
3021 1.47 skrll void
3022 1.47 skrll ieee80211_note_frame(struct ieee80211com *ic,
3023 1.47 skrll const struct ieee80211_frame *wh,
3024 1.47 skrll const char *fmt, ...)
3025 1.47 skrll {
3026 1.47 skrll char buf[128]; /* XXX */
3027 1.47 skrll va_list ap;
3028 1.85 christos char ebuf[3 * ETHER_ADDR_LEN];
3029 1.47 skrll
3030 1.47 skrll va_start(ap, fmt);
3031 1.47 skrll vsnprintf(buf, sizeof(buf), fmt, ap);
3032 1.47 skrll va_end(ap);
3033 1.47 skrll if_printf(ic->ic_ifp, "[%s] %s\n",
3034 1.85 christos ether_snprintf(ebuf, sizeof(ebuf),
3035 1.85 christos ieee80211_getbssid(ic, wh)), buf);
3036 1.47 skrll }
3037 1.47 skrll
3038 1.47 skrll void
3039 1.47 skrll ieee80211_note_mac(struct ieee80211com *ic,
3040 1.47 skrll const u_int8_t mac[IEEE80211_ADDR_LEN],
3041 1.47 skrll const char *fmt, ...)
3042 1.47 skrll {
3043 1.47 skrll char buf[128]; /* XXX */
3044 1.47 skrll va_list ap;
3045 1.85 christos char ebuf[3 * ETHER_ADDR_LEN];
3046 1.47 skrll
3047 1.47 skrll va_start(ap, fmt);
3048 1.47 skrll vsnprintf(buf, sizeof(buf), fmt, ap);
3049 1.47 skrll va_end(ap);
3050 1.85 christos if_printf(ic->ic_ifp, "[%s] %s\n", ether_snprintf(ebuf, sizeof(ebuf),
3051 1.85 christos mac), buf);
3052 1.47 skrll }
3053 1.47 skrll
3054 1.40 dyoung static void
3055 1.40 dyoung ieee80211_discard_frame(struct ieee80211com *ic,
3056 1.40 dyoung const struct ieee80211_frame *wh,
3057 1.40 dyoung const char *type, const char *fmt, ...)
3058 1.31 dyoung {
3059 1.40 dyoung va_list ap;
3060 1.85 christos char ebuf[3 * ETHER_ADDR_LEN];
3061 1.31 dyoung
3062 1.47 skrll printf("[%s:%s] discard ", ic->ic_ifp->if_xname,
3063 1.85 christos ether_snprintf(ebuf, sizeof(ebuf), ieee80211_getbssid(ic, wh)));
3064 1.40 dyoung if (type != NULL)
3065 1.47 skrll printf("%s frame, ", type);
3066 1.40 dyoung else
3067 1.47 skrll printf("frame, ");
3068 1.40 dyoung va_start(ap, fmt);
3069 1.40 dyoung vprintf(fmt, ap);
3070 1.40 dyoung va_end(ap);
3071 1.40 dyoung printf("\n");
3072 1.31 dyoung }
3073 1.31 dyoung
3074 1.40 dyoung static void
3075 1.40 dyoung ieee80211_discard_ie(struct ieee80211com *ic,
3076 1.40 dyoung const struct ieee80211_frame *wh,
3077 1.40 dyoung const char *type, const char *fmt, ...)
3078 1.31 dyoung {
3079 1.40 dyoung va_list ap;
3080 1.85 christos char ebuf[3 * ETHER_ADDR_LEN];
3081 1.31 dyoung
3082 1.47 skrll printf("[%s:%s] discard ", ic->ic_ifp->if_xname,
3083 1.85 christos ether_snprintf(ebuf, sizeof(ebuf), ieee80211_getbssid(ic, wh)));
3084 1.40 dyoung if (type != NULL)
3085 1.47 skrll printf("%s information element, ", type);
3086 1.40 dyoung else
3087 1.47 skrll printf("information element, ");
3088 1.40 dyoung va_start(ap, fmt);
3089 1.40 dyoung vprintf(fmt, ap);
3090 1.40 dyoung va_end(ap);
3091 1.40 dyoung printf("\n");
3092 1.40 dyoung }
3093 1.31 dyoung
3094 1.40 dyoung static void
3095 1.40 dyoung ieee80211_discard_mac(struct ieee80211com *ic,
3096 1.40 dyoung const u_int8_t mac[IEEE80211_ADDR_LEN],
3097 1.40 dyoung const char *type, const char *fmt, ...)
3098 1.40 dyoung {
3099 1.40 dyoung va_list ap;
3100 1.85 christos char ebuf[3 * ETHER_ADDR_LEN];
3101 1.31 dyoung
3102 1.85 christos printf("[%s:%s] discard ", ic->ic_ifp->if_xname,
3103 1.85 christos ether_snprintf(ebuf, sizeof(ebuf), mac));
3104 1.40 dyoung if (type != NULL)
3105 1.47 skrll printf("%s frame, ", type);
3106 1.40 dyoung else
3107 1.47 skrll printf("frame, ");
3108 1.40 dyoung va_start(ap, fmt);
3109 1.40 dyoung vprintf(fmt, ap);
3110 1.40 dyoung va_end(ap);
3111 1.40 dyoung printf("\n");
3112 1.31 dyoung }
3113 1.40 dyoung #endif /* IEEE80211_DEBUG */
3114