2 * Some parts based on code from net80211
3 * Copyright (c) 2001 Atsushi Onoe
4 * Copyright (c) 2002-2005 Sam Leffler, Errno Consulting
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
10 * 1. Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 * 2. Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in the
14 * documentation and/or other materials provided with the distribution.
15 * 3. The name of the author may not be used to endorse or promote products
16 * derived from this software without specific prior written permission.
18 * Alternatively, this software may be distributed under the terms of the
19 * GNU General Public License ("GPL") version 2 as published by the Free
20 * Software Foundation.
22 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
23 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
24 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
25 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
26 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
27 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
28 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
29 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
30 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
31 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
35 #include "ieee80211softmac_priv.h"
37 /* Helper functions for inserting data into the frames */
40 * Adds an ESSID element to the frame
44 ieee80211softmac_add_essid(u8
*dst
, struct ieee80211softmac_essid
*essid
)
47 *dst
++ = MFIE_TYPE_SSID
;
49 memcpy(dst
, essid
->data
, essid
->len
);
50 return dst
+essid
->len
;
52 *dst
++ = MFIE_TYPE_SSID
;
58 /* Adds Supported Rates and if required Extended Rates Information Element
59 * to the frame, ASSUMES WE HAVE A SORTED LIST OF RATES */
61 ieee80211softmac_frame_add_rates(u8
*dst
, const struct ieee80211softmac_ratesinfo
*r
)
63 int cck_len
, ofdm_len
;
64 *dst
++ = MFIE_TYPE_RATES
;
66 for(cck_len
=0; ieee80211_is_cck_rate(r
->rates
[cck_len
]) && (cck_len
< r
->count
);cck_len
++);
68 if(cck_len
> IEEE80211SOFTMAC_MAX_RATES_LEN
)
69 cck_len
= IEEE80211SOFTMAC_MAX_RATES_LEN
;
71 memcpy(dst
, r
->rates
, cck_len
);
74 if(cck_len
< r
->count
){
75 for (ofdm_len
=0; ieee80211_is_ofdm_rate(r
->rates
[ofdm_len
+ cck_len
]) && (ofdm_len
+ cck_len
< r
->count
); ofdm_len
++);
77 if (ofdm_len
> IEEE80211SOFTMAC_MAX_EX_RATES_LEN
)
78 ofdm_len
= IEEE80211SOFTMAC_MAX_EX_RATES_LEN
;
79 *dst
++ = MFIE_TYPE_RATES_EX
;
81 memcpy(dst
, r
->rates
+ cck_len
, ofdm_len
);
88 /* Allocate a management frame */
90 ieee80211softmac_alloc_mgt(u32 size
)
94 /* Add the header and FCS to the size */
95 size
= size
+ IEEE80211_3ADDR_LEN
;
96 if(size
> IEEE80211_DATA_LEN
)
98 /* Allocate the frame */
99 data
= kmalloc(size
, GFP_ATOMIC
);
100 memset(data
, 0, size
);
105 * Add a 2 Address Header
108 ieee80211softmac_hdr_2addr(struct ieee80211softmac_device
*mac
,
109 struct ieee80211_hdr_2addr
*header
, u32 type
, u8
*dest
)
111 /* Fill in the frame control flags */
112 header
->frame_ctl
= cpu_to_le16(type
);
113 /* Control packets always have WEP turned off */
114 if(type
> IEEE80211_STYPE_CFENDACK
&& type
< IEEE80211_STYPE_PSPOLL
)
115 header
->frame_ctl
|= mac
->ieee
->sec
.level
? cpu_to_le16(IEEE80211_FCTL_PROTECTED
) : 0;
117 /* Fill in the duration */
118 header
->duration_id
= 0;
119 /* FIXME: How do I find this?
120 * calculate. But most drivers just fill in 0 (except if it's a station id of course) */
122 /* Fill in the Destination Address */
124 memset(header
->addr1
, 0xFF, ETH_ALEN
);
126 memcpy(header
->addr1
, dest
, ETH_ALEN
);
127 /* Fill in the Source Address */
128 memcpy(header
->addr2
, mac
->ieee
->dev
->dev_addr
, ETH_ALEN
);
133 /* Add a 3 Address Header */
135 ieee80211softmac_hdr_3addr(struct ieee80211softmac_device
*mac
,
136 struct ieee80211_hdr_3addr
*header
, u32 type
, u8
*dest
, u8
*bssid
)
138 /* This is common with 2addr, so use that instead */
139 ieee80211softmac_hdr_2addr(mac
, (struct ieee80211_hdr_2addr
*)header
, type
, dest
);
141 /* Fill in the BSS ID */
143 memset(header
->addr3
, 0xFF, ETH_ALEN
);
145 memcpy(header
->addr3
, bssid
, ETH_ALEN
);
147 /* Fill in the sequence # */
148 /* FIXME: I need to add this to the softmac struct
149 * shouldn't the sequence number be in ieee80211? */
153 /*****************************************************************************
154 * Create Management packets
155 *****************************************************************************/
157 /* Creates an association request packet */
159 ieee80211softmac_assoc_req(struct ieee80211_assoc_request
**pkt
,
160 struct ieee80211softmac_device
*mac
, struct ieee80211softmac_network
*net
)
163 (*pkt
) = (struct ieee80211_assoc_request
*)ieee80211softmac_alloc_mgt(
164 2 + /* Capability Info */
165 2 + /* Listen Interval */
167 1 + 1 + IW_ESSID_MAX_SIZE
+
169 1 + 1 + IEEE80211SOFTMAC_MAX_RATES_LEN
+
170 /* Extended Rates IE */
171 1 + 1 + IEEE80211SOFTMAC_MAX_EX_RATES_LEN
+
172 /* WPA IE if present */
174 /* Other IE's? Optional?
175 * Yeah, probably need an extra IE parameter -- lots of vendors like to
176 * fill in their own IEs */
178 if (unlikely((*pkt
) == NULL
))
180 ieee80211softmac_hdr_3addr(mac
, &((*pkt
)->header
), IEEE80211_STYPE_ASSOC_REQ
, net
->bssid
, net
->bssid
);
182 /* Fill in capability Info */
183 switch (mac
->ieee
->iw_mode
) {
185 (*pkt
)->capability
= cpu_to_le16(WLAN_CAPABILITY_ESS
);
188 (*pkt
)->capability
= cpu_to_le16(WLAN_CAPABILITY_IBSS
);
191 (*pkt
)->capability
= net
->capabilities
& (WLAN_CAPABILITY_ESS
|WLAN_CAPABILITY_IBSS
);
194 /* bleh. we don't ever go to these modes */
195 printk(KERN_ERR PFX
"invalid iw_mode!\n");
199 (*pkt)->capability |= mac->ieee->short_slot ?
200 cpu_to_le16(WLAN_CAPABILITY_SHORT_SLOT_TIME) : 0;
202 (*pkt
)->capability
|= mac
->ieee
->sec
.level
? cpu_to_le16(WLAN_CAPABILITY_PRIVACY
) : 0;
203 /* Fill in Listen Interval (?) */
204 (*pkt
)->listen_interval
= cpu_to_le16(10);
206 data
= (u8
*)(*pkt
)->info_element
;
208 data
= ieee80211softmac_add_essid(data
, &net
->essid
);
210 data
= ieee80211softmac_frame_add_rates(data
, &mac
->ratesinfo
);
212 if (mac
->wpa
.IElen
&& mac
->wpa
.IE
) {
213 memcpy(data
, mac
->wpa
.IE
, mac
->wpa
.IElen
);
214 data
+= mac
->wpa
.IElen
;
216 /* Return the number of used bytes */
217 return (data
- (u8
*)(*pkt
));
220 /* Create a reassociation request packet */
222 ieee80211softmac_reassoc_req(struct ieee80211_reassoc_request
**pkt
,
223 struct ieee80211softmac_device
*mac
, struct ieee80211softmac_network
*net
)
226 (*pkt
) = (struct ieee80211_reassoc_request
*)ieee80211softmac_alloc_mgt(
227 2 + /* Capability Info */
228 2 + /* Listen Interval */
229 ETH_ALEN
+ /* AP MAC */
231 1 + 1 + IW_ESSID_MAX_SIZE
+
233 1 + 1 + IEEE80211SOFTMAC_MAX_RATES_LEN
+
234 /* Extended Rates IE */
235 1 + 1 + IEEE80211SOFTMAC_MAX_EX_RATES_LEN
238 if (unlikely((*pkt
) == NULL
))
240 ieee80211softmac_hdr_3addr(mac
, &((*pkt
)->header
), IEEE80211_STYPE_REASSOC_REQ
, net
->bssid
, net
->bssid
);
242 /* Fill in capability Info */
243 (*pkt
)->capability
= mac
->ieee
->iw_mode
== IW_MODE_MASTER
?
244 cpu_to_le16(WLAN_CAPABILITY_ESS
) :
245 cpu_to_le16(WLAN_CAPABILITY_IBSS
);
247 (*pkt)->capability |= mac->ieee->short_slot ?
248 cpu_to_le16(WLAN_CAPABILITY_SHORT_SLOT_TIME) : 0;
250 (*pkt
)->capability
|= mac
->ieee
->sec
.level
?
251 cpu_to_le16(WLAN_CAPABILITY_PRIVACY
) : 0;
253 /* Fill in Listen Interval (?) */
254 (*pkt
)->listen_interval
= cpu_to_le16(10);
255 /* Fill in the current AP MAC */
256 memcpy((*pkt
)->current_ap
, mac
->ieee
->bssid
, ETH_ALEN
);
258 data
= (u8
*)(*pkt
)->info_element
;
260 data
= ieee80211softmac_add_essid(data
, &net
->essid
);
262 data
= ieee80211softmac_frame_add_rates(data
, &mac
->ratesinfo
);
263 /* Return packet size */
264 return (data
- (u8
*)(*pkt
));
267 /* Create an authentication packet */
269 ieee80211softmac_auth(struct ieee80211_auth
**pkt
,
270 struct ieee80211softmac_device
*mac
, struct ieee80211softmac_network
*net
,
271 u16 transaction
, u16 status
)
274 /* Allocate Packet */
275 (*pkt
) = (struct ieee80211_auth
*)ieee80211softmac_alloc_mgt(
276 2 + /* Auth Algorithm */
277 2 + /* Auth Transaction Seq */
278 2 + /* Status Code */
279 /* Challenge Text IE */
280 mac
->ieee
->open_wep
? 0 :
281 1 + 1 + WLAN_AUTH_CHALLENGE_LEN
283 if (unlikely((*pkt
) == NULL
))
285 ieee80211softmac_hdr_3addr(mac
, &((*pkt
)->header
), IEEE80211_STYPE_AUTH
, net
->bssid
, net
->bssid
);
288 (*pkt
)->algorithm
= mac
->ieee
->open_wep
?
289 cpu_to_le16(WLAN_AUTH_OPEN
) :
290 cpu_to_le16(WLAN_AUTH_SHARED_KEY
);
292 (*pkt
)->transaction
= cpu_to_le16(transaction
);
294 (*pkt
)->status
= cpu_to_le16(status
);
296 data
= (u8
*)(*pkt
)->info_element
;
298 if(!mac
->ieee
->open_wep
){
299 *data
= MFIE_TYPE_CHALLENGE
;
302 /* Copy the challenge in */
303 // *data = challenge length
304 // data += sizeof(u16);
305 // memcpy(data, challenge, challenge length);
306 // data += challenge length;
308 /* Add the full size to the packet length */
311 /* Return the packet size */
312 return (data
- (u8
*)(*pkt
));
315 /* Create a disassocation or deauthentication packet */
317 ieee80211softmac_disassoc_deauth(struct ieee80211_disassoc
**pkt
,
318 struct ieee80211softmac_device
*mac
, struct ieee80211softmac_network
*net
,
319 u16 type
, u16 reason
)
321 /* Allocate Packet */
322 (*pkt
) = (struct ieee80211_disassoc
*)ieee80211softmac_alloc_mgt(2);
323 if (unlikely((*pkt
) == NULL
))
325 ieee80211softmac_hdr_3addr(mac
, &((*pkt
)->header
), type
, net
->bssid
, net
->bssid
);
327 (*pkt
)->reason
= cpu_to_le16(reason
);
328 /* Return the packet size */
329 return (2 + IEEE80211_3ADDR_LEN
);
332 /* Create a probe request packet */
334 ieee80211softmac_probe_req(struct ieee80211_probe_request
**pkt
,
335 struct ieee80211softmac_device
*mac
, struct ieee80211softmac_essid
*essid
)
338 /* Allocate Packet */
339 (*pkt
) = (struct ieee80211_probe_request
*)ieee80211softmac_alloc_mgt(
340 /* SSID of requested network */
341 1 + 1 + IW_ESSID_MAX_SIZE
+
343 1 + 1 + IEEE80211SOFTMAC_MAX_RATES_LEN
+
344 /* Extended Rates IE */
345 1 + 1 + IEEE80211SOFTMAC_MAX_EX_RATES_LEN
347 if (unlikely((*pkt
) == NULL
))
349 ieee80211softmac_hdr_3addr(mac
, &((*pkt
)->header
), IEEE80211_STYPE_PROBE_REQ
, NULL
, NULL
);
351 data
= (u8
*)(*pkt
)->info_element
;
352 /* Add ESSID (can be NULL) */
353 data
= ieee80211softmac_add_essid(data
, essid
);
355 data
= ieee80211softmac_frame_add_rates(data
, &mac
->ratesinfo
);
356 /* Return packet size */
357 return (data
- (u8
*)(*pkt
));
360 /* Create a probe response packet */
361 /* FIXME: Not complete */
363 ieee80211softmac_probe_resp(struct ieee80211_probe_response
**pkt
,
364 struct ieee80211softmac_device
*mac
, struct ieee80211softmac_network
*net
)
367 /* Allocate Packet */
368 (*pkt
) = (struct ieee80211_probe_response
*)ieee80211softmac_alloc_mgt(
370 2 + /* Beacon Interval */
371 2 + /* Capability Info */
373 1 + 1 + IW_ESSID_MAX_SIZE
+
374 7 + /* FH Parameter Set */
375 2 + /* DS Parameter Set */
376 8 + /* CF Parameter Set */
377 4 /* IBSS Parameter Set */
379 if (unlikely((*pkt
) == NULL
))
381 ieee80211softmac_hdr_3addr(mac
, &((*pkt
)->header
), IEEE80211_STYPE_PROBE_RESP
, net
->bssid
, net
->bssid
);
382 data
= (u8
*)(*pkt
)->info_element
;
384 /* Return the packet size */
385 return (data
- (u8
*)(*pkt
));
389 /* Sends a manangement packet
390 * FIXME: document the use of the arg parameter
391 * for _AUTH: (transaction #) | (status << 16)
394 ieee80211softmac_send_mgt_frame(struct ieee80211softmac_device
*mac
,
395 void *ptrarg
, u32 type
, u32 arg
)
401 case IEEE80211_STYPE_ASSOC_REQ
:
402 pkt_size
= ieee80211softmac_assoc_req((struct ieee80211_assoc_request
**)(&pkt
), mac
, (struct ieee80211softmac_network
*)ptrarg
);
404 case IEEE80211_STYPE_REASSOC_REQ
:
405 pkt_size
= ieee80211softmac_reassoc_req((struct ieee80211_reassoc_request
**)(&pkt
), mac
, (struct ieee80211softmac_network
*)ptrarg
);
407 case IEEE80211_STYPE_AUTH
:
408 pkt_size
= ieee80211softmac_auth((struct ieee80211_auth
**)(&pkt
), mac
, (struct ieee80211softmac_network
*)ptrarg
, (u16
)(arg
& 0xFFFF), (u16
) (arg
>> 16));
410 case IEEE80211_STYPE_DISASSOC
:
411 case IEEE80211_STYPE_DEAUTH
:
412 pkt_size
= ieee80211softmac_disassoc_deauth((struct ieee80211_disassoc
**)(&pkt
), mac
, (struct ieee80211softmac_network
*)ptrarg
, type
, (u16
)(arg
& 0xFFFF));
414 case IEEE80211_STYPE_PROBE_REQ
:
415 pkt_size
= ieee80211softmac_probe_req((struct ieee80211_probe_request
**)(&pkt
), mac
, (struct ieee80211softmac_essid
*)ptrarg
);
417 case IEEE80211_STYPE_PROBE_RESP
:
418 pkt_size
= ieee80211softmac_probe_resp((struct ieee80211_probe_response
**)(&pkt
), mac
, (struct ieee80211softmac_network
*)ptrarg
);
421 printkl(KERN_DEBUG PFX
"Unsupported Management Frame type: %i\n", type
);
425 if(pkt_size
== 0 || pkt
== NULL
) {
426 printkl(KERN_DEBUG PFX
"Error, packet is nonexistant or 0 length\n");
430 /* Send the packet to the ieee80211 layer for tx */
431 /* we defined softmac->mgmt_xmit for this. Should we keep it
432 * as it is (that means we'd need to wrap this into a txb),
433 * modify the prototype (so it matches this function),
434 * or get rid of it alltogether?
435 * Does this work for you now?
437 ieee80211_tx_frame(mac
->ieee
, (struct ieee80211_hdr
*)pkt
, pkt_size
);
444 /* Create an rts/cts frame */
446 ieee80211softmac_rts_cts(struct ieee80211_hdr_2addr
**pkt
,
447 struct ieee80211softmac_device
*mac
, struct ieee80211softmac_network
*net
,
450 /* Allocate Packet */
451 (*pkt
) = kmalloc(IEEE80211_2ADDR_LEN
, GFP_ATOMIC
);
452 memset(*pkt
, 0, IEEE80211_2ADDR_LEN
);
455 ieee80211softmac_hdr_2addr(mac
, (*pkt
), type
, net
->bssid
);
456 return IEEE80211_2ADDR_LEN
;
460 /* Sends a control packet */
462 ieee80211softmac_send_ctl_frame(struct ieee80211softmac_device
*mac
,
463 struct ieee80211softmac_network
*net
, u32 type
, u32 arg
)
469 case IEEE80211_STYPE_RTS
:
470 case IEEE80211_STYPE_CTS
:
471 pkt_size
= ieee80211softmac_rts_cts((struct ieee80211_hdr_2addr
**)(&pkt
), mac
, net
, type
);
474 printkl(KERN_DEBUG PFX
"Unsupported Control Frame type: %i\n", type
);
481 /* Send the packet to the ieee80211 layer for tx */
482 ieee80211_tx_frame(mac
->ieee
, (struct ieee80211_hdr
*) pkt
, pkt_size
);