dc7e04fe28
The driver code uses do { } while (0) together with the break statement to emulate gotos for error handling. Fix that up by using the goto statement instead. Acked-by: Pavel Machek <pavel@suse.cz> Signed-off-by: Pekka Enberg <penberg@cs.helsinki.fi> Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
276 lines
6.4 KiB
C
276 lines
6.4 KiB
C
//============================================================================
|
|
// Copyright (c) 1996-2005 Winbond Electronic Corporation
|
|
//
|
|
// Module Name:
|
|
// wblinux.c
|
|
//
|
|
// Abstract:
|
|
// Linux releated routines
|
|
//
|
|
//============================================================================
|
|
#include "os_common.h"
|
|
|
|
u32
|
|
WBLINUX_MemoryAlloc(void* *VirtualAddress, u32 Length)
|
|
{
|
|
*VirtualAddress = kzalloc( Length, GFP_ATOMIC ); //GFP_KERNEL is not suitable
|
|
|
|
if (*VirtualAddress == NULL)
|
|
return 0;
|
|
return 1;
|
|
}
|
|
|
|
s32
|
|
EncapAtomicInc(PADAPTER Adapter, void* pAtomic)
|
|
{
|
|
PWBLINUX pWbLinux = &Adapter->WbLinux;
|
|
u32 ltmp;
|
|
u32 * pltmp = (u32 *)pAtomic;
|
|
spin_lock_irq( &pWbLinux->AtomicSpinLock );
|
|
(*pltmp)++;
|
|
ltmp = (*pltmp);
|
|
spin_unlock_irq( &pWbLinux->AtomicSpinLock );
|
|
return ltmp;
|
|
}
|
|
|
|
s32
|
|
EncapAtomicDec(PADAPTER Adapter, void* pAtomic)
|
|
{
|
|
PWBLINUX pWbLinux = &Adapter->WbLinux;
|
|
u32 ltmp;
|
|
u32 * pltmp = (u32 *)pAtomic;
|
|
spin_lock_irq( &pWbLinux->AtomicSpinLock );
|
|
(*pltmp)--;
|
|
ltmp = (*pltmp);
|
|
spin_unlock_irq( &pWbLinux->AtomicSpinLock );
|
|
return ltmp;
|
|
}
|
|
|
|
unsigned char
|
|
WBLINUX_Initial(PADAPTER Adapter)
|
|
{
|
|
PWBLINUX pWbLinux = &Adapter->WbLinux;
|
|
|
|
spin_lock_init( &pWbLinux->SpinLock );
|
|
spin_lock_init( &pWbLinux->AtomicSpinLock );
|
|
return TRUE;
|
|
}
|
|
|
|
void
|
|
WBLinux_ReceivePacket(PADAPTER Adapter, PRXLAYER1 pRxLayer1)
|
|
{
|
|
BUG();
|
|
}
|
|
|
|
|
|
void
|
|
WBLINUX_GetNextPacket(PADAPTER Adapter, PDESCRIPTOR pDes)
|
|
{
|
|
BUG();
|
|
}
|
|
|
|
void
|
|
WBLINUX_GetNextPacketCompleted(PADAPTER Adapter, PDESCRIPTOR pDes)
|
|
{
|
|
BUG();
|
|
}
|
|
|
|
void
|
|
WBLINUX_Destroy(PADAPTER Adapter)
|
|
{
|
|
WBLINUX_stop( Adapter );
|
|
#ifdef _PE_USB_INI_DUMP_
|
|
WBDEBUG(("[w35und] unregister_netdev!\n"));
|
|
#endif
|
|
}
|
|
|
|
void
|
|
WBLINUX_stop( PADAPTER Adapter )
|
|
{
|
|
PWBLINUX pWbLinux = &Adapter->WbLinux;
|
|
struct sk_buff *pSkb;
|
|
|
|
if (OS_ATOMIC_INC( Adapter, &pWbLinux->ThreadCount ) == 1) {
|
|
// Shutdown module immediately
|
|
pWbLinux->shutdown = 1;
|
|
|
|
while (pWbLinux->skb_array[ pWbLinux->skb_GetIndex ]) {
|
|
// Trying to free the un-sending packet
|
|
pSkb = pWbLinux->skb_array[ pWbLinux->skb_GetIndex ];
|
|
pWbLinux->skb_array[ pWbLinux->skb_GetIndex ] = NULL;
|
|
if( in_irq() )
|
|
dev_kfree_skb_irq( pSkb );
|
|
else
|
|
dev_kfree_skb( pSkb );
|
|
|
|
pWbLinux->skb_GetIndex++;
|
|
pWbLinux->skb_GetIndex %= WBLINUX_PACKET_ARRAY_SIZE;
|
|
}
|
|
|
|
#ifdef _PE_STATE_DUMP_
|
|
WBDEBUG(( "[w35und] SKB_RELEASE OK\n" ));
|
|
#endif
|
|
}
|
|
|
|
OS_ATOMIC_DEC( Adapter, &pWbLinux->ThreadCount );
|
|
}
|
|
|
|
void
|
|
WbWlanHalt( PADAPTER Adapter )
|
|
{
|
|
//---------------------
|
|
Adapter->sLocalPara.ShutDowned = TRUE;
|
|
|
|
Mds_Destroy( Adapter );
|
|
|
|
// Turn off Rx and Tx hardware ability
|
|
hal_stop( &Adapter->sHwData );
|
|
#ifdef _PE_USB_INI_DUMP_
|
|
WBDEBUG(("[w35und] Hal_stop O.K.\n"));
|
|
#endif
|
|
OS_SLEEP(100000);// Waiting Irp completed
|
|
|
|
// Destroy the NDIS module
|
|
WBLINUX_Destroy( Adapter );
|
|
|
|
// Halt the HAL
|
|
hal_halt(&Adapter->sHwData, NULL);
|
|
}
|
|
|
|
unsigned char
|
|
WbWLanInitialize(PADAPTER Adapter)
|
|
{
|
|
phw_data_t pHwData;
|
|
u8 *pMacAddr;
|
|
u8 *pMacAddr2;
|
|
u32 InitStep = 0;
|
|
u8 EEPROM_region;
|
|
u8 HwRadioOff;
|
|
|
|
//
|
|
// Setting default value for Linux
|
|
//
|
|
Adapter->sLocalPara.region_INF = REGION_AUTO;
|
|
Adapter->sLocalPara.TxRateMode = RATE_AUTO;
|
|
psLOCAL->bMacOperationMode = MODE_802_11_BG; // B/G mode
|
|
Adapter->Mds.TxRTSThreshold = DEFAULT_RTSThreshold;
|
|
Adapter->Mds.TxFragmentThreshold = DEFAULT_FRAGMENT_THRESHOLD;
|
|
hal_set_phy_type( &Adapter->sHwData, RF_WB_242_1 );
|
|
Adapter->sLocalPara.MTUsize = MAX_ETHERNET_PACKET_SIZE;
|
|
psLOCAL->bPreambleMode = AUTO_MODE;
|
|
Adapter->sLocalPara.RadioOffStatus.boSwRadioOff = FALSE;
|
|
pHwData = &Adapter->sHwData;
|
|
hal_set_phy_type( pHwData, RF_DECIDE_BY_INF );
|
|
|
|
//
|
|
// Initial each module and variable
|
|
//
|
|
if (!WBLINUX_Initial(Adapter)) {
|
|
#ifdef _PE_USB_INI_DUMP_
|
|
WBDEBUG(("[w35und]WBNDIS initialization failed\n"));
|
|
#endif
|
|
goto error;
|
|
}
|
|
|
|
// Initial Software variable
|
|
Adapter->sLocalPara.ShutDowned = FALSE;
|
|
|
|
//added by ws for wep key error detection
|
|
Adapter->sLocalPara.bWepKeyError= FALSE;
|
|
Adapter->sLocalPara.bToSelfPacketReceived = FALSE;
|
|
Adapter->sLocalPara.WepKeyDetectTimerCount= 2 * 100; /// 2 seconds
|
|
|
|
// Initial USB hal
|
|
InitStep = 1;
|
|
pHwData = &Adapter->sHwData;
|
|
if (!hal_init_hardware(pHwData, Adapter))
|
|
goto error;
|
|
|
|
EEPROM_region = hal_get_region_from_EEPROM( pHwData );
|
|
if (EEPROM_region != REGION_AUTO)
|
|
psLOCAL->region = EEPROM_region;
|
|
else {
|
|
if (psLOCAL->region_INF != REGION_AUTO)
|
|
psLOCAL->region = psLOCAL->region_INF;
|
|
else
|
|
psLOCAL->region = REGION_USA; //default setting
|
|
}
|
|
|
|
// Get Software setting flag from hal
|
|
Adapter->sLocalPara.boAntennaDiversity = FALSE;
|
|
if (hal_software_set(pHwData) & 0x00000001)
|
|
Adapter->sLocalPara.boAntennaDiversity = TRUE;
|
|
|
|
//
|
|
// For TS module
|
|
//
|
|
InitStep = 2;
|
|
|
|
// For MDS module
|
|
InitStep = 3;
|
|
Mds_initial(Adapter);
|
|
|
|
//=======================================
|
|
// Initialize the SME, SCAN, MLME, ROAM
|
|
//=======================================
|
|
InitStep = 4;
|
|
InitStep = 5;
|
|
InitStep = 6;
|
|
|
|
// If no user-defined address in the registry, use the addresss "burned" on the NIC instead.
|
|
pMacAddr = Adapter->sLocalPara.ThisMacAddress;
|
|
pMacAddr2 = Adapter->sLocalPara.PermanentAddress;
|
|
hal_get_permanent_address( pHwData, Adapter->sLocalPara.PermanentAddress );// Reading ethernet address from EEPROM
|
|
if (OS_MEMORY_COMPARE(pMacAddr, "\x00\x00\x00\x00\x00\x00", MAC_ADDR_LENGTH )) // Is equal
|
|
{
|
|
memcpy( pMacAddr, pMacAddr2, MAC_ADDR_LENGTH );
|
|
} else {
|
|
// Set the user define MAC address
|
|
hal_set_ethernet_address( pHwData, Adapter->sLocalPara.ThisMacAddress );
|
|
}
|
|
|
|
//get current antenna
|
|
psLOCAL->bAntennaNo = hal_get_antenna_number(pHwData);
|
|
#ifdef _PE_STATE_DUMP_
|
|
WBDEBUG(("Driver init, antenna no = %d\n", psLOCAL->bAntennaNo));
|
|
#endif
|
|
hal_get_hw_radio_off( pHwData );
|
|
|
|
// Waiting for HAL setting OK
|
|
while (!hal_idle(pHwData))
|
|
OS_SLEEP(10000);
|
|
|
|
MTO_Init(Adapter);
|
|
|
|
HwRadioOff = hal_get_hw_radio_off( pHwData );
|
|
psLOCAL->RadioOffStatus.boHwRadioOff = !!HwRadioOff;
|
|
|
|
hal_set_radio_mode( pHwData, (unsigned char)(psLOCAL->RadioOffStatus.boSwRadioOff || psLOCAL->RadioOffStatus.boHwRadioOff) );
|
|
|
|
hal_driver_init_OK(pHwData) = 1; // Notify hal that the driver is ready now.
|
|
//set a tx power for reference.....
|
|
// sme_set_tx_power_level(Adapter, 12); FIXME?
|
|
return TRUE;
|
|
|
|
error:
|
|
switch (InitStep) {
|
|
case 5:
|
|
case 4:
|
|
case 3: Mds_Destroy( Adapter );
|
|
case 2:
|
|
case 1: WBLINUX_Destroy( Adapter );
|
|
hal_halt( pHwData, NULL );
|
|
case 0: break;
|
|
}
|
|
|
|
return FALSE;
|
|
}
|
|
|
|
void WBLINUX_ConnectStatus(PADAPTER Adapter, u32 flag)
|
|
{
|
|
PWBLINUX pWbLinux = &Adapter->WbLinux;
|
|
|
|
pWbLinux->LinkStatus = flag; // OS_DISCONNECTED or OS_CONNECTED
|
|
}
|
|
|