]> www.pilppa.org Git - linux-2.6-omap-h63xx.git/blobdiff - drivers/staging/winbond/wbusb.c
Staging: w35und: clean up wblinux.c a bit
[linux-2.6-omap-h63xx.git] / drivers / staging / winbond / wbusb.c
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));