Staging: w35und: clean up wblinux.c a bit
authorPekka Enberg <penberg@cs.helsinki.fi>
Thu, 30 Oct 2008 16:12:02 +0000 (18:12 +0200)
committerGreg Kroah-Hartman <gregkh@suse.de>
Tue, 6 Jan 2009 21:51:49 +0000 (13:51 -0800)
This patch removes wrapper functions from wblinux.c and moves the hardware init
and halt functions to wbusb.c which has the only callers of them.

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>
drivers/staging/winbond/wblinux.c
drivers/staging/winbond/wblinux_f.h
drivers/staging/winbond/wbusb.c

index 03458bcd827b130e6efb07a620770ef4115832c2..9b436ac7e634bfea5a445a4c162e7fcbcc6cee6d 100644 (file)
 #include "wbhal_f.h"
 #include "wblinux_f.h"
 
-unsigned char
-WBLINUX_Initial(struct wbsoft_priv * adapter)
-{
-       spin_lock_init( &adapter->SpinLock );
-       return true;
-}
-
-void
-WBLINUX_Destroy(struct wbsoft_priv * adapter)
-{
-       WBLINUX_stop( adapter );
-#ifdef _PE_USB_INI_DUMP_
-       WBDEBUG(("[w35und] unregister_netdev!\n"));
-#endif
-}
-
 void
 WBLINUX_stop(  struct wbsoft_priv * adapter )
 {
@@ -61,154 +45,3 @@ WBLINUX_stop(  struct wbsoft_priv * adapter )
 
        atomic_dec(&adapter->ThreadCount);
 }
