git.oblomov.eu Git - linux-2.6/blob - drivers/staging/rt2860/rt_main_dev.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     Module Name:
  28     rt_main_dev.c
  29
  30     Abstract:
  31     Create and register network interface.
  32
  33     Revision History:
  34     Who         When            What
  35     --------    ----------      ----------------------------------------------
  36         Sample          Mar/21/07               Merge RT2870 and RT2860 drivers.
  37 */
  38
  39 #include "rt_config.h"
  40
  41 #define FORTY_MHZ_INTOLERANT_INTERVAL   (60*1000) // 1 min
  42
  43 #ifdef MULTIPLE_CARD_SUPPORT
  44 // record whether the card in the card list is used in the card file
  45 UINT8  MC_CardUsed[MAX_NUM_OF_MULTIPLE_CARD];
  46 // record used card mac address in the card list
  47 static UINT8  MC_CardMac[MAX_NUM_OF_MULTIPLE_CARD][6];
  48 #endif // MULTIPLE_CARD_SUPPORT //
  49
  50 #ifdef CONFIG_APSTA_MIXED_SUPPORT
  51 UINT32 CW_MAX_IN_BITS;
  52 #endif // CONFIG_APSTA_MIXED_SUPPORT //
  53
  54 /*---------------------------------------------------------------------*/
  55 /* Private Variables Used                                              */
  56 /*---------------------------------------------------------------------*/
  57 //static RALINK_TIMER_STRUCT     PeriodicTimer;
  58
  59 char *mac = "";            // default 00:00:00:00:00:00
  60 char *hostname = "";               // default CMPC
  61 #if LINUX_VERSION_CODE <= KERNEL_VERSION(2,6,12)
  62 MODULE_PARM (mac, "s");
  63 #else
  64 module_param (mac, charp, 0);
  65 #endif
  66 MODULE_PARM_DESC (mac, "rt28xx: wireless mac addr");
  67
  68
  69 /*---------------------------------------------------------------------*/
  70 /* Prototypes of Functions Used                                        */
  71 /*---------------------------------------------------------------------*/
  72 #ifdef DOT11_N_SUPPORT
  73 extern BOOLEAN ba_reordering_resource_init(PRTMP_ADAPTER pAd, int num);
  74 extern void ba_reordering_resource_release(PRTMP_ADAPTER pAd);
  75 #endif // DOT11_N_SUPPORT //
  76 extern NDIS_STATUS NICLoadRateSwitchingParams(IN PRTMP_ADAPTER pAd);
  77
  78 #ifdef RT2860
  79 extern void init_thread_task(PRTMP_ADAPTER pAd);
  80 #endif // RT2860 //
  81
  82 // public function prototype
  83 INT __devinit rt28xx_probe(IN void *_dev_p, IN void *_dev_id_p,
  84                                                         IN UINT argc, OUT PRTMP_ADAPTER *ppAd);
  85
  86 // private function prototype
  87 static int rt28xx_init(IN struct net_device *net_dev);
  88 INT rt28xx_send_packets(IN struct sk_buff *skb_p, IN struct net_device *net_dev);
  89
  90 #if LINUX_VERSION_CODE <= 0x20402       // Red Hat 7.1
  91 struct net_device *alloc_netdev(
  92         int sizeof_priv,
  93         const char *mask,
  94         void (*setup)(struct net_device *));
  95 #endif // LINUX_VERSION_CODE //
  96
  97 static void CfgInitHook(PRTMP_ADAPTER pAd);
  98
  99 #ifdef CONFIG_STA_SUPPORT
 100 extern  const struct iw_handler_def rt28xx_iw_handler_def;
 101 #endif // CONFIG_STA_SUPPORT //
 102
 103 #ifdef CONFIG_APSTA_MIXED_SUPPORT
 104 extern  const struct iw_handler_def rt28xx_ap_iw_handler_def;
 105 #endif // CONFIG_APSTA_MIXED_SUPPORT //
 106
 107 #if WIRELESS_EXT >= 12
 108 // This function will be called when query /proc
 109 struct iw_statistics *rt28xx_get_wireless_stats(
 110     IN struct net_device *net_dev);
 111 #endif
 112
 113 struct net_device_stats *RT28xx_get_ether_stats(
 114     IN  struct net_device *net_dev);
 115
 116 /*
 117 ========================================================================
 118 Routine Description:
 119     Close raxx interface.
 120
 121 Arguments:
 122         *net_dev                        the raxx interface pointer
 123
 124 Return Value:
 125     0                                   Open OK
 126         otherwise                       Open Fail
 127
 128 Note:
 129         1. if open fail, kernel will not call the close function.
 130         2. Free memory for
 131                 (1) Mlme Memory Handler:                MlmeHalt()
 132                 (2) TX & RX:                                    RTMPFreeTxRxRingMemory()
 133                 (3) BA Reordering:                              ba_reordering_resource_release()
 134 ========================================================================
 135 */
 136 int MainVirtualIF_close(IN struct net_device *net_dev)
 137 {
 138     RTMP_ADAPTER *pAd = net_dev->ml_priv;
 139
 140         // Sanity check for pAd
 141         if (pAd == NULL)
 142                 return 0; // close ok
 143
 144         netif_carrier_off(pAd->net_dev);
 145         netif_stop_queue(pAd->net_dev);
 146
 147
 148         VIRTUAL_IF_DOWN(pAd);
 149
 150         RT_MOD_DEC_USE_COUNT();
 151
 152         return 0; // close ok
 153 }
 154
 155 /*
 156 ========================================================================
 157 Routine Description:
 158     Open raxx interface.
 159
 160 Arguments:
 161         *net_dev                        the raxx interface pointer
 162
 163 Return Value:
 164     0                                   Open OK
 165         otherwise                       Open Fail
 166
 167 Note:
 168         1. if open fail, kernel will not call the close function.
 169         2. Free memory for
 170                 (1) Mlme Memory Handler:                MlmeHalt()
 171                 (2) TX & RX:                                    RTMPFreeTxRxRingMemory()
 172                 (3) BA Reordering:                              ba_reordering_resource_release()
 173 ========================================================================
 174 */
 175 int MainVirtualIF_open(IN struct net_device *net_dev)
 176 {
 177     RTMP_ADAPTER *pAd = net_dev->ml_priv;
 178
 179         // Sanity check for pAd
 180         if (pAd == NULL)
 181                 return 0; // close ok
 182
 183         if (VIRTUAL_IF_UP(pAd) != 0)
 184                 return -1;
 185
 186         // increase MODULE use count
 187         RT_MOD_INC_USE_COUNT();
 188
 189         netif_start_queue(net_dev);
 190         netif_carrier_on(net_dev);
 191         netif_wake_queue(net_dev);
 192
 193         return 0;
 194 }
 195
 196 /*
 197 ========================================================================
 198 Routine Description:
 199     Close raxx interface.
 200
 201 Arguments:
 202         *net_dev                        the raxx interface pointer
 203
 204 Return Value:
 205     0                                   Open OK
 206         otherwise                       Open Fail
 207
 208 Note:
 209         1. if open fail, kernel will not call the close function.
 210         2. Free memory for
 211                 (1) Mlme Memory Handler:                MlmeHalt()
 212                 (2) TX & RX:                                    RTMPFreeTxRxRingMemory()
 213                 (3) BA Reordering:                              ba_reordering_resource_release()
 214 ========================================================================
 215 */
 216 int rt28xx_close(IN PNET_DEV dev)
 217 {
 218         struct net_device * net_dev = (struct net_device *)dev;
 219     RTMP_ADAPTER        *pAd = net_dev->ml_priv;
 220         BOOLEAN                 Cancelled = FALSE;
 221         UINT32                  i = 0;
 222
 223
 224     DBGPRINT(RT_DEBUG_TRACE, ("===> rt28xx_close\n"));
 225
 226         // Sanity check for pAd
 227         if (pAd == NULL)
 228                 return 0; // close ok
 229
 230
 231 #ifdef WDS_SUPPORT
 232         WdsDown(pAd);
 233 #endif // WDS_SUPPORT //
 234
 235 #ifdef CONFIG_STA_SUPPORT
 236         IF_DEV_CONFIG_OPMODE_ON_STA(pAd)
 237         {
 238 #ifdef RT2860
 239                 RTMPPCIeLinkCtrlValueRestore(pAd, RESTORE_CLOSE);
 240 #endif // RT2860 //
 241
 242                 // If dirver doesn't wake up firmware here,
 243                 // NICLoadFirmware will hang forever when interface is up again.
 244                 if (OPSTATUS_TEST_FLAG(pAd, fOP_STATUS_DOZE))
 245         {
 246                     AsicForceWakeup(pAd, TRUE);
 247         }
 248
 249 #ifdef QOS_DLS_SUPPORT
 250                 // send DLS-TEAR_DOWN message,
 251                 if (pAd->CommonCfg.bDLSCapable)
 252                 {
 253                         UCHAR i;
 254
 255                         // tear down local dls table entry
 256                         for (i=0; i<MAX_NUM_OF_INIT_DLS_ENTRY; i++)
 257                         {
 258                                 if (pAd->StaCfg.DLSEntry[i].Valid && (pAd->StaCfg.DLSEntry[i].Status == DLS_FINISH))
 259                                 {
 260                                         RTMPSendDLSTearDownFrame(pAd, pAd->StaCfg.DLSEntry[i].MacAddr);
 261                                         pAd->StaCfg.DLSEntry[i].Status  = DLS_NONE;
 262                                         pAd->StaCfg.DLSEntry[i].Valid   = FALSE;
 263                                 }
 264                         }
 265
 266                         // tear down peer dls table entry
 267                         for (i=MAX_NUM_OF_INIT_DLS_ENTRY; i<MAX_NUM_OF_DLS_ENTRY; i++)
 268                         {
 269                                 if (pAd->StaCfg.DLSEntry[i].Valid && (pAd->StaCfg.DLSEntry[i].Status == DLS_FINISH))
 270                                 {
 271                                         RTMPSendDLSTearDownFrame(pAd, pAd->StaCfg.DLSEntry[i].MacAddr);
 272                                         pAd->StaCfg.DLSEntry[i].Status = DLS_NONE;
 273                                         pAd->StaCfg.DLSEntry[i].Valid   = FALSE;
 274                                 }
 275                         }
 276                         RT28XX_MLME_HANDLER(pAd);
 277                 }
 278 #endif // QOS_DLS_SUPPORT //
 279
 280                 if (INFRA_ON(pAd) &&
 281                         (!RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_NIC_NOT_EXIST)))
 282                 {
 283                         MLME_DISASSOC_REQ_STRUCT        DisReq;
 284                         MLME_QUEUE_ELEM *MsgElem = (MLME_QUEUE_ELEM *) kmalloc(sizeof(MLME_QUEUE_ELEM), MEM_ALLOC_FLAG);
 285
 286                         COPY_MAC_ADDR(DisReq.Addr, pAd->CommonCfg.Bssid);
 287                         DisReq.Reason =  REASON_DEAUTH_STA_LEAVING;
 288
 289                         MsgElem->Machine = ASSOC_STATE_MACHINE;
 290                         MsgElem->MsgType = MT2_MLME_DISASSOC_REQ;
 291                         MsgElem->MsgLen = sizeof(MLME_DISASSOC_REQ_STRUCT);
 292                         NdisMoveMemory(MsgElem->Msg, &DisReq, sizeof(MLME_DISASSOC_REQ_STRUCT));
 293
 294                         // Prevent to connect AP again in STAMlmePeriodicExec
 295                         pAd->MlmeAux.AutoReconnectSsidLen= 32;
 296                         NdisZeroMemory(pAd->MlmeAux.AutoReconnectSsid, pAd->MlmeAux.AutoReconnectSsidLen);
 297
 298                         pAd->Mlme.CntlMachine.CurrState = CNTL_WAIT_OID_DISASSOC;
 299                         MlmeDisassocReqAction(pAd, MsgElem);
 300                         kfree(MsgElem);
 301
 302                         RTMPusecDelay(1000);
 303                 }
 304
 305
 306 #ifdef CCX_SUPPORT
 307                 RTMPCancelTimer(&pAd->StaCfg.LeapAuthTimer, &Cancelled);
 308 #endif
 309
 310                 RTMPCancelTimer(&pAd->StaCfg.StaQuickResponeForRateUpTimer, &Cancelled);
 311                 RTMPCancelTimer(&pAd->StaCfg.WpaDisassocAndBlockAssocTimer, &Cancelled);
 312
 313 #ifdef WPA_SUPPLICANT_SUPPORT
 314 #ifndef NATIVE_WPA_SUPPLICANT_SUPPORT
 315                 {
 316                         union iwreq_data    wrqu;
 317                         // send wireless event to wpa_supplicant for infroming interface down.
 318                         memset(&wrqu, 0, sizeof(wrqu));
 319                         wrqu.data.flags = RT_INTERFACE_DOWN;
 320                         wireless_send_event(pAd->net_dev, IWEVCUSTOM, &wrqu, NULL);
 321                 }
 322 #endif // NATIVE_WPA_SUPPLICANT_SUPPORT //
 323 #endif // WPA_SUPPLICANT_SUPPORT //
 324
 325                 MlmeRadioOff(pAd);
 326 #ifdef RT2860
 327                 pAd->bPCIclkOff = FALSE;
 328 #endif // RT2860 //
 329         }
 330 #endif // CONFIG_STA_SUPPORT //
 331
 332         RTMP_SET_FLAG(pAd, fRTMP_ADAPTER_HALT_IN_PROGRESS);
 333
 334         for (i = 0 ; i < NUM_OF_TX_RING; i++)
 335         {
 336                 while (pAd->DeQueueRunning[i] == TRUE)
 337                 {
 338                         printk("Waiting for TxQueue[%d] done..........\n", i);
 339                         RTMPusecDelay(1000);
 340                 }
 341         }
 342
 343         // Stop Mlme state machine
 344         MlmeHalt(pAd);
 345
 346         // Close kernel threads or tasklets
 347         kill_thread_task(pAd);
 348
 349
 350 #ifdef CONFIG_STA_SUPPORT
 351         IF_DEV_CONFIG_OPMODE_ON_STA(pAd)
 352         {
 353                 MacTableReset(pAd);
 354         }
 355 #endif // CONFIG_STA_SUPPORT //
 356
 357
 358         MeasureReqTabExit(pAd);
 359         TpcReqTabExit(pAd);
 360
 361
 362 #ifdef RT2860
 363         if (RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_INTERRUPT_ACTIVE))
 364         {
 365                 NICDisableInterrupt(pAd);
 366         }
 367
 368         // Disable Rx, register value supposed will remain after reset
 369         NICIssueReset(pAd);
 370
 371         // Free IRQ
 372         if (RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_INTERRUPT_IN_USE))
 373         {
 374                 // Deregister interrupt function
 375                 RT28XX_IRQ_RELEASE(net_dev)
 376                 RTMP_CLEAR_FLAG(pAd, fRTMP_ADAPTER_INTERRUPT_IN_USE);
 377         }
 378 #endif // RT2860 //
 379
 380
 381         // Free Ring or USB buffers
 382         RTMPFreeTxRxRingMemory(pAd);
 383
 384         RTMP_CLEAR_FLAG(pAd, fRTMP_ADAPTER_HALT_IN_PROGRESS);
 385
 386 #ifdef DOT11_N_SUPPORT
 387         // Free BA reorder resource
 388         ba_reordering_resource_release(pAd);
 389 #endif // DOT11_N_SUPPORT //
 390
 391
 392         RTMP_CLEAR_FLAG(pAd, fRTMP_ADAPTER_START_UP);
 393
 394         return 0; // close ok
 395 } /* End of rt28xx_close */
 396
 397 static int rt28xx_init(IN struct net_device *net_dev)
 398 {
 399         PRTMP_ADAPTER                   pAd = (PRTMP_ADAPTER)net_dev->ml_priv;
 400         UINT                                    index;
 401         UCHAR                                   TmpPhy;
 402         NDIS_STATUS                             Status;
 403         UINT32          MacCsr0 = 0;
 404
 405
 406 #ifdef DOT11_N_SUPPORT
 407         // Allocate BA Reordering memory
 408         ba_reordering_resource_init(pAd, MAX_REORDERING_MPDU_NUM);
 409 #endif // DOT11_N_SUPPORT //
 410
 411         // Make sure MAC gets ready.
 412         index = 0;
 413         do
 414         {
 415                 RTMP_IO_READ32(pAd, MAC_CSR0, &MacCsr0);
 416                 pAd->MACVersion = MacCsr0;
 417
 418                 if ((pAd->MACVersion != 0x00) && (pAd->MACVersion != 0xFFFFFFFF))
 419                         break;
 420
 421                 RTMPusecDelay(10);
 422         } while (index++ < 100);
 423
 424         DBGPRINT(RT_DEBUG_TRACE, ("MAC_CSR0  [ Ver:Rev=0x%08x]\n", pAd->MACVersion));
 425
 426         // Disable DMA
 427         RT28XXDMADisable(pAd);
 428
 429
 430         // Load 8051 firmware
 431         Status = NICLoadFirmware(pAd);
 432         if (Status != NDIS_STATUS_SUCCESS)
 433         {
 434                 DBGPRINT_ERR(("NICLoadFirmware failed, Status[=0x%08x]\n", Status));
 435                 goto err1;
 436         }
 437
 438         NICLoadRateSwitchingParams(pAd);
 439
 440         // Disable interrupts here which is as soon as possible
 441         // This statement should never be true. We might consider to remove it later
 442 #ifdef RT2860
 443         if (RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_INTERRUPT_ACTIVE))
 444         {
 445                 NICDisableInterrupt(pAd);
 446         }
 447 #endif // RT2860 //
 448
 449         Status = RTMPAllocTxRxRingMemory(pAd);
 450         if (Status != NDIS_STATUS_SUCCESS)
 451         {
 452                 DBGPRINT_ERR(("RTMPAllocDMAMemory failed, Status[=0x%08x]\n", Status));
 453                 goto err1;
 454         }
 455
 456         RTMP_SET_FLAG(pAd, fRTMP_ADAPTER_INTERRUPT_IN_USE);
 457
 458         // initialize MLME
 459         //
 460
 461         Status = MlmeInit(pAd);
 462         if (Status != NDIS_STATUS_SUCCESS)
 463         {
 464                 DBGPRINT_ERR(("MlmeInit failed, Status[=0x%08x]\n", Status));
 465                 goto err2;
 466         }
 467
 468         // Initialize pAd->StaCfg, pAd->ApCfg, pAd->CommonCfg to manufacture default
 469         //
 470         UserCfgInit(pAd);
 471
 472
 473         RT28XX_TASK_THREAD_INIT(pAd, Status);
 474         if (Status != NDIS_STATUS_SUCCESS)
 475                 goto err1;
 476
 477         CfgInitHook(pAd);
 478
 479
 480 #ifdef BLOCK_NET_IF
 481         initblockQueueTab(pAd);
 482 #endif // BLOCK_NET_IF //
 483
 484 #ifdef CONFIG_STA_SUPPORT
 485         IF_DEV_CONFIG_OPMODE_ON_STA(pAd)
 486                 NdisAllocateSpinLock(&pAd->MacTabLock);
 487 #endif // CONFIG_STA_SUPPORT //
 488
 489         MeasureReqTabInit(pAd);
 490         TpcReqTabInit(pAd);
 491
 492         //
 493         // Init the hardware, we need to init asic before read registry, otherwise mac register will be reset
 494         //
 495         Status = NICInitializeAdapter(pAd, TRUE);
 496         if (Status != NDIS_STATUS_SUCCESS)
 497         {
 498                 DBGPRINT_ERR(("NICInitializeAdapter failed, Status[=0x%08x]\n", Status));
 499                 if (Status != NDIS_STATUS_SUCCESS)
 500                 goto err3;
 501         }
 502
 503         // Read parameters from Config File
 504         Status = RTMPReadParametersHook(pAd);
 505
 506         printk("1. Phy Mode = %d\n", pAd->CommonCfg.PhyMode);
 507         if (Status != NDIS_STATUS_SUCCESS)
 508         {
 509                 DBGPRINT_ERR(("NICReadRegParameters failed, Status[=0x%08x]\n",Status));
 510                 goto err4;
 511         }
 512
 513
 514
 515         //Init Ba Capability parameters.
 516 #ifdef DOT11_N_SUPPORT
 517         pAd->CommonCfg.DesiredHtPhy.MpduDensity = (UCHAR)pAd->CommonCfg.BACapability.field.MpduDensity;
 518         pAd->CommonCfg.DesiredHtPhy.AmsduEnable = (USHORT)pAd->CommonCfg.BACapability.field.AmsduEnable;
 519         pAd->CommonCfg.DesiredHtPhy.AmsduSize = (USHORT)pAd->CommonCfg.BACapability.field.AmsduSize;
 520         pAd->CommonCfg.DesiredHtPhy.MimoPs = (USHORT)pAd->CommonCfg.BACapability.field.MMPSmode;
 521         // UPdata to HT IE
 522         pAd->CommonCfg.HtCapability.HtCapInfo.MimoPs = (USHORT)pAd->CommonCfg.BACapability.field.MMPSmode;
 523         pAd->CommonCfg.HtCapability.HtCapInfo.AMsduSize = (USHORT)pAd->CommonCfg.BACapability.field.AmsduSize;
 524         pAd->CommonCfg.HtCapability.HtCapParm.MpduDensity = (UCHAR)pAd->CommonCfg.BACapability.field.MpduDensity;
 525 #endif // DOT11_N_SUPPORT //
 526
 527         printk("2. Phy Mode = %d\n", pAd->CommonCfg.PhyMode);
 528
 529         // We should read EEPROM for all cases.  rt2860b
 530         NICReadEEPROMParameters(pAd, mac);
 531
 532         printk("3. Phy Mode = %d\n", pAd->CommonCfg.PhyMode);
 533
 534         NICInitAsicFromEEPROM(pAd); //rt2860b
 535
 536         // Set PHY to appropriate mode
 537         TmpPhy = pAd->CommonCfg.PhyMode;
 538         pAd->CommonCfg.PhyMode = 0xff;
 539         RTMPSetPhyMode(pAd, TmpPhy);
 540 #ifdef DOT11_N_SUPPORT
 541         SetCommonHT(pAd);
 542 #endif // DOT11_N_SUPPORT //
 543
 544         // No valid channels.
 545         if (pAd->ChannelListNum == 0)
 546         {
 547                 printk("Wrong configuration. No valid channel found. Check \"ContryCode\" and \"ChannelGeography\" setting.\n");
 548                 goto err4;
 549         }
 550
 551 #ifdef DOT11_N_SUPPORT
 552         printk("MCS Set = %02x %02x %02x %02x %02x\n", pAd->CommonCfg.HtCapability.MCSSet[0],
 553            pAd->CommonCfg.HtCapability.MCSSet[1], pAd->CommonCfg.HtCapability.MCSSet[2],
 554            pAd->CommonCfg.HtCapability.MCSSet[3], pAd->CommonCfg.HtCapability.MCSSet[4]);
 555 #endif // DOT11_N_SUPPORT //
 556
 557 #ifdef IKANOS_VX_1X0
 558         VR_IKANOS_FP_Init(pAd->ApCfg.BssidNum, pAd->PermanentAddress);
 559 #endif // IKANOS_VX_1X0 //
 560
 561                 //
 562         // Initialize RF register to default value
 563         //
 564         AsicSwitchChannel(pAd, pAd->CommonCfg.Channel, FALSE);
 565         AsicLockChannel(pAd, pAd->CommonCfg.Channel);
 566
 567         // 8051 firmware require the signal during booting time.
 568         AsicSendCommandToMcu(pAd, 0x72, 0xFF, 0x00, 0x00);
 569
 570         if (pAd && (Status != NDIS_STATUS_SUCCESS))
 571         {
 572                 //
 573                 // Undo everything if it failed
 574                 //
 575                 if (RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_INTERRUPT_IN_USE))
 576                 {
 577                         RTMP_CLEAR_FLAG(pAd, fRTMP_ADAPTER_INTERRUPT_IN_USE);
 578                 }
 579         }
 580         else if (pAd)
 581         {
 582                 // Microsoft HCT require driver send a disconnect event after driver initialization.
 583                 OPSTATUS_CLEAR_FLAG(pAd, fOP_STATUS_MEDIA_STATE_CONNECTED);
 584                 RTMP_SET_FLAG(pAd, fRTMP_ADAPTER_MEDIA_STATE_CHANGE);
 585                 DBGPRINT(RT_DEBUG_TRACE, ("NDIS_STATUS_MEDIA_DISCONNECT Event B!\n"));
 586
 587
 588         }// end of else
 589
 590
 591         DBGPRINT_S(Status, ("<==== RTMPInitialize, Status=%x\n", Status));
 592
 593         return TRUE;
 594
 595
 596 err4:
 597 err3:
 598         MlmeHalt(pAd);
 599 err2:
 600         RTMPFreeTxRxRingMemory(pAd);
 601 err1:
 602
 603 #ifdef DOT11_N_SUPPORT
 604         os_free_mem(pAd, pAd->mpdu_blk_pool.mem); // free BA pool
 605 #endif // DOT11_N_SUPPORT //
 606         RT28XX_IRQ_RELEASE(net_dev);
 607
 608         // shall not set ml_priv to NULL here because the ml_priv didn't been free yet.
 609         //net_dev->ml_priv = 0;
 610 #ifdef INF_AMAZON_SE
 611 err0:
 612 #endif // INF_AMAZON_SE //
 613         printk("!!! %s Initialized fail !!!\n", RT28xx_CHIP_NAME);
 614         return FALSE;
 615 } /* End of rt28xx_init */
 616
 617
 618 /*
 619 ========================================================================
 620 Routine Description:
 621     Open raxx interface.
 622
 623 Arguments:
 624         *net_dev                        the raxx interface pointer
 625
 626 Return Value:
 627     0                                   Open OK
 628         otherwise                       Open Fail
 629
 630 Note:
 631 ========================================================================
 632 */
 633 int rt28xx_open(IN PNET_DEV dev)
 634 {
 635         struct net_device * net_dev = (struct net_device *)dev;
 636         PRTMP_ADAPTER pAd = net_dev->ml_priv;
 637         int retval = 0;
 638         POS_COOKIE pObj;
 639
 640
 641         // Sanity check for pAd
 642         if (pAd == NULL)
 643         {
 644                 /* if 1st open fail, pAd will be free;
 645                    So the net_dev->ml_priv will be NULL in 2rd open */
 646                 return -1;
 647         }
 648
 649 #ifdef CONFIG_APSTA_MIXED_SUPPORT
 650         if (pAd->OpMode == OPMODE_AP)
 651         {
 652                 CW_MAX_IN_BITS = 6;
 653         }
 654         else if (pAd->OpMode == OPMODE_STA)
 655         {
 656                 CW_MAX_IN_BITS = 10;
 657         }
 658
 659 #if WIRELESS_EXT >= 12
 660         if (net_dev->priv_flags == INT_MAIN)
 661         {
 662                 if (pAd->OpMode == OPMODE_AP)
 663                         net_dev->wireless_handlers = (struct iw_handler_def *) &rt28xx_ap_iw_handler_def;
 664                 else if (pAd->OpMode == OPMODE_STA)
 665                         net_dev->wireless_handlers = (struct iw_handler_def *) &rt28xx_iw_handler_def;
 666         }
 667 #endif // WIRELESS_EXT >= 12 //
 668 #endif // CONFIG_APSTA_MIXED_SUPPORT //
 669
 670 #ifdef CONFIG_STA_SUPPORT
 671 #ifdef RT2860
 672         IF_DEV_CONFIG_OPMODE_ON_STA(pAd)
 673         {
 674         // If dirver doesn't wake up firmware here,
 675         // NICLoadFirmware will hang forever when interface is up again.
 676         // RT2860 PCI
 677         if (OPSTATUS_TEST_FLAG(pAd, fOP_STATUS_DOZE) &&
 678                 OPSTATUS_TEST_FLAG(pAd, fOP_STATUS_ADVANCE_POWER_SAVE_PCIE_DEVICE))
 679         {
 680                 AUTO_WAKEUP_STRUC AutoWakeupCfg;
 681                         AsicForceWakeup(pAd, TRUE);
 682                 AutoWakeupCfg.word = 0;
 683                 RTMP_IO_WRITE32(pAd, AUTO_WAKEUP_CFG, AutoWakeupCfg.word);
 684                 OPSTATUS_CLEAR_FLAG(pAd, fOP_STATUS_DOZE);
 685         }
 686         }
 687 #endif // RT2860 //
 688 #endif // CONFIG_STA_SUPPORT //
 689
 690         // Init
 691         pObj = (POS_COOKIE)pAd->OS_Cookie;
 692
 693         // reset Adapter flags
 694         RTMP_CLEAR_FLAGS(pAd);
 695
 696         // Request interrupt service routine for PCI device
 697         // register the interrupt routine with the os
 698         RT28XX_IRQ_REQUEST(net_dev);
 699
 700
 701         // Init BssTab & ChannelInfo tabbles for auto channel select.
 702
 703
 704         // Chip & other init
 705         if (rt28xx_init(net_dev) == FALSE)
 706                 goto err;
 707
 708 #ifdef CONFIG_STA_SUPPORT
 709         IF_DEV_CONFIG_OPMODE_ON_STA(pAd)
 710         {
 711                 NdisZeroMemory(pAd->StaCfg.dev_name, 16);
 712                 NdisMoveMemory(pAd->StaCfg.dev_name, net_dev->name, strlen(net_dev->name));
 713         }
 714 #endif // CONFIG_STA_SUPPORT //
 715
 716         // Set up the Mac address
 717         NdisMoveMemory(net_dev->dev_addr, (void *) pAd->CurrentAddress, 6);
 718
 719         // Init IRQ parameters
 720         RT28XX_IRQ_INIT(pAd);
 721
 722         // Various AP function init
 723
 724 #ifdef CONFIG_STA_SUPPORT
 725         IF_DEV_CONFIG_OPMODE_ON_STA(pAd)
 726         {
 727 #ifdef WPA_SUPPLICANT_SUPPORT
 728 #ifndef NATIVE_WPA_SUPPLICANT_SUPPORT
 729                 {
 730                         union iwreq_data    wrqu;
 731                         // send wireless event to wpa_supplicant for infroming interface down.
 732                         memset(&wrqu, 0, sizeof(wrqu));
 733                         wrqu.data.flags = RT_INTERFACE_UP;
 734                         wireless_send_event(pAd->net_dev, IWEVCUSTOM, &wrqu, NULL);
 735                 }
 736 #endif // NATIVE_WPA_SUPPLICANT_SUPPORT //
 737 #endif // WPA_SUPPLICANT_SUPPORT //
 738
 739         }
 740 #endif // CONFIG_STA_SUPPORT //
 741
 742         // Enable Interrupt
 743         RT28XX_IRQ_ENABLE(pAd);
 744
 745         // Now Enable RxTx
 746         RTMPEnableRxTx(pAd);
 747         RTMP_SET_FLAG(pAd, fRTMP_ADAPTER_START_UP);
 748
 749         {
 750         UINT32 reg = 0;
 751         RTMP_IO_READ32(pAd, 0x1300, &reg);  // clear garbage interrupts
 752         printk("0x1300 = %08x\n", reg);
 753         }
 754
 755 #ifdef CONFIG_STA_SUPPORT
 756 #ifdef RT2860
 757         IF_DEV_CONFIG_OPMODE_ON_STA(pAd)
 758         RTMPInitPCIeLinkCtrlValue(pAd);
 759 #endif // RT2860 //
 760 #endif // CONFIG_STA_SUPPORT //
 761
 762         return (retval);
 763
 764 err:
 765         return (-1);
 766 } /* End of rt28xx_open */
 767
 768
 769 /* Must not be called for mdev and apdev */
 770 static NDIS_STATUS rt_ieee80211_if_setup(struct net_device *dev, PRTMP_ADAPTER pAd)
 771 {
 772         NDIS_STATUS Status;
 773         INT     i=0;
 774         CHAR    slot_name[IFNAMSIZ];
 775         struct net_device   *device;
 776
 777
 778         //ether_setup(dev);
 779         dev->hard_start_xmit = rt28xx_send_packets;
 780
 781 #ifdef IKANOS_VX_1X0
 782         dev->hard_start_xmit = IKANOS_DataFramesTx;
 783 #endif // IKANOS_VX_1X0 //
 784
 785 #ifdef CONFIG_STA_SUPPORT
 786 #if WIRELESS_EXT >= 12
 787         if (pAd->OpMode == OPMODE_STA)
 788         {
 789                 dev->wireless_handlers = &rt28xx_iw_handler_def;
 790         }
 791 #endif //WIRELESS_EXT >= 12
 792 #endif // CONFIG_STA_SUPPORT //
 793
 794 #ifdef CONFIG_APSTA_MIXED_SUPPORT
 795 #if WIRELESS_EXT >= 12
 796         if (pAd->OpMode == OPMODE_AP)
 797         {
 798                 dev->wireless_handlers = &rt28xx_ap_iw_handler_def;
 799         }
 800 #endif //WIRELESS_EXT >= 12
 801 #endif // CONFIG_APSTA_MIXED_SUPPORT //
 802
 803 #if WIRELESS_EXT < 21
 804                 dev->get_wireless_stats = rt28xx_get_wireless_stats;
 805 #endif
 806         dev->get_stats = RT28xx_get_ether_stats;
 807         dev->open = MainVirtualIF_open; //rt28xx_open;
 808         dev->stop = MainVirtualIF_close; //rt28xx_close;
 809         dev->priv_flags = INT_MAIN;
 810         dev->do_ioctl = rt28xx_ioctl;
 811 #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,24)
 812     dev->validate_addr = NULL;
 813 #endif
 814         // find available device name
 815         for (i = 0; i < 8; i++)
 816         {
 817 #ifdef MULTIPLE_CARD_SUPPORT
 818                 if (pAd->MC_RowID >= 0)
 819                         sprintf(slot_name, "ra%02d_%d", pAd->MC_RowID, i);
 820                 else
 821 #endif // MULTIPLE_CARD_SUPPORT //
 822                 sprintf(slot_name, "ra%d", i);
 823
 824 #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,5,0)
 825 #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,24)
 826 #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,26)
 827         device = dev_get_by_name(dev_net(dev), slot_name);
 828 #else
 829         device = dev_get_by_name(dev->nd_net, slot_name);
 830 #endif
 831 #else
 832                 device = dev_get_by_name(slot_name);
 833 #endif
 834                 if (device != NULL) dev_put(device);
 835 #else
 836                 for (device = dev_base; device != NULL; device = device->next)
 837                 {
 838                         if (strncmp(device->name, slot_name, 4) == 0)
 839                                 break;
 840                 }
 841 #endif
 842                 if(device == NULL)
 843                         break;
 844         }
 845
 846         if(i == 8)
 847         {
 848                 DBGPRINT(RT_DEBUG_ERROR, ("No available slot name\n"));
 849                 Status = NDIS_STATUS_FAILURE;
 850         }
 851         else
 852         {
 853 #ifdef MULTIPLE_CARD_SUPPORT
 854                 if (pAd->MC_RowID >= 0)
 855                 sprintf(dev->name, "ra%02d_%d", pAd->MC_RowID, i);
 856                 else
 857 #endif // MULTIPLE_CARD_SUPPORT //
 858                 sprintf(dev->name, "ra%d", i);
 859                 Status = NDIS_STATUS_SUCCESS;
 860         }
 861
 862         return Status;
 863
 864 }
 865
 866
 867 #ifdef MULTIPLE_CARD_SUPPORT
 868 /*
 869 ========================================================================
 870 Routine Description:
 871     Get card profile path.
 872
 873 Arguments:
 874     pAd
 875
 876 Return Value:
 877     TRUE                - Find a card profile
 878         FALSE           - use default profile
 879
 880 Note:
 881 ========================================================================
 882 */
 883 extern INT RTMPGetKeyParameter(
 884     IN  PCHAR   key,
 885     OUT PCHAR   dest,
 886     IN  INT     destsize,
 887     IN  PCHAR   buffer);
 888
 889 BOOLEAN RTMP_CardInfoRead(
 890         IN      PRTMP_ADAPTER pAd)
 891 {
 892 #define MC_SELECT_CARDID                0       /* use CARD ID (0 ~ 31) to identify different cards */
 893 #define MC_SELECT_MAC                   1       /* use CARD MAC to identify different cards */
 894 #define MC_SELECT_CARDTYPE              2       /* use CARD type (abgn or bgn) to identify different cards */
 895
 896 #define LETTER_CASE_TRANSLATE(txt_p, card_id)                   \
 897         {       UINT32 _len; char _char;                                                \
 898                 for(_len=0; _len<strlen(card_id); _len++) {             \
 899                         _char = *(txt_p + _len);                                        \
 900                         if (('A' <= _char) && (_char <= 'Z'))           \
 901                                 *(txt_p+_len) = 'a'+(_char-'A');                \
 902                 } }
 903
 904         struct file *srcf;
 905         INT retval, orgfsuid, orgfsgid;
 906         mm_segment_t orgfs;
 907         CHAR *buffer, *tmpbuf, card_id_buf[30], RFIC_word[30];
 908         BOOLEAN flg_match_ok = FALSE;
 909         INT32 card_select_method;
 910         INT32 card_free_id, card_nouse_id, card_same_mac_id, card_match_id;
 911         EEPROM_ANTENNA_STRUC antenna;
 912         USHORT addr01, addr23, addr45;
 913         UINT8 mac[6];
 914         UINT32 data, card_index;
 915         UCHAR *start_ptr;
 916
 917
 918         // init
 919         buffer = kmalloc(MAX_INI_BUFFER_SIZE, MEM_ALLOC_FLAG);
 920         if (buffer == NULL)
 921         return FALSE;
 922
 923         tmpbuf = kmalloc(MAX_PARAM_BUFFER_SIZE, MEM_ALLOC_FLAG);
 924         if(tmpbuf == NULL)
 925         {
 926                 kfree(buffer);
 927         return NDIS_STATUS_FAILURE;
 928         }
 929
 930         orgfsuid = current->fsuid;
 931         orgfsgid = current->fsgid;
 932         current->fsuid = current->fsgid = 0;
 933     orgfs = get_fs();
 934     set_fs(KERNEL_DS);
 935
 936         // get RF IC type
 937         RTMP_IO_READ32(pAd, E2PROM_CSR, &data);
 938
 939         if ((data & 0x30) == 0)
 940                 pAd->EEPROMAddressNum = 6;      // 93C46
 941         else if ((data & 0x30) == 0x10)
 942                 pAd->EEPROMAddressNum = 8;      // 93C66
 943         else
 944                 pAd->EEPROMAddressNum = 8;      // 93C86
 945
 946         RT28xx_EEPROM_READ16(pAd, EEPROM_NIC1_OFFSET, antenna.word);
 947
 948         if ((antenna.field.RfIcType == RFIC_2850) ||
 949                 (antenna.field.RfIcType == RFIC_2750))
 950         {
 951                 /* ABGN card */
 952                 strcpy(RFIC_word, "abgn");
 953         }
 954         else
 955         {
 956                 /* BGN card */
 957                 strcpy(RFIC_word, "bgn");
 958         }
 959
 960         // get MAC address
 961         RT28xx_EEPROM_READ16(pAd, 0x04, addr01);
 962         RT28xx_EEPROM_READ16(pAd, 0x06, addr23);
 963         RT28xx_EEPROM_READ16(pAd, 0x08, addr45);
 964
 965         mac[0] = (UCHAR)(addr01 & 0xff);
 966         mac[1] = (UCHAR)(addr01 >> 8);
 967         mac[2] = (UCHAR)(addr23 & 0xff);
 968         mac[3] = (UCHAR)(addr23 >> 8);
 969         mac[4] = (UCHAR)(addr45 & 0xff);
 970         mac[5] = (UCHAR)(addr45 >> 8);
 971
 972         // open card information file
 973         srcf = filp_open(CARD_INFO_PATH, O_RDONLY, 0);
 974         if (IS_ERR(srcf))
 975         {
 976                 /* card information file does not exist */
 977                         DBGPRINT(RT_DEBUG_TRACE,
 978                                 ("--> Error %ld opening %s\n", -PTR_ERR(srcf), CARD_INFO_PATH));
 979                 return FALSE;
 980         }
 981
 982         if (srcf->f_op && srcf->f_op->read)
 983         {
 984                 /* card information file exists so reading the card information */
 985                 memset(buffer, 0x00, MAX_INI_BUFFER_SIZE);
 986                 retval = srcf->f_op->read(srcf, buffer, MAX_INI_BUFFER_SIZE, &srcf->f_pos);
 987                 if (retval < 0)
 988                 {
 989                         /* read fail */
 990                                 DBGPRINT(RT_DEBUG_TRACE,
 991                                         ("--> Read %s error %d\n", CARD_INFO_PATH, -retval));
 992                 }
 993                 else
 994                 {
 995                         /* get card selection method */
 996                         memset(tmpbuf, 0x00, MAX_PARAM_BUFFER_SIZE);
 997                         card_select_method = MC_SELECT_CARDTYPE; // default
 998
 999                         if (RTMPGetKeyParameter("SELECT", tmpbuf, 256, buffer))
1000                         {
1001                                 if (strcmp(tmpbuf, "CARDID") == 0)
1002                                         card_select_method = MC_SELECT_CARDID;
1003                                 else if (strcmp(tmpbuf, "MAC") == 0)
1004                                         card_select_method = MC_SELECT_MAC;
1005                                 else if (strcmp(tmpbuf, "CARDTYPE") == 0)
1006                                         card_select_method = MC_SELECT_CARDTYPE;
1007                         }
1008
1009                         DBGPRINT(RT_DEBUG_TRACE,
1010                                         ("MC> Card Selection = %d\n", card_select_method));
1011
1012                         // init
1013                         card_free_id = -1;
1014                         card_nouse_id = -1;
1015                         card_same_mac_id = -1;
1016                         card_match_id = -1;
1017
1018                         // search current card information records
1019                         for(card_index=0;
1020                                 card_index<MAX_NUM_OF_MULTIPLE_CARD;
1021                                 card_index++)
1022                         {
1023                                 if ((*(UINT32 *)&MC_CardMac[card_index][0] == 0) &&
1024                                         (*(UINT16 *)&MC_CardMac[card_index][4] == 0))
1025                                 {
1026                                         // MAC is all-0 so the entry is available
1027                                         MC_CardUsed[card_index] = 0;
1028
1029                                         if (card_free_id < 0)
1030                                                 card_free_id = card_index; // 1st free entry
1031                                 }
1032                                 else
1033                                 {
1034                                         if (memcmp(MC_CardMac[card_index], mac, 6) == 0)
1035                                         {
1036                                                 // we find the entry with same MAC
1037                                                 if (card_same_mac_id < 0)
1038                                                         card_same_mac_id = card_index; // 1st same entry
1039                                         }
1040                                         else
1041                                         {
1042                                                 // MAC is not all-0 but used flag == 0
1043                                                 if ((MC_CardUsed[card_index] == 0) &&
1044                                                         (card_nouse_id < 0))
1045                                                 {
1046                                                         card_nouse_id = card_index; // 1st available entry
1047                                                 }
1048                                         }
1049                                 }
1050                         }
1051
1052                         DBGPRINT(RT_DEBUG_TRACE,
1053                                         ("MC> Free = %d, Same = %d, NOUSE = %d\n",
1054                                         card_free_id, card_same_mac_id, card_nouse_id));
1055
1056                         if ((card_same_mac_id >= 0) &&
1057                                 ((card_select_method == MC_SELECT_CARDID) ||
1058                                 (card_select_method == MC_SELECT_CARDTYPE)))
1059                         {
1060                                 // same MAC entry is found
1061                                 card_match_id = card_same_mac_id;
1062
1063                                 if (card_select_method == MC_SELECT_CARDTYPE)
1064                                 {
1065                                         // for CARDTYPE
1066                                         sprintf(card_id_buf, "%02dCARDTYPE%s",
1067                                                         card_match_id, RFIC_word);
1068
1069                                         if ((start_ptr=rtstrstruncasecmp(buffer, card_id_buf)) != NULL)
1070                                         {
1071                                                 // we found the card ID
1072                                                 LETTER_CASE_TRANSLATE(start_ptr, card_id_buf);
1073                                         }
1074                                 }
1075                         }
1076                         else
1077                         {
1078                                 // the card is 1st plug-in, try to find the match card profile
1079                                 switch(card_select_method)
1080                                 {
1081                                         case MC_SELECT_CARDID: // CARDID
1082                                         default:
1083                                                 if (card_free_id >= 0)
1084                                                         card_match_id = card_free_id;
1085                                                 else
1086                                                         card_match_id = card_nouse_id;
1087                                                 break;
1088
1089                                         case MC_SELECT_MAC: // MAC
1090                                                 sprintf(card_id_buf, "MAC%02x:%02x:%02x:%02x:%02x:%02x",
1091                                                                 mac[0], mac[1], mac[2],
1092                                                                 mac[3], mac[4], mac[5]);
1093
1094                                                 /* try to find the key word in the card file */
1095                                                 if ((start_ptr=rtstrstruncasecmp(buffer, card_id_buf)) != NULL)
1096                                                 {
1097                                                         LETTER_CASE_TRANSLATE(start_ptr, card_id_buf);
1098
1099                                                         /* get the row ID (2 ASCII characters) */
1100                                                         start_ptr -= 2;
1101                                                         card_id_buf[0] = *(start_ptr);
1102                                                         card_id_buf[1] = *(start_ptr+1);
1103                                                         card_id_buf[2] = 0x00;
1104
1105                                                         card_match_id = simple_strtol(card_id_buf, 0, 10);
1106                                                 }
1107                                                 break;
1108
1109                                         case MC_SELECT_CARDTYPE: // CARDTYPE
1110                                                 card_nouse_id = -1;
1111
1112                                                 for(card_index=0;
1113                                                         card_index<MAX_NUM_OF_MULTIPLE_CARD;
1114                                                         card_index++)
1115                                                 {
1116                                                         sprintf(card_id_buf, "%02dCARDTYPE%s",
1117                                                                         card_index, RFIC_word);
1118
1119                                                         if ((start_ptr=rtstrstruncasecmp(buffer,
1120                                                                                                                 card_id_buf)) != NULL)
1121                                                         {
1122                                                                 LETTER_CASE_TRANSLATE(start_ptr, card_id_buf);
1123
1124                                                                 if (MC_CardUsed[card_index] == 0)
1125                                                                 {
1126                                                                         /* current the card profile is not used */
1127                                                                         if ((*(UINT32 *)&MC_CardMac[card_index][0] == 0) &&
1128                                                                                 (*(UINT16 *)&MC_CardMac[card_index][4] == 0))
1129                                                                         {
1130                                                                                 // find it and no previous card use it
1131                                                                                 card_match_id = card_index;
1132                                                                                 break;
1133                                                                         }
1134                                                                         else
1135                                                                         {
1136                                                                                 // ever a card use it
1137                                                                                 if (card_nouse_id < 0)
1138                                                                                         card_nouse_id = card_index;
1139                                                                         }
1140                                                                 }
1141                                                         }
1142                                                 }
1143
1144                                                 // if not find a free one, use the available one
1145                                                 if (card_match_id < 0)
1146                                                         card_match_id = card_nouse_id;
1147                                                 break;
1148                                 }
1149                         }
1150
1151                         if (card_match_id >= 0)
1152                         {
1153                                 // make up search keyword
1154                                 switch(card_select_method)
1155                                 {
1156                                         case MC_SELECT_CARDID: // CARDID
1157                                                 sprintf(card_id_buf, "%02dCARDID", card_match_id);
1158                                                 break;
1159
1160                                         case MC_SELECT_MAC: // MAC
1161                                                 sprintf(card_id_buf,
1162                                                                 "%02dmac%02x:%02x:%02x:%02x:%02x:%02x",
1163                                                                 card_match_id,
1164                                                                 mac[0], mac[1], mac[2],
1165                                                                 mac[3], mac[4], mac[5]);
1166                                                 break;
1167
1168                                         case MC_SELECT_CARDTYPE: // CARDTYPE
1169                                         default:
1170                                                 sprintf(card_id_buf, "%02dcardtype%s",
1171                                                                 card_match_id, RFIC_word);
1172                                                 break;
1173                                 }
1174
1175                                 DBGPRINT(RT_DEBUG_TRACE, ("Search Keyword = %s\n", card_id_buf));
1176
1177                                 // read card file path
1178                                 if (RTMPGetKeyParameter(card_id_buf, tmpbuf, 256, buffer))
1179                                 {
1180                                         if (strlen(tmpbuf) < sizeof(pAd->MC_FileName))
1181                                         {
1182                                                 // backup card information
1183                                                 pAd->MC_RowID = card_match_id; /* base 0 */
1184                                                 MC_CardUsed[card_match_id] = 1;
1185                                                 memcpy(MC_CardMac[card_match_id], mac, sizeof(mac));
1186
1187                                                 // backup card file path
1188                                                 NdisMoveMemory(pAd->MC_FileName, tmpbuf , strlen(tmpbuf));
1189                                                 pAd->MC_FileName[strlen(tmpbuf)] = '\0';
1190                                                 flg_match_ok = TRUE;
1191
1192                                                 DBGPRINT(RT_DEBUG_TRACE,
1193                                                                 ("Card Profile Name = %s\n", pAd->MC_FileName));
1194                                         }
1195                                         else
1196                                         {
1197                                                 DBGPRINT(RT_DEBUG_ERROR,
1198                                                                 ("Card Profile Name length too large!\n"));
1199                                         }
1200                                 }
1201                                 else
1202                                 {
1203                                         DBGPRINT(RT_DEBUG_ERROR,
1204                                                         ("Can not find search key word in card.dat!\n"));
1205                                 }
1206
1207                                 if ((flg_match_ok != TRUE) &&
1208                                         (card_match_id < MAX_NUM_OF_MULTIPLE_CARD))
1209                                 {
1210                                         MC_CardUsed[card_match_id] = 0;
1211                                         memset(MC_CardMac[card_match_id], 0, sizeof(mac));
1212                                 }
1213                         } // if (card_match_id >= 0)
1214                 }
1215         }
1216
1217         // close file
1218         retval = filp_close(srcf, NULL);
1219         set_fs(orgfs);
1220         current->fsuid = orgfsuid;
1221         current->fsgid = orgfsgid;
1222         kfree(buffer);
1223         kfree(tmpbuf);
1224         return flg_match_ok;
1225 }
1226 #endif // MULTIPLE_CARD_SUPPORT //
1227
1228
1229 /*
1230 ========================================================================
1231 Routine Description:
1232     Probe RT28XX chipset.
1233
1234 Arguments:
1235     _dev_p                              Point to the PCI or USB device
1236         _dev_id_p                       Point to the PCI or USB device ID
1237
1238 Return Value:
1239     0                                   Probe OK
1240         -ENODEV                         Probe Fail
1241
1242 Note:
1243 ========================================================================
1244 */
1245 INT __devinit   rt28xx_probe(
1246     IN  void *_dev_p,
1247     IN  void *_dev_id_p,
1248         IN  UINT argc,
1249         OUT PRTMP_ADAPTER *ppAd)
1250 {
1251     struct  net_device  *net_dev;
1252     PRTMP_ADAPTER       pAd = (PRTMP_ADAPTER) NULL;
1253     INT                 status;
1254         PVOID                           handle;
1255 #ifdef RT2860
1256         struct pci_dev *dev_p = (struct pci_dev *)_dev_p;
1257 #endif // RT2860 //
1258
1259
1260 #ifdef CONFIG_STA_SUPPORT
1261     DBGPRINT(RT_DEBUG_TRACE, ("STA Driver version-%s\n", STA_DRIVER_VERSION));
1262 #endif // CONFIG_STA_SUPPORT //
1263
1264 #if LINUX_VERSION_CODE <= 0x20402       // Red Hat 7.1
1265     net_dev = alloc_netdev(sizeof(PRTMP_ADAPTER), "eth%d", ether_setup);
1266 #else
1267     net_dev = alloc_etherdev(sizeof(PRTMP_ADAPTER));
1268 #endif
1269     if (net_dev == NULL)
1270     {
1271         printk("alloc_netdev failed\n");
1272
1273 #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,5,0)
1274 #if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,15)
1275                 module_put(THIS_MODULE);
1276 #endif //LINUX_VERSION_CODE < KERNEL_VERSION(2,6,15)
1277 #else
1278                 MOD_DEC_USE_COUNT;
1279 #endif
1280         goto err_out;
1281     }
1282
1283 #if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,24)
1284     SET_MODULE_OWNER(net_dev);
1285 #endif
1286
1287         netif_stop_queue(net_dev);
1288 #ifdef NATIVE_WPA_SUPPLICANT_SUPPORT
1289 /* for supporting Network Manager */
1290 /* Set the sysfs physical device reference for the network logical device
1291  * if set prior to registration will cause a symlink during initialization.
1292  */
1293 #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,0))
1294     SET_NETDEV_DEV(net_dev, &(dev_p->dev));
1295 #endif
1296 #endif // NATIVE_WPA_SUPPLICANT_SUPPORT //
1297
1298         // Allocate RTMP_ADAPTER miniport adapter structure
1299         handle = kmalloc(sizeof(struct os_cookie), GFP_KERNEL);
1300         RT28XX_HANDLE_DEV_ASSIGN(handle, dev_p);
1301
1302         status = RTMPAllocAdapterBlock(handle, &pAd);
1303         if (status != NDIS_STATUS_SUCCESS)
1304                 goto err_out_free_netdev;
1305
1306         net_dev->ml_priv = (PVOID)pAd;
1307     pAd->net_dev = net_dev; // must be before RT28XXNetDevInit()
1308
1309         RT28XXNetDevInit(_dev_p, net_dev, pAd);
1310
1311 #ifdef CONFIG_STA_SUPPORT
1312     pAd->StaCfg.OriDevType = net_dev->type;
1313 #endif // CONFIG_STA_SUPPORT //
1314
1315         // Post config
1316 #if LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0)
1317         if (RT28XXProbePostConfig(_dev_p, pAd, argc) == FALSE)
1318                 goto err_out_unmap;
1319 #else
1320         if (RT28XXProbePostConfig(_dev_p, pAd, 0) == FALSE)
1321                 goto err_out_unmap;
1322 #endif // LINUX_VERSION_CODE //
1323
1324 #ifdef CONFIG_STA_SUPPORT
1325         pAd->OpMode = OPMODE_STA;
1326 #endif // CONFIG_STA_SUPPORT //
1327
1328
1329 #ifdef MULTIPLE_CARD_SUPPORT
1330         // find its profile path
1331         pAd->MC_RowID = -1; // use default profile path
1332         RTMP_CardInfoRead(pAd);
1333
1334         if (pAd->MC_RowID == -1)
1335 #ifdef CONFIG_STA_SUPPORT
1336                 strcpy(pAd->MC_FileName, STA_PROFILE_PATH);
1337 #endif // CONFIG_STA_SUPPORT //
1338
1339         DBGPRINT(RT_DEBUG_TRACE,
1340                         ("MC> ROW = %d, PATH = %s\n", pAd->MC_RowID, pAd->MC_FileName));
1341 #endif // MULTIPLE_CARD_SUPPORT //
1342
1343         // sample move
1344         if (rt_ieee80211_if_setup(net_dev, pAd) != NDIS_STATUS_SUCCESS)
1345                 goto err_out_unmap;
1346
1347     // Register this device
1348     status = register_netdev(net_dev);
1349     if (status)
1350         goto err_out_unmap;
1351
1352     // Set driver data
1353         RT28XX_DRVDATA_SET(_dev_p);
1354
1355         *ppAd = pAd;
1356     return 0; // probe ok
1357
1358
1359         /* --------------------------- ERROR HANDLE --------------------------- */
1360 err_out_unmap:
1361         RTMPFreeAdapter(pAd);
1362         RT28XX_UNMAP();
1363
1364 err_out_free_netdev:
1365 #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,5,0)
1366     free_netdev(net_dev);
1367 #else
1368         kfree(net_dev);
1369 #endif
1370
1371 err_out:
1372         RT28XX_PUT_DEVICE(dev_p);
1373
1374 #if LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0)
1375         return (LONG)NULL;
1376 #else
1377     return -ENODEV; /* probe fail */
1378 #endif // LINUX_VERSION_CODE //
1379 } /* End of rt28xx_probe */
1380
1381
1382 /*
1383 ========================================================================
1384 Routine Description:
1385     The entry point for Linux kernel sent packet to our driver.
1386
1387 Arguments:
1388     sk_buff *skb                the pointer refer to a sk_buffer.
1389
1390 Return Value:
1391     0
1392
1393 Note:
1394         This function is the entry point of Tx Path for Os delivery packet to
1395         our driver. You only can put OS-depened & STA/AP common handle procedures
1396         in here.
1397 ========================================================================
1398 */
1399 int rt28xx_packet_xmit(struct sk_buff *skb)
1400 {
1401         struct net_device *net_dev = skb->dev;
1402         PRTMP_ADAPTER pAd = net_dev->ml_priv;
1403         int status = 0;
1404         PNDIS_PACKET pPacket = (PNDIS_PACKET) skb;
1405
1406         /* RT2870STA does this in RTMPSendPackets() */
1407 #ifdef RALINK_ATE
1408         if (ATE_ON(pAd))
1409         {
1410                 RELEASE_NDIS_PACKET(pAd, pPacket, NDIS_STATUS_RESOURCES);
1411                 return 0;
1412         }
1413 #endif // RALINK_ATE //
1414
1415 #ifdef CONFIG_STA_SUPPORT
1416         IF_DEV_CONFIG_OPMODE_ON_STA(pAd)
1417         {
1418                 // Drop send request since we are in monitor mode
1419                 if (MONITOR_ON(pAd))
1420                 {
1421                         RELEASE_NDIS_PACKET(pAd, pPacket, NDIS_STATUS_FAILURE);
1422                         goto done;
1423                 }
1424         }
1425 #endif // CONFIG_STA_SUPPORT //
1426
1427         // EapolStart size is 18
1428         if (skb->len < 14)
1429         {
1430                 //printk("bad packet size: %d\n", pkt->len);
1431                 hex_dump("bad packet", skb->data, skb->len);
1432                 RELEASE_NDIS_PACKET(pAd, pPacket, NDIS_STATUS_FAILURE);
1433                 goto done;
1434         }
1435
1436         RTMP_SET_PACKET_5VT(pPacket, 0);
1437 #ifdef CONFIG_5VT_ENHANCE
1438     if (*(int*)(skb->cb) == BRIDGE_TAG) {
1439                 RTMP_SET_PACKET_5VT(pPacket, 1);
1440     }
1441 #endif
1442
1443
1444
1445 #ifdef CONFIG_STA_SUPPORT
1446         IF_DEV_CONFIG_OPMODE_ON_STA(pAd)
1447         {
1448
1449                 STASendPackets((NDIS_HANDLE)pAd, (PPNDIS_PACKET) &pPacket, 1);
1450         }
1451
1452 #endif // CONFIG_STA_SUPPORT //
1453
1454         status = 0;
1455 done:
1456
1457         return status;
1458 }
1459
1460
1461 /*
1462 ========================================================================
1463 Routine Description:
1464     Send a packet to WLAN.
1465
1466 Arguments:
1467     skb_p           points to our adapter
1468     dev_p           which WLAN network interface
1469
1470 Return Value:
1471     0: transmit successfully
1472     otherwise: transmit fail
1473
1474 Note:
1475 ========================================================================
1476 */
1477 INT rt28xx_send_packets(
1478         IN struct sk_buff               *skb_p,
1479         IN struct net_device    *net_dev)
1480 {
1481     RTMP_ADAPTER *pAd = net_dev->ml_priv;
1482         if (!(net_dev->flags & IFF_UP))
1483         {
1484                 RELEASE_NDIS_PACKET(pAd, (PNDIS_PACKET)skb_p, NDIS_STATUS_FAILURE);
1485                 return 0;
1486         }
1487
1488         NdisZeroMemory((PUCHAR)&skb_p->cb[CB_OFF], 15);
1489         RTMP_SET_PACKET_NET_DEVICE_MBSSID(skb_p, MAIN_MBSSID);
1490
1491         return rt28xx_packet_xmit(skb_p);
1492
1493 } /* End of MBSS_VirtualIF_PacketSend */
1494
1495
1496
1497
1498 #if LINUX_VERSION_CODE <= 0x20402       // Red Hat 7.1
1499 struct net_device *alloc_netdev(
1500         int sizeof_priv,
1501         const char *mask,
1502         void (*setup)(struct net_device *))
1503 {
1504     struct net_device   *dev;
1505     INT                                 alloc_size;
1506
1507
1508     /* ensure 32-byte alignment of the private area */
1509     alloc_size = sizeof (*dev) + sizeof_priv + 31;
1510
1511     dev = (struct net_device *) kmalloc(alloc_size, GFP_KERNEL);
1512     if (dev == NULL)
1513     {
1514         DBGPRINT(RT_DEBUG_ERROR,
1515                                 ("alloc_netdev: Unable to allocate device memory.\n"));
1516         return NULL;
1517     }
1518
1519     memset(dev, 0, alloc_size);
1520
1521     if (sizeof_priv)
1522         dev->priv = (void *) (((long)(dev + 1) + 31) & ~31);
1523
1524     setup(dev);
1525     strcpy(dev->name, mask);
1526
1527     return dev;
1528 }
1529 #endif // LINUX_VERSION_CODE //
1530
1531
1532 void CfgInitHook(PRTMP_ADAPTER pAd)
1533 {
1534         pAd->bBroadComHT = TRUE;
1535 } /* End of CfgInitHook */
1536
1537
1538 #if WIRELESS_EXT >= 12
1539 // This function will be called when query /proc
1540 struct iw_statistics *rt28xx_get_wireless_stats(
1541     IN struct net_device *net_dev)
1542 {
1543         PRTMP_ADAPTER pAd = net_dev->ml_priv;
1544
1545
1546         DBGPRINT(RT_DEBUG_TRACE, ("rt28xx_get_wireless_stats --->\n"));
1547
1548         pAd->iw_stats.status = 0; // Status - device dependent for now
1549
1550         // link quality
1551         pAd->iw_stats.qual.qual = ((pAd->Mlme.ChannelQuality * 12)/10 + 10);
1552         if(pAd->iw_stats.qual.qual > 100)
1553                 pAd->iw_stats.qual.qual = 100;
1554
1555 #ifdef CONFIG_STA_SUPPORT
1556         if (pAd->OpMode == OPMODE_STA)
1557                 pAd->iw_stats.qual.level = RTMPMaxRssi(pAd, pAd->StaCfg.RssiSample.LastRssi0, pAd->StaCfg.RssiSample.LastRssi1, pAd->StaCfg.RssiSample.LastRssi2);
1558 #endif // CONFIG_STA_SUPPORT //
1559
1560         pAd->iw_stats.qual.noise = pAd->BbpWriteLatch[66]; // noise level (dBm)
1561
1562         pAd->iw_stats.qual.noise += 256 - 143;
1563         pAd->iw_stats.qual.updated = 1;     // Flags to know if updated
1564 #ifdef IW_QUAL_DBM
1565         pAd->iw_stats.qual.updated |= IW_QUAL_DBM;      // Level + Noise are dBm
1566 #endif // IW_QUAL_DBM //
1567
1568         pAd->iw_stats.discard.nwid = 0;     // Rx : Wrong nwid/essid
1569         pAd->iw_stats.miss.beacon = 0;      // Missed beacons/superframe
1570
1571         DBGPRINT(RT_DEBUG_TRACE, ("<--- rt28xx_get_wireless_stats\n"));
1572         return &pAd->iw_stats;
1573 } /* End of rt28xx_get_wireless_stats */
1574 #endif // WIRELESS_EXT //
1575
1576
1577
1578 void tbtt_tasklet(unsigned long data)
1579 {
1580 #define MAX_TX_IN_TBTT          (16)
1581
1582 }
1583
1584 INT rt28xx_ioctl(
1585         IN      struct net_device       *net_dev,
1586         IN      OUT     struct ifreq    *rq,
1587         IN      INT                                     cmd)
1588 {
1589         VIRTUAL_ADAPTER *pVirtualAd = NULL;
1590         RTMP_ADAPTER    *pAd = NULL;
1591         INT                             ret = 0;
1592
1593         if (net_dev->priv_flags == INT_MAIN)
1594         {
1595                 pAd = net_dev->ml_priv;
1596         }
1597         else
1598         {
1599                 pVirtualAd = net_dev->ml_priv;
1600                 pAd = pVirtualAd->RtmpDev->ml_priv;
1601         }
1602
1603         if (pAd == NULL)
1604         {
1605                 /* if 1st open fail, pAd will be free;
1606                    So the net_dev->ml_priv will be NULL in 2rd open */
1607                 return -ENETDOWN;
1608         }
1609
1610
1611 #ifdef CONFIG_STA_SUPPORT
1612         IF_DEV_CONFIG_OPMODE_ON_STA(pAd)
1613         {
1614                 ret = rt28xx_sta_ioctl(net_dev, rq, cmd);
1615         }
1616 #endif // CONFIG_STA_SUPPORT //
1617
1618         return ret;
1619 }
1620
1621 /*
1622     ========================================================================
1623
1624     Routine Description:
1625         return ethernet statistics counter
1626
1627     Arguments:
1628         net_dev                     Pointer to net_device
1629
1630     Return Value:
1631         net_device_stats*
1632
1633     Note:
1634
1635     ========================================================================
1636 */
1637 struct net_device_stats *RT28xx_get_ether_stats(
1638     IN  struct net_device *net_dev)
1639 {
1640     RTMP_ADAPTER *pAd = NULL;
1641
1642         if (net_dev)
1643                 pAd = net_dev->ml_priv;
1644
1645         if (pAd)
1646         {
1647
1648                 pAd->stats.rx_packets = pAd->WlanCounters.ReceivedFragmentCount.QuadPart;
1649                 pAd->stats.tx_packets = pAd->WlanCounters.TransmittedFragmentCount.QuadPart;
1650
1651                 pAd->stats.rx_bytes = pAd->RalinkCounters.ReceivedByteCount;
1652                 pAd->stats.tx_bytes = pAd->RalinkCounters.TransmittedByteCount;
1653
1654                 pAd->stats.rx_errors = pAd->Counters8023.RxErrors;
1655                 pAd->stats.tx_errors = pAd->Counters8023.TxErrors;
1656
1657                 pAd->stats.rx_dropped = 0;
1658                 pAd->stats.tx_dropped = 0;
1659
1660             pAd->stats.multicast = pAd->WlanCounters.MulticastReceivedFrameCount.QuadPart;   // multicast packets received
1661             pAd->stats.collisions = pAd->Counters8023.OneCollision + pAd->Counters8023.MoreCollisions;  // Collision packets
1662
1663             pAd->stats.rx_length_errors = 0;
1664             pAd->stats.rx_over_errors = pAd->Counters8023.RxNoBuffer;                   // receiver ring buff overflow
1665             pAd->stats.rx_crc_errors = 0;//pAd->WlanCounters.FCSErrorCount;     // recved pkt with crc error
1666             pAd->stats.rx_frame_errors = pAd->Counters8023.RcvAlignmentErrors;          // recv'd frame alignment error
1667             pAd->stats.rx_fifo_errors = pAd->Counters8023.RxNoBuffer;                   // recv'r fifo overrun
1668             pAd->stats.rx_missed_errors = 0;                                            // receiver missed packet
1669
1670             // detailed tx_errors
1671             pAd->stats.tx_aborted_errors = 0;
1672             pAd->stats.tx_carrier_errors = 0;
1673             pAd->stats.tx_fifo_errors = 0;
1674             pAd->stats.tx_heartbeat_errors = 0;
1675             pAd->stats.tx_window_errors = 0;
1676
1677             // for cslip etc
1678             pAd->stats.rx_compressed = 0;
1679             pAd->stats.tx_compressed = 0;
1680
1681                 return &pAd->stats;
1682         }
1683         else
1684         return NULL;
1685 }
1686