drivers/staging/winbond/wblinux.c

   1 //============================================================================
   2 //  Copyright (c) 1996-2005 Winbond Electronic Corporation
   3 //
   4 //  Module Name:
   5 //    wblinux.c
   6 //
   7 //  Abstract:
   8 //    Linux releated routines
   9 //
  10 //============================================================================
  11 #include "os_common.h"
  12
  13 u32
  14 WBLINUX_MemoryAlloc(void* *VirtualAddress, u32 Length)
  15 {
  16         *VirtualAddress = kzalloc( Length, GFP_ATOMIC ); //GFP_KERNEL is not suitable
  17
  18         if (*VirtualAddress == NULL)
  19                 return 0;
  20         return 1;
  21 }
  22
  23 s32
  24 EncapAtomicInc(PADAPTER Adapter, void* pAtomic)
  25 {
  26         PWBLINUX pWbLinux = &Adapter->WbLinux;
  27         u32     ltmp;
  28         u32 *   pltmp = (u32 *)pAtomic;
  29         spin_lock_irq( &pWbLinux->AtomicSpinLock );
  30         (*pltmp)++;
  31         ltmp = (*pltmp);
  32         spin_unlock_irq( &pWbLinux->AtomicSpinLock );
  33         return ltmp;
  34 }
  35
  36 s32
  37 EncapAtomicDec(PADAPTER Adapter, void* pAtomic)
  38 {
  39         PWBLINUX pWbLinux = &Adapter->WbLinux;
  40         u32     ltmp;
  41         u32 *   pltmp = (u32 *)pAtomic;
  42         spin_lock_irq( &pWbLinux->AtomicSpinLock );
  43         (*pltmp)--;
  44         ltmp = (*pltmp);
  45         spin_unlock_irq( &pWbLinux->AtomicSpinLock );
  46         return ltmp;
  47 }
  48
  49 unsigned char
  50 WBLINUX_Initial(PADAPTER Adapter)
  51 {
  52         PWBLINUX pWbLinux = &Adapter->WbLinux;
  53
  54         spin_lock_init( &pWbLinux->SpinLock );
  55         spin_lock_init( &pWbLinux->AtomicSpinLock );
  56         return TRUE;
  57 }
  58
  59 void
  60 WBLinux_ReceivePacket(PADAPTER Adapter, PRXLAYER1 pRxLayer1)
  61 {
  62         BUG();
  63 }
  64
  65
  66 void
  67 WBLINUX_GetNextPacket(PADAPTER Adapter,  PDESCRIPTOR pDes)
  68 {
  69         BUG();
  70 }
  71
  72 void
  73 WBLINUX_GetNextPacketCompleted(PADAPTER Adapter, PDESCRIPTOR pDes)
  74 {
  75         BUG();
  76 }
  77
  78 void
  79 WBLINUX_Destroy(PADAPTER Adapter)
  80 {
  81         WBLINUX_stop( Adapter );
  82 #ifdef _PE_USB_INI_DUMP_
  83         WBDEBUG(("[w35und] unregister_netdev!\n"));
  84 #endif
  85 }
  86
  87 void
  88 WBLINUX_stop(  PADAPTER Adapter )
  89 {
  90         PWBLINUX        pWbLinux = &Adapter->WbLinux;
  91         struct sk_buff *pSkb;
  92
  93         if (OS_ATOMIC_INC( Adapter, &pWbLinux->ThreadCount ) == 1) {
  94                 // Shutdown module immediately
  95                 pWbLinux->shutdown = 1;
  96
  97                 while (pWbLinux->skb_array[ pWbLinux->skb_GetIndex ]) {
  98                         // Trying to free the un-sending packet
  99                         pSkb = pWbLinux->skb_array[ pWbLinux->skb_GetIndex ];
 100                         pWbLinux->skb_array[ pWbLinux->skb_GetIndex ] = NULL;
 101                         if( in_irq() )
 102                                 dev_kfree_skb_irq( pSkb );
 103                         else
 104                                 dev_kfree_skb( pSkb );
 105
 106                         pWbLinux->skb_GetIndex++;
 107                         pWbLinux->skb_GetIndex %= WBLINUX_PACKET_ARRAY_SIZE;
 108                 }
 109
 110 #ifdef _PE_STATE_DUMP_
 111                 WBDEBUG(( "[w35und] SKB_RELEASE OK\n" ));
 112 #endif
 113         }
 114
 115         OS_ATOMIC_DEC( Adapter, &pWbLinux->ThreadCount );
 116 }
 117
 118 void
 119 WbWlanHalt(  PADAPTER Adapter )
 120 {
 121         //---------------------
 122         Adapter->sLocalPara.ShutDowned = TRUE;
 123
 124         Mds_Destroy( Adapter );
 125
 126         // Turn off Rx and Tx hardware ability
 127         hal_stop( &Adapter->sHwData );
 128 #ifdef _PE_USB_INI_DUMP_
 129         WBDEBUG(("[w35und] Hal_stop O.K.\n"));
 130 #endif
 131         OS_SLEEP(100000);// Waiting Irp completed
 132
 133         // Destroy the NDIS module
 134         WBLINUX_Destroy( Adapter );
 135
 136         // Halt the HAL
 137         hal_halt(&Adapter->sHwData, NULL);
 138 }
 139
 140 unsigned char
 141 WbWLanInitialize(PADAPTER Adapter)
 142 {
 143         phw_data_t      pHwData;
 144         u8              *pMacAddr;
 145         u8              *pMacAddr2;
 146         u32             InitStep = 0;
 147         u8              EEPROM_region;
 148         u8              HwRadioOff;
 149
 150         do {
 151                 //
 152                 // Setting default value for Linux
 153                 //
 154                 Adapter->sLocalPara.region_INF = REGION_AUTO;
 155                 Adapter->sLocalPara.TxRateMode = RATE_AUTO;
 156                 psLOCAL->bMacOperationMode = MODE_802_11_BG;    // B/G mode
 157                 Adapter->Mds.TxRTSThreshold = DEFAULT_RTSThreshold;
 158                 Adapter->Mds.TxFragmentThreshold = DEFAULT_FRAGMENT_THRESHOLD;
 159                 hal_set_phy_type( &Adapter->sHwData, RF_WB_242_1 );
 160                 Adapter->sLocalPara.MTUsize = MAX_ETHERNET_PACKET_SIZE;
 161                 psLOCAL->bPreambleMode = AUTO_MODE;
 162                 Adapter->sLocalPara.RadioOffStatus.boSwRadioOff = FALSE;
 163                 pHwData = &Adapter->sHwData;
 164                 hal_set_phy_type( pHwData, RF_DECIDE_BY_INF );
 165
 166                 //
 167                 // Initial each module and variable
 168                 //
 169                 if (!WBLINUX_Initial(Adapter)) {
 170 #ifdef _PE_USB_INI_DUMP_
 171                         WBDEBUG(("[w35und]WBNDIS initialization failed\n"));
 172 #endif
 173                         break;
 174                 }
 175
 176                 // Initial Software variable
 177                 Adapter->sLocalPara.ShutDowned = FALSE;
 178
 179                 //added by ws for wep key error detection
 180                 Adapter->sLocalPara.bWepKeyError= FALSE;
 181                 Adapter->sLocalPara.bToSelfPacketReceived = FALSE;
 182                 Adapter->sLocalPara.WepKeyDetectTimerCount= 2 * 100; /// 2 seconds
 183
 184                 // Initial USB hal
 185                 InitStep = 1;
 186                 pHwData = &Adapter->sHwData;
 187                 if (!hal_init_hardware(pHwData, Adapter))
 188                         break;
 189
 190                 EEPROM_region = hal_get_region_from_EEPROM( pHwData );
 191                 if (EEPROM_region != REGION_AUTO)
 192                         psLOCAL->region = EEPROM_region;
 193                 else {
 194                         if (psLOCAL->region_INF != REGION_AUTO)
 195                                 psLOCAL->region = psLOCAL->region_INF;
 196                         else
 197                                 psLOCAL->region = REGION_USA;   //default setting
 198                 }
 199
 200                 // Get Software setting flag from hal
 201                 Adapter->sLocalPara.boAntennaDiversity = FALSE;
 202                 if (hal_software_set(pHwData) & 0x00000001)
 203                         Adapter->sLocalPara.boAntennaDiversity = TRUE;
 204
 205                 //
 206                 // For TS module
 207                 //
 208                 InitStep = 2;
 209
 210                 // For MDS module
 211                 InitStep = 3;
 212                 Mds_initial(Adapter);
 213
 214                 //=======================================
 215                 // Initialize the SME, SCAN, MLME, ROAM
 216                 //=======================================
 217                 InitStep = 4;
 218                 InitStep = 5;
 219                 InitStep = 6;
 220
 221                 // If no user-defined address in the registry, use the addresss "burned" on the NIC instead.
 222                 pMacAddr = Adapter->sLocalPara.ThisMacAddress;
 223                 pMacAddr2 = Adapter->sLocalPara.PermanentAddress;
 224                 hal_get_permanent_address( pHwData, Adapter->sLocalPara.PermanentAddress );// Reading ethernet address from EEPROM
 225                 if (OS_MEMORY_COMPARE(pMacAddr, "\x00\x00\x00\x00\x00\x00", MAC_ADDR_LENGTH )) // Is equal
 226                 {
 227                         memcpy( pMacAddr, pMacAddr2, MAC_ADDR_LENGTH );
 228                 } else {
 229                         // Set the user define MAC address
 230                         hal_set_ethernet_address( pHwData, Adapter->sLocalPara.ThisMacAddress );
 231                 }
 232
 233                 //get current antenna
 234                 psLOCAL->bAntennaNo = hal_get_antenna_number(pHwData);
 235 #ifdef _PE_STATE_DUMP_
 236                 WBDEBUG(("Driver init, antenna no = %d\n", psLOCAL->bAntennaNo));
 237 #endif
 238                 hal_get_hw_radio_off( pHwData );
 239
 240                 // Waiting for HAL setting OK
 241                 while (!hal_idle(pHwData))
 242                         OS_SLEEP(10000);
 243
 244                 MTO_Init(Adapter);
 245
 246                 HwRadioOff = hal_get_hw_radio_off( pHwData );
 247                 psLOCAL->RadioOffStatus.boHwRadioOff = !!HwRadioOff;
 248
 249                 hal_set_radio_mode( pHwData, (unsigned char)(psLOCAL->RadioOffStatus.boSwRadioOff || psLOCAL->RadioOffStatus.boHwRadioOff) );
 250
 251                 hal_driver_init_OK(pHwData) = 1; // Notify hal that the driver is ready now.
 252                 //set a tx power for reference.....
 253 //              sme_set_tx_power_level(Adapter, 12);    FIXME?
 254                 return TRUE;
 255         }
 256         while(FALSE);
 257
 258         switch (InitStep) {
 259         case 5:
 260         case 4:
 261         case 3: Mds_Destroy( Adapter );
 262         case 2:
 263         case 1: WBLINUX_Destroy( Adapter );
 264                 hal_halt( pHwData, NULL );
 265         case 0: break;
 266         }
 267
 268         return FALSE;
 269 }
 270
 271 void WBLINUX_ConnectStatus(PADAPTER Adapter, u32 flag)
 272 {
 273         PWBLINUX        pWbLinux = &Adapter->WbLinux;
 274
 275         pWbLinux->LinkStatus = flag; // OS_DISCONNECTED or  OS_CONNECTED
 276 }
 277