drivers/staging/winbond/wblinux.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
}