Deleted Added
sdiff udiff text old ( 117817 ) new ( 119150 )
full compact
ieee80211_output.c (117817) ieee80211_output.c (119150)
1/*-
2 * Copyright (c) 2001 Atsushi Onoe
3 * Copyright (c) 2002, 2003 Sam Leffler, Errno Consulting
4 * All rights reserved.
5 *
6 * Redistribution and use in source and binary forms, with or without
7 * modification, are permitted provided that the following conditions
8 * are met:

--- 17 unchanged lines hidden (view full) ---

26 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
27 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
28 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
29 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
30 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
31 */
32
33#include <sys/cdefs.h>
1/*-
2 * Copyright (c) 2001 Atsushi Onoe
3 * Copyright (c) 2002, 2003 Sam Leffler, Errno Consulting
4 * All rights reserved.
5 *
6 * Redistribution and use in source and binary forms, with or without
7 * modification, are permitted provided that the following conditions
8 * are met:

--- 17 unchanged lines hidden (view full) ---

26 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
27 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
28 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
29 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
30 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
31 */
32
33#include <sys/cdefs.h>
34__FBSDID("$FreeBSD: head/sys/net80211/ieee80211_output.c 117817 2003-07-21 02:49:42Z sam $");
34__FBSDID("$FreeBSD: head/sys/net80211/ieee80211_output.c 119150 2003-08-19 22:17:04Z sam $");
35
36#include "opt_inet.h"
37
38#include <sys/param.h>
39#include <sys/systm.h>
40#include <sys/mbuf.h>
41#include <sys/malloc.h>
42#include <sys/kernel.h>

--- 18 unchanged lines hidden (view full) ---

61
62#include <net/bpf.h>
63
64#ifdef INET
65#include <netinet/in.h>
66#include <netinet/if_ether.h>
67#endif
68
35
36#include "opt_inet.h"
37
38#include <sys/param.h>
39#include <sys/systm.h>
40#include <sys/mbuf.h>
41#include <sys/malloc.h>
42#include <sys/kernel.h>

--- 18 unchanged lines hidden (view full) ---

61
62#include <net/bpf.h>
63
64#ifdef INET
65#include <netinet/in.h>
66#include <netinet/if_ether.h>
67#endif
68
69int
69/*
70 * Send a management frame to the specified node. The node pointer
71 * must have a reference as the pointer will be passed to the driver
72 * and potentially held for a long time. If the frame is successfully
73 * dispatched to the driver, then it is responsible for freeing the
74 * reference (and potentially free'ing up any associated storage).
75 */
76static int
70ieee80211_mgmt_output(struct ifnet *ifp, struct ieee80211_node *ni,
71 struct mbuf *m, int type)
72{
73 struct ieee80211com *ic = (void *)ifp;
74 struct ieee80211_frame *wh;
75
77ieee80211_mgmt_output(struct ifnet *ifp, struct ieee80211_node *ni,
78 struct mbuf *m, int type)
79{
80 struct ieee80211com *ic = (void *)ifp;
81 struct ieee80211_frame *wh;
82
76 /* XXX this probably shouldn't be permitted */
77 KASSERT(ni != NULL, ("%s: null node", __func__));
83 KASSERT(ni != NULL, ("null node"));
78 ni->ni_inact = 0;
79
84 ni->ni_inact = 0;
85
86 /*
87 * Yech, hack alert! We want to pass the node down to the
88 * driver's start routine. If we don't do so then the start
89 * routine must immediately look it up again and that can
90 * cause a lock order reversal if, for example, this frame
91 * is being sent because the station is being timedout and
92 * the frame being sent is a DEAUTH message. We could stick
93 * this in an m_tag and tack that on to the mbuf. However
94 * that's rather expensive to do for every frame so instead
95 * we stuff it in the rcvif field since outbound frames do
96 * not (presently) use this.
97 */
80 M_PREPEND(m, sizeof(struct ieee80211_frame), M_DONTWAIT);
81 if (m == NULL)
82 return ENOMEM;
98 M_PREPEND(m, sizeof(struct ieee80211_frame), M_DONTWAIT);
99 if (m == NULL)
100 return ENOMEM;
101 KASSERT(m->m_pkthdr.rcvif == NULL, ("rcvif not null"));
102 m->m_pkthdr.rcvif = (void *)ni;
103
83 wh = mtod(m, struct ieee80211_frame *);
84 wh->i_fc[0] = IEEE80211_FC0_VERSION_0 | IEEE80211_FC0_TYPE_MGT | type;
85 wh->i_fc[1] = IEEE80211_FC1_DIR_NODS;
86 *(u_int16_t *)wh->i_dur = 0;
87 *(u_int16_t *)wh->i_seq =
88 htole16(ni->ni_txseq << IEEE80211_SEQ_SEQ_SHIFT);
89 ni->ni_txseq++;
90 IEEE80211_ADDR_COPY(wh->i_addr1, ni->ni_macaddr);

--- 10 unchanged lines hidden (view full) ---

101 IEEE80211_FC0_SUBTYPE_PROBE_RESP)
102 if_printf(ifp, "sending %s to %s on channel %u\n",
103 ieee80211_mgt_subtype_name[
104 (type & IEEE80211_FC0_SUBTYPE_MASK)
105 >> IEEE80211_FC0_SUBTYPE_SHIFT],
106 ether_sprintf(ni->ni_macaddr),
107 ieee80211_chan2ieee(ic, ni->ni_chan));
108 }
104 wh = mtod(m, struct ieee80211_frame *);
105 wh->i_fc[0] = IEEE80211_FC0_VERSION_0 | IEEE80211_FC0_TYPE_MGT | type;
106 wh->i_fc[1] = IEEE80211_FC1_DIR_NODS;
107 *(u_int16_t *)wh->i_dur = 0;
108 *(u_int16_t *)wh->i_seq =
109 htole16(ni->ni_txseq << IEEE80211_SEQ_SEQ_SHIFT);
110 ni->ni_txseq++;
111 IEEE80211_ADDR_COPY(wh->i_addr1, ni->ni_macaddr);

