git.oblomov.eu Git - linux-2.6/blob - drivers/staging/rt2860/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                 IF_DEV_CONFIG_OPMODE_ON_STA(pAd)
 760                 {
 761                         KeyIdx = simple_strtol(tmpbuf, 0, 10);
 762                         if((KeyIdx >= 1 ) && (KeyIdx <= 4))
 763                                 pAd->StaCfg.DefaultKeyId = (UCHAR) (KeyIdx - 1);
 764                         else
 765                                 pAd->StaCfg.DefaultKeyId = 0;
 766
 767                         DBGPRINT(RT_DEBUG_TRACE, ("DefaultKeyID(0~3)=%d\n", pAd->StaCfg.DefaultKeyId));
 768                 }
 769         }
 770
 771
 772         for (idx = 0; idx < 4; idx++)
 773         {
 774                 sprintf(tok_str, "Key%dType", idx + 1);
 775                 //Key1Type
 776                 if (RTMPGetKeyParameter(tok_str, tmpbuf, 128, buffer))
 777                 {
 778                     for (i = 0, macptr = rstrtok(tmpbuf,";"); macptr; macptr = rstrtok(NULL,";"), i++)
 779                     {
 780                             KeyType[i] = simple_strtol(macptr, 0, 10);
 781                     }
 782
 783                         IF_DEV_CONFIG_OPMODE_ON_STA(pAd)
 784                         {
 785                                 sprintf(tok_str, "Key%dStr", idx + 1);
 786                                 if (RTMPGetCriticalParameter(tok_str, tmpbuf, 128, buffer))
 787                                 {
 788                                         rtmp_parse_key_buffer_from_file(pAd, tmpbuf, KeyType[BSS0], BSS0, idx);
 789                                 }
 790                         }
 791                 }
 792         }
 793 }
 794
 795 static void rtmp_read_sta_wmm_parms_from_file(IN  PRTMP_ADAPTER pAd, char *tmpbuf, char *buffer)
 796 {
 797         PUCHAR                                  macptr;
 798         INT                                             i=0;
 799         BOOLEAN                                 bWmmEnable = FALSE;
 800
 801         //WmmCapable
 802         if(RTMPGetKeyParameter("WmmCapable", tmpbuf, 32, buffer))
 803         {
 804                 if(simple_strtol(tmpbuf, 0, 10) != 0) //Enable
 805                 {
 806                         pAd->CommonCfg.bWmmCapable = TRUE;
 807                         bWmmEnable = TRUE;
 808                 }
 809                 else //Disable
 810                 {
 811                         pAd->CommonCfg.bWmmCapable = FALSE;
 812                 }
 813
 814                 DBGPRINT(RT_DEBUG_TRACE, ("WmmCapable=%d\n", pAd->CommonCfg.bWmmCapable));
 815         }
 816
 817         //AckPolicy for AC_BK, AC_BE, AC_VI, AC_VO
 818         if(RTMPGetKeyParameter("AckPolicy", tmpbuf, 32, buffer))
 819         {
 820                 for (i = 0, macptr = rstrtok(tmpbuf,";"); macptr; macptr = rstrtok(NULL,";"), i++)
 821                 {
 822                         pAd->CommonCfg.AckPolicy[i] = (UCHAR)simple_strtol(macptr, 0, 10);
 823
 824                         DBGPRINT(RT_DEBUG_TRACE, ("AckPolicy[%d]=%d\n", i, pAd->CommonCfg.AckPolicy[i]));
 825                 }
 826         }
 827
 828         if (bWmmEnable)
 829         {
 830                 //APSDCapable
 831                 if(RTMPGetKeyParameter("APSDCapable", tmpbuf, 10, buffer))
 832                 {
 833                         if(simple_strtol(tmpbuf, 0, 10) != 0)  //Enable
 834                                 pAd->CommonCfg.bAPSDCapable = TRUE;
 835                         else
 836                                 pAd->CommonCfg.bAPSDCapable = FALSE;
 837
 838                         DBGPRINT(RT_DEBUG_TRACE, ("APSDCapable=%d\n", pAd->CommonCfg.bAPSDCapable));
 839                 }
 840
 841                 //APSDAC for AC_BE, AC_BK, AC_VI, AC_VO
 842                 if(RTMPGetKeyParameter("APSDAC", tmpbuf, 32, buffer))
 843                 {
 844                         BOOLEAN apsd_ac[4];
 845
 846                         for (i = 0, macptr = rstrtok(tmpbuf,";"); macptr; macptr = rstrtok(NULL,";"), i++)
 847                         {
 848                                 apsd_ac[i] = (BOOLEAN)simple_strtol(macptr, 0, 10);
 849
 850                                 DBGPRINT(RT_DEBUG_TRACE, ("APSDAC%d  %d\n", i,  apsd_ac[i]));
 851                         }
 852
 853                         pAd->CommonCfg.bAPSDAC_BE = apsd_ac[0];
 854                         pAd->CommonCfg.bAPSDAC_BK = apsd_ac[1];
 855                         pAd->CommonCfg.bAPSDAC_VI = apsd_ac[2];
 856                         pAd->CommonCfg.bAPSDAC_VO = apsd_ac[3];
 857                 }
 858         }
 859
 860 }
 861
 862 NDIS_STATUS     RTMPReadParametersHook(
 863         IN      PRTMP_ADAPTER pAd)
 864 {
 865         PUCHAR                                  src = NULL;
 866         struct file                             *srcf;
 867         INT                                     retval, orgfsuid, orgfsgid;
 868         mm_segment_t                    orgfs;
 869         CHAR                                    *buffer;
 870         CHAR                                    *tmpbuf;
 871         ULONG                                   RtsThresh;
 872         ULONG                                   FragThresh;
 873         UCHAR                   keyMaterial[40];
 874
 875         PUCHAR                                  macptr;
 876         INT                                             i = 0;
 877
 878         buffer = kmalloc(MAX_INI_BUFFER_SIZE, MEM_ALLOC_FLAG);
 879         if(buffer == NULL)
 880         return NDIS_STATUS_FAILURE;
 881
 882         tmpbuf = kmalloc(MAX_PARAM_BUFFER_SIZE, MEM_ALLOC_FLAG);
 883         if(tmpbuf == NULL)
 884         {
 885                 kfree(buffer);
 886         return NDIS_STATUS_FAILURE;
 887         }
 888
 889         IF_DEV_CONFIG_OPMODE_ON_STA(pAd)
 890                 src = STA_PROFILE_PATH;
 891
 892         // Save uid and gid used for filesystem access.
 893         // Set user and group to 0 (root)
 894         orgfsuid = current_fsuid();
 895         orgfsgid = current_fsgid();
 896         /* Hm, can't really do this nicely anymore, so rely on these files
 897          * being set to the proper permission to read them... */
 898         /* current->cred->fsuid = current->cred->fsgid = 0; */
 899     orgfs = get_fs();
 900     set_fs(KERNEL_DS);
 901
 902         if (src && *src)
 903         {
 904                 srcf = filp_open(src, O_RDONLY, 0);
 905                 if (IS_ERR(srcf))
 906                 {
 907                         DBGPRINT(RT_DEBUG_ERROR, ("--> Error %ld opening %s\n", -PTR_ERR(srcf),src));
 908                 }
 909                 else
 910                 {
 911                         // The object must have a read method
 912                         if (srcf->f_op && srcf->f_op->read)
 913                         {
 914                                 memset(buffer, 0x00, MAX_INI_BUFFER_SIZE);
 915                                 retval=srcf->f_op->read(srcf, buffer, MAX_INI_BUFFER_SIZE, &srcf->f_pos);
 916                                 if (retval < 0)
 917                                 {
 918                                         DBGPRINT(RT_DEBUG_TRACE, ("--> Read %s error %d\n", src, -retval));
 919                                 }
 920                                 else
 921                                 {
 922                                         // set file parameter to portcfg
 923                                         //CountryRegion
 924                                         if(RTMPGetKeyParameter("CountryRegion", tmpbuf, 25, buffer))
 925                                         {
 926                                                 pAd->CommonCfg.CountryRegion = (UCHAR) simple_strtol(tmpbuf, 0, 10);
 927                                                 DBGPRINT(RT_DEBUG_TRACE, ("CountryRegion=%d\n", pAd->CommonCfg.CountryRegion));
 928                                         }
 929                                         //CountryRegionABand
 930                                         if(RTMPGetKeyParameter("CountryRegionABand", tmpbuf, 25, buffer))
 931                                         {
 932                                                 pAd->CommonCfg.CountryRegionForABand= (UCHAR) simple_strtol(tmpbuf, 0, 10);
 933                                                 DBGPRINT(RT_DEBUG_TRACE, ("CountryRegionABand=%d\n", pAd->CommonCfg.CountryRegionForABand));
 934                                         }
 935                                         //CountryCode
 936                                         if(RTMPGetKeyParameter("CountryCode", tmpbuf, 25, buffer))
 937                                         {
 938                                                 NdisMoveMemory(pAd->CommonCfg.CountryCode, tmpbuf , 2);
 939
 940                                                 if (strlen(pAd->CommonCfg.CountryCode) != 0)
 941                                                 {
 942                                                         pAd->CommonCfg.bCountryFlag = TRUE;
 943                                                 }
 944                                                 DBGPRINT(RT_DEBUG_TRACE, ("CountryCode=%s\n", pAd->CommonCfg.CountryCode));
 945                                         }
 946                                         //ChannelGeography
 947                                         if(RTMPGetKeyParameter("ChannelGeography", tmpbuf, 25, buffer))
 948                                         {
 949                                                 UCHAR Geography = (UCHAR) simple_strtol(tmpbuf, 0, 10);
 950                                                 if (Geography <= BOTH)
 951                                                 {
 952                                                         pAd->CommonCfg.Geography = Geography;
 953                                                         pAd->CommonCfg.CountryCode[2] =
 954                                                                 (pAd->CommonCfg.Geography == BOTH) ? ' ' : ((pAd->CommonCfg.Geography == IDOR) ? 'I' : 'O');
 955                                                         DBGPRINT(RT_DEBUG_TRACE, ("ChannelGeography=%d\n", pAd->CommonCfg.Geography));
 956                                                 }
 957                                         }
 958                                         else
 959                                         {
 960                                                 pAd->CommonCfg.Geography = BOTH;
 961                                                 pAd->CommonCfg.CountryCode[2] = ' ';
 962                                         }
 963
 964                                         IF_DEV_CONFIG_OPMODE_ON_STA(pAd)
 965                                         {
 966                                                 //SSID
 967                                                 if (RTMPGetCriticalParameter("SSID", tmpbuf, 256, buffer))
 968                                                 {
 969                                                         if (strlen(tmpbuf) <= 32)
 970                                                         {
 971                                                                 pAd->CommonCfg.SsidLen = (UCHAR) strlen(tmpbuf);
 972                                                                 NdisZeroMemory(pAd->CommonCfg.Ssid, NDIS_802_11_LENGTH_SSID);
 973                                                                 NdisMoveMemory(pAd->CommonCfg.Ssid, tmpbuf, pAd->CommonCfg.SsidLen);
 974                                                                 pAd->MlmeAux.AutoReconnectSsidLen = pAd->CommonCfg.SsidLen;
 975                                                                 NdisZeroMemory(pAd->MlmeAux.AutoReconnectSsid, NDIS_802_11_LENGTH_SSID);
 976                                                                 NdisMoveMemory(pAd->MlmeAux.AutoReconnectSsid, tmpbuf, pAd->MlmeAux.AutoReconnectSsidLen);
 977                                                                 pAd->MlmeAux.SsidLen = pAd->CommonCfg.SsidLen;
 978                                                                 NdisZeroMemory(pAd->MlmeAux.Ssid, NDIS_802_11_LENGTH_SSID);
 979                                                                 NdisMoveMemory(pAd->MlmeAux.Ssid, tmpbuf, pAd->MlmeAux.SsidLen);
 980                                                                 DBGPRINT(RT_DEBUG_TRACE, ("%s::(SSID=%s)\n", __func__, tmpbuf));
 981                                                         }
 982                                                 }
 983                                         }
 984
 985                                         IF_DEV_CONFIG_OPMODE_ON_STA(pAd)
 986                                         {
 987                                                 //NetworkType
 988                                                 if (RTMPGetKeyParameter("NetworkType", tmpbuf, 25, buffer))
 989                                                 {
 990                                                         pAd->bConfigChanged = TRUE;
 991                                                         if (strcmp(tmpbuf, "Adhoc") == 0)
 992                                                                 pAd->StaCfg.BssType = BSS_ADHOC;
 993                                                         else //Default Infrastructure mode
 994                                                                 pAd->StaCfg.BssType = BSS_INFRA;
 995                                                         // Reset Ralink supplicant to not use, it will be set to start when UI set PMK key
 996                                                         pAd->StaCfg.WpaState = SS_NOTUSE;
 997                                                         DBGPRINT(RT_DEBUG_TRACE, ("%s::(NetworkType=%d)\n", __func__, pAd->StaCfg.BssType));
 998                                                 }
 999                                         }
1000
1001                                         //Channel
1002                                         if(RTMPGetKeyParameter("Channel", tmpbuf, 10, buffer))
1003                                         {
1004                                                 pAd->CommonCfg.Channel = (UCHAR) simple_strtol(tmpbuf, 0, 10);
1005                                                 DBGPRINT(RT_DEBUG_TRACE, ("Channel=%d\n", pAd->CommonCfg.Channel));
1006                                         }
1007                                         //WirelessMode
1008                                         if(RTMPGetKeyParameter("WirelessMode", tmpbuf, 10, buffer))
1009                                         {
1010                                                 int value  = 0, maxPhyMode = PHY_11G;
1011
1012 #ifdef DOT11_N_SUPPORT
1013                                                 maxPhyMode = PHY_11N_5G;
1014 #endif // DOT11_N_SUPPORT //
1015
1016                                                 value = simple_strtol(tmpbuf, 0, 10);
1017
1018                                                 if (value <= maxPhyMode)
1019                                                 {
1020                                                         pAd->CommonCfg.PhyMode = value;
1021                                                 }
1022                                                 DBGPRINT(RT_DEBUG_TRACE, ("PhyMode=%d\n", pAd->CommonCfg.PhyMode));
1023                                         }
1024                     //BasicRate
1025                                         if(RTMPGetKeyParameter("BasicRate", tmpbuf, 10, buffer))
1026                                         {
1027                                                 pAd->CommonCfg.BasicRateBitmap = (ULONG) simple_strtol(tmpbuf, 0, 10);
1028                                                 DBGPRINT(RT_DEBUG_TRACE, ("BasicRate=%ld\n", pAd->CommonCfg.BasicRateBitmap));
1029                                         }
1030                                         //BeaconPeriod
1031                                         if(RTMPGetKeyParameter("BeaconPeriod", tmpbuf, 10, buffer))
1032                                         {
1033                                                 pAd->CommonCfg.BeaconPeriod = (USHORT) simple_strtol(tmpbuf, 0, 10);
1034                                                 DBGPRINT(RT_DEBUG_TRACE, ("BeaconPeriod=%d\n", pAd->CommonCfg.BeaconPeriod));
1035                                         }
1036                     //TxPower
1037                                         if(RTMPGetKeyParameter("TxPower", tmpbuf, 10, buffer))
1038                                         {
1039                                                 pAd->CommonCfg.TxPowerPercentage = (ULONG) simple_strtol(tmpbuf, 0, 10);
1040
1041                                                 IF_DEV_CONFIG_OPMODE_ON_STA(pAd)
1042                                                         pAd->CommonCfg.TxPowerDefault = pAd->CommonCfg.TxPowerPercentage;
1043
1044                                                 DBGPRINT(RT_DEBUG_TRACE, ("TxPower=%ld\n", pAd->CommonCfg.TxPowerPercentage));
1045                                         }
1046                                         //BGProtection
1047                                         if(RTMPGetKeyParameter("BGProtection", tmpbuf, 10, buffer))
1048                                         {
1049                                                 switch (simple_strtol(tmpbuf, 0, 10))
1050                                                 {
1051                                                         case 1: //Always On
1052                                                                 pAd->CommonCfg.UseBGProtection = 1;
1053                                                                 break;
1054                                                         case 2: //Always OFF
1055                                                                 pAd->CommonCfg.UseBGProtection = 2;
1056                                                                 break;
1057                                                         case 0: //AUTO
1058                                                         default:
1059                                                                 pAd->CommonCfg.UseBGProtection = 0;
1060                                                                 break;
1061                                                 }
1062                                                 DBGPRINT(RT_DEBUG_TRACE, ("BGProtection=%ld\n", pAd->CommonCfg.UseBGProtection));
1063                                         }
1064                                         //OLBCDetection
1065                                         if(RTMPGetKeyParameter("DisableOLBC", tmpbuf, 10, buffer))
1066                                         {
1067                                                 switch (simple_strtol(tmpbuf, 0, 10))
1068                                                 {
1069                                                         case 1: //disable OLBC Detection
1070                                                                 pAd->CommonCfg.DisableOLBCDetect = 1;
1071                                                                 break;
1072                                                         case 0: //enable OLBC Detection
1073                                                                 pAd->CommonCfg.DisableOLBCDetect = 0;
1074                                                                 break;
1075                                                         default:
1076                                                                 pAd->CommonCfg.DisableOLBCDetect= 0;
1077                                                                 break;
1078                                                 }
1079                                                 DBGPRINT(RT_DEBUG_TRACE, ("OLBCDetection=%ld\n", pAd->CommonCfg.DisableOLBCDetect));
1080                                         }
1081                                         //TxPreamble
1082                                         if(RTMPGetKeyParameter("TxPreamble", tmpbuf, 10, buffer))
1083                                         {
1084                                                 switch (simple_strtol(tmpbuf, 0, 10))
1085                                                 {
1086                                                         case Rt802_11PreambleShort:
1087                                                                 pAd->CommonCfg.TxPreamble = Rt802_11PreambleShort;
1088                                                                 break;
1089                                                         case Rt802_11PreambleLong:
1090                                                         default:
1091                                                                 pAd->CommonCfg.TxPreamble = Rt802_11PreambleLong;
1092                                                                 break;
1093                                                 }
1094                                                 DBGPRINT(RT_DEBUG_TRACE, ("TxPreamble=%ld\n", pAd->CommonCfg.TxPreamble));
1095                                         }
1096                                         //RTSThreshold
1097                                         if(RTMPGetKeyParameter("RTSThreshold", tmpbuf, 10, buffer))
1098                                         {
1099                                                 RtsThresh = simple_strtol(tmpbuf, 0, 10);
1100                                                 if( (RtsThresh >= 1) && (RtsThresh <= MAX_RTS_THRESHOLD) )
1101                                                         pAd->CommonCfg.RtsThreshold  = (USHORT)RtsThresh;
1102                                                 else
1103                                                         pAd->CommonCfg.RtsThreshold = MAX_RTS_THRESHOLD;
1104
1105                                                 DBGPRINT(RT_DEBUG_TRACE, ("RTSThreshold=%d\n", pAd->CommonCfg.RtsThreshold));
1106                                         }
1107                                         //FragThreshold
1108                                         if(RTMPGetKeyParameter("FragThreshold", tmpbuf, 10, buffer))
1109                                         {
1110                                                 FragThresh = simple_strtol(tmpbuf, 0, 10);
1111                                                 pAd->CommonCfg.bUseZeroToDisableFragment = FALSE;
1112
1113                                                 if (FragThresh > MAX_FRAG_THRESHOLD || FragThresh < MIN_FRAG_THRESHOLD)
1114                                                 { //illegal FragThresh so we set it to default
1115                                                         pAd->CommonCfg.FragmentThreshold = MAX_FRAG_THRESHOLD;
1116                                                         pAd->CommonCfg.bUseZeroToDisableFragment = TRUE;
1117                                                 }
1118                                                 else if (FragThresh % 2 == 1)
1119                                                 {
1120                                                         // The length of each fragment shall always be an even number of octets, except for the last fragment
1121                                                         // of an MSDU or MMPDU, which may be either an even or an odd number of octets.
1122                                                         pAd->CommonCfg.FragmentThreshold = (USHORT)(FragThresh - 1);
1123                                                 }
1124                                                 else
1125                                                 {
1126                                                         pAd->CommonCfg.FragmentThreshold = (USHORT)FragThresh;
1127                                                 }
1128                                                 //pAd->CommonCfg.AllowFragSize = (pAd->CommonCfg.FragmentThreshold) - LENGTH_802_11 - LENGTH_CRC;
1129                                                 DBGPRINT(RT_DEBUG_TRACE, ("FragThreshold=%d\n", pAd->CommonCfg.FragmentThreshold));
1130                                         }
1131                                         //TxBurst
1132                                         if(RTMPGetKeyParameter("TxBurst", tmpbuf, 10, buffer))
1133                                         {
1134                                                 if(simple_strtol(tmpbuf, 0, 10) != 0)  //Enable
1135                                                         pAd->CommonCfg.bEnableTxBurst = TRUE;
1136                                                 else //Disable
1137                                                         pAd->CommonCfg.bEnableTxBurst = FALSE;
1138                                                 DBGPRINT(RT_DEBUG_TRACE, ("TxBurst=%d\n", pAd->CommonCfg.bEnableTxBurst));
1139                                         }
1140
1141 #ifdef AGGREGATION_SUPPORT
1142                                         //PktAggregate
1143                                         if(RTMPGetKeyParameter("PktAggregate", tmpbuf, 10, buffer))
1144                                         {
1145                                                 if(simple_strtol(tmpbuf, 0, 10) != 0)  //Enable
1146                                                         pAd->CommonCfg.bAggregationCapable = TRUE;
1147                                                 else //Disable
1148                                                         pAd->CommonCfg.bAggregationCapable = FALSE;
1149 #ifdef PIGGYBACK_SUPPORT
1150                                                 pAd->CommonCfg.bPiggyBackCapable = pAd->CommonCfg.bAggregationCapable;
1151 #endif // PIGGYBACK_SUPPORT //
1152                                                 DBGPRINT(RT_DEBUG_TRACE, ("PktAggregate=%d\n", pAd->CommonCfg.bAggregationCapable));
1153                                         }
1154 #else
1155                                         pAd->CommonCfg.bAggregationCapable = FALSE;
1156                                         pAd->CommonCfg.bPiggyBackCapable = FALSE;
1157 #endif // AGGREGATION_SUPPORT //
1158
1159                                         // WmmCapable
1160                                         IF_DEV_CONFIG_OPMODE_ON_STA(pAd)
1161                                                 rtmp_read_sta_wmm_parms_from_file(pAd, tmpbuf, buffer);
1162
1163                                         //ShortSlot
1164                                         if(RTMPGetKeyParameter("ShortSlot", tmpbuf, 10, buffer))
1165                                         {
1166                                                 if(simple_strtol(tmpbuf, 0, 10) != 0)  //Enable
1167                                                         pAd->CommonCfg.bUseShortSlotTime = TRUE;
1168                                                 else //Disable
1169                                                         pAd->CommonCfg.bUseShortSlotTime = FALSE;
1170
1171                                                 DBGPRINT(RT_DEBUG_TRACE, ("ShortSlot=%d\n", pAd->CommonCfg.bUseShortSlotTime));
1172                                         }
1173                                         //IEEE80211H
1174                                         if(RTMPGetKeyParameter("IEEE80211H", tmpbuf, 10, buffer))
1175                                         {
1176                                             for (i = 0, macptr = rstrtok(tmpbuf,";"); macptr; macptr = rstrtok(NULL,";"), i++)
1177                                             {
1178                                                 if(simple_strtol(macptr, 0, 10) != 0)  //Enable
1179                                                         pAd->CommonCfg.bIEEE80211H = TRUE;
1180                                                 else //Disable
1181                                                         pAd->CommonCfg.bIEEE80211H = FALSE;
1182
1183                                                 DBGPRINT(RT_DEBUG_TRACE, ("IEEE80211H=%d\n", pAd->CommonCfg.bIEEE80211H));
1184                                             }
1185                                         }
1186                                         //CSPeriod
1187                                         if(RTMPGetKeyParameter("CSPeriod", tmpbuf, 10, buffer))
1188                                         {
1189                                             if(simple_strtol(tmpbuf, 0, 10) != 0)
1190                                                         pAd->CommonCfg.RadarDetect.CSPeriod = simple_strtol(tmpbuf, 0, 10);
1191                                                 else
1192                                                         pAd->CommonCfg.RadarDetect.CSPeriod = 0;
1193
1194                                                 DBGPRINT(RT_DEBUG_TRACE, ("CSPeriod=%d\n", pAd->CommonCfg.RadarDetect.CSPeriod));
1195                                         }
1196
1197                                         //RDRegion
1198                                         if(RTMPGetKeyParameter("RDRegion", tmpbuf, 128, buffer))
1199                                         {
1200                                                 if ((strncmp(tmpbuf, "JAP_W53", 7) == 0) || (strncmp(tmpbuf, "jap_w53", 7) == 0))
1201                                                 {
1202                                                         pAd->CommonCfg.RadarDetect.RDDurRegion = JAP_W53;
1203                                                         pAd->CommonCfg.RadarDetect.DfsSessionTime = 15;
1204                                                 }
1205                                                 else if ((strncmp(tmpbuf, "JAP_W56", 7) == 0) || (strncmp(tmpbuf, "jap_w56", 7) == 0))
1206                                                 {
1207                                                         pAd->CommonCfg.RadarDetect.RDDurRegion = JAP_W56;
1208                                                         pAd->CommonCfg.RadarDetect.DfsSessionTime = 13;
1209                                                 }
1210                                                 else if ((strncmp(tmpbuf, "JAP", 3) == 0) || (strncmp(tmpbuf, "jap", 3) == 0))
1211                                                 {
1212                                                         pAd->CommonCfg.RadarDetect.RDDurRegion = JAP;
1213                                                         pAd->CommonCfg.RadarDetect.DfsSessionTime = 5;
1214                                                 }
1215                                                 else  if ((strncmp(tmpbuf, "FCC", 3) == 0) || (strncmp(tmpbuf, "fcc", 3) == 0))
1216                                                 {
1217                                                         pAd->CommonCfg.RadarDetect.RDDurRegion = FCC;
1218                                                         pAd->CommonCfg.RadarDetect.DfsSessionTime = 5;
1219                                                 }
1220                                                 else if ((strncmp(tmpbuf, "CE", 2) == 0) || (strncmp(tmpbuf, "ce", 2) == 0))
1221                                                 {
1222                                                         pAd->CommonCfg.RadarDetect.RDDurRegion = CE;
1223                                                         pAd->CommonCfg.RadarDetect.DfsSessionTime = 13;
1224                                                 }
1225                                                 else
1226                                                 {
1227                                                         pAd->CommonCfg.RadarDetect.RDDurRegion = CE;
1228                                                         pAd->CommonCfg.RadarDetect.DfsSessionTime = 13;
1229                                                 }
1230
1231                                                 DBGPRINT(RT_DEBUG_TRACE, ("RDRegion=%d\n", pAd->CommonCfg.RadarDetect.RDDurRegion));
1232                                         }
1233                                         else
1234                                         {
1235                                                 pAd->CommonCfg.RadarDetect.RDDurRegion = CE;
1236                                                 pAd->CommonCfg.RadarDetect.DfsSessionTime = 13;
1237                                         }
1238
1239                                         //WirelessEvent
1240                                         if(RTMPGetKeyParameter("WirelessEvent", tmpbuf, 10, buffer))
1241                                         {
1242 #if WIRELESS_EXT >= 15
1243                                             if(simple_strtol(tmpbuf, 0, 10) != 0)
1244                                                         pAd->CommonCfg.bWirelessEvent = simple_strtol(tmpbuf, 0, 10);
1245                                                 else
1246                                                         pAd->CommonCfg.bWirelessEvent = 0;      // disable
1247 #else
1248                                                 pAd->CommonCfg.bWirelessEvent = 0;      // disable
1249 #endif
1250                                                 DBGPRINT(RT_DEBUG_TRACE, ("WirelessEvent=%d\n", pAd->CommonCfg.bWirelessEvent));
1251                                         }
1252                                         if(RTMPGetKeyParameter("WiFiTest", tmpbuf, 10, buffer))
1253                                         {
1254                                             if(simple_strtol(tmpbuf, 0, 10) != 0)
1255                                                         pAd->CommonCfg.bWiFiTest= simple_strtol(tmpbuf, 0, 10);
1256                                                 else
1257                                                         pAd->CommonCfg.bWiFiTest = 0;   // disable
1258
1259                                                 DBGPRINT(RT_DEBUG_TRACE, ("WiFiTest=%d\n", pAd->CommonCfg.bWiFiTest));
1260                                         }
1261                                         //AuthMode
1262                                         if(RTMPGetKeyParameter("AuthMode", tmpbuf, 128, buffer))
1263                                         {
1264                                                 IF_DEV_CONFIG_OPMODE_ON_STA(pAd)
1265                                                 {
1266                                                         if ((strcmp(tmpbuf, "WEPAUTO") == 0) || (strcmp(tmpbuf, "wepauto") == 0))
1267                                                             pAd->StaCfg.AuthMode = Ndis802_11AuthModeAutoSwitch;
1268                                                         else if ((strcmp(tmpbuf, "SHARED") == 0) || (strcmp(tmpbuf, "shared") == 0))
1269                                                             pAd->StaCfg.AuthMode = Ndis802_11AuthModeShared;
1270                                                         else if ((strcmp(tmpbuf, "WPAPSK") == 0) || (strcmp(tmpbuf, "wpapsk") == 0))
1271                                                             pAd->StaCfg.AuthMode = Ndis802_11AuthModeWPAPSK;
1272                                                         else if ((strcmp(tmpbuf, "WPANONE") == 0) || (strcmp(tmpbuf, "wpanone") == 0))
1273                                                             pAd->StaCfg.AuthMode = Ndis802_11AuthModeWPANone;
1274                                                         else if ((strcmp(tmpbuf, "WPA2PSK") == 0) || (strcmp(tmpbuf, "wpa2psk") == 0))
1275                                                             pAd->StaCfg.AuthMode = Ndis802_11AuthModeWPA2PSK;
1276 #ifdef WPA_SUPPLICANT_SUPPORT
1277                                                         else if ((strcmp(tmpbuf, "WPA") == 0) || (strcmp(tmpbuf, "wpa") == 0))
1278                                                             pAd->StaCfg.AuthMode = Ndis802_11AuthModeWPA;
1279                                                         else if ((strcmp(tmpbuf, "WPA2") == 0) || (strcmp(tmpbuf, "wpa2") == 0))
1280                                                             pAd->StaCfg.AuthMode = Ndis802_11AuthModeWPA2;
1281 #endif // WPA_SUPPLICANT_SUPPORT //
1282                                                         else
1283                                                             pAd->StaCfg.AuthMode = Ndis802_11AuthModeOpen;
1284
1285                                                         pAd->StaCfg.PortSecured = WPA_802_1X_PORT_NOT_SECURED;
1286
1287                                                         DBGPRINT(RT_DEBUG_TRACE, ("%s::(EncrypType=%d)\n", __func__, pAd->StaCfg.WepStatus));
1288                                                 }
1289                                         }
1290                                         //EncrypType
1291                                         if(RTMPGetKeyParameter("EncrypType", tmpbuf, 128, buffer))
1292                                         {
1293                                                 IF_DEV_CONFIG_OPMODE_ON_STA(pAd)
1294                                                 {
1295                                                         if ((strcmp(tmpbuf, "WEP") == 0) || (strcmp(tmpbuf, "wep") == 0))
1296                                                                 pAd->StaCfg.WepStatus   = Ndis802_11WEPEnabled;
1297                                                         else if ((strcmp(tmpbuf, "TKIP") == 0) || (strcmp(tmpbuf, "tkip") == 0))
1298                                                                 pAd->StaCfg.WepStatus   = Ndis802_11Encryption2Enabled;
1299                                                         else if ((strcmp(tmpbuf, "AES") == 0) || (strcmp(tmpbuf, "aes") == 0))
1300                                                                 pAd->StaCfg.WepStatus   = Ndis802_11Encryption3Enabled;
1301                                                         else
1302                                                                 pAd->StaCfg.WepStatus   = Ndis802_11WEPDisabled;
1303
1304                                                         // Update all wepstatus related
1305                                                         pAd->StaCfg.PairCipher          = pAd->StaCfg.WepStatus;
1306                                                         pAd->StaCfg.GroupCipher         = pAd->StaCfg.WepStatus;
1307                                                         pAd->StaCfg.OrigWepStatus       = pAd->StaCfg.WepStatus;
1308                                                         pAd->StaCfg.bMixCipher          = FALSE;
1309
1310                                                         DBGPRINT(RT_DEBUG_TRACE, ("%s::(EncrypType=%d)\n", __func__, pAd->StaCfg.WepStatus));
1311                                                 }
1312                                         }
1313
1314                                         IF_DEV_CONFIG_OPMODE_ON_STA(pAd)
1315                                         {
1316                                                 if(RTMPGetCriticalParameter("WPAPSK", tmpbuf, 512, buffer))
1317                                                 {
1318                                                         int     err=0;
1319
1320                                                         tmpbuf[strlen(tmpbuf)] = '\0'; // make STA can process .$^& for WPAPSK input
1321
1322                                                         if ((pAd->StaCfg.AuthMode != Ndis802_11AuthModeWPAPSK) &&
1323                                                                 (pAd->StaCfg.AuthMode != Ndis802_11AuthModeWPA2PSK) &&
1324                                                                 (pAd->StaCfg.AuthMode != Ndis802_11AuthModeWPANone)
1325                                                                 )
1326                                                         {
1327                                                                 err = 1;
1328                                                         }
1329                                                         else if ((strlen(tmpbuf) >= 8) && (strlen(tmpbuf) < 64))
1330                                                         {
1331                                                                 PasswordHash((char *)tmpbuf, pAd->CommonCfg.Ssid, pAd->CommonCfg.SsidLen, keyMaterial);
1332                                                                 NdisMoveMemory(pAd->StaCfg.PMK, keyMaterial, 32);
1333
1334                                                         }
1335                                                         else if (strlen(tmpbuf) == 64)
1336                                                         {
1337                                                                 AtoH(tmpbuf, keyMaterial, 32);
1338                                                                 NdisMoveMemory(pAd->StaCfg.PMK, keyMaterial, 32);
1339                                                         }
1340                                                         else
1341                                                         {
1342                                                                 err = 1;
1343                                                                 DBGPRINT(RT_DEBUG_ERROR, ("%s::(WPAPSK key-string required 8 ~ 64 characters!)\n", __func__));
1344                                                         }
1345
1346                                                         if (err == 0)
1347                                                         {
1348                                                                 if ((pAd->StaCfg.AuthMode == Ndis802_11AuthModeWPAPSK) ||
1349                                                                         (pAd->StaCfg.AuthMode == Ndis802_11AuthModeWPA2PSK))
1350                                                                 {
1351                                                                         // Start STA supplicant state machine
1352                                                                         pAd->StaCfg.WpaState = SS_START;
1353                                                                 }
1354                                                                 else if (pAd->StaCfg.AuthMode == Ndis802_11AuthModeWPANone)
1355                                                                 {
1356                                                                         pAd->StaCfg.WpaState = SS_NOTUSE;
1357                                                                 }
1358
1359                                                                 DBGPRINT(RT_DEBUG_TRACE, ("%s::(WPAPSK=%s)\n", __func__, tmpbuf));
1360                                                         }
1361                                                 }
1362                                         }
1363
1364                                         //DefaultKeyID, KeyType, KeyStr
1365                                         rtmp_read_key_parms_from_file(pAd, tmpbuf, buffer);
1366
1367 #ifdef DOT11_N_SUPPORT
1368                                         HTParametersHook(pAd, tmpbuf, buffer);
1369 #endif // DOT11_N_SUPPORT //
1370
1371                                         IF_DEV_CONFIG_OPMODE_ON_STA(pAd)
1372                                         {
1373                                                 //PSMode
1374                                                 if (RTMPGetKeyParameter("PSMode", tmpbuf, 32, buffer))
1375                                                 {
1376                                                         if (pAd->StaCfg.BssType == BSS_INFRA)
1377                                                         {
1378                                                                 if ((strcmp(tmpbuf, "MAX_PSP") == 0) || (strcmp(tmpbuf, "max_psp") == 0))
1379                                                                 {
1380                                                                         // do NOT turn on PSM bit here, wait until MlmeCheckForPsmChange()
1381                                                                         // to exclude certain situations.
1382                                                                         //         MlmeSetPsm(pAd, PWR_SAVE);
1383                                                                         OPSTATUS_SET_FLAG(pAd, fOP_STATUS_RECEIVE_DTIM);
1384                                                                         if (pAd->StaCfg.bWindowsACCAMEnable == FALSE)
1385                                                                                 pAd->StaCfg.WindowsPowerMode = Ndis802_11PowerModeMAX_PSP;
1386                                                                         pAd->StaCfg.WindowsBatteryPowerMode = Ndis802_11PowerModeMAX_PSP;
1387                                                                         pAd->StaCfg.DefaultListenCount = 5;
1388                                                                 }
1389                                                                 else if ((strcmp(tmpbuf, "Fast_PSP") == 0) || (strcmp(tmpbuf, "fast_psp") == 0)
1390                                                                         || (strcmp(tmpbuf, "FAST_PSP") == 0))
1391                                                                 {
1392                                                                         // do NOT turn on PSM bit here, wait until MlmeCheckForPsmChange()
1393                                                                         // to exclude certain situations.
1394                                                                         //         MlmeSetPsmBit(pAd, PWR_SAVE);
1395                                                                         OPSTATUS_SET_FLAG(pAd, fOP_STATUS_RECEIVE_DTIM);
1396                                                                         if (pAd->StaCfg.bWindowsACCAMEnable == FALSE)
1397                                                                                 pAd->StaCfg.WindowsPowerMode = Ndis802_11PowerModeFast_PSP;
1398                                                                         pAd->StaCfg.WindowsBatteryPowerMode = Ndis802_11PowerModeFast_PSP;
1399                                                                         pAd->StaCfg.DefaultListenCount = 3;
1400                                                                 }
1401                                                                 else if ((strcmp(tmpbuf, "Legacy_PSP") == 0) || (strcmp(tmpbuf, "legacy_psp") == 0)
1402                                                                         || (strcmp(tmpbuf, "LEGACY_PSP") == 0))
1403                                                                 {
1404                                                                         // do NOT turn on PSM bit here, wait until MlmeCheckForPsmChange()
1405                                                                         // to exclude certain situations.
1406                                                                         //         MlmeSetPsmBit(pAd, PWR_SAVE);
1407                                                                         OPSTATUS_SET_FLAG(pAd, fOP_STATUS_RECEIVE_DTIM);
1408                                                                         if (pAd->StaCfg.bWindowsACCAMEnable == FALSE)
1409                                                                                 pAd->StaCfg.WindowsPowerMode = Ndis802_11PowerModeLegacy_PSP;
1410                                                                         pAd->StaCfg.WindowsBatteryPowerMode = Ndis802_11PowerModeLegacy_PSP;
1411                                                                         pAd->StaCfg.DefaultListenCount = 3;
1412                                                                 }
1413                                                                 else
1414                                                                 { //Default Ndis802_11PowerModeCAM
1415                                                                         // clear PSM bit immediately
1416                                                                         MlmeSetPsmBit(pAd, PWR_ACTIVE);
1417                                                                         OPSTATUS_SET_FLAG(pAd, fOP_STATUS_RECEIVE_DTIM);
1418                                                                         if (pAd->StaCfg.bWindowsACCAMEnable == FALSE)
1419                                                                                 pAd->StaCfg.WindowsPowerMode = Ndis802_11PowerModeCAM;
1420                                                                         pAd->StaCfg.WindowsBatteryPowerMode = Ndis802_11PowerModeCAM;
1421                                                                 }
1422                                                                 DBGPRINT(RT_DEBUG_TRACE, ("PSMode=%ld\n", pAd->StaCfg.WindowsPowerMode));
1423                                                         }
1424                                                 }
1425                                                 // FastRoaming
1426                                                 if (RTMPGetKeyParameter("FastRoaming", tmpbuf, 32, buffer))
1427                                                 {
1428                                                         if (simple_strtol(tmpbuf, 0, 10) == 0)
1429                                                                 pAd->StaCfg.bFastRoaming = FALSE;
1430                                                         else
1431                                                                 pAd->StaCfg.bFastRoaming = TRUE;
1432
1433                                                         DBGPRINT(RT_DEBUG_TRACE, ("FastRoaming=%d\n", pAd->StaCfg.bFastRoaming));
1434                                                 }
1435                                                 // RoamThreshold
1436                                                 if (RTMPGetKeyParameter("RoamThreshold", tmpbuf, 32, buffer))
1437                                                 {
1438                                                         long lInfo = simple_strtol(tmpbuf, 0, 10);
1439
1440                                                         if (lInfo > 90 || lInfo < 60)
1441                                                                 pAd->StaCfg.dBmToRoam = -70;
1442                                                         else
1443                                                                 pAd->StaCfg.dBmToRoam = (CHAR)(-1)*lInfo;
1444
1445                                                         DBGPRINT(RT_DEBUG_TRACE, ("RoamThreshold=%d  dBm\n", pAd->StaCfg.dBmToRoam));
1446                                                 }
1447
1448                                                 if(RTMPGetKeyParameter("TGnWifiTest", tmpbuf, 10, buffer))
1449                                                 {
1450                                                         if(simple_strtol(tmpbuf, 0, 10) == 0)
1451                                                                 pAd->StaCfg.bTGnWifiTest = FALSE;
1452                                                         else
1453                                                                 pAd->StaCfg.bTGnWifiTest = TRUE;
1454                                                                 DBGPRINT(RT_DEBUG_TRACE, ("TGnWifiTest=%d\n", pAd->StaCfg.bTGnWifiTest));
1455                                                 }
1456                                         }
1457                                 }
1458                         }
1459                         else
1460                         {
1461                                 DBGPRINT(RT_DEBUG_TRACE, ("--> %s does not have a write method\n", src));
1462                         }
1463
1464                         retval=filp_close(srcf,NULL);
1465
1466                         if (retval)
1467                         {
1468                                 DBGPRINT(RT_DEBUG_TRACE, ("--> Error %d closing %s\n", -retval, src));
1469                         }
1470                 }
1471         }
1472
1473         set_fs(orgfs);
1474
1475 #if 0
1476         current->cred->fsuid = orgfsuid;
1477         current->cred->fsgid = orgfsgid;
1478 #endif
1479
1480         kfree(buffer);
1481         kfree(tmpbuf);
1482
1483         return (NDIS_STATUS_SUCCESS);
1484 }
1485
1486 #ifdef DOT11_N_SUPPORT
1487 static void     HTParametersHook(
1488         IN      PRTMP_ADAPTER pAd,
1489         IN      CHAR              *pValueStr,
1490         IN      CHAR              *pInput)
1491 {
1492
1493         INT Value;
1494
1495     if (RTMPGetKeyParameter("HT_PROTECT", pValueStr, 25, pInput))
1496     {
1497         Value = simple_strtol(pValueStr, 0, 10);
1498         if (Value == 0)
1499         {
1500             pAd->CommonCfg.bHTProtect = FALSE;
1501         }
1502         else
1503         {
1504             pAd->CommonCfg.bHTProtect = TRUE;
1505         }
1506         DBGPRINT(RT_DEBUG_TRACE, ("HT: Protection  = %s\n", (Value==0) ? "Disable" : "Enable"));
1507     }
1508
1509     if (RTMPGetKeyParameter("HT_MIMOPSEnable", pValueStr, 25, pInput))
1510     {
1511         Value = simple_strtol(pValueStr, 0, 10);
1512         if (Value == 0)
1513         {
1514             pAd->CommonCfg.bMIMOPSEnable = FALSE;
1515         }
1516         else
1517         {
1518             pAd->CommonCfg.bMIMOPSEnable = TRUE;
1519         }
1520         DBGPRINT(RT_DEBUG_TRACE, ("HT: MIMOPSEnable  = %s\n", (Value==0) ? "Disable" : "Enable"));
1521     }
1522
1523
1524     if (RTMPGetKeyParameter("HT_MIMOPSMode", pValueStr, 25, pInput))
1525     {
1526         Value = simple_strtol(pValueStr, 0, 10);
1527         if (Value > MMPS_ENABLE)
1528         {
1529                         pAd->CommonCfg.BACapability.field.MMPSmode = MMPS_ENABLE;
1530         }
1531         else
1532         {
1533             //TODO: add mimo power saving mechanism
1534             pAd->CommonCfg.BACapability.field.MMPSmode = MMPS_ENABLE;
1535                         //pAd->CommonCfg.BACapability.field.MMPSmode = Value;
1536         }
1537         DBGPRINT(RT_DEBUG_TRACE, ("HT: MIMOPS Mode  = %d\n", Value));
1538     }
1539
1540     if (RTMPGetKeyParameter("HT_BADecline", pValueStr, 25, pInput))
1541     {
1542         Value = simple_strtol(pValueStr, 0, 10);
1543         if (Value == 0)
1544         {
1545             pAd->CommonCfg.bBADecline = FALSE;
1546         }
1547         else
1548         {
1549             pAd->CommonCfg.bBADecline = TRUE;
1550         }
1551         DBGPRINT(RT_DEBUG_TRACE, ("HT: BA Decline  = %s\n", (Value==0) ? "Disable" : "Enable"));
1552     }
1553
1554
1555     if (RTMPGetKeyParameter("HT_DisableReordering", pValueStr, 25, pInput))
1556     {
1557         Value = simple_strtol(pValueStr, 0, 10);
1558         if (Value == 0)
1559         {
1560             pAd->CommonCfg.bDisableReordering = FALSE;
1561         }
1562         else
1563         {
1564             pAd->CommonCfg.bDisableReordering = TRUE;
1565         }
1566         DBGPRINT(RT_DEBUG_TRACE, ("HT: DisableReordering  = %s\n", (Value==0) ? "Disable" : "Enable"));
1567     }
1568
1569     if (RTMPGetKeyParameter("HT_AutoBA", pValueStr, 25, pInput))
1570     {
1571         Value = simple_strtol(pValueStr, 0, 10);
1572         if (Value == 0)
1573         {
1574             pAd->CommonCfg.BACapability.field.AutoBA = FALSE;
1575         }
1576         else
1577         {
1578             pAd->CommonCfg.BACapability.field.AutoBA = TRUE;
1579         }
1580         pAd->CommonCfg.REGBACapability.field.AutoBA = pAd->CommonCfg.BACapability.field.AutoBA;
1581         DBGPRINT(RT_DEBUG_TRACE, ("HT: Auto BA  = %s\n", (Value==0) ? "Disable" : "Enable"));
1582     }
1583
1584         // Tx_+HTC frame
1585     if (RTMPGetKeyParameter("HT_HTC", pValueStr, 25, pInput))
1586         {
1587                 Value = simple_strtol(pValueStr, 0, 10);
1588                 if (Value == 0)
1589                 {
1590                         pAd->HTCEnable = FALSE;
1591                 }
1592                 else
1593                 {
1594                         pAd->HTCEnable = TRUE;
1595                 }
1596                 DBGPRINT(RT_DEBUG_TRACE, ("HT: Tx +HTC frame = %s\n", (Value==0) ? "Disable" : "Enable"));
1597         }
1598
1599         // Enable HT Link Adaptation Control
1600         if (RTMPGetKeyParameter("HT_LinkAdapt", pValueStr, 25, pInput))
1601         {
1602                 Value = simple_strtol(pValueStr, 0, 10);
1603                 if (Value == 0)
1604                 {
1605                         pAd->bLinkAdapt = FALSE;
1606                 }
1607                 else
1608                 {
1609                         pAd->HTCEnable = TRUE;
1610                         pAd->bLinkAdapt = TRUE;
1611                 }
1612                 DBGPRINT(RT_DEBUG_TRACE, ("HT: Link Adaptation Control = %s\n", (Value==0) ? "Disable" : "Enable(+HTC)"));
1613         }
1614
1615         // Reverse Direction Mechanism
1616     if (RTMPGetKeyParameter("HT_RDG", pValueStr, 25, pInput))
1617         {
1618                 Value = simple_strtol(pValueStr, 0, 10);
1619                 if (Value == 0)
1620                 {
1621                         pAd->CommonCfg.bRdg = FALSE;
1622                 }
1623                 else
1624                 {
1625                         pAd->HTCEnable = TRUE;
1626             pAd->CommonCfg.bRdg = TRUE;
1627                 }
1628                 DBGPRINT(RT_DEBUG_TRACE, ("HT: RDG = %s\n", (Value==0) ? "Disable" : "Enable(+HTC)"));
1629         }
1630
1631
1632
1633
1634         // Tx A-MSUD ?
1635     if (RTMPGetKeyParameter("HT_AMSDU", pValueStr, 25, pInput))
1636         {
1637                 Value = simple_strtol(pValueStr, 0, 10);
1638                 if (Value == 0)
1639                 {
1640                         pAd->CommonCfg.BACapability.field.AmsduEnable = FALSE;
1641                 }
1642                 else
1643                 {
1644             pAd->CommonCfg.BACapability.field.AmsduEnable = TRUE;
1645                 }
1646                 DBGPRINT(RT_DEBUG_TRACE, ("HT: Tx A-MSDU = %s\n", (Value==0) ? "Disable" : "Enable"));
1647         }
1648
1649         // MPDU Density
1650     if (RTMPGetKeyParameter("HT_MpduDensity", pValueStr, 25, pInput))
1651         {
1652                 Value = simple_strtol(pValueStr, 0, 10);
1653                 if (Value <=7 && Value >= 0)
1654                 {
1655                         pAd->CommonCfg.BACapability.field.MpduDensity = Value;
1656                         DBGPRINT(RT_DEBUG_TRACE, ("HT: MPDU Density = %d\n", Value));
1657                 }
1658                 else
1659                 {
1660                         pAd->CommonCfg.BACapability.field.MpduDensity = 4;
1661                         DBGPRINT(RT_DEBUG_TRACE, ("HT: MPDU Density = %d (Default)\n", 4));
1662                 }
1663         }
1664
1665         // Max Rx BA Window Size
1666     if (RTMPGetKeyParameter("HT_BAWinSize", pValueStr, 25, pInput))
1667         {
1668                 Value = simple_strtol(pValueStr, 0, 10);
1669
1670                 if (Value >=1 && Value <= 64)
1671                 {
1672                         pAd->CommonCfg.REGBACapability.field.RxBAWinLimit = Value;
1673                         pAd->CommonCfg.BACapability.field.RxBAWinLimit = Value;
1674                         DBGPRINT(RT_DEBUG_TRACE, ("HT: BA Windw Size = %d\n", Value));
1675                 }
1676                 else
1677                 {
1678             pAd->CommonCfg.REGBACapability.field.RxBAWinLimit = 64;
1679                         pAd->CommonCfg.BACapability.field.RxBAWinLimit = 64;
1680                         DBGPRINT(RT_DEBUG_TRACE, ("HT: BA Windw Size = 64 (Defualt)\n"));
1681                 }
1682
1683         }
1684
1685         // Guard Interval
1686         if (RTMPGetKeyParameter("HT_GI", pValueStr, 25, pInput))
1687         {
1688                 Value = simple_strtol(pValueStr, 0, 10);
1689
1690                 if (Value == GI_400)
1691                 {
1692                         pAd->CommonCfg.RegTransmitSetting.field.ShortGI = GI_400;
1693                 }
1694                 else
1695                 {
1696                         pAd->CommonCfg.RegTransmitSetting.field.ShortGI = GI_800;
1697                 }
1698
1699                 DBGPRINT(RT_DEBUG_TRACE, ("HT: Guard Interval = %s\n", (Value==GI_400) ? "400" : "800" ));
1700         }
1701
1702         // HT Operation Mode : Mixed Mode , Green Field
1703         if (RTMPGetKeyParameter("HT_OpMode", pValueStr, 25, pInput))
1704         {
1705                 Value = simple_strtol(pValueStr, 0, 10);
1706
1707                 if (Value == HTMODE_GF)
1708                 {
1709
1710                         pAd->CommonCfg.RegTransmitSetting.field.HTMODE  = HTMODE_GF;
1711                 }
1712                 else
1713                 {
1714                         pAd->CommonCfg.RegTransmitSetting.field.HTMODE  = HTMODE_MM;
1715                 }
1716
1717                 DBGPRINT(RT_DEBUG_TRACE, ("HT: Operate Mode = %s\n", (Value==HTMODE_GF) ? "Green Field" : "Mixed Mode" ));
1718         }
1719
1720         // Fixed Tx mode : CCK, OFDM
1721         if (RTMPGetKeyParameter("FixedTxMode", pValueStr, 25, pInput))
1722         {
1723                 UCHAR   fix_tx_mode;
1724
1725                 IF_DEV_CONFIG_OPMODE_ON_STA(pAd)
1726                 {
1727                         fix_tx_mode = FIXED_TXMODE_HT;
1728
1729                         if (strcmp(pValueStr, "OFDM") == 0 || strcmp(pValueStr, "ofdm") == 0)
1730                         {
1731                                 fix_tx_mode = FIXED_TXMODE_OFDM;
1732                         }
1733                         else if (strcmp(pValueStr, "CCK") == 0 || strcmp(pValueStr, "cck") == 0)
1734                         {
1735                         fix_tx_mode = FIXED_TXMODE_CCK;
1736                         }
1737                         else if (strcmp(pValueStr, "HT") == 0 || strcmp(pValueStr, "ht") == 0)
1738                         {
1739                         fix_tx_mode = FIXED_TXMODE_HT;
1740                 }
1741                 else
1742                 {
1743                                 Value = simple_strtol(pValueStr, 0, 10);
1744                                 // 1 : CCK
1745                                 // 2 : OFDM
1746                                 // otherwise : HT
1747                                 if (Value == FIXED_TXMODE_CCK || Value == FIXED_TXMODE_OFDM)
1748                                         fix_tx_mode = Value;
1749                                 else
1750                                         fix_tx_mode = FIXED_TXMODE_HT;
1751                 }
1752
1753                         pAd->StaCfg.DesiredTransmitSetting.field.FixedTxMode = fix_tx_mode;
1754                         DBGPRINT(RT_DEBUG_TRACE, ("Fixed Tx Mode = %d\n", fix_tx_mode));
1755
1756                 }
1757         }
1758
1759
1760         // Channel Width
1761         if (RTMPGetKeyParameter("HT_BW", pValueStr, 25, pInput))
1762         {
1763                 Value = simple_strtol(pValueStr, 0, 10);
1764
1765                 if (Value == BW_40)
1766                 {
1767                         pAd->CommonCfg.RegTransmitSetting.field.BW  = BW_40;
1768                 }
1769                 else
1770                 {
1771             pAd->CommonCfg.RegTransmitSetting.field.BW  = BW_20;
1772                 }
1773
1774 #ifdef MCAST_RATE_SPECIFIC
1775                 pAd->CommonCfg.MCastPhyMode.field.BW = pAd->CommonCfg.RegTransmitSetting.field.BW;
1776 #endif // MCAST_RATE_SPECIFIC //
1777
1778                 DBGPRINT(RT_DEBUG_TRACE, ("HT: Channel Width = %s\n", (Value==BW_40) ? "40 MHz" : "20 MHz" ));
1779         }
1780
1781         if (RTMPGetKeyParameter("HT_EXTCHA", pValueStr, 25, pInput))
1782         {
1783                 Value = simple_strtol(pValueStr, 0, 10);
1784
1785                 if (Value == 0)
1786                 {
1787
1788                         pAd->CommonCfg.RegTransmitSetting.field.EXTCHA  = EXTCHA_BELOW;
1789                 }
1790                 else
1791                 {
1792             pAd->CommonCfg.RegTransmitSetting.field.EXTCHA = EXTCHA_ABOVE;
1793                 }
1794
1795                 DBGPRINT(RT_DEBUG_TRACE, ("HT: Ext Channel = %s\n", (Value==0) ? "BELOW" : "ABOVE" ));
1796         }
1797
1798         // MSC
1799         if (RTMPGetKeyParameter("HT_MCS", pValueStr, 50, pInput))
1800         {
1801                 IF_DEV_CONFIG_OPMODE_ON_STA(pAd)
1802                 {
1803                         Value = simple_strtol(pValueStr, 0, 10);
1804
1805                         if ((Value >= 0 && Value <= 23) || (Value == 32)) // 3*3
1806                 {
1807                                 pAd->StaCfg.DesiredTransmitSetting.field.MCS  = Value;
1808                                 pAd->StaCfg.bAutoTxRateSwitch = FALSE;
1809                                 DBGPRINT(RT_DEBUG_TRACE, ("HT: MCS = %d\n", pAd->StaCfg.DesiredTransmitSetting.field.MCS));
1810                 }
1811                 else
1812                 {
1813                                 pAd->StaCfg.DesiredTransmitSetting.field.MCS  = MCS_AUTO;
1814                                 pAd->StaCfg.bAutoTxRateSwitch = TRUE;
1815                                 DBGPRINT(RT_DEBUG_TRACE, ("HT: MCS = AUTO\n"));
1816                 }
1817         }
1818         }
1819
1820         // STBC
1821     if (RTMPGetKeyParameter("HT_STBC", pValueStr, 25, pInput))
1822         {
1823                 Value = simple_strtol(pValueStr, 0, 10);
1824                 if (Value == STBC_USE)
1825                 {
1826                         pAd->CommonCfg.RegTransmitSetting.field.STBC = STBC_USE;
1827                 }
1828                 else
1829                 {
1830                         pAd->CommonCfg.RegTransmitSetting.field.STBC = STBC_NONE;
1831                 }
1832                 DBGPRINT(RT_DEBUG_TRACE, ("HT: STBC = %d\n", pAd->CommonCfg.RegTransmitSetting.field.STBC));
1833         }
1834
1835         // 40_Mhz_Intolerant
1836         if (RTMPGetKeyParameter("HT_40MHZ_INTOLERANT", pValueStr, 25, pInput))
1837         {
1838                 Value = simple_strtol(pValueStr, 0, 10);
1839                 if (Value == 0)
1840                 {
1841                         pAd->CommonCfg.bForty_Mhz_Intolerant = FALSE;
1842                 }
1843                 else
1844                 {
1845                         pAd->CommonCfg.bForty_Mhz_Intolerant = TRUE;
1846                 }
1847                 DBGPRINT(RT_DEBUG_TRACE, ("HT: 40MHZ INTOLERANT = %d\n", pAd->CommonCfg.bForty_Mhz_Intolerant));
1848         }
1849         //HT_TxStream
1850         if(RTMPGetKeyParameter("HT_TxStream", pValueStr, 10, pInput))
1851         {
1852                 switch (simple_strtol(pValueStr, 0, 10))
1853                 {
1854                         case 1:
1855                                 pAd->CommonCfg.TxStream = 1;
1856                                 break;
1857                         case 2:
1858                                 pAd->CommonCfg.TxStream = 2;
1859                                 break;
1860                         case 3: // 3*3
1861                         default:
1862                                 pAd->CommonCfg.TxStream = 3;
1863
1864                                 if (pAd->MACVersion < RALINK_2883_VERSION)
1865                                         pAd->CommonCfg.TxStream = 2; // only 2 tx streams for RT2860 series
1866                                 break;
1867                 }
1868                 DBGPRINT(RT_DEBUG_TRACE, ("HT: Tx Stream = %d\n", pAd->CommonCfg.TxStream));
1869         }
1870         //HT_RxStream
1871         if(RTMPGetKeyParameter("HT_RxStream", pValueStr, 10, pInput))
1872         {
1873                 switch (simple_strtol(pValueStr, 0, 10))
1874                 {
1875                         case 1:
1876                                 pAd->CommonCfg.RxStream = 1;
1877                                 break;
1878                         case 2:
1879                                 pAd->CommonCfg.RxStream = 2;
1880                                 break;
1881                         case 3:
1882                         default:
1883                                 pAd->CommonCfg.RxStream = 3;
1884
1885                                 if (pAd->MACVersion < RALINK_2883_VERSION)
1886                                         pAd->CommonCfg.RxStream = 2; // only 2 rx streams for RT2860 series
1887                                 break;
1888                 }
1889                 DBGPRINT(RT_DEBUG_TRACE, ("HT: Rx Stream = %d\n", pAd->CommonCfg.RxStream));
1890         }
1891
1892 }
1893 #endif // DOT11_N_SUPPORT //
1894