![Pekka Enberg](/assets/img/avatar_default.png)
Impact: fix module removal This patch fixes an oops when the w35und module is removed from the kernel and added back. Reported-by: luoyi <luoyi.ly@gmail.com> Tested-by: Sandro Bonazzola <sandro.bonazzola@gmail.com> Cc: Pavel Machek <pavel@ucw.cz> Signed-off-by: Pekka Enberg <penberg@cs.helsinki.fi> Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
450 lines
11 KiB
C
450 lines
11 KiB
C
/*
|
|
* Copyright 2008 Pavel Machek <pavel@suse.cz>
|
|
*
|
|
* Distribute under GPLv2.
|
|
*/
|
|
#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_AUTHOR("Original by: Jeff Lee<YY_Lee@issc.com.tw> Adapted to 2.6.x by Costantino Leandro (Rxart Desktop) <le_costantino@pixartargentina.com.ar>");
|
|
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 int wbsoft_add_interface(struct ieee80211_hw *dev,
|
|
struct ieee80211_if_init_conf *conf)
|
|
{
|
|
printk("wbsoft_add interface called\n");
|
|
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 void wbsoft_configure_filter(struct ieee80211_hw *dev,
|
|
unsigned int changed_flags,
|
|
unsigned int *total_flags,
|
|
int mc_count, struct dev_mc_list *mclist)
|
|
{
|
|
unsigned int bit_nr, new_flags;
|
|
u32 mc_filter[2];
|
|
int i;
|
|
|
|
new_flags = 0;
|
|
|
|
if (*total_flags & FIF_PROMISC_IN_BSS) {
|
|
new_flags |= FIF_PROMISC_IN_BSS;
|
|
mc_filter[1] = mc_filter[0] = ~0;
|
|
} else if ((*total_flags & FIF_ALLMULTI) || (mc_count > 32)) {
|
|
new_flags |= FIF_ALLMULTI;
|
|
mc_filter[1] = mc_filter[0] = ~0;
|
|
} else {
|
|
mc_filter[1] = mc_filter[0] = 0;
|
|
for (i = 0; i < mc_count; i++) {
|
|
if (!mclist)
|
|
break;
|
|
printk("Should call ether_crc here\n");
|
|
//bit_nr = ether_crc(ETH_ALEN, mclist->dmi_addr) >> 26;
|
|
bit_nr = 0;
|
|
|
|
bit_nr &= 0x3F;
|
|
mc_filter[bit_nr >> 5] |= 1 << (bit_nr & 31);
|
|
mclist = mclist->next;
|
|
}
|
|
}
|
|
|
|
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 int wbsoft_config(struct ieee80211_hw *dev, u32 changed)
|
|
{
|
|
struct wbsoft_priv *priv = dev->priv;
|
|
struct ieee80211_conf *conf = &dev->conf;
|
|
ChanInfo ch;
|
|
|
|
printk("wbsoft_config called\n");
|
|
|
|
ch.band = 1;
|
|
ch.ChanNo = 1; /* Should use channel_num, or something, as that is already pre-translated */
|
|
|
|
|
|
hal_set_current_channel(&priv->sHwData, ch);
|
|
hal_set_beacon_period(&priv->sHwData, conf->beacon_int);
|
|
// hal_set_cap_info(&priv->sHwData, ?? );
|
|
// hal_set_ssid(struct hw_data * pHwData, u8 * pssid, u8 ssid_len); ??
|
|
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);
|
|
//hal_set_antenna_number( struct hw_data * pHwData, u8 number )
|
|
//hal_set_rf_power(struct hw_data * pHwData, u8 PowerIndex)
|
|
|
|
|
|
// hal_start_bss(&priv->sHwData, WLAN_BSSTYPE_INFRASTRUCTURE); ??
|
|
|
|
//void hal_set_rates(struct hw_data * pHwData, u8 * pbss_rates,
|
|
// u8 length, unsigned char basic_rate_set)
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int wbsoft_config_interface(struct ieee80211_hw *dev,
|
|
struct ieee80211_vif *vif,
|
|
struct ieee80211_if_conf *conf)
|
|
{
|
|
printk("wbsoft_config_interface called\n");
|
|
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, /* 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,
|
|
.config = wbsoft_config,
|
|
.config_interface = wbsoft_config_interface,
|
|
.configure_filter = wbsoft_configure_filter,
|
|
.get_stats = wbsoft_get_stats,
|
|
.get_tx_stats = wbsoft_get_tx_stats,
|
|
.get_tsf = wbsoft_get_tsf,
|
|
// conf_tx: hal_set_cwmin()/hal_set_cwmax;
|
|
};
|
|
|
|
static unsigned char wb35_hw_init(struct ieee80211_hw *hw)
|
|
{
|
|
struct wbsoft_priv *priv = hw->priv;
|
|
struct hw_data * 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 );
|
|
|
|
//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_
|
|
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) );
|
|
|
|
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: hal_halt( pHwData, NULL );
|
|
case 0: break;
|
|
}
|
|
|
|
return false;
|
|
}
|
|
|
|
static int wb35_probe(struct usb_interface *intf, const struct usb_device_id *id_table)
|
|
{
|
|
struct wb_usb *pWbUsb;
|
|
struct usb_host_interface *interface;
|
|
struct usb_endpoint_descriptor *endpoint;
|
|
u32 ltmp;
|
|
struct usb_device *udev = interface_to_usbdev(intf);
|
|
struct wbsoft_priv *priv;
|
|
struct ieee80211_hw *dev;
|
|
int nr, err;
|
|
|
|
usb_get_dev(udev);
|
|
|
|
// 20060630.2 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;
|
|
}
|
|
|
|
ltmp = cpu_to_le32(ltmp);
|
|
if (ltmp) { // Is already initialized?
|
|
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;
|
|
}
|
|
|
|
if (!wb35_hw_init(dev)) {
|
|
err = -EINVAL;
|
|
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 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
|
|
msleep(100);// Waiting Irp completed
|
|
|
|
// Halt the HAL
|
|
hal_halt(&adapter->sHwData, NULL);
|
|
}
|
|
|
|
|
|
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);
|