--- 10 unchanged lines hidden (view full) ---

122 IEEE80211_FC0_SUBTYPE_PROBE_RESP)
123 if_printf(ifp, "sending %s to %s on channel %u\n",
124 ieee80211_mgt_subtype_name[
125 (type & IEEE80211_FC0_SUBTYPE_MASK)
126 >> IEEE80211_FC0_SUBTYPE_SHIFT],
127 ether_sprintf(ni->ni_macaddr),
128 ieee80211_chan2ieee(ic, ni->ni_chan));
129 }
130
109 IF_ENQUEUE(&ic->ic_mgtq, m);
110 ifp->if_timer = 1;
111 (*ifp->if_start)(ifp);
112 return 0;
113}
114
131 IF_ENQUEUE(&ic->ic_mgtq, m);
132 ifp->if_timer = 1;
133 (*ifp->if_start)(ifp);
134 return 0;
135}
136
137/*
138 * Encapsulate an outbound data frame. The mbuf chain is updated and
139 * a reference to the destination node is returned. If an error is
140 * encountered NULL is returned and the node reference will also be NULL.
141 *
142 * NB: The caller is responsible for free'ing a returned node reference.
143 * The convention is ic_bss is not reference counted; the caller must
144 * maintain that.
145 */
115struct mbuf *
146struct mbuf *
116ieee80211_encap(struct ifnet *ifp, struct mbuf *m)
147ieee80211_encap(struct ifnet *ifp, struct mbuf *m, struct ieee80211_node **pni)
117{
118 struct ieee80211com *ic = (void *)ifp;
119 struct ether_header eh;
120 struct ieee80211_frame *wh;
148{
149 struct ieee80211com *ic = (void *)ifp;
150 struct ether_header eh;
151 struct ieee80211_frame *wh;
152 struct ieee80211_node *ni = NULL;
121 struct llc *llc;
153 struct llc *llc;
122 struct ieee80211_node *ni;
123
124 if (m->m_len < sizeof(struct ether_header)) {
125 m = m_pullup(m, sizeof(struct ether_header));
154
155 if (m->m_len < sizeof(struct ether_header)) {
156 m = m_pullup(m, sizeof(struct ether_header));
126 if (m == NULL)
127 return NULL;
157 if (m == NULL) {
158 /* XXX statistic */
159 goto bad;
160 }
128 }
129 memcpy(&eh, mtod(m, caddr_t), sizeof(struct ether_header));
130
161 }
162 memcpy(&eh, mtod(m, caddr_t), sizeof(struct ether_header));
163
131 ni = ieee80211_find_node(ic, eh.ether_dhost);
132 if (ni == NULL) /*ic_opmode?? XXX*/
133 ni = ieee80211_ref_node(ic->ic_bss);
164 if (ic->ic_opmode != IEEE80211_M_STA) {
165 ni = ieee80211_find_node(ic, eh.ether_dhost);
166 if (ni == NULL) {
167 /*
168 * When not in station mode the
169 * destination address should always be
170 * in the node table unless this is a
171 * multicast/broadcast frame.
172 */
173 if (!IEEE80211_IS_MULTICAST(eh.ether_dhost)) {
174 /* ic->ic_stats.st_tx_nonode++; XXX statistic */
175 goto bad;
176 }
177 ni = ic->ic_bss;
178 }
179 } else
180 ni = ic->ic_bss;
134 ni->ni_inact = 0;
135
136 m_adj(m, sizeof(struct ether_header) - sizeof(struct llc));
137 llc = mtod(m, struct llc *);
138 llc->llc_dsap = llc->llc_ssap = LLC_SNAP_LSAP;
139 llc->llc_control = LLC_UI;
140 llc->llc_snap.org_code[0] = 0;
141 llc->llc_snap.org_code[1] = 0;
142 llc->llc_snap.org_code[2] = 0;
143 llc->llc_snap.ether_type = eh.ether_type;
144 M_PREPEND(m, sizeof(struct ieee80211_frame), M_DONTWAIT);
181 ni->ni_inact = 0;
182
183 m_adj(m, sizeof(struct ether_header) - sizeof(struct llc));
184 llc = mtod(m, struct llc *);
185 llc->llc_dsap = llc->llc_ssap = LLC_SNAP_LSAP;
186 llc->llc_control = LLC_UI;
187 llc->llc_snap.org_code[0] = 0;
188 llc->llc_snap.org_code[1] = 0;
189 llc->llc_snap.org_code[2] = 0;
190 llc->llc_snap.ether_type = eh.ether_type;
191 M_PREPEND(m, sizeof(struct ieee80211_frame), M_DONTWAIT);
145 if (m == NULL) {
146 ieee80211_unref_node(&ni);
147 return NULL;
148 }
192 if (m == NULL)
193 goto bad;
149 wh = mtod(m, struct ieee80211_frame *);
150 wh->i_fc[0] = IEEE80211_FC0_VERSION_0 | IEEE80211_FC0_TYPE_DATA;
151 *(u_int16_t *)wh->i_dur = 0;
152 *(u_int16_t *)wh->i_seq =
153 htole16(ni->ni_txseq << IEEE80211_SEQ_SEQ_SHIFT);
154 ni->ni_txseq++;
155 switch (ic->ic_opmode) {
156 case IEEE80211_M_STA:

--- 11 unchanged lines hidden (view full) ---

168 break;
169 case IEEE80211_M_HOSTAP:
170 wh->i_fc[1] = IEEE80211_FC1_DIR_FROMDS;
171 IEEE80211_ADDR_COPY(wh->i_addr1, eh.ether_dhost);
172 IEEE80211_ADDR_COPY(wh->i_addr2, ni->ni_bssid);
173 IEEE80211_ADDR_COPY(wh->i_addr3, eh.ether_shost);
174 break;
175 case IEEE80211_M_MONITOR:
194 wh = mtod(m, struct ieee80211_frame *);
195 wh->i_fc[0] = IEEE80211_FC0_VERSION_0 | IEEE80211_FC0_TYPE_DATA;
196 *(u_int16_t *)wh->i_dur = 0;
197 *(u_int16_t *)wh->i_seq =
198 htole16(ni->ni_txseq << IEEE80211_SEQ_SEQ_SHIFT);
199 ni->ni_txseq++;
200 switch (ic->ic_opmode) {
201 case IEEE80211_M_STA:

--- 11 unchanged lines hidden (view full) ---

213 break;
214 case IEEE80211_M_HOSTAP:
215 wh->i_fc[1] = IEEE80211_FC1_DIR_FROMDS;
216 IEEE80211_ADDR_COPY(wh->i_addr1, eh.ether_dhost);
217 IEEE80211_ADDR_COPY(wh->i_addr2, ni->ni_bssid);
218 IEEE80211_ADDR_COPY(wh->i_addr3, eh.ether_shost);
219 break;
220 case IEEE80211_M_MONITOR:
176 m_freem(m), m = NULL;
177 break;
221 goto bad;
178 }
222 }
179 ieee80211_unref_node(&ni);
223 *pni = ni;
180 return m;
224 return m;
225bad:
226 if (m != NULL)
227 m_freem(m);
228 if (ni && ni != ic->ic_bss)
229 ieee80211_free_node(ic, ni);
230 *pni = NULL;
231 return NULL;
181}
182
183/*
184 * Add a supported rates element id to a frame.
185 */
186u_int8_t *
187ieee80211_add_rates(u_int8_t *frm, const struct ieee80211_rateset *rs)
188{

--- 46 unchanged lines hidden (view full) ---

235
236 if (pktlen > MHLEN)
237 MGETHDR(m, flags, type);
238 else
239 m = m_getcl(flags, type, M_PKTHDR);
240 return m;
241}
242
232}
233
234/*
235 * Add a supported rates element id to a frame.
236 */
237u_int8_t *
238ieee80211_add_rates(u_int8_t *frm, const struct ieee80211_rateset *rs)
239{

--- 46 unchanged lines hidden (view full) ---

286
287 if (pktlen > MHLEN)
288 MGETHDR(m, flags, type);
289 else
290 m = m_getcl(flags, type, M_PKTHDR);
291 return m;
292}
293
294/*
295 * Send a management frame. The node is for the destination (or ic_bss
296 * when in station mode). Nodes other than ic_bss have their reference
297 * count bumped to reflect our use for an indeterminant time.
298 */
243int
244ieee80211_send_mgmt(struct ieee80211com *ic, struct ieee80211_node *ni,
245 int type, int arg)
246{
299int
300ieee80211_send_mgmt(struct ieee80211com *ic, struct ieee80211_node *ni,
301 int type, int arg)
302{
303#define senderr(_x) do { ret = _x; goto bad; } while (0)
247 struct ifnet *ifp = &ic->ic_if;
248 struct mbuf *m;
249 u_int8_t *frm;
250 enum ieee80211_phymode mode;
251 u_int16_t capinfo;
252 int ret, timer;
253
304 struct ifnet *ifp = &ic->ic_if;
305 struct mbuf *m;
306 u_int8_t *frm;
307 enum ieee80211_phymode mode;
308 u_int16_t capinfo;
309 int ret, timer;
310
311 KASSERT(ni != NULL, ("null node"));
312
313 /*
314 * Hold a reference on the node so it doesn't go away until after
315 * the xmit is complete all the way in the driver. On error we
316 * will remove our reference.
317 */
318 if (ni != ic->ic_bss)
319 ieee80211_ref_node(ni);
254 timer = 0;
255 switch (type) {
256 case IEEE80211_FC0_SUBTYPE_PROBE_REQ:
257 /*
258 * prreq frame format
259 * [tlv] ssid
260 * [tlv] supported rates
261 * [tlv] extended supported rates
262 */
263 m = ieee80211_getmbuf(M_DONTWAIT, MT_DATA,
264 2 + ic->ic_des_esslen
265 + 2 + IEEE80211_RATE_SIZE
266 + 2 + (IEEE80211_RATE_MAXSIZE - IEEE80211_RATE_SIZE));
267 if (m == NULL)
320 timer = 0;
321 switch (type) {
322 case IEEE80211_FC0_SUBTYPE_PROBE_REQ:
323 /*
324 * prreq frame format
325 * [tlv] ssid
326 * [tlv] supported rates
327 * [tlv] extended supported rates
328 */
329 m = ieee80211_getmbuf(M_DONTWAIT, MT_DATA,
330 2 + ic->ic_des_esslen
331 + 2 + IEEE80211_RATE_SIZE
332 + 2 + (IEEE80211_RATE_MAXSIZE - IEEE80211_RATE_SIZE));
333 if (m == NULL)
268 return ENOMEM;
334 senderr(ENOMEM);
269 m->m_data += sizeof(struct ieee80211_frame);
270 frm = mtod(m, u_int8_t *);
271 frm = ieee80211_add_ssid(frm, ic->ic_des_essid, ic->ic_des_esslen);
272 mode = ieee80211_chan2mode(ic, ni->ni_chan);
273 frm = ieee80211_add_rates(frm, &ic->ic_sup_rates[mode]);
274 frm = ieee80211_add_xrates(frm, &ic->ic_sup_rates[mode]);
275 m->m_pkthdr.len = m->m_len = frm - mtod(m, u_int8_t *);
276

--- 13 unchanged lines hidden (view full) ---

290 */
291 m = ieee80211_getmbuf(M_DONTWAIT, MT_DATA,
292 8 + 2 + 2 + 2
293 + 2 + ni->ni_esslen
294 + 2 + IEEE80211_RATE_SIZE
295 + 6
296 + 2 + (IEEE80211_RATE_MAXSIZE - IEEE80211_RATE_SIZE));
297 if (m == NULL)
335 m->m_data += sizeof(struct ieee80211_frame);
336 frm = mtod(m, u_int8_t *);
337 frm = ieee80211_add_ssid(frm, ic->ic_des_essid, ic->ic_des_esslen);
338 mode = ieee80211_chan2mode(ic, ni->ni_chan);
339 frm = ieee80211_add_rates(frm, &ic->ic_sup_rates[mode]);
340 frm = ieee80211_add_xrates(frm, &ic->ic_sup_rates[mode]);
341 m->m_pkthdr.len = m->m_len = frm - mtod(m, u_int8_t *);
342

--- 13 unchanged lines hidden (view full) ---

356 */
357 m = ieee80211_getmbuf(M_DONTWAIT, MT_DATA,
358 8 + 2 + 2 + 2
359 + 2 + ni->ni_esslen
360 + 2 + IEEE80211_RATE_SIZE
361 + 6
362 + 2 + (IEEE80211_RATE_MAXSIZE - IEEE80211_RATE_SIZE));
363 if (m == NULL)
298 return ENOMEM;
364 senderr(ENOMEM);
299 m->m_data += sizeof(struct ieee80211_frame);
300 frm = mtod(m, u_int8_t *);
301
302 memset(frm, 0, 8); /* timestamp should be filled later */
303 frm += 8;
304 *(u_int16_t *)frm = htole16(ic->ic_bss->ni_intval);
305 frm += 2;
306 if (ic->ic_opmode == IEEE80211_M_IBSS)

--- 24 unchanged lines hidden (view full) ---

331 }
332 frm = ieee80211_add_xrates(frm, &ic->ic_bss->ni_rates);
333 m->m_pkthdr.len = m->m_len = frm - mtod(m, u_int8_t *);
334 break;
335
336 case IEEE80211_FC0_SUBTYPE_AUTH:
337 MGETHDR(m, M_DONTWAIT, MT_DATA);
338 if (m == NULL)
365 m->m_data += sizeof(struct ieee80211_frame);
366 frm = mtod(m, u_int8_t *);
367
368 memset(frm, 0, 8); /* timestamp should be filled later */
369 frm += 8;
370 *(u_int16_t *)frm = htole16(ic->ic_bss->ni_intval);
371 frm += 2;
372 if (ic->ic_opmode == IEEE80211_M_IBSS)

--- 24 unchanged lines hidden (view full) ---

397 }
398 frm = ieee80211_add_xrates(frm, &ic->ic_bss->ni_rates);
399 m->m_pkthdr.len = m->m_len = frm - mtod(m, u_int8_t *);
400 break;
401
402 case IEEE80211_FC0_SUBTYPE_AUTH:
403 MGETHDR(m, M_DONTWAIT, MT_DATA);
404 if (m == NULL)
339 return ENOMEM;
405 senderr(ENOMEM);
340 MH_ALIGN(m, 2 * 3);
341 m->m_pkthdr.len = m->m_len = 6;
342 frm = mtod(m, u_int8_t *);
343 /* TODO: shared key auth */
344 ((u_int16_t *)frm)[0] = htole16(IEEE80211_AUTH_ALG_OPEN);
345 ((u_int16_t *)frm)[1] = htole16(arg); /* sequence number */
346 ((u_int16_t *)frm)[2] = 0; /* status */
347 if (ic->ic_opmode == IEEE80211_M_STA)
348 timer = IEEE80211_TRANS_WAIT;
349 break;
350
351 case IEEE80211_FC0_SUBTYPE_DEAUTH:
352 if (ifp->if_flags & IFF_DEBUG)
353 if_printf(ifp, "station %s deauthenticate (reason %d)\n",
354 ether_sprintf(ni->ni_macaddr), arg);
355 MGETHDR(m, M_DONTWAIT, MT_DATA);
356 if (m == NULL)
406 MH_ALIGN(m, 2 * 3);
407 m->m_pkthdr.len = m->m_len = 6;
408 frm = mtod(m, u_int8_t *);
409 /* TODO: shared key auth */
410 ((u_int16_t *)frm)[0] = htole16(IEEE80211_AUTH_ALG_OPEN);
411 ((u_int16_t *)frm)[1] = htole16(arg); /* sequence number */
412 ((u_int16_t *)frm)[2] = 0; /* status */
413 if (ic->ic_opmode == IEEE80211_M_STA)
414 timer = IEEE80211_TRANS_WAIT;
415 break;
416
417 case IEEE80211_FC0_SUBTYPE_DEAUTH:
418 if (ifp->if_flags & IFF_DEBUG)
419 if_printf(ifp, "station %s deauthenticate (reason %d)\n",
420 ether_sprintf(ni->ni_macaddr), arg);
421 MGETHDR(m, M_DONTWAIT, MT_DATA);
422 if (m == NULL)
357 return ENOMEM;
423 senderr(ENOMEM);
358 MH_ALIGN(m, 2);
359 m->m_pkthdr.len = m->m_len = 2;
360 *mtod(m, u_int16_t *) = htole16(arg); /* reason */
361 break;
362
363 case IEEE80211_FC0_SUBTYPE_ASSOC_REQ:
364 case IEEE80211_FC0_SUBTYPE_REASSOC_REQ:
365 /*

--- 8 unchanged lines hidden (view full) ---

374 m = ieee80211_getmbuf(M_DONTWAIT, MT_DATA,
375 sizeof(capinfo)
376 + sizeof(u_int16_t)
377 + IEEE80211_ADDR_LEN
378 + 2 + ni->ni_esslen
379 + 2 + IEEE80211_RATE_SIZE
380 + 2 + (IEEE80211_RATE_MAXSIZE - IEEE80211_RATE_SIZE));
381 if (m == NULL)
424 MH_ALIGN(m, 2);
425 m->m_pkthdr.len = m->m_len = 2;
426 *mtod(m, u_int16_t *) = htole16(arg); /* reason */
427 break;
428
429 case IEEE80211_FC0_SUBTYPE_ASSOC_REQ:
430 case IEEE80211_FC0_SUBTYPE_REASSOC_REQ:
431 /*

--- 8 unchanged lines hidden (view full) ---

440 m = ieee80211_getmbuf(M_DONTWAIT, MT_DATA,
441 sizeof(capinfo)
442 + sizeof(u_int16_t)
443 + IEEE80211_ADDR_LEN
444 + 2 + ni->ni_esslen
445 + 2 + IEEE80211_RATE_SIZE
446 + 2 + (IEEE80211_RATE_MAXSIZE - IEEE80211_RATE_SIZE));
447 if (m == NULL)
382 return ENOMEM;
448 senderr(ENOMEM);
383 m->m_data += sizeof(struct ieee80211_frame);
384 frm = mtod(m, u_int8_t *);
385
386 capinfo = 0;
387 if (ic->ic_opmode == IEEE80211_M_IBSS)
388 capinfo |= IEEE80211_CAPINFO_IBSS;
389 else /* IEEE80211_M_STA */
390 capinfo |= IEEE80211_CAPINFO_ESS;

--- 34 unchanged lines hidden (view full) ---

425 */
426 m = ieee80211_getmbuf(M_DONTWAIT, MT_DATA,
427 sizeof(capinfo)
428 + sizeof(u_int16_t)
429 + sizeof(u_int16_t)
430 + 2 + IEEE80211_RATE_SIZE
431 + 2 + (IEEE80211_RATE_MAXSIZE - IEEE80211_RATE_SIZE));
432 if (m == NULL)
449 m->m_data += sizeof(struct ieee80211_frame);
450 frm = mtod(m, u_int8_t *);
451
452 capinfo = 0;
453 if (ic->ic_opmode == IEEE80211_M_IBSS)
454 capinfo |= IEEE80211_CAPINFO_IBSS;
455 else /* IEEE80211_M_STA */
456 capinfo |= IEEE80211_CAPINFO_ESS;

--- 34 unchanged lines hidden (view full) ---

491 */
492 m = ieee80211_getmbuf(M_DONTWAIT, MT_DATA,
493 sizeof(capinfo)
494 + sizeof(u_int16_t)
495 + sizeof(u_int16_t)
496 + 2 + IEEE80211_RATE_SIZE
497 + 2 + (IEEE80211_RATE_MAXSIZE - IEEE80211_RATE_SIZE));
498 if (m == NULL)
433 return ENOMEM;
499 senderr(ENOMEM);
434 m->m_data += sizeof(struct ieee80211_frame);
435 frm = mtod(m, u_int8_t *);
436
437 capinfo = IEEE80211_CAPINFO_ESS;
438 if (ic->ic_flags & IEEE80211_F_WEPON)
439 capinfo |= IEEE80211_CAPINFO_PRIVACY;
440 *(u_int16_t *)frm = htole16(capinfo);
441 frm += 2;
442
443 *(u_int16_t *)frm = htole16(arg); /* status */
444 frm += 2;
445
500 m->m_data += sizeof(struct ieee80211_frame);
501 frm = mtod(m, u_int8_t *);
502
503 capinfo = IEEE80211_CAPINFO_ESS;
504 if (ic->ic_flags & IEEE80211_F_WEPON)
505 capinfo |= IEEE80211_CAPINFO_PRIVACY;
506 *(u_int16_t *)frm = htole16(capinfo);
507 frm += 2;
508
509 *(u_int16_t *)frm = htole16(arg); /* status */
510 frm += 2;
511
446 if (arg == IEEE80211_STATUS_SUCCESS && ni != NULL)
512 if (arg == IEEE80211_STATUS_SUCCESS)
447 *(u_int16_t *)frm = htole16(ni->ni_associd);
513 *(u_int16_t *)frm = htole16(ni->ni_associd);
448 else
449 *(u_int16_t *)frm = htole16(0);
450 frm += 2;
451
514 frm += 2;
515
452 if (ni != NULL) {
453 frm = ieee80211_add_rates(frm, &ni->ni_rates);
454 frm = ieee80211_add_xrates(frm, &ni->ni_rates);
455 } else {
456 frm = ieee80211_add_rates(frm, &ic->ic_bss->ni_rates);
457 frm = ieee80211_add_xrates(frm, &ic->ic_bss->ni_rates);
458 }
516 frm = ieee80211_add_rates(frm, &ni->ni_rates);
517 frm = ieee80211_add_xrates(frm, &ni->ni_rates);
459 m->m_pkthdr.len = m->m_len = frm - mtod(m, u_int8_t *);
460 break;
461
462 case IEEE80211_FC0_SUBTYPE_DISASSOC:
463 if (ifp->if_flags & IFF_DEBUG)
464 if_printf(ifp, "station %s disassociate (reason %d)\n",
465 ether_sprintf(ni->ni_macaddr), arg);
466 MGETHDR(m, M_DONTWAIT, MT_DATA);
467 if (m == NULL)
518 m->m_pkthdr.len = m->m_len = frm - mtod(m, u_int8_t *);
519 break;
520
521 case IEEE80211_FC0_SUBTYPE_DISASSOC:
522 if (ifp->if_flags & IFF_DEBUG)
523 if_printf(ifp, "station %s disassociate (reason %d)\n",
524 ether_sprintf(ni->ni_macaddr), arg);
525 MGETHDR(m, M_DONTWAIT, MT_DATA);
526 if (m == NULL)
468 return ENOMEM;
527 senderr(ENOMEM);
469 MH_ALIGN(m, 2);
470 m->m_pkthdr.len = m->m_len = 2;
471 *mtod(m, u_int16_t *) = htole16(arg); /* reason */
472 break;
473
474 default:
475 IEEE80211_DPRINTF(("%s: invalid mgmt frame type %u\n",
476 __func__, type));
528 MH_ALIGN(m, 2);
529 m->m_pkthdr.len = m->m_len = 2;
530 *mtod(m, u_int16_t *) = htole16(arg); /* reason */
531 break;
532
533 default:
534 IEEE80211_DPRINTF(("%s: invalid mgmt frame type %u\n",
535 __func__, type));
477 return EINVAL;
536 senderr(EINVAL);
537 /* NOTREACHED */
478 }
479
480 ret = ieee80211_mgmt_output(ifp, ni, m, type);
538 }
539
540 ret = ieee80211_mgmt_output(ifp, ni, m, type);
481 if (ret == 0 && timer)
482 ic->ic_mgt_timer = timer;
541 if (ret == 0) {
542 if (timer)
543 ic->ic_mgt_timer = timer;
544 } else {
545bad:
546 if (ni != ic->ic_bss) /* remove ref we added */
547 ieee80211_free_node(ic, ni);
548 }
483 return ret;
549 return ret;
550#undef senderr
484}
551}