?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
GUI: Fix Tomato RAF theme for all builds. Compilation typo.
[tomato.git] / release / src-rt-6.x.4708 / linux / linux-2.6.36 / drivers / staging / vt6656 / 80211mgr.c
blobfceec4999c361b6e3aa897bfa8e8bee72885a100
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 management 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 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 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 break;
179 case WLAN_EID_RSN_WPA:
180 if (pFrame->pRSNWPA == NULL) {
181 if (WPAb_Is_RSN((PWLAN_IE_RSN_EXT)pItem) == TRUE)
182 pFrame->pRSNWPA = (PWLAN_IE_RSN_EXT)pItem;
183 }
184 break;
185
186 case WLAN_EID_ERP:
187 if (pFrame->pERP == NULL)
188 pFrame->pERP = (PWLAN_IE_ERP)pItem;
189 break;
190 case WLAN_EID_EXTSUPP_RATES:
191 if (pFrame->pExtSuppRates == NULL)
192 pFrame->pExtSuppRates = (PWLAN_IE_SUPP_RATES)pItem;
193 break;
194
195 case WLAN_EID_COUNTRY: /* 7 */
196 if (pFrame->pIE_Country == NULL)
197 pFrame->pIE_Country = (PWLAN_IE_COUNTRY)pItem;
198 break;
199
200 case WLAN_EID_PWR_CONSTRAINT: /* 32 */
201 if (pFrame->pIE_PowerConstraint == NULL)
202 pFrame->pIE_PowerConstraint = (PWLAN_IE_PW_CONST)pItem;
203 break;
204
205 case WLAN_EID_CH_SWITCH: /* 37 */
206 if (pFrame->pIE_CHSW == NULL)
207 pFrame->pIE_CHSW = (PWLAN_IE_CH_SW)pItem;
208 break;
209
210 case WLAN_EID_QUIET: /* 40 */
211 if (pFrame->pIE_Quiet == NULL)
212 pFrame->pIE_Quiet = (PWLAN_IE_QUIET)pItem;
213 break;
214
215 case WLAN_EID_IBSS_DFS:
216 if (pFrame->pIE_IBSSDFS == NULL)
217 pFrame->pIE_IBSSDFS = (PWLAN_IE_IBSS_DFS)pItem;
218 break;
219
220 default:
221 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Unrecognized EID=%dd in beacon decode.\n", pItem->byElementID);
222 break;
223
224 }
225 pItem = (PWLAN_IE)(((PBYTE)pItem) + 2 + pItem->len);
226 }
227
228 return;
229 }
230
231
232 /*+
233 *
234 * Routine Description:
235 * Encode IBSS ATIM
236 *
237 *
238 * Return Value:
239 * None.
240 *
241 -*/
242
243
244 void
245 vMgrEncodeIBSSATIM(
246 PWLAN_FR_IBSSATIM pFrame
247 )
248 {
249 pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
250 pFrame->len = WLAN_HDR_ADDR3_LEN;
251
252 return;
253 }
254
255
256 /*+
257 *
258 * Routine Description:
259 * Decode IBSS ATIM
260 *
261 *
262 * Return Value:
263 * None.
264 *
265 -*/
266
267 void
268 vMgrDecodeIBSSATIM(
269 PWLAN_FR_IBSSATIM pFrame
270 )
271 {
272 pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
273
274 return;
275 }
276
277
278 /*+
279 *
280 * Routine Description:
281 * Encode Disassociation
282 *
283 *
284 * Return Value:
285 * None.
286 *
287 -*/
288
289 void
290 vMgrEncodeDisassociation(
291 PWLAN_FR_DISASSOC pFrame
292 )
293 {
294 pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
295
296
297 /* Fixed Fields */
298 pFrame->pwReason = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
299 + WLAN_DISASSOC_OFF_REASON);
300 pFrame->len = WLAN_HDR_ADDR3_LEN + WLAN_DISASSOC_OFF_REASON + sizeof(*(pFrame->pwReason));
301
302 return;
303 }
304
305
306 /*+
307 *
308 * Routine Description:
309 * Decode Disassociation
310 *
311 *
312 * Return Value:
313 * None.
314 *
315 -*/
316
317 void
318 vMgrDecodeDisassociation(
319 PWLAN_FR_DISASSOC pFrame
320 )
321 {
322 pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
323
324 /* Fixed Fields */
325 pFrame->pwReason = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
326 + WLAN_DISASSOC_OFF_REASON);
327
328 return;
329 }
330
331 /*+
332 *
333 * Routine Description:
334 * Encode Association Request
335 *
336 *
337 * Return Value:
338 * None.
339 *
340 -*/
341
342
343 void
344 vMgrEncodeAssocRequest(
345 PWLAN_FR_ASSOCREQ pFrame
346 )
347 {
348 pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
349 /* Fixed Fields */
350 pFrame->pwCapInfo = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
351 + WLAN_ASSOCREQ_OFF_CAP_INFO);
352 pFrame->pwListenInterval = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
353 + WLAN_ASSOCREQ_OFF_LISTEN_INT);
354 pFrame->len = WLAN_HDR_ADDR3_LEN + WLAN_ASSOCREQ_OFF_LISTEN_INT + sizeof(*(pFrame->pwListenInterval));
355 return;
356 }
357
358
359 /*+
360 *
361 * Routine Description: (AP)
362 * Decode Association Request
363 *
364 *
365 * Return Value:
366 * None.
367 *
368 -*/
369
370 void
371 vMgrDecodeAssocRequest(
372 PWLAN_FR_ASSOCREQ pFrame
373 )
374 {
375 PWLAN_IE pItem;
376
377 pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
378 /* Fixed Fields */
379 pFrame->pwCapInfo = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
380 + WLAN_ASSOCREQ_OFF_CAP_INFO);
381 pFrame->pwListenInterval = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
382 + WLAN_ASSOCREQ_OFF_LISTEN_INT);
383
384 /* Information elements */
385 pItem = (PWLAN_IE)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
386 + WLAN_ASSOCREQ_OFF_SSID);
387
388 while (((PBYTE)pItem) < (pFrame->pBuf + pFrame->len)) {
389 switch (pItem->byElementID) {
390 case WLAN_EID_SSID:
391 if (pFrame->pSSID == NULL)
392 pFrame->pSSID = (PWLAN_IE_SSID)pItem;
393 break;
394 case WLAN_EID_SUPP_RATES:
395 if (pFrame->pSuppRates == NULL)
396 pFrame->pSuppRates = (PWLAN_IE_SUPP_RATES)pItem;
397 break;
398
399 case WLAN_EID_RSN:
400 if (pFrame->pRSN == NULL)
401 pFrame->pRSN = (PWLAN_IE_RSN)pItem;
402 break;
403 case WLAN_EID_RSN_WPA:
404 if (pFrame->pRSNWPA == NULL) {
405 if (WPAb_Is_RSN((PWLAN_IE_RSN_EXT)pItem) == TRUE)
406 pFrame->pRSNWPA = (PWLAN_IE_RSN_EXT)pItem;
407 }
408 break;
409 case WLAN_EID_EXTSUPP_RATES:
410 if (pFrame->pExtSuppRates == NULL)
411 pFrame->pExtSuppRates = (PWLAN_IE_SUPP_RATES)pItem;
412 break;
413
414 default:
415 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Unrecognized EID=%dd in assocreq decode.\n",
416 pItem->byElementID);
417 break;
418 }
419 pItem = (PWLAN_IE)(((PBYTE)pItem) + 2 + pItem->len);
420 }
421 return;
422 }
423
424 /*+
425 *
426 * Routine Description: (AP)
427 * Encode Association Response
428 *
429 *
430 * Return Value:
431 * None.
432 *
433 -*/
434
435 void
436 vMgrEncodeAssocResponse(
437 PWLAN_FR_ASSOCRESP pFrame
438 )
439 {
440 pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
441
442 /* Fixed Fields */
443 pFrame->pwCapInfo = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
444 + WLAN_ASSOCRESP_OFF_CAP_INFO);
445 pFrame->pwStatus = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
446 + WLAN_ASSOCRESP_OFF_STATUS);
447 pFrame->pwAid = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
448 + WLAN_ASSOCRESP_OFF_AID);
449 pFrame->len = WLAN_HDR_ADDR3_LEN + WLAN_ASSOCRESP_OFF_AID
450 + sizeof(*(pFrame->pwAid));
451
452 return;
453 }
454
455
456 /*+
457 *
458 * Routine Description:
459 * Decode Association Response
460 *
461 *
462 * Return Value:
463 * None.
464 *
465 -*/
466
467 void
468 vMgrDecodeAssocResponse(
469 PWLAN_FR_ASSOCRESP pFrame
470 )
471 {
472 PWLAN_IE pItem;
473
474 pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
475
476 /* Fixed Fields */
477 pFrame->pwCapInfo = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
478 + WLAN_ASSOCRESP_OFF_CAP_INFO);
479 pFrame->pwStatus = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
480 + WLAN_ASSOCRESP_OFF_STATUS);
481 pFrame->pwAid = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
482 + WLAN_ASSOCRESP_OFF_AID);
483
484 /* Information elements */
485 pFrame->pSuppRates = (PWLAN_IE_SUPP_RATES)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
486 + WLAN_ASSOCRESP_OFF_SUPP_RATES);
487
488 pItem = (PWLAN_IE)(pFrame->pSuppRates);
489 pItem = (PWLAN_IE)(((PBYTE)pItem) + 2 + pItem->len);
490
491 if ((((PBYTE)pItem) < (pFrame->pBuf + pFrame->len)) && (pItem->byElementID == WLAN_EID_EXTSUPP_RATES)) {
492 pFrame->pExtSuppRates = (PWLAN_IE_SUPP_RATES)pItem;
493 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "pFrame->pExtSuppRates=[%p].\n", pItem);
494 } else {
495 pFrame->pExtSuppRates = NULL;
496 }
497 return;
498 }
499
500
501 /*+
502 *
503 * Routine Description:
504 * Encode Reassociation Request
505 *
506 *
507 * Return Value:
508 * None.
509 *
510 -*/
511
512 void
513 vMgrEncodeReassocRequest(
514 PWLAN_FR_REASSOCREQ pFrame
515 )
516 {
517 pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
518
519 /* Fixed Fields */
520 pFrame->pwCapInfo = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
521 + WLAN_REASSOCREQ_OFF_CAP_INFO);
522 pFrame->pwListenInterval = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
523 + WLAN_REASSOCREQ_OFF_LISTEN_INT);
524 pFrame->pAddrCurrAP = (PIEEE_ADDR)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
525 + WLAN_REASSOCREQ_OFF_CURR_AP);
526 pFrame->len = WLAN_HDR_ADDR3_LEN + WLAN_REASSOCREQ_OFF_CURR_AP + sizeof(*(pFrame->pAddrCurrAP));
527
528 return;
529 }
530
531
532 /*+
533 *
534 * Routine Description: (AP)
535 * Decode Reassociation Request
536 *
537 *
538 * Return Value:
539 * None.
540 *
541 -*/
542
543
544 void
545 vMgrDecodeReassocRequest(
546 PWLAN_FR_REASSOCREQ pFrame
547 )
548 {
549 PWLAN_IE pItem;
550 pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
551
552 /* Fixed Fields */
553 pFrame->pwCapInfo = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
554 + WLAN_REASSOCREQ_OFF_CAP_INFO);
555 pFrame->pwListenInterval = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
556 + WLAN_REASSOCREQ_OFF_LISTEN_INT);
557 pFrame->pAddrCurrAP = (PIEEE_ADDR)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
558 + WLAN_REASSOCREQ_OFF_CURR_AP);
559
560 /* Information elements */
561 pItem = (PWLAN_IE)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
562 + WLAN_REASSOCREQ_OFF_SSID);
563
564 while (((PBYTE)pItem) < (pFrame->pBuf + pFrame->len)) {
565
566 switch (pItem->byElementID) {
567 case WLAN_EID_SSID:
568 if (pFrame->pSSID == NULL)
569 pFrame->pSSID = (PWLAN_IE_SSID)pItem;
570 break;
571 case WLAN_EID_SUPP_RATES:
572 if (pFrame->pSuppRates == NULL)
573 pFrame->pSuppRates = (PWLAN_IE_SUPP_RATES)pItem;
574 break;
575
576 case WLAN_EID_RSN:
577 if (pFrame->pRSN == NULL)
578 pFrame->pRSN = (PWLAN_IE_RSN)pItem;
579 break;
580 case WLAN_EID_RSN_WPA:
581 if (pFrame->pRSNWPA == NULL) {
582 if (WPAb_Is_RSN((PWLAN_IE_RSN_EXT)pItem) == TRUE)
583 pFrame->pRSNWPA = (PWLAN_IE_RSN_EXT)pItem;
584 }
585 break;
586
587 case WLAN_EID_EXTSUPP_RATES:
588 if (pFrame->pExtSuppRates == NULL)
589 pFrame->pExtSuppRates = (PWLAN_IE_SUPP_RATES)pItem;
590 break;
591 default:
592 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Unrecognized EID=%dd in reassocreq decode.\n",
593 pItem->byElementID);
594 break;
595 }
596 pItem = (PWLAN_IE)(((PBYTE)pItem) + 2 + pItem->len);
597 }
598 return;
599 }
600
601
602
603 /*+
604 *
605 * Routine Description:
606 * Encode Probe Request
607 *
608 *
609 * Return Value:
610 * None.
611 *
612 -*/
613
614
615 void
616 vMgrEncodeProbeRequest(
617 PWLAN_FR_PROBEREQ pFrame
618 )
619 {
620 pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
621 pFrame->len = WLAN_HDR_ADDR3_LEN;
622 return;
623 }
624
625 /*+
626 *
627 * Routine Description:
628 * Decode Probe Request
629 *
630 *
631 * Return Value:
632 * None.
633 *
634 -*/
635
636 void
637 vMgrDecodeProbeRequest(
638 PWLAN_FR_PROBEREQ pFrame
639 )
640 {
641 PWLAN_IE pItem;
642
643 pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
644
645 /* Information elements */
646 pItem = (PWLAN_IE)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3)));
647
648 while (((PBYTE)pItem) < (pFrame->pBuf + pFrame->len)) {
649
650 switch (pItem->byElementID) {
651 case WLAN_EID_SSID:
652 if (pFrame->pSSID == NULL)
653 pFrame->pSSID = (PWLAN_IE_SSID)pItem;
654 break;
655
656 case WLAN_EID_SUPP_RATES:
657 if (pFrame->pSuppRates == NULL)
658 pFrame->pSuppRates = (PWLAN_IE_SUPP_RATES)pItem;
659 break;
660
661 case WLAN_EID_EXTSUPP_RATES:
662 if (pFrame->pExtSuppRates == NULL)
663 pFrame->pExtSuppRates = (PWLAN_IE_SUPP_RATES)pItem;
664 break;
665
666 default:
667 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Bad EID=%dd in probereq\n", pItem->byElementID);
668 break;
669 }
670
671 pItem = (PWLAN_IE)(((PBYTE)pItem) + 2 + pItem->len);
672 }
673 return;
674 }
675
676
677 /*+
678 *
679 * Routine Description:
680 * Encode Probe Response
681 *
682 *
683 * Return Value:
684 * None.
685 *
686 -*/
687
688
689 void
690 vMgrEncodeProbeResponse(
691 PWLAN_FR_PROBERESP pFrame
692 )
693 {
694 pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
695
696 /* Fixed Fields */
697 pFrame->pqwTimestamp = (PQWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
698 + WLAN_PROBERESP_OFF_TS);
699 pFrame->pwBeaconInterval = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
700 + WLAN_PROBERESP_OFF_BCN_INT);
701 pFrame->pwCapInfo = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
702 + WLAN_PROBERESP_OFF_CAP_INFO);
703
704 pFrame->len = WLAN_HDR_ADDR3_LEN + WLAN_PROBERESP_OFF_CAP_INFO +
705 sizeof(*(pFrame->pwCapInfo));
706
707 return;
708 }
709
710
711
712 /*+
713 *
714 * Routine Description:
715 * Decode Probe Response
716 *
717 *
718 * Return Value:
719 * None.
720 *
721 -*/
722
723 void
724 vMgrDecodeProbeResponse(
725 PWLAN_FR_PROBERESP pFrame
726 )
727 {
728 PWLAN_IE pItem;
729
730
731 pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
732
733 /* Fixed Fields */
734 pFrame->pqwTimestamp = (PQWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
735 + WLAN_PROBERESP_OFF_TS);
736 pFrame->pwBeaconInterval = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
737 + WLAN_PROBERESP_OFF_BCN_INT);
738 pFrame->pwCapInfo = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
739 + WLAN_PROBERESP_OFF_CAP_INFO);
740
741 /* Information elements */
742 pItem = (PWLAN_IE)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
743 + WLAN_PROBERESP_OFF_SSID);
744
745 while (((PBYTE)pItem) < (pFrame->pBuf + pFrame->len)) {
746 switch (pItem->byElementID) {
747 case WLAN_EID_SSID:
748 if (pFrame->pSSID == NULL)
749 pFrame->pSSID = (PWLAN_IE_SSID)pItem;
750 break;
751 case WLAN_EID_SUPP_RATES:
752 if (pFrame->pSuppRates == NULL)
753 pFrame->pSuppRates = (PWLAN_IE_SUPP_RATES)pItem;
754 break;
755 case WLAN_EID_FH_PARMS:
756 break;
757 case WLAN_EID_DS_PARMS:
758 if (pFrame->pDSParms == NULL)
759 pFrame->pDSParms = (PWLAN_IE_DS_PARMS)pItem;
760 break;
761 case WLAN_EID_CF_PARMS:
762 if (pFrame->pCFParms == NULL)
763 pFrame->pCFParms = (PWLAN_IE_CF_PARMS)pItem;
764 break;
765 case WLAN_EID_IBSS_PARMS:
766 if (pFrame->pIBSSParms == NULL)
767 pFrame->pIBSSParms = (PWLAN_IE_IBSS_PARMS)pItem;
768 break;
769
770 case WLAN_EID_RSN:
771 if (pFrame->pRSN == NULL)
772 pFrame->pRSN = (PWLAN_IE_RSN)pItem;
773 break;
774 case WLAN_EID_RSN_WPA:
775 if (pFrame->pRSNWPA == NULL) {
776 if (WPAb_Is_RSN((PWLAN_IE_RSN_EXT)pItem) == TRUE)
777 pFrame->pRSNWPA = (PWLAN_IE_RSN_EXT)pItem;
778 }
779 break;
780 case WLAN_EID_ERP:
781 if (pFrame->pERP == NULL)
782 pFrame->pERP = (PWLAN_IE_ERP)pItem;
783 break;
784 case WLAN_EID_EXTSUPP_RATES:
785 if (pFrame->pExtSuppRates == NULL)
786 pFrame->pExtSuppRates = (PWLAN_IE_SUPP_RATES)pItem;
787 break;
788
789 case WLAN_EID_COUNTRY: /* 7 */
790 if (pFrame->pIE_Country == NULL)
791 pFrame->pIE_Country = (PWLAN_IE_COUNTRY)pItem;
792 break;
793
794 case WLAN_EID_PWR_CONSTRAINT: /* 32 */
795 if (pFrame->pIE_PowerConstraint == NULL)
796 pFrame->pIE_PowerConstraint = (PWLAN_IE_PW_CONST)pItem;
797 break;
798
799 case WLAN_EID_CH_SWITCH: /* 37 */
800 if (pFrame->pIE_CHSW == NULL)
801 pFrame->pIE_CHSW = (PWLAN_IE_CH_SW)pItem;
802 break;
803
804 case WLAN_EID_QUIET: /* 40 */
805 if (pFrame->pIE_Quiet == NULL)
806 pFrame->pIE_Quiet = (PWLAN_IE_QUIET)pItem;
807 break;
808
809 case WLAN_EID_IBSS_DFS:
810 if (pFrame->pIE_IBSSDFS == NULL)
811 pFrame->pIE_IBSSDFS = (PWLAN_IE_IBSS_DFS)pItem;
812 break;
813
814 default:
815 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Bad EID=%dd in proberesp\n", pItem->byElementID);
816 break;
817 }
818
819 pItem = (PWLAN_IE)(((PBYTE)pItem) + 2 + pItem->len);
820 }
821 return;
822 }
823
824
825 /*+
826 *
827 * Routine Description:
828 * Encode Authentication frame
829 *
830 *
831 * Return Value:
832 * None.
833 *
834 -*/
835
836 void
837 vMgrEncodeAuthen(
838 PWLAN_FR_AUTHEN pFrame
839 )
840 {
841 pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
842
843 /* Fixed Fields */
844 pFrame->pwAuthAlgorithm = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
845 + WLAN_AUTHEN_OFF_AUTH_ALG);
846 pFrame->pwAuthSequence = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
847 + WLAN_AUTHEN_OFF_AUTH_SEQ);
848 pFrame->pwStatus = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
849 + WLAN_AUTHEN_OFF_STATUS);
850 pFrame->len = WLAN_HDR_ADDR3_LEN + WLAN_AUTHEN_OFF_STATUS + sizeof(*(pFrame->pwStatus));
851 return;
852 }
853
854
855 /*+
856 *
857 * Routine Description:
858 * Decode Authentication
859 *
860 *
861 * Return Value:
862 * None.
863 *
864 -*/
865
866 void
867 vMgrDecodeAuthen(
868 PWLAN_FR_AUTHEN pFrame
869 )
870 {
871 PWLAN_IE pItem;
872
873 pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
874
875 /* Fixed Fields */
876 pFrame->pwAuthAlgorithm = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
877 + WLAN_AUTHEN_OFF_AUTH_ALG);
878 pFrame->pwAuthSequence = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
879 + WLAN_AUTHEN_OFF_AUTH_SEQ);
880 pFrame->pwStatus = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
881 + WLAN_AUTHEN_OFF_STATUS);
882
883 /* Information elements */
884 pItem = (PWLAN_IE)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
885 + WLAN_AUTHEN_OFF_CHALLENGE);
886
887 if ((((PBYTE)pItem) < (pFrame->pBuf + pFrame->len)) && (pItem->byElementID == WLAN_EID_CHALLENGE))
888 pFrame->pChallenge = (PWLAN_IE_CHALLENGE)pItem;
889 return;
890 }
891
892
893 /*+
894 *
895 * Routine Description:
896 * Encode Authentication
897 *
898 *
899 * Return Value:
900 * None.
901 *
902 -*/
903
904 void
905 vMgrEncodeDeauthen(
906 PWLAN_FR_DEAUTHEN pFrame
907 )
908 {
909 pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
910
911 /* Fixed Fields */
912 pFrame->pwReason = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
913 + WLAN_DEAUTHEN_OFF_REASON);
914 pFrame->len = WLAN_HDR_ADDR3_LEN + WLAN_DEAUTHEN_OFF_REASON + sizeof(*(pFrame->pwReason));
915 return;
916 }
917
918
919 /*+
920 *
921 * Routine Description:
922 * Decode Deauthentication
923 *
924 *
925 * Return Value:
926 * None.
927 *
928 -*/
929
930 void
931 vMgrDecodeDeauthen(
932 PWLAN_FR_DEAUTHEN pFrame
933 )
934 {
935 pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
936
937 /* Fixed Fields */
938 pFrame->pwReason = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
939 + WLAN_DEAUTHEN_OFF_REASON);
940 return;
941 }
942
943
944 /*+
945 *
946 * Routine Description: (AP)
947 * Encode Reassociation Response
948 *
949 *
950 * Return Value:
951 * None.
952 *
953 -*/
954
955 void
956 vMgrEncodeReassocResponse(
957 PWLAN_FR_REASSOCRESP pFrame
958 )
959 {
960 pFrame->pHdr = (PUWLAN_80211HDR)pFrame->pBuf;
961
962 /* Fixed Fields */
963 pFrame->pwCapInfo = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
964 + WLAN_REASSOCRESP_OFF_CAP_INFO);
965 pFrame->pwStatus = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
966 + WLAN_REASSOCRESP_OFF_STATUS);
967 pFrame->pwAid = (PWORD)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
968 + WLAN_REASSOCRESP_OFF_AID);
969
970 pFrame->len = WLAN_HDR_ADDR3_LEN + WLAN_REASSOCRESP_OFF_AID + sizeof(*(pFrame->pwAid));
971 return;
972 }
973
974
975 /*+
976 *
977 * Routine Description:
978 * Decode Reassociation Response
979 *
980 *
981 * Return Value:
982 * None.
983 *
984 -*/
985
986
987 void
988 vMgrDecodeReassocResponse(
989 PWLAN_FR_REASSOCRESP pFrame
990 )
991 {
992 PWLAN_IE pItem;
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 /* Information elements */
1005 pFrame->pSuppRates = (PWLAN_IE_SUPP_RATES)(WLAN_HDR_A3_DATA_PTR(&(pFrame->pHdr->sA3))
1006 + WLAN_REASSOCRESP_OFF_SUPP_RATES);
1007
1008 pItem = (PWLAN_IE)(pFrame->pSuppRates);
1009 pItem = (PWLAN_IE)(((PBYTE)pItem) + 2 + pItem->len);
1010
1011 if ((((PBYTE)pItem) < (pFrame->pBuf + pFrame->len)) && (pItem->byElementID == WLAN_EID_EXTSUPP_RATES))
1012 pFrame->pExtSuppRates = (PWLAN_IE_SUPP_RATES)pItem;
1013 return;
1014 }
Tomato firmware and modifications.