mirror of https://gitee.com/openkylin/linux.git
359 lines
8.0 KiB
C
359 lines
8.0 KiB
C
/**
|
|
* This file contains the initialization for FW and HW
|
|
*/
|
|
#include <linux/module.h>
|
|
#include <linux/moduleparam.h>
|
|
|
|
#include <linux/vmalloc.h>
|
|
#include <linux/firmware.h>
|
|
#include <linux/version.h>
|
|
|
|
#include "host.h"
|
|
#include "sbi.h"
|
|
#include "defs.h"
|
|
#include "decl.h"
|
|
#include "dev.h"
|
|
#include "fw.h"
|
|
#include "wext.h"
|
|
#include "if_usb.h"
|
|
|
|
char *libertas_fw_name = NULL;
|
|
module_param_named(fw_name, libertas_fw_name, charp, 0644);
|
|
|
|
unsigned int libertas_debug = 0;
|
|
module_param(libertas_debug, int, 0);
|
|
|
|
/**
|
|
* @brief This function checks the validity of Boot2/FW image.
|
|
*
|
|
* @param data pointer to image
|
|
* len image length
|
|
* @return 0 or -1
|
|
*/
|
|
static int check_fwfile_format(u8 *data, u32 totlen)
|
|
{
|
|
u8 bincmd, exit;
|
|
u32 blksize, offset, len;
|
|
int ret;
|
|
|
|
ret = 1;
|
|
exit = len = 0;
|
|
|
|
do {
|
|
bincmd = *data;
|
|
blksize = *(u32*)(data + offsetof(struct fwheader, datalength));
|
|
switch (bincmd) {
|
|
case FW_HAS_DATA_TO_RECV:
|
|
offset = sizeof(struct fwheader) + blksize;
|
|
data += offset;
|
|
len += offset;
|
|
if (len >= totlen)
|
|
exit = 1;
|
|
break;
|
|
case FW_HAS_LAST_BLOCK:
|
|
exit = 1;
|
|
ret = 0;
|
|
break;
|
|
default:
|
|
exit = 1;
|
|
break;
|
|
}
|
|
} while (!exit);
|
|
|
|
if (ret)
|
|
lbs_pr_err("bin file format check FAIL...\n");
|
|
else
|
|
lbs_pr_debug(1, "bin file format check PASS...\n");
|
|
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* @brief This function downloads firmware image, gets
|
|
* HW spec from firmware and set basic parameters to
|
|
* firmware.
|
|
*
|
|
* @param priv A pointer to wlan_private structure
|
|
* @return 0 or -1
|
|
*/
|
|
static int wlan_setup_station_hw(wlan_private * priv)
|
|
{
|
|
int ret = -1;
|
|
wlan_adapter *adapter = priv->adapter;
|
|
|
|
ENTER();
|
|
|
|
if ((ret = request_firmware(&priv->firmware, libertas_fw_name,
|
|
priv->hotplug_device)) < 0) {
|
|
lbs_pr_err("request_firmware() failed, error code = %#x\n",
|
|
ret);
|
|
lbs_pr_err("%s not found in /lib/firmware\n", libertas_fw_name);
|
|
goto done;
|
|
}
|
|
|
|
if(check_fwfile_format(priv->firmware->data, priv->firmware->size)) {
|
|
release_firmware(priv->firmware);
|
|
goto done;
|
|
}
|
|
|
|
ret = libertas_sbi_prog_firmware(priv);
|
|
|
|
release_firmware(priv->firmware);
|
|
|
|
if (ret) {
|
|
lbs_pr_debug(1, "Bootloader in invalid state!\n");
|
|
ret = -1;
|
|
goto done;
|
|
}
|
|
|
|
/*
|
|
* Read MAC address from HW
|
|
*/
|
|
memset(adapter->current_addr, 0xff, ETH_ALEN);
|
|
|
|
ret = libertas_prepare_and_send_command(priv, cmd_get_hw_spec,
|
|
0, cmd_option_waitforrsp, 0, NULL);
|
|
|
|
if (ret) {
|
|
ret = -1;
|
|
goto done;
|
|
}
|
|
|
|
libertas_set_mac_packet_filter(priv);
|
|
|
|
/* Get the supported Data rates */
|
|
ret = libertas_prepare_and_send_command(priv, cmd_802_11_data_rate,
|
|
cmd_act_get_tx_rate,
|
|
cmd_option_waitforrsp, 0, NULL);
|
|
|
|
if (ret) {
|
|
ret = -1;
|
|
goto done;
|
|
}
|
|
|
|
ret = 0;
|
|
done:
|
|
LEAVE();
|
|
|
|
return (ret);
|
|
}
|
|
|
|
static int wlan_allocate_adapter(wlan_private * priv)
|
|
{
|
|
u32 ulbufsize;
|
|
wlan_adapter *adapter = priv->adapter;
|
|
|
|
struct bss_descriptor *ptempscantable;
|
|
|
|
/* Allocate buffer to store the BSSID list */
|
|
ulbufsize = sizeof(struct bss_descriptor) * MRVDRV_MAX_BSSID_LIST;
|
|
if (!(ptempscantable = kmalloc(ulbufsize, GFP_KERNEL))) {
|
|
libertas_free_adapter(priv);
|
|
return -1;
|
|
}
|
|
|
|
adapter->scantable = ptempscantable;
|
|
memset(adapter->scantable, 0, ulbufsize);
|
|
|
|
/* Allocate the command buffers */
|
|
libertas_allocate_cmd_buffer(priv);
|
|
|
|
memset(&adapter->libertas_ps_confirm_sleep, 0, sizeof(struct PS_CMD_ConfirmSleep));
|
|
adapter->libertas_ps_confirm_sleep.seqnum = cpu_to_le16(++adapter->seqnum);
|
|
adapter->libertas_ps_confirm_sleep.command =
|
|
cpu_to_le16(cmd_802_11_ps_mode);
|
|
adapter->libertas_ps_confirm_sleep.size =
|
|
cpu_to_le16(sizeof(struct PS_CMD_ConfirmSleep));
|
|
adapter->libertas_ps_confirm_sleep.result = 0;
|
|
adapter->libertas_ps_confirm_sleep.action =
|
|
cpu_to_le16(cmd_subcmd_sleep_confirmed);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void wlan_init_adapter(wlan_private * priv)
|
|
{
|
|
wlan_adapter *adapter = priv->adapter;
|
|
int i;
|
|
|
|
adapter->scanprobes = 0;
|
|
|
|
adapter->bcn_avg_factor = DEFAULT_BCN_AVG_FACTOR;
|
|
adapter->data_avg_factor = DEFAULT_DATA_AVG_FACTOR;
|
|
|
|
/* ATIM params */
|
|
adapter->atimwindow = 0;
|
|
|
|
adapter->connect_status = libertas_disconnected;
|
|
memset(adapter->current_addr, 0xff, ETH_ALEN);
|
|
|
|
/* scan type */
|
|
adapter->scantype = cmd_scan_type_active;
|
|
|
|
/* scan mode */
|
|
adapter->scanmode = cmd_bss_type_any;
|
|
|
|
/* 802.11 specific */
|
|
adapter->secinfo.wep_enabled = 0;
|
|
for (i = 0; i < sizeof(adapter->wep_keys) / sizeof(adapter->wep_keys[0]);
|
|
i++)
|
|
memset(&adapter->wep_keys[i], 0, sizeof(struct WLAN_802_11_KEY));
|
|
adapter->wep_tx_keyidx = 0;
|
|
adapter->secinfo.auth_mode = IW_AUTH_ALG_OPEN_SYSTEM;
|
|
adapter->mode = IW_MODE_INFRA;
|
|
|
|
adapter->assoc_req = NULL;
|
|
|
|
adapter->numinscantable = 0;
|
|
adapter->pattemptedbssdesc = NULL;
|
|
mutex_init(&adapter->lock);
|
|
|
|
adapter->prescan = 1;
|
|
|
|
memset(&adapter->curbssparams, 0, sizeof(adapter->curbssparams));
|
|
|
|
/* PnP and power profile */
|
|
adapter->surpriseremoved = 0;
|
|
|
|
adapter->currentpacketfilter =
|
|
cmd_act_mac_rx_on | cmd_act_mac_tx_on;
|
|
|
|
adapter->radioon = RADIO_ON;
|
|
adapter->txantenna = RF_ANTENNA_2;
|
|
adapter->rxantenna = RF_ANTENNA_AUTO;
|
|
|
|
adapter->is_datarate_auto = 1;
|
|
adapter->beaconperiod = MRVDRV_BEACON_INTERVAL;
|
|
|
|
// set default value of capinfo.
|
|
#define SHORT_PREAMBLE_ALLOWED 1
|
|
memset(&adapter->capinfo, 0, sizeof(adapter->capinfo));
|
|
adapter->capinfo.shortpreamble = SHORT_PREAMBLE_ALLOWED;
|
|
|
|
adapter->adhocchannel = DEFAULT_AD_HOC_CHANNEL;
|
|
|
|
adapter->psmode = wlan802_11powermodecam;
|
|
adapter->multipledtim = MRVDRV_DEFAULT_MULTIPLE_DTIM;
|
|
|
|
adapter->listeninterval = MRVDRV_DEFAULT_LISTEN_INTERVAL;
|
|
|
|
adapter->psstate = PS_STATE_FULL_POWER;
|
|
adapter->needtowakeup = 0;
|
|
adapter->locallisteninterval = 0; /* default value in firmware will be used */
|
|
|
|
adapter->datarate = 0; // Initially indicate the rate as auto
|
|
|
|
adapter->adhoc_grate_enabled = 0;
|
|
|
|
adapter->intcounter = 0;
|
|
|
|
adapter->currenttxskb = NULL;
|
|
adapter->pkttxctrl = 0;
|
|
|
|
memset(&adapter->tx_queue_ps, 0, NR_TX_QUEUE*sizeof(struct sk_buff*));
|
|
adapter->tx_queue_idx = 0;
|
|
spin_lock_init(&adapter->txqueue_lock);
|
|
|
|
return;
|
|
}
|
|
|
|
static void command_timer_fn(unsigned long data);
|
|
|
|
int libertas_init_fw(wlan_private * priv)
|
|
{
|
|
int ret = -1;
|
|
wlan_adapter *adapter = priv->adapter;
|
|
|
|
ENTER();
|
|
|
|
/* Allocate adapter structure */
|
|
if ((ret = wlan_allocate_adapter(priv)) != 0)
|
|
goto done;
|
|
|
|
/* init adapter structure */
|
|
wlan_init_adapter(priv);
|
|
|
|
/* init timer etc. */
|
|
setup_timer(&adapter->command_timer, command_timer_fn,
|
|
(unsigned long)priv);
|
|
|
|
/* download fimrware etc. */
|
|
if ((ret = wlan_setup_station_hw(priv)) != 0) {
|
|
del_timer_sync(&adapter->command_timer);
|
|
goto done;
|
|
}
|
|
|
|
/* init 802.11d */
|
|
libertas_init_11d(priv);
|
|
|
|
ret = 0;
|
|
done:
|
|
LEAVE();
|
|
return ret;
|
|
}
|
|
|
|
void libertas_free_adapter(wlan_private * priv)
|
|
{
|
|
wlan_adapter *adapter = priv->adapter;
|
|
|
|
if (!adapter) {
|
|
lbs_pr_debug(1, "Why double free adapter?:)\n");
|
|
return;
|
|
}
|
|
|
|
lbs_pr_debug(1, "Free command buffer\n");
|
|
libertas_free_cmd_buffer(priv);
|
|
|
|
lbs_pr_debug(1, "Free commandTimer\n");
|
|
del_timer(&adapter->command_timer);
|
|
|
|
lbs_pr_debug(1, "Free scantable\n");
|
|
if (adapter->scantable) {
|
|
kfree(adapter->scantable);
|
|
adapter->scantable = NULL;
|
|
}
|
|
|
|
lbs_pr_debug(1, "Free adapter\n");
|
|
|
|
/* Free the adapter object itself */
|
|
kfree(adapter);
|
|
priv->adapter = NULL;
|
|
}
|
|
|
|
/**
|
|
* This function handles the timeout of command sending.
|
|
* It will re-send the same command again.
|
|
*/
|
|
static void command_timer_fn(unsigned long data)
|
|
{
|
|
wlan_private *priv = (wlan_private *)data;
|
|
wlan_adapter *adapter = priv->adapter;
|
|
struct cmd_ctrl_node *ptempnode;
|
|
struct cmd_ds_command *cmd;
|
|
unsigned long flags;
|
|
|
|
ptempnode = adapter->cur_cmd;
|
|
cmd = (struct cmd_ds_command *)ptempnode->bufvirtualaddr;
|
|
|
|
lbs_pr_info("command_timer_fn fired (%x)\n", cmd->command);
|
|
|
|
if (!adapter->fw_ready)
|
|
return;
|
|
|
|
if (ptempnode == NULL) {
|
|
lbs_pr_debug(1, "PTempnode Empty\n");
|
|
return;
|
|
}
|
|
|
|
spin_lock_irqsave(&adapter->driver_lock, flags);
|
|
adapter->cur_cmd = NULL;
|
|
spin_unlock_irqrestore(&adapter->driver_lock, flags);
|
|
|
|
lbs_pr_debug(1, "Re-sending same command as it timeout...!\n");
|
|
libertas_queue_cmd(adapter, ptempnode, 0);
|
|
|
|
wake_up_interruptible(&priv->mainthread.waitq);
|
|
|
|
return;
|
|
}
|