-
-void
-WbWlanHalt(  struct wbsoft_priv * 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
-       msleep(100);// Waiting Irp completed
-
-       // Destroy the NDIS module
-       WBLINUX_Destroy(adapter);
-
-       // Halt the HAL
-       hal_halt(&adapter->sHwData, NULL);
-}
-
-unsigned char
-WbWLanInitialize(struct ieee80211_hw *hw)
-{
-       struct wbsoft_priv *priv = hw->priv;
-       phw_data_t      pHwData;
-       u8              *pMacAddr;
-       u8              *pMacAddr2;
-       u32             InitStep = 0;
-       u8              EEPROM_region;
-       u8              HwRadioOff;
-
-       //
-       // Setting default value for Linux
-       //
-       priv->sLocalPara.region_INF = REGION_AUTO;
-       priv->sLocalPara.TxRateMode = RATE_AUTO;
-       priv->sLocalPara.bMacOperationMode = MODE_802_11_BG;    // B/G mode
-       priv->Mds.TxRTSThreshold = DEFAULT_RTSThreshold;
-       priv->Mds.TxFragmentThreshold = DEFAULT_FRAGMENT_THRESHOLD;
-       hal_set_phy_type( &priv->sHwData, RF_WB_242_1 );
-       priv->sLocalPara.MTUsize = MAX_ETHERNET_PACKET_SIZE;
-       priv->sLocalPara.bPreambleMode = AUTO_MODE;
-       priv->sLocalPara.RadioOffStatus.boSwRadioOff = false;
-       pHwData = &priv->sHwData;
-       hal_set_phy_type( pHwData, RF_DECIDE_BY_INF );
-
-       //
-       // Initial each module and variable
-       //
-       if (!WBLINUX_Initial(priv)) {
-#ifdef _PE_USB_INI_DUMP_
-               WBDEBUG(("[w35und]WBNDIS initialization failed\n"));
-#endif
-               goto error;
-       }
-
-       // Initial Software variable
-       priv->sLocalPara.ShutDowned = false;
-
-       //added by ws for wep key error detection
-       priv->sLocalPara.bWepKeyError= false;
-       priv->sLocalPara.bToSelfPacketReceived = false;
-       priv->sLocalPara.WepKeyDetectTimerCount= 2 * 100; /// 2 seconds
-
-       // Initial USB hal
-       InitStep = 1;
-       pHwData = &priv->sHwData;
-       if (!hal_init_hardware(hw))
-               goto error;
-
-       EEPROM_region = hal_get_region_from_EEPROM( pHwData );
-       if (EEPROM_region != REGION_AUTO)
-               priv->sLocalPara.region = EEPROM_region;
-       else {
-               if (priv->sLocalPara.region_INF != REGION_AUTO)
-                       priv->sLocalPara.region = priv->sLocalPara.region_INF;
-               else
-                       priv->sLocalPara.region = REGION_USA;   //default setting
-       }
-
-       // Get Software setting flag from hal
-       priv->sLocalPara.boAntennaDiversity = false;
-       if (hal_software_set(pHwData) & 0x00000001)
-               priv->sLocalPara.boAntennaDiversity = true;
-
-       //
-       // For TS module
-       //
-       InitStep = 2;
-
-       // For MDS module
-       InitStep = 3;
-       Mds_initial(priv);
-
-       //=======================================
-       // 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 = priv->sLocalPara.ThisMacAddress;
-       pMacAddr2 = priv->sLocalPara.PermanentAddress;
-       hal_get_permanent_address( pHwData, priv->sLocalPara.PermanentAddress );// Reading ethernet address from EEPROM
-       if (memcmp(pMacAddr, "\x00\x00\x00\x00\x00\x00", MAC_ADDR_LENGTH) == 0)
-               memcpy(pMacAddr, pMacAddr2, MAC_ADDR_LENGTH);
-       else {
-               // Set the user define MAC address
-               hal_set_ethernet_address(pHwData, priv->sLocalPara.ThisMacAddress);
-       }
-
-       //get current antenna
-       priv->sLocalPara.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))
-               msleep(10);
-
-       MTO_Init(priv);
-
-       HwRadioOff = hal_get_hw_radio_off( pHwData );
-       priv->sLocalPara.RadioOffStatus.boHwRadioOff = !!HwRadioOff;
-
-       hal_set_radio_mode( pHwData, (unsigned char)(priv->sLocalPara.RadioOffStatus.boSwRadioOff || priv->sLocalPara.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(priv, 12);       FIXME?
-       return true;
-
-error:
-       switch (InitStep) {
-       case 5:
-       case 4:
-       case 3: Mds_Destroy( priv );
-       case 2:
-       case 1: WBLINUX_Destroy( priv );
-               hal_halt( pHwData, NULL );
-       case 0: break;
-       }
-
-       return false;
-}
index 15e6a6562fcc181a671794a90893240261211e4f..f531a012948085634444fbea87a02669404e7d82 100644 (file)
@@ -9,15 +9,10 @@
 //
 // wblinux_f.h
 //
-unsigned char WBLINUX_Initial(  struct wbsoft_priv *adapter );
 int wb35_start_xmit(struct sk_buff *skb, struct net_device *netdev );
 void WBLINUX_stop(  struct wbsoft_priv *adapter );
-void WBLINUX_Destroy(  struct wbsoft_priv *adapter );
 void wb35_set_multicast( struct net_device *netdev );
 struct net_device_stats * wb35_netdev_stats( struct net_device *netdev );
 void WBLINUX_stop(  struct wbsoft_priv *adapter );
-void WbWlanHalt(  struct wbsoft_priv *adapter );
-unsigned char WbWLanInitialize(struct ieee80211_hw *hw);
-
 
 #endif
index 67847c8ad28c4c4e4cf679cff8dec3c20af6be2f..673875d30ca3badf2402100d745078247ce51313 100644 (file)
@@ -7,7 +7,9 @@
 #include <linux/usb.h>
 
 #include "core.h"
+#include "mds_f.h"
 #include "mlmetxrx_f.h"
+#include "mto_f.h"
 #include "wbhal_f.h"
 #include "wblinux_f.h"
 
@@ -180,7 +182,7 @@ static u64 wbsoft_get_tsf(struct ieee80211_hw *dev)
 
 static const struct ieee80211_ops wbsoft_ops = {
        .tx                     = wbsoft_tx,
-       .start                  = wbsoft_start,         /* Start can be pretty much empty as we do WbWLanInitialize() during probe? */
+       .start                  = wbsoft_start,         /* Start can be pretty much empty as we do wb35_hw_init() during probe? */
        .stop                   = wbsoft_stop,
        .add_interface          = wbsoft_add_interface,
        .remove_interface       = wbsoft_remove_interface,
@@ -193,6 +195,124 @@ static const struct ieee80211_ops wbsoft_ops = {
 // conf_tx: hal_set_cwmin()/hal_set_cwmax;
 };
 
+static unsigned char wb35_hw_init(struct ieee80211_hw *hw)
+{
+       struct wbsoft_priv *priv = hw->priv;
+       phw_data_t      pHwData;
+       u8              *pMacAddr;
+       u8              *pMacAddr2;
+       u32             InitStep = 0;
+       u8              EEPROM_region;
+       u8              HwRadioOff;
+
+       //
+       // Setting default value for Linux
+       //
+       priv->sLocalPara.region_INF = REGION_AUTO;
+       priv->sLocalPara.TxRateMode = RATE_AUTO;
+       priv->sLocalPara.bMacOperationMode = MODE_802_11_BG;    // B/G mode
+       priv->Mds.TxRTSThreshold = DEFAULT_RTSThreshold;
+       priv->Mds.TxFragmentThreshold = DEFAULT_FRAGMENT_THRESHOLD;
+       hal_set_phy_type( &priv->sHwData, RF_WB_242_1 );
+       priv->sLocalPara.MTUsize = MAX_ETHERNET_PACKET_SIZE;
+       priv->sLocalPara.bPreambleMode = AUTO_MODE;
+       priv->sLocalPara.RadioOffStatus.boSwRadioOff = false;
+       pHwData = &priv->sHwData;
+       hal_set_phy_type( pHwData, RF_DECIDE_BY_INF );
+
+       // Initial Software variable
+       priv->sLocalPara.ShutDowned = false;
+
+       //added by ws for wep key error detection
+       priv->sLocalPara.bWepKeyError= false;
+       priv->sLocalPara.bToSelfPacketReceived = false;
+       priv->sLocalPara.WepKeyDetectTimerCount= 2 * 100; /// 2 seconds
+
+       // Initial USB hal
+       InitStep = 1;
+       pHwData = &priv->sHwData;
+       if (!hal_init_hardware(hw))
+               goto error;
+
+       EEPROM_region = hal_get_region_from_EEPROM( pHwData );
+       if (EEPROM_region != REGION_AUTO)
+               priv->sLocalPara.region = EEPROM_region;
+       else {
+               if (priv->sLocalPara.region_INF != REGION_AUTO)
+                       priv->sLocalPara.region = priv->sLocalPara.region_INF;
+               else
+                       priv->sLocalPara.region = REGION_USA;   //default setting
+       }
+
+       // Get Software setting flag from hal
+       priv->sLocalPara.boAntennaDiversity = false;
+       if (hal_software_set(pHwData) & 0x00000001)
+               priv->sLocalPara.boAntennaDiversity = true;
+
+       //
+       // For TS module
+       //
+       InitStep = 2;
+
+       // For MDS module
+       InitStep = 3;
+       Mds_initial(priv);
+
+       //=======================================
+       // 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 = priv->sLocalPara.ThisMacAddress;
+       pMacAddr2 = priv->sLocalPara.PermanentAddress;
+       hal_get_permanent_address( pHwData, priv->sLocalPara.PermanentAddress );// Reading ethernet address from EEPROM
+       if (memcmp(pMacAddr, "\x00\x00\x00\x00\x00\x00", MAC_ADDR_LENGTH) == 0)
+               memcpy(pMacAddr, pMacAddr2, MAC_ADDR_LENGTH);
+       else {
+               // Set the user define MAC address
+               hal_set_ethernet_address(pHwData, priv->sLocalPara.ThisMacAddress);
+       }
+
+       //get current antenna
+       priv->sLocalPara.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))
+               msleep(10);
+
+       MTO_Init(priv);
+
+       HwRadioOff = hal_get_hw_radio_off( pHwData );
+       priv->sLocalPara.RadioOffStatus.boHwRadioOff = !!HwRadioOff;
+
+       hal_set_radio_mode( pHwData, (unsigned char)(priv->sLocalPara.RadioOffStatus.boSwRadioOff || priv->sLocalPara.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(priv, 12);       FIXME?
+       return true;
+
+error:
+       switch (InitStep) {
+       case 5:
+       case 4:
+       case 3: Mds_Destroy( priv );
+       case 2:
+       case 1: WBLINUX_stop(priv);
+               hal_halt( pHwData, NULL );
+       case 0: break;
+       }
+
+       return false;
+}
+
 static int wb35_probe(struct usb_interface *intf, const struct usb_device_id *id_table)
 {
        PWBUSB          pWbUsb;
@@ -225,6 +345,8 @@ static int wb35_probe(struct usb_interface *intf, const struct usb_device_id *id
 
        priv = dev->priv;
 
+       spin_lock_init(&priv->SpinLock);
+
        pWbUsb = &priv->sHwData.WbUsb;
        pWbUsb->udev = udev;
 
@@ -236,7 +358,7 @@ static int wb35_probe(struct usb_interface *intf, const struct usb_device_id *id
                pWbUsb->IsUsb20 = 1;
        }
 
-       if (!WbWLanInitialize(dev)) {
+       if (!wb35_hw_init(dev)) {
                err = -EINVAL;
                goto error_free_hw;
        }
@@ -300,11 +422,33 @@ void packet_came(struct ieee80211_hw *hw, char *pRxBufferAddress, int PacketSize
        ieee80211_rx_irqsafe(hw, skb, &rx_status);
 }
 
+static void wb35_hw_halt(struct wbsoft_priv *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
+       msleep(100);// Waiting Irp completed
+
+       // Destroy the NDIS module
+       WBLINUX_stop(adapter);
+
+       // Halt the HAL
+       hal_halt(&adapter->sHwData, NULL);
+}
+
+
 static void wb35_disconnect(struct usb_interface *intf)
 {
        struct wbsoft_priv *priv = usb_get_intfdata(intf);
 
-       WbWlanHalt(priv);
+       wb35_hw_halt(priv);
 
        usb_set_intfdata(intf, NULL);
        usb_put_dev(interface_to_usbdev(intf));