6d7fd647c2
This patch adds a prepare_multicast callback for the winbond driver to properly receive mc_count in ->configure_filter. This also fixes incompatible pointer assignment build errors because ->configure_filter had changed. This is build tested only, but that's more than the original code received. Signed-off-by: Jeff Mahoney <jeffm@suse.com> Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
922 lines
23 KiB
C
922 lines
23 KiB
C
/*
|
|
* Copyright 2008 Pavel Machek <pavel@suse.cz>
|
|
*
|
|
* Distribute under GPLv2.
|
|
*
|
|
* The original driver was written by:
|
|
* Jeff Lee <YY_Lee@issc.com.tw>
|
|
*
|
|
* and was adapted to the 2.6 kernel by:
|
|
* Costantino Leandro (Rxart Desktop) <le_costantino@pixartargentina.com.ar>
|
|
*/
|
|
#include <net/mac80211.h>
|
|
#include <linux/usb.h>
|
|
|
|
#include "core.h"
|
|
#include "mds_f.h"
|
|
#include "mlmetxrx_f.h"
|
|
#include "mto.h"
|
|
#include "wbhal_f.h"
|
|
#include "wblinux_f.h"
|
|
|
|
MODULE_DESCRIPTION("IS89C35 802.11bg WLAN USB Driver");
|
|
MODULE_LICENSE("GPL");
|
|
MODULE_VERSION("0.1");
|
|
|
|
static struct usb_device_id wb35_table[] __devinitdata = {
|
|
{ USB_DEVICE(0x0416, 0x0035) },
|
|
{ USB_DEVICE(0x18E8, 0x6201) },
|
|
{ USB_DEVICE(0x18E8, 0x6206) },
|
|
{ USB_DEVICE(0x18E8, 0x6217) },
|
|
{ USB_DEVICE(0x18E8, 0x6230) },
|
|
{ USB_DEVICE(0x18E8, 0x6233) },
|
|
{ USB_DEVICE(0x1131, 0x2035) },
|
|
{ 0, }
|
|
};
|
|
|
|
MODULE_DEVICE_TABLE(usb, wb35_table);
|
|
|
|
static struct ieee80211_rate wbsoft_rates[] = {
|
|
{ .bitrate = 10, .flags = IEEE80211_RATE_SHORT_PREAMBLE },
|
|
};
|
|
|
|
static struct ieee80211_channel wbsoft_channels[] = {
|
|
{ .center_freq = 2412 },
|
|
};
|
|
|
|
static struct ieee80211_supported_band wbsoft_band_2GHz = {
|
|
.channels = wbsoft_channels,
|
|
.n_channels = ARRAY_SIZE(wbsoft_channels),
|
|
.bitrates = wbsoft_rates,
|
|
.n_bitrates = ARRAY_SIZE(wbsoft_rates),
|
|
};
|
|
|
|
static void hal_set_beacon_period(struct hw_data *pHwData, u16 beacon_period)
|
|
{
|
|
u32 tmp;
|
|
|
|
if (pHwData->SurpriseRemove)
|
|
return;
|
|
|
|
pHwData->BeaconPeriod = beacon_period;
|
|
tmp = pHwData->BeaconPeriod << 16;
|
|
tmp |= pHwData->ProbeDelay;
|
|
Wb35Reg_Write(pHwData, 0x0848, tmp);
|
|
}
|
|
|
|
static int wbsoft_add_interface(struct ieee80211_hw *dev,
|
|
struct ieee80211_if_init_conf *conf)
|
|
{
|
|
struct wbsoft_priv *priv = dev->priv;
|
|
|
|
hal_set_beacon_period(&priv->sHwData, conf->vif->bss_conf.beacon_int);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void wbsoft_remove_interface(struct ieee80211_hw *dev,
|
|
struct ieee80211_if_init_conf *conf)
|
|
{
|
|
printk("wbsoft_remove interface called\n");
|
|
}
|
|
|
|
static void wbsoft_stop(struct ieee80211_hw *hw)
|
|
{
|
|
printk(KERN_INFO "%s called\n", __func__);
|
|
}
|
|
|
|
static int wbsoft_get_stats(struct ieee80211_hw *hw,
|
|
struct ieee80211_low_level_stats *stats)
|
|
{
|
|
printk(KERN_INFO "%s called\n", __func__);
|
|
return 0;
|
|
}
|
|
|
|
static int wbsoft_get_tx_stats(struct ieee80211_hw *hw,
|
|
struct ieee80211_tx_queue_stats *stats)
|
|
{
|
|
printk(KERN_INFO "%s called\n", __func__);
|
|
return 0;
|
|
}
|
|
|
|
static u64 wbsoft_prepare_multicast(struct ieee80211_hw *hw, int mc_count,
|
|
struct dev_addr_list *mc_list)
|
|
{
|
|
return mc_count;
|
|
}
|
|
|
|
static void wbsoft_configure_filter(struct ieee80211_hw *dev,
|
|
unsigned int changed_flags,
|
|
unsigned int *total_flags,
|
|
u64 multicast)
|
|
{
|
|
unsigned int new_flags;
|
|
|
|
new_flags = 0;
|
|
|
|
if (*total_flags & FIF_PROMISC_IN_BSS)
|
|
new_flags |= FIF_PROMISC_IN_BSS;
|
|
else if ((*total_flags & FIF_ALLMULTI) || (multicast > 32))
|
|
new_flags |= FIF_ALLMULTI;
|
|
|
|
dev->flags &= ~IEEE80211_HW_RX_INCLUDES_FCS;
|
|
|
|
*total_flags = new_flags;
|
|
}
|
|
|
|
static int wbsoft_tx(struct ieee80211_hw *dev, struct sk_buff *skb)
|
|
{
|
|
struct wbsoft_priv *priv = dev->priv;
|
|
|
|
MLMESendFrame(priv, skb->data, skb->len, FRAME_TYPE_802_11_MANAGEMENT);
|
|
|
|
return NETDEV_TX_OK;
|
|
}
|
|
|
|
static int wbsoft_start(struct ieee80211_hw *dev)
|
|
{
|
|
struct wbsoft_priv *priv = dev->priv;
|
|
|
|
priv->enabled = true;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void hal_set_radio_mode(struct hw_data *pHwData, unsigned char radio_off)
|
|
{
|
|
struct wb35_reg *reg = &pHwData->reg;
|
|
|
|
if (pHwData->SurpriseRemove)
|
|
return;
|
|
|
|
if (radio_off) //disable Baseband receive off
|
|
{
|
|
pHwData->CurrentRadioSw = 1; // off
|
|
reg->M24_MacControl &= 0xffffffbf;
|
|
} else {
|
|
pHwData->CurrentRadioSw = 0; // on
|
|
reg->M24_MacControl |= 0x00000040;
|
|
}
|
|
Wb35Reg_Write(pHwData, 0x0824, reg->M24_MacControl);
|
|
}
|
|
|
|
static void
|
|
hal_set_current_channel_ex(struct hw_data *pHwData, ChanInfo channel)
|
|
{
|
|
struct wb35_reg *reg = &pHwData->reg;
|
|
|
|
if (pHwData->SurpriseRemove)
|
|
return;
|
|
|
|
printk("Going to channel: %d/%d\n", channel.band, channel.ChanNo);
|
|
|
|
RFSynthesizer_SwitchingChannel(pHwData, channel); // Switch channel
|
|
pHwData->Channel = channel.ChanNo;
|
|
pHwData->band = channel.band;
|
|
#ifdef _PE_STATE_DUMP_
|
|
printk("Set channel is %d, band =%d\n", pHwData->Channel,
|
|
pHwData->band);
|
|
#endif
|
|
reg->M28_MacControl &= ~0xff; // Clean channel information field
|
|
reg->M28_MacControl |= channel.ChanNo;
|
|
Wb35Reg_WriteWithCallbackValue(pHwData, 0x0828, reg->M28_MacControl,
|
|
(s8 *) & channel, sizeof(ChanInfo));
|
|
}
|
|
|
|
static void hal_set_current_channel(struct hw_data *pHwData, ChanInfo channel)
|
|
{
|
|
hal_set_current_channel_ex(pHwData, channel);
|
|
}
|
|
|
|
static void hal_set_accept_broadcast(struct hw_data *pHwData, u8 enable)
|
|
{
|
|
struct wb35_reg *reg = &pHwData->reg;
|
|
|
|
if (pHwData->SurpriseRemove)
|
|
return;
|
|
|
|
reg->M00_MacControl &= ~0x02000000; //The HW value
|
|
|
|
if (enable)
|
|
reg->M00_MacControl |= 0x02000000; //The HW value
|
|
|
|
Wb35Reg_Write(pHwData, 0x0800, reg->M00_MacControl);
|
|
}
|
|
|
|
//for wep key error detection, we need to accept broadcast packets to be received temporary.
|
|
static void hal_set_accept_promiscuous(struct hw_data *pHwData, u8 enable)
|
|
{
|
|
struct wb35_reg *reg = &pHwData->reg;
|
|
|
|
if (pHwData->SurpriseRemove)
|
|
return;
|
|
if (enable) {
|
|
reg->M00_MacControl |= 0x00400000;
|
|
Wb35Reg_Write(pHwData, 0x0800, reg->M00_MacControl);
|
|
} else {
|
|
reg->M00_MacControl &= ~0x00400000;
|
|
Wb35Reg_Write(pHwData, 0x0800, reg->M00_MacControl);
|
|
}
|
|
}
|
|
|
|
static void hal_set_accept_multicast(struct hw_data *pHwData, u8 enable)
|
|
{
|
|
struct wb35_reg *reg = &pHwData->reg;
|
|
|
|
if (pHwData->SurpriseRemove)
|
|
return;
|
|
|
|
reg->M00_MacControl &= ~0x01000000; //The HW value
|
|
if (enable)
|
|
reg->M00_MacControl |= 0x01000000; //The HW value
|
|
Wb35Reg_Write(pHwData, 0x0800, reg->M00_MacControl);
|
|
}
|
|
|
|
static void hal_set_accept_beacon(struct hw_data *pHwData, u8 enable)
|
|
{
|
|
struct wb35_reg *reg = &pHwData->reg;
|
|
|
|
if (pHwData->SurpriseRemove)
|
|
return;
|
|
|
|
// 20040108 debug
|
|
if (!enable) //Due to SME and MLME are not suitable for 35
|
|
return;
|
|
|
|
reg->M00_MacControl &= ~0x04000000; //The HW value
|
|
if (enable)
|
|
reg->M00_MacControl |= 0x04000000; //The HW value
|
|
|
|
Wb35Reg_Write(pHwData, 0x0800, reg->M00_MacControl);
|
|
}
|
|
|
|
static int wbsoft_config(struct ieee80211_hw *dev, u32 changed)
|
|
{
|
|
struct wbsoft_priv *priv = dev->priv;
|
|
ChanInfo ch;
|
|
|
|
printk("wbsoft_config called\n");
|
|
|
|
/* Should use channel_num, or something, as that is already pre-translated */
|
|
ch.band = 1;
|
|
ch.ChanNo = 1;
|
|
|
|
hal_set_current_channel(&priv->sHwData, ch);
|
|
hal_set_accept_broadcast(&priv->sHwData, 1);
|
|
hal_set_accept_promiscuous(&priv->sHwData, 1);
|
|
hal_set_accept_multicast(&priv->sHwData, 1);
|
|
hal_set_accept_beacon(&priv->sHwData, 1);
|
|
hal_set_radio_mode(&priv->sHwData, 0);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static u64 wbsoft_get_tsf(struct ieee80211_hw *dev)
|
|
{
|
|
printk("wbsoft_get_tsf called\n");
|
|
return 0;
|
|
}
|
|
|
|
static const struct ieee80211_ops wbsoft_ops = {
|
|
.tx = wbsoft_tx,
|
|
.start = wbsoft_start,
|
|
.stop = wbsoft_stop,
|
|
.add_interface = wbsoft_add_interface,
|
|
.remove_interface = wbsoft_remove_interface,
|
|
.config = wbsoft_config,
|
|
.prepare_multicast = wbsoft_prepare_multicast,
|
|
.configure_filter = wbsoft_configure_filter,
|
|
.get_stats = wbsoft_get_stats,
|
|
.get_tx_stats = wbsoft_get_tx_stats,
|
|
.get_tsf = wbsoft_get_tsf,
|
|
};
|
|
|
|
static void
|
|
hal_set_ethernet_address(struct hw_data *pHwData, u8 * current_address)
|
|
{
|
|
u32 ltmp[2];
|
|
|
|
if (pHwData->SurpriseRemove)
|
|
return;
|
|
|
|
memcpy(pHwData->CurrentMacAddress, current_address, ETH_ALEN);
|
|
|
|
ltmp[0] = cpu_to_le32(*(u32 *) pHwData->CurrentMacAddress);
|
|
ltmp[1] =
|
|
cpu_to_le32(*(u32 *) (pHwData->CurrentMacAddress + 4)) & 0xffff;
|
|
|
|
Wb35Reg_BurstWrite(pHwData, 0x03e8, ltmp, 2, AUTO_INCREMENT);
|
|
}
|
|
|
|
static void
|
|
hal_get_permanent_address(struct hw_data *pHwData, u8 * pethernet_address)
|
|
{
|
|
if (pHwData->SurpriseRemove)
|
|
return;
|
|
|
|
memcpy(pethernet_address, pHwData->PermanentMacAddress, 6);
|
|
}
|
|
|
|
static void hal_stop(struct hw_data *pHwData)
|
|
{
|
|
struct wb35_reg *reg = &pHwData->reg;
|
|
|
|
pHwData->Wb35Rx.rx_halt = 1;
|
|
Wb35Rx_stop(pHwData);
|
|
|
|
pHwData->Wb35Tx.tx_halt = 1;
|
|
Wb35Tx_stop(pHwData);
|
|
|
|
reg->D00_DmaControl &= ~0xc0000000; //Tx Off, Rx Off
|
|
Wb35Reg_Write(pHwData, 0x0400, reg->D00_DmaControl);
|
|
}
|
|
|
|
static unsigned char hal_idle(struct hw_data *pHwData)
|
|
{
|
|
struct wb35_reg *reg = &pHwData->reg;
|
|
struct wb_usb *pWbUsb = &pHwData->WbUsb;
|
|
|
|
if (!pHwData->SurpriseRemove
|
|
&& (pWbUsb->DetectCount || reg->EP0vm_state != VM_STOP))
|
|
return false;
|
|
|
|
return true;
|
|
}
|
|
|
|
u8 hal_get_antenna_number(struct hw_data *pHwData)
|
|
{
|
|
struct wb35_reg *reg = &pHwData->reg;
|
|
|
|
if ((reg->BB2C & BIT(11)) == 0)
|
|
return 0;
|
|
else
|
|
return 1;
|
|
}
|
|
|
|
/* 0 : radio on; 1: radio off */
|
|
static u8 hal_get_hw_radio_off(struct hw_data * pHwData)
|
|
{
|
|
struct wb35_reg *reg = &pHwData->reg;
|
|
|
|
if (pHwData->SurpriseRemove)
|
|
return 1;
|
|
|
|
//read the bit16 of register U1B0
|
|
Wb35Reg_Read(pHwData, 0x3b0, ®->U1B0);
|
|
if ((reg->U1B0 & 0x00010000)) {
|
|
pHwData->CurrentRadioHw = 1;
|
|
return 1;
|
|
} else {
|
|
pHwData->CurrentRadioHw = 0;
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
static u8 LED_GRAY[20] = {
|
|
0, 3, 4, 6, 8, 10, 11, 12, 13, 14, 15, 14, 13, 12, 11, 10, 8, 6, 4, 2
|
|
};
|
|
|
|
static u8 LED_GRAY2[30] = {
|
|
7, 8, 9, 10, 11, 12, 13, 14, 15, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
|
|
0, 15, 14, 13, 12, 11, 10, 9, 8
|
|
};
|
|
|
|
static void hal_led_control(unsigned long data)
|
|
{
|
|
struct wbsoft_priv *adapter = (struct wbsoft_priv *)data;
|
|
struct hw_data *pHwData = &adapter->sHwData;
|
|
struct wb35_reg *reg = &pHwData->reg;
|
|
u32 LEDSet = (pHwData->SoftwareSet & HAL_LED_SET_MASK) >> HAL_LED_SET_SHIFT;
|
|
u32 TimeInterval = 500, ltmp, ltmp2;
|
|
ltmp = 0;
|
|
|
|
if (pHwData->SurpriseRemove)
|
|
return;
|
|
|
|
if (pHwData->LED_control) {
|
|
ltmp2 = pHwData->LED_control & 0xff;
|
|
if (ltmp2 == 5) // 5 is WPS mode
|
|
{
|
|
TimeInterval = 100;
|
|
ltmp2 = (pHwData->LED_control >> 8) & 0xff;
|
|
switch (ltmp2) {
|
|
case 1: // [0.2 On][0.1 Off]...
|
|
pHwData->LED_Blinking %= 3;
|
|
ltmp = 0x1010; // Led 1 & 0 Green and Red
|
|
if (pHwData->LED_Blinking == 2) // Turn off
|
|
ltmp = 0;
|
|
break;
|
|
case 2: // [0.1 On][0.1 Off]...
|
|
pHwData->LED_Blinking %= 2;
|
|
ltmp = 0x0010; // Led 0 red color
|
|
if (pHwData->LED_Blinking) // Turn off
|
|
ltmp = 0;
|
|
break;
|
|
case 3: // [0.1 On][0.1 Off][0.1 On][0.1 Off][0.1 On][0.1 Off][0.1 On][0.1 Off][0.1 On][0.1 Off][0.5 Off]...
|
|
pHwData->LED_Blinking %= 15;
|
|
ltmp = 0x0010; // Led 0 red color
|
|
if ((pHwData->LED_Blinking >= 9) || (pHwData->LED_Blinking % 2)) // Turn off 0.6 sec
|
|
ltmp = 0;
|
|
break;
|
|
case 4: // [300 On][ off ]
|
|
ltmp = 0x1000; // Led 1 Green color
|
|
if (pHwData->LED_Blinking >= 3000)
|
|
ltmp = 0; // led maybe on after 300sec * 32bit counter overlap.
|
|
break;
|
|
}
|
|
pHwData->LED_Blinking++;
|
|
|
|
reg->U1BC_LEDConfigure = ltmp;
|
|
if (LEDSet != 7) // Only 111 mode has 2 LEDs on PCB.
|
|
{
|
|
reg->U1BC_LEDConfigure |= (ltmp & 0xff) << 8; // Copy LED result to each LED control register
|
|
reg->U1BC_LEDConfigure |= (ltmp & 0xff00) >> 8;
|
|
}
|
|
Wb35Reg_Write(pHwData, 0x03bc, reg->U1BC_LEDConfigure);
|
|
}
|
|
} else if (pHwData->CurrentRadioSw || pHwData->CurrentRadioHw) // If radio off
|
|
{
|
|
if (reg->U1BC_LEDConfigure & 0x1010) {
|
|
reg->U1BC_LEDConfigure &= ~0x1010;
|
|
Wb35Reg_Write(pHwData, 0x03bc, reg->U1BC_LEDConfigure);
|
|
}
|
|
} else {
|
|
switch (LEDSet) {
|
|
case 4: // [100] Only 1 Led be placed on PCB and use pin 21 of IC. Use LED_0 for showing
|
|
if (!pHwData->LED_LinkOn) // Blink only if not Link On
|
|
{
|
|
// Blinking if scanning is on progress
|
|
if (pHwData->LED_Scanning) {
|
|
if (pHwData->LED_Blinking == 0) {
|
|
reg->U1BC_LEDConfigure |= 0x10;
|
|
Wb35Reg_Write(pHwData, 0x03bc, reg->U1BC_LEDConfigure); // LED_0 On
|
|
pHwData->LED_Blinking = 1;
|
|
TimeInterval = 300;
|
|
} else {
|
|
reg->U1BC_LEDConfigure &= ~0x10;
|
|
Wb35Reg_Write(pHwData, 0x03bc, reg->U1BC_LEDConfigure); // LED_0 Off
|
|
pHwData->LED_Blinking = 0;
|
|
TimeInterval = 300;
|
|
}
|
|
} else {
|
|
//Turn Off LED_0
|
|
if (reg->U1BC_LEDConfigure & 0x10) {
|
|
reg->U1BC_LEDConfigure &= ~0x10;
|
|
Wb35Reg_Write(pHwData, 0x03bc, reg->U1BC_LEDConfigure); // LED_0 Off
|
|
}
|
|
}
|
|
} else {
|
|
// Turn On LED_0
|
|
if ((reg->U1BC_LEDConfigure & 0x10) == 0) {
|
|
reg->U1BC_LEDConfigure |= 0x10;
|
|
Wb35Reg_Write(pHwData, 0x03bc, reg->U1BC_LEDConfigure); // LED_0 Off
|
|
}
|
|
}
|
|
break;
|
|
|
|
case 6: // [110] Only 1 Led be placed on PCB and use pin 21 of IC. Use LED_0 for showing
|
|
if (!pHwData->LED_LinkOn) // Blink only if not Link On
|
|
{
|
|
// Blinking if scanning is on progress
|
|
if (pHwData->LED_Scanning) {
|
|
if (pHwData->LED_Blinking == 0) {
|
|
reg->U1BC_LEDConfigure &= ~0xf;
|
|
reg->U1BC_LEDConfigure |= 0x10;
|
|
Wb35Reg_Write(pHwData, 0x03bc, reg->U1BC_LEDConfigure); // LED_0 On
|
|
pHwData->LED_Blinking = 1;
|
|
TimeInterval = 300;
|
|
} else {
|
|
reg->U1BC_LEDConfigure &= ~0x1f;
|
|
Wb35Reg_Write(pHwData, 0x03bc, reg->U1BC_LEDConfigure); // LED_0 Off
|
|
pHwData->LED_Blinking = 0;
|
|
TimeInterval = 300;
|
|
}
|
|
} else {
|
|
// 20060901 Gray blinking if in disconnect state and not scanning
|
|
ltmp = reg->U1BC_LEDConfigure;
|
|
reg->U1BC_LEDConfigure &= ~0x1f;
|
|
if (LED_GRAY2[(pHwData->LED_Blinking % 30)]) {
|
|
reg->U1BC_LEDConfigure |= 0x10;
|
|
reg->U1BC_LEDConfigure |=
|
|
LED_GRAY2[(pHwData->LED_Blinking % 30)];
|
|
}
|
|
pHwData->LED_Blinking++;
|
|
if (reg->U1BC_LEDConfigure != ltmp)
|
|
Wb35Reg_Write(pHwData, 0x03bc, reg->U1BC_LEDConfigure); // LED_0 Off
|
|
TimeInterval = 100;
|
|
}
|
|
} else {
|
|
// Turn On LED_0
|
|
if ((reg->U1BC_LEDConfigure & 0x10) == 0) {
|
|
reg->U1BC_LEDConfigure |= 0x10;
|
|
Wb35Reg_Write(pHwData, 0x03bc, reg->U1BC_LEDConfigure); // LED_0 Off
|
|
}
|
|
}
|
|
break;
|
|
|
|
case 5: // [101] Only 1 Led be placed on PCB and use LED_1 for showing
|
|
if (!pHwData->LED_LinkOn) // Blink only if not Link On
|
|
{
|
|
// Blinking if scanning is on progress
|
|
if (pHwData->LED_Scanning) {
|
|
if (pHwData->LED_Blinking == 0) {
|
|
reg->U1BC_LEDConfigure |=
|
|
0x1000;
|
|
Wb35Reg_Write(pHwData, 0x03bc, reg->U1BC_LEDConfigure); // LED_1 On
|
|
pHwData->LED_Blinking = 1;
|
|
TimeInterval = 300;
|
|
} else {
|
|
reg->U1BC_LEDConfigure &=
|
|
~0x1000;
|
|
Wb35Reg_Write(pHwData, 0x03bc, reg->U1BC_LEDConfigure); // LED_1 Off
|
|
pHwData->LED_Blinking = 0;
|
|
TimeInterval = 300;
|
|
}
|
|
} else {
|
|
//Turn Off LED_1
|
|
if (reg->U1BC_LEDConfigure & 0x1000) {
|
|
reg->U1BC_LEDConfigure &=
|
|
~0x1000;
|
|
Wb35Reg_Write(pHwData, 0x03bc, reg->U1BC_LEDConfigure); // LED_1 Off
|
|
}
|
|
}
|
|
} else {
|
|
// Is transmitting/receiving ??
|
|
if ((adapter->RxByteCount !=
|
|
pHwData->RxByteCountLast)
|
|
|| (adapter->TxByteCount !=
|
|
pHwData->TxByteCountLast)) {
|
|
if ((reg->U1BC_LEDConfigure & 0x3000) !=
|
|
0x3000) {
|
|
reg->U1BC_LEDConfigure |=
|
|
0x3000;
|
|
Wb35Reg_Write(pHwData, 0x03bc, reg->U1BC_LEDConfigure); // LED_1 On
|
|
}
|
|
// Update variable
|
|
pHwData->RxByteCountLast =
|
|
adapter->RxByteCount;
|
|
pHwData->TxByteCountLast =
|
|
adapter->TxByteCount;
|
|
TimeInterval = 200;
|
|
} else {
|
|
// Turn On LED_1 and blinking if transmitting/receiving
|
|
if ((reg->U1BC_LEDConfigure & 0x3000) !=
|
|
0x1000) {
|
|
reg->U1BC_LEDConfigure &=
|
|
~0x3000;
|
|
reg->U1BC_LEDConfigure |=
|
|
0x1000;
|
|
Wb35Reg_Write(pHwData, 0x03bc, reg->U1BC_LEDConfigure); // LED_1 On
|
|
}
|
|
}
|
|
}
|
|
break;
|
|
|
|
default: // Default setting. 2 LED be placed on PCB. LED_0: Link On LED_1 Active
|
|
if ((reg->U1BC_LEDConfigure & 0x3000) != 0x3000) {
|
|
reg->U1BC_LEDConfigure |= 0x3000; // LED_1 is always on and event enable
|
|
Wb35Reg_Write(pHwData, 0x03bc,
|
|
reg->U1BC_LEDConfigure);
|
|
}
|
|
|
|
if (pHwData->LED_Blinking) {
|
|
// Gray blinking
|
|
reg->U1BC_LEDConfigure &= ~0x0f;
|
|
reg->U1BC_LEDConfigure |= 0x10;
|
|
reg->U1BC_LEDConfigure |=
|
|
LED_GRAY[(pHwData->LED_Blinking - 1) % 20];
|
|
Wb35Reg_Write(pHwData, 0x03bc,
|
|
reg->U1BC_LEDConfigure);
|
|
|
|
pHwData->LED_Blinking += 2;
|
|
if (pHwData->LED_Blinking < 40)
|
|
TimeInterval = 100;
|
|
else {
|
|
pHwData->LED_Blinking = 0; // Stop blinking
|
|
reg->U1BC_LEDConfigure &= ~0x0f;
|
|
Wb35Reg_Write(pHwData, 0x03bc,
|
|
reg->U1BC_LEDConfigure);
|
|
}
|
|
break;
|
|
}
|
|
|
|
if (pHwData->LED_LinkOn) {
|
|
if (!(reg->U1BC_LEDConfigure & 0x10)) // Check the LED_0
|
|
{
|
|
//Try to turn ON LED_0 after gray blinking
|
|
reg->U1BC_LEDConfigure |= 0x10;
|
|
pHwData->LED_Blinking = 1; //Start blinking
|
|
TimeInterval = 50;
|
|
}
|
|
} else {
|
|
if (reg->U1BC_LEDConfigure & 0x10) // Check the LED_0
|
|
{
|
|
reg->U1BC_LEDConfigure &= ~0x10;
|
|
Wb35Reg_Write(pHwData, 0x03bc,
|
|
reg->U1BC_LEDConfigure);
|
|
}
|
|
}
|
|
break;
|
|
}
|
|
|
|
//20060828.1 Active send null packet to avoid AP disconnect
|
|
if (pHwData->LED_LinkOn) {
|
|
pHwData->NullPacketCount += TimeInterval;
|
|
if (pHwData->NullPacketCount >=
|
|
DEFAULT_NULL_PACKET_COUNT) {
|
|
pHwData->NullPacketCount = 0;
|
|
}
|
|
}
|
|
}
|
|
|
|
pHwData->time_count += TimeInterval;
|
|
Wb35Tx_CurrentTime(adapter, pHwData->time_count); // 20060928 add
|
|
pHwData->LEDTimer.expires = jiffies + msecs_to_jiffies(TimeInterval);
|
|
add_timer(&pHwData->LEDTimer);
|
|
}
|
|
|
|
static int hal_init_hardware(struct ieee80211_hw *hw)
|
|
{
|
|
struct wbsoft_priv *priv = hw->priv;
|
|
struct hw_data *pHwData = &priv->sHwData;
|
|
u16 SoftwareSet;
|
|
|
|
pHwData->MaxReceiveLifeTime = DEFAULT_MSDU_LIFE_TIME;
|
|
pHwData->FragmentThreshold = DEFAULT_FRAGMENT_THRESHOLD;
|
|
|
|
if (!Wb35Reg_initial(pHwData))
|
|
goto error_reg_destroy;
|
|
|
|
if (!Wb35Tx_initial(pHwData))
|
|
goto error_tx_destroy;
|
|
|
|
if (!Wb35Rx_initial(pHwData))
|
|
goto error_rx_destroy;
|
|
|
|
init_timer(&pHwData->LEDTimer);
|
|
pHwData->LEDTimer.function = hal_led_control;
|
|
pHwData->LEDTimer.data = (unsigned long)priv;
|
|
pHwData->LEDTimer.expires = jiffies + msecs_to_jiffies(1000);
|
|
add_timer(&pHwData->LEDTimer);
|
|
|
|
SoftwareSet = hal_software_set(pHwData);
|
|
|
|
#ifdef Vendor2
|
|
// Try to make sure the EEPROM contain
|
|
SoftwareSet >>= 8;
|
|
if (SoftwareSet != 0x82)
|
|
return false;
|
|
#endif
|
|
|
|
Wb35Rx_start(hw);
|
|
Wb35Tx_EP2VM_start(priv);
|
|
|
|
return 0;
|
|
|
|
error_rx_destroy:
|
|
Wb35Rx_destroy(pHwData);
|
|
error_tx_destroy:
|
|
Wb35Tx_destroy(pHwData);
|
|
error_reg_destroy:
|
|
Wb35Reg_destroy(pHwData);
|
|
|
|
pHwData->SurpriseRemove = 1;
|
|
return -EINVAL;
|
|
}
|
|
|
|
static int wb35_hw_init(struct ieee80211_hw *hw)
|
|
{
|
|
struct wbsoft_priv *priv = hw->priv;
|
|
struct hw_data *pHwData = &priv->sHwData;
|
|
u8 EEPROM_region;
|
|
u8 HwRadioOff;
|
|
u8 *pMacAddr2;
|
|
u8 *pMacAddr;
|
|
int err;
|
|
|
|
pHwData->phy_type = RF_DECIDE_BY_INF;
|
|
|
|
priv->Mds.TxRTSThreshold = DEFAULT_RTSThreshold;
|
|
priv->Mds.TxFragmentThreshold = DEFAULT_FRAGMENT_THRESHOLD;
|
|
|
|
priv->sLocalPara.region_INF = REGION_AUTO;
|
|
priv->sLocalPara.TxRateMode = RATE_AUTO;
|
|
priv->sLocalPara.bMacOperationMode = MODE_802_11_BG;
|
|
priv->sLocalPara.MTUsize = MAX_ETHERNET_PACKET_SIZE;
|
|
priv->sLocalPara.bPreambleMode = AUTO_MODE;
|
|
priv->sLocalPara.bWepKeyError = false;
|
|
priv->sLocalPara.bToSelfPacketReceived = false;
|
|
priv->sLocalPara.WepKeyDetectTimerCount = 2 * 100; /* 2 seconds */
|
|
|
|
priv->sLocalPara.RadioOffStatus.boSwRadioOff = false;
|
|
|
|
err = hal_init_hardware(hw);
|
|
if (err)
|
|
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 */
|
|
}
|
|
|
|
Mds_initial(priv);
|
|
|
|
/*
|
|
* If no user-defined address in the registry, use the addresss
|
|
* "burned" on the NIC instead.
|
|
*/
|
|
pMacAddr = priv->sLocalPara.ThisMacAddress;
|
|
pMacAddr2 = priv->sLocalPara.PermanentAddress;
|
|
|
|
/* Reading ethernet address from EEPROM */
|
|
hal_get_permanent_address(pHwData, priv->sLocalPara.PermanentAddress);
|
|
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);
|
|
}
|
|
|
|
priv->sLocalPara.bAntennaNo = hal_get_antenna_number(pHwData);
|
|
#ifdef _PE_STATE_DUMP_
|
|
printk("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));
|
|
|
|
/* Notify hal that the driver is ready now. */
|
|
hal_driver_init_OK(pHwData) = 1;
|
|
|
|
error:
|
|
return err;
|
|
}
|
|
|
|
static int wb35_probe(struct usb_interface *intf,
|
|
const struct usb_device_id *id_table)
|
|
{
|
|
struct usb_device *udev = interface_to_usbdev(intf);
|
|
struct usb_endpoint_descriptor *endpoint;
|
|
struct usb_host_interface *interface;
|
|
struct ieee80211_hw *dev;
|
|
struct wbsoft_priv *priv;
|
|
struct wb_usb *pWbUsb;
|
|
int nr, err;
|
|
u32 ltmp;
|
|
|
|
usb_get_dev(udev);
|
|
|
|
/* Check the device if it already be opened */
|
|
nr = usb_control_msg(udev, usb_rcvctrlpipe(udev, 0),
|
|
0x01,
|
|
USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_IN,
|
|
0x0, 0x400, <mp, 4, HZ * 100);
|
|
if (nr < 0) {
|
|
err = nr;
|
|
goto error;
|
|
}
|
|
|
|
/* Is already initialized? */
|
|
ltmp = cpu_to_le32(ltmp);
|
|
if (ltmp) {
|
|
err = -EBUSY;
|
|
goto error;
|
|
}
|
|
|
|
dev = ieee80211_alloc_hw(sizeof(*priv), &wbsoft_ops);
|
|
if (!dev) {
|
|
err = -ENOMEM;
|
|
goto error;
|
|
}
|
|
|
|
priv = dev->priv;
|
|
|
|
spin_lock_init(&priv->SpinLock);
|
|
|
|
pWbUsb = &priv->sHwData.WbUsb;
|
|
pWbUsb->udev = udev;
|
|
|
|
interface = intf->cur_altsetting;
|
|
endpoint = &interface->endpoint[0].desc;
|
|
|
|
if (endpoint[2].wMaxPacketSize == 512) {
|
|
printk("[w35und] Working on USB 2.0\n");
|
|
pWbUsb->IsUsb20 = 1;
|
|
}
|
|
|
|
err = wb35_hw_init(dev);
|
|
if (err)
|
|
goto error_free_hw;
|
|
|
|
SET_IEEE80211_DEV(dev, &udev->dev);
|
|
{
|
|
struct hw_data *pHwData = &priv->sHwData;
|
|
unsigned char dev_addr[MAX_ADDR_LEN];
|
|
hal_get_permanent_address(pHwData, dev_addr);
|
|
SET_IEEE80211_PERM_ADDR(dev, dev_addr);
|
|
}
|
|
|
|
dev->extra_tx_headroom = 12; /* FIXME */
|
|
dev->flags = IEEE80211_HW_SIGNAL_UNSPEC;
|
|
dev->wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION);
|
|
|
|
dev->channel_change_time = 1000;
|
|
dev->max_signal = 100;
|
|
dev->queues = 1;
|
|
|
|
dev->wiphy->bands[IEEE80211_BAND_2GHZ] = &wbsoft_band_2GHz;
|
|
|
|
err = ieee80211_register_hw(dev);
|
|
if (err)
|
|
goto error_free_hw;
|
|
|
|
usb_set_intfdata(intf, dev);
|
|
|
|
return 0;
|
|
|
|
error_free_hw:
|
|
ieee80211_free_hw(dev);
|
|
error:
|
|
usb_put_dev(udev);
|
|
return err;
|
|
}
|
|
|
|
static void hal_halt(struct hw_data *pHwData)
|
|
{
|
|
del_timer_sync(&pHwData->LEDTimer);
|
|
/* XXX: Wait for Timer DPC exit. */
|
|
msleep(100);
|
|
Wb35Rx_destroy(pHwData);
|
|
Wb35Tx_destroy(pHwData);
|
|
Wb35Reg_destroy(pHwData);
|
|
}
|
|
|
|
static void wb35_hw_halt(struct wbsoft_priv *adapter)
|
|
{
|
|
Mds_Destroy(adapter);
|
|
|
|
/* Turn off Rx and Tx hardware ability */
|
|
hal_stop(&adapter->sHwData);
|
|
#ifdef _PE_USB_INI_DUMP_
|
|
printk("[w35und] Hal_stop O.K.\n");
|
|
#endif
|
|
/* Waiting Irp completed */
|
|
msleep(100);
|
|
|
|
hal_halt(&adapter->sHwData);
|
|
}
|
|
|
|
static void wb35_disconnect(struct usb_interface *intf)
|
|
{
|
|
struct ieee80211_hw *hw = usb_get_intfdata(intf);
|
|
struct wbsoft_priv *priv = hw->priv;
|
|
|
|
wb35_hw_halt(priv);
|
|
|
|
ieee80211_stop_queues(hw);
|
|
ieee80211_unregister_hw(hw);
|
|
ieee80211_free_hw(hw);
|
|
|
|
usb_set_intfdata(intf, NULL);
|
|
usb_put_dev(interface_to_usbdev(intf));
|
|
}
|
|
|
|
static struct usb_driver wb35_driver = {
|
|
.name = "w35und",
|
|
.id_table = wb35_table,
|
|
.probe = wb35_probe,
|
|
.disconnect = wb35_disconnect,
|
|
};
|
|
|
|
static int __init wb35_init(void)
|
|
{
|
|
return usb_register(&wb35_driver);
|
|
}
|
|
|
|
static void __exit wb35_exit(void)
|
|
{
|
|
usb_deregister(&wb35_driver);
|
|
}
|
|
|
|
module_init(wb35_init);
|
|
module_exit(wb35_exit);
|