Gitiles
Code Review Sign In
gerrit-public.fairphone.software / kernel / msm-4.9 / cc21181217549e0a894dd6b57feacbcb979d831b / . / drivers / staging / vt6655 / 80211mgr.c
blob: 84745fb6b03515d94ebdb76e99bb9878f7c0376b [file] [log] [blame]
Forest Bond5449c682009-04-25 10:30:44 -0400[diff] [blame]1/*
2 * Copyright (c) 1996, 2003 VIA Networking Technologies, Inc.
3 * All rights reserved.
4 *
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License as published by
7 * the Free Software Foundation; either version 2 of the License, or
8 * (at your option) any later version.
9 *
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
14 *
15 * You should have received a copy of the GNU General Public License along
16 * with this program; if not, write to the Free Software Foundation, Inc.,
17 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
18 *
19 *
20 * File: 80211mgr.c
21 *
22 * Purpose: Handles the 802.11 managment support functions
23 *
24 * Author: Lyndon Chen
25 *
26 * Date: May 8, 2002
27 *
28 * Functions:
29 * vMgrEncodeBeacon - Encode the Beacon frame
30 * vMgrDecodeBeacon - Decode the Beacon frame
31 * vMgrEncodeIBSSATIM - Encode the IBSS ATIM frame
32 * vMgrDecodeIBSSATIM - Decode the IBSS ATIM frame
33 * vMgrEncodeDisassociation - Encode the Disassociation frame
34 * vMgrDecodeDisassociation - Decode the Disassociation frame
35 * vMgrEncodeAssocRequest - Encode the Association request frame
36 * vMgrDecodeAssocRequest - Decode the Association request frame
37 * vMgrEncodeAssocResponse - Encode the Association response frame
38 * vMgrDecodeAssocResponse - Decode the Association response frame
39 * vMgrEncodeReAssocRequest - Encode the ReAssociation request frame
40 * vMgrDecodeReAssocRequest - Decode the ReAssociation request frame
41 * vMgrEncodeProbeRequest - Encode the Probe request frame
42 * vMgrDecodeProbeRequest - Decode the Probe request frame
43 * vMgrEncodeProbeResponse - Encode the Probe response frame
44 * vMgrDecodeProbeResponse - Decode the Probe response frame
45 * vMgrEncodeAuthen - Encode the Authentication frame
46 * vMgrDecodeAuthen - Decode the Authentication frame
47 * vMgrEncodeDeauthen - Encode the DeAuthentication frame
48 * vMgrDecodeDeauthen - Decode the DeAuthentication frame
49 * vMgrEncodeReassocResponse - Encode the Reassociation response frame
50 * vMgrDecodeReassocResponse - Decode the Reassociation response frame
51 *
52 * Revision History:
53 *
54 */
55
56
57
58#if !defined(__TMACRO_H__)
59#include "tmacro.h"
60#endif
61#if !defined(__TETHER_H__)
62#include "tether.h"
63#endif
64#if !defined(__80211MGR_H__)
65#include "80211mgr.h"
66#endif
67#if !defined(__80211HDR_H__)
68#include "80211hdr.h"
69#endif
70#if !defined(__DEVICE_H__)
71#include "device.h"
72#endif
73#if !defined(__WPA_H__)
74#include "wpa.h"
75#endif
76
77
78
79/*--------------------- Static Definitions -------------------------*/
80
81
82
83/*--------------------- Static Classes ----------------------------*/
84
85/*--------------------- Static Variables --------------------------*/
86
87static int msglevel =MSG_LEVEL_INFO;
88//static int msglevel =MSG_LEVEL_DEBUG;
89/*--------------------- Static Functions --------------------------*/
90
91
92
93/*--------------------- Export Variables --------------------------*/
94
95
96/*--------------------- Export Functions --------------------------*/
97
98
99/*+
100 *
101 * Routine Description:
102 * Encode Beacon frame body offset
103 *
104 * Return Value:
105 * None.
106 *
107-*/
108
109VOID
110vMgrEncodeBeacon(
111 IN PWLAN_FR_BEACON pFrame
112 )
113{
114 pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
115
116 // Fixed Fields
117 pFrame->pqwTimestamp = (PQWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
118 + WLAN_BEACON_OFF_TS);
119 pFrame->pwBeaconInterval = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
120 + WLAN_BEACON_OFF_BCN_INT);
121 pFrame->pwCapInfo = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
122 + WLAN_BEACON_OFF_CAPINFO);
123
124 pFrame->len = WLAN_HDR_ADDR3_LEN + WLAN_BEACON_OFF_SSID;
125
126 return;
127}
128
129/*+
130 *
131 * Routine Description:
132 * Decode Beacon frame body offset
133 *
134 *
135 * Return Value:
136 * None.
137 *
138-*/
139
140
141VOID
142vMgrDecodeBeacon(
143 IN PWLAN_FR_BEACON pFrame
144 )
145{
146 PWLAN_IE pItem;
147
148 pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
149
150 // Fixed Fields
151 pFrame->pqwTimestamp = (PQWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
152 + WLAN_BEACON_OFF_TS);
153 pFrame->pwBeaconInterval = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
154 + WLAN_BEACON_OFF_BCN_INT);
155 pFrame->pwCapInfo = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
156 + WLAN_BEACON_OFF_CAPINFO);
157
158 // Information elements
159 pItem = (PWLAN_IE)((PBYTE)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3)))
160 + WLAN_BEACON_OFF_SSID);
161 while( ((PBYTE)pItem) < (pFrame->pBuf + pFrame->len) ){
162
163 switch (pItem->byElementID) {
164 case WLAN_EID_SSID:
165 if (pFrame->pSSID == NULL)
166 pFrame->pSSID = (PWLAN_IE_SSID)pItem;
167 break;
168 case WLAN_EID_SUPP_RATES:
169 if (pFrame->pSuppRates == NULL)
170 pFrame->pSuppRates = (PWLAN_IE_SUPP_RATES)pItem;
171 break;
172 case WLAN_EID_FH_PARMS:
173 //pFrame->pFHParms = (PWLAN_IE_FH_PARMS)pItem;
174 break;
175 case WLAN_EID_DS_PARMS:
176 if (pFrame->pDSParms == NULL)
177 pFrame->pDSParms = (PWLAN_IE_DS_PARMS)pItem;
178 break;
179 case WLAN_EID_CF_PARMS:
180 if (pFrame->pCFParms == NULL)
181 pFrame->pCFParms = (PWLAN_IE_CF_PARMS)pItem;
182 break;
183 case WLAN_EID_IBSS_PARMS:
184 if (pFrame->pIBSSParms == NULL)
185 pFrame->pIBSSParms = (PWLAN_IE_IBSS_PARMS)pItem;
186 break;
187 case WLAN_EID_TIM:
188 if (pFrame->pTIM == NULL)
189 pFrame->pTIM = (PWLAN_IE_TIM)pItem;
190 break;
191
192 case WLAN_EID_RSN:
193 if (pFrame->pRSN == NULL) {
194 pFrame->pRSN = (PWLAN_IE_RSN)pItem;
195 }
196 break;
197 case WLAN_EID_RSN_WPA:
198 if (pFrame->pRSNWPA == NULL) {
199 if (WPAb_Is_RSN((PWLAN_IE_RSN_EXT)pItem) == TRUE)
200 pFrame->pRSNWPA = (PWLAN_IE_RSN_EXT)pItem;
201 }
202 break;
203
204 case WLAN_EID_ERP:
205 if (pFrame->pERP == NULL)
206 pFrame->pERP = (PWLAN_IE_ERP)pItem;
207 break;
208 case WLAN_EID_EXTSUPP_RATES:
209 if (pFrame->pExtSuppRates == NULL)
210 pFrame->pExtSuppRates = (PWLAN_IE_SUPP_RATES)pItem;
211 break;
212
213 case WLAN_EID_COUNTRY: //7
214 if (pFrame->pIE_Country == NULL)
215 pFrame->pIE_Country = (PWLAN_IE_COUNTRY)pItem;
216 break;
217
218 case WLAN_EID_PWR_CONSTRAINT: //32
219 if (pFrame->pIE_PowerConstraint == NULL)
220 pFrame->pIE_PowerConstraint = (PWLAN_IE_PW_CONST)pItem;
221 break;
222
223 case WLAN_EID_CH_SWITCH: //37
224 if (pFrame->pIE_CHSW == NULL)
225 pFrame->pIE_CHSW = (PWLAN_IE_CH_SW)pItem;
226 break;
227
228 case WLAN_EID_QUIET: //40
229 if (pFrame->pIE_Quiet == NULL)
230 pFrame->pIE_Quiet = (PWLAN_IE_QUIET)pItem;
231 break;
232
233 case WLAN_EID_IBSS_DFS:
234 if (pFrame->pIE_IBSSDFS == NULL)
235 pFrame->pIE_IBSSDFS = (PWLAN_IE_IBSS_DFS)pItem;
236 break;
237
238 default:
239 DEVICE_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Unrecognized EID=%dd in beacon decode.\n", pItem->byElementID);
240 break;
241
242 }
243 pItem = (PWLAN_IE)(((PBYTE)pItem) + 2 + pItem->len);
244 }
245
246 return;
247}
248
249
250/*+
251 *
252 * Routine Description:
253 * Encode IBSS ATIM
254 *
255 *
256 * Return Value:
257 * None.
258 *
259-*/
260
261
262VOID
263vMgrEncodeIBSSATIM(
264 IN PWLAN_FR_IBSSATIM pFrame
265 )
266{
267 pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
268 pFrame->len = WLAN_HDR_ADDR3_LEN;
269
270 return;
271}
272
273
274/*+
275 *
276 * Routine Description:
277 * Decode IBSS ATIM
278 *
279 *
280 * Return Value:
281 * None.
282 *
283-*/
284
285VOID
286vMgrDecodeIBSSATIM(
287 IN PWLAN_FR_IBSSATIM pFrame
288 )
289{
290 pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
291
292 return;
293}
294
295
296/*+
297 *
298 * Routine Description:
299 * Encode Disassociation
300 *
301 *
302 * Return Value:
303 * None.
304 *
305-*/
306
307VOID
308vMgrEncodeDisassociation(
309 IN PWLAN_FR_DISASSOC pFrame
310 )
311{
312 pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
313
314
315 // Fixed Fields
316 pFrame->pwReason = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
317 + WLAN_DISASSOC_OFF_REASON);
318 pFrame->len = WLAN_HDR_ADDR3_LEN + WLAN_DISASSOC_OFF_REASON + sizeof(*(pFrame->pwReason));
319
320 return;
321}
322
323
324/*+
325 *
326 * Routine Description:
327 * Decode Disassociation
328 *
329 *
330 * Return Value:
331 * None.
332 *
333-*/
334
335VOID
336vMgrDecodeDisassociation(
337 IN PWLAN_FR_DISASSOC pFrame
338 )
339{
340 pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
341
342 // Fixed Fields
343 pFrame->pwReason = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
344 + WLAN_DISASSOC_OFF_REASON);
345
346 return;
347}
348
349/*+
350 *
351 * Routine Description:
352 * Encode Association Request
353 *
354 *
355 * Return Value:
356 * None.
357 *
358-*/
359
360
361VOID
362vMgrEncodeAssocRequest(
363 IN PWLAN_FR_ASSOCREQ pFrame
364 )
365{
366 pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
367 // Fixed Fields
368 pFrame->pwCapInfo = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
369 + WLAN_ASSOCREQ_OFF_CAP_INFO);
370 pFrame->pwListenInterval = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
371 + WLAN_ASSOCREQ_OFF_LISTEN_INT);
372 pFrame->len = WLAN_HDR_ADDR3_LEN + WLAN_ASSOCREQ_OFF_LISTEN_INT + sizeof(*(pFrame->pwListenInterval));
373 return;
374}
375
376
377/*+
378 *
379 * Routine Description: (AP)
380 * Decode Association Request
381 *
382 *
383 * Return Value:
384 * None.
385 *
386-*/
387
388VOID
389vMgrDecodeAssocRequest(
390 IN PWLAN_FR_ASSOCREQ pFrame
391 )
392{
393 PWLAN_IE pItem;
394
395 pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
396 // Fixed Fields
397 pFrame->pwCapInfo = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
398 + WLAN_ASSOCREQ_OFF_CAP_INFO);
399 pFrame->pwListenInterval = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
400 + WLAN_ASSOCREQ_OFF_LISTEN_INT);
401
402 // Information elements
403 pItem = (PWLAN_IE)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
404 + WLAN_ASSOCREQ_OFF_SSID);
405
406 while (((PBYTE)pItem) < (pFrame->pBuf + pFrame->len)) {
407 switch (pItem->byElementID){
408 case WLAN_EID_SSID:
409 if (pFrame->pSSID == NULL)
410 pFrame->pSSID = (PWLAN_IE_SSID)pItem;
411 break;
412 case WLAN_EID_SUPP_RATES:
413 if (pFrame->pSuppRates == NULL)
414 pFrame->pSuppRates = (PWLAN_IE_SUPP_RATES)pItem;
415 break;
416
417 case WLAN_EID_RSN:
418 if (pFrame->pRSN == NULL) {
419 pFrame->pRSN = (PWLAN_IE_RSN)pItem;
420 }
421 break;
422 case WLAN_EID_RSN_WPA:
423 if (pFrame->pRSNWPA == NULL) {
424 if (WPAb_Is_RSN((PWLAN_IE_RSN_EXT)pItem) == TRUE)
425 pFrame->pRSNWPA = (PWLAN_IE_RSN_EXT)pItem;
426 }
427 break;
428 case WLAN_EID_EXTSUPP_RATES:
429 if (pFrame->pExtSuppRates == NULL)
430 pFrame->pExtSuppRates = (PWLAN_IE_SUPP_RATES)pItem;
431 break;
432
433 default:
434 DEVICE_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Unrecognized EID=%dd in assocreq decode.\n",
435 pItem->byElementID);
436 break;
437 }
438 pItem = (PWLAN_IE)(((PBYTE)pItem) + 2 + pItem->len);
439 }
440 return;
441}
442
443/*+
444 *
445 * Routine Description: (AP)
446 * Encode Association Response
447 *
448 *
449 * Return Value:
450 * None.
451 *
452-*/
453
454VOID
455vMgrEncodeAssocResponse(
456 IN PWLAN_FR_ASSOCRESP pFrame
457 )
458{
459 pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
460
461 // Fixed Fields
462 pFrame->pwCapInfo = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
463 + WLAN_ASSOCRESP_OFF_CAP_INFO);
464 pFrame->pwStatus = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
465 + WLAN_ASSOCRESP_OFF_STATUS);
466 pFrame->pwAid = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
467 + WLAN_ASSOCRESP_OFF_AID);
468 pFrame->len = WLAN_HDR_ADDR3_LEN + WLAN_ASSOCRESP_OFF_AID
469 + sizeof(*(pFrame->pwAid));
470
471 return;
472}
473
474
475/*+
476 *
477 * Routine Description:
478 * Decode Association Response
479 *
480 *
481 * Return Value:
482 * None.
483 *
484-*/
485
486VOID
487vMgrDecodeAssocResponse(
488 IN PWLAN_FR_ASSOCRESP pFrame
489 )
490{
491 PWLAN_IE pItem;
492
493 pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
494
495 // Fixed Fields
496 pFrame->pwCapInfo = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
497 + WLAN_ASSOCRESP_OFF_CAP_INFO);
498 pFrame->pwStatus = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
499 + WLAN_ASSOCRESP_OFF_STATUS);
500 pFrame->pwAid = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
501 + WLAN_ASSOCRESP_OFF_AID);
502
503 // Information elements
504 pFrame->pSuppRates = (PWLAN_IE_SUPP_RATES)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
505 + WLAN_ASSOCRESP_OFF_SUPP_RATES);
506
507 pItem = (PWLAN_IE)(pFrame->pSuppRates);
508 pItem = (PWLAN_IE)(((PBYTE)pItem) + 2 + pItem->len);
509
510 if ((((PBYTE)pItem) < (pFrame->pBuf + pFrame->len)) && (pItem->byElementID == WLAN_EID_EXTSUPP_RATES)) {
511 pFrame->pExtSuppRates = (PWLAN_IE_SUPP_RATES)pItem;
512 DEVICE_PRT(MSG_LEVEL_DEBUG, KERN_INFO "pFrame->pExtSuppRates=[%p].\n", pItem);
513 }
514 else {
515 pFrame->pExtSuppRates = NULL;
516 }
517 return;
518}
519
520
521/*+
522 *
523 * Routine Description:
524 * Encode Reassociation Request
525 *
526 *
527 * Return Value:
528 * None.
529 *
530-*/
531
532VOID
533vMgrEncodeReassocRequest(
534 IN PWLAN_FR_REASSOCREQ pFrame
535 )
536{
537 pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
538
539 // Fixed Fields
540 pFrame->pwCapInfo = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
541 + WLAN_REASSOCREQ_OFF_CAP_INFO);
542 pFrame->pwListenInterval = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
543 + WLAN_REASSOCREQ_OFF_LISTEN_INT);
544 pFrame->pAddrCurrAP = (PIEEE_ADDR)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
545 + WLAN_REASSOCREQ_OFF_CURR_AP);
546 pFrame->len = WLAN_HDR_ADDR3_LEN + WLAN_REASSOCREQ_OFF_CURR_AP + sizeof(*(pFrame->pAddrCurrAP));
547
548 return;
549}
550
551
552/*+
553 *
554 * Routine Description: (AP)
555 * Decode Reassociation Request
556 *
557 *
558 * Return Value:
559 * None.
560 *
561-*/
562
563
564VOID
565vMgrDecodeReassocRequest(
566 IN PWLAN_FR_REASSOCREQ pFrame
567 )
568{
569 PWLAN_IE pItem;
570 pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
571
572 // Fixed Fields
573 pFrame->pwCapInfo = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
574 + WLAN_REASSOCREQ_OFF_CAP_INFO);
575 pFrame->pwListenInterval = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
576 + WLAN_REASSOCREQ_OFF_LISTEN_INT);
577 pFrame->pAddrCurrAP = (PIEEE_ADDR)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
578 + WLAN_REASSOCREQ_OFF_CURR_AP);
579
580 // Information elements
581 pItem = (PWLAN_IE)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
582 + WLAN_REASSOCREQ_OFF_SSID);
583
584 while(((PBYTE)pItem) < (pFrame->pBuf + pFrame->len)) {
585
586 switch (pItem->byElementID){
587 case WLAN_EID_SSID:
588 if (pFrame->pSSID == NULL)
589 pFrame->pSSID = (PWLAN_IE_SSID)pItem;
590 break;
591 case WLAN_EID_SUPP_RATES:
592 if (pFrame->pSuppRates == NULL)
593 pFrame->pSuppRates = (PWLAN_IE_SUPP_RATES)pItem;
594 break;
595
596 case WLAN_EID_RSN:
597 if (pFrame->pRSN == NULL) {
598 pFrame->pRSN = (PWLAN_IE_RSN)pItem;
599 }
600 break;
601 case WLAN_EID_RSN_WPA:
602 if (pFrame->pRSNWPA == NULL) {
603 if (WPAb_Is_RSN((PWLAN_IE_RSN_EXT)pItem) == TRUE)
604 pFrame->pRSNWPA = (PWLAN_IE_RSN_EXT)pItem;
605 }
606 break;
607
608 case WLAN_EID_EXTSUPP_RATES:
609 if (pFrame->pExtSuppRates == NULL)
610 pFrame->pExtSuppRates = (PWLAN_IE_SUPP_RATES)pItem;
611 break;
612 default:
613 DEVICE_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Unrecognized EID=%dd in reassocreq decode.\n",
614 pItem->byElementID);
615 break;
616 }
617 pItem = (PWLAN_IE)(((PBYTE)pItem) + 2 + pItem->len);
618 }
619 return;
620}
621
622
623
624/*+
625 *
626 * Routine Description:
627 * Encode Probe Request
628 *
629 *
630 * Return Value:
631 * None.
632 *
633-*/
634
635
636VOID
637vMgrEncodeProbeRequest(
638 IN PWLAN_FR_PROBEREQ pFrame
639 )
640{
641 pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
642 pFrame->len = WLAN_HDR_ADDR3_LEN;
643 return;
644}
645
646/*+
647 *
648 * Routine Description:
649 * Decode Probe Request
650 *
651 *
652 * Return Value:
653 * None.
654 *
655-*/
656
657VOID
658vMgrDecodeProbeRequest(
659 IN PWLAN_FR_PROBEREQ pFrame
660 )
661{
662 PWLAN_IE pItem;
663
664 pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
665
666 // Information elements
667 pItem = (PWLAN_IE)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3)));
668
669 while( ((PBYTE)pItem) < (pFrame->pBuf + pFrame->len) ) {
670
671 switch (pItem->byElementID) {
672 case WLAN_EID_SSID:
673 if (pFrame->pSSID == NULL)
674 pFrame->pSSID = (PWLAN_IE_SSID)pItem;
675 break;
676
677 case WLAN_EID_SUPP_RATES:
678 if (pFrame->pSuppRates == NULL)
679 pFrame->pSuppRates = (PWLAN_IE_SUPP_RATES)pItem;
680 break;
681
682 case WLAN_EID_EXTSUPP_RATES:
683 if (pFrame->pExtSuppRates == NULL)
684 pFrame->pExtSuppRates = (PWLAN_IE_SUPP_RATES)pItem;
685 break;
686
687 default:
688 DEVICE_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Bad EID=%dd in probereq\n", pItem->byElementID);
689 break;
690 }
691
692 pItem = (PWLAN_IE)(((PBYTE)pItem) + 2 + pItem->len);
693 }
694 return;
695}
696
697
698/*+
699 *
700 * Routine Description:
701 * Encode Probe Response
702 *
703 *
704 * Return Value:
705 * None.
706 *
707-*/
708
709
710VOID
711vMgrEncodeProbeResponse(
712 IN PWLAN_FR_PROBERESP pFrame
713 )
714{
715 pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
716
717 // Fixed Fields
718 pFrame->pqwTimestamp = (PQWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
719 + WLAN_PROBERESP_OFF_TS);
720 pFrame->pwBeaconInterval = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
721 + WLAN_PROBERESP_OFF_BCN_INT);
722 pFrame->pwCapInfo = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
723 + WLAN_PROBERESP_OFF_CAP_INFO);
724
725 pFrame->len = WLAN_HDR_ADDR3_LEN + WLAN_PROBERESP_OFF_CAP_INFO +
726 sizeof(*(pFrame->pwCapInfo));
727
728 return;
729}
730
731
732
733/*+
734 *
735 * Routine Description:
736 * Decode Probe Response
737 *
738 *
739 * Return Value:
740 * None.
741 *
742-*/
743
744VOID
745vMgrDecodeProbeResponse(
746 IN PWLAN_FR_PROBERESP pFrame
747 )
748{
749 PWLAN_IE pItem;
750// BYTE byCheckEID = 0;
751
752
753 pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
754
755 // Fixed Fields
756 pFrame->pqwTimestamp = (PQWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
757 + WLAN_PROBERESP_OFF_TS);
758 pFrame->pwBeaconInterval = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
759 + WLAN_PROBERESP_OFF_BCN_INT);
760 pFrame->pwCapInfo = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
761 + WLAN_PROBERESP_OFF_CAP_INFO);
762
763 // Information elements
764 pItem = (PWLAN_IE)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
765 + WLAN_PROBERESP_OFF_SSID);
766
767 while( ((PBYTE)pItem) < (pFrame->pBuf + pFrame->len) ) {
768 /*
769 if (pItem->byElementID < byCheckEID)
770 break;
771 else
772 byCheckEID = pItem->byElementID;
773*/
774 switch (pItem->byElementID) {
775 case WLAN_EID_SSID:
776 if (pFrame->pSSID == NULL)
777 pFrame->pSSID = (PWLAN_IE_SSID)pItem;
778 break;
779 case WLAN_EID_SUPP_RATES:
780 if (pFrame->pSuppRates == NULL)
781 pFrame->pSuppRates = (PWLAN_IE_SUPP_RATES)pItem;
782 break;
783 case WLAN_EID_FH_PARMS:
784 break;
785 case WLAN_EID_DS_PARMS:
786 if (pFrame->pDSParms == NULL)
787 pFrame->pDSParms = (PWLAN_IE_DS_PARMS)pItem;
788 break;
789 case WLAN_EID_CF_PARMS:
790 if (pFrame->pCFParms == NULL)
791 pFrame->pCFParms = (PWLAN_IE_CF_PARMS)pItem;
792 break;
793 case WLAN_EID_IBSS_PARMS:
794 if (pFrame->pIBSSParms == NULL)
795 pFrame->pIBSSParms = (PWLAN_IE_IBSS_PARMS)pItem;
796 break;
797
798 case WLAN_EID_RSN:
799 if (pFrame->pRSN == NULL) {
800 pFrame->pRSN = (PWLAN_IE_RSN)pItem;
801 }
802 break;
803 case WLAN_EID_RSN_WPA:
804 if (pFrame->pRSNWPA == NULL) {
805 if (WPAb_Is_RSN((PWLAN_IE_RSN_EXT)pItem) == TRUE)
806 pFrame->pRSNWPA = (PWLAN_IE_RSN_EXT)pItem;
807 }
808 break;
809 case WLAN_EID_ERP:
810 if (pFrame->pERP == NULL)
811 pFrame->pERP = (PWLAN_IE_ERP)pItem;
812 break;
813 case WLAN_EID_EXTSUPP_RATES:
814 if (pFrame->pExtSuppRates == NULL)
815 pFrame->pExtSuppRates = (PWLAN_IE_SUPP_RATES)pItem;
816 break;
817
818 case WLAN_EID_COUNTRY: //7
819 if (pFrame->pIE_Country == NULL)
820 pFrame->pIE_Country = (PWLAN_IE_COUNTRY)pItem;
821 break;
822
823 case WLAN_EID_PWR_CONSTRAINT: //32
824 if (pFrame->pIE_PowerConstraint == NULL)
825 pFrame->pIE_PowerConstraint = (PWLAN_IE_PW_CONST)pItem;
826 break;
827
828 case WLAN_EID_CH_SWITCH: //37
829 if (pFrame->pIE_CHSW == NULL)
830 pFrame->pIE_CHSW = (PWLAN_IE_CH_SW)pItem;
831 break;
832
833 case WLAN_EID_QUIET: //40
834 if (pFrame->pIE_Quiet == NULL)
835 pFrame->pIE_Quiet = (PWLAN_IE_QUIET)pItem;
836 break;
837
838 case WLAN_EID_IBSS_DFS:
839 if (pFrame->pIE_IBSSDFS == NULL)
840 pFrame->pIE_IBSSDFS = (PWLAN_IE_IBSS_DFS)pItem;
841 break;
842
843 default:
844 DEVICE_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Bad EID=%dd in proberesp\n", pItem->byElementID);
845 break;
846 }
847
848 pItem = (PWLAN_IE)(((PBYTE)pItem) + 2 + pItem->len);
849 }
850 return;
851}
852
853
854/*+
855 *
856 * Routine Description:
857 * Encode Authentication frame
858 *
859 *
860 * Return Value:
861 * None.
862 *
863-*/
864
865VOID
866vMgrEncodeAuthen(
867 IN PWLAN_FR_AUTHEN pFrame
868 )
869{
870 pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
871
872 // Fixed Fields
873 pFrame->pwAuthAlgorithm = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
874 + WLAN_AUTHEN_OFF_AUTH_ALG);
875 pFrame->pwAuthSequence = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
876 + WLAN_AUTHEN_OFF_AUTH_SEQ);
877 pFrame->pwStatus = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
878 + WLAN_AUTHEN_OFF_STATUS);
879 pFrame->len = WLAN_HDR_ADDR3_LEN + WLAN_AUTHEN_OFF_STATUS + sizeof(*(pFrame->pwStatus));
880
881 return;
882}
883
884
885/*+
886 *
887 * Routine Description:
888 * Decode Authentication
889 *
890 *
891 * Return Value:
892 * None.
893 *
894-*/
895
896VOID
897vMgrDecodeAuthen(
898 IN PWLAN_FR_AUTHEN pFrame
899 )
900{
901 PWLAN_IE pItem;
902
903 pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
904
905 // Fixed Fields
906 pFrame->pwAuthAlgorithm = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
907 + WLAN_AUTHEN_OFF_AUTH_ALG);
908 pFrame->pwAuthSequence = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
909 + WLAN_AUTHEN_OFF_AUTH_SEQ);
910 pFrame->pwStatus = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
911 + WLAN_AUTHEN_OFF_STATUS);
912
913 // Information elements
914 pItem = (PWLAN_IE)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
915 + WLAN_AUTHEN_OFF_CHALLENGE);
916
917 if ((((PBYTE)pItem) < (pFrame->pBuf + pFrame->len)) && (pItem->byElementID == WLAN_EID_CHALLENGE)) {
918 pFrame->pChallenge = (PWLAN_IE_CHALLENGE)pItem;
919 }
920
921 return;
922}
923
924
925/*+
926 *
927 * Routine Description:
928 * Encode Authentication
929 *
930 *
931 * Return Value:
932 * None.
933 *
934-*/
935
936VOID
937vMgrEncodeDeauthen(
938 IN PWLAN_FR_DEAUTHEN pFrame
939 )
940{
941 pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
942
943 // Fixed Fields
944 pFrame->pwReason = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
945 + WLAN_DEAUTHEN_OFF_REASON);
946 pFrame->len = WLAN_HDR_ADDR3_LEN + WLAN_DEAUTHEN_OFF_REASON + sizeof(*(pFrame->pwReason));
947
948 return;
949}
950
951
952/*+
953 *
954 * Routine Description:
955 * Decode Deauthentication
956 *
957 *
958 * Return Value:
959 * None.
960 *
961-*/
962
963VOID
964vMgrDecodeDeauthen(
965 IN PWLAN_FR_DEAUTHEN pFrame
966 )
967{
968 pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
969
970 // Fixed Fields
971 pFrame->pwReason = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
972 + WLAN_DEAUTHEN_OFF_REASON);
973
974 return;
975}
976
977
978/*+
979 *
980 * Routine Description: (AP)
981 * Encode Reassociation Response
982 *
983 *
984 * Return Value:
985 * None.
986 *
987-*/
988
989VOID
990vMgrEncodeReassocResponse(
991 IN PWLAN_FR_REASSOCRESP pFrame
992 )
993{
994 pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
995
996 // Fixed Fields
997 pFrame->pwCapInfo = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
998 + WLAN_REASSOCRESP_OFF_CAP_INFO);
999 pFrame->pwStatus = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
1000 + WLAN_REASSOCRESP_OFF_STATUS);
1001 pFrame->pwAid = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
1002 + WLAN_REASSOCRESP_OFF_AID);
1003
1004 pFrame->len = WLAN_HDR_ADDR3_LEN + WLAN_REASSOCRESP_OFF_AID + sizeof(*(pFrame->pwAid));
1005
1006 return;
1007}
1008
1009
1010/*+
1011 *
1012 * Routine Description:
1013 * Decode Reassociation Response
1014 *
1015 *
1016 * Return Value:
1017 * None.
1018 *
1019-*/
1020
1021
1022VOID
1023vMgrDecodeReassocResponse(
1024 IN PWLAN_FR_REASSOCRESP pFrame
1025 )
1026{
1027 PWLAN_IE pItem;
1028
1029 pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
1030
1031 // Fixed Fields
1032 pFrame->pwCapInfo = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
1033 + WLAN_REASSOCRESP_OFF_CAP_INFO);
1034 pFrame->pwStatus = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
1035 + WLAN_REASSOCRESP_OFF_STATUS);
1036 pFrame->pwAid = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
1037 + WLAN_REASSOCRESP_OFF_AID);
1038
1039 //Information elements
1040 pFrame->pSuppRates = (PWLAN_IE_SUPP_RATES)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
1041 + WLAN_REASSOCRESP_OFF_SUPP_RATES);
1042
1043 pItem = (PWLAN_IE)(pFrame->pSuppRates);
1044 pItem = (PWLAN_IE)(((PBYTE)pItem) + 2 + pItem->len);
1045
1046 if ((((PBYTE)pItem) < (pFrame->pBuf + pFrame->len)) && (pItem->byElementID == WLAN_EID_EXTSUPP_RATES)) {
1047 pFrame->pExtSuppRates = (PWLAN_IE_SUPP_RATES)pItem;
1048 }
1049 return;
1050}