Commit | Line | Data |
---|---|---|
370121e5 JB |
1 | /* |
2 | * Some parts based on code from net80211 | |
3 | * Copyright (c) 2001 Atsushi Onoe | |
4 | * Copyright (c) 2002-2005 Sam Leffler, Errno Consulting | |
5 | * All rights reserved. | |
6 | * | |
7 | * Redistribution and use in source and binary forms, with or without | |
8 | * modification, are permitted provided that the following conditions | |
9 | * are met: | |
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. | |
17 | * | |
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. | |
21 | * | |
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. | |
32 | * | |
33 | */ | |
34 | ||
35 | #include "ieee80211softmac_priv.h" | |
36 | ||
37 | /* Helper functions for inserting data into the frames */ | |
38 | ||
39 | /* | |
40 | * Adds an ESSID element to the frame | |
41 | * | |
42 | */ | |
43 | static u8 * | |
44 | ieee80211softmac_add_essid(u8 *dst, struct ieee80211softmac_essid *essid) | |
45 | { | |
46 | if (essid) { | |
47 | *dst++ = MFIE_TYPE_SSID; | |
48 | *dst++ = essid->len; | |
49 | memcpy(dst, essid->data, essid->len); | |
50 | return dst+essid->len; | |
51 | } else { | |
52 | *dst++ = MFIE_TYPE_SSID; | |
53 | *dst++ = 0; | |
54 | return dst; | |
55 | } | |
56 | } | |
57 | ||
58 | /* Adds Supported Rates and if required Extended Rates Information Element | |
59 | * to the frame, ASSUMES WE HAVE A SORTED LIST OF RATES */ | |
60 | static u8 * | |
61 | ieee80211softmac_frame_add_rates(u8 *dst, const struct ieee80211softmac_ratesinfo *r) | |
62 | { | |
63 | int cck_len, ofdm_len; | |
64 | *dst++ = MFIE_TYPE_RATES; | |
65 | ||
66 | for(cck_len=0; ieee80211_is_cck_rate(r->rates[cck_len]) && (cck_len < r->count);cck_len++); | |
67 | ||
68 | if(cck_len > IEEE80211SOFTMAC_MAX_RATES_LEN) | |
69 | cck_len = IEEE80211SOFTMAC_MAX_RATES_LEN; | |
70 | *dst++ = cck_len; | |
71 | memcpy(dst, r->rates, cck_len); | |
72 | dst += cck_len; | |
73 | ||
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++); | |
76 | if (ofdm_len > 0) { | |
77 | if (ofdm_len > IEEE80211SOFTMAC_MAX_EX_RATES_LEN) | |
78 | ofdm_len = IEEE80211SOFTMAC_MAX_EX_RATES_LEN; | |
79 | *dst++ = MFIE_TYPE_RATES_EX; | |
80 | *dst++ = ofdm_len; | |
81 | memcpy(dst, r->rates + cck_len, ofdm_len); | |
82 | dst += ofdm_len; | |
83 | } | |
84 | } | |
85 | return dst; | |
86 | } | |
87 | ||
88 | /* Allocate a management frame */ | |
89 | static u8 * | |
90 | ieee80211softmac_alloc_mgt(u32 size) | |
91 | { | |
92 | u8 * data; | |
93 | ||
94 | /* Add the header and FCS to the size */ | |
95 | size = size + IEEE80211_3ADDR_LEN; | |
96 | if(size > IEEE80211_DATA_LEN) | |
97 | return NULL; | |
98 | /* Allocate the frame */ | |
99 | data = kmalloc(size, GFP_ATOMIC); | |
100 | memset(data, 0, size); | |
101 | return data; | |
102 | } | |
103 | ||
104 | /* | |
105 | * Add a 2 Address Header | |
106 | */ | |
107 | static void | |
108 | ieee80211softmac_hdr_2addr(struct ieee80211softmac_device *mac, | |
109 | struct ieee80211_hdr_2addr *header, u32 type, u8 *dest) | |
110 | { | |
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; | |
116 | ||
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) */ | |
121 | ||
122 | /* Fill in the Destination Address */ | |
123 | if(dest == NULL) | |
124 | memset(header->addr1, 0xFF, ETH_ALEN); | |
125 | else | |
126 | memcpy(header->addr1, dest, ETH_ALEN); | |
127 | /* Fill in the Source Address */ | |
128 | memcpy(header->addr2, mac->ieee->dev->dev_addr, ETH_ALEN); | |
129 | ||
130 | } | |
131 | ||
132 | ||
133 | /* Add a 3 Address Header */ | |
134 | static void | |
135 | ieee80211softmac_hdr_3addr(struct ieee80211softmac_device *mac, | |
136 | struct ieee80211_hdr_3addr *header, u32 type, u8 *dest, u8 *bssid) | |
137 | { | |
138 | /* This is common with 2addr, so use that instead */ | |
139 | ieee80211softmac_hdr_2addr(mac, (struct ieee80211_hdr_2addr *)header, type, dest); | |
140 | ||
141 | /* Fill in the BSS ID */ | |
142 | if(bssid == NULL) | |
143 | memset(header->addr3, 0xFF, ETH_ALEN); | |
144 | else | |
145 | memcpy(header->addr3, bssid, ETH_ALEN); | |
146 | ||
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? */ | |
150 | } | |
151 | ||
152 | ||
153 | /***************************************************************************** | |
154 | * Create Management packets | |
155 | *****************************************************************************/ | |
156 | ||
157 | /* Creates an association request packet */ | |
714e1a51 | 158 | static u32 |
370121e5 JB |
159 | ieee80211softmac_assoc_req(struct ieee80211_assoc_request **pkt, |
160 | struct ieee80211softmac_device *mac, struct ieee80211softmac_network *net) | |
161 | { | |
162 | u8 *data; | |
163 | (*pkt) = (struct ieee80211_assoc_request *)ieee80211softmac_alloc_mgt( | |
164 | 2 + /* Capability Info */ | |
165 | 2 + /* Listen Interval */ | |
166 | /* SSID IE */ | |
167 | 1 + 1 + IW_ESSID_MAX_SIZE + | |
168 | /* Rates IE */ | |
169 | 1 + 1 + IEEE80211SOFTMAC_MAX_RATES_LEN + | |
170 | /* Extended Rates IE */ | |
171 | 1 + 1 + IEEE80211SOFTMAC_MAX_EX_RATES_LEN + | |
172 | /* WPA IE if present */ | |
173 | mac->wpa.IElen | |
174 | /* Other IE's? Optional? | |
175 | * Yeah, probably need an extra IE parameter -- lots of vendors like to | |
176 | * fill in their own IEs */ | |
177 | ); | |
178 | if (unlikely((*pkt) == NULL)) | |
179 | return 0; | |
180 | ieee80211softmac_hdr_3addr(mac, &((*pkt)->header), IEEE80211_STYPE_ASSOC_REQ, net->bssid, net->bssid); | |
181 | ||
182 | /* Fill in capability Info */ | |
68970ce6 | 183 | switch (mac->ieee->iw_mode) { |
184 | case IW_MODE_INFRA: | |
185 | (*pkt)->capability = cpu_to_le16(WLAN_CAPABILITY_ESS); | |
186 | break; | |
187 | case IW_MODE_ADHOC: | |
188 | (*pkt)->capability = cpu_to_le16(WLAN_CAPABILITY_IBSS); | |
189 | break; | |
190 | case IW_MODE_AUTO: | |
191 | (*pkt)->capability = net->capabilities & (WLAN_CAPABILITY_ESS|WLAN_CAPABILITY_IBSS); | |
192 | break; | |
193 | default: | |
194 | /* bleh. we don't ever go to these modes */ | |
195 | printk(KERN_ERR PFX "invalid iw_mode!\n"); | |
196 | break; | |
197 | } | |
370121e5 JB |
198 | /* Need to add this |
199 | (*pkt)->capability |= mac->ieee->short_slot ? | |
200 | cpu_to_le16(WLAN_CAPABILITY_SHORT_SLOT_TIME) : 0; | |
201 | */ | |
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); | |
205 | ||
206 | data = (u8 *)(*pkt)->info_element; | |
207 | /* Add SSID */ | |
208 | data = ieee80211softmac_add_essid(data, &net->essid); | |
209 | /* Add Rates */ | |
210 | data = ieee80211softmac_frame_add_rates(data, &mac->ratesinfo); | |
211 | /* Add WPA IE */ | |
212 | if (mac->wpa.IElen && mac->wpa.IE) { | |
213 | memcpy(data, mac->wpa.IE, mac->wpa.IElen); | |
214 | data += mac->wpa.IElen; | |
215 | } | |
216 | /* Return the number of used bytes */ | |
217 | return (data - (u8*)(*pkt)); | |
218 | } | |
219 | ||
220 | /* Create a reassociation request packet */ | |
714e1a51 | 221 | static u32 |
370121e5 JB |
222 | ieee80211softmac_reassoc_req(struct ieee80211_reassoc_request **pkt, |
223 | struct ieee80211softmac_device *mac, struct ieee80211softmac_network *net) | |
224 | { | |
225 | u8 *data; | |
226 | (*pkt) = (struct ieee80211_reassoc_request *)ieee80211softmac_alloc_mgt( | |
227 | 2 + /* Capability Info */ | |
228 | 2 + /* Listen Interval */ | |
229 | ETH_ALEN + /* AP MAC */ | |
230 | /* SSID IE */ | |
231 | 1 + 1 + IW_ESSID_MAX_SIZE + | |
232 | /* Rates IE */ | |
233 | 1 + 1 + IEEE80211SOFTMAC_MAX_RATES_LEN + | |
234 | /* Extended Rates IE */ | |
235 | 1 + 1 + IEEE80211SOFTMAC_MAX_EX_RATES_LEN | |
236 | /* Other IE's? */ | |
237 | ); | |
238 | if (unlikely((*pkt) == NULL)) | |
239 | return 0; | |
240 | ieee80211softmac_hdr_3addr(mac, &((*pkt)->header), IEEE80211_STYPE_REASSOC_REQ, net->bssid, net->bssid); | |
241 | ||
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); | |
246 | /* | |
247 | (*pkt)->capability |= mac->ieee->short_slot ? | |
248 | cpu_to_le16(WLAN_CAPABILITY_SHORT_SLOT_TIME) : 0; | |
249 | */ | |
250 | (*pkt)->capability |= mac->ieee->sec.level ? | |
251 | cpu_to_le16(WLAN_CAPABILITY_PRIVACY) : 0; | |
252 | ||
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); | |
257 | ||
258 | data = (u8 *)(*pkt)->info_element; | |
259 | /* Add SSID */ | |
260 | data = ieee80211softmac_add_essid(data, &net->essid); | |
261 | /* Add Rates */ | |
262 | data = ieee80211softmac_frame_add_rates(data, &mac->ratesinfo); | |
263 | /* Return packet size */ | |
264 | return (data - (u8 *)(*pkt)); | |
265 | } | |
266 | ||
267 | /* Create an authentication packet */ | |
714e1a51 | 268 | static u32 |
370121e5 JB |
269 | ieee80211softmac_auth(struct ieee80211_auth **pkt, |
270 | struct ieee80211softmac_device *mac, struct ieee80211softmac_network *net, | |
271 | u16 transaction, u16 status) | |
272 | { | |
273 | u8 *data; | |
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 | |
282 | ); | |
283 | if (unlikely((*pkt) == NULL)) | |
284 | return 0; | |
285 | ieee80211softmac_hdr_3addr(mac, &((*pkt)->header), IEEE80211_STYPE_AUTH, net->bssid, net->bssid); | |
286 | ||
287 | /* Algorithm */ | |
288 | (*pkt)->algorithm = mac->ieee->open_wep ? | |
289 | cpu_to_le16(WLAN_AUTH_OPEN) : | |
290 | cpu_to_le16(WLAN_AUTH_SHARED_KEY); | |
291 | /* Transaction */ | |
292 | (*pkt)->transaction = cpu_to_le16(transaction); | |
293 | /* Status */ | |
294 | (*pkt)->status = cpu_to_le16(status); | |
295 | ||
296 | data = (u8 *)(*pkt)->info_element; | |
297 | /* Challenge Text */ | |
298 | if(!mac->ieee->open_wep){ | |
299 | *data = MFIE_TYPE_CHALLENGE; | |
300 | data++; | |
301 | ||
302 | /* Copy the challenge in */ | |
303 | // *data = challenge length | |
304 | // data += sizeof(u16); | |
305 | // memcpy(data, challenge, challenge length); | |
306 | // data += challenge length; | |
307 | ||
308 | /* Add the full size to the packet length */ | |
309 | } | |
310 | ||
311 | /* Return the packet size */ | |
312 | return (data - (u8 *)(*pkt)); | |
313 | } | |
314 | ||
315 | /* Create a disassocation or deauthentication packet */ | |
714e1a51 | 316 | static u32 |
370121e5 JB |
317 | ieee80211softmac_disassoc_deauth(struct ieee80211_disassoc **pkt, |
318 | struct ieee80211softmac_device *mac, struct ieee80211softmac_network *net, | |
319 | u16 type, u16 reason) | |
320 | { | |
321 | /* Allocate Packet */ | |
322 | (*pkt) = (struct ieee80211_disassoc *)ieee80211softmac_alloc_mgt(2); | |
bba52d5e | 323 | if (unlikely((*pkt) == NULL)) |
370121e5 JB |
324 | return 0; |
325 | ieee80211softmac_hdr_3addr(mac, &((*pkt)->header), type, net->bssid, net->bssid); | |
326 | /* Reason */ | |
327 | (*pkt)->reason = cpu_to_le16(reason); | |
328 | /* Return the packet size */ | |
329 | return (2 + IEEE80211_3ADDR_LEN); | |
330 | } | |
331 | ||
332 | /* Create a probe request packet */ | |
714e1a51 | 333 | static u32 |
370121e5 JB |
334 | ieee80211softmac_probe_req(struct ieee80211_probe_request **pkt, |
335 | struct ieee80211softmac_device *mac, struct ieee80211softmac_essid *essid) | |
336 | { | |
337 | u8 *data; | |
338 | /* Allocate Packet */ | |
339 | (*pkt) = (struct ieee80211_probe_request *)ieee80211softmac_alloc_mgt( | |
340 | /* SSID of requested network */ | |
341 | 1 + 1 + IW_ESSID_MAX_SIZE + | |
342 | /* Rates IE */ | |
343 | 1 + 1 + IEEE80211SOFTMAC_MAX_RATES_LEN + | |
344 | /* Extended Rates IE */ | |
345 | 1 + 1 + IEEE80211SOFTMAC_MAX_EX_RATES_LEN | |
346 | ); | |
347 | if (unlikely((*pkt) == NULL)) | |
348 | return 0; | |
349 | ieee80211softmac_hdr_3addr(mac, &((*pkt)->header), IEEE80211_STYPE_PROBE_REQ, NULL, NULL); | |
350 | ||
351 | data = (u8 *)(*pkt)->info_element; | |
352 | /* Add ESSID (can be NULL) */ | |
353 | data = ieee80211softmac_add_essid(data, essid); | |
354 | /* Add Rates */ | |
355 | data = ieee80211softmac_frame_add_rates(data, &mac->ratesinfo); | |
356 | /* Return packet size */ | |
357 | return (data - (u8 *)(*pkt)); | |
358 | } | |
359 | ||
360 | /* Create a probe response packet */ | |
361 | /* FIXME: Not complete */ | |
714e1a51 | 362 | static u32 |
370121e5 JB |
363 | ieee80211softmac_probe_resp(struct ieee80211_probe_response **pkt, |
364 | struct ieee80211softmac_device *mac, struct ieee80211softmac_network *net) | |
365 | { | |
366 | u8 *data; | |
367 | /* Allocate Packet */ | |
368 | (*pkt) = (struct ieee80211_probe_response *)ieee80211softmac_alloc_mgt( | |
369 | 8 + /* Timestamp */ | |
370 | 2 + /* Beacon Interval */ | |
371 | 2 + /* Capability Info */ | |
372 | /* SSID IE */ | |
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 */ | |
378 | ); | |
379 | if (unlikely((*pkt) == NULL)) | |
380 | return 0; | |
381 | ieee80211softmac_hdr_3addr(mac, &((*pkt)->header), IEEE80211_STYPE_PROBE_RESP, net->bssid, net->bssid); | |
382 | data = (u8 *)(*pkt)->info_element; | |
383 | ||
384 | /* Return the packet size */ | |
385 | return (data - (u8 *)(*pkt)); | |
386 | } | |
387 | ||
388 | ||
389 | /* Sends a manangement packet | |
390 | * FIXME: document the use of the arg parameter | |
391 | * for _AUTH: (transaction #) | (status << 16) | |
392 | */ | |
393 | int | |
394 | ieee80211softmac_send_mgt_frame(struct ieee80211softmac_device *mac, | |
395 | void *ptrarg, u32 type, u32 arg) | |
396 | { | |
397 | void *pkt = NULL; | |
398 | u32 pkt_size = 0; | |
399 | ||
400 | switch(type) { | |
401 | case IEEE80211_STYPE_ASSOC_REQ: | |
402 | pkt_size = ieee80211softmac_assoc_req((struct ieee80211_assoc_request **)(&pkt), mac, (struct ieee80211softmac_network *)ptrarg); | |
403 | break; | |
404 | case IEEE80211_STYPE_REASSOC_REQ: | |
405 | pkt_size = ieee80211softmac_reassoc_req((struct ieee80211_reassoc_request **)(&pkt), mac, (struct ieee80211softmac_network *)ptrarg); | |
406 | break; | |
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)); | |
409 | break; | |
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)); | |
413 | break; | |
414 | case IEEE80211_STYPE_PROBE_REQ: | |
415 | pkt_size = ieee80211softmac_probe_req((struct ieee80211_probe_request **)(&pkt), mac, (struct ieee80211softmac_essid *)ptrarg); | |
416 | break; | |
417 | case IEEE80211_STYPE_PROBE_RESP: | |
418 | pkt_size = ieee80211softmac_probe_resp((struct ieee80211_probe_response **)(&pkt), mac, (struct ieee80211softmac_network *)ptrarg); | |
419 | break; | |
420 | default: | |
421 | printkl(KERN_DEBUG PFX "Unsupported Management Frame type: %i\n", type); | |
422 | return -EINVAL; | |
423 | }; | |
424 | ||
425 | if(pkt_size == 0 || pkt == NULL) { | |
426 | printkl(KERN_DEBUG PFX "Error, packet is nonexistant or 0 length\n"); | |
427 | return -ENOMEM; | |
428 | } | |
429 | ||
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? | |
436 | */ | |
437 | ieee80211_tx_frame(mac->ieee, (struct ieee80211_hdr *)pkt, pkt_size); | |
438 | ||
439 | kfree(pkt); | |
440 | return 0; | |
441 | } |