4092 lines
106 KiB
C
4092 lines
106 KiB
C
#include <linux/slab.h>
|
|
#include <linux/time.h>
|
|
#include <linux/kthread.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/completion.h>
|
|
#include <linux/list.h>
|
|
#include <linux/workqueue.h>
|
|
#include "host_interface.h"
|
|
#include <linux/spinlock.h>
|
|
#include <linux/errno.h>
|
|
#include "coreconfigurator.h"
|
|
#include "wilc_wlan.h"
|
|
#include "wilc_wlan_if.h"
|
|
#include <linux/etherdevice.h>
|
|
#include "wilc_wfi_netdevice.h"
|
|
|
|
#define HOST_IF_MSG_SCAN 0
|
|
#define HOST_IF_MSG_CONNECT 1
|
|
#define HOST_IF_MSG_RCVD_GNRL_ASYNC_INFO 2
|
|
#define HOST_IF_MSG_KEY 3
|
|
#define HOST_IF_MSG_RCVD_NTWRK_INFO 4
|
|
#define HOST_IF_MSG_RCVD_SCAN_COMPLETE 5
|
|
#define HOST_IF_MSG_CFG_PARAMS 6
|
|
#define HOST_IF_MSG_SET_CHANNEL 7
|
|
#define HOST_IF_MSG_DISCONNECT 8
|
|
#define HOST_IF_MSG_GET_RSSI 9
|
|
#define HOST_IF_MSG_ADD_BEACON 11
|
|
#define HOST_IF_MSG_DEL_BEACON 12
|
|
#define HOST_IF_MSG_ADD_STATION 13
|
|
#define HOST_IF_MSG_DEL_STATION 14
|
|
#define HOST_IF_MSG_EDIT_STATION 15
|
|
#define HOST_IF_MSG_SCAN_TIMER_FIRED 16
|
|
#define HOST_IF_MSG_CONNECT_TIMER_FIRED 17
|
|
#define HOST_IF_MSG_POWER_MGMT 18
|
|
#define HOST_IF_MSG_GET_INACTIVETIME 19
|
|
#define HOST_IF_MSG_REMAIN_ON_CHAN 20
|
|
#define HOST_IF_MSG_REGISTER_FRAME 21
|
|
#define HOST_IF_MSG_LISTEN_TIMER_FIRED 22
|
|
#define HOST_IF_MSG_SET_WFIDRV_HANDLER 24
|
|
#define HOST_IF_MSG_GET_MAC_ADDRESS 26
|
|
#define HOST_IF_MSG_SET_OPERATION_MODE 27
|
|
#define HOST_IF_MSG_SET_IPADDRESS 28
|
|
#define HOST_IF_MSG_GET_IPADDRESS 29
|
|
#define HOST_IF_MSG_GET_STATISTICS 31
|
|
#define HOST_IF_MSG_SET_MULTICAST_FILTER 32
|
|
#define HOST_IF_MSG_DEL_BA_SESSION 34
|
|
#define HOST_IF_MSG_DEL_ALL_STA 36
|
|
#define HOST_IF_MSG_SET_TX_POWER 38
|
|
#define HOST_IF_MSG_GET_TX_POWER 39
|
|
#define HOST_IF_MSG_EXIT 100
|
|
|
|
#define HOST_IF_SCAN_TIMEOUT 4000
|
|
#define HOST_IF_CONNECT_TIMEOUT 9500
|
|
|
|
#define BA_SESSION_DEFAULT_BUFFER_SIZE 16
|
|
#define BA_SESSION_DEFAULT_TIMEOUT 1000
|
|
#define BLOCK_ACK_REQ_SIZE 0x14
|
|
#define FALSE_FRMWR_CHANNEL 100
|
|
|
|
#define TCP_ACK_FILTER_LINK_SPEED_THRESH 54
|
|
#define DEFAULT_LINK_SPEED 72
|
|
|
|
struct host_if_wpa_attr {
|
|
u8 *key;
|
|
const u8 *mac_addr;
|
|
u8 *seq;
|
|
u8 seq_len;
|
|
u8 index;
|
|
u8 key_len;
|
|
u8 mode;
|
|
};
|
|
|
|
struct host_if_wep_attr {
|
|
u8 *key;
|
|
u8 key_len;
|
|
u8 index;
|
|
u8 mode;
|
|
enum AUTHTYPE auth_type;
|
|
};
|
|
|
|
union host_if_key_attr {
|
|
struct host_if_wep_attr wep;
|
|
struct host_if_wpa_attr wpa;
|
|
struct host_if_pmkid_attr pmkid;
|
|
};
|
|
|
|
struct key_attr {
|
|
enum KEY_TYPE type;
|
|
u8 action;
|
|
union host_if_key_attr attr;
|
|
};
|
|
|
|
struct scan_attr {
|
|
u8 src;
|
|
u8 type;
|
|
u8 *ch_freq_list;
|
|
u8 ch_list_len;
|
|
u8 *ies;
|
|
size_t ies_len;
|
|
wilc_scan_result result;
|
|
void *arg;
|
|
struct hidden_network hidden_network;
|
|
};
|
|
|
|
struct connect_attr {
|
|
u8 *bssid;
|
|
u8 *ssid;
|
|
size_t ssid_len;
|
|
u8 *ies;
|
|
size_t ies_len;
|
|
u8 security;
|
|
wilc_connect_result result;
|
|
void *arg;
|
|
enum AUTHTYPE auth_type;
|
|
u8 ch;
|
|
void *params;
|
|
};
|
|
|
|
struct rcvd_async_info {
|
|
u8 *buffer;
|
|
u32 len;
|
|
};
|
|
|
|
struct channel_attr {
|
|
u8 set_ch;
|
|
};
|
|
|
|
struct beacon_attr {
|
|
u32 interval;
|
|
u32 dtim_period;
|
|
u32 head_len;
|
|
u8 *head;
|
|
u32 tail_len;
|
|
u8 *tail;
|
|
};
|
|
|
|
struct set_multicast {
|
|
bool enabled;
|
|
u32 cnt;
|
|
};
|
|
|
|
struct del_all_sta {
|
|
u8 del_all_sta[MAX_NUM_STA][ETH_ALEN];
|
|
u8 assoc_sta;
|
|
};
|
|
|
|
struct del_sta {
|
|
u8 mac_addr[ETH_ALEN];
|
|
};
|
|
|
|
struct power_mgmt_param {
|
|
bool enabled;
|
|
u32 timeout;
|
|
};
|
|
|
|
struct set_ip_addr {
|
|
u8 *ip_addr;
|
|
u8 idx;
|
|
};
|
|
|
|
struct sta_inactive_t {
|
|
u8 mac[6];
|
|
};
|
|
|
|
struct tx_power {
|
|
u8 tx_pwr;
|
|
};
|
|
|
|
union message_body {
|
|
struct scan_attr scan_info;
|
|
struct connect_attr con_info;
|
|
struct rcvd_net_info net_info;
|
|
struct rcvd_async_info async_info;
|
|
struct key_attr key_info;
|
|
struct cfg_param_attr cfg_info;
|
|
struct channel_attr channel_info;
|
|
struct beacon_attr beacon_info;
|
|
struct add_sta_param add_sta_info;
|
|
struct del_sta del_sta_info;
|
|
struct add_sta_param edit_sta_info;
|
|
struct power_mgmt_param pwr_mgmt_info;
|
|
struct sta_inactive_t mac_info;
|
|
struct set_ip_addr ip_info;
|
|
struct drv_handler drv;
|
|
struct set_multicast multicast_info;
|
|
struct op_mode mode;
|
|
struct get_mac_addr get_mac_info;
|
|
struct ba_session_info session_info;
|
|
struct remain_ch remain_on_ch;
|
|
struct reg_frame reg_frame;
|
|
char *data;
|
|
struct del_all_sta del_all_sta_info;
|
|
struct tx_power tx_power;
|
|
};
|
|
|
|
struct host_if_msg {
|
|
u16 id;
|
|
union message_body body;
|
|
struct wilc_vif *vif;
|
|
struct work_struct work;
|
|
};
|
|
|
|
struct join_bss_param {
|
|
BSSTYPE_T bss_type;
|
|
u8 dtim_period;
|
|
u16 beacon_period;
|
|
u16 cap_info;
|
|
u8 bssid[6];
|
|
char ssid[MAX_SSID_LEN];
|
|
u8 ssid_len;
|
|
u8 supp_rates[MAX_RATES_SUPPORTED + 1];
|
|
u8 ht_capable;
|
|
u8 wmm_cap;
|
|
u8 uapsd_cap;
|
|
bool rsn_found;
|
|
u8 rsn_grp_policy;
|
|
u8 mode_802_11i;
|
|
u8 rsn_pcip_policy[3];
|
|
u8 rsn_auth_policy[3];
|
|
u8 rsn_cap[2];
|
|
u32 tsf;
|
|
u8 noa_enabled;
|
|
u8 opp_enabled;
|
|
u8 ct_window;
|
|
u8 cnt;
|
|
u8 idx;
|
|
u8 duration[4];
|
|
u8 interval[4];
|
|
u8 start_time[4];
|
|
};
|
|
|
|
static struct host_if_drv *terminated_handle;
|
|
bool wilc_optaining_ip;
|
|
static u8 P2P_LISTEN_STATE;
|
|
static struct workqueue_struct *hif_workqueue;
|
|
static struct completion hif_thread_comp;
|
|
static struct completion hif_driver_comp;
|
|
static struct completion hif_wait_response;
|
|
static struct mutex hif_deinit_lock;
|
|
static struct timer_list periodic_rssi;
|
|
|
|
u8 wilc_multicast_mac_addr_list[WILC_MULTICAST_TABLE_SIZE][ETH_ALEN];
|
|
|
|
static u8 rcv_assoc_resp[MAX_ASSOC_RESP_FRAME_SIZE];
|
|
|
|
static bool scan_while_connected;
|
|
|
|
static s8 rssi;
|
|
static u8 set_ip[2][4];
|
|
static u8 get_ip[2][4];
|
|
static u32 inactive_time;
|
|
static u8 del_beacon;
|
|
static u32 clients_count;
|
|
|
|
static u8 *join_req;
|
|
static u8 *info_element;
|
|
static u8 mode_11i;
|
|
static u8 auth_type;
|
|
static u32 join_req_size;
|
|
static u32 info_element_size;
|
|
static struct wilc_vif *join_req_vif;
|
|
#define REAL_JOIN_REQ 0
|
|
#define FLUSHED_JOIN_REQ 1
|
|
#define FLUSHED_BYTE_POS 79
|
|
|
|
static void *host_int_ParseJoinBssParam(struct network_info *ptstrNetworkInfo);
|
|
static int host_int_get_ipaddress(struct wilc_vif *vif, u8 *ip_addr, u8 idx);
|
|
static s32 Handle_ScanDone(struct wilc_vif *vif, enum scan_event enuEvent);
|
|
static void host_if_work(struct work_struct *work);
|
|
|
|
/*!
|
|
* @author syounan
|
|
* @date 1 Sep 2010
|
|
* @note copied from FLO glue implementatuion
|
|
* @version 1.0
|
|
*/
|
|
static int wilc_enqueue_cmd(struct host_if_msg *msg)
|
|
{
|
|
struct host_if_msg *new_msg;
|
|
|
|
new_msg = kmemdup(msg, sizeof(*new_msg), GFP_ATOMIC);
|
|
if (!new_msg)
|
|
return -ENOMEM;
|
|
|
|
INIT_WORK(&new_msg->work, host_if_work);
|
|
queue_work(hif_workqueue, &new_msg->work);
|
|
return 0;
|
|
}
|
|
|
|
/* The u8IfIdx starts from 0 to NUM_CONCURRENT_IFC -1, but 0 index used as
|
|
* special purpose in wilc device, so we add 1 to the index to starts from 1.
|
|
* As a result, the returned index will be 1 to NUM_CONCURRENT_IFC.
|
|
*/
|
|
int wilc_get_vif_idx(struct wilc_vif *vif)
|
|
{
|
|
return vif->idx + 1;
|
|
}
|
|
|
|
/* We need to minus 1 from idx which is from wilc device to get real index
|
|
* of wilc->vif[], because we add 1 when pass to wilc device in the function
|
|
* wilc_get_vif_idx.
|
|
* As a result, the index should be between 0 and NUM_CONCURRENT_IFC -1.
|
|
*/
|
|
static struct wilc_vif *wilc_get_vif_from_idx(struct wilc *wilc, int idx)
|
|
{
|
|
int index = idx - 1;
|
|
|
|
if (index < 0 || index >= NUM_CONCURRENT_IFC)
|
|
return NULL;
|
|
|
|
return wilc->vif[index];
|
|
}
|
|
|
|
static void handle_set_channel(struct wilc_vif *vif,
|
|
struct channel_attr *hif_set_ch)
|
|
{
|
|
int ret = 0;
|
|
struct wid wid;
|
|
|
|
wid.id = (u16)WID_CURRENT_CHANNEL;
|
|
wid.type = WID_CHAR;
|
|
wid.val = (char *)&hif_set_ch->set_ch;
|
|
wid.size = sizeof(char);
|
|
|
|
ret = wilc_send_config_pkt(vif, SET_CFG, &wid, 1,
|
|
wilc_get_vif_idx(vif));
|
|
|
|
if (ret)
|
|
netdev_err(vif->ndev, "Failed to set channel\n");
|
|
}
|
|
|
|
static int handle_set_wfi_drv_handler(struct wilc_vif *vif,
|
|
struct drv_handler *hif_drv_handler)
|
|
{
|
|
int ret = 0;
|
|
struct wid wid;
|
|
u8 *currbyte, *buffer;
|
|
struct host_if_drv *hif_drv = NULL;
|
|
|
|
if (!vif->hif_drv)
|
|
return -EINVAL;
|
|
|
|
if (!hif_drv_handler)
|
|
return -EINVAL;
|
|
|
|
hif_drv = vif->hif_drv;
|
|
|
|
buffer = kzalloc(DRV_HANDLER_SIZE, GFP_KERNEL);
|
|
if (!buffer)
|
|
return -ENOMEM;
|
|
|
|
currbyte = buffer;
|
|
*currbyte = hif_drv->driver_handler_id & DRV_HANDLER_MASK;
|
|
currbyte++;
|
|
*currbyte = (u32)0 & DRV_HANDLER_MASK;
|
|
currbyte++;
|
|
*currbyte = (u32)0 & DRV_HANDLER_MASK;
|
|
currbyte++;
|
|
*currbyte = (u32)0 & DRV_HANDLER_MASK;
|
|
currbyte++;
|
|
*currbyte = (hif_drv_handler->name | (hif_drv_handler->mode << 1));
|
|
|
|
wid.id = (u16)WID_SET_DRV_HANDLER;
|
|
wid.type = WID_STR;
|
|
wid.val = (s8 *)buffer;
|
|
wid.size = DRV_HANDLER_SIZE;
|
|
|
|
ret = wilc_send_config_pkt(vif, SET_CFG, &wid, 1,
|
|
hif_drv->driver_handler_id);
|
|
if (ret) {
|
|
netdev_err(vif->ndev, "Failed to set driver handler\n");
|
|
complete(&hif_driver_comp);
|
|
kfree(buffer);
|
|
return ret;
|
|
}
|
|
complete(&hif_driver_comp);
|
|
kfree(buffer);
|
|
return 0;
|
|
}
|
|
|
|
static void handle_set_operation_mode(struct wilc_vif *vif,
|
|
struct op_mode *hif_op_mode)
|
|
{
|
|
int ret = 0;
|
|
struct wid wid;
|
|
|
|
wid.id = (u16)WID_SET_OPERATION_MODE;
|
|
wid.type = WID_INT;
|
|
wid.val = (s8 *)&hif_op_mode->mode;
|
|
wid.size = sizeof(u32);
|
|
|
|
ret = wilc_send_config_pkt(vif, SET_CFG, &wid, 1,
|
|
wilc_get_vif_idx(vif));
|
|
|
|
if ((hif_op_mode->mode) == IDLE_MODE)
|
|
complete(&hif_driver_comp);
|
|
|
|
if (ret)
|
|
netdev_err(vif->ndev, "Failed to set driver handler\n");
|
|
}
|
|
|
|
static void handle_set_ip_address(struct wilc_vif *vif, u8 *ip_addr, u8 idx)
|
|
{
|
|
int ret = 0;
|
|
struct wid wid;
|
|
char firmware_ip_addr[4] = {0};
|
|
|
|
if (ip_addr[0] < 192)
|
|
ip_addr[0] = 0;
|
|
|
|
memcpy(set_ip[idx], ip_addr, IP_ALEN);
|
|
|
|
wid.id = (u16)WID_IP_ADDRESS;
|
|
wid.type = WID_STR;
|
|
wid.val = ip_addr;
|
|
wid.size = IP_ALEN;
|
|
|
|
ret = wilc_send_config_pkt(vif, SET_CFG, &wid, 1,
|
|
wilc_get_vif_idx(vif));
|
|
|
|
host_int_get_ipaddress(vif, firmware_ip_addr, idx);
|
|
|
|
if (ret)
|
|
netdev_err(vif->ndev, "Failed to set IP address\n");
|
|
}
|
|
|
|
static void handle_get_ip_address(struct wilc_vif *vif, u8 idx)
|
|
{
|
|
int ret = 0;
|
|
struct wid wid;
|
|
|
|
wid.id = (u16)WID_IP_ADDRESS;
|
|
wid.type = WID_STR;
|
|
wid.val = kmalloc(IP_ALEN, GFP_KERNEL);
|
|
wid.size = IP_ALEN;
|
|
|
|
ret = wilc_send_config_pkt(vif, GET_CFG, &wid, 1,
|
|
wilc_get_vif_idx(vif));
|
|
|
|
memcpy(get_ip[idx], wid.val, IP_ALEN);
|
|
|
|
kfree(wid.val);
|
|
|
|
if (memcmp(get_ip[idx], set_ip[idx], IP_ALEN) != 0)
|
|
wilc_setup_ipaddress(vif, set_ip[idx], idx);
|
|
|
|
if (ret)
|
|
netdev_err(vif->ndev, "Failed to get IP address\n");
|
|
}
|
|
|
|
static void handle_get_mac_address(struct wilc_vif *vif,
|
|
struct get_mac_addr *get_mac_addr)
|
|
{
|
|
int ret = 0;
|
|
struct wid wid;
|
|
|
|
wid.id = (u16)WID_MAC_ADDR;
|
|
wid.type = WID_STR;
|
|
wid.val = get_mac_addr->mac_addr;
|
|
wid.size = ETH_ALEN;
|
|
|
|
ret = wilc_send_config_pkt(vif, GET_CFG, &wid, 1,
|
|
wilc_get_vif_idx(vif));
|
|
|
|
if (ret)
|
|
netdev_err(vif->ndev, "Failed to get mac address\n");
|
|
complete(&hif_wait_response);
|
|
}
|
|
|
|
static void handle_cfg_param(struct wilc_vif *vif,
|
|
struct cfg_param_attr *cfg_param_attr)
|
|
{
|
|
int ret = 0;
|
|
struct wid wid_list[32];
|
|
struct host_if_drv *hif_drv = vif->hif_drv;
|
|
int i = 0;
|
|
|
|
mutex_lock(&hif_drv->cfg_values_lock);
|
|
|
|
if (cfg_param_attr->flag & BSS_TYPE) {
|
|
u8 bss_type = cfg_param_attr->bss_type;
|
|
|
|
if (bss_type < 6) {
|
|
wid_list[i].id = WID_BSS_TYPE;
|
|
wid_list[i].val = (s8 *)&bss_type;
|
|
wid_list[i].type = WID_CHAR;
|
|
wid_list[i].size = sizeof(char);
|
|
hif_drv->cfg_values.bss_type = bss_type;
|
|
} else {
|
|
netdev_err(vif->ndev, "check value 6 over\n");
|
|
goto unlock;
|
|
}
|
|
i++;
|
|
}
|
|
if (cfg_param_attr->flag & AUTH_TYPE) {
|
|
if (cfg_param_attr->auth_type == 1 ||
|
|
cfg_param_attr->auth_type == 2 ||
|
|
cfg_param_attr->auth_type == 5) {
|
|
wid_list[i].id = WID_AUTH_TYPE;
|
|
wid_list[i].val = (s8 *)&cfg_param_attr->auth_type;
|
|
wid_list[i].type = WID_CHAR;
|
|
wid_list[i].size = sizeof(char);
|
|
hif_drv->cfg_values.auth_type = (u8)cfg_param_attr->auth_type;
|
|
} else {
|
|
netdev_err(vif->ndev, "Impossible value\n");
|
|
goto unlock;
|
|
}
|
|
i++;
|
|
}
|
|
if (cfg_param_attr->flag & AUTHEN_TIMEOUT) {
|
|
if (cfg_param_attr->auth_timeout > 0 &&
|
|
cfg_param_attr->auth_timeout < 65536) {
|
|
wid_list[i].id = WID_AUTH_TIMEOUT;
|
|
wid_list[i].val = (s8 *)&cfg_param_attr->auth_timeout;
|
|
wid_list[i].type = WID_SHORT;
|
|
wid_list[i].size = sizeof(u16);
|
|
hif_drv->cfg_values.auth_timeout = cfg_param_attr->auth_timeout;
|
|
} else {
|
|
netdev_err(vif->ndev, "Range(1 ~ 65535) over\n");
|
|
goto unlock;
|
|
}
|
|
i++;
|
|
}
|
|
if (cfg_param_attr->flag & POWER_MANAGEMENT) {
|
|
if (cfg_param_attr->power_mgmt_mode < 5) {
|
|
wid_list[i].id = WID_POWER_MANAGEMENT;
|
|
wid_list[i].val = (s8 *)&cfg_param_attr->power_mgmt_mode;
|
|
wid_list[i].type = WID_CHAR;
|
|
wid_list[i].size = sizeof(char);
|
|
hif_drv->cfg_values.power_mgmt_mode = (u8)cfg_param_attr->power_mgmt_mode;
|
|
} else {
|
|
netdev_err(vif->ndev, "Invalid power mode\n");
|
|
goto unlock;
|
|
}
|
|
i++;
|
|
}
|
|
if (cfg_param_attr->flag & RETRY_SHORT) {
|
|
if (cfg_param_attr->short_retry_limit > 0 &&
|
|
cfg_param_attr->short_retry_limit < 256) {
|
|
wid_list[i].id = WID_SHORT_RETRY_LIMIT;
|
|
wid_list[i].val = (s8 *)&cfg_param_attr->short_retry_limit;
|
|
wid_list[i].type = WID_SHORT;
|
|
wid_list[i].size = sizeof(u16);
|
|
hif_drv->cfg_values.short_retry_limit = cfg_param_attr->short_retry_limit;
|
|
} else {
|
|
netdev_err(vif->ndev, "Range(1~256) over\n");
|
|
goto unlock;
|
|
}
|
|
i++;
|
|
}
|
|
if (cfg_param_attr->flag & RETRY_LONG) {
|
|
if (cfg_param_attr->long_retry_limit > 0 &&
|
|
cfg_param_attr->long_retry_limit < 256) {
|
|
wid_list[i].id = WID_LONG_RETRY_LIMIT;
|
|
wid_list[i].val = (s8 *)&cfg_param_attr->long_retry_limit;
|
|
wid_list[i].type = WID_SHORT;
|
|
wid_list[i].size = sizeof(u16);
|
|
hif_drv->cfg_values.long_retry_limit = cfg_param_attr->long_retry_limit;
|
|
} else {
|
|
netdev_err(vif->ndev, "Range(1~256) over\n");
|
|
goto unlock;
|
|
}
|
|
i++;
|
|
}
|
|
if (cfg_param_attr->flag & FRAG_THRESHOLD) {
|
|
if (cfg_param_attr->frag_threshold > 255 &&
|
|
cfg_param_attr->frag_threshold < 7937) {
|
|
wid_list[i].id = WID_FRAG_THRESHOLD;
|
|
wid_list[i].val = (s8 *)&cfg_param_attr->frag_threshold;
|
|
wid_list[i].type = WID_SHORT;
|
|
wid_list[i].size = sizeof(u16);
|
|
hif_drv->cfg_values.frag_threshold = cfg_param_attr->frag_threshold;
|
|
} else {
|
|
netdev_err(vif->ndev, "Threshold Range fail\n");
|
|
goto unlock;
|
|
}
|
|
i++;
|
|
}
|
|
if (cfg_param_attr->flag & RTS_THRESHOLD) {
|
|
if (cfg_param_attr->rts_threshold > 255 &&
|
|
cfg_param_attr->rts_threshold < 65536) {
|
|
wid_list[i].id = WID_RTS_THRESHOLD;
|
|
wid_list[i].val = (s8 *)&cfg_param_attr->rts_threshold;
|
|
wid_list[i].type = WID_SHORT;
|
|
wid_list[i].size = sizeof(u16);
|
|
hif_drv->cfg_values.rts_threshold = cfg_param_attr->rts_threshold;
|
|
} else {
|
|
netdev_err(vif->ndev, "Threshold Range fail\n");
|
|
goto unlock;
|
|
}
|
|
i++;
|
|
}
|
|
if (cfg_param_attr->flag & PREAMBLE) {
|
|
if (cfg_param_attr->preamble_type < 3) {
|
|
wid_list[i].id = WID_PREAMBLE;
|
|
wid_list[i].val = (s8 *)&cfg_param_attr->preamble_type;
|
|
wid_list[i].type = WID_CHAR;
|
|
wid_list[i].size = sizeof(char);
|
|
hif_drv->cfg_values.preamble_type = cfg_param_attr->preamble_type;
|
|
} else {
|
|
netdev_err(vif->ndev, "Preamle Range(0~2) over\n");
|
|
goto unlock;
|
|
}
|
|
i++;
|
|
}
|
|
if (cfg_param_attr->flag & SHORT_SLOT_ALLOWED) {
|
|
if (cfg_param_attr->short_slot_allowed < 2) {
|
|
wid_list[i].id = WID_SHORT_SLOT_ALLOWED;
|
|
wid_list[i].val = (s8 *)&cfg_param_attr->short_slot_allowed;
|
|
wid_list[i].type = WID_CHAR;
|
|
wid_list[i].size = sizeof(char);
|
|
hif_drv->cfg_values.short_slot_allowed = (u8)cfg_param_attr->short_slot_allowed;
|
|
} else {
|
|
netdev_err(vif->ndev, "Short slot(2) over\n");
|
|
goto unlock;
|
|
}
|
|
i++;
|
|
}
|
|
if (cfg_param_attr->flag & TXOP_PROT_DISABLE) {
|
|
if (cfg_param_attr->txop_prot_disabled < 2) {
|
|
wid_list[i].id = WID_11N_TXOP_PROT_DISABLE;
|
|
wid_list[i].val = (s8 *)&cfg_param_attr->txop_prot_disabled;
|
|
wid_list[i].type = WID_CHAR;
|
|
wid_list[i].size = sizeof(char);
|
|
hif_drv->cfg_values.txop_prot_disabled = (u8)cfg_param_attr->txop_prot_disabled;
|
|
} else {
|
|
netdev_err(vif->ndev, "TXOP prot disable\n");
|
|
goto unlock;
|
|
}
|
|
i++;
|
|
}
|
|
if (cfg_param_attr->flag & BEACON_INTERVAL) {
|
|
if (cfg_param_attr->beacon_interval > 0 &&
|
|
cfg_param_attr->beacon_interval < 65536) {
|
|
wid_list[i].id = WID_BEACON_INTERVAL;
|
|
wid_list[i].val = (s8 *)&cfg_param_attr->beacon_interval;
|
|
wid_list[i].type = WID_SHORT;
|
|
wid_list[i].size = sizeof(u16);
|
|
hif_drv->cfg_values.beacon_interval = cfg_param_attr->beacon_interval;
|
|
} else {
|
|
netdev_err(vif->ndev, "Beacon interval(1~65535)fail\n");
|
|
goto unlock;
|
|
}
|
|
i++;
|
|
}
|
|
if (cfg_param_attr->flag & DTIM_PERIOD) {
|
|
if (cfg_param_attr->dtim_period > 0 &&
|
|
cfg_param_attr->dtim_period < 256) {
|
|
wid_list[i].id = WID_DTIM_PERIOD;
|
|
wid_list[i].val = (s8 *)&cfg_param_attr->dtim_period;
|
|
wid_list[i].type = WID_CHAR;
|
|
wid_list[i].size = sizeof(char);
|
|
hif_drv->cfg_values.dtim_period = cfg_param_attr->dtim_period;
|
|
} else {
|
|
netdev_err(vif->ndev, "DTIM range(1~255) fail\n");
|
|
goto unlock;
|
|
}
|
|
i++;
|
|
}
|
|
if (cfg_param_attr->flag & SITE_SURVEY) {
|
|
if (cfg_param_attr->site_survey_enabled < 3) {
|
|
wid_list[i].id = WID_SITE_SURVEY;
|
|
wid_list[i].val = (s8 *)&cfg_param_attr->site_survey_enabled;
|
|
wid_list[i].type = WID_CHAR;
|
|
wid_list[i].size = sizeof(char);
|
|
hif_drv->cfg_values.site_survey_enabled = (u8)cfg_param_attr->site_survey_enabled;
|
|
} else {
|
|
netdev_err(vif->ndev, "Site survey disable\n");
|
|
goto unlock;
|
|
}
|
|
i++;
|
|
}
|
|
if (cfg_param_attr->flag & SITE_SURVEY_SCAN_TIME) {
|
|
if (cfg_param_attr->site_survey_scan_time > 0 &&
|
|
cfg_param_attr->site_survey_scan_time < 65536) {
|
|
wid_list[i].id = WID_SITE_SURVEY_SCAN_TIME;
|
|
wid_list[i].val = (s8 *)&cfg_param_attr->site_survey_scan_time;
|
|
wid_list[i].type = WID_SHORT;
|
|
wid_list[i].size = sizeof(u16);
|
|
hif_drv->cfg_values.site_survey_scan_time = cfg_param_attr->site_survey_scan_time;
|
|
} else {
|
|
netdev_err(vif->ndev, "Site scan time(1~65535) over\n");
|
|
goto unlock;
|
|
}
|
|
i++;
|
|
}
|
|
if (cfg_param_attr->flag & ACTIVE_SCANTIME) {
|
|
if (cfg_param_attr->active_scan_time > 0 &&
|
|
cfg_param_attr->active_scan_time < 65536) {
|
|
wid_list[i].id = WID_ACTIVE_SCAN_TIME;
|
|
wid_list[i].val = (s8 *)&cfg_param_attr->active_scan_time;
|
|
wid_list[i].type = WID_SHORT;
|
|
wid_list[i].size = sizeof(u16);
|
|
hif_drv->cfg_values.active_scan_time = cfg_param_attr->active_scan_time;
|
|
} else {
|
|
netdev_err(vif->ndev, "Active time(1~65535) over\n");
|
|
goto unlock;
|
|
}
|
|
i++;
|
|
}
|
|
if (cfg_param_attr->flag & PASSIVE_SCANTIME) {
|
|
if (cfg_param_attr->passive_scan_time > 0 &&
|
|
cfg_param_attr->passive_scan_time < 65536) {
|
|
wid_list[i].id = WID_PASSIVE_SCAN_TIME;
|
|
wid_list[i].val = (s8 *)&cfg_param_attr->passive_scan_time;
|
|
wid_list[i].type = WID_SHORT;
|
|
wid_list[i].size = sizeof(u16);
|
|
hif_drv->cfg_values.passive_scan_time = cfg_param_attr->passive_scan_time;
|
|
} else {
|
|
netdev_err(vif->ndev, "Passive time(1~65535) over\n");
|
|
goto unlock;
|
|
}
|
|
i++;
|
|
}
|
|
if (cfg_param_attr->flag & CURRENT_TX_RATE) {
|
|
enum CURRENT_TXRATE curr_tx_rate = cfg_param_attr->curr_tx_rate;
|
|
|
|
if (curr_tx_rate == AUTORATE || curr_tx_rate == MBPS_1 ||
|
|
curr_tx_rate == MBPS_2 || curr_tx_rate == MBPS_5_5 ||
|
|
curr_tx_rate == MBPS_11 || curr_tx_rate == MBPS_6 ||
|
|
curr_tx_rate == MBPS_9 || curr_tx_rate == MBPS_12 ||
|
|
curr_tx_rate == MBPS_18 || curr_tx_rate == MBPS_24 ||
|
|
curr_tx_rate == MBPS_36 || curr_tx_rate == MBPS_48 ||
|
|
curr_tx_rate == MBPS_54) {
|
|
wid_list[i].id = WID_CURRENT_TX_RATE;
|
|
wid_list[i].val = (s8 *)&curr_tx_rate;
|
|
wid_list[i].type = WID_SHORT;
|
|
wid_list[i].size = sizeof(u16);
|
|
hif_drv->cfg_values.curr_tx_rate = (u8)curr_tx_rate;
|
|
} else {
|
|
netdev_err(vif->ndev, "out of TX rate\n");
|
|
goto unlock;
|
|
}
|
|
i++;
|
|
}
|
|
|
|
ret = wilc_send_config_pkt(vif, SET_CFG, wid_list,
|
|
i, wilc_get_vif_idx(vif));
|
|
|
|
if (ret)
|
|
netdev_err(vif->ndev, "Error in setting CFG params\n");
|
|
|
|
unlock:
|
|
mutex_unlock(&hif_drv->cfg_values_lock);
|
|
}
|
|
|
|
static s32 handle_scan(struct wilc_vif *vif, struct scan_attr *scan_info)
|
|
{
|
|
s32 result = 0;
|
|
struct wid wid_list[5];
|
|
u32 index = 0;
|
|
u32 i;
|
|
u8 *buffer;
|
|
u8 valuesize = 0;
|
|
u8 *pu8HdnNtwrksWidVal = NULL;
|
|
struct host_if_drv *hif_drv = vif->hif_drv;
|
|
|
|
hif_drv->usr_scan_req.scan_result = scan_info->result;
|
|
hif_drv->usr_scan_req.arg = scan_info->arg;
|
|
|
|
if ((hif_drv->hif_state >= HOST_IF_SCANNING) &&
|
|
(hif_drv->hif_state < HOST_IF_CONNECTED)) {
|
|
netdev_err(vif->ndev, "Already scan\n");
|
|
result = -EBUSY;
|
|
goto ERRORHANDLER;
|
|
}
|
|
|
|
if (wilc_optaining_ip || wilc_connecting) {
|
|
netdev_err(vif->ndev, "Don't do obss scan\n");
|
|
result = -EBUSY;
|
|
goto ERRORHANDLER;
|
|
}
|
|
|
|
hif_drv->usr_scan_req.rcvd_ch_cnt = 0;
|
|
|
|
wid_list[index].id = (u16)WID_SSID_PROBE_REQ;
|
|
wid_list[index].type = WID_STR;
|
|
|
|
for (i = 0; i < scan_info->hidden_network.n_ssids; i++)
|
|
valuesize += ((scan_info->hidden_network.net_info[i].ssid_len) + 1);
|
|
pu8HdnNtwrksWidVal = kmalloc(valuesize + 1, GFP_KERNEL);
|
|
wid_list[index].val = pu8HdnNtwrksWidVal;
|
|
if (wid_list[index].val) {
|
|
buffer = wid_list[index].val;
|
|
|
|
*buffer++ = scan_info->hidden_network.n_ssids;
|
|
|
|
for (i = 0; i < scan_info->hidden_network.n_ssids; i++) {
|
|
*buffer++ = scan_info->hidden_network.net_info[i].ssid_len;
|
|
memcpy(buffer, scan_info->hidden_network.net_info[i].ssid, scan_info->hidden_network.net_info[i].ssid_len);
|
|
buffer += scan_info->hidden_network.net_info[i].ssid_len;
|
|
}
|
|
|
|
wid_list[index].size = (s32)(valuesize + 1);
|
|
index++;
|
|
}
|
|
|
|
wid_list[index].id = WID_INFO_ELEMENT_PROBE;
|
|
wid_list[index].type = WID_BIN_DATA;
|
|
wid_list[index].val = scan_info->ies;
|
|
wid_list[index].size = scan_info->ies_len;
|
|
index++;
|
|
|
|
wid_list[index].id = WID_SCAN_TYPE;
|
|
wid_list[index].type = WID_CHAR;
|
|
wid_list[index].size = sizeof(char);
|
|
wid_list[index].val = (s8 *)&scan_info->type;
|
|
index++;
|
|
|
|
wid_list[index].id = WID_SCAN_CHANNEL_LIST;
|
|
wid_list[index].type = WID_BIN_DATA;
|
|
|
|
if (scan_info->ch_freq_list &&
|
|
scan_info->ch_list_len > 0) {
|
|
int i;
|
|
|
|
for (i = 0; i < scan_info->ch_list_len; i++) {
|
|
if (scan_info->ch_freq_list[i] > 0)
|
|
scan_info->ch_freq_list[i] = scan_info->ch_freq_list[i] - 1;
|
|
}
|
|
}
|
|
|
|
wid_list[index].val = scan_info->ch_freq_list;
|
|
wid_list[index].size = scan_info->ch_list_len;
|
|
index++;
|
|
|
|
wid_list[index].id = WID_START_SCAN_REQ;
|
|
wid_list[index].type = WID_CHAR;
|
|
wid_list[index].size = sizeof(char);
|
|
wid_list[index].val = (s8 *)&scan_info->src;
|
|
index++;
|
|
|
|
if (hif_drv->hif_state == HOST_IF_CONNECTED)
|
|
scan_while_connected = true;
|
|
else if (hif_drv->hif_state == HOST_IF_IDLE)
|
|
scan_while_connected = false;
|
|
|
|
result = wilc_send_config_pkt(vif, SET_CFG, wid_list,
|
|
index,
|
|
wilc_get_vif_idx(vif));
|
|
|
|
if (result)
|
|
netdev_err(vif->ndev, "Failed to send scan parameters\n");
|
|
|
|
ERRORHANDLER:
|
|
if (result) {
|
|
del_timer(&hif_drv->scan_timer);
|
|
Handle_ScanDone(vif, SCAN_EVENT_ABORTED);
|
|
}
|
|
|
|
kfree(scan_info->ch_freq_list);
|
|
scan_info->ch_freq_list = NULL;
|
|
|
|
kfree(scan_info->ies);
|
|
scan_info->ies = NULL;
|
|
kfree(scan_info->hidden_network.net_info);
|
|
scan_info->hidden_network.net_info = NULL;
|
|
|
|
kfree(pu8HdnNtwrksWidVal);
|
|
|
|
return result;
|
|
}
|
|
|
|
static s32 Handle_ScanDone(struct wilc_vif *vif,
|
|
enum scan_event enuEvent)
|
|
{
|
|
s32 result = 0;
|
|
u8 u8abort_running_scan;
|
|
struct wid wid;
|
|
struct host_if_drv *hif_drv = vif->hif_drv;
|
|
|
|
if (enuEvent == SCAN_EVENT_ABORTED) {
|
|
u8abort_running_scan = 1;
|
|
wid.id = (u16)WID_ABORT_RUNNING_SCAN;
|
|
wid.type = WID_CHAR;
|
|
wid.val = (s8 *)&u8abort_running_scan;
|
|
wid.size = sizeof(char);
|
|
|
|
result = wilc_send_config_pkt(vif, SET_CFG, &wid, 1,
|
|
wilc_get_vif_idx(vif));
|
|
|
|
if (result) {
|
|
netdev_err(vif->ndev, "Failed to set abort running\n");
|
|
result = -EFAULT;
|
|
}
|
|
}
|
|
|
|
if (!hif_drv) {
|
|
netdev_err(vif->ndev, "Driver handler is NULL\n");
|
|
return result;
|
|
}
|
|
|
|
if (hif_drv->usr_scan_req.scan_result) {
|
|
hif_drv->usr_scan_req.scan_result(enuEvent, NULL,
|
|
hif_drv->usr_scan_req.arg, NULL);
|
|
hif_drv->usr_scan_req.scan_result = NULL;
|
|
}
|
|
|
|
return result;
|
|
}
|
|
|
|
u8 wilc_connected_ssid[6] = {0};
|
|
static s32 Handle_Connect(struct wilc_vif *vif,
|
|
struct connect_attr *pstrHostIFconnectAttr)
|
|
{
|
|
s32 result = 0;
|
|
struct wid strWIDList[8];
|
|
u32 u32WidsCount = 0, dummyval = 0;
|
|
u8 *pu8CurrByte = NULL;
|
|
struct join_bss_param *ptstrJoinBssParam;
|
|
struct host_if_drv *hif_drv = vif->hif_drv;
|
|
|
|
if (memcmp(pstrHostIFconnectAttr->bssid, wilc_connected_ssid, ETH_ALEN) == 0) {
|
|
result = 0;
|
|
netdev_err(vif->ndev, "Discard connect request\n");
|
|
return result;
|
|
}
|
|
|
|
ptstrJoinBssParam = pstrHostIFconnectAttr->params;
|
|
if (!ptstrJoinBssParam) {
|
|
netdev_err(vif->ndev, "Required BSSID not found\n");
|
|
result = -ENOENT;
|
|
goto ERRORHANDLER;
|
|
}
|
|
|
|
if (pstrHostIFconnectAttr->bssid) {
|
|
hif_drv->usr_conn_req.bssid = kmalloc(6, GFP_KERNEL);
|
|
memcpy(hif_drv->usr_conn_req.bssid, pstrHostIFconnectAttr->bssid, 6);
|
|
}
|
|
|
|
hif_drv->usr_conn_req.ssid_len = pstrHostIFconnectAttr->ssid_len;
|
|
if (pstrHostIFconnectAttr->ssid) {
|
|
hif_drv->usr_conn_req.ssid = kmalloc(pstrHostIFconnectAttr->ssid_len + 1, GFP_KERNEL);
|
|
memcpy(hif_drv->usr_conn_req.ssid,
|
|
pstrHostIFconnectAttr->ssid,
|
|
pstrHostIFconnectAttr->ssid_len);
|
|
hif_drv->usr_conn_req.ssid[pstrHostIFconnectAttr->ssid_len] = '\0';
|
|
}
|
|
|
|
hif_drv->usr_conn_req.ies_len = pstrHostIFconnectAttr->ies_len;
|
|
if (pstrHostIFconnectAttr->ies) {
|
|
hif_drv->usr_conn_req.ies = kmalloc(pstrHostIFconnectAttr->ies_len, GFP_KERNEL);
|
|
memcpy(hif_drv->usr_conn_req.ies,
|
|
pstrHostIFconnectAttr->ies,
|
|
pstrHostIFconnectAttr->ies_len);
|
|
}
|
|
|
|
hif_drv->usr_conn_req.security = pstrHostIFconnectAttr->security;
|
|
hif_drv->usr_conn_req.auth_type = pstrHostIFconnectAttr->auth_type;
|
|
hif_drv->usr_conn_req.conn_result = pstrHostIFconnectAttr->result;
|
|
hif_drv->usr_conn_req.arg = pstrHostIFconnectAttr->arg;
|
|
|
|
strWIDList[u32WidsCount].id = WID_SUCCESS_FRAME_COUNT;
|
|
strWIDList[u32WidsCount].type = WID_INT;
|
|
strWIDList[u32WidsCount].size = sizeof(u32);
|
|
strWIDList[u32WidsCount].val = (s8 *)(&(dummyval));
|
|
u32WidsCount++;
|
|
|
|
strWIDList[u32WidsCount].id = WID_RECEIVED_FRAGMENT_COUNT;
|
|
strWIDList[u32WidsCount].type = WID_INT;
|
|
strWIDList[u32WidsCount].size = sizeof(u32);
|
|
strWIDList[u32WidsCount].val = (s8 *)(&(dummyval));
|
|
u32WidsCount++;
|
|
|
|
strWIDList[u32WidsCount].id = WID_FAILED_COUNT;
|
|
strWIDList[u32WidsCount].type = WID_INT;
|
|
strWIDList[u32WidsCount].size = sizeof(u32);
|
|
strWIDList[u32WidsCount].val = (s8 *)(&(dummyval));
|
|
u32WidsCount++;
|
|
|
|
{
|
|
strWIDList[u32WidsCount].id = WID_INFO_ELEMENT_ASSOCIATE;
|
|
strWIDList[u32WidsCount].type = WID_BIN_DATA;
|
|
strWIDList[u32WidsCount].val = hif_drv->usr_conn_req.ies;
|
|
strWIDList[u32WidsCount].size = hif_drv->usr_conn_req.ies_len;
|
|
u32WidsCount++;
|
|
|
|
if (memcmp("DIRECT-", pstrHostIFconnectAttr->ssid, 7)) {
|
|
info_element_size = hif_drv->usr_conn_req.ies_len;
|
|
info_element = kmalloc(info_element_size, GFP_KERNEL);
|
|
memcpy(info_element, hif_drv->usr_conn_req.ies,
|
|
info_element_size);
|
|
}
|
|
}
|
|
strWIDList[u32WidsCount].id = (u16)WID_11I_MODE;
|
|
strWIDList[u32WidsCount].type = WID_CHAR;
|
|
strWIDList[u32WidsCount].size = sizeof(char);
|
|
strWIDList[u32WidsCount].val = (s8 *)&hif_drv->usr_conn_req.security;
|
|
u32WidsCount++;
|
|
|
|
if (memcmp("DIRECT-", pstrHostIFconnectAttr->ssid, 7))
|
|
mode_11i = hif_drv->usr_conn_req.security;
|
|
|
|
strWIDList[u32WidsCount].id = (u16)WID_AUTH_TYPE;
|
|
strWIDList[u32WidsCount].type = WID_CHAR;
|
|
strWIDList[u32WidsCount].size = sizeof(char);
|
|
strWIDList[u32WidsCount].val = (s8 *)&hif_drv->usr_conn_req.auth_type;
|
|
u32WidsCount++;
|
|
|
|
if (memcmp("DIRECT-", pstrHostIFconnectAttr->ssid, 7))
|
|
auth_type = (u8)hif_drv->usr_conn_req.auth_type;
|
|
|
|
strWIDList[u32WidsCount].id = (u16)WID_JOIN_REQ_EXTENDED;
|
|
strWIDList[u32WidsCount].type = WID_STR;
|
|
strWIDList[u32WidsCount].size = 112;
|
|
strWIDList[u32WidsCount].val = kmalloc(strWIDList[u32WidsCount].size, GFP_KERNEL);
|
|
|
|
if (memcmp("DIRECT-", pstrHostIFconnectAttr->ssid, 7)) {
|
|
join_req_size = strWIDList[u32WidsCount].size;
|
|
join_req = kmalloc(join_req_size, GFP_KERNEL);
|
|
}
|
|
if (!strWIDList[u32WidsCount].val) {
|
|
result = -EFAULT;
|
|
goto ERRORHANDLER;
|
|
}
|
|
|
|
pu8CurrByte = strWIDList[u32WidsCount].val;
|
|
|
|
if (pstrHostIFconnectAttr->ssid) {
|
|
memcpy(pu8CurrByte, pstrHostIFconnectAttr->ssid, pstrHostIFconnectAttr->ssid_len);
|
|
pu8CurrByte[pstrHostIFconnectAttr->ssid_len] = '\0';
|
|
}
|
|
pu8CurrByte += MAX_SSID_LEN;
|
|
*(pu8CurrByte++) = INFRASTRUCTURE;
|
|
|
|
if ((pstrHostIFconnectAttr->ch >= 1) && (pstrHostIFconnectAttr->ch <= 14)) {
|
|
*(pu8CurrByte++) = pstrHostIFconnectAttr->ch;
|
|
} else {
|
|
netdev_err(vif->ndev, "Channel out of range\n");
|
|
*(pu8CurrByte++) = 0xFF;
|
|
}
|
|
*(pu8CurrByte++) = (ptstrJoinBssParam->cap_info) & 0xFF;
|
|
*(pu8CurrByte++) = ((ptstrJoinBssParam->cap_info) >> 8) & 0xFF;
|
|
|
|
if (pstrHostIFconnectAttr->bssid)
|
|
memcpy(pu8CurrByte, pstrHostIFconnectAttr->bssid, 6);
|
|
pu8CurrByte += 6;
|
|
|
|
if (pstrHostIFconnectAttr->bssid)
|
|
memcpy(pu8CurrByte, pstrHostIFconnectAttr->bssid, 6);
|
|
pu8CurrByte += 6;
|
|
|
|
*(pu8CurrByte++) = (ptstrJoinBssParam->beacon_period) & 0xFF;
|
|
*(pu8CurrByte++) = ((ptstrJoinBssParam->beacon_period) >> 8) & 0xFF;
|
|
*(pu8CurrByte++) = ptstrJoinBssParam->dtim_period;
|
|
|
|
memcpy(pu8CurrByte, ptstrJoinBssParam->supp_rates, MAX_RATES_SUPPORTED + 1);
|
|
pu8CurrByte += (MAX_RATES_SUPPORTED + 1);
|
|
|
|
*(pu8CurrByte++) = ptstrJoinBssParam->wmm_cap;
|
|
*(pu8CurrByte++) = ptstrJoinBssParam->uapsd_cap;
|
|
|
|
*(pu8CurrByte++) = ptstrJoinBssParam->ht_capable;
|
|
hif_drv->usr_conn_req.ht_capable = ptstrJoinBssParam->ht_capable;
|
|
|
|
*(pu8CurrByte++) = ptstrJoinBssParam->rsn_found;
|
|
*(pu8CurrByte++) = ptstrJoinBssParam->rsn_grp_policy;
|
|
*(pu8CurrByte++) = ptstrJoinBssParam->mode_802_11i;
|
|
|
|
memcpy(pu8CurrByte, ptstrJoinBssParam->rsn_pcip_policy, sizeof(ptstrJoinBssParam->rsn_pcip_policy));
|
|
pu8CurrByte += sizeof(ptstrJoinBssParam->rsn_pcip_policy);
|
|
|
|
memcpy(pu8CurrByte, ptstrJoinBssParam->rsn_auth_policy, sizeof(ptstrJoinBssParam->rsn_auth_policy));
|
|
pu8CurrByte += sizeof(ptstrJoinBssParam->rsn_auth_policy);
|
|
|
|
memcpy(pu8CurrByte, ptstrJoinBssParam->rsn_cap, sizeof(ptstrJoinBssParam->rsn_cap));
|
|
pu8CurrByte += sizeof(ptstrJoinBssParam->rsn_cap);
|
|
|
|
*(pu8CurrByte++) = REAL_JOIN_REQ;
|
|
*(pu8CurrByte++) = ptstrJoinBssParam->noa_enabled;
|
|
|
|
if (ptstrJoinBssParam->noa_enabled) {
|
|
*(pu8CurrByte++) = (ptstrJoinBssParam->tsf) & 0xFF;
|
|
*(pu8CurrByte++) = ((ptstrJoinBssParam->tsf) >> 8) & 0xFF;
|
|
*(pu8CurrByte++) = ((ptstrJoinBssParam->tsf) >> 16) & 0xFF;
|
|
*(pu8CurrByte++) = ((ptstrJoinBssParam->tsf) >> 24) & 0xFF;
|
|
|
|
*(pu8CurrByte++) = ptstrJoinBssParam->opp_enabled;
|
|
*(pu8CurrByte++) = ptstrJoinBssParam->idx;
|
|
|
|
if (ptstrJoinBssParam->opp_enabled)
|
|
*(pu8CurrByte++) = ptstrJoinBssParam->ct_window;
|
|
|
|
*(pu8CurrByte++) = ptstrJoinBssParam->cnt;
|
|
|
|
memcpy(pu8CurrByte, ptstrJoinBssParam->duration, sizeof(ptstrJoinBssParam->duration));
|
|
pu8CurrByte += sizeof(ptstrJoinBssParam->duration);
|
|
|
|
memcpy(pu8CurrByte, ptstrJoinBssParam->interval, sizeof(ptstrJoinBssParam->interval));
|
|
pu8CurrByte += sizeof(ptstrJoinBssParam->interval);
|
|
|
|
memcpy(pu8CurrByte, ptstrJoinBssParam->start_time, sizeof(ptstrJoinBssParam->start_time));
|
|
pu8CurrByte += sizeof(ptstrJoinBssParam->start_time);
|
|
}
|
|
|
|
pu8CurrByte = strWIDList[u32WidsCount].val;
|
|
u32WidsCount++;
|
|
|
|
if (memcmp("DIRECT-", pstrHostIFconnectAttr->ssid, 7)) {
|
|
memcpy(join_req, pu8CurrByte, join_req_size);
|
|
join_req_vif = vif;
|
|
}
|
|
|
|
if (pstrHostIFconnectAttr->bssid)
|
|
memcpy(wilc_connected_ssid,
|
|
pstrHostIFconnectAttr->bssid, ETH_ALEN);
|
|
|
|
result = wilc_send_config_pkt(vif, SET_CFG, strWIDList,
|
|
u32WidsCount,
|
|
wilc_get_vif_idx(vif));
|
|
if (result) {
|
|
netdev_err(vif->ndev, "failed to send config packet\n");
|
|
result = -EFAULT;
|
|
goto ERRORHANDLER;
|
|
} else {
|
|
hif_drv->hif_state = HOST_IF_WAITING_CONN_RESP;
|
|
}
|
|
|
|
ERRORHANDLER:
|
|
if (result) {
|
|
struct connect_info strConnectInfo;
|
|
|
|
del_timer(&hif_drv->connect_timer);
|
|
|
|
memset(&strConnectInfo, 0, sizeof(struct connect_info));
|
|
|
|
if (pstrHostIFconnectAttr->result) {
|
|
if (pstrHostIFconnectAttr->bssid)
|
|
memcpy(strConnectInfo.bssid, pstrHostIFconnectAttr->bssid, 6);
|
|
|
|
if (pstrHostIFconnectAttr->ies) {
|
|
strConnectInfo.req_ies_len = pstrHostIFconnectAttr->ies_len;
|
|
strConnectInfo.req_ies = kmalloc(pstrHostIFconnectAttr->ies_len, GFP_KERNEL);
|
|
memcpy(strConnectInfo.req_ies,
|
|
pstrHostIFconnectAttr->ies,
|
|
pstrHostIFconnectAttr->ies_len);
|
|
}
|
|
|
|
pstrHostIFconnectAttr->result(CONN_DISCONN_EVENT_CONN_RESP,
|
|
&strConnectInfo,
|
|
MAC_DISCONNECTED,
|
|
NULL,
|
|
pstrHostIFconnectAttr->arg);
|
|
hif_drv->hif_state = HOST_IF_IDLE;
|
|
kfree(strConnectInfo.req_ies);
|
|
strConnectInfo.req_ies = NULL;
|
|
|
|
} else {
|
|
netdev_err(vif->ndev, "Connect callback is NULL\n");
|
|
}
|
|
}
|
|
|
|
kfree(pstrHostIFconnectAttr->bssid);
|
|
pstrHostIFconnectAttr->bssid = NULL;
|
|
|
|
kfree(pstrHostIFconnectAttr->ssid);
|
|
pstrHostIFconnectAttr->ssid = NULL;
|
|
|
|
kfree(pstrHostIFconnectAttr->ies);
|
|
pstrHostIFconnectAttr->ies = NULL;
|
|
|
|
kfree(pu8CurrByte);
|
|
return result;
|
|
}
|
|
|
|
static s32 Handle_ConnectTimeout(struct wilc_vif *vif)
|
|
{
|
|
s32 result = 0;
|
|
struct connect_info strConnectInfo;
|
|
struct wid wid;
|
|
u16 u16DummyReasonCode = 0;
|
|
struct host_if_drv *hif_drv = vif->hif_drv;
|
|
|
|
if (!hif_drv) {
|
|
netdev_err(vif->ndev, "Driver handler is NULL\n");
|
|
return result;
|
|
}
|
|
|
|
hif_drv->hif_state = HOST_IF_IDLE;
|
|
|
|
scan_while_connected = false;
|
|
|
|
memset(&strConnectInfo, 0, sizeof(struct connect_info));
|
|
|
|
if (hif_drv->usr_conn_req.conn_result) {
|
|
if (hif_drv->usr_conn_req.bssid) {
|
|
memcpy(strConnectInfo.bssid,
|
|
hif_drv->usr_conn_req.bssid, 6);
|
|
}
|
|
|
|
if (hif_drv->usr_conn_req.ies) {
|
|
strConnectInfo.req_ies_len = hif_drv->usr_conn_req.ies_len;
|
|
strConnectInfo.req_ies = kmalloc(hif_drv->usr_conn_req.ies_len, GFP_KERNEL);
|
|
memcpy(strConnectInfo.req_ies,
|
|
hif_drv->usr_conn_req.ies,
|
|
hif_drv->usr_conn_req.ies_len);
|
|
}
|
|
|
|
hif_drv->usr_conn_req.conn_result(CONN_DISCONN_EVENT_CONN_RESP,
|
|
&strConnectInfo,
|
|
MAC_DISCONNECTED,
|
|
NULL,
|
|
hif_drv->usr_conn_req.arg);
|
|
|
|
kfree(strConnectInfo.req_ies);
|
|
strConnectInfo.req_ies = NULL;
|
|
} else {
|
|
netdev_err(vif->ndev, "Connect callback is NULL\n");
|
|
}
|
|
|
|
wid.id = (u16)WID_DISCONNECT;
|
|
wid.type = WID_CHAR;
|
|
wid.val = (s8 *)&u16DummyReasonCode;
|
|
wid.size = sizeof(char);
|
|
|
|
result = wilc_send_config_pkt(vif, SET_CFG, &wid, 1,
|
|
wilc_get_vif_idx(vif));
|
|
if (result)
|
|
netdev_err(vif->ndev, "Failed to send disconnect\n");
|
|
|
|
hif_drv->usr_conn_req.ssid_len = 0;
|
|
kfree(hif_drv->usr_conn_req.ssid);
|
|
hif_drv->usr_conn_req.ssid = NULL;
|
|
kfree(hif_drv->usr_conn_req.bssid);
|
|
hif_drv->usr_conn_req.bssid = NULL;
|
|
hif_drv->usr_conn_req.ies_len = 0;
|
|
kfree(hif_drv->usr_conn_req.ies);
|
|
hif_drv->usr_conn_req.ies = NULL;
|
|
|
|
eth_zero_addr(wilc_connected_ssid);
|
|
|
|
if (join_req && join_req_vif == vif) {
|
|
kfree(join_req);
|
|
join_req = NULL;
|
|
}
|
|
|
|
if (info_element && join_req_vif == vif) {
|
|
kfree(info_element);
|
|
info_element = NULL;
|
|
}
|
|
|
|
return result;
|
|
}
|
|
|
|
static s32 Handle_RcvdNtwrkInfo(struct wilc_vif *vif,
|
|
struct rcvd_net_info *pstrRcvdNetworkInfo)
|
|
{
|
|
u32 i;
|
|
bool bNewNtwrkFound;
|
|
s32 result = 0;
|
|
struct network_info *pstrNetworkInfo = NULL;
|
|
void *pJoinParams = NULL;
|
|
struct host_if_drv *hif_drv = vif->hif_drv;
|
|
|
|
bNewNtwrkFound = true;
|
|
|
|
if (hif_drv->usr_scan_req.scan_result) {
|
|
wilc_parse_network_info(pstrRcvdNetworkInfo->buffer, &pstrNetworkInfo);
|
|
if ((!pstrNetworkInfo) ||
|
|
(!hif_drv->usr_scan_req.scan_result)) {
|
|
netdev_err(vif->ndev, "driver is null\n");
|
|
result = -EINVAL;
|
|
goto done;
|
|
}
|
|
|
|
for (i = 0; i < hif_drv->usr_scan_req.rcvd_ch_cnt; i++) {
|
|
if (memcmp(hif_drv->usr_scan_req.net_info[i].bssid,
|
|
pstrNetworkInfo->bssid, 6) == 0) {
|
|
if (pstrNetworkInfo->rssi <= hif_drv->usr_scan_req.net_info[i].rssi) {
|
|
goto done;
|
|
} else {
|
|
hif_drv->usr_scan_req.net_info[i].rssi = pstrNetworkInfo->rssi;
|
|
bNewNtwrkFound = false;
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
if (bNewNtwrkFound) {
|
|
if (hif_drv->usr_scan_req.rcvd_ch_cnt < MAX_NUM_SCANNED_NETWORKS) {
|
|
hif_drv->usr_scan_req.net_info[hif_drv->usr_scan_req.rcvd_ch_cnt].rssi = pstrNetworkInfo->rssi;
|
|
|
|
memcpy(hif_drv->usr_scan_req.net_info[hif_drv->usr_scan_req.rcvd_ch_cnt].bssid,
|
|
pstrNetworkInfo->bssid, 6);
|
|
|
|
hif_drv->usr_scan_req.rcvd_ch_cnt++;
|
|
|
|
pstrNetworkInfo->new_network = true;
|
|
pJoinParams = host_int_ParseJoinBssParam(pstrNetworkInfo);
|
|
|
|
hif_drv->usr_scan_req.scan_result(SCAN_EVENT_NETWORK_FOUND, pstrNetworkInfo,
|
|
hif_drv->usr_scan_req.arg,
|
|
pJoinParams);
|
|
}
|
|
} else {
|
|
pstrNetworkInfo->new_network = false;
|
|
hif_drv->usr_scan_req.scan_result(SCAN_EVENT_NETWORK_FOUND, pstrNetworkInfo,
|
|
hif_drv->usr_scan_req.arg, NULL);
|
|
}
|
|
}
|
|
|
|
done:
|
|
kfree(pstrRcvdNetworkInfo->buffer);
|
|
pstrRcvdNetworkInfo->buffer = NULL;
|
|
|
|
if (pstrNetworkInfo) {
|
|
kfree(pstrNetworkInfo->ies);
|
|
kfree(pstrNetworkInfo);
|
|
}
|
|
|
|
return result;
|
|
}
|
|
|
|
static s32 host_int_get_assoc_res_info(struct wilc_vif *vif,
|
|
u8 *pu8AssocRespInfo,
|
|
u32 u32MaxAssocRespInfoLen,
|
|
u32 *pu32RcvdAssocRespInfoLen);
|
|
|
|
static s32 Handle_RcvdGnrlAsyncInfo(struct wilc_vif *vif,
|
|
struct rcvd_async_info *pstrRcvdGnrlAsyncInfo)
|
|
{
|
|
s32 result = 0;
|
|
u8 u8MsgType = 0;
|
|
u8 u8MsgID = 0;
|
|
u16 u16MsgLen = 0;
|
|
u16 u16WidID = (u16)WID_NIL;
|
|
u8 u8WidLen = 0;
|
|
u8 u8MacStatus;
|
|
u8 u8MacStatusReasonCode;
|
|
u8 u8MacStatusAdditionalInfo;
|
|
struct connect_info strConnectInfo;
|
|
struct disconnect_info strDisconnectNotifInfo;
|
|
s32 s32Err = 0;
|
|
struct host_if_drv *hif_drv = vif->hif_drv;
|
|
|
|
if (!hif_drv) {
|
|
netdev_err(vif->ndev, "Driver handler is NULL\n");
|
|
return -ENODEV;
|
|
}
|
|
|
|
if ((hif_drv->hif_state == HOST_IF_WAITING_CONN_RESP) ||
|
|
(hif_drv->hif_state == HOST_IF_CONNECTED) ||
|
|
hif_drv->usr_scan_req.scan_result) {
|
|
if (!pstrRcvdGnrlAsyncInfo->buffer ||
|
|
!hif_drv->usr_conn_req.conn_result) {
|
|
netdev_err(vif->ndev, "driver is null\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
u8MsgType = pstrRcvdGnrlAsyncInfo->buffer[0];
|
|
|
|
if ('I' != u8MsgType) {
|
|
netdev_err(vif->ndev, "Received Message incorrect.\n");
|
|
return -EFAULT;
|
|
}
|
|
|
|
u8MsgID = pstrRcvdGnrlAsyncInfo->buffer[1];
|
|
u16MsgLen = MAKE_WORD16(pstrRcvdGnrlAsyncInfo->buffer[2], pstrRcvdGnrlAsyncInfo->buffer[3]);
|
|
u16WidID = MAKE_WORD16(pstrRcvdGnrlAsyncInfo->buffer[4], pstrRcvdGnrlAsyncInfo->buffer[5]);
|
|
u8WidLen = pstrRcvdGnrlAsyncInfo->buffer[6];
|
|
u8MacStatus = pstrRcvdGnrlAsyncInfo->buffer[7];
|
|
u8MacStatusReasonCode = pstrRcvdGnrlAsyncInfo->buffer[8];
|
|
u8MacStatusAdditionalInfo = pstrRcvdGnrlAsyncInfo->buffer[9];
|
|
if (hif_drv->hif_state == HOST_IF_WAITING_CONN_RESP) {
|
|
u32 u32RcvdAssocRespInfoLen = 0;
|
|
struct connect_resp_info *pstrConnectRespInfo = NULL;
|
|
|
|
memset(&strConnectInfo, 0, sizeof(struct connect_info));
|
|
|
|
if (u8MacStatus == MAC_CONNECTED) {
|
|
memset(rcv_assoc_resp, 0, MAX_ASSOC_RESP_FRAME_SIZE);
|
|
|
|
host_int_get_assoc_res_info(vif,
|
|
rcv_assoc_resp,
|
|
MAX_ASSOC_RESP_FRAME_SIZE,
|
|
&u32RcvdAssocRespInfoLen);
|
|
|
|
if (u32RcvdAssocRespInfoLen != 0) {
|
|
s32Err = wilc_parse_assoc_resp_info(rcv_assoc_resp, u32RcvdAssocRespInfoLen,
|
|
&pstrConnectRespInfo);
|
|
if (s32Err) {
|
|
netdev_err(vif->ndev, "wilc_parse_assoc_resp_info() returned error %d\n", s32Err);
|
|
} else {
|
|
strConnectInfo.status = pstrConnectRespInfo->status;
|
|
|
|
if (strConnectInfo.status == SUCCESSFUL_STATUSCODE && pstrConnectRespInfo->ies) {
|
|
strConnectInfo.resp_ies_len = pstrConnectRespInfo->ies_len;
|
|
strConnectInfo.resp_ies = kmalloc(pstrConnectRespInfo->ies_len, GFP_KERNEL);
|
|
memcpy(strConnectInfo.resp_ies, pstrConnectRespInfo->ies,
|
|
pstrConnectRespInfo->ies_len);
|
|
}
|
|
|
|
if (pstrConnectRespInfo) {
|
|
kfree(pstrConnectRespInfo->ies);
|
|
kfree(pstrConnectRespInfo);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
if ((u8MacStatus == MAC_CONNECTED) &&
|
|
(strConnectInfo.status != SUCCESSFUL_STATUSCODE)) {
|
|
netdev_err(vif->ndev, "Received MAC status is MAC_CONNECTED while the received status code in Asoc Resp is not SUCCESSFUL_STATUSCODE\n");
|
|
eth_zero_addr(wilc_connected_ssid);
|
|
} else if (u8MacStatus == MAC_DISCONNECTED) {
|
|
netdev_err(vif->ndev, "Received MAC status is MAC_DISCONNECTED\n");
|
|
eth_zero_addr(wilc_connected_ssid);
|
|
}
|
|
|
|
if (hif_drv->usr_conn_req.bssid) {
|
|
memcpy(strConnectInfo.bssid, hif_drv->usr_conn_req.bssid, 6);
|
|
|
|
if ((u8MacStatus == MAC_CONNECTED) &&
|
|
(strConnectInfo.status == SUCCESSFUL_STATUSCODE)) {
|
|
memcpy(hif_drv->assoc_bssid,
|
|
hif_drv->usr_conn_req.bssid, ETH_ALEN);
|
|
}
|
|
}
|
|
|
|
if (hif_drv->usr_conn_req.ies) {
|
|
strConnectInfo.req_ies_len = hif_drv->usr_conn_req.ies_len;
|
|
strConnectInfo.req_ies = kmalloc(hif_drv->usr_conn_req.ies_len, GFP_KERNEL);
|
|
memcpy(strConnectInfo.req_ies,
|
|
hif_drv->usr_conn_req.ies,
|
|
hif_drv->usr_conn_req.ies_len);
|
|
}
|
|
|
|
del_timer(&hif_drv->connect_timer);
|
|
hif_drv->usr_conn_req.conn_result(CONN_DISCONN_EVENT_CONN_RESP,
|
|
&strConnectInfo,
|
|
u8MacStatus,
|
|
NULL,
|
|
hif_drv->usr_conn_req.arg);
|
|
|
|
if ((u8MacStatus == MAC_CONNECTED) &&
|
|
(strConnectInfo.status == SUCCESSFUL_STATUSCODE)) {
|
|
wilc_set_power_mgmt(vif, 0, 0);
|
|
|
|
hif_drv->hif_state = HOST_IF_CONNECTED;
|
|
|
|
wilc_optaining_ip = true;
|
|
mod_timer(&wilc_during_ip_timer,
|
|
jiffies + msecs_to_jiffies(10000));
|
|
} else {
|
|
hif_drv->hif_state = HOST_IF_IDLE;
|
|
scan_while_connected = false;
|
|
}
|
|
|
|
kfree(strConnectInfo.resp_ies);
|
|
strConnectInfo.resp_ies = NULL;
|
|
|
|
kfree(strConnectInfo.req_ies);
|
|
strConnectInfo.req_ies = NULL;
|
|
hif_drv->usr_conn_req.ssid_len = 0;
|
|
kfree(hif_drv->usr_conn_req.ssid);
|
|
hif_drv->usr_conn_req.ssid = NULL;
|
|
kfree(hif_drv->usr_conn_req.bssid);
|
|
hif_drv->usr_conn_req.bssid = NULL;
|
|
hif_drv->usr_conn_req.ies_len = 0;
|
|
kfree(hif_drv->usr_conn_req.ies);
|
|
hif_drv->usr_conn_req.ies = NULL;
|
|
} else if ((u8MacStatus == MAC_DISCONNECTED) &&
|
|
(hif_drv->hif_state == HOST_IF_CONNECTED)) {
|
|
memset(&strDisconnectNotifInfo, 0, sizeof(struct disconnect_info));
|
|
|
|
if (hif_drv->usr_scan_req.scan_result) {
|
|
del_timer(&hif_drv->scan_timer);
|
|
Handle_ScanDone(vif, SCAN_EVENT_ABORTED);
|
|
}
|
|
|
|
strDisconnectNotifInfo.reason = 0;
|
|
strDisconnectNotifInfo.ie = NULL;
|
|
strDisconnectNotifInfo.ie_len = 0;
|
|
|
|
if (hif_drv->usr_conn_req.conn_result) {
|
|
wilc_optaining_ip = false;
|
|
wilc_set_power_mgmt(vif, 0, 0);
|
|
|
|
hif_drv->usr_conn_req.conn_result(CONN_DISCONN_EVENT_DISCONN_NOTIF,
|
|
NULL,
|
|
0,
|
|
&strDisconnectNotifInfo,
|
|
hif_drv->usr_conn_req.arg);
|
|
} else {
|
|
netdev_err(vif->ndev, "Connect result NULL\n");
|
|
}
|
|
|
|
eth_zero_addr(hif_drv->assoc_bssid);
|
|
|
|
hif_drv->usr_conn_req.ssid_len = 0;
|
|
kfree(hif_drv->usr_conn_req.ssid);
|
|
hif_drv->usr_conn_req.ssid = NULL;
|
|
kfree(hif_drv->usr_conn_req.bssid);
|
|
hif_drv->usr_conn_req.bssid = NULL;
|
|
hif_drv->usr_conn_req.ies_len = 0;
|
|
kfree(hif_drv->usr_conn_req.ies);
|
|
hif_drv->usr_conn_req.ies = NULL;
|
|
|
|
if (join_req && join_req_vif == vif) {
|
|
kfree(join_req);
|
|
join_req = NULL;
|
|
}
|
|
|
|
if (info_element && join_req_vif == vif) {
|
|
kfree(info_element);
|
|
info_element = NULL;
|
|
}
|
|
|
|
hif_drv->hif_state = HOST_IF_IDLE;
|
|
scan_while_connected = false;
|
|
|
|
} else if ((u8MacStatus == MAC_DISCONNECTED) &&
|
|
(hif_drv->usr_scan_req.scan_result)) {
|
|
del_timer(&hif_drv->scan_timer);
|
|
if (hif_drv->usr_scan_req.scan_result)
|
|
Handle_ScanDone(vif, SCAN_EVENT_ABORTED);
|
|
}
|
|
}
|
|
|
|
kfree(pstrRcvdGnrlAsyncInfo->buffer);
|
|
pstrRcvdGnrlAsyncInfo->buffer = NULL;
|
|
|
|
return result;
|
|
}
|
|
|
|
static int Handle_Key(struct wilc_vif *vif,
|
|
struct key_attr *pstrHostIFkeyAttr)
|
|
{
|
|
s32 result = 0;
|
|
struct wid wid;
|
|
struct wid strWIDList[5];
|
|
u8 i;
|
|
u8 *pu8keybuf;
|
|
s8 s8idxarray[1];
|
|
s8 ret = 0;
|
|
struct host_if_drv *hif_drv = vif->hif_drv;
|
|
|
|
switch (pstrHostIFkeyAttr->type) {
|
|
case WEP:
|
|
|
|
if (pstrHostIFkeyAttr->action & ADDKEY_AP) {
|
|
strWIDList[0].id = (u16)WID_11I_MODE;
|
|
strWIDList[0].type = WID_CHAR;
|
|
strWIDList[0].size = sizeof(char);
|
|
strWIDList[0].val = (s8 *)&pstrHostIFkeyAttr->attr.wep.mode;
|
|
|
|
strWIDList[1].id = WID_AUTH_TYPE;
|
|
strWIDList[1].type = WID_CHAR;
|
|
strWIDList[1].size = sizeof(char);
|
|
strWIDList[1].val = (s8 *)&pstrHostIFkeyAttr->attr.wep.auth_type;
|
|
|
|
pu8keybuf = kmalloc(pstrHostIFkeyAttr->attr.wep.key_len + 2,
|
|
GFP_KERNEL);
|
|
if (!pu8keybuf)
|
|
return -ENOMEM;
|
|
|
|
pu8keybuf[0] = pstrHostIFkeyAttr->attr.wep.index;
|
|
pu8keybuf[1] = pstrHostIFkeyAttr->attr.wep.key_len;
|
|
|
|
memcpy(&pu8keybuf[2], pstrHostIFkeyAttr->attr.wep.key,
|
|
pstrHostIFkeyAttr->attr.wep.key_len);
|
|
|
|
kfree(pstrHostIFkeyAttr->attr.wep.key);
|
|
|
|
strWIDList[2].id = (u16)WID_WEP_KEY_VALUE;
|
|
strWIDList[2].type = WID_STR;
|
|
strWIDList[2].size = pstrHostIFkeyAttr->attr.wep.key_len + 2;
|
|
strWIDList[2].val = (s8 *)pu8keybuf;
|
|
|
|
result = wilc_send_config_pkt(vif, SET_CFG,
|
|
strWIDList, 3,
|
|
wilc_get_vif_idx(vif));
|
|
kfree(pu8keybuf);
|
|
} else if (pstrHostIFkeyAttr->action & ADDKEY) {
|
|
pu8keybuf = kmalloc(pstrHostIFkeyAttr->attr.wep.key_len + 2, GFP_KERNEL);
|
|
if (!pu8keybuf)
|
|
return -ENOMEM;
|
|
pu8keybuf[0] = pstrHostIFkeyAttr->attr.wep.index;
|
|
memcpy(pu8keybuf + 1, &pstrHostIFkeyAttr->attr.wep.key_len, 1);
|
|
memcpy(pu8keybuf + 2, pstrHostIFkeyAttr->attr.wep.key,
|
|
pstrHostIFkeyAttr->attr.wep.key_len);
|
|
kfree(pstrHostIFkeyAttr->attr.wep.key);
|
|
|
|
wid.id = (u16)WID_ADD_WEP_KEY;
|
|
wid.type = WID_STR;
|
|
wid.val = (s8 *)pu8keybuf;
|
|
wid.size = pstrHostIFkeyAttr->attr.wep.key_len + 2;
|
|
|
|
result = wilc_send_config_pkt(vif, SET_CFG,
|
|
&wid, 1,
|
|
wilc_get_vif_idx(vif));
|
|
kfree(pu8keybuf);
|
|
} else if (pstrHostIFkeyAttr->action & REMOVEKEY) {
|
|
wid.id = (u16)WID_REMOVE_WEP_KEY;
|
|
wid.type = WID_STR;
|
|
|
|
s8idxarray[0] = (s8)pstrHostIFkeyAttr->attr.wep.index;
|
|
wid.val = s8idxarray;
|
|
wid.size = 1;
|
|
|
|
result = wilc_send_config_pkt(vif, SET_CFG,
|
|
&wid, 1,
|
|
wilc_get_vif_idx(vif));
|
|
} else if (pstrHostIFkeyAttr->action & DEFAULTKEY) {
|
|
wid.id = (u16)WID_KEY_ID;
|
|
wid.type = WID_CHAR;
|
|
wid.val = (s8 *)&pstrHostIFkeyAttr->attr.wep.index;
|
|
wid.size = sizeof(char);
|
|
|
|
result = wilc_send_config_pkt(vif, SET_CFG,
|
|
&wid, 1,
|
|
wilc_get_vif_idx(vif));
|
|
}
|
|
complete(&hif_drv->comp_test_key_block);
|
|
break;
|
|
|
|
case WPA_RX_GTK:
|
|
if (pstrHostIFkeyAttr->action & ADDKEY_AP) {
|
|
pu8keybuf = kzalloc(RX_MIC_KEY_MSG_LEN, GFP_KERNEL);
|
|
if (!pu8keybuf) {
|
|
ret = -ENOMEM;
|
|
goto _WPARxGtk_end_case_;
|
|
}
|
|
|
|
if (pstrHostIFkeyAttr->attr.wpa.seq)
|
|
memcpy(pu8keybuf + 6, pstrHostIFkeyAttr->attr.wpa.seq, 8);
|
|
|
|
memcpy(pu8keybuf + 14, &pstrHostIFkeyAttr->attr.wpa.index, 1);
|
|
memcpy(pu8keybuf + 15, &pstrHostIFkeyAttr->attr.wpa.key_len, 1);
|
|
memcpy(pu8keybuf + 16, pstrHostIFkeyAttr->attr.wpa.key,
|
|
pstrHostIFkeyAttr->attr.wpa.key_len);
|
|
|
|
strWIDList[0].id = (u16)WID_11I_MODE;
|
|
strWIDList[0].type = WID_CHAR;
|
|
strWIDList[0].size = sizeof(char);
|
|
strWIDList[0].val = (s8 *)&pstrHostIFkeyAttr->attr.wpa.mode;
|
|
|
|
strWIDList[1].id = (u16)WID_ADD_RX_GTK;
|
|
strWIDList[1].type = WID_STR;
|
|
strWIDList[1].val = (s8 *)pu8keybuf;
|
|
strWIDList[1].size = RX_MIC_KEY_MSG_LEN;
|
|
|
|
result = wilc_send_config_pkt(vif, SET_CFG,
|
|
strWIDList, 2,
|
|
wilc_get_vif_idx(vif));
|
|
|
|
kfree(pu8keybuf);
|
|
complete(&hif_drv->comp_test_key_block);
|
|
} else if (pstrHostIFkeyAttr->action & ADDKEY) {
|
|
pu8keybuf = kzalloc(RX_MIC_KEY_MSG_LEN, GFP_KERNEL);
|
|
if (!pu8keybuf) {
|
|
ret = -ENOMEM;
|
|
goto _WPARxGtk_end_case_;
|
|
}
|
|
|
|
if (hif_drv->hif_state == HOST_IF_CONNECTED)
|
|
memcpy(pu8keybuf, hif_drv->assoc_bssid, ETH_ALEN);
|
|
else
|
|
netdev_err(vif->ndev, "Couldn't handle\n");
|
|
|
|
memcpy(pu8keybuf + 6, pstrHostIFkeyAttr->attr.wpa.seq, 8);
|
|
memcpy(pu8keybuf + 14, &pstrHostIFkeyAttr->attr.wpa.index, 1);
|
|
memcpy(pu8keybuf + 15, &pstrHostIFkeyAttr->attr.wpa.key_len, 1);
|
|
memcpy(pu8keybuf + 16, pstrHostIFkeyAttr->attr.wpa.key,
|
|
pstrHostIFkeyAttr->attr.wpa.key_len);
|
|
|
|
wid.id = (u16)WID_ADD_RX_GTK;
|
|
wid.type = WID_STR;
|
|
wid.val = (s8 *)pu8keybuf;
|
|
wid.size = RX_MIC_KEY_MSG_LEN;
|
|
|
|
result = wilc_send_config_pkt(vif, SET_CFG,
|
|
&wid, 1,
|
|
wilc_get_vif_idx(vif));
|
|
|
|
kfree(pu8keybuf);
|
|
complete(&hif_drv->comp_test_key_block);
|
|
}
|
|
_WPARxGtk_end_case_:
|
|
kfree(pstrHostIFkeyAttr->attr.wpa.key);
|
|
kfree(pstrHostIFkeyAttr->attr.wpa.seq);
|
|
if (ret)
|
|
return ret;
|
|
|
|
break;
|
|
|
|
case WPA_PTK:
|
|
if (pstrHostIFkeyAttr->action & ADDKEY_AP) {
|
|
pu8keybuf = kmalloc(PTK_KEY_MSG_LEN + 1, GFP_KERNEL);
|
|
if (!pu8keybuf) {
|
|
ret = -ENOMEM;
|
|
goto _WPAPtk_end_case_;
|
|
}
|
|
|
|
memcpy(pu8keybuf, pstrHostIFkeyAttr->attr.wpa.mac_addr, 6);
|
|
memcpy(pu8keybuf + 6, &pstrHostIFkeyAttr->attr.wpa.index, 1);
|
|
memcpy(pu8keybuf + 7, &pstrHostIFkeyAttr->attr.wpa.key_len, 1);
|
|
memcpy(pu8keybuf + 8, pstrHostIFkeyAttr->attr.wpa.key,
|
|
pstrHostIFkeyAttr->attr.wpa.key_len);
|
|
|
|
strWIDList[0].id = (u16)WID_11I_MODE;
|
|
strWIDList[0].type = WID_CHAR;
|
|
strWIDList[0].size = sizeof(char);
|
|
strWIDList[0].val = (s8 *)&pstrHostIFkeyAttr->attr.wpa.mode;
|
|
|
|
strWIDList[1].id = (u16)WID_ADD_PTK;
|
|
strWIDList[1].type = WID_STR;
|
|
strWIDList[1].val = (s8 *)pu8keybuf;
|
|
strWIDList[1].size = PTK_KEY_MSG_LEN + 1;
|
|
|
|
result = wilc_send_config_pkt(vif, SET_CFG,
|
|
strWIDList, 2,
|
|
wilc_get_vif_idx(vif));
|
|
kfree(pu8keybuf);
|
|
complete(&hif_drv->comp_test_key_block);
|
|
} else if (pstrHostIFkeyAttr->action & ADDKEY) {
|
|
pu8keybuf = kmalloc(PTK_KEY_MSG_LEN, GFP_KERNEL);
|
|
if (!pu8keybuf) {
|
|
netdev_err(vif->ndev, "No buffer send PTK\n");
|
|
ret = -ENOMEM;
|
|
goto _WPAPtk_end_case_;
|
|
}
|
|
|
|
memcpy(pu8keybuf, pstrHostIFkeyAttr->attr.wpa.mac_addr, 6);
|
|
memcpy(pu8keybuf + 6, &pstrHostIFkeyAttr->attr.wpa.key_len, 1);
|
|
memcpy(pu8keybuf + 7, pstrHostIFkeyAttr->attr.wpa.key,
|
|
pstrHostIFkeyAttr->attr.wpa.key_len);
|
|
|
|
wid.id = (u16)WID_ADD_PTK;
|
|
wid.type = WID_STR;
|
|
wid.val = (s8 *)pu8keybuf;
|
|
wid.size = PTK_KEY_MSG_LEN;
|
|
|
|
result = wilc_send_config_pkt(vif, SET_CFG,
|
|
&wid, 1,
|
|
wilc_get_vif_idx(vif));
|
|
kfree(pu8keybuf);
|
|
complete(&hif_drv->comp_test_key_block);
|
|
}
|
|
|
|
_WPAPtk_end_case_:
|
|
kfree(pstrHostIFkeyAttr->attr.wpa.key);
|
|
if (ret)
|
|
return ret;
|
|
|
|
break;
|
|
|
|
case PMKSA:
|
|
pu8keybuf = kmalloc((pstrHostIFkeyAttr->attr.pmkid.numpmkid * PMKSA_KEY_LEN) + 1, GFP_KERNEL);
|
|
if (!pu8keybuf)
|
|
return -ENOMEM;
|
|
|
|
pu8keybuf[0] = pstrHostIFkeyAttr->attr.pmkid.numpmkid;
|
|
|
|
for (i = 0; i < pstrHostIFkeyAttr->attr.pmkid.numpmkid; i++) {
|
|
memcpy(pu8keybuf + ((PMKSA_KEY_LEN * i) + 1), pstrHostIFkeyAttr->attr.pmkid.pmkidlist[i].bssid, ETH_ALEN);
|
|
memcpy(pu8keybuf + ((PMKSA_KEY_LEN * i) + ETH_ALEN + 1), pstrHostIFkeyAttr->attr.pmkid.pmkidlist[i].pmkid, PMKID_LEN);
|
|
}
|
|
|
|
wid.id = (u16)WID_PMKID_INFO;
|
|
wid.type = WID_STR;
|
|
wid.val = (s8 *)pu8keybuf;
|
|
wid.size = (pstrHostIFkeyAttr->attr.pmkid.numpmkid * PMKSA_KEY_LEN) + 1;
|
|
|
|
result = wilc_send_config_pkt(vif, SET_CFG, &wid, 1,
|
|
wilc_get_vif_idx(vif));
|
|
|
|
kfree(pu8keybuf);
|
|
break;
|
|
}
|
|
|
|
if (result)
|
|
netdev_err(vif->ndev, "Failed to send key config packet\n");
|
|
|
|
return result;
|
|
}
|
|
|
|
static void Handle_Disconnect(struct wilc_vif *vif)
|
|
{
|
|
struct wid wid;
|
|
struct host_if_drv *hif_drv = vif->hif_drv;
|
|
|
|
s32 result = 0;
|
|
u16 u16DummyReasonCode = 0;
|
|
|
|
wid.id = (u16)WID_DISCONNECT;
|
|
wid.type = WID_CHAR;
|
|
wid.val = (s8 *)&u16DummyReasonCode;
|
|
wid.size = sizeof(char);
|
|
|
|
wilc_optaining_ip = false;
|
|
wilc_set_power_mgmt(vif, 0, 0);
|
|
|
|
eth_zero_addr(wilc_connected_ssid);
|
|
|
|
result = wilc_send_config_pkt(vif, SET_CFG, &wid, 1,
|
|
wilc_get_vif_idx(vif));
|
|
|
|
if (result) {
|
|
netdev_err(vif->ndev, "Failed to send dissconect\n");
|
|
} else {
|
|
struct disconnect_info strDisconnectNotifInfo;
|
|
|
|
memset(&strDisconnectNotifInfo, 0, sizeof(struct disconnect_info));
|
|
|
|
strDisconnectNotifInfo.reason = 0;
|
|
strDisconnectNotifInfo.ie = NULL;
|
|
strDisconnectNotifInfo.ie_len = 0;
|
|
|
|
if (hif_drv->usr_scan_req.scan_result) {
|
|
del_timer(&hif_drv->scan_timer);
|
|
hif_drv->usr_scan_req.scan_result(SCAN_EVENT_ABORTED,
|
|
NULL,
|
|
hif_drv->usr_scan_req.arg,
|
|
NULL);
|
|
hif_drv->usr_scan_req.scan_result = NULL;
|
|
}
|
|
|
|
if (hif_drv->usr_conn_req.conn_result) {
|
|
if (hif_drv->hif_state == HOST_IF_WAITING_CONN_RESP)
|
|
del_timer(&hif_drv->connect_timer);
|
|
|
|
hif_drv->usr_conn_req.conn_result(CONN_DISCONN_EVENT_DISCONN_NOTIF,
|
|
NULL,
|
|
0,
|
|
&strDisconnectNotifInfo,
|
|
hif_drv->usr_conn_req.arg);
|
|
} else {
|
|
netdev_err(vif->ndev, "conn_result = NULL\n");
|
|
}
|
|
|
|
scan_while_connected = false;
|
|
|
|
hif_drv->hif_state = HOST_IF_IDLE;
|
|
|
|
eth_zero_addr(hif_drv->assoc_bssid);
|
|
|
|
hif_drv->usr_conn_req.ssid_len = 0;
|
|
kfree(hif_drv->usr_conn_req.ssid);
|
|
hif_drv->usr_conn_req.ssid = NULL;
|
|
kfree(hif_drv->usr_conn_req.bssid);
|
|
hif_drv->usr_conn_req.bssid = NULL;
|
|
hif_drv->usr_conn_req.ies_len = 0;
|
|
kfree(hif_drv->usr_conn_req.ies);
|
|
hif_drv->usr_conn_req.ies = NULL;
|
|
|
|
if (join_req && join_req_vif == vif) {
|
|
kfree(join_req);
|
|
join_req = NULL;
|
|
}
|
|
|
|
if (info_element && join_req_vif == vif) {
|
|
kfree(info_element);
|
|
info_element = NULL;
|
|
}
|
|
}
|
|
|
|
complete(&hif_drv->comp_test_disconn_block);
|
|
}
|
|
|
|
void wilc_resolve_disconnect_aberration(struct wilc_vif *vif)
|
|
{
|
|
if (!vif->hif_drv)
|
|
return;
|
|
if ((vif->hif_drv->hif_state == HOST_IF_WAITING_CONN_RESP) ||
|
|
(vif->hif_drv->hif_state == HOST_IF_CONNECTING))
|
|
wilc_disconnect(vif, 1);
|
|
}
|
|
|
|
static void Handle_GetRssi(struct wilc_vif *vif)
|
|
{
|
|
s32 result = 0;
|
|
struct wid wid;
|
|
|
|
wid.id = (u16)WID_RSSI;
|
|
wid.type = WID_CHAR;
|
|
wid.val = &rssi;
|
|
wid.size = sizeof(char);
|
|
|
|
result = wilc_send_config_pkt(vif, GET_CFG, &wid, 1,
|
|
wilc_get_vif_idx(vif));
|
|
if (result) {
|
|
netdev_err(vif->ndev, "Failed to get RSSI value\n");
|
|
result = -EFAULT;
|
|
}
|
|
|
|
complete(&vif->hif_drv->comp_get_rssi);
|
|
}
|
|
|
|
static s32 Handle_GetStatistics(struct wilc_vif *vif,
|
|
struct rf_info *pstrStatistics)
|
|
{
|
|
struct wid strWIDList[5];
|
|
u32 u32WidsCount = 0, result = 0;
|
|
|
|
strWIDList[u32WidsCount].id = WID_LINKSPEED;
|
|
strWIDList[u32WidsCount].type = WID_CHAR;
|
|
strWIDList[u32WidsCount].size = sizeof(char);
|
|
strWIDList[u32WidsCount].val = (s8 *)&pstrStatistics->link_speed;
|
|
u32WidsCount++;
|
|
|
|
strWIDList[u32WidsCount].id = WID_RSSI;
|
|
strWIDList[u32WidsCount].type = WID_CHAR;
|
|
strWIDList[u32WidsCount].size = sizeof(char);
|
|
strWIDList[u32WidsCount].val = (s8 *)&pstrStatistics->rssi;
|
|
u32WidsCount++;
|
|
|
|
strWIDList[u32WidsCount].id = WID_SUCCESS_FRAME_COUNT;
|
|
strWIDList[u32WidsCount].type = WID_INT;
|
|
strWIDList[u32WidsCount].size = sizeof(u32);
|
|
strWIDList[u32WidsCount].val = (s8 *)&pstrStatistics->tx_cnt;
|
|
u32WidsCount++;
|
|
|
|
strWIDList[u32WidsCount].id = WID_RECEIVED_FRAGMENT_COUNT;
|
|
strWIDList[u32WidsCount].type = WID_INT;
|
|
strWIDList[u32WidsCount].size = sizeof(u32);
|
|
strWIDList[u32WidsCount].val = (s8 *)&pstrStatistics->rx_cnt;
|
|
u32WidsCount++;
|
|
|
|
strWIDList[u32WidsCount].id = WID_FAILED_COUNT;
|
|
strWIDList[u32WidsCount].type = WID_INT;
|
|
strWIDList[u32WidsCount].size = sizeof(u32);
|
|
strWIDList[u32WidsCount].val = (s8 *)&pstrStatistics->tx_fail_cnt;
|
|
u32WidsCount++;
|
|
|
|
result = wilc_send_config_pkt(vif, GET_CFG, strWIDList,
|
|
u32WidsCount,
|
|
wilc_get_vif_idx(vif));
|
|
|
|
if (result)
|
|
netdev_err(vif->ndev, "Failed to send scan parameters\n");
|
|
|
|
if (pstrStatistics->link_speed > TCP_ACK_FILTER_LINK_SPEED_THRESH &&
|
|
pstrStatistics->link_speed != DEFAULT_LINK_SPEED)
|
|
wilc_enable_tcp_ack_filter(true);
|
|
else if (pstrStatistics->link_speed != DEFAULT_LINK_SPEED)
|
|
wilc_enable_tcp_ack_filter(false);
|
|
|
|
if (pstrStatistics != &vif->wilc->dummy_statistics)
|
|
complete(&hif_wait_response);
|
|
return 0;
|
|
}
|
|
|
|
static s32 Handle_Get_InActiveTime(struct wilc_vif *vif,
|
|
struct sta_inactive_t *strHostIfStaInactiveT)
|
|
{
|
|
s32 result = 0;
|
|
u8 *stamac;
|
|
struct wid wid;
|
|
struct host_if_drv *hif_drv = vif->hif_drv;
|
|
|
|
wid.id = (u16)WID_SET_STA_MAC_INACTIVE_TIME;
|
|
wid.type = WID_STR;
|
|
wid.size = ETH_ALEN;
|
|
wid.val = kmalloc(wid.size, GFP_KERNEL);
|
|
if (!wid.val)
|
|
return -ENOMEM;
|
|
|
|
stamac = wid.val;
|
|
ether_addr_copy(stamac, strHostIfStaInactiveT->mac);
|
|
|
|
result = wilc_send_config_pkt(vif, SET_CFG, &wid, 1,
|
|
wilc_get_vif_idx(vif));
|
|
|
|
if (result) {
|
|
netdev_err(vif->ndev, "Failed to SET incative time\n");
|
|
return -EFAULT;
|
|
}
|
|
|
|
wid.id = (u16)WID_GET_INACTIVE_TIME;
|
|
wid.type = WID_INT;
|
|
wid.val = (s8 *)&inactive_time;
|
|
wid.size = sizeof(u32);
|
|
|
|
result = wilc_send_config_pkt(vif, GET_CFG, &wid, 1,
|
|
wilc_get_vif_idx(vif));
|
|
|
|
if (result) {
|
|
netdev_err(vif->ndev, "Failed to get incative time\n");
|
|
return -EFAULT;
|
|
}
|
|
|
|
complete(&hif_drv->comp_inactive_time);
|
|
|
|
return result;
|
|
}
|
|
|
|
static void Handle_AddBeacon(struct wilc_vif *vif,
|
|
struct beacon_attr *pstrSetBeaconParam)
|
|
{
|
|
s32 result = 0;
|
|
struct wid wid;
|
|
u8 *pu8CurrByte;
|
|
|
|
wid.id = (u16)WID_ADD_BEACON;
|
|
wid.type = WID_BIN;
|
|
wid.size = pstrSetBeaconParam->head_len + pstrSetBeaconParam->tail_len + 16;
|
|
wid.val = kmalloc(wid.size, GFP_KERNEL);
|
|
if (!wid.val)
|
|
goto ERRORHANDLER;
|
|
|
|
pu8CurrByte = wid.val;
|
|
*pu8CurrByte++ = (pstrSetBeaconParam->interval & 0xFF);
|
|
*pu8CurrByte++ = ((pstrSetBeaconParam->interval >> 8) & 0xFF);
|
|
*pu8CurrByte++ = ((pstrSetBeaconParam->interval >> 16) & 0xFF);
|
|
*pu8CurrByte++ = ((pstrSetBeaconParam->interval >> 24) & 0xFF);
|
|
|
|
*pu8CurrByte++ = (pstrSetBeaconParam->dtim_period & 0xFF);
|
|
*pu8CurrByte++ = ((pstrSetBeaconParam->dtim_period >> 8) & 0xFF);
|
|
*pu8CurrByte++ = ((pstrSetBeaconParam->dtim_period >> 16) & 0xFF);
|
|
*pu8CurrByte++ = ((pstrSetBeaconParam->dtim_period >> 24) & 0xFF);
|
|
|
|
*pu8CurrByte++ = (pstrSetBeaconParam->head_len & 0xFF);
|
|
*pu8CurrByte++ = ((pstrSetBeaconParam->head_len >> 8) & 0xFF);
|
|
*pu8CurrByte++ = ((pstrSetBeaconParam->head_len >> 16) & 0xFF);
|
|
*pu8CurrByte++ = ((pstrSetBeaconParam->head_len >> 24) & 0xFF);
|
|
|
|
memcpy(pu8CurrByte, pstrSetBeaconParam->head, pstrSetBeaconParam->head_len);
|
|
pu8CurrByte += pstrSetBeaconParam->head_len;
|
|
|
|
*pu8CurrByte++ = (pstrSetBeaconParam->tail_len & 0xFF);
|
|
*pu8CurrByte++ = ((pstrSetBeaconParam->tail_len >> 8) & 0xFF);
|
|
*pu8CurrByte++ = ((pstrSetBeaconParam->tail_len >> 16) & 0xFF);
|
|
*pu8CurrByte++ = ((pstrSetBeaconParam->tail_len >> 24) & 0xFF);
|
|
|
|
if (pstrSetBeaconParam->tail)
|
|
memcpy(pu8CurrByte, pstrSetBeaconParam->tail, pstrSetBeaconParam->tail_len);
|
|
pu8CurrByte += pstrSetBeaconParam->tail_len;
|
|
|
|
result = wilc_send_config_pkt(vif, SET_CFG, &wid, 1,
|
|
wilc_get_vif_idx(vif));
|
|
if (result)
|
|
netdev_err(vif->ndev, "Failed to send add beacon\n");
|
|
|
|
ERRORHANDLER:
|
|
kfree(wid.val);
|
|
kfree(pstrSetBeaconParam->head);
|
|
kfree(pstrSetBeaconParam->tail);
|
|
}
|
|
|
|
static void Handle_DelBeacon(struct wilc_vif *vif)
|
|
{
|
|
s32 result = 0;
|
|
struct wid wid;
|
|
u8 *pu8CurrByte;
|
|
|
|
wid.id = (u16)WID_DEL_BEACON;
|
|
wid.type = WID_CHAR;
|
|
wid.size = sizeof(char);
|
|
wid.val = &del_beacon;
|
|
|
|
if (!wid.val)
|
|
return;
|
|
|
|
pu8CurrByte = wid.val;
|
|
|
|
result = wilc_send_config_pkt(vif, SET_CFG, &wid, 1,
|
|
wilc_get_vif_idx(vif));
|
|
if (result)
|
|
netdev_err(vif->ndev, "Failed to send delete beacon\n");
|
|
}
|
|
|
|
static u32 WILC_HostIf_PackStaParam(u8 *pu8Buffer,
|
|
struct add_sta_param *pstrStationParam)
|
|
{
|
|
u8 *pu8CurrByte;
|
|
|
|
pu8CurrByte = pu8Buffer;
|
|
|
|
memcpy(pu8CurrByte, pstrStationParam->bssid, ETH_ALEN);
|
|
pu8CurrByte += ETH_ALEN;
|
|
|
|
*pu8CurrByte++ = pstrStationParam->aid & 0xFF;
|
|
*pu8CurrByte++ = (pstrStationParam->aid >> 8) & 0xFF;
|
|
|
|
*pu8CurrByte++ = pstrStationParam->rates_len;
|
|
if (pstrStationParam->rates_len > 0)
|
|
memcpy(pu8CurrByte, pstrStationParam->rates,
|
|
pstrStationParam->rates_len);
|
|
pu8CurrByte += pstrStationParam->rates_len;
|
|
|
|
*pu8CurrByte++ = pstrStationParam->ht_supported;
|
|
memcpy(pu8CurrByte, &pstrStationParam->ht_capa,
|
|
sizeof(struct ieee80211_ht_cap));
|
|
pu8CurrByte += sizeof(struct ieee80211_ht_cap);
|
|
|
|
*pu8CurrByte++ = pstrStationParam->flags_mask & 0xFF;
|
|
*pu8CurrByte++ = (pstrStationParam->flags_mask >> 8) & 0xFF;
|
|
|
|
*pu8CurrByte++ = pstrStationParam->flags_set & 0xFF;
|
|
*pu8CurrByte++ = (pstrStationParam->flags_set >> 8) & 0xFF;
|
|
|
|
return pu8CurrByte - pu8Buffer;
|
|
}
|
|
|
|
static void Handle_AddStation(struct wilc_vif *vif,
|
|
struct add_sta_param *pstrStationParam)
|
|
{
|
|
s32 result = 0;
|
|
struct wid wid;
|
|
u8 *pu8CurrByte;
|
|
|
|
wid.id = (u16)WID_ADD_STA;
|
|
wid.type = WID_BIN;
|
|
wid.size = WILC_ADD_STA_LENGTH + pstrStationParam->rates_len;
|
|
|
|
wid.val = kmalloc(wid.size, GFP_KERNEL);
|
|
if (!wid.val)
|
|
goto ERRORHANDLER;
|
|
|
|
pu8CurrByte = wid.val;
|
|
pu8CurrByte += WILC_HostIf_PackStaParam(pu8CurrByte, pstrStationParam);
|
|
|
|
result = wilc_send_config_pkt(vif, SET_CFG, &wid, 1,
|
|
wilc_get_vif_idx(vif));
|
|
if (result != 0)
|
|
netdev_err(vif->ndev, "Failed to send add station\n");
|
|
|
|
ERRORHANDLER:
|
|
kfree(pstrStationParam->rates);
|
|
kfree(wid.val);
|
|
}
|
|
|
|
static void Handle_DelAllSta(struct wilc_vif *vif,
|
|
struct del_all_sta *pstrDelAllStaParam)
|
|
{
|
|
s32 result = 0;
|
|
struct wid wid;
|
|
u8 *pu8CurrByte;
|
|
u8 i;
|
|
u8 au8Zero_Buff[6] = {0};
|
|
|
|
wid.id = (u16)WID_DEL_ALL_STA;
|
|
wid.type = WID_STR;
|
|
wid.size = (pstrDelAllStaParam->assoc_sta * ETH_ALEN) + 1;
|
|
|
|
wid.val = kmalloc((pstrDelAllStaParam->assoc_sta * ETH_ALEN) + 1, GFP_KERNEL);
|
|
if (!wid.val)
|
|
goto ERRORHANDLER;
|
|
|
|
pu8CurrByte = wid.val;
|
|
|
|
*(pu8CurrByte++) = pstrDelAllStaParam->assoc_sta;
|
|
|
|
for (i = 0; i < MAX_NUM_STA; i++) {
|
|
if (memcmp(pstrDelAllStaParam->del_all_sta[i], au8Zero_Buff, ETH_ALEN))
|
|
memcpy(pu8CurrByte, pstrDelAllStaParam->del_all_sta[i], ETH_ALEN);
|
|
else
|
|
continue;
|
|
|
|
pu8CurrByte += ETH_ALEN;
|
|
}
|
|
|
|
result = wilc_send_config_pkt(vif, SET_CFG, &wid, 1,
|
|
wilc_get_vif_idx(vif));
|
|
if (result)
|
|
netdev_err(vif->ndev, "Failed to send add station\n");
|
|
|
|
ERRORHANDLER:
|
|
kfree(wid.val);
|
|
|
|
complete(&hif_wait_response);
|
|
}
|
|
|
|
static void Handle_DelStation(struct wilc_vif *vif,
|
|
struct del_sta *pstrDelStaParam)
|
|
{
|
|
s32 result = 0;
|
|
struct wid wid;
|
|
u8 *pu8CurrByte;
|
|
|
|
wid.id = (u16)WID_REMOVE_STA;
|
|
wid.type = WID_BIN;
|
|
wid.size = ETH_ALEN;
|
|
|
|
wid.val = kmalloc(wid.size, GFP_KERNEL);
|
|
if (!wid.val)
|
|
goto ERRORHANDLER;
|
|
|
|
pu8CurrByte = wid.val;
|
|
|
|
ether_addr_copy(pu8CurrByte, pstrDelStaParam->mac_addr);
|
|
|
|
result = wilc_send_config_pkt(vif, SET_CFG, &wid, 1,
|
|
wilc_get_vif_idx(vif));
|
|
if (result)
|
|
netdev_err(vif->ndev, "Failed to send add station\n");
|
|
|
|
ERRORHANDLER:
|
|
kfree(wid.val);
|
|
}
|
|
|
|
static void Handle_EditStation(struct wilc_vif *vif,
|
|
struct add_sta_param *pstrStationParam)
|
|
{
|
|
s32 result = 0;
|
|
struct wid wid;
|
|
u8 *pu8CurrByte;
|
|
|
|
wid.id = (u16)WID_EDIT_STA;
|
|
wid.type = WID_BIN;
|
|
wid.size = WILC_ADD_STA_LENGTH + pstrStationParam->rates_len;
|
|
|
|
wid.val = kmalloc(wid.size, GFP_KERNEL);
|
|
if (!wid.val)
|
|
goto ERRORHANDLER;
|
|
|
|
pu8CurrByte = wid.val;
|
|
pu8CurrByte += WILC_HostIf_PackStaParam(pu8CurrByte, pstrStationParam);
|
|
|
|
result = wilc_send_config_pkt(vif, SET_CFG, &wid, 1,
|
|
wilc_get_vif_idx(vif));
|
|
if (result)
|
|
netdev_err(vif->ndev, "Failed to send edit station\n");
|
|
|
|
ERRORHANDLER:
|
|
kfree(pstrStationParam->rates);
|
|
kfree(wid.val);
|
|
}
|
|
|
|
static int Handle_RemainOnChan(struct wilc_vif *vif,
|
|
struct remain_ch *pstrHostIfRemainOnChan)
|
|
{
|
|
s32 result = 0;
|
|
u8 u8remain_on_chan_flag;
|
|
struct wid wid;
|
|
struct host_if_drv *hif_drv = vif->hif_drv;
|
|
|
|
if (!hif_drv->remain_on_ch_pending) {
|
|
hif_drv->remain_on_ch.arg = pstrHostIfRemainOnChan->arg;
|
|
hif_drv->remain_on_ch.expired = pstrHostIfRemainOnChan->expired;
|
|
hif_drv->remain_on_ch.ready = pstrHostIfRemainOnChan->ready;
|
|
hif_drv->remain_on_ch.ch = pstrHostIfRemainOnChan->ch;
|
|
hif_drv->remain_on_ch.id = pstrHostIfRemainOnChan->id;
|
|
} else {
|
|
pstrHostIfRemainOnChan->ch = hif_drv->remain_on_ch.ch;
|
|
}
|
|
|
|
if (hif_drv->usr_scan_req.scan_result) {
|
|
hif_drv->remain_on_ch_pending = 1;
|
|
result = -EBUSY;
|
|
goto ERRORHANDLER;
|
|
}
|
|
if (hif_drv->hif_state == HOST_IF_WAITING_CONN_RESP) {
|
|
result = -EBUSY;
|
|
goto ERRORHANDLER;
|
|
}
|
|
|
|
if (wilc_optaining_ip || wilc_connecting) {
|
|
result = -EBUSY;
|
|
goto ERRORHANDLER;
|
|
}
|
|
|
|
u8remain_on_chan_flag = true;
|
|
wid.id = (u16)WID_REMAIN_ON_CHAN;
|
|
wid.type = WID_STR;
|
|
wid.size = 2;
|
|
wid.val = kmalloc(wid.size, GFP_KERNEL);
|
|
if (!wid.val) {
|
|
result = -ENOMEM;
|
|
goto ERRORHANDLER;
|
|
}
|
|
|
|
wid.val[0] = u8remain_on_chan_flag;
|
|
wid.val[1] = (s8)pstrHostIfRemainOnChan->ch;
|
|
|
|
result = wilc_send_config_pkt(vif, SET_CFG, &wid, 1,
|
|
wilc_get_vif_idx(vif));
|
|
if (result != 0)
|
|
netdev_err(vif->ndev, "Failed to set remain on channel\n");
|
|
|
|
ERRORHANDLER:
|
|
{
|
|
P2P_LISTEN_STATE = 1;
|
|
hif_drv->remain_on_ch_timer.data = (unsigned long)vif;
|
|
mod_timer(&hif_drv->remain_on_ch_timer,
|
|
jiffies +
|
|
msecs_to_jiffies(pstrHostIfRemainOnChan->duration));
|
|
|
|
if (hif_drv->remain_on_ch.ready)
|
|
hif_drv->remain_on_ch.ready(hif_drv->remain_on_ch.arg);
|
|
|
|
if (hif_drv->remain_on_ch_pending)
|
|
hif_drv->remain_on_ch_pending = 0;
|
|
}
|
|
|
|
return result;
|
|
}
|
|
|
|
static int Handle_RegisterFrame(struct wilc_vif *vif,
|
|
struct reg_frame *pstrHostIfRegisterFrame)
|
|
{
|
|
s32 result = 0;
|
|
struct wid wid;
|
|
u8 *pu8CurrByte;
|
|
|
|
wid.id = (u16)WID_REGISTER_FRAME;
|
|
wid.type = WID_STR;
|
|
wid.val = kmalloc(sizeof(u16) + 2, GFP_KERNEL);
|
|
if (!wid.val)
|
|
return -ENOMEM;
|
|
|
|
pu8CurrByte = wid.val;
|
|
|
|
*pu8CurrByte++ = pstrHostIfRegisterFrame->reg;
|
|
*pu8CurrByte++ = pstrHostIfRegisterFrame->reg_id;
|
|
memcpy(pu8CurrByte, &pstrHostIfRegisterFrame->frame_type, sizeof(u16));
|
|
|
|
wid.size = sizeof(u16) + 2;
|
|
|
|
result = wilc_send_config_pkt(vif, SET_CFG, &wid, 1,
|
|
wilc_get_vif_idx(vif));
|
|
if (result) {
|
|
netdev_err(vif->ndev, "Failed to frame register\n");
|
|
result = -EINVAL;
|
|
}
|
|
|
|
return result;
|
|
}
|
|
|
|
static u32 Handle_ListenStateExpired(struct wilc_vif *vif,
|
|
struct remain_ch *pstrHostIfRemainOnChan)
|
|
{
|
|
u8 u8remain_on_chan_flag;
|
|
struct wid wid;
|
|
s32 result = 0;
|
|
struct host_if_drv *hif_drv = vif->hif_drv;
|
|
|
|
if (P2P_LISTEN_STATE) {
|
|
u8remain_on_chan_flag = false;
|
|
wid.id = (u16)WID_REMAIN_ON_CHAN;
|
|
wid.type = WID_STR;
|
|
wid.size = 2;
|
|
wid.val = kmalloc(wid.size, GFP_KERNEL);
|
|
|
|
if (!wid.val)
|
|
return -ENOMEM;
|
|
|
|
wid.val[0] = u8remain_on_chan_flag;
|
|
wid.val[1] = FALSE_FRMWR_CHANNEL;
|
|
|
|
result = wilc_send_config_pkt(vif, SET_CFG, &wid, 1,
|
|
wilc_get_vif_idx(vif));
|
|
if (result != 0) {
|
|
netdev_err(vif->ndev, "Failed to set remain channel\n");
|
|
goto _done_;
|
|
}
|
|
|
|
if (hif_drv->remain_on_ch.expired) {
|
|
hif_drv->remain_on_ch.expired(hif_drv->remain_on_ch.arg,
|
|
pstrHostIfRemainOnChan->id);
|
|
}
|
|
P2P_LISTEN_STATE = 0;
|
|
} else {
|
|
netdev_dbg(vif->ndev, "Not in listen state\n");
|
|
result = -EFAULT;
|
|
}
|
|
|
|
_done_:
|
|
return result;
|
|
}
|
|
|
|
static void ListenTimerCB(unsigned long arg)
|
|
{
|
|
s32 result = 0;
|
|
struct host_if_msg msg;
|
|
struct wilc_vif *vif = (struct wilc_vif *)arg;
|
|
|
|
del_timer(&vif->hif_drv->remain_on_ch_timer);
|
|
|
|
memset(&msg, 0, sizeof(struct host_if_msg));
|
|
msg.id = HOST_IF_MSG_LISTEN_TIMER_FIRED;
|
|
msg.vif = vif;
|
|
msg.body.remain_on_ch.id = vif->hif_drv->remain_on_ch.id;
|
|
|
|
result = wilc_enqueue_cmd(&msg);
|
|
if (result)
|
|
netdev_err(vif->ndev, "wilc_mq_send fail\n");
|
|
}
|
|
|
|
static void Handle_PowerManagement(struct wilc_vif *vif,
|
|
struct power_mgmt_param *strPowerMgmtParam)
|
|
{
|
|
s32 result = 0;
|
|
struct wid wid;
|
|
s8 s8PowerMode;
|
|
|
|
wid.id = (u16)WID_POWER_MANAGEMENT;
|
|
|
|
if (strPowerMgmtParam->enabled)
|
|
s8PowerMode = MIN_FAST_PS;
|
|
else
|
|
s8PowerMode = NO_POWERSAVE;
|
|
|
|
wid.val = &s8PowerMode;
|
|
wid.size = sizeof(char);
|
|
|
|
result = wilc_send_config_pkt(vif, SET_CFG, &wid, 1,
|
|
wilc_get_vif_idx(vif));
|
|
if (result)
|
|
netdev_err(vif->ndev, "Failed to send power management\n");
|
|
}
|
|
|
|
static void Handle_SetMulticastFilter(struct wilc_vif *vif,
|
|
struct set_multicast *strHostIfSetMulti)
|
|
{
|
|
s32 result = 0;
|
|
struct wid wid;
|
|
u8 *pu8CurrByte;
|
|
|
|
wid.id = (u16)WID_SETUP_MULTICAST_FILTER;
|
|
wid.type = WID_BIN;
|
|
wid.size = sizeof(struct set_multicast) + ((strHostIfSetMulti->cnt) * ETH_ALEN);
|
|
wid.val = kmalloc(wid.size, GFP_KERNEL);
|
|
if (!wid.val)
|
|
goto ERRORHANDLER;
|
|
|
|
pu8CurrByte = wid.val;
|
|
*pu8CurrByte++ = (strHostIfSetMulti->enabled & 0xFF);
|
|
*pu8CurrByte++ = ((strHostIfSetMulti->enabled >> 8) & 0xFF);
|
|
*pu8CurrByte++ = ((strHostIfSetMulti->enabled >> 16) & 0xFF);
|
|
*pu8CurrByte++ = ((strHostIfSetMulti->enabled >> 24) & 0xFF);
|
|
|
|
*pu8CurrByte++ = (strHostIfSetMulti->cnt & 0xFF);
|
|
*pu8CurrByte++ = ((strHostIfSetMulti->cnt >> 8) & 0xFF);
|
|
*pu8CurrByte++ = ((strHostIfSetMulti->cnt >> 16) & 0xFF);
|
|
*pu8CurrByte++ = ((strHostIfSetMulti->cnt >> 24) & 0xFF);
|
|
|
|
if ((strHostIfSetMulti->cnt) > 0)
|
|
memcpy(pu8CurrByte, wilc_multicast_mac_addr_list,
|
|
((strHostIfSetMulti->cnt) * ETH_ALEN));
|
|
|
|
result = wilc_send_config_pkt(vif, SET_CFG, &wid, 1,
|
|
wilc_get_vif_idx(vif));
|
|
if (result)
|
|
netdev_err(vif->ndev, "Failed to send setup multicast\n");
|
|
|
|
ERRORHANDLER:
|
|
kfree(wid.val);
|
|
}
|
|
|
|
static void handle_set_tx_pwr(struct wilc_vif *vif, u8 tx_pwr)
|
|
{
|
|
int ret;
|
|
struct wid wid;
|
|
|
|
wid.id = (u16)WID_TX_POWER;
|
|
wid.type = WID_CHAR;
|
|
wid.val = &tx_pwr;
|
|
wid.size = sizeof(char);
|
|
|
|
ret = wilc_send_config_pkt(vif, SET_CFG, &wid, 1,
|
|
wilc_get_vif_idx(vif));
|
|
if (ret)
|
|
netdev_err(vif->ndev, "Failed to set TX PWR\n");
|
|
}
|
|
|
|
static void handle_get_tx_pwr(struct wilc_vif *vif, u8 *tx_pwr)
|
|
{
|
|
int ret = 0;
|
|
struct wid wid;
|
|
|
|
wid.id = (u16)WID_TX_POWER;
|
|
wid.type = WID_CHAR;
|
|
wid.val = (s8 *)tx_pwr;
|
|
wid.size = sizeof(char);
|
|
|
|
ret = wilc_send_config_pkt(vif, GET_CFG, &wid, 1,
|
|
wilc_get_vif_idx(vif));
|
|
if (ret)
|
|
netdev_err(vif->ndev, "Failed to get TX PWR\n");
|
|
|
|
complete(&hif_wait_response);
|
|
}
|
|
|
|
static void host_if_work(struct work_struct *work)
|
|
{
|
|
struct host_if_msg *msg;
|
|
struct wilc *wilc;
|
|
int ret = 0;
|
|
|
|
msg = container_of(work, struct host_if_msg, work);
|
|
wilc = msg->vif->wilc;
|
|
|
|
if (msg->id == HOST_IF_MSG_CONNECT &&
|
|
msg->vif->hif_drv->usr_scan_req.scan_result) {
|
|
wilc_enqueue_cmd(msg);
|
|
usleep_range(2 * 1000, 2 * 1000);
|
|
goto free_msg;
|
|
}
|
|
switch (msg->id) {
|
|
case HOST_IF_MSG_SCAN:
|
|
handle_scan(msg->vif, &msg->body.scan_info);
|
|
break;
|
|
|
|
case HOST_IF_MSG_CONNECT:
|
|
Handle_Connect(msg->vif, &msg->body.con_info);
|
|
break;
|
|
|
|
case HOST_IF_MSG_RCVD_NTWRK_INFO:
|
|
Handle_RcvdNtwrkInfo(msg->vif, &msg->body.net_info);
|
|
break;
|
|
|
|
case HOST_IF_MSG_RCVD_GNRL_ASYNC_INFO:
|
|
Handle_RcvdGnrlAsyncInfo(msg->vif,
|
|
&msg->body.async_info);
|
|
break;
|
|
|
|
case HOST_IF_MSG_KEY:
|
|
Handle_Key(msg->vif, &msg->body.key_info);
|
|
break;
|
|
|
|
case HOST_IF_MSG_CFG_PARAMS:
|
|
handle_cfg_param(msg->vif, &msg->body.cfg_info);
|
|
break;
|
|
|
|
case HOST_IF_MSG_SET_CHANNEL:
|
|
handle_set_channel(msg->vif, &msg->body.channel_info);
|
|
break;
|
|
|
|
case HOST_IF_MSG_DISCONNECT:
|
|
Handle_Disconnect(msg->vif);
|
|
break;
|
|
|
|
case HOST_IF_MSG_RCVD_SCAN_COMPLETE:
|
|
del_timer(&msg->vif->hif_drv->scan_timer);
|
|
|
|
if (!wilc_wlan_get_num_conn_ifcs(wilc))
|
|
wilc_chip_sleep_manually(wilc);
|
|
|
|
Handle_ScanDone(msg->vif, SCAN_EVENT_DONE);
|
|
|
|
if (msg->vif->hif_drv->remain_on_ch_pending)
|
|
Handle_RemainOnChan(msg->vif,
|
|
&msg->body.remain_on_ch);
|
|
|
|
break;
|
|
|
|
case HOST_IF_MSG_GET_RSSI:
|
|
Handle_GetRssi(msg->vif);
|
|
break;
|
|
|
|
case HOST_IF_MSG_GET_STATISTICS:
|
|
Handle_GetStatistics(msg->vif,
|
|
(struct rf_info *)msg->body.data);
|
|
break;
|
|
|
|
case HOST_IF_MSG_ADD_BEACON:
|
|
Handle_AddBeacon(msg->vif, &msg->body.beacon_info);
|
|
break;
|
|
|
|
case HOST_IF_MSG_DEL_BEACON:
|
|
Handle_DelBeacon(msg->vif);
|
|
break;
|
|
|
|
case HOST_IF_MSG_ADD_STATION:
|
|
Handle_AddStation(msg->vif, &msg->body.add_sta_info);
|
|
break;
|
|
|
|
case HOST_IF_MSG_DEL_STATION:
|
|
Handle_DelStation(msg->vif, &msg->body.del_sta_info);
|
|
break;
|
|
|
|
case HOST_IF_MSG_EDIT_STATION:
|
|
Handle_EditStation(msg->vif, &msg->body.edit_sta_info);
|
|
break;
|
|
|
|
case HOST_IF_MSG_GET_INACTIVETIME:
|
|
Handle_Get_InActiveTime(msg->vif, &msg->body.mac_info);
|
|
break;
|
|
|
|
case HOST_IF_MSG_SCAN_TIMER_FIRED:
|
|
Handle_ScanDone(msg->vif, SCAN_EVENT_ABORTED);
|
|
break;
|
|
|
|
case HOST_IF_MSG_CONNECT_TIMER_FIRED:
|
|
Handle_ConnectTimeout(msg->vif);
|
|
break;
|
|
|
|
case HOST_IF_MSG_POWER_MGMT:
|
|
Handle_PowerManagement(msg->vif,
|
|
&msg->body.pwr_mgmt_info);
|
|
break;
|
|
|
|
case HOST_IF_MSG_SET_WFIDRV_HANDLER:
|
|
ret = handle_set_wfi_drv_handler(msg->vif, &msg->body.drv);
|
|
break;
|
|
|
|
case HOST_IF_MSG_SET_OPERATION_MODE:
|
|
handle_set_operation_mode(msg->vif, &msg->body.mode);
|
|
break;
|
|
|
|
case HOST_IF_MSG_SET_IPADDRESS:
|
|
handle_set_ip_address(msg->vif,
|
|
msg->body.ip_info.ip_addr,
|
|
msg->body.ip_info.idx);
|
|
break;
|
|
|
|
case HOST_IF_MSG_GET_IPADDRESS:
|
|
handle_get_ip_address(msg->vif, msg->body.ip_info.idx);
|
|
break;
|
|
|
|
case HOST_IF_MSG_GET_MAC_ADDRESS:
|
|
handle_get_mac_address(msg->vif,
|
|
&msg->body.get_mac_info);
|
|
break;
|
|
|
|
case HOST_IF_MSG_REMAIN_ON_CHAN:
|
|
Handle_RemainOnChan(msg->vif, &msg->body.remain_on_ch);
|
|
break;
|
|
|
|
case HOST_IF_MSG_REGISTER_FRAME:
|
|
Handle_RegisterFrame(msg->vif, &msg->body.reg_frame);
|
|
break;
|
|
|
|
case HOST_IF_MSG_LISTEN_TIMER_FIRED:
|
|
Handle_ListenStateExpired(msg->vif, &msg->body.remain_on_ch);
|
|
break;
|
|
|
|
case HOST_IF_MSG_SET_MULTICAST_FILTER:
|
|
Handle_SetMulticastFilter(msg->vif, &msg->body.multicast_info);
|
|
break;
|
|
|
|
case HOST_IF_MSG_DEL_ALL_STA:
|
|
Handle_DelAllSta(msg->vif, &msg->body.del_all_sta_info);
|
|
break;
|
|
|
|
case HOST_IF_MSG_SET_TX_POWER:
|
|
handle_set_tx_pwr(msg->vif, msg->body.tx_power.tx_pwr);
|
|
break;
|
|
|
|
case HOST_IF_MSG_GET_TX_POWER:
|
|
handle_get_tx_pwr(msg->vif, &msg->body.tx_power.tx_pwr);
|
|
break;
|
|
default:
|
|
netdev_err(msg->vif->ndev, "[Host Interface] undefined\n");
|
|
break;
|
|
}
|
|
free_msg:
|
|
if (ret)
|
|
netdev_err(msg->vif->ndev, "Host cmd %d failed\n", msg->id);
|
|
kfree(msg);
|
|
complete(&hif_thread_comp);
|
|
}
|
|
|
|
static void TimerCB_Scan(unsigned long arg)
|
|
{
|
|
struct wilc_vif *vif = (struct wilc_vif *)arg;
|
|
struct host_if_msg msg;
|
|
|
|
memset(&msg, 0, sizeof(struct host_if_msg));
|
|
msg.vif = vif;
|
|
msg.id = HOST_IF_MSG_SCAN_TIMER_FIRED;
|
|
|
|
wilc_enqueue_cmd(&msg);
|
|
}
|
|
|
|
static void TimerCB_Connect(unsigned long arg)
|
|
{
|
|
struct wilc_vif *vif = (struct wilc_vif *)arg;
|
|
struct host_if_msg msg;
|
|
|
|
memset(&msg, 0, sizeof(struct host_if_msg));
|
|
msg.vif = vif;
|
|
msg.id = HOST_IF_MSG_CONNECT_TIMER_FIRED;
|
|
|
|
wilc_enqueue_cmd(&msg);
|
|
}
|
|
|
|
s32 wilc_remove_key(struct host_if_drv *hif_drv, const u8 *pu8StaAddress)
|
|
{
|
|
struct wid wid;
|
|
|
|
wid.id = (u16)WID_REMOVE_KEY;
|
|
wid.type = WID_STR;
|
|
wid.val = (s8 *)pu8StaAddress;
|
|
wid.size = 6;
|
|
|
|
return 0;
|
|
}
|
|
|
|
int wilc_remove_wep_key(struct wilc_vif *vif, u8 index)
|
|
{
|
|
int result = 0;
|
|
struct host_if_msg msg;
|
|
struct host_if_drv *hif_drv = vif->hif_drv;
|
|
|
|
if (!hif_drv) {
|
|
result = -EFAULT;
|
|
netdev_err(vif->ndev, "Failed to send setup multicast\n");
|
|
return result;
|
|
}
|
|
|
|
memset(&msg, 0, sizeof(struct host_if_msg));
|
|
|
|
msg.id = HOST_IF_MSG_KEY;
|
|
msg.body.key_info.type = WEP;
|
|
msg.body.key_info.action = REMOVEKEY;
|
|
msg.vif = vif;
|
|
msg.body.key_info.attr.wep.index = index;
|
|
|
|
result = wilc_enqueue_cmd(&msg);
|
|
if (result)
|
|
netdev_err(vif->ndev, "Request to remove WEP key\n");
|
|
else
|
|
wait_for_completion(&hif_drv->comp_test_key_block);
|
|
|
|
return result;
|
|
}
|
|
|
|
int wilc_set_wep_default_keyid(struct wilc_vif *vif, u8 index)
|
|
{
|
|
int result = 0;
|
|
struct host_if_msg msg;
|
|
struct host_if_drv *hif_drv = vif->hif_drv;
|
|
|
|
if (!hif_drv) {
|
|
result = -EFAULT;
|
|
netdev_err(vif->ndev, "driver is null\n");
|
|
return result;
|
|
}
|
|
|
|
memset(&msg, 0, sizeof(struct host_if_msg));
|
|
|
|
msg.id = HOST_IF_MSG_KEY;
|
|
msg.body.key_info.type = WEP;
|
|
msg.body.key_info.action = DEFAULTKEY;
|
|
msg.vif = vif;
|
|
msg.body.key_info.attr.wep.index = index;
|
|
|
|
result = wilc_enqueue_cmd(&msg);
|
|
if (result)
|
|
netdev_err(vif->ndev, "Default key index\n");
|
|
else
|
|
wait_for_completion(&hif_drv->comp_test_key_block);
|
|
|
|
return result;
|
|
}
|
|
|
|
int wilc_add_wep_key_bss_sta(struct wilc_vif *vif, const u8 *key, u8 len,
|
|
u8 index)
|
|
{
|
|
int result = 0;
|
|
struct host_if_msg msg;
|
|
struct host_if_drv *hif_drv = vif->hif_drv;
|
|
|
|
if (!hif_drv) {
|
|
netdev_err(vif->ndev, "driver is null\n");
|
|
return -EFAULT;
|
|
}
|
|
|
|
memset(&msg, 0, sizeof(struct host_if_msg));
|
|
|
|
msg.id = HOST_IF_MSG_KEY;
|
|
msg.body.key_info.type = WEP;
|
|
msg.body.key_info.action = ADDKEY;
|
|
msg.vif = vif;
|
|
msg.body.key_info.attr.wep.key = kmemdup(key, len, GFP_KERNEL);
|
|
if (!msg.body.key_info.attr.wep.key)
|
|
return -ENOMEM;
|
|
|
|
msg.body.key_info.attr.wep.key_len = len;
|
|
msg.body.key_info.attr.wep.index = index;
|
|
|
|
result = wilc_enqueue_cmd(&msg);
|
|
if (result)
|
|
netdev_err(vif->ndev, "STA - WEP Key\n");
|
|
wait_for_completion(&hif_drv->comp_test_key_block);
|
|
|
|
return result;
|
|
}
|
|
|
|
int wilc_add_wep_key_bss_ap(struct wilc_vif *vif, const u8 *key, u8 len,
|
|
u8 index, u8 mode, enum AUTHTYPE auth_type)
|
|
{
|
|
int result = 0;
|
|
struct host_if_msg msg;
|
|
struct host_if_drv *hif_drv = vif->hif_drv;
|
|
|
|
if (!hif_drv) {
|
|
netdev_err(vif->ndev, "driver is null\n");
|
|
return -EFAULT;
|
|
}
|
|
|
|
memset(&msg, 0, sizeof(struct host_if_msg));
|
|
|
|
msg.id = HOST_IF_MSG_KEY;
|
|
msg.body.key_info.type = WEP;
|
|
msg.body.key_info.action = ADDKEY_AP;
|
|
msg.vif = vif;
|
|
msg.body.key_info.attr.wep.key = kmemdup(key, len, GFP_KERNEL);
|
|
if (!msg.body.key_info.attr.wep.key)
|
|
return -ENOMEM;
|
|
|
|
msg.body.key_info.attr.wep.key_len = len;
|
|
msg.body.key_info.attr.wep.index = index;
|
|
msg.body.key_info.attr.wep.mode = mode;
|
|
msg.body.key_info.attr.wep.auth_type = auth_type;
|
|
|
|
result = wilc_enqueue_cmd(&msg);
|
|
|
|
if (result)
|
|
netdev_err(vif->ndev, "AP - WEP Key\n");
|
|
else
|
|
wait_for_completion(&hif_drv->comp_test_key_block);
|
|
|
|
return result;
|
|
}
|
|
|
|
int wilc_add_ptk(struct wilc_vif *vif, const u8 *ptk, u8 ptk_key_len,
|
|
const u8 *mac_addr, const u8 *rx_mic, const u8 *tx_mic,
|
|
u8 mode, u8 cipher_mode, u8 index)
|
|
{
|
|
int result = 0;
|
|
struct host_if_msg msg;
|
|
struct host_if_drv *hif_drv = vif->hif_drv;
|
|
u8 key_len = ptk_key_len;
|
|
|
|
if (!hif_drv) {
|
|
netdev_err(vif->ndev, "driver is null\n");
|
|
return -EFAULT;
|
|
}
|
|
|
|
if (rx_mic)
|
|
key_len += RX_MIC_KEY_LEN;
|
|
|
|
if (tx_mic)
|
|
key_len += TX_MIC_KEY_LEN;
|
|
|
|
memset(&msg, 0, sizeof(struct host_if_msg));
|
|
|
|
msg.id = HOST_IF_MSG_KEY;
|
|
msg.body.key_info.type = WPA_PTK;
|
|
if (mode == AP_MODE) {
|
|
msg.body.key_info.action = ADDKEY_AP;
|
|
msg.body.key_info.attr.wpa.index = index;
|
|
}
|
|
if (mode == STATION_MODE)
|
|
msg.body.key_info.action = ADDKEY;
|
|
|
|
msg.body.key_info.attr.wpa.key = kmemdup(ptk, ptk_key_len, GFP_KERNEL);
|
|
if (!msg.body.key_info.attr.wpa.key)
|
|
return -ENOMEM;
|
|
|
|
if (rx_mic)
|
|
memcpy(msg.body.key_info.attr.wpa.key + 16, rx_mic, RX_MIC_KEY_LEN);
|
|
|
|
if (tx_mic)
|
|
memcpy(msg.body.key_info.attr.wpa.key + 24, tx_mic, TX_MIC_KEY_LEN);
|
|
|
|
msg.body.key_info.attr.wpa.key_len = key_len;
|
|
msg.body.key_info.attr.wpa.mac_addr = mac_addr;
|
|
msg.body.key_info.attr.wpa.mode = cipher_mode;
|
|
msg.vif = vif;
|
|
|
|
result = wilc_enqueue_cmd(&msg);
|
|
|
|
if (result)
|
|
netdev_err(vif->ndev, "PTK Key\n");
|
|
else
|
|
wait_for_completion(&hif_drv->comp_test_key_block);
|
|
|
|
return result;
|
|
}
|
|
|
|
int wilc_add_rx_gtk(struct wilc_vif *vif, const u8 *rx_gtk, u8 gtk_key_len,
|
|
u8 index, u32 key_rsc_len, const u8 *key_rsc,
|
|
const u8 *rx_mic, const u8 *tx_mic, u8 mode,
|
|
u8 cipher_mode)
|
|
{
|
|
int result = 0;
|
|
struct host_if_msg msg;
|
|
struct host_if_drv *hif_drv = vif->hif_drv;
|
|
u8 key_len = gtk_key_len;
|
|
|
|
if (!hif_drv) {
|
|
netdev_err(vif->ndev, "driver is null\n");
|
|
return -EFAULT;
|
|
}
|
|
memset(&msg, 0, sizeof(struct host_if_msg));
|
|
|
|
if (rx_mic)
|
|
key_len += RX_MIC_KEY_LEN;
|
|
|
|
if (tx_mic)
|
|
key_len += TX_MIC_KEY_LEN;
|
|
|
|
if (key_rsc) {
|
|
msg.body.key_info.attr.wpa.seq = kmemdup(key_rsc,
|
|
key_rsc_len,
|
|
GFP_KERNEL);
|
|
if (!msg.body.key_info.attr.wpa.seq)
|
|
return -ENOMEM;
|
|
}
|
|
|
|
msg.id = HOST_IF_MSG_KEY;
|
|
msg.body.key_info.type = WPA_RX_GTK;
|
|
msg.vif = vif;
|
|
|
|
if (mode == AP_MODE) {
|
|
msg.body.key_info.action = ADDKEY_AP;
|
|
msg.body.key_info.attr.wpa.mode = cipher_mode;
|
|
}
|
|
if (mode == STATION_MODE)
|
|
msg.body.key_info.action = ADDKEY;
|
|
|
|
msg.body.key_info.attr.wpa.key = kmemdup(rx_gtk,
|
|
key_len,
|
|
GFP_KERNEL);
|
|
if (!msg.body.key_info.attr.wpa.key)
|
|
return -ENOMEM;
|
|
|
|
if (rx_mic)
|
|
memcpy(msg.body.key_info.attr.wpa.key + 16, rx_mic,
|
|
RX_MIC_KEY_LEN);
|
|
|
|
if (tx_mic)
|
|
memcpy(msg.body.key_info.attr.wpa.key + 24, tx_mic,
|
|
TX_MIC_KEY_LEN);
|
|
|
|
msg.body.key_info.attr.wpa.index = index;
|
|
msg.body.key_info.attr.wpa.key_len = key_len;
|
|
msg.body.key_info.attr.wpa.seq_len = key_rsc_len;
|
|
|
|
result = wilc_enqueue_cmd(&msg);
|
|
if (result)
|
|
netdev_err(vif->ndev, "RX GTK\n");
|
|
else
|
|
wait_for_completion(&hif_drv->comp_test_key_block);
|
|
|
|
return result;
|
|
}
|
|
|
|
int wilc_set_pmkid_info(struct wilc_vif *vif,
|
|
struct host_if_pmkid_attr *pmkid)
|
|
{
|
|
int result = 0;
|
|
struct host_if_msg msg;
|
|
int i;
|
|
|
|
memset(&msg, 0, sizeof(struct host_if_msg));
|
|
|
|
msg.id = HOST_IF_MSG_KEY;
|
|
msg.body.key_info.type = PMKSA;
|
|
msg.body.key_info.action = ADDKEY;
|
|
msg.vif = vif;
|
|
|
|
for (i = 0; i < pmkid->numpmkid; i++) {
|
|
memcpy(msg.body.key_info.attr.pmkid.pmkidlist[i].bssid,
|
|
&pmkid->pmkidlist[i].bssid, ETH_ALEN);
|
|
memcpy(msg.body.key_info.attr.pmkid.pmkidlist[i].pmkid,
|
|
&pmkid->pmkidlist[i].pmkid, PMKID_LEN);
|
|
}
|
|
|
|
result = wilc_enqueue_cmd(&msg);
|
|
if (result)
|
|
netdev_err(vif->ndev, "PMKID Info\n");
|
|
|
|
return result;
|
|
}
|
|
|
|
int wilc_get_mac_address(struct wilc_vif *vif, u8 *mac_addr)
|
|
{
|
|
int result = 0;
|
|
struct host_if_msg msg;
|
|
|
|
memset(&msg, 0, sizeof(struct host_if_msg));
|
|
|
|
msg.id = HOST_IF_MSG_GET_MAC_ADDRESS;
|
|
msg.body.get_mac_info.mac_addr = mac_addr;
|
|
msg.vif = vif;
|
|
|
|
result = wilc_enqueue_cmd(&msg);
|
|
if (result) {
|
|
netdev_err(vif->ndev, "Failed to send get mac address\n");
|
|
return -EFAULT;
|
|
}
|
|
|
|
wait_for_completion(&hif_wait_response);
|
|
return result;
|
|
}
|
|
|
|
int wilc_set_join_req(struct wilc_vif *vif, u8 *bssid, const u8 *ssid,
|
|
size_t ssid_len, const u8 *ies, size_t ies_len,
|
|
wilc_connect_result connect_result, void *user_arg,
|
|
u8 security, enum AUTHTYPE auth_type,
|
|
u8 channel, void *join_params)
|
|
{
|
|
int result = 0;
|
|
struct host_if_msg msg;
|
|
struct host_if_drv *hif_drv = vif->hif_drv;
|
|
|
|
if (!hif_drv || !connect_result) {
|
|
netdev_err(vif->ndev, "Driver is null\n");
|
|
return -EFAULT;
|
|
}
|
|
|
|
if (!join_params) {
|
|
netdev_err(vif->ndev, "Unable to Join - JoinParams is NULL\n");
|
|
return -EFAULT;
|
|
}
|
|
|
|
memset(&msg, 0, sizeof(struct host_if_msg));
|
|
|
|
msg.id = HOST_IF_MSG_CONNECT;
|
|
|
|
msg.body.con_info.security = security;
|
|
msg.body.con_info.auth_type = auth_type;
|
|
msg.body.con_info.ch = channel;
|
|
msg.body.con_info.result = connect_result;
|
|
msg.body.con_info.arg = user_arg;
|
|
msg.body.con_info.params = join_params;
|
|
msg.vif = vif;
|
|
|
|
if (bssid) {
|
|
msg.body.con_info.bssid = kmemdup(bssid, 6, GFP_KERNEL);
|
|
if (!msg.body.con_info.bssid)
|
|
return -ENOMEM;
|
|
}
|
|
|
|
if (ssid) {
|
|
msg.body.con_info.ssid_len = ssid_len;
|
|
msg.body.con_info.ssid = kmemdup(ssid, ssid_len, GFP_KERNEL);
|
|
if (!msg.body.con_info.ssid)
|
|
return -ENOMEM;
|
|
}
|
|
|
|
if (ies) {
|
|
msg.body.con_info.ies_len = ies_len;
|
|
msg.body.con_info.ies = kmemdup(ies, ies_len, GFP_KERNEL);
|
|
if (!msg.body.con_info.ies)
|
|
return -ENOMEM;
|
|
}
|
|
if (hif_drv->hif_state < HOST_IF_CONNECTING)
|
|
hif_drv->hif_state = HOST_IF_CONNECTING;
|
|
|
|
result = wilc_enqueue_cmd(&msg);
|
|
if (result) {
|
|
netdev_err(vif->ndev, "send message: Set join request\n");
|
|
return -EFAULT;
|
|
}
|
|
|
|
hif_drv->connect_timer.data = (unsigned long)vif;
|
|
mod_timer(&hif_drv->connect_timer,
|
|
jiffies + msecs_to_jiffies(HOST_IF_CONNECT_TIMEOUT));
|
|
|
|
return result;
|
|
}
|
|
|
|
int wilc_disconnect(struct wilc_vif *vif, u16 reason_code)
|
|
{
|
|
int result = 0;
|
|
struct host_if_msg msg;
|
|
struct host_if_drv *hif_drv = vif->hif_drv;
|
|
|
|
if (!hif_drv) {
|
|
netdev_err(vif->ndev, "Driver is null\n");
|
|
return -EFAULT;
|
|
}
|
|
|
|
memset(&msg, 0, sizeof(struct host_if_msg));
|
|
|
|
msg.id = HOST_IF_MSG_DISCONNECT;
|
|
msg.vif = vif;
|
|
|
|
result = wilc_enqueue_cmd(&msg);
|
|
if (result)
|
|
netdev_err(vif->ndev, "Failed to send message: disconnect\n");
|
|
else
|
|
wait_for_completion(&hif_drv->comp_test_disconn_block);
|
|
|
|
return result;
|
|
}
|
|
|
|
static s32 host_int_get_assoc_res_info(struct wilc_vif *vif,
|
|
u8 *pu8AssocRespInfo,
|
|
u32 u32MaxAssocRespInfoLen,
|
|
u32 *pu32RcvdAssocRespInfoLen)
|
|
{
|
|
s32 result = 0;
|
|
struct wid wid;
|
|
|
|
wid.id = (u16)WID_ASSOC_RES_INFO;
|
|
wid.type = WID_STR;
|
|
wid.val = pu8AssocRespInfo;
|
|
wid.size = u32MaxAssocRespInfoLen;
|
|
|
|
result = wilc_send_config_pkt(vif, GET_CFG, &wid, 1,
|
|
wilc_get_vif_idx(vif));
|
|
if (result) {
|
|
*pu32RcvdAssocRespInfoLen = 0;
|
|
netdev_err(vif->ndev, "Failed to send association response\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
*pu32RcvdAssocRespInfoLen = wid.size;
|
|
return result;
|
|
}
|
|
|
|
int wilc_set_mac_chnl_num(struct wilc_vif *vif, u8 channel)
|
|
{
|
|
int result;
|
|
struct host_if_msg msg;
|
|
|
|
memset(&msg, 0, sizeof(struct host_if_msg));
|
|
msg.id = HOST_IF_MSG_SET_CHANNEL;
|
|
msg.body.channel_info.set_ch = channel;
|
|
msg.vif = vif;
|
|
|
|
result = wilc_enqueue_cmd(&msg);
|
|
if (result) {
|
|
netdev_err(vif->ndev, "wilc mq send fail\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
int wilc_set_wfi_drv_handler(struct wilc_vif *vif, int index, u8 mode,
|
|
u8 ifc_id)
|
|
{
|
|
int result = 0;
|
|
struct host_if_msg msg;
|
|
|
|
memset(&msg, 0, sizeof(struct host_if_msg));
|
|
msg.id = HOST_IF_MSG_SET_WFIDRV_HANDLER;
|
|
msg.body.drv.handler = index;
|
|
msg.body.drv.mode = mode;
|
|
msg.body.drv.name = ifc_id;
|
|
msg.vif = vif;
|
|
|
|
result = wilc_enqueue_cmd(&msg);
|
|
if (result) {
|
|
netdev_err(vif->ndev, "wilc mq send fail\n");
|
|
result = -EINVAL;
|
|
}
|
|
|
|
return result;
|
|
}
|
|
|
|
int wilc_set_operation_mode(struct wilc_vif *vif, u32 mode)
|
|
{
|
|
int result = 0;
|
|
struct host_if_msg msg;
|
|
|
|
memset(&msg, 0, sizeof(struct host_if_msg));
|
|
msg.id = HOST_IF_MSG_SET_OPERATION_MODE;
|
|
msg.body.mode.mode = mode;
|
|
msg.vif = vif;
|
|
|
|
result = wilc_enqueue_cmd(&msg);
|
|
if (result) {
|
|
netdev_err(vif->ndev, "wilc mq send fail\n");
|
|
result = -EINVAL;
|
|
}
|
|
|
|
return result;
|
|
}
|
|
|
|
s32 wilc_get_inactive_time(struct wilc_vif *vif, const u8 *mac,
|
|
u32 *pu32InactiveTime)
|
|
{
|
|
s32 result = 0;
|
|
struct host_if_msg msg;
|
|
struct host_if_drv *hif_drv = vif->hif_drv;
|
|
|
|
if (!hif_drv) {
|
|
netdev_err(vif->ndev, "driver is null\n");
|
|
return -EFAULT;
|
|
}
|
|
|
|
memset(&msg, 0, sizeof(struct host_if_msg));
|
|
memcpy(msg.body.mac_info.mac, mac, ETH_ALEN);
|
|
|
|
msg.id = HOST_IF_MSG_GET_INACTIVETIME;
|
|
msg.vif = vif;
|
|
|
|
result = wilc_enqueue_cmd(&msg);
|
|
if (result)
|
|
netdev_err(vif->ndev, "Failed to send get host ch param\n");
|
|
else
|
|
wait_for_completion(&hif_drv->comp_inactive_time);
|
|
|
|
*pu32InactiveTime = inactive_time;
|
|
|
|
return result;
|
|
}
|
|
|
|
int wilc_get_rssi(struct wilc_vif *vif, s8 *rssi_level)
|
|
{
|
|
int result = 0;
|
|
struct host_if_msg msg;
|
|
struct host_if_drv *hif_drv = vif->hif_drv;
|
|
|
|
memset(&msg, 0, sizeof(struct host_if_msg));
|
|
msg.id = HOST_IF_MSG_GET_RSSI;
|
|
msg.vif = vif;
|
|
|
|
result = wilc_enqueue_cmd(&msg);
|
|
if (result) {
|
|
netdev_err(vif->ndev, "Failed to send get host ch param\n");
|
|
return -EFAULT;
|
|
}
|
|
|
|
wait_for_completion(&hif_drv->comp_get_rssi);
|
|
|
|
if (!rssi_level) {
|
|
netdev_err(vif->ndev, "RSS pointer value is null\n");
|
|
return -EFAULT;
|
|
}
|
|
|
|
*rssi_level = rssi;
|
|
|
|
return result;
|
|
}
|
|
|
|
int wilc_get_statistics(struct wilc_vif *vif, struct rf_info *stats)
|
|
{
|
|
int result = 0;
|
|
struct host_if_msg msg;
|
|
|
|
memset(&msg, 0, sizeof(struct host_if_msg));
|
|
msg.id = HOST_IF_MSG_GET_STATISTICS;
|
|
msg.body.data = (char *)stats;
|
|
msg.vif = vif;
|
|
|
|
result = wilc_enqueue_cmd(&msg);
|
|
if (result) {
|
|
netdev_err(vif->ndev, "Failed to send get host channel\n");
|
|
return -EFAULT;
|
|
}
|
|
|
|
if (stats != &vif->wilc->dummy_statistics)
|
|
wait_for_completion(&hif_wait_response);
|
|
return result;
|
|
}
|
|
|
|
int wilc_scan(struct wilc_vif *vif, u8 scan_source, u8 scan_type,
|
|
u8 *ch_freq_list, u8 ch_list_len, const u8 *ies,
|
|
size_t ies_len, wilc_scan_result scan_result, void *user_arg,
|
|
struct hidden_network *hidden_network)
|
|
{
|
|
int result = 0;
|
|
struct host_if_msg msg;
|
|
struct scan_attr *scan_info = &msg.body.scan_info;
|
|
struct host_if_drv *hif_drv = vif->hif_drv;
|
|
|
|
if (!hif_drv || !scan_result) {
|
|
netdev_err(vif->ndev, "hif_drv or scan_result = NULL\n");
|
|
return -EFAULT;
|
|
}
|
|
|
|
memset(&msg, 0, sizeof(struct host_if_msg));
|
|
|
|
msg.id = HOST_IF_MSG_SCAN;
|
|
|
|
if (hidden_network) {
|
|
scan_info->hidden_network.net_info = hidden_network->net_info;
|
|
scan_info->hidden_network.n_ssids = hidden_network->n_ssids;
|
|
}
|
|
|
|
msg.vif = vif;
|
|
scan_info->src = scan_source;
|
|
scan_info->type = scan_type;
|
|
scan_info->result = scan_result;
|
|
scan_info->arg = user_arg;
|
|
|
|
scan_info->ch_list_len = ch_list_len;
|
|
scan_info->ch_freq_list = kmemdup(ch_freq_list,
|
|
ch_list_len,
|
|
GFP_KERNEL);
|
|
if (!scan_info->ch_freq_list)
|
|
return -ENOMEM;
|
|
|
|
scan_info->ies_len = ies_len;
|
|
scan_info->ies = kmemdup(ies, ies_len, GFP_KERNEL);
|
|
if (!scan_info->ies)
|
|
return -ENOMEM;
|
|
|
|
result = wilc_enqueue_cmd(&msg);
|
|
if (result) {
|
|
netdev_err(vif->ndev, "Error in sending message queue\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
hif_drv->scan_timer.data = (unsigned long)vif;
|
|
mod_timer(&hif_drv->scan_timer,
|
|
jiffies + msecs_to_jiffies(HOST_IF_SCAN_TIMEOUT));
|
|
|
|
return result;
|
|
}
|
|
|
|
int wilc_hif_set_cfg(struct wilc_vif *vif,
|
|
struct cfg_param_attr *cfg_param)
|
|
{
|
|
struct host_if_msg msg;
|
|
struct host_if_drv *hif_drv = vif->hif_drv;
|
|
|
|
if (!hif_drv) {
|
|
netdev_err(vif->ndev, "hif_drv NULL\n");
|
|
return -EFAULT;
|
|
}
|
|
|
|
memset(&msg, 0, sizeof(struct host_if_msg));
|
|
msg.id = HOST_IF_MSG_CFG_PARAMS;
|
|
msg.body.cfg_info = *cfg_param;
|
|
msg.vif = vif;
|
|
|
|
return wilc_enqueue_cmd(&msg);
|
|
}
|
|
|
|
static void GetPeriodicRSSI(unsigned long arg)
|
|
{
|
|
struct wilc_vif *vif = (struct wilc_vif *)arg;
|
|
|
|
if (!vif->hif_drv) {
|
|
netdev_err(vif->ndev, "Driver handler is NULL\n");
|
|
return;
|
|
}
|
|
|
|
if (vif->hif_drv->hif_state == HOST_IF_CONNECTED)
|
|
wilc_get_statistics(vif, &vif->wilc->dummy_statistics);
|
|
|
|
periodic_rssi.data = (unsigned long)vif;
|
|
mod_timer(&periodic_rssi, jiffies + msecs_to_jiffies(5000));
|
|
}
|
|
|
|
int wilc_init(struct net_device *dev, struct host_if_drv **hif_drv_handler)
|
|
{
|
|
int result = 0;
|
|
struct host_if_drv *hif_drv;
|
|
struct wilc_vif *vif;
|
|
struct wilc *wilc;
|
|
int i;
|
|
|
|
vif = netdev_priv(dev);
|
|
wilc = vif->wilc;
|
|
|
|
scan_while_connected = false;
|
|
|
|
init_completion(&hif_wait_response);
|
|
|
|
hif_drv = kzalloc(sizeof(*hif_drv), GFP_KERNEL);
|
|
if (!hif_drv) {
|
|
result = -ENOMEM;
|
|
goto _fail_;
|
|
}
|
|
*hif_drv_handler = hif_drv;
|
|
for (i = 0; i < wilc->vif_num; i++)
|
|
if (dev == wilc->vif[i]->ndev) {
|
|
wilc->vif[i]->hif_drv = hif_drv;
|
|
hif_drv->driver_handler_id = i + 1;
|
|
break;
|
|
}
|
|
|
|
wilc_optaining_ip = false;
|
|
|
|
if (clients_count == 0) {
|
|
init_completion(&hif_thread_comp);
|
|
init_completion(&hif_driver_comp);
|
|
mutex_init(&hif_deinit_lock);
|
|
}
|
|
|
|
init_completion(&hif_drv->comp_test_key_block);
|
|
init_completion(&hif_drv->comp_test_disconn_block);
|
|
init_completion(&hif_drv->comp_get_rssi);
|
|
init_completion(&hif_drv->comp_inactive_time);
|
|
|
|
if (clients_count == 0) {
|
|
hif_workqueue = create_singlethread_workqueue("WILC_wq");
|
|
if (!hif_workqueue) {
|
|
netdev_err(vif->ndev, "Failed to create workqueue\n");
|
|
result = -ENOMEM;
|
|
goto _fail_;
|
|
}
|
|
|
|
setup_timer(&periodic_rssi, GetPeriodicRSSI,
|
|
(unsigned long)vif);
|
|
mod_timer(&periodic_rssi, jiffies + msecs_to_jiffies(5000));
|
|
}
|
|
|
|
setup_timer(&hif_drv->scan_timer, TimerCB_Scan, 0);
|
|
setup_timer(&hif_drv->connect_timer, TimerCB_Connect, 0);
|
|
setup_timer(&hif_drv->remain_on_ch_timer, ListenTimerCB, 0);
|
|
|
|
mutex_init(&hif_drv->cfg_values_lock);
|
|
mutex_lock(&hif_drv->cfg_values_lock);
|
|
|
|
hif_drv->hif_state = HOST_IF_IDLE;
|
|
hif_drv->cfg_values.site_survey_enabled = SITE_SURVEY_OFF;
|
|
hif_drv->cfg_values.scan_source = DEFAULT_SCAN;
|
|
hif_drv->cfg_values.active_scan_time = ACTIVE_SCAN_TIME;
|
|
hif_drv->cfg_values.passive_scan_time = PASSIVE_SCAN_TIME;
|
|
hif_drv->cfg_values.curr_tx_rate = AUTORATE;
|
|
|
|
hif_drv->p2p_timeout = 0;
|
|
|
|
mutex_unlock(&hif_drv->cfg_values_lock);
|
|
|
|
clients_count++;
|
|
|
|
_fail_:
|
|
return result;
|
|
}
|
|
|
|
int wilc_deinit(struct wilc_vif *vif)
|
|
{
|
|
int result = 0;
|
|
struct host_if_msg msg;
|
|
struct host_if_drv *hif_drv = vif->hif_drv;
|
|
|
|
if (!hif_drv) {
|
|
netdev_err(vif->ndev, "hif_drv = NULL\n");
|
|
return -EFAULT;
|
|
}
|
|
|
|
mutex_lock(&hif_deinit_lock);
|
|
|
|
terminated_handle = hif_drv;
|
|
|
|
del_timer_sync(&hif_drv->scan_timer);
|
|
del_timer_sync(&hif_drv->connect_timer);
|
|
del_timer_sync(&periodic_rssi);
|
|
del_timer_sync(&hif_drv->remain_on_ch_timer);
|
|
|
|
wilc_set_wfi_drv_handler(vif, 0, 0, 0);
|
|
wait_for_completion(&hif_driver_comp);
|
|
|
|
if (hif_drv->usr_scan_req.scan_result) {
|
|
hif_drv->usr_scan_req.scan_result(SCAN_EVENT_ABORTED, NULL,
|
|
hif_drv->usr_scan_req.arg, NULL);
|
|
hif_drv->usr_scan_req.scan_result = NULL;
|
|
}
|
|
|
|
hif_drv->hif_state = HOST_IF_IDLE;
|
|
|
|
scan_while_connected = false;
|
|
|
|
memset(&msg, 0, sizeof(struct host_if_msg));
|
|
|
|
if (clients_count == 1) {
|
|
msg.id = HOST_IF_MSG_EXIT;
|
|
msg.vif = vif;
|
|
|
|
result = wilc_enqueue_cmd(&msg);
|
|
if (result != 0)
|
|
netdev_err(vif->ndev, "deinit : Error(%d)\n", result);
|
|
else
|
|
wait_for_completion(&hif_thread_comp);
|
|
|
|
destroy_workqueue(hif_workqueue);
|
|
}
|
|
|
|
kfree(hif_drv);
|
|
|
|
clients_count--;
|
|
terminated_handle = NULL;
|
|
mutex_unlock(&hif_deinit_lock);
|
|
return result;
|
|
}
|
|
|
|
void wilc_network_info_received(struct wilc *wilc, u8 *buffer, u32 length)
|
|
{
|
|
s32 result = 0;
|
|
struct host_if_msg msg;
|
|
int id;
|
|
struct host_if_drv *hif_drv = NULL;
|
|
struct wilc_vif *vif;
|
|
|
|
id = ((buffer[length - 4]) | (buffer[length - 3] << 8) | (buffer[length - 2] << 16) | (buffer[length - 1] << 24));
|
|
vif = wilc_get_vif_from_idx(wilc, id);
|
|
if (!vif)
|
|
return;
|
|
hif_drv = vif->hif_drv;
|
|
|
|
if (!hif_drv || hif_drv == terminated_handle) {
|
|
netdev_err(vif->ndev, "driver not init[%p]\n", hif_drv);
|
|
return;
|
|
}
|
|
|
|
memset(&msg, 0, sizeof(struct host_if_msg));
|
|
|
|
msg.id = HOST_IF_MSG_RCVD_NTWRK_INFO;
|
|
msg.vif = vif;
|
|
|
|
msg.body.net_info.len = length;
|
|
msg.body.net_info.buffer = kmalloc(length, GFP_KERNEL);
|
|
memcpy(msg.body.net_info.buffer, buffer, length);
|
|
|
|
result = wilc_enqueue_cmd(&msg);
|
|
if (result)
|
|
netdev_err(vif->ndev, "message parameters (%d)\n", result);
|
|
}
|
|
|
|
void wilc_gnrl_async_info_received(struct wilc *wilc, u8 *buffer, u32 length)
|
|
{
|
|
s32 result = 0;
|
|
struct host_if_msg msg;
|
|
int id;
|
|
struct host_if_drv *hif_drv = NULL;
|
|
struct wilc_vif *vif;
|
|
|
|
mutex_lock(&hif_deinit_lock);
|
|
|
|
id = ((buffer[length - 4]) | (buffer[length - 3] << 8) | (buffer[length - 2] << 16) | (buffer[length - 1] << 24));
|
|
vif = wilc_get_vif_from_idx(wilc, id);
|
|
if (!vif) {
|
|
mutex_unlock(&hif_deinit_lock);
|
|
return;
|
|
}
|
|
|
|
hif_drv = vif->hif_drv;
|
|
|
|
if (!hif_drv || hif_drv == terminated_handle) {
|
|
mutex_unlock(&hif_deinit_lock);
|
|
return;
|
|
}
|
|
|
|
if (!hif_drv->usr_conn_req.conn_result) {
|
|
netdev_err(vif->ndev, "there is no current Connect Request\n");
|
|
mutex_unlock(&hif_deinit_lock);
|
|
return;
|
|
}
|
|
|
|
memset(&msg, 0, sizeof(struct host_if_msg));
|
|
|
|
msg.id = HOST_IF_MSG_RCVD_GNRL_ASYNC_INFO;
|
|
msg.vif = vif;
|
|
|
|
msg.body.async_info.len = length;
|
|
msg.body.async_info.buffer = kmalloc(length, GFP_KERNEL);
|
|
memcpy(msg.body.async_info.buffer, buffer, length);
|
|
|
|
result = wilc_enqueue_cmd(&msg);
|
|
if (result)
|
|
netdev_err(vif->ndev, "synchronous info (%d)\n", result);
|
|
|
|
mutex_unlock(&hif_deinit_lock);
|
|
}
|
|
|
|
void wilc_scan_complete_received(struct wilc *wilc, u8 *buffer, u32 length)
|
|
{
|
|
s32 result = 0;
|
|
struct host_if_msg msg;
|
|
int id;
|
|
struct host_if_drv *hif_drv = NULL;
|
|
struct wilc_vif *vif;
|
|
|
|
id = ((buffer[length - 4]) | (buffer[length - 3] << 8) | (buffer[length - 2] << 16) | (buffer[length - 1] << 24));
|
|
vif = wilc_get_vif_from_idx(wilc, id);
|
|
if (!vif)
|
|
return;
|
|
hif_drv = vif->hif_drv;
|
|
|
|
if (!hif_drv || hif_drv == terminated_handle)
|
|
return;
|
|
|
|
if (hif_drv->usr_scan_req.scan_result) {
|
|
memset(&msg, 0, sizeof(struct host_if_msg));
|
|
|
|
msg.id = HOST_IF_MSG_RCVD_SCAN_COMPLETE;
|
|
msg.vif = vif;
|
|
|
|
result = wilc_enqueue_cmd(&msg);
|
|
if (result)
|
|
netdev_err(vif->ndev, "complete param (%d)\n", result);
|
|
}
|
|
}
|
|
|
|
int wilc_remain_on_channel(struct wilc_vif *vif, u32 session_id,
|
|
u32 duration, u16 chan,
|
|
wilc_remain_on_chan_expired expired,
|
|
wilc_remain_on_chan_ready ready,
|
|
void *user_arg)
|
|
{
|
|
int result = 0;
|
|
struct host_if_msg msg;
|
|
|
|
memset(&msg, 0, sizeof(struct host_if_msg));
|
|
|
|
msg.id = HOST_IF_MSG_REMAIN_ON_CHAN;
|
|
msg.body.remain_on_ch.ch = chan;
|
|
msg.body.remain_on_ch.expired = expired;
|
|
msg.body.remain_on_ch.ready = ready;
|
|
msg.body.remain_on_ch.arg = user_arg;
|
|
msg.body.remain_on_ch.duration = duration;
|
|
msg.body.remain_on_ch.id = session_id;
|
|
msg.vif = vif;
|
|
|
|
result = wilc_enqueue_cmd(&msg);
|
|
if (result)
|
|
netdev_err(vif->ndev, "wilc mq send fail\n");
|
|
|
|
return result;
|
|
}
|
|
|
|
int wilc_listen_state_expired(struct wilc_vif *vif, u32 session_id)
|
|
{
|
|
int result = 0;
|
|
struct host_if_msg msg;
|
|
struct host_if_drv *hif_drv = vif->hif_drv;
|
|
|
|
if (!hif_drv) {
|
|
netdev_err(vif->ndev, "driver is null\n");
|
|
return -EFAULT;
|
|
}
|
|
|
|
del_timer(&hif_drv->remain_on_ch_timer);
|
|
|
|
memset(&msg, 0, sizeof(struct host_if_msg));
|
|
msg.id = HOST_IF_MSG_LISTEN_TIMER_FIRED;
|
|
msg.vif = vif;
|
|
msg.body.remain_on_ch.id = session_id;
|
|
|
|
result = wilc_enqueue_cmd(&msg);
|
|
if (result)
|
|
netdev_err(vif->ndev, "wilc mq send fail\n");
|
|
|
|
return result;
|
|
}
|
|
|
|
int wilc_frame_register(struct wilc_vif *vif, u16 frame_type, bool reg)
|
|
{
|
|
int result = 0;
|
|
struct host_if_msg msg;
|
|
|
|
memset(&msg, 0, sizeof(struct host_if_msg));
|
|
|
|
msg.id = HOST_IF_MSG_REGISTER_FRAME;
|
|
switch (frame_type) {
|
|
case ACTION:
|
|
msg.body.reg_frame.reg_id = ACTION_FRM_IDX;
|
|
break;
|
|
|
|
case PROBE_REQ:
|
|
msg.body.reg_frame.reg_id = PROBE_REQ_IDX;
|
|
break;
|
|
|
|
default:
|
|
break;
|
|
}
|
|
msg.body.reg_frame.frame_type = frame_type;
|
|
msg.body.reg_frame.reg = reg;
|
|
msg.vif = vif;
|
|
|
|
result = wilc_enqueue_cmd(&msg);
|
|
if (result)
|
|
netdev_err(vif->ndev, "wilc mq send fail\n");
|
|
|
|
return result;
|
|
}
|
|
|
|
int wilc_add_beacon(struct wilc_vif *vif, u32 interval, u32 dtim_period,
|
|
u32 head_len, u8 *head, u32 tail_len, u8 *tail)
|
|
{
|
|
int result = 0;
|
|
struct host_if_msg msg;
|
|
struct beacon_attr *beacon_info = &msg.body.beacon_info;
|
|
|
|
memset(&msg, 0, sizeof(struct host_if_msg));
|
|
|
|
msg.id = HOST_IF_MSG_ADD_BEACON;
|
|
msg.vif = vif;
|
|
beacon_info->interval = interval;
|
|
beacon_info->dtim_period = dtim_period;
|
|
beacon_info->head_len = head_len;
|
|
beacon_info->head = kmemdup(head, head_len, GFP_KERNEL);
|
|
if (!beacon_info->head) {
|
|
result = -ENOMEM;
|
|
goto ERRORHANDLER;
|
|
}
|
|
beacon_info->tail_len = tail_len;
|
|
|
|
if (tail_len > 0) {
|
|
beacon_info->tail = kmemdup(tail, tail_len, GFP_KERNEL);
|
|
if (!beacon_info->tail) {
|
|
result = -ENOMEM;
|
|
goto ERRORHANDLER;
|
|
}
|
|
} else {
|
|
beacon_info->tail = NULL;
|
|
}
|
|
|
|
result = wilc_enqueue_cmd(&msg);
|
|
if (result)
|
|
netdev_err(vif->ndev, "wilc mq send fail\n");
|
|
|
|
ERRORHANDLER:
|
|
if (result) {
|
|
kfree(beacon_info->head);
|
|
|
|
kfree(beacon_info->tail);
|
|
}
|
|
|
|
return result;
|
|
}
|
|
|
|
int wilc_del_beacon(struct wilc_vif *vif)
|
|
{
|
|
int result = 0;
|
|
struct host_if_msg msg;
|
|
|
|
msg.id = HOST_IF_MSG_DEL_BEACON;
|
|
msg.vif = vif;
|
|
|
|
result = wilc_enqueue_cmd(&msg);
|
|
if (result)
|
|
netdev_err(vif->ndev, "wilc_mq_send fail\n");
|
|
|
|
return result;
|
|
}
|
|
|
|
int wilc_add_station(struct wilc_vif *vif, struct add_sta_param *sta_param)
|
|
{
|
|
int result = 0;
|
|
struct host_if_msg msg;
|
|
struct add_sta_param *add_sta_info = &msg.body.add_sta_info;
|
|
|
|
memset(&msg, 0, sizeof(struct host_if_msg));
|
|
|
|
msg.id = HOST_IF_MSG_ADD_STATION;
|
|
msg.vif = vif;
|
|
|
|
memcpy(add_sta_info, sta_param, sizeof(struct add_sta_param));
|
|
if (add_sta_info->rates_len > 0) {
|
|
add_sta_info->rates = kmemdup(sta_param->rates,
|
|
add_sta_info->rates_len,
|
|
GFP_KERNEL);
|
|
if (!add_sta_info->rates)
|
|
return -ENOMEM;
|
|
}
|
|
|
|
result = wilc_enqueue_cmd(&msg);
|
|
if (result)
|
|
netdev_err(vif->ndev, "wilc_mq_send fail\n");
|
|
return result;
|
|
}
|
|
|
|
int wilc_del_station(struct wilc_vif *vif, const u8 *mac_addr)
|
|
{
|
|
int result = 0;
|
|
struct host_if_msg msg;
|
|
struct del_sta *del_sta_info = &msg.body.del_sta_info;
|
|
|
|
memset(&msg, 0, sizeof(struct host_if_msg));
|
|
|
|
msg.id = HOST_IF_MSG_DEL_STATION;
|
|
msg.vif = vif;
|
|
|
|
if (!mac_addr)
|
|
eth_broadcast_addr(del_sta_info->mac_addr);
|
|
else
|
|
memcpy(del_sta_info->mac_addr, mac_addr, ETH_ALEN);
|
|
|
|
result = wilc_enqueue_cmd(&msg);
|
|
if (result)
|
|
netdev_err(vif->ndev, "wilc_mq_send fail\n");
|
|
return result;
|
|
}
|
|
|
|
int wilc_del_allstation(struct wilc_vif *vif, u8 mac_addr[][ETH_ALEN])
|
|
{
|
|
int result = 0;
|
|
struct host_if_msg msg;
|
|
struct del_all_sta *del_all_sta_info = &msg.body.del_all_sta_info;
|
|
u8 zero_addr[ETH_ALEN] = {0};
|
|
int i;
|
|
u8 assoc_sta = 0;
|
|
|
|
memset(&msg, 0, sizeof(struct host_if_msg));
|
|
|
|
msg.id = HOST_IF_MSG_DEL_ALL_STA;
|
|
msg.vif = vif;
|
|
|
|
for (i = 0; i < MAX_NUM_STA; i++) {
|
|
if (memcmp(mac_addr[i], zero_addr, ETH_ALEN)) {
|
|
memcpy(del_all_sta_info->del_all_sta[i], mac_addr[i], ETH_ALEN);
|
|
assoc_sta++;
|
|
}
|
|
}
|
|
if (!assoc_sta)
|
|
return result;
|
|
|
|
del_all_sta_info->assoc_sta = assoc_sta;
|
|
result = wilc_enqueue_cmd(&msg);
|
|
|
|
if (result)
|
|
netdev_err(vif->ndev, "wilc_mq_send fail\n");
|
|
else
|
|
wait_for_completion(&hif_wait_response);
|
|
|
|
return result;
|
|
}
|
|
|
|
int wilc_edit_station(struct wilc_vif *vif,
|
|
struct add_sta_param *sta_param)
|
|
{
|
|
int result = 0;
|
|
struct host_if_msg msg;
|
|
struct add_sta_param *add_sta_info = &msg.body.add_sta_info;
|
|
|
|
memset(&msg, 0, sizeof(struct host_if_msg));
|
|
|
|
msg.id = HOST_IF_MSG_EDIT_STATION;
|
|
msg.vif = vif;
|
|
|
|
memcpy(add_sta_info, sta_param, sizeof(struct add_sta_param));
|
|
if (add_sta_info->rates_len > 0) {
|
|
add_sta_info->rates = kmemdup(sta_param->rates,
|
|
add_sta_info->rates_len,
|
|
GFP_KERNEL);
|
|
if (!add_sta_info->rates)
|
|
return -ENOMEM;
|
|
}
|
|
|
|
result = wilc_enqueue_cmd(&msg);
|
|
if (result)
|
|
netdev_err(vif->ndev, "wilc_mq_send fail\n");
|
|
|
|
return result;
|
|
}
|
|
|
|
int wilc_set_power_mgmt(struct wilc_vif *vif, bool enabled, u32 timeout)
|
|
{
|
|
int result = 0;
|
|
struct host_if_msg msg;
|
|
struct power_mgmt_param *pwr_mgmt_info = &msg.body.pwr_mgmt_info;
|
|
|
|
if (wilc_wlan_get_num_conn_ifcs(vif->wilc) == 2 && enabled)
|
|
return 0;
|
|
|
|
memset(&msg, 0, sizeof(struct host_if_msg));
|
|
|
|
msg.id = HOST_IF_MSG_POWER_MGMT;
|
|
msg.vif = vif;
|
|
|
|
pwr_mgmt_info->enabled = enabled;
|
|
pwr_mgmt_info->timeout = timeout;
|
|
|
|
result = wilc_enqueue_cmd(&msg);
|
|
if (result)
|
|
netdev_err(vif->ndev, "wilc_mq_send fail\n");
|
|
return result;
|
|
}
|
|
|
|
int wilc_setup_multicast_filter(struct wilc_vif *vif, bool enabled,
|
|
u32 count)
|
|
{
|
|
int result = 0;
|
|
struct host_if_msg msg;
|
|
struct set_multicast *multicast_filter_param = &msg.body.multicast_info;
|
|
|
|
memset(&msg, 0, sizeof(struct host_if_msg));
|
|
|
|
msg.id = HOST_IF_MSG_SET_MULTICAST_FILTER;
|
|
msg.vif = vif;
|
|
|
|
multicast_filter_param->enabled = enabled;
|
|
multicast_filter_param->cnt = count;
|
|
|
|
result = wilc_enqueue_cmd(&msg);
|
|
if (result)
|
|
netdev_err(vif->ndev, "wilc_mq_send fail\n");
|
|
return result;
|
|
}
|
|
|
|
static void *host_int_ParseJoinBssParam(struct network_info *ptstrNetworkInfo)
|
|
{
|
|
struct join_bss_param *pNewJoinBssParam = NULL;
|
|
u8 *pu8IEs;
|
|
u16 u16IEsLen;
|
|
u16 index = 0;
|
|
u8 suppRatesNo = 0;
|
|
u8 extSuppRatesNo;
|
|
u16 jumpOffset;
|
|
u8 pcipherCount;
|
|
u8 authCount;
|
|
u8 pcipherTotalCount = 0;
|
|
u8 authTotalCount = 0;
|
|
u8 i, j;
|
|
|
|
pu8IEs = ptstrNetworkInfo->ies;
|
|
u16IEsLen = ptstrNetworkInfo->ies_len;
|
|
|
|
pNewJoinBssParam = kzalloc(sizeof(*pNewJoinBssParam), GFP_KERNEL);
|
|
if (pNewJoinBssParam) {
|
|
pNewJoinBssParam->dtim_period = ptstrNetworkInfo->dtim_period;
|
|
pNewJoinBssParam->beacon_period = ptstrNetworkInfo->beacon_period;
|
|
pNewJoinBssParam->cap_info = ptstrNetworkInfo->cap_info;
|
|
memcpy(pNewJoinBssParam->bssid, ptstrNetworkInfo->bssid, 6);
|
|
memcpy((u8 *)pNewJoinBssParam->ssid, ptstrNetworkInfo->ssid,
|
|
ptstrNetworkInfo->ssid_len + 1);
|
|
pNewJoinBssParam->ssid_len = ptstrNetworkInfo->ssid_len;
|
|
memset(pNewJoinBssParam->rsn_pcip_policy, 0xFF, 3);
|
|
memset(pNewJoinBssParam->rsn_auth_policy, 0xFF, 3);
|
|
|
|
while (index < u16IEsLen) {
|
|
if (pu8IEs[index] == SUPP_RATES_IE) {
|
|
suppRatesNo = pu8IEs[index + 1];
|
|
pNewJoinBssParam->supp_rates[0] = suppRatesNo;
|
|
index += 2;
|
|
|
|
for (i = 0; i < suppRatesNo; i++)
|
|
pNewJoinBssParam->supp_rates[i + 1] = pu8IEs[index + i];
|
|
|
|
index += suppRatesNo;
|
|
} else if (pu8IEs[index] == EXT_SUPP_RATES_IE) {
|
|
extSuppRatesNo = pu8IEs[index + 1];
|
|
if (extSuppRatesNo > (MAX_RATES_SUPPORTED - suppRatesNo))
|
|
pNewJoinBssParam->supp_rates[0] = MAX_RATES_SUPPORTED;
|
|
else
|
|
pNewJoinBssParam->supp_rates[0] += extSuppRatesNo;
|
|
index += 2;
|
|
for (i = 0; i < (pNewJoinBssParam->supp_rates[0] - suppRatesNo); i++)
|
|
pNewJoinBssParam->supp_rates[suppRatesNo + i + 1] = pu8IEs[index + i];
|
|
|
|
index += extSuppRatesNo;
|
|
} else if (pu8IEs[index] == HT_CAPABILITY_IE) {
|
|
pNewJoinBssParam->ht_capable = true;
|
|
index += pu8IEs[index + 1] + 2;
|
|
} else if ((pu8IEs[index] == WMM_IE) &&
|
|
(pu8IEs[index + 2] == 0x00) && (pu8IEs[index + 3] == 0x50) &&
|
|
(pu8IEs[index + 4] == 0xF2) &&
|
|
(pu8IEs[index + 5] == 0x02) &&
|
|
((pu8IEs[index + 6] == 0x00) || (pu8IEs[index + 6] == 0x01)) &&
|
|
(pu8IEs[index + 7] == 0x01)) {
|
|
pNewJoinBssParam->wmm_cap = true;
|
|
|
|
if (pu8IEs[index + 8] & BIT(7))
|
|
pNewJoinBssParam->uapsd_cap = true;
|
|
index += pu8IEs[index + 1] + 2;
|
|
} else if ((pu8IEs[index] == P2P_IE) &&
|
|
(pu8IEs[index + 2] == 0x50) && (pu8IEs[index + 3] == 0x6f) &&
|
|
(pu8IEs[index + 4] == 0x9a) &&
|
|
(pu8IEs[index + 5] == 0x09) && (pu8IEs[index + 6] == 0x0c)) {
|
|
u16 u16P2P_count;
|
|
|
|
pNewJoinBssParam->tsf = ptstrNetworkInfo->tsf_lo;
|
|
pNewJoinBssParam->noa_enabled = 1;
|
|
pNewJoinBssParam->idx = pu8IEs[index + 9];
|
|
|
|
if (pu8IEs[index + 10] & BIT(7)) {
|
|
pNewJoinBssParam->opp_enabled = 1;
|
|
pNewJoinBssParam->ct_window = pu8IEs[index + 10];
|
|
} else {
|
|
pNewJoinBssParam->opp_enabled = 0;
|
|
}
|
|
|
|
pNewJoinBssParam->cnt = pu8IEs[index + 11];
|
|
u16P2P_count = index + 12;
|
|
|
|
memcpy(pNewJoinBssParam->duration, pu8IEs + u16P2P_count, 4);
|
|
u16P2P_count += 4;
|
|
|
|
memcpy(pNewJoinBssParam->interval, pu8IEs + u16P2P_count, 4);
|
|
u16P2P_count += 4;
|
|
|
|
memcpy(pNewJoinBssParam->start_time, pu8IEs + u16P2P_count, 4);
|
|
|
|
index += pu8IEs[index + 1] + 2;
|
|
} else if ((pu8IEs[index] == RSN_IE) ||
|
|
((pu8IEs[index] == WPA_IE) && (pu8IEs[index + 2] == 0x00) &&
|
|
(pu8IEs[index + 3] == 0x50) && (pu8IEs[index + 4] == 0xF2) &&
|
|
(pu8IEs[index + 5] == 0x01))) {
|
|
u16 rsnIndex = index;
|
|
|
|
if (pu8IEs[rsnIndex] == RSN_IE) {
|
|
pNewJoinBssParam->mode_802_11i = 2;
|
|
} else {
|
|
if (pNewJoinBssParam->mode_802_11i == 0)
|
|
pNewJoinBssParam->mode_802_11i = 1;
|
|
rsnIndex += 4;
|
|
}
|
|
|
|
rsnIndex += 7;
|
|
pNewJoinBssParam->rsn_grp_policy = pu8IEs[rsnIndex];
|
|
rsnIndex++;
|
|
jumpOffset = pu8IEs[rsnIndex] * 4;
|
|
pcipherCount = (pu8IEs[rsnIndex] > 3) ? 3 : pu8IEs[rsnIndex];
|
|
rsnIndex += 2;
|
|
|
|
for (i = pcipherTotalCount, j = 0; i < pcipherCount + pcipherTotalCount && i < 3; i++, j++)
|
|
pNewJoinBssParam->rsn_pcip_policy[i] = pu8IEs[rsnIndex + ((j + 1) * 4) - 1];
|
|
|
|
pcipherTotalCount += pcipherCount;
|
|
rsnIndex += jumpOffset;
|
|
|
|
jumpOffset = pu8IEs[rsnIndex] * 4;
|
|
|
|
authCount = (pu8IEs[rsnIndex] > 3) ? 3 : pu8IEs[rsnIndex];
|
|
rsnIndex += 2;
|
|
|
|
for (i = authTotalCount, j = 0; i < authTotalCount + authCount; i++, j++)
|
|
pNewJoinBssParam->rsn_auth_policy[i] = pu8IEs[rsnIndex + ((j + 1) * 4) - 1];
|
|
|
|
authTotalCount += authCount;
|
|
rsnIndex += jumpOffset;
|
|
|
|
if (pu8IEs[index] == RSN_IE) {
|
|
pNewJoinBssParam->rsn_cap[0] = pu8IEs[rsnIndex];
|
|
pNewJoinBssParam->rsn_cap[1] = pu8IEs[rsnIndex + 1];
|
|
rsnIndex += 2;
|
|
}
|
|
pNewJoinBssParam->rsn_found = true;
|
|
index += pu8IEs[index + 1] + 2;
|
|
} else {
|
|
index += pu8IEs[index + 1] + 2;
|
|
}
|
|
}
|
|
}
|
|
|
|
return (void *)pNewJoinBssParam;
|
|
}
|
|
|
|
int wilc_setup_ipaddress(struct wilc_vif *vif, u8 *ip_addr, u8 idx)
|
|
{
|
|
int result = 0;
|
|
struct host_if_msg msg;
|
|
|
|
memset(&msg, 0, sizeof(struct host_if_msg));
|
|
|
|
msg.id = HOST_IF_MSG_SET_IPADDRESS;
|
|
|
|
msg.body.ip_info.ip_addr = ip_addr;
|
|
msg.vif = vif;
|
|
msg.body.ip_info.idx = idx;
|
|
|
|
result = wilc_enqueue_cmd(&msg);
|
|
if (result)
|
|
netdev_err(vif->ndev, "wilc_mq_send fail\n");
|
|
|
|
return result;
|
|
}
|
|
|
|
static int host_int_get_ipaddress(struct wilc_vif *vif, u8 *ip_addr, u8 idx)
|
|
{
|
|
int result = 0;
|
|
struct host_if_msg msg;
|
|
|
|
memset(&msg, 0, sizeof(struct host_if_msg));
|
|
|
|
msg.id = HOST_IF_MSG_GET_IPADDRESS;
|
|
|
|
msg.body.ip_info.ip_addr = ip_addr;
|
|
msg.vif = vif;
|
|
msg.body.ip_info.idx = idx;
|
|
|
|
result = wilc_enqueue_cmd(&msg);
|
|
if (result)
|
|
netdev_err(vif->ndev, "wilc_mq_send fail\n");
|
|
|
|
return result;
|
|
}
|
|
|
|
int wilc_set_tx_power(struct wilc_vif *vif, u8 tx_power)
|
|
{
|
|
int ret = 0;
|
|
struct host_if_msg msg;
|
|
|
|
memset(&msg, 0, sizeof(struct host_if_msg));
|
|
|
|
msg.id = HOST_IF_MSG_SET_TX_POWER;
|
|
msg.body.tx_power.tx_pwr = tx_power;
|
|
msg.vif = vif;
|
|
|
|
ret = wilc_enqueue_cmd(&msg);
|
|
if (ret)
|
|
netdev_err(vif->ndev, "wilc_mq_send fail\n");
|
|
|
|
return ret;
|
|
}
|
|
|
|
int wilc_get_tx_power(struct wilc_vif *vif, u8 *tx_power)
|
|
{
|
|
int ret = 0;
|
|
struct host_if_msg msg;
|
|
|
|
memset(&msg, 0, sizeof(struct host_if_msg));
|
|
|
|
msg.id = HOST_IF_MSG_GET_TX_POWER;
|
|
msg.vif = vif;
|
|
|
|
ret = wilc_enqueue_cmd(&msg);
|
|
if (ret)
|
|
netdev_err(vif->ndev, "Failed to get TX PWR\n");
|
|
|
|
wait_for_completion(&hif_wait_response);
|
|
*tx_power = msg.body.tx_power.tx_pwr;
|
|
|
|
return ret;
|
|
}
|