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