1 files changed, 361 insertions, 0 deletions

diff --git a/drivers/net/wireless/libertas/fw.c b/drivers/net/wireless/libertas/fw.c
new file mode 100644
index 000000000000..b194a4570791
--- /dev/null
+++ b/drivers/net/wireless/libertas/fw.c
@@ -0,0 +1,361 @@
+/**
+  * 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.WEPstatus = wlan802_11WEPdisabled;
+        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.WEPstatus = wlan802_11WEPdisabled;
+        adapter->secinfo.authmode = wlan802_11authmodeopen;
+        adapter->secinfo.auth1xalg = WLAN_1X_AUTH_ALG_NONE;
+        adapter->secinfo.Encryptionmode = CIPHER_NONE;
+        adapter->inframode = wlan802_11infrastructure;
+
+        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;
+}