Staging: rt3070: remove dead MULTIPLE_CARD_SUPPORT code
[linux-2.6] / drivers / staging / rt3070 / rt_profile.c
1 /*
2  *************************************************************************
3  * Ralink Tech Inc.
4  * 5F., No.36, Taiyuan St., Jhubei City,
5  * Hsinchu County 302,
6  * Taiwan, R.O.C.
7  *
8  * (c) Copyright 2002-2007, Ralink Technology, Inc.
9  *
10  * This program is free software; you can redistribute it and/or modify  *
11  * it under the terms of the GNU General Public License as published by  *
12  * the Free Software Foundation; either version 2 of the License, or     *
13  * (at your option) any later version.                                   *
14  *                                                                       *
15  * This program is distributed in the hope that it will be useful,       *
16  * but WITHOUT ANY WARRANTY; without even the implied warranty of        *
17  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the         *
18  * GNU General Public License for more details.                          *
19  *                                                                       *
20  * You should have received a copy of the GNU General Public License     *
21  * along with this program; if not, write to the                         *
22  * Free Software Foundation, Inc.,                                       *
23  * 59 Temple Place - Suite 330, Boston, MA  02111-1307, USA.             *
24  *                                                                       *
25  *************************************************************************
26  */
27
28 #include "rt_config.h"
29
30 #ifdef DOT11_N_SUPPORT
31 static void HTParametersHook(
32         IN      PRTMP_ADAPTER pAd,
33         IN      CHAR              *pValueStr,
34         IN      CHAR              *pInput);
35 #endif // DOT11_N_SUPPORT //
36
37 #define ETH_MAC_ADDR_STR_LEN 17  // in format of xx:xx:xx:xx:xx:xx
38
39 // We assume the s1 is a sting, s2 is a memory space with 6 bytes. and content of s1 will be changed.
40 BOOLEAN rtstrmactohex(char *s1, char *s2)
41 {
42         int i = 0;
43         char *ptokS = s1, *ptokE = s1;
44
45         if (strlen(s1) != ETH_MAC_ADDR_STR_LEN)
46                 return FALSE;
47
48         while((*ptokS) != '\0')
49         {
50                 if((ptokE = strchr(ptokS, ':')) != NULL)
51                         *ptokE++ = '\0';
52                 if ((strlen(ptokS) != 2) || (!isxdigit(*ptokS)) || (!isxdigit(*(ptokS+1))))
53                         break; // fail
54                 AtoH(ptokS, &s2[i++], 1);
55                 ptokS = ptokE;
56                 if (i == 6)
57                         break; // parsing finished
58         }
59
60         return ( i == 6 ? TRUE : FALSE);
61
62 }
63
64
65 // we assume the s1 and s2 both are strings.
66 BOOLEAN rtstrcasecmp(char *s1, char *s2)
67 {
68         char *p1 = s1, *p2 = s2;
69
70         if (strlen(s1) != strlen(s2))
71                 return FALSE;
72
73         while(*p1 != '\0')
74         {
75                 if((*p1 != *p2) && ((*p1 ^ *p2) != 0x20))
76                         return FALSE;
77                 p1++;
78                 p2++;
79         }
80
81         return TRUE;
82 }
83
84 // we assume the s1 (buffer) and s2 (key) both are strings.
85 char * rtstrstruncasecmp(char * s1, char * s2)
86 {
87         INT l1, l2, i;
88         char temp1, temp2;
89
90         l2 = strlen(s2);
91         if (!l2)
92                 return (char *) s1;
93
94         l1 = strlen(s1);
95
96         while (l1 >= l2)
97         {
98                 l1--;
99
100                 for(i=0; i<l2; i++)
101                 {
102                         temp1 = *(s1+i);
103                         temp2 = *(s2+i);
104
105                         if (('a' <= temp1) && (temp1 <= 'z'))
106                                 temp1 = 'A'+(temp1-'a');
107                         if (('a' <= temp2) && (temp2 <= 'z'))
108                                 temp2 = 'A'+(temp2-'a');
109
110                         if (temp1 != temp2)
111                                 break;
112                 }
113
114                 if (i == l2)
115                         return (char *) s1;
116
117                 s1++;
118         }
119
120         return NULL; // not found
121 }
122
123 //add by kathy
124
125  /**
126   * strstr - Find the first substring in a %NUL terminated string
127   * @s1: The string to be searched
128   * @s2: The string to search for
129   */
130 char * rtstrstr(const char * s1,const char * s2)
131 {
132         INT l1, l2;
133
134         l2 = strlen(s2);
135         if (!l2)
136                 return (char *) s1;
137
138         l1 = strlen(s1);
139
140         while (l1 >= l2)
141         {
142                 l1--;
143                 if (!memcmp(s1,s2,l2))
144                         return (char *) s1;
145                 s1++;
146         }
147
148         return NULL;
149 }
150
151 /**
152  * rstrtok - Split a string into tokens
153  * @s: The string to be searched
154  * @ct: The characters to search for
155  * * WARNING: strtok is deprecated, use strsep instead. However strsep is not compatible with old architecture.
156  */
157 char * __rstrtok;
158 char * rstrtok(char * s,const char * ct)
159 {
160         char *sbegin, *send;
161
162         sbegin  = s ? s : __rstrtok;
163         if (!sbegin)
164         {
165                 return NULL;
166         }
167
168         sbegin += strspn(sbegin,ct);
169         if (*sbegin == '\0')
170         {
171                 __rstrtok = NULL;
172                 return( NULL );
173         }
174
175         send = strpbrk( sbegin, ct);
176         if (send && *send != '\0')
177                 *send++ = '\0';
178
179         __rstrtok = send;
180
181         return (sbegin);
182 }
183
184 /**
185  * delimitcnt - return the count of a given delimiter in a given string.
186  * @s: The string to be searched.
187  * @ct: The delimiter to search for.
188  * Notice : We suppose the delimiter is a single-char string(for example : ";").
189  */
190 INT delimitcnt(char * s,const char * ct)
191 {
192         INT count = 0;
193         /* point to the beginning of the line */
194         const char *token = s;
195
196         for ( ;; )
197         {
198                 token = strpbrk(token, ct); /* search for delimiters */
199
200         if ( token == NULL )
201                 {
202                         /* advanced to the terminating null character */
203                         break;
204                 }
205                 /* skip the delimiter */
206             ++token;
207
208                 /*
209                  * Print the found text: use len with %.*s to specify field width.
210                  */
211
212                 /* accumulate delimiter count */
213             ++count;
214         }
215     return count;
216 }
217
218 /*
219   * converts the Internet host address from the standard numbers-and-dots notation
220   * into binary data.
221   * returns nonzero if the address is valid, zero if not.
222   */
223 int rtinet_aton(const char *cp, unsigned int *addr)
224 {
225         unsigned int    val;
226         int             base, n;
227         char            c;
228         unsigned int    parts[4];
229         unsigned int    *pp = parts;
230
231         for (;;)
232     {
233          /*
234           * Collect number up to ``.''.
235           * Values are specified as for C:
236           *     0x=hex, 0=octal, other=decimal.
237           */
238          val = 0;
239          base = 10;
240          if (*cp == '0')
241          {
242              if (*++cp == 'x' || *cp == 'X')
243                  base = 16, cp++;
244              else
245                  base = 8;
246          }
247          while ((c = *cp) != '\0')
248          {
249              if (isdigit((unsigned char) c))
250              {
251                  val = (val * base) + (c - '0');
252                  cp++;
253                  continue;
254              }
255              if (base == 16 && isxdigit((unsigned char) c))
256              {
257                  val = (val << 4) +
258                      (c + 10 - (islower((unsigned char) c) ? 'a' : 'A'));
259                  cp++;
260                  continue;
261              }
262              break;
263          }
264          if (*cp == '.')
265          {
266              /*
267               * Internet format: a.b.c.d a.b.c   (with c treated as 16-bits)
268               * a.b     (with b treated as 24 bits)
269               */
270              if (pp >= parts + 3 || val > 0xff)
271                  return 0;
272              *pp++ = val, cp++;
273          }
274          else
275              break;
276      }
277
278      /*
279       * Check for trailing junk.
280       */
281      while (*cp)
282          if (!isspace((unsigned char) *cp++))
283              return 0;
284
285      /*
286       * Concoct the address according to the number of parts specified.
287       */
288      n = pp - parts + 1;
289      switch (n)
290      {
291
292          case 1:         /* a -- 32 bits */
293              break;
294
295          case 2:         /* a.b -- 8.24 bits */
296              if (val > 0xffffff)
297                  return 0;
298              val |= parts[0] << 24;
299              break;
300
301          case 3:         /* a.b.c -- 8.8.16 bits */
302              if (val > 0xffff)
303                  return 0;
304              val |= (parts[0] << 24) | (parts[1] << 16);
305              break;
306
307          case 4:         /* a.b.c.d -- 8.8.8.8 bits */
308              if (val > 0xff)
309                  return 0;
310              val |= (parts[0] << 24) | (parts[1] << 16) | (parts[2] << 8);
311              break;
312      }
313
314      *addr = htonl(val);
315      return 1;
316
317 }
318
319 /*
320     ========================================================================
321
322     Routine Description:
323         Find key section for Get key parameter.
324
325     Arguments:
326         buffer                      Pointer to the buffer to start find the key section
327         section                     the key of the secion to be find
328
329     Return Value:
330         NULL                        Fail
331         Others                      Success
332     ========================================================================
333 */
334 PUCHAR  RTMPFindSection(
335     IN  PCHAR   buffer)
336 {
337     CHAR temp_buf[32];
338     PUCHAR  ptr;
339
340     strcpy(temp_buf, "Default");
341
342     if((ptr = rtstrstr(buffer, temp_buf)) != NULL)
343             return (ptr+strlen("\n"));
344         else
345             return NULL;
346 }
347
348 /*
349     ========================================================================
350
351     Routine Description:
352         Get key parameter.
353
354     Arguments:
355         key                         Pointer to key string
356         dest                        Pointer to destination
357         destsize                    The datasize of the destination
358         buffer                      Pointer to the buffer to start find the key
359
360     Return Value:
361         TRUE                        Success
362         FALSE                       Fail
363
364     Note:
365         This routine get the value with the matched key (case case-sensitive)
366     ========================================================================
367 */
368 INT RTMPGetKeyParameter(
369     IN  PCHAR   key,
370     OUT PCHAR   dest,
371     IN  INT     destsize,
372     IN  PCHAR   buffer)
373 {
374     UCHAR *temp_buf1 = NULL;
375     UCHAR *temp_buf2 = NULL;
376     CHAR *start_ptr;
377     CHAR *end_ptr;
378     CHAR *ptr;
379     CHAR *offset = 0;
380     INT  len;
381
382         //temp_buf1 = kmalloc(MAX_PARAM_BUFFER_SIZE, MEM_ALLOC_FLAG);
383         os_alloc_mem(NULL, &temp_buf1, MAX_PARAM_BUFFER_SIZE);
384
385         if(temp_buf1 == NULL)
386         return (FALSE);
387
388         //temp_buf2 = kmalloc(MAX_PARAM_BUFFER_SIZE, MEM_ALLOC_FLAG);
389         os_alloc_mem(NULL, &temp_buf2, MAX_PARAM_BUFFER_SIZE);
390         if(temp_buf2 == NULL)
391         {
392                 os_free_mem(NULL, temp_buf1);
393         return (FALSE);
394         }
395
396     //find section
397     if((offset = RTMPFindSection(buffer)) == NULL)
398     {
399         os_free_mem(NULL, temp_buf1);
400         os_free_mem(NULL, temp_buf2);
401         return (FALSE);
402     }
403
404     strcpy(temp_buf1, "\n");
405     strcat(temp_buf1, key);
406     strcat(temp_buf1, "=");
407
408     //search key
409     if((start_ptr=rtstrstr(offset, temp_buf1))==NULL)
410     {
411                 os_free_mem(NULL, temp_buf1);
412         os_free_mem(NULL, temp_buf2);
413         return (FALSE);
414     }
415
416     start_ptr+=strlen("\n");
417     if((end_ptr=rtstrstr(start_ptr, "\n"))==NULL)
418        end_ptr=start_ptr+strlen(start_ptr);
419
420     if (end_ptr<start_ptr)
421     {
422                 os_free_mem(NULL, temp_buf1);
423         os_free_mem(NULL, temp_buf2);
424         return (FALSE);
425     }
426
427     NdisMoveMemory(temp_buf2, start_ptr, end_ptr-start_ptr);
428     temp_buf2[end_ptr-start_ptr]='\0';
429     len = strlen(temp_buf2);
430     strcpy(temp_buf1, temp_buf2);
431     if((start_ptr=rtstrstr(temp_buf1, "=")) == NULL)
432     {
433                 os_free_mem(NULL, temp_buf1);
434         os_free_mem(NULL, temp_buf2);
435         return (FALSE);
436     }
437
438     strcpy(temp_buf2, start_ptr+1);
439     ptr = temp_buf2;
440     //trim space or tab
441     while(*ptr != 0x00)
442     {
443         if( (*ptr == ' ') || (*ptr == '\t') )
444             ptr++;
445         else
446            break;
447     }
448
449     len = strlen(ptr);
450     memset(dest, 0x00, destsize);
451     strncpy(dest, ptr, len >= destsize ?  destsize: len);
452
453         os_free_mem(NULL, temp_buf1);
454     os_free_mem(NULL, temp_buf2);
455     return TRUE;
456 }
457
458 /*
459     ========================================================================
460
461     Routine Description:
462         Get key parameter.
463
464     Arguments:
465         key                         Pointer to key string
466         dest                        Pointer to destination
467         destsize                    The datasize of the destination
468         buffer                      Pointer to the buffer to start find the key
469
470     Return Value:
471         TRUE                        Success
472         FALSE                       Fail
473
474     Note:
475         This routine get the value with the matched key (case case-sensitive).
476         It is called for parsing SSID and any key string.
477     ========================================================================
478 */
479 INT RTMPGetCriticalParameter(
480     IN  PCHAR   key,
481     OUT PCHAR   dest,
482     IN  INT     destsize,
483     IN  PCHAR   buffer)
484 {
485     UCHAR *temp_buf1 = NULL;
486     UCHAR *temp_buf2 = NULL;
487     CHAR *start_ptr;
488     CHAR *end_ptr;
489     CHAR *ptr;
490     CHAR *offset = 0;
491     INT  len;
492
493         //temp_buf1 = kmalloc(MAX_PARAM_BUFFER_SIZE, MEM_ALLOC_FLAG);
494         os_alloc_mem(NULL, &temp_buf1, MAX_PARAM_BUFFER_SIZE);
495
496         if(temp_buf1 == NULL)
497         return (FALSE);
498
499         //temp_buf2 = kmalloc(MAX_PARAM_BUFFER_SIZE, MEM_ALLOC_FLAG);
500         os_alloc_mem(NULL, &temp_buf2, MAX_PARAM_BUFFER_SIZE);
501         if(temp_buf2 == NULL)
502         {
503                 os_free_mem(NULL, temp_buf1);
504         return (FALSE);
505         }
506
507     //find section
508     if((offset = RTMPFindSection(buffer)) == NULL)
509     {
510         os_free_mem(NULL, temp_buf1);
511         os_free_mem(NULL, temp_buf2);
512         return (FALSE);
513     }
514
515     strcpy(temp_buf1, "\n");
516     strcat(temp_buf1, key);
517     strcat(temp_buf1, "=");
518
519     //search key
520     if((start_ptr=rtstrstr(offset, temp_buf1))==NULL)
521     {
522                 os_free_mem(NULL, temp_buf1);
523         os_free_mem(NULL, temp_buf2);
524         return (FALSE);
525     }
526
527     start_ptr+=strlen("\n");
528     if((end_ptr=rtstrstr(start_ptr, "\n"))==NULL)
529        end_ptr=start_ptr+strlen(start_ptr);
530
531     if (end_ptr<start_ptr)
532     {
533                 os_free_mem(NULL, temp_buf1);
534         os_free_mem(NULL, temp_buf2);
535         return (FALSE);
536     }
537
538     NdisMoveMemory(temp_buf2, start_ptr, end_ptr-start_ptr);
539     temp_buf2[end_ptr-start_ptr]='\0';
540     len = strlen(temp_buf2);
541     strcpy(temp_buf1, temp_buf2);
542     if((start_ptr=rtstrstr(temp_buf1, "=")) == NULL)
543     {
544                 os_free_mem(NULL, temp_buf1);
545         os_free_mem(NULL, temp_buf2);
546         return (FALSE);
547     }
548
549     strcpy(temp_buf2, start_ptr+1);
550     ptr = temp_buf2;
551
552     //trim tab
553     /* We cannot trim space(' ') for SSID and key string. */
554     while(*ptr != 0x00)
555     {
556         //if( (*ptr == ' ') || (*ptr == '\t') )
557         if( (*ptr == '\t') )
558             ptr++;
559         else
560            break;
561     }
562
563     len = strlen(ptr);
564     memset(dest, 0x00, destsize);
565     strncpy(dest, ptr, len >= destsize ?  destsize: len);
566
567         os_free_mem(NULL, temp_buf1);
568     os_free_mem(NULL, temp_buf2);
569     return TRUE;
570 }
571
572 /*
573     ========================================================================
574
575     Routine Description:
576         Get multiple key parameter.
577
578     Arguments:
579         key                         Pointer to key string
580         dest                        Pointer to destination
581         destsize                    The datasize of the destination
582         buffer                      Pointer to the buffer to start find the key
583
584     Return Value:
585         TRUE                        Success
586         FALSE                       Fail
587
588     Note:
589         This routine get the value with the matched key (case case-sensitive)
590     ========================================================================
591 */
592 INT RTMPGetKeyParameterWithOffset(
593     IN  PCHAR   key,
594     OUT PCHAR   dest,
595     OUT USHORT  *end_offset,
596     IN  INT     destsize,
597     IN  PCHAR   buffer,
598     IN  BOOLEAN bTrimSpace)
599 {
600     UCHAR *temp_buf1 = NULL;
601     UCHAR *temp_buf2 = NULL;
602     CHAR *start_ptr;
603     CHAR *end_ptr;
604     CHAR *ptr;
605     CHAR *offset = 0;
606     INT  len;
607
608         if (*end_offset >= MAX_INI_BUFFER_SIZE)
609                 return (FALSE);
610
611         os_alloc_mem(NULL, &temp_buf1, MAX_PARAM_BUFFER_SIZE);
612
613         if(temp_buf1 == NULL)
614         return (FALSE);
615
616         os_alloc_mem(NULL, &temp_buf2, MAX_PARAM_BUFFER_SIZE);
617         if(temp_buf2 == NULL)
618         {
619                 os_free_mem(NULL, temp_buf1);
620         return (FALSE);
621         }
622
623     //find section
624         if(*end_offset == 0)
625     {
626                 if ((offset = RTMPFindSection(buffer)) == NULL)
627                 {
628                         os_free_mem(NULL, temp_buf1);
629                 os_free_mem(NULL, temp_buf2);
630             return (FALSE);
631                 }
632     }
633         else
634                 offset = buffer + (*end_offset);
635
636     strcpy(temp_buf1, "\n");
637     strcat(temp_buf1, key);
638     strcat(temp_buf1, "=");
639
640     //search key
641     if((start_ptr=rtstrstr(offset, temp_buf1))==NULL)
642     {
643                 os_free_mem(NULL, temp_buf1);
644         os_free_mem(NULL, temp_buf2);
645         return (FALSE);
646     }
647
648     start_ptr+=strlen("\n");
649     if((end_ptr=rtstrstr(start_ptr, "\n"))==NULL)
650        end_ptr=start_ptr+strlen(start_ptr);
651
652     if (end_ptr<start_ptr)
653     {
654                 os_free_mem(NULL, temp_buf1);
655         os_free_mem(NULL, temp_buf2);
656         return (FALSE);
657     }
658
659         *end_offset = end_ptr - buffer;
660
661     NdisMoveMemory(temp_buf2, start_ptr, end_ptr-start_ptr);
662     temp_buf2[end_ptr-start_ptr]='\0';
663     len = strlen(temp_buf2);
664     strcpy(temp_buf1, temp_buf2);
665     if((start_ptr=rtstrstr(temp_buf1, "=")) == NULL)
666     {
667                 os_free_mem(NULL, temp_buf1);
668         os_free_mem(NULL, temp_buf2);
669         return (FALSE);
670     }
671
672     strcpy(temp_buf2, start_ptr+1);
673     ptr = temp_buf2;
674     //trim space or tab
675     while(*ptr != 0x00)
676     {
677         if((bTrimSpace && (*ptr == ' ')) || (*ptr == '\t') )
678             ptr++;
679         else
680            break;
681     }
682
683     len = strlen(ptr);
684     memset(dest, 0x00, destsize);
685     strncpy(dest, ptr, len >= destsize ?  destsize: len);
686
687         os_free_mem(NULL, temp_buf1);
688     os_free_mem(NULL, temp_buf2);
689     return TRUE;
690 }
691
692
693 static int rtmp_parse_key_buffer_from_file(IN  PRTMP_ADAPTER pAd,IN  char *buffer,IN  ULONG KeyType,IN  INT BSSIdx,IN  INT KeyIdx)
694 {
695         PUCHAR          keybuff;
696         INT                     i = BSSIdx, idx = KeyIdx;
697         ULONG           KeyLen;
698         UCHAR           CipherAlg = CIPHER_WEP64;
699
700         keybuff = buffer;
701         KeyLen = strlen(keybuff);
702
703         if (KeyType == 1)
704         {//Ascii
705                 if( (KeyLen == 5) || (KeyLen == 13))
706                 {
707                         pAd->SharedKey[i][idx].KeyLen = KeyLen;
708                         NdisMoveMemory(pAd->SharedKey[i][idx].Key, keybuff, KeyLen);
709                         if (KeyLen == 5)
710                                 CipherAlg = CIPHER_WEP64;
711                         else
712                                 CipherAlg = CIPHER_WEP128;
713                         pAd->SharedKey[i][idx].CipherAlg = CipherAlg;
714
715                         DBGPRINT(RT_DEBUG_TRACE, ("I/F(ra%d) Key%dStr=%s and type=%s\n", i, idx+1, keybuff, (KeyType == 0) ? "Hex":"Ascii"));
716                         return 1;
717                 }
718                 else
719                 {//Invalid key length
720                         DBGPRINT(RT_DEBUG_ERROR, ("Key%dStr is Invalid key length! KeyLen = %ld!\n", idx+1, KeyLen));
721                         return 0;
722                 }
723         }
724         else
725         {//Hex type
726                 if( (KeyLen == 10) || (KeyLen == 26))
727                 {
728                         pAd->SharedKey[i][idx].KeyLen = KeyLen / 2;
729                         AtoH(keybuff, pAd->SharedKey[i][idx].Key, KeyLen / 2);
730                         if (KeyLen == 10)
731                                 CipherAlg = CIPHER_WEP64;
732                         else
733                                 CipherAlg = CIPHER_WEP128;
734                         pAd->SharedKey[i][idx].CipherAlg = CipherAlg;
735
736                         DBGPRINT(RT_DEBUG_TRACE, ("I/F(ra%d) Key%dStr=%s and type=%s\n", i, idx+1, keybuff, (KeyType == 0) ? "Hex":"Ascii"));
737                         return 1;
738                 }
739                 else
740                 {//Invalid key length
741                         DBGPRINT(RT_DEBUG_ERROR, ("I/F(ra%d) Key%dStr is Invalid key length! KeyLen = %ld!\n", i, idx+1, KeyLen));
742                         return 0;
743                 }
744         }
745 }
746 static void rtmp_read_key_parms_from_file(IN  PRTMP_ADAPTER pAd, char *tmpbuf, char *buffer)
747 {
748         char            tok_str[16];
749         PUCHAR          macptr;
750         INT                     i = 0, idx;
751         ULONG           KeyType[MAX_MBSSID_NUM];
752         ULONG           KeyIdx;
753
754         NdisZeroMemory(KeyType, MAX_MBSSID_NUM);
755
756         //DefaultKeyID
757         if(RTMPGetKeyParameter("DefaultKeyID", tmpbuf, 25, buffer))
758         {
759
760 #ifdef CONFIG_STA_SUPPORT
761                 IF_DEV_CONFIG_OPMODE_ON_STA(pAd)
762                 {
763                         KeyIdx = simple_strtol(tmpbuf, 0, 10);
764                         if((KeyIdx >= 1 ) && (KeyIdx <= 4))
765                                 pAd->StaCfg.DefaultKeyId = (UCHAR) (KeyIdx - 1);
766                         else
767                                 pAd->StaCfg.DefaultKeyId = 0;
768
769                         DBGPRINT(RT_DEBUG_TRACE, ("DefaultKeyID(0~3)=%d\n", pAd->StaCfg.DefaultKeyId));
770                 }
771 #endif // CONFIG_STA_SUPPORT //
772         }
773
774
775         for (idx = 0; idx < 4; idx++)
776         {
777                 sprintf(tok_str, "Key%dType", idx + 1);
778                 //Key1Type
779                 if (RTMPGetKeyParameter(tok_str, tmpbuf, 128, buffer))
780                 {
781                     for (i = 0, macptr = rstrtok(tmpbuf,";"); macptr; macptr = rstrtok(NULL,";"), i++)
782                     {
783                             KeyType[i] = simple_strtol(macptr, 0, 10);
784                     }
785
786 #ifdef CONFIG_STA_SUPPORT
787                         IF_DEV_CONFIG_OPMODE_ON_STA(pAd)
788                         {
789                                 sprintf(tok_str, "Key%dStr", idx + 1);
790                                 if (RTMPGetCriticalParameter(tok_str, tmpbuf, 128, buffer))
791                                 {
792                                         rtmp_parse_key_buffer_from_file(pAd, tmpbuf, KeyType[BSS0], BSS0, idx);
793                                 }
794                         }
795 #endif // CONFIG_STA_SUPPORT //
796                 }
797         }
798 }
799
800
801 #ifdef CONFIG_STA_SUPPORT
802 static void rtmp_read_sta_wmm_parms_from_file(IN  PRTMP_ADAPTER pAd, char *tmpbuf, char *buffer)
803 {
804         PUCHAR                                  macptr;
805         INT                                             i=0;
806         BOOLEAN                                 bWmmEnable = FALSE;
807
808         //WmmCapable
809         if(RTMPGetKeyParameter("WmmCapable", tmpbuf, 32, buffer))
810         {
811                 if(simple_strtol(tmpbuf, 0, 10) != 0) //Enable
812                 {
813                         pAd->CommonCfg.bWmmCapable = TRUE;
814                         bWmmEnable = TRUE;
815                 }
816                 else //Disable
817                 {
818                         pAd->CommonCfg.bWmmCapable = FALSE;
819                 }
820
821                 DBGPRINT(RT_DEBUG_TRACE, ("WmmCapable=%d\n", pAd->CommonCfg.bWmmCapable));
822         }
823
824 #ifdef QOS_DLS_SUPPORT
825         //DLSCapable
826         if(RTMPGetKeyParameter("DLSCapable", tmpbuf, 32, buffer))
827         {
828                 if(simple_strtol(tmpbuf, 0, 10) != 0)  //Enable
829                 {
830                         pAd->CommonCfg.bDLSCapable = TRUE;
831                 }
832                 else //Disable
833                 {
834                         pAd->CommonCfg.bDLSCapable = FALSE;
835                 }
836
837                 DBGPRINT(RT_DEBUG_TRACE, ("bDLSCapable=%d\n", pAd->CommonCfg.bDLSCapable));
838         }
839 #endif // QOS_DLS_SUPPORT //
840
841         //AckPolicy for AC_BK, AC_BE, AC_VI, AC_VO
842         if(RTMPGetKeyParameter("AckPolicy", tmpbuf, 32, buffer))
843         {
844                 for (i = 0, macptr = rstrtok(tmpbuf,";"); macptr; macptr = rstrtok(NULL,";"), i++)
845                 {
846                         pAd->CommonCfg.AckPolicy[i] = (UCHAR)simple_strtol(macptr, 0, 10);
847
848                         DBGPRINT(RT_DEBUG_TRACE, ("AckPolicy[%d]=%d\n", i, pAd->CommonCfg.AckPolicy[i]));
849                 }
850         }
851
852         if (bWmmEnable)
853         {
854                 //APSDCapable
855                 if(RTMPGetKeyParameter("APSDCapable", tmpbuf, 10, buffer))
856                 {
857                         if(simple_strtol(tmpbuf, 0, 10) != 0)  //Enable
858                                 pAd->CommonCfg.bAPSDCapable = TRUE;
859                         else
860                                 pAd->CommonCfg.bAPSDCapable = FALSE;
861
862                         DBGPRINT(RT_DEBUG_TRACE, ("APSDCapable=%d\n", pAd->CommonCfg.bAPSDCapable));
863                 }
864
865                 //APSDAC for AC_BE, AC_BK, AC_VI, AC_VO
866                 if(RTMPGetKeyParameter("APSDAC", tmpbuf, 32, buffer))
867                 {
868                         BOOLEAN apsd_ac[4];
869
870                         for (i = 0, macptr = rstrtok(tmpbuf,";"); macptr; macptr = rstrtok(NULL,";"), i++)
871                         {
872                                 apsd_ac[i] = (BOOLEAN)simple_strtol(macptr, 0, 10);
873
874                                 DBGPRINT(RT_DEBUG_TRACE, ("APSDAC%d  %d\n", i,  apsd_ac[i]));
875                         }
876
877                         pAd->CommonCfg.bAPSDAC_BE = apsd_ac[0];
878                         pAd->CommonCfg.bAPSDAC_BK = apsd_ac[1];
879                         pAd->CommonCfg.bAPSDAC_VI = apsd_ac[2];
880                         pAd->CommonCfg.bAPSDAC_VO = apsd_ac[3];
881                 }
882         }
883
884 }
885 #endif // CONFIG_STA_SUPPORT //
886
887
888 NDIS_STATUS     RTMPReadParametersHook(
889         IN      PRTMP_ADAPTER pAd)
890 {
891         PUCHAR                                  src = NULL;
892         struct file                             *srcf;
893         INT                                     retval, orgfsuid, orgfsgid;
894         mm_segment_t                    orgfs;
895         CHAR                                    *buffer;
896         CHAR                                    *tmpbuf;
897         ULONG                                   RtsThresh;
898         ULONG                                   FragThresh;
899 #ifdef CONFIG_STA_SUPPORT
900         UCHAR                   keyMaterial[40];
901 #endif // CONFIG_STA_SUPPORT //
902
903
904         PUCHAR                                  macptr;
905         INT                                             i = 0;
906
907         buffer = kmalloc(MAX_INI_BUFFER_SIZE, MEM_ALLOC_FLAG);
908         if(buffer == NULL)
909         return NDIS_STATUS_FAILURE;
910
911         tmpbuf = kmalloc(MAX_PARAM_BUFFER_SIZE, MEM_ALLOC_FLAG);
912         if(tmpbuf == NULL)
913         {
914                 kfree(buffer);
915         return NDIS_STATUS_FAILURE;
916         }
917
918 #ifdef CONFIG_STA_SUPPORT
919         IF_DEV_CONFIG_OPMODE_ON_STA(pAd)
920                 src = STA_PROFILE_PATH;
921 #endif // CONFIG_STA_SUPPORT //
922
923         // Save uid and gid used for filesystem access.
924         // Set user and group to 0 (root)
925 #if 0
926         orgfsuid = current->fsuid;
927         orgfsgid = current->fsgid;
928         current->fsuid=current->fsgid = 0;
929 #endif
930     orgfs = get_fs();
931     set_fs(KERNEL_DS);
932
933         if (src && *src)
934         {
935                 srcf = filp_open(src, O_RDONLY, 0);
936                 if (IS_ERR(srcf))
937                 {
938                         DBGPRINT(RT_DEBUG_ERROR, ("--> Error %ld opening %s\n", -PTR_ERR(srcf),src));
939                 }
940                 else
941                 {
942                         // The object must have a read method
943                         if (srcf->f_op && srcf->f_op->read)
944                         {
945                                 memset(buffer, 0x00, MAX_INI_BUFFER_SIZE);
946                                 retval=srcf->f_op->read(srcf, buffer, MAX_INI_BUFFER_SIZE, &srcf->f_pos);
947                                 if (retval < 0)
948                                 {
949                                         DBGPRINT(RT_DEBUG_TRACE, ("--> Read %s error %d\n", src, -retval));
950                                 }
951                                 else
952                                 {
953                                         // set file parameter to portcfg
954                                         //CountryRegion
955                                         if(RTMPGetKeyParameter("CountryRegion", tmpbuf, 25, buffer))
956                                         {
957                                                 pAd->CommonCfg.CountryRegion = (UCHAR) simple_strtol(tmpbuf, 0, 10);
958                                                 DBGPRINT(RT_DEBUG_TRACE, ("CountryRegion=%d\n", pAd->CommonCfg.CountryRegion));
959                                         }
960                                         //CountryRegionABand
961                                         if(RTMPGetKeyParameter("CountryRegionABand", tmpbuf, 25, buffer))
962                                         {
963                                                 pAd->CommonCfg.CountryRegionForABand= (UCHAR) simple_strtol(tmpbuf, 0, 10);
964                                                 DBGPRINT(RT_DEBUG_TRACE, ("CountryRegionABand=%d\n", pAd->CommonCfg.CountryRegionForABand));
965                                         }
966                                         //CountryCode
967                                         if(RTMPGetKeyParameter("CountryCode", tmpbuf, 25, buffer))
968                                         {
969                                                 NdisMoveMemory(pAd->CommonCfg.CountryCode, tmpbuf , 2);
970 #ifdef CONFIG_STA_SUPPORT
971 #ifdef EXT_BUILD_CHANNEL_LIST
972                                                 IF_DEV_CONFIG_OPMODE_ON_STA(pAd)
973                                                         NdisMoveMemory(pAd->StaCfg.StaOriCountryCode, tmpbuf , 2);
974 #endif // EXT_BUILD_CHANNEL_LIST //
975 #endif // CONFIG_STA_SUPPORT //
976                                                 if (strlen(pAd->CommonCfg.CountryCode) != 0)
977                                                 {
978                                                         pAd->CommonCfg.bCountryFlag = TRUE;
979                                                 }
980                                                 DBGPRINT(RT_DEBUG_TRACE, ("CountryCode=%s\n", pAd->CommonCfg.CountryCode));
981                                         }
982                                         //ChannelGeography
983                                         if(RTMPGetKeyParameter("ChannelGeography", tmpbuf, 25, buffer))
984                                         {
985                                                 UCHAR Geography = (UCHAR) simple_strtol(tmpbuf, 0, 10);
986                                                 if (Geography <= BOTH)
987                                                 {
988                                                         pAd->CommonCfg.Geography = Geography;
989                                                         pAd->CommonCfg.CountryCode[2] =
990                                                                 (pAd->CommonCfg.Geography == BOTH) ? ' ' : ((pAd->CommonCfg.Geography == IDOR) ? 'I' : 'O');
991 #ifdef CONFIG_STA_SUPPORT
992 #ifdef EXT_BUILD_CHANNEL_LIST
993                                                 IF_DEV_CONFIG_OPMODE_ON_STA(pAd)
994                                                         pAd->StaCfg.StaOriGeography = pAd->CommonCfg.Geography;
995 #endif // EXT_BUILD_CHANNEL_LIST //
996 #endif // CONFIG_STA_SUPPORT //
997                                                         DBGPRINT(RT_DEBUG_TRACE, ("ChannelGeography=%d\n", pAd->CommonCfg.Geography));
998                                                 }
999                                         }
1000                                         else
1001                                         {
1002                                                 pAd->CommonCfg.Geography = BOTH;
1003                                                 pAd->CommonCfg.CountryCode[2] = ' ';
1004                                         }
1005
1006
1007 #ifdef CONFIG_STA_SUPPORT
1008                                         IF_DEV_CONFIG_OPMODE_ON_STA(pAd)
1009                                         {
1010                                                 //SSID
1011                                                 if (RTMPGetCriticalParameter("SSID", tmpbuf, 256, buffer))
1012                                                 {
1013                                                         if (strlen(tmpbuf) <= 32)
1014                                                         {
1015                                                                 pAd->CommonCfg.SsidLen = (UCHAR) strlen(tmpbuf);
1016                                                                 NdisZeroMemory(pAd->CommonCfg.Ssid, NDIS_802_11_LENGTH_SSID);
1017                                                                 NdisMoveMemory(pAd->CommonCfg.Ssid, tmpbuf, pAd->CommonCfg.SsidLen);
1018                                                                 pAd->MlmeAux.AutoReconnectSsidLen = pAd->CommonCfg.SsidLen;
1019                                                                 NdisZeroMemory(pAd->MlmeAux.AutoReconnectSsid, NDIS_802_11_LENGTH_SSID);
1020                                                                 NdisMoveMemory(pAd->MlmeAux.AutoReconnectSsid, tmpbuf, pAd->MlmeAux.AutoReconnectSsidLen);
1021                                                                 pAd->MlmeAux.SsidLen = pAd->CommonCfg.SsidLen;
1022                                                                 NdisZeroMemory(pAd->MlmeAux.Ssid, NDIS_802_11_LENGTH_SSID);
1023                                                                 NdisMoveMemory(pAd->MlmeAux.Ssid, tmpbuf, pAd->MlmeAux.SsidLen);
1024                                                                 DBGPRINT(RT_DEBUG_TRACE, ("%s::(SSID=%s)\n", __func__, tmpbuf));
1025                                                         }
1026                                                 }
1027                                         }
1028 #endif // CONFIG_STA_SUPPORT //
1029
1030 #ifdef CONFIG_STA_SUPPORT
1031                                         IF_DEV_CONFIG_OPMODE_ON_STA(pAd)
1032                                         {
1033                                                 //NetworkType
1034                                                 if (RTMPGetKeyParameter("NetworkType", tmpbuf, 25, buffer))
1035                                                 {
1036                                                         pAd->bConfigChanged = TRUE;
1037                                                         if (strcmp(tmpbuf, "Adhoc") == 0)
1038                                                                 pAd->StaCfg.BssType = BSS_ADHOC;
1039                                                         else //Default Infrastructure mode
1040                                                                 pAd->StaCfg.BssType = BSS_INFRA;
1041                                                         // Reset Ralink supplicant to not use, it will be set to start when UI set PMK key
1042                                                         pAd->StaCfg.WpaState = SS_NOTUSE;
1043                                                         DBGPRINT(RT_DEBUG_TRACE, ("%s::(NetworkType=%d)\n", __func__, pAd->StaCfg.BssType));
1044                                                 }
1045                                         }
1046 #endif // CONFIG_STA_SUPPORT //
1047                                         //Channel
1048                                         if(RTMPGetKeyParameter("Channel", tmpbuf, 10, buffer))
1049                                         {
1050                                                 pAd->CommonCfg.Channel = (UCHAR) simple_strtol(tmpbuf, 0, 10);
1051                                                 DBGPRINT(RT_DEBUG_TRACE, ("Channel=%d\n", pAd->CommonCfg.Channel));
1052                                         }
1053                                         //WirelessMode
1054                                         if(RTMPGetKeyParameter("WirelessMode", tmpbuf, 10, buffer))
1055                                         {
1056                                                 int value  = 0, maxPhyMode = PHY_11G;
1057
1058 #ifdef DOT11_N_SUPPORT
1059                                                 maxPhyMode = PHY_11N_5G;
1060 #endif // DOT11_N_SUPPORT //
1061
1062                                                 value = simple_strtol(tmpbuf, 0, 10);
1063
1064                                                 if (value <= maxPhyMode)
1065                                                 {
1066                                                         pAd->CommonCfg.PhyMode = value;
1067                                                 }
1068                                                 DBGPRINT(RT_DEBUG_TRACE, ("PhyMode=%d\n", pAd->CommonCfg.PhyMode));
1069                                         }
1070                     //BasicRate
1071                                         if(RTMPGetKeyParameter("BasicRate", tmpbuf, 10, buffer))
1072                                         {
1073                                                 pAd->CommonCfg.BasicRateBitmap = (ULONG) simple_strtol(tmpbuf, 0, 10);
1074                                                 DBGPRINT(RT_DEBUG_TRACE, ("BasicRate=%ld\n", pAd->CommonCfg.BasicRateBitmap));
1075                                         }
1076                                         //BeaconPeriod
1077                                         if(RTMPGetKeyParameter("BeaconPeriod", tmpbuf, 10, buffer))
1078                                         {
1079                                                 pAd->CommonCfg.BeaconPeriod = (USHORT) simple_strtol(tmpbuf, 0, 10);
1080                                                 DBGPRINT(RT_DEBUG_TRACE, ("BeaconPeriod=%d\n", pAd->CommonCfg.BeaconPeriod));
1081                                         }
1082                     //TxPower
1083                                         if(RTMPGetKeyParameter("TxPower", tmpbuf, 10, buffer))
1084                                         {
1085                                                 pAd->CommonCfg.TxPowerPercentage = (ULONG) simple_strtol(tmpbuf, 0, 10);
1086 #ifdef CONFIG_STA_SUPPORT
1087                                                 IF_DEV_CONFIG_OPMODE_ON_STA(pAd)
1088                                                         pAd->CommonCfg.TxPowerDefault = pAd->CommonCfg.TxPowerPercentage;
1089 #endif // CONFIG_STA_SUPPORT //
1090                                                 DBGPRINT(RT_DEBUG_TRACE, ("TxPower=%ld\n", pAd->CommonCfg.TxPowerPercentage));
1091                                         }
1092                                         //BGProtection
1093                                         if(RTMPGetKeyParameter("BGProtection", tmpbuf, 10, buffer))
1094                                         {
1095                                                 switch (simple_strtol(tmpbuf, 0, 10))
1096                                                 {
1097                                                         case 1: //Always On
1098                                                                 pAd->CommonCfg.UseBGProtection = 1;
1099                                                                 break;
1100                                                         case 2: //Always OFF
1101                                                                 pAd->CommonCfg.UseBGProtection = 2;
1102                                                                 break;
1103                                                         case 0: //AUTO
1104                                                         default:
1105                                                                 pAd->CommonCfg.UseBGProtection = 0;
1106                                                                 break;
1107                                                 }
1108                                                 DBGPRINT(RT_DEBUG_TRACE, ("BGProtection=%ld\n", pAd->CommonCfg.UseBGProtection));
1109                                         }
1110                                         //OLBCDetection
1111                                         if(RTMPGetKeyParameter("DisableOLBC", tmpbuf, 10, buffer))
1112                                         {
1113                                                 switch (simple_strtol(tmpbuf, 0, 10))
1114                                                 {
1115                                                         case 1: //disable OLBC Detection
1116                                                                 pAd->CommonCfg.DisableOLBCDetect = 1;
1117                                                                 break;
1118                                                         case 0: //enable OLBC Detection
1119                                                                 pAd->CommonCfg.DisableOLBCDetect = 0;
1120                                                                 break;
1121                                                         default:
1122                                                                 pAd->CommonCfg.DisableOLBCDetect= 0;
1123                                                                 break;
1124                                                 }
1125                                                 DBGPRINT(RT_DEBUG_TRACE, ("OLBCDetection=%ld\n", pAd->CommonCfg.DisableOLBCDetect));
1126                                         }
1127                                         //TxPreamble
1128                                         if(RTMPGetKeyParameter("TxPreamble", tmpbuf, 10, buffer))
1129                                         {
1130                                                 switch (simple_strtol(tmpbuf, 0, 10))
1131                                                 {
1132                                                         case Rt802_11PreambleShort:
1133                                                                 pAd->CommonCfg.TxPreamble = Rt802_11PreambleShort;
1134                                                                 break;
1135                                                         case Rt802_11PreambleLong:
1136                                                         default:
1137                                                                 pAd->CommonCfg.TxPreamble = Rt802_11PreambleLong;
1138                                                                 break;
1139                                                 }
1140                                                 DBGPRINT(RT_DEBUG_TRACE, ("TxPreamble=%ld\n", pAd->CommonCfg.TxPreamble));
1141                                         }
1142                                         //RTSThreshold
1143                                         if(RTMPGetKeyParameter("RTSThreshold", tmpbuf, 10, buffer))
1144                                         {
1145                                                 RtsThresh = simple_strtol(tmpbuf, 0, 10);
1146                                                 if( (RtsThresh >= 1) && (RtsThresh <= MAX_RTS_THRESHOLD) )
1147                                                         pAd->CommonCfg.RtsThreshold  = (USHORT)RtsThresh;
1148                                                 else
1149                                                         pAd->CommonCfg.RtsThreshold = MAX_RTS_THRESHOLD;
1150
1151                                                 DBGPRINT(RT_DEBUG_TRACE, ("RTSThreshold=%d\n", pAd->CommonCfg.RtsThreshold));
1152                                         }
1153                                         //FragThreshold
1154                                         if(RTMPGetKeyParameter("FragThreshold", tmpbuf, 10, buffer))
1155                                         {
1156                                                 FragThresh = simple_strtol(tmpbuf, 0, 10);
1157                                                 pAd->CommonCfg.bUseZeroToDisableFragment = FALSE;
1158
1159                                                 if (FragThresh > MAX_FRAG_THRESHOLD || FragThresh < MIN_FRAG_THRESHOLD)
1160                                                 { //illegal FragThresh so we set it to default
1161                                                         pAd->CommonCfg.FragmentThreshold = MAX_FRAG_THRESHOLD;
1162                                                         pAd->CommonCfg.bUseZeroToDisableFragment = TRUE;
1163                                                 }
1164                                                 else if (FragThresh % 2 == 1)
1165                                                 {
1166                                                         // The length of each fragment shall always be an even number of octets, except for the last fragment
1167                                                         // of an MSDU or MMPDU, which may be either an even or an odd number of octets.
1168                                                         pAd->CommonCfg.FragmentThreshold = (USHORT)(FragThresh - 1);
1169                                                 }
1170                                                 else
1171                                                 {
1172                                                         pAd->CommonCfg.FragmentThreshold = (USHORT)FragThresh;
1173                                                 }
1174                                                 //pAd->CommonCfg.AllowFragSize = (pAd->CommonCfg.FragmentThreshold) - LENGTH_802_11 - LENGTH_CRC;
1175                                                 DBGPRINT(RT_DEBUG_TRACE, ("FragThreshold=%d\n", pAd->CommonCfg.FragmentThreshold));
1176                                         }
1177                                         //TxBurst
1178                                         if(RTMPGetKeyParameter("TxBurst", tmpbuf, 10, buffer))
1179                                         {
1180 //#ifdef WIFI_TEST
1181 //                                              pAd->CommonCfg.bEnableTxBurst = FALSE;
1182 //#else
1183                                                 if(simple_strtol(tmpbuf, 0, 10) != 0)  //Enable
1184                                                         pAd->CommonCfg.bEnableTxBurst = TRUE;
1185                                                 else //Disable
1186                                                         pAd->CommonCfg.bEnableTxBurst = FALSE;
1187 //#endif
1188                                                 DBGPRINT(RT_DEBUG_TRACE, ("TxBurst=%d\n", pAd->CommonCfg.bEnableTxBurst));
1189                                         }
1190
1191 #ifdef AGGREGATION_SUPPORT
1192                                         //PktAggregate
1193                                         if(RTMPGetKeyParameter("PktAggregate", tmpbuf, 10, buffer))
1194                                         {
1195                                                 if(simple_strtol(tmpbuf, 0, 10) != 0)  //Enable
1196                                                         pAd->CommonCfg.bAggregationCapable = TRUE;
1197                                                 else //Disable
1198                                                         pAd->CommonCfg.bAggregationCapable = FALSE;
1199 #ifdef PIGGYBACK_SUPPORT
1200                                                 pAd->CommonCfg.bPiggyBackCapable = pAd->CommonCfg.bAggregationCapable;
1201 #endif // PIGGYBACK_SUPPORT //
1202                                                 DBGPRINT(RT_DEBUG_TRACE, ("PktAggregate=%d\n", pAd->CommonCfg.bAggregationCapable));
1203                                         }
1204 #else
1205                                         pAd->CommonCfg.bAggregationCapable = FALSE;
1206                                         pAd->CommonCfg.bPiggyBackCapable = FALSE;
1207 #endif // AGGREGATION_SUPPORT //
1208
1209                                         // WmmCapable
1210
1211 #ifdef CONFIG_STA_SUPPORT
1212                                         IF_DEV_CONFIG_OPMODE_ON_STA(pAd)
1213                                                 rtmp_read_sta_wmm_parms_from_file(pAd, tmpbuf, buffer);
1214 #endif // CONFIG_STA_SUPPORT //
1215
1216                                         //ShortSlot
1217                                         if(RTMPGetKeyParameter("ShortSlot", tmpbuf, 10, buffer))
1218                                         {
1219                                                 if(simple_strtol(tmpbuf, 0, 10) != 0)  //Enable
1220                                                         pAd->CommonCfg.bUseShortSlotTime = TRUE;
1221                                                 else //Disable
1222                                                         pAd->CommonCfg.bUseShortSlotTime = FALSE;
1223
1224                                                 DBGPRINT(RT_DEBUG_TRACE, ("ShortSlot=%d\n", pAd->CommonCfg.bUseShortSlotTime));
1225                                         }
1226                                         //IEEE80211H
1227                                         if(RTMPGetKeyParameter("IEEE80211H", tmpbuf, 10, buffer))
1228                                         {
1229                                             for (i = 0, macptr = rstrtok(tmpbuf,";"); macptr; macptr = rstrtok(NULL,";"), i++)
1230                                             {
1231                                                 if(simple_strtol(macptr, 0, 10) != 0)  //Enable
1232                                                         pAd->CommonCfg.bIEEE80211H = TRUE;
1233                                                 else //Disable
1234                                                         pAd->CommonCfg.bIEEE80211H = FALSE;
1235
1236                                                 DBGPRINT(RT_DEBUG_TRACE, ("IEEE80211H=%d\n", pAd->CommonCfg.bIEEE80211H));
1237                                             }
1238                                         }
1239                                         //CSPeriod
1240                                         if(RTMPGetKeyParameter("CSPeriod", tmpbuf, 10, buffer))
1241                                         {
1242                                             if(simple_strtol(tmpbuf, 0, 10) != 0)
1243                                                         pAd->CommonCfg.RadarDetect.CSPeriod = simple_strtol(tmpbuf, 0, 10);
1244                                                 else
1245                                                         pAd->CommonCfg.RadarDetect.CSPeriod = 0;
1246
1247                                                 DBGPRINT(RT_DEBUG_TRACE, ("CSPeriod=%d\n", pAd->CommonCfg.RadarDetect.CSPeriod));
1248                                         }
1249
1250                                         //RDRegion
1251                                         if(RTMPGetKeyParameter("RDRegion", tmpbuf, 128, buffer))
1252                                         {
1253                                                 if ((strncmp(tmpbuf, "JAP_W53", 7) == 0) || (strncmp(tmpbuf, "jap_w53", 7) == 0))
1254                                                 {
1255                                                         pAd->CommonCfg.RadarDetect.RDDurRegion = JAP_W53;
1256                                                         pAd->CommonCfg.RadarDetect.DfsSessionTime = 15;
1257                                                 }
1258                                                 else if ((strncmp(tmpbuf, "JAP_W56", 7) == 0) || (strncmp(tmpbuf, "jap_w56", 7) == 0))
1259                                                 {
1260                                                         pAd->CommonCfg.RadarDetect.RDDurRegion = JAP_W56;
1261                                                         pAd->CommonCfg.RadarDetect.DfsSessionTime = 13;
1262                                                 }
1263                                                 else if ((strncmp(tmpbuf, "JAP", 3) == 0) || (strncmp(tmpbuf, "jap", 3) == 0))
1264                                                 {
1265                                                         pAd->CommonCfg.RadarDetect.RDDurRegion = JAP;
1266                                                         pAd->CommonCfg.RadarDetect.DfsSessionTime = 5;
1267                                                 }
1268                                                 else  if ((strncmp(tmpbuf, "FCC", 3) == 0) || (strncmp(tmpbuf, "fcc", 3) == 0))
1269                                                 {
1270                                                         pAd->CommonCfg.RadarDetect.RDDurRegion = FCC;
1271                                                         pAd->CommonCfg.RadarDetect.DfsSessionTime = 5;
1272                                                 }
1273                                                 else if ((strncmp(tmpbuf, "CE", 2) == 0) || (strncmp(tmpbuf, "ce", 2) == 0))
1274                                                 {
1275                                                         pAd->CommonCfg.RadarDetect.RDDurRegion = CE;
1276                                                         pAd->CommonCfg.RadarDetect.DfsSessionTime = 13;
1277                                                 }
1278                                                 else
1279                                                 {
1280                                                         pAd->CommonCfg.RadarDetect.RDDurRegion = CE;
1281                                                         pAd->CommonCfg.RadarDetect.DfsSessionTime = 13;
1282                                                 }
1283
1284                                                 DBGPRINT(RT_DEBUG_TRACE, ("RDRegion=%d\n", pAd->CommonCfg.RadarDetect.RDDurRegion));
1285                                         }
1286                                         else
1287                                         {
1288                                                 pAd->CommonCfg.RadarDetect.RDDurRegion = CE;
1289                                                 pAd->CommonCfg.RadarDetect.DfsSessionTime = 13;
1290                                         }
1291
1292                                         //WirelessEvent
1293                                         if(RTMPGetKeyParameter("WirelessEvent", tmpbuf, 10, buffer))
1294                                         {
1295 #if WIRELESS_EXT >= 15
1296                                             if(simple_strtol(tmpbuf, 0, 10) != 0)
1297                                                         pAd->CommonCfg.bWirelessEvent = simple_strtol(tmpbuf, 0, 10);
1298                                                 else
1299                                                         pAd->CommonCfg.bWirelessEvent = 0;      // disable
1300 #else
1301                                                 pAd->CommonCfg.bWirelessEvent = 0;      // disable
1302 #endif
1303                                                 DBGPRINT(RT_DEBUG_TRACE, ("WirelessEvent=%d\n", pAd->CommonCfg.bWirelessEvent));
1304                                         }
1305                                         if(RTMPGetKeyParameter("WiFiTest", tmpbuf, 10, buffer))
1306                                         {
1307                                             if(simple_strtol(tmpbuf, 0, 10) != 0)
1308                                                         pAd->CommonCfg.bWiFiTest= simple_strtol(tmpbuf, 0, 10);
1309                                                 else
1310                                                         pAd->CommonCfg.bWiFiTest = 0;   // disable
1311
1312                                                 DBGPRINT(RT_DEBUG_TRACE, ("WiFiTest=%d\n", pAd->CommonCfg.bWiFiTest));
1313                                         }
1314                                         //AuthMode
1315                                         if(RTMPGetKeyParameter("AuthMode", tmpbuf, 128, buffer))
1316                                         {
1317 #ifdef CONFIG_STA_SUPPORT
1318                                                 IF_DEV_CONFIG_OPMODE_ON_STA(pAd)
1319                                                 {
1320                                                         if ((strcmp(tmpbuf, "WEPAUTO") == 0) || (strcmp(tmpbuf, "wepauto") == 0))
1321                                                             pAd->StaCfg.AuthMode = Ndis802_11AuthModeAutoSwitch;
1322                                                         else if ((strcmp(tmpbuf, "SHARED") == 0) || (strcmp(tmpbuf, "shared") == 0))
1323                                                             pAd->StaCfg.AuthMode = Ndis802_11AuthModeShared;
1324                                                         else if ((strcmp(tmpbuf, "WPAPSK") == 0) || (strcmp(tmpbuf, "wpapsk") == 0))
1325                                                             pAd->StaCfg.AuthMode = Ndis802_11AuthModeWPAPSK;
1326                                                         else if ((strcmp(tmpbuf, "WPANONE") == 0) || (strcmp(tmpbuf, "wpanone") == 0))
1327                                                             pAd->StaCfg.AuthMode = Ndis802_11AuthModeWPANone;
1328                                                         else if ((strcmp(tmpbuf, "WPA2PSK") == 0) || (strcmp(tmpbuf, "wpa2psk") == 0))
1329                                                             pAd->StaCfg.AuthMode = Ndis802_11AuthModeWPA2PSK;
1330 #ifdef WPA_SUPPLICANT_SUPPORT
1331                                                         else if ((strcmp(tmpbuf, "WPA") == 0) || (strcmp(tmpbuf, "wpa") == 0))
1332                                                             pAd->StaCfg.AuthMode = Ndis802_11AuthModeWPA;
1333                                                         else if ((strcmp(tmpbuf, "WPA2") == 0) || (strcmp(tmpbuf, "wpa2") == 0))
1334                                                             pAd->StaCfg.AuthMode = Ndis802_11AuthModeWPA2;
1335 #endif // WPA_SUPPLICANT_SUPPORT //
1336                                                         else
1337                                                             pAd->StaCfg.AuthMode = Ndis802_11AuthModeOpen;
1338
1339                                                         pAd->StaCfg.PortSecured = WPA_802_1X_PORT_NOT_SECURED;
1340
1341                                                         DBGPRINT(RT_DEBUG_TRACE, ("%s::(EncrypType=%d)\n", __func__, pAd->StaCfg.WepStatus));
1342                                                 }
1343 #endif // CONFIG_STA_SUPPORT //
1344                                         }
1345                                         //EncrypType
1346                                         if(RTMPGetKeyParameter("EncrypType", tmpbuf, 128, buffer))
1347                                         {
1348
1349 #ifdef CONFIG_STA_SUPPORT
1350                                                 IF_DEV_CONFIG_OPMODE_ON_STA(pAd)
1351                                                 {
1352                                                         if ((strcmp(tmpbuf, "WEP") == 0) || (strcmp(tmpbuf, "wep") == 0))
1353                                                                 pAd->StaCfg.WepStatus   = Ndis802_11WEPEnabled;
1354                                                         else if ((strcmp(tmpbuf, "TKIP") == 0) || (strcmp(tmpbuf, "tkip") == 0))
1355                                                                 pAd->StaCfg.WepStatus   = Ndis802_11Encryption2Enabled;
1356                                                         else if ((strcmp(tmpbuf, "AES") == 0) || (strcmp(tmpbuf, "aes") == 0))
1357                                                                 pAd->StaCfg.WepStatus   = Ndis802_11Encryption3Enabled;
1358                                                         else
1359                                                                 pAd->StaCfg.WepStatus   = Ndis802_11WEPDisabled;
1360
1361                                                         // Update all wepstatus related
1362                                                         pAd->StaCfg.PairCipher          = pAd->StaCfg.WepStatus;
1363                                                         pAd->StaCfg.GroupCipher         = pAd->StaCfg.WepStatus;
1364                                                         pAd->StaCfg.OrigWepStatus       = pAd->StaCfg.WepStatus;
1365                                                         pAd->StaCfg.bMixCipher          = FALSE;
1366
1367                                                         //RTMPMakeRSNIE(pAd, pAd->StaCfg.AuthMode, pAd->StaCfg.WepStatus, 0);
1368                                                         DBGPRINT(RT_DEBUG_TRACE, ("%s::(EncrypType=%d)\n", __func__, pAd->StaCfg.WepStatus));
1369                                                 }
1370 #endif // CONFIG_STA_SUPPORT //
1371                                         }
1372
1373
1374
1375 #ifdef CONFIG_STA_SUPPORT
1376                                         IF_DEV_CONFIG_OPMODE_ON_STA(pAd)
1377                                         {
1378                                                 if(RTMPGetCriticalParameter("WPAPSK", tmpbuf, 512, buffer))
1379                                                 {
1380                                                         int     err=0;
1381
1382                                                         tmpbuf[strlen(tmpbuf)] = '\0'; // make STA can process .$^& for WPAPSK input
1383
1384                                                         if ((pAd->StaCfg.AuthMode != Ndis802_11AuthModeWPAPSK) &&
1385                                                                 (pAd->StaCfg.AuthMode != Ndis802_11AuthModeWPA2PSK) &&
1386                                                                 (pAd->StaCfg.AuthMode != Ndis802_11AuthModeWPANone)
1387                                                                 )
1388                                                         {
1389                                                                 err = 1;
1390                                                         }
1391                                                         else if ((strlen(tmpbuf) >= 8) && (strlen(tmpbuf) < 64))
1392                                                         {
1393                                                                 PasswordHash((char *)tmpbuf, pAd->CommonCfg.Ssid, pAd->CommonCfg.SsidLen, keyMaterial);
1394                                                                 NdisMoveMemory(pAd->StaCfg.PMK, keyMaterial, 32);
1395
1396                                                         }
1397                                                         else if (strlen(tmpbuf) == 64)
1398                                                         {
1399                                                                 AtoH(tmpbuf, keyMaterial, 32);
1400                                                                 NdisMoveMemory(pAd->StaCfg.PMK, keyMaterial, 32);
1401                                                         }
1402                                                         else
1403                                                         {
1404                                                                 err = 1;
1405                                                                 DBGPRINT(RT_DEBUG_ERROR, ("%s::(WPAPSK key-string required 8 ~ 64 characters!)\n", __func__));
1406                                                         }
1407
1408                                                         if (err == 0)
1409                                                         {
1410                                                                 if ((pAd->StaCfg.AuthMode == Ndis802_11AuthModeWPAPSK) ||
1411                                                                         (pAd->StaCfg.AuthMode == Ndis802_11AuthModeWPA2PSK))
1412                                                                 {
1413                                                                         // Start STA supplicant state machine
1414                                                                         pAd->StaCfg.WpaState = SS_START;
1415                                                                 }
1416                                                                 else if (pAd->StaCfg.AuthMode == Ndis802_11AuthModeWPANone)
1417                                                                 {
1418         /*
1419                                                                         NdisZeroMemory(&pAd->SharedKey[BSS0][0], sizeof(CIPHER_KEY));
1420                                                                         pAd->SharedKey[BSS0][0].KeyLen = LEN_TKIP_EK;
1421                                                                         NdisMoveMemory(pAd->SharedKey[BSS0][0].Key, pAd->StaCfg.PMK, LEN_TKIP_EK);
1422                                                                         NdisMoveMemory(pAd->SharedKey[BSS0][0].RxMic, &pAd->StaCfg.PMK[16], LEN_TKIP_RXMICK);
1423                                                                         NdisMoveMemory(pAd->SharedKey[BSS0][0].TxMic, &pAd->StaCfg.PMK[16], LEN_TKIP_TXMICK);
1424
1425                                                                         // Decide its ChiperAlg
1426                                                                         if (pAd->StaCfg.PairCipher == Ndis802_11Encryption2Enabled)
1427                                                                                 pAd->SharedKey[BSS0][0].CipherAlg = CIPHER_TKIP;
1428                                                                         else if (pAd->StaCfg.PairCipher == Ndis802_11Encryption3Enabled)
1429                                                                                 pAd->SharedKey[BSS0][0].CipherAlg = CIPHER_AES;
1430                                                                         else
1431                                                                                 pAd->SharedKey[BSS0][0].CipherAlg = CIPHER_NONE;
1432         */
1433                                                                         pAd->StaCfg.WpaState = SS_NOTUSE;
1434                                                                 }
1435
1436                                                                 DBGPRINT(RT_DEBUG_TRACE, ("%s::(WPAPSK=%s)\n", __func__, tmpbuf));
1437                                                         }
1438                                                 }
1439                                         }
1440 #endif // CONFIG_STA_SUPPORT //
1441
1442                                         //DefaultKeyID, KeyType, KeyStr
1443                                         rtmp_read_key_parms_from_file(pAd, tmpbuf, buffer);
1444
1445
1446                                         //HSCounter
1447                                         /*if(RTMPGetKeyParameter("HSCounter", tmpbuf, 10, buffer))
1448                                         {
1449                                                 switch (simple_strtol(tmpbuf, 0, 10))
1450                                                 {
1451                                                         case 1: //Enable
1452                                                                 pAd->CommonCfg.bEnableHSCounter = TRUE;
1453                                                                 break;
1454                                                         case 0: //Disable
1455                                                         default:
1456                                                                 pAd->CommonCfg.bEnableHSCounter = FALSE;
1457                                                                 break;
1458                                                 }
1459                                                 DBGPRINT(RT_DEBUG_TRACE, "HSCounter=%d\n", pAd->CommonCfg.bEnableHSCounter);
1460                                         }*/
1461
1462 #ifdef DOT11_N_SUPPORT
1463                                         HTParametersHook(pAd, tmpbuf, buffer);
1464 #endif // DOT11_N_SUPPORT //
1465
1466 #ifdef CONFIG_STA_SUPPORT
1467                                         IF_DEV_CONFIG_OPMODE_ON_STA(pAd)
1468                                         {
1469                                                 //PSMode
1470                                                 if (RTMPGetKeyParameter("PSMode", tmpbuf, 10, buffer))
1471                                                 {
1472                                                         if (pAd->StaCfg.BssType == BSS_INFRA)
1473                                                         {
1474                                                                 if ((strcmp(tmpbuf, "MAX_PSP") == 0) || (strcmp(tmpbuf, "max_psp") == 0))
1475                                                                 {
1476                                                                         // do NOT turn on PSM bit here, wait until MlmeCheckForPsmChange()
1477                                                                         // to exclude certain situations.
1478                                                                         //         MlmeSetPsm(pAd, PWR_SAVE);
1479                                                                         OPSTATUS_SET_FLAG(pAd, fOP_STATUS_RECEIVE_DTIM);
1480                                                                         if (pAd->StaCfg.bWindowsACCAMEnable == FALSE)
1481                                                                                 pAd->StaCfg.WindowsPowerMode = Ndis802_11PowerModeMAX_PSP;
1482                                                                         pAd->StaCfg.WindowsBatteryPowerMode = Ndis802_11PowerModeMAX_PSP;
1483                                                                         pAd->StaCfg.DefaultListenCount = 5;
1484                                                                 }
1485                                                                 else if ((strcmp(tmpbuf, "Fast_PSP") == 0) || (strcmp(tmpbuf, "fast_psp") == 0)
1486                                                                         || (strcmp(tmpbuf, "FAST_PSP") == 0))
1487                                                                 {
1488                                                                         // do NOT turn on PSM bit here, wait until MlmeCheckForPsmChange()
1489                                                                         // to exclude certain situations.
1490                                                                         //         MlmeSetPsmBit(pAd, PWR_SAVE);
1491                                                                         OPSTATUS_SET_FLAG(pAd, fOP_STATUS_RECEIVE_DTIM);
1492                                                                         if (pAd->StaCfg.bWindowsACCAMEnable == FALSE)
1493                                                                                 pAd->StaCfg.WindowsPowerMode = Ndis802_11PowerModeFast_PSP;
1494                                                                         pAd->StaCfg.WindowsBatteryPowerMode = Ndis802_11PowerModeFast_PSP;
1495                                                                         pAd->StaCfg.DefaultListenCount = 3;
1496                                                                 }
1497                                                                 else if ((strcmp(tmpbuf, "Legacy_PSP") == 0) || (strcmp(tmpbuf, "legacy_psp") == 0)
1498                                                                         || (strcmp(tmpbuf, "LEGACY_PSP") == 0))
1499                                                                 {
1500                                                                         // do NOT turn on PSM bit here, wait until MlmeCheckForPsmChange()
1501                                                                         // to exclude certain situations.
1502                                                                         //         MlmeSetPsmBit(pAd, PWR_SAVE);
1503                                                                         OPSTATUS_SET_FLAG(pAd, fOP_STATUS_RECEIVE_DTIM);
1504                                                                         if (pAd->StaCfg.bWindowsACCAMEnable == FALSE)
1505                                                                                 pAd->StaCfg.WindowsPowerMode = Ndis802_11PowerModeLegacy_PSP;
1506                                                                         pAd->StaCfg.WindowsBatteryPowerMode = Ndis802_11PowerModeLegacy_PSP;
1507                                                                         pAd->StaCfg.DefaultListenCount = 3;
1508                                                                 }
1509                                                                 else
1510                                                                 { //Default Ndis802_11PowerModeCAM
1511                                                                         // clear PSM bit immediately
1512                                                                         MlmeSetPsmBit(pAd, PWR_ACTIVE);
1513                                                                         OPSTATUS_SET_FLAG(pAd, fOP_STATUS_RECEIVE_DTIM);
1514                                                                         if (pAd->StaCfg.bWindowsACCAMEnable == FALSE)
1515                                                                                 pAd->StaCfg.WindowsPowerMode = Ndis802_11PowerModeCAM;
1516                                                                         pAd->StaCfg.WindowsBatteryPowerMode = Ndis802_11PowerModeCAM;
1517                                                                 }
1518                                                                 DBGPRINT(RT_DEBUG_TRACE, ("PSMode=%ld\n", pAd->StaCfg.WindowsPowerMode));
1519                                                         }
1520                                                 }
1521                                                 // FastRoaming
1522                                                 if (RTMPGetKeyParameter("FastRoaming", tmpbuf, 32, buffer))
1523                                                 {
1524                                                         if (simple_strtol(tmpbuf, 0, 10) == 0)
1525                                                                 pAd->StaCfg.bFastRoaming = FALSE;
1526                                                         else
1527                                                                 pAd->StaCfg.bFastRoaming = TRUE;
1528
1529                                                         DBGPRINT(RT_DEBUG_TRACE, ("FastRoaming=%d\n", pAd->StaCfg.bFastRoaming));
1530                                                 }
1531                                                 // RoamThreshold
1532                                                 if (RTMPGetKeyParameter("RoamThreshold", tmpbuf, 32, buffer))
1533                                                 {
1534                                                         long lInfo = simple_strtol(tmpbuf, 0, 10);
1535
1536                                                         if (lInfo > 90 || lInfo < 60)
1537                                                                 pAd->StaCfg.dBmToRoam = -70;
1538                                                         else
1539                                                                 pAd->StaCfg.dBmToRoam = (CHAR)(-1)*lInfo;
1540
1541                                                         DBGPRINT(RT_DEBUG_TRACE, ("RoamThreshold=%d  dBm\n", pAd->StaCfg.dBmToRoam));
1542                                                 }
1543
1544                                                 if(RTMPGetKeyParameter("TGnWifiTest", tmpbuf, 10, buffer))
1545                                                 {
1546                                                         if(simple_strtol(tmpbuf, 0, 10) == 0)
1547                                                                 pAd->StaCfg.bTGnWifiTest = FALSE;
1548                                                         else
1549                                                                 pAd->StaCfg.bTGnWifiTest = TRUE;
1550                                                                 DBGPRINT(RT_DEBUG_TRACE, ("TGnWifiTest=%d\n", pAd->StaCfg.bTGnWifiTest));
1551                                                 }
1552                                         }
1553 #endif // CONFIG_STA_SUPPORT //
1554
1555
1556 #ifdef RT30xx
1557 #ifdef CONFIG_STA_SUPPORT
1558                                                 IF_DEV_CONFIG_OPMODE_ON_STA(pAd)
1559                                                 {
1560                                                         if(RTMPGetKeyParameter("AntDiversity", tmpbuf, 10, buffer))
1561                                                         {
1562                                                                 for (i = 0, macptr = rstrtok(tmpbuf,";"); macptr; macptr = rstrtok(NULL,";"), i++)
1563                                                                 {
1564                                                                         if(simple_strtol(macptr, 0, 10) != 0)  //Enable
1565                                                                                 pAd->CommonCfg.bRxAntDiversity = TRUE;
1566                                                                         else //Disable
1567                                                                                 pAd->CommonCfg.bRxAntDiversity = FALSE;
1568
1569                                                                         DBGPRINT(RT_DEBUG_ERROR, ("AntDiversity=%d\n", pAd->CommonCfg.bRxAntDiversity));
1570                                                                 }
1571                                                         }
1572                                                 }
1573 #endif // CONFIG_STA_SUPPORT //
1574 #endif // RT30xx //
1575                                 }
1576                         }
1577                         else
1578                         {
1579                                 DBGPRINT(RT_DEBUG_TRACE, ("--> %s does not have a write method\n", src));
1580                         }
1581
1582                         retval=filp_close(srcf,NULL);
1583
1584                         if (retval)
1585                         {
1586                                 DBGPRINT(RT_DEBUG_TRACE, ("--> Error %d closing %s\n", -retval, src));
1587                         }
1588                 }
1589         }
1590
1591         set_fs(orgfs);
1592 #if 0
1593         current->fsuid = orgfsuid;
1594         current->fsgid = orgfsgid;
1595 #endif
1596
1597         kfree(buffer);
1598         kfree(tmpbuf);
1599
1600         return (NDIS_STATUS_SUCCESS);
1601 }
1602
1603 #ifdef DOT11_N_SUPPORT
1604 static void     HTParametersHook(
1605         IN      PRTMP_ADAPTER pAd,
1606         IN      CHAR              *pValueStr,
1607         IN      CHAR              *pInput)
1608 {
1609
1610         INT Value;
1611
1612     if (RTMPGetKeyParameter("HT_PROTECT", pValueStr, 25, pInput))
1613     {
1614         Value = simple_strtol(pValueStr, 0, 10);
1615         if (Value == 0)
1616         {
1617             pAd->CommonCfg.bHTProtect = FALSE;
1618         }
1619         else
1620         {
1621             pAd->CommonCfg.bHTProtect = TRUE;
1622         }
1623         DBGPRINT(RT_DEBUG_TRACE, ("HT: Protection  = %s\n", (Value==0) ? "Disable" : "Enable"));
1624     }
1625
1626     if (RTMPGetKeyParameter("HT_MIMOPSEnable", pValueStr, 25, pInput))
1627     {
1628         Value = simple_strtol(pValueStr, 0, 10);
1629         if (Value == 0)
1630         {
1631             pAd->CommonCfg.bMIMOPSEnable = FALSE;
1632         }
1633         else
1634         {
1635             pAd->CommonCfg.bMIMOPSEnable = TRUE;
1636         }
1637         DBGPRINT(RT_DEBUG_TRACE, ("HT: MIMOPSEnable  = %s\n", (Value==0) ? "Disable" : "Enable"));
1638     }
1639
1640
1641     if (RTMPGetKeyParameter("HT_MIMOPSMode", pValueStr, 25, pInput))
1642     {
1643         Value = simple_strtol(pValueStr, 0, 10);
1644         if (Value > MMPS_ENABLE)
1645         {
1646                         pAd->CommonCfg.BACapability.field.MMPSmode = MMPS_ENABLE;
1647         }
1648         else
1649         {
1650             //TODO: add mimo power saving mechanism
1651             pAd->CommonCfg.BACapability.field.MMPSmode = MMPS_ENABLE;
1652                         //pAd->CommonCfg.BACapability.field.MMPSmode = Value;
1653         }
1654         DBGPRINT(RT_DEBUG_TRACE, ("HT: MIMOPS Mode  = %d\n", Value));
1655     }
1656
1657     if (RTMPGetKeyParameter("HT_BADecline", pValueStr, 25, pInput))
1658     {
1659         Value = simple_strtol(pValueStr, 0, 10);
1660         if (Value == 0)
1661         {
1662             pAd->CommonCfg.bBADecline = FALSE;
1663         }
1664         else
1665         {
1666             pAd->CommonCfg.bBADecline = TRUE;
1667         }
1668         DBGPRINT(RT_DEBUG_TRACE, ("HT: BA Decline  = %s\n", (Value==0) ? "Disable" : "Enable"));
1669     }
1670
1671
1672     if (RTMPGetKeyParameter("HT_DisableReordering", pValueStr, 25, pInput))
1673     {
1674         Value = simple_strtol(pValueStr, 0, 10);
1675         if (Value == 0)
1676         {
1677             pAd->CommonCfg.bDisableReordering = FALSE;
1678         }
1679         else
1680         {
1681             pAd->CommonCfg.bDisableReordering = TRUE;
1682         }
1683         DBGPRINT(RT_DEBUG_TRACE, ("HT: DisableReordering  = %s\n", (Value==0) ? "Disable" : "Enable"));
1684     }
1685
1686     if (RTMPGetKeyParameter("HT_AutoBA", pValueStr, 25, pInput))
1687     {
1688         Value = simple_strtol(pValueStr, 0, 10);
1689         if (Value == 0)
1690         {
1691             pAd->CommonCfg.BACapability.field.AutoBA = FALSE;
1692             pAd->CommonCfg.BACapability.field.Policy = BA_NOTUSE;
1693         }
1694         else
1695         {
1696             pAd->CommonCfg.BACapability.field.AutoBA = TRUE;
1697             pAd->CommonCfg.BACapability.field.Policy = IMMED_BA;
1698         }
1699         pAd->CommonCfg.REGBACapability.field.AutoBA = pAd->CommonCfg.BACapability.field.AutoBA;
1700         pAd->CommonCfg.REGBACapability.field.Policy = pAd->CommonCfg.BACapability.field.Policy;
1701         DBGPRINT(RT_DEBUG_TRACE, ("HT: Auto BA  = %s\n", (Value==0) ? "Disable" : "Enable"));
1702     }
1703
1704         // Tx_+HTC frame
1705     if (RTMPGetKeyParameter("HT_HTC", pValueStr, 25, pInput))
1706         {
1707                 Value = simple_strtol(pValueStr, 0, 10);
1708                 if (Value == 0)
1709                 {
1710                         pAd->HTCEnable = FALSE;
1711                 }
1712                 else
1713                 {
1714                         pAd->HTCEnable = TRUE;
1715                 }
1716                 DBGPRINT(RT_DEBUG_TRACE, ("HT: Tx +HTC frame = %s\n", (Value==0) ? "Disable" : "Enable"));
1717         }
1718
1719         // Enable HT Link Adaptation Control
1720         if (RTMPGetKeyParameter("HT_LinkAdapt", pValueStr, 25, pInput))
1721         {
1722                 Value = simple_strtol(pValueStr, 0, 10);
1723                 if (Value == 0)
1724                 {
1725                         pAd->bLinkAdapt = FALSE;
1726                 }
1727                 else
1728                 {
1729                         pAd->HTCEnable = TRUE;
1730                         pAd->bLinkAdapt = TRUE;
1731                 }
1732                 DBGPRINT(RT_DEBUG_TRACE, ("HT: Link Adaptation Control = %s\n", (Value==0) ? "Disable" : "Enable(+HTC)"));
1733         }
1734
1735         // Reverse Direction Mechanism
1736     if (RTMPGetKeyParameter("HT_RDG", pValueStr, 25, pInput))
1737         {
1738                 Value = simple_strtol(pValueStr, 0, 10);
1739                 if (Value == 0)
1740                 {
1741                         pAd->CommonCfg.bRdg = FALSE;
1742                 }
1743                 else
1744                 {
1745                         pAd->HTCEnable = TRUE;
1746             pAd->CommonCfg.bRdg = TRUE;
1747                 }
1748                 DBGPRINT(RT_DEBUG_TRACE, ("HT: RDG = %s\n", (Value==0) ? "Disable" : "Enable(+HTC)"));
1749         }
1750
1751
1752
1753
1754         // Tx A-MSUD ?
1755     if (RTMPGetKeyParameter("HT_AMSDU", pValueStr, 25, pInput))
1756         {
1757                 Value = simple_strtol(pValueStr, 0, 10);
1758                 if (Value == 0)
1759                 {
1760                         pAd->CommonCfg.BACapability.field.AmsduEnable = FALSE;
1761                 }
1762                 else
1763                 {
1764             pAd->CommonCfg.BACapability.field.AmsduEnable = TRUE;
1765                 }
1766                 DBGPRINT(RT_DEBUG_TRACE, ("HT: Tx A-MSDU = %s\n", (Value==0) ? "Disable" : "Enable"));
1767         }
1768
1769         // MPDU Density
1770     if (RTMPGetKeyParameter("HT_MpduDensity", pValueStr, 25, pInput))
1771         {
1772                 Value = simple_strtol(pValueStr, 0, 10);
1773                 if (Value <=7 && Value >= 0)
1774                 {
1775                         pAd->CommonCfg.BACapability.field.MpduDensity = Value;
1776                         DBGPRINT(RT_DEBUG_TRACE, ("HT: MPDU Density = %d\n", Value));
1777                 }
1778                 else
1779                 {
1780                         pAd->CommonCfg.BACapability.field.MpduDensity = 4;
1781                         DBGPRINT(RT_DEBUG_TRACE, ("HT: MPDU Density = %d (Default)\n", 4));
1782                 }
1783         }
1784
1785         // Max Rx BA Window Size
1786     if (RTMPGetKeyParameter("HT_BAWinSize", pValueStr, 25, pInput))
1787         {
1788                 Value = simple_strtol(pValueStr, 0, 10);
1789
1790                 if (Value >=1 && Value <= 64)
1791                 {
1792                         pAd->CommonCfg.REGBACapability.field.RxBAWinLimit = Value;
1793                         pAd->CommonCfg.BACapability.field.RxBAWinLimit = Value;
1794                         DBGPRINT(RT_DEBUG_TRACE, ("HT: BA Windw Size = %d\n", Value));
1795                 }
1796                 else
1797                 {
1798             pAd->CommonCfg.REGBACapability.field.RxBAWinLimit = 64;
1799                         pAd->CommonCfg.BACapability.field.RxBAWinLimit = 64;
1800                         DBGPRINT(RT_DEBUG_TRACE, ("HT: BA Windw Size = 64 (Defualt)\n"));
1801                 }
1802
1803         }
1804
1805         // Guard Interval
1806         if (RTMPGetKeyParameter("HT_GI", pValueStr, 25, pInput))
1807         {
1808                 Value = simple_strtol(pValueStr, 0, 10);
1809
1810                 if (Value == GI_400)
1811                 {
1812                         pAd->CommonCfg.RegTransmitSetting.field.ShortGI = GI_400;
1813                 }
1814                 else
1815                 {
1816                         pAd->CommonCfg.RegTransmitSetting.field.ShortGI = GI_800;
1817                 }
1818
1819                 DBGPRINT(RT_DEBUG_TRACE, ("HT: Guard Interval = %s\n", (Value==GI_400) ? "400" : "800" ));
1820         }
1821
1822         // HT Operation Mode : Mixed Mode , Green Field
1823         if (RTMPGetKeyParameter("HT_OpMode", pValueStr, 25, pInput))
1824         {
1825                 Value = simple_strtol(pValueStr, 0, 10);
1826
1827                 if (Value == HTMODE_GF)
1828                 {
1829
1830                         pAd->CommonCfg.RegTransmitSetting.field.HTMODE  = HTMODE_GF;
1831                 }
1832                 else
1833                 {
1834                         pAd->CommonCfg.RegTransmitSetting.field.HTMODE  = HTMODE_MM;
1835                 }
1836
1837                 DBGPRINT(RT_DEBUG_TRACE, ("HT: Operate Mode = %s\n", (Value==HTMODE_GF) ? "Green Field" : "Mixed Mode" ));
1838         }
1839
1840         // Fixed Tx mode : CCK, OFDM
1841         if (RTMPGetKeyParameter("FixedTxMode", pValueStr, 25, pInput))
1842         {
1843                 UCHAR   fix_tx_mode;
1844
1845 #ifdef CONFIG_STA_SUPPORT
1846                 IF_DEV_CONFIG_OPMODE_ON_STA(pAd)
1847                 {
1848                         fix_tx_mode = FIXED_TXMODE_HT;
1849
1850                         if (strcmp(pValueStr, "OFDM") == 0 || strcmp(pValueStr, "ofdm") == 0)
1851                         {
1852                                 fix_tx_mode = FIXED_TXMODE_OFDM;
1853                         }
1854                         else if (strcmp(pValueStr, "CCK") == 0 || strcmp(pValueStr, "cck") == 0)
1855                         {
1856                         fix_tx_mode = FIXED_TXMODE_CCK;
1857                         }
1858                         else if (strcmp(pValueStr, "HT") == 0 || strcmp(pValueStr, "ht") == 0)
1859                         {
1860                         fix_tx_mode = FIXED_TXMODE_HT;
1861                 }
1862                 else
1863                 {
1864                                 Value = simple_strtol(pValueStr, 0, 10);
1865                                 // 1 : CCK
1866                                 // 2 : OFDM
1867                                 // otherwise : HT
1868                                 if (Value == FIXED_TXMODE_CCK || Value == FIXED_TXMODE_OFDM)
1869                                         fix_tx_mode = Value;
1870                                 else
1871                                         fix_tx_mode = FIXED_TXMODE_HT;
1872                 }
1873
1874                         pAd->StaCfg.DesiredTransmitSetting.field.FixedTxMode = fix_tx_mode;
1875                         DBGPRINT(RT_DEBUG_TRACE, ("Fixed Tx Mode = %d\n", fix_tx_mode));
1876
1877                 }
1878 #endif // CONFIG_STA_SUPPORT //
1879         }
1880
1881
1882         // Channel Width
1883         if (RTMPGetKeyParameter("HT_BW", pValueStr, 25, pInput))
1884         {
1885                 Value = simple_strtol(pValueStr, 0, 10);
1886
1887                 if (Value == BW_40)
1888                 {
1889                         pAd->CommonCfg.RegTransmitSetting.field.BW  = BW_40;
1890                 }
1891                 else
1892                 {
1893             pAd->CommonCfg.RegTransmitSetting.field.BW  = BW_20;
1894                 }
1895
1896 #ifdef MCAST_RATE_SPECIFIC
1897                 pAd->CommonCfg.MCastPhyMode.field.BW = pAd->CommonCfg.RegTransmitSetting.field.BW;
1898 #endif // MCAST_RATE_SPECIFIC //
1899
1900                 DBGPRINT(RT_DEBUG_TRACE, ("HT: Channel Width = %s\n", (Value==BW_40) ? "40 MHz" : "20 MHz" ));
1901         }
1902
1903         if (RTMPGetKeyParameter("HT_EXTCHA", pValueStr, 25, pInput))
1904         {
1905                 Value = simple_strtol(pValueStr, 0, 10);
1906
1907                 if (Value == 0)
1908                 {
1909
1910                         pAd->CommonCfg.RegTransmitSetting.field.EXTCHA  = EXTCHA_BELOW;
1911                 }
1912                 else
1913                 {
1914             pAd->CommonCfg.RegTransmitSetting.field.EXTCHA = EXTCHA_ABOVE;
1915                 }
1916
1917                 DBGPRINT(RT_DEBUG_TRACE, ("HT: Ext Channel = %s\n", (Value==0) ? "BELOW" : "ABOVE" ));
1918         }
1919
1920         // MSC
1921         if (RTMPGetKeyParameter("HT_MCS", pValueStr, 50, pInput))
1922         {
1923
1924 #ifdef CONFIG_STA_SUPPORT
1925                 IF_DEV_CONFIG_OPMODE_ON_STA(pAd)
1926                 {
1927                         Value = simple_strtol(pValueStr, 0, 10);
1928
1929 //                      if ((Value >= 0 && Value <= 15) || (Value == 32))
1930                         if ((Value >= 0 && Value <= 23) || (Value == 32)) // 3*3
1931                 {
1932                                 pAd->StaCfg.DesiredTransmitSetting.field.MCS  = Value;
1933                                 pAd->StaCfg.bAutoTxRateSwitch = FALSE;
1934                                 DBGPRINT(RT_DEBUG_TRACE, ("HT: MCS = %d\n", pAd->StaCfg.DesiredTransmitSetting.field.MCS));
1935                 }
1936                 else
1937                 {
1938                                 pAd->StaCfg.DesiredTransmitSetting.field.MCS  = MCS_AUTO;
1939                                 pAd->StaCfg.bAutoTxRateSwitch = TRUE;
1940                                 DBGPRINT(RT_DEBUG_TRACE, ("HT: MCS = AUTO\n"));
1941                 }
1942         }
1943 #endif // CONFIG_STA_SUPPORT //
1944         }
1945
1946         // STBC
1947     if (RTMPGetKeyParameter("HT_STBC", pValueStr, 25, pInput))
1948         {
1949                 Value = simple_strtol(pValueStr, 0, 10);
1950                 if (Value == STBC_USE)
1951                 {
1952                         pAd->CommonCfg.RegTransmitSetting.field.STBC = STBC_USE;
1953                 }
1954                 else
1955                 {
1956                         pAd->CommonCfg.RegTransmitSetting.field.STBC = STBC_NONE;
1957                 }
1958                 DBGPRINT(RT_DEBUG_TRACE, ("HT: STBC = %d\n", pAd->CommonCfg.RegTransmitSetting.field.STBC));
1959         }
1960
1961         // 40_Mhz_Intolerant
1962         if (RTMPGetKeyParameter("HT_40MHZ_INTOLERANT", pValueStr, 25, pInput))
1963         {
1964                 Value = simple_strtol(pValueStr, 0, 10);
1965                 if (Value == 0)
1966                 {
1967                         pAd->CommonCfg.bForty_Mhz_Intolerant = FALSE;
1968                 }
1969                 else
1970                 {
1971                         pAd->CommonCfg.bForty_Mhz_Intolerant = TRUE;
1972                 }
1973                 DBGPRINT(RT_DEBUG_TRACE, ("HT: 40MHZ INTOLERANT = %d\n", pAd->CommonCfg.bForty_Mhz_Intolerant));
1974         }
1975         //HT_TxStream
1976         if(RTMPGetKeyParameter("HT_TxStream", pValueStr, 10, pInput))
1977         {
1978                 switch (simple_strtol(pValueStr, 0, 10))
1979                 {
1980                         case 1:
1981                                 pAd->CommonCfg.TxStream = 1;
1982                                 break;
1983                         case 2:
1984                                 pAd->CommonCfg.TxStream = 2;
1985                                 break;
1986                         case 3: // 3*3
1987                         default:
1988                                 pAd->CommonCfg.TxStream = 3;
1989
1990                                 if (pAd->MACVersion < RALINK_2883_VERSION)
1991                                         pAd->CommonCfg.TxStream = 2; // only 2 tx streams for RT2860 series
1992                                 break;
1993                 }
1994                 DBGPRINT(RT_DEBUG_TRACE, ("HT: Tx Stream = %d\n", pAd->CommonCfg.TxStream));
1995         }
1996         //HT_RxStream
1997         if(RTMPGetKeyParameter("HT_RxStream", pValueStr, 10, pInput))
1998         {
1999                 switch (simple_strtol(pValueStr, 0, 10))
2000                 {
2001                         case 1:
2002                                 pAd->CommonCfg.RxStream = 1;
2003                                 break;
2004                         case 2:
2005                                 pAd->CommonCfg.RxStream = 2;
2006                                 break;
2007                         case 3:
2008                         default:
2009                                 pAd->CommonCfg.RxStream = 3;
2010
2011                                 if (pAd->MACVersion < RALINK_2883_VERSION)
2012                                         pAd->CommonCfg.RxStream = 2; // only 2 rx streams for RT2860 series
2013                                 break;
2014                 }
2015                 DBGPRINT(RT_DEBUG_TRACE, ("HT: Rx Stream = %d\n", pAd->CommonCfg.RxStream));
2016         }
2017
2018 }
2019 #endif // DOT11_N_SUPPORT //
2020