drivers/staging/wilc1000/host_interface.c

   1 #include <linux/slab.h>
   2 #include <linux/time.h>
   3 #include <linux/kthread.h>
   4 #include <linux/delay.h>
   5 #include "host_interface.h"
   6 #include "coreconfigurator.h"
   7 #include "wilc_wlan_if.h"
   8 #include "wilc_msgqueue.h"
   9 #include <linux/etherdevice.h>
  10 #include "wilc_wfi_netdevice.h"
  11
  12 extern u8 connecting;
  13
  14 extern struct timer_list hDuringIpTimer;
  15
  16 extern u8 g_wilc_initialized;
  17
  18 #define HOST_IF_MSG_SCAN                        0
  19 #define HOST_IF_MSG_CONNECT                     1
  20 #define HOST_IF_MSG_RCVD_GNRL_ASYNC_INFO        2
  21 #define HOST_IF_MSG_KEY                         3
  22 #define HOST_IF_MSG_RCVD_NTWRK_INFO             4
  23 #define HOST_IF_MSG_RCVD_SCAN_COMPLETE          5
  24 #define HOST_IF_MSG_CFG_PARAMS                  6
  25 #define HOST_IF_MSG_SET_CHANNEL                 7
  26 #define HOST_IF_MSG_DISCONNECT                  8
  27 #define HOST_IF_MSG_GET_RSSI                    9
  28 #define HOST_IF_MSG_GET_CHNL                    10
  29 #define HOST_IF_MSG_ADD_BEACON                  11
  30 #define HOST_IF_MSG_DEL_BEACON                  12
  31 #define HOST_IF_MSG_ADD_STATION                 13
  32 #define HOST_IF_MSG_DEL_STATION                 14
  33 #define HOST_IF_MSG_EDIT_STATION                15
  34 #define HOST_IF_MSG_SCAN_TIMER_FIRED            16
  35 #define HOST_IF_MSG_CONNECT_TIMER_FIRED         17
  36 #define HOST_IF_MSG_POWER_MGMT                  18
  37 #define HOST_IF_MSG_GET_INACTIVETIME            19
  38 #define HOST_IF_MSG_REMAIN_ON_CHAN              20
  39 #define HOST_IF_MSG_REGISTER_FRAME              21
  40 #define HOST_IF_MSG_LISTEN_TIMER_FIRED          22
  41 #define HOST_IF_MSG_GET_LINKSPEED               23
  42 #define HOST_IF_MSG_SET_WFIDRV_HANDLER          24
  43 #define HOST_IF_MSG_SET_MAC_ADDRESS             25
  44 #define HOST_IF_MSG_GET_MAC_ADDRESS             26
  45 #define HOST_IF_MSG_SET_OPERATION_MODE          27
  46 #define HOST_IF_MSG_SET_IPADDRESS               28
  47 #define HOST_IF_MSG_GET_IPADDRESS               29
  48 #define HOST_IF_MSG_FLUSH_CONNECT               30
  49 #define HOST_IF_MSG_GET_STATISTICS              31
  50 #define HOST_IF_MSG_SET_MULTICAST_FILTER        32
  51 #define HOST_IF_MSG_ADD_BA_SESSION              33
  52 #define HOST_IF_MSG_DEL_BA_SESSION              34
  53 #define HOST_IF_MSG_Q_IDLE                      35
  54 #define HOST_IF_MSG_DEL_ALL_STA                 36
  55 #define HOST_IF_MSG_DEL_ALL_RX_BA_SESSIONS      34
  56 #define HOST_IF_MSG_EXIT                        100
  57
  58 #define HOST_IF_SCAN_TIMEOUT                    4000
  59 #define HOST_IF_CONNECT_TIMEOUT                 9500
  60
  61 #define BA_SESSION_DEFAULT_BUFFER_SIZE          16
  62 #define BA_SESSION_DEFAULT_TIMEOUT              1000
  63 #define BLOCK_ACK_REQ_SIZE                      0x14
  64 #define FALSE_FRMWR_CHANNEL                     100
  65
  66 struct cfg_param_attr {
  67         struct cfg_param_val cfg_attr_info;
  68 };
  69
  70 struct host_if_wpa_attr {
  71         u8 *key;
  72         const u8 *mac_addr;
  73         u8 *seq;
  74         u8 seq_len;
  75         u8 index;
  76         u8 key_len;
  77         u8 mode;
  78 };
  79
  80 struct host_if_wep_attr {
  81         u8 *key;
  82         u8 key_len;
  83         u8 index;
  84         u8 mode;
  85         enum AUTHTYPE auth_type;
  86 };
  87
  88 union host_if_key_attr {
  89         struct host_if_wep_attr wep;
  90         struct host_if_wpa_attr wpa;
  91         struct host_if_pmkid_attr pmkid;
  92 };
  93
  94 struct key_attr {
  95         enum KEY_TYPE type;
  96         u8 action;
  97         union host_if_key_attr attr;
  98 };
  99
 100 struct scan_attr {
 101         u8 src;
 102         u8 type;
 103         u8 *ch_freq_list;
 104         u8 ch_list_len;
 105         u8 *ies;
 106         size_t ies_len;
 107         wilc_scan_result result;
 108         void *arg;
 109         struct hidden_network hidden_network;
 110 };
 111
 112 struct connect_attr {
 113         u8 *bssid;
 114         u8 *ssid;
 115         size_t ssid_len;
 116         u8 *ies;
 117         size_t ies_len;
 118         u8 security;
 119         wilc_connect_result result;
 120         void *arg;
 121         enum AUTHTYPE auth_type;
 122         u8 ch;
 123         void *params;
 124 };
 125
 126 struct rcvd_async_info {
 127         u8 *buffer;
 128         u32 len;
 129 };
 130
 131 struct channel_attr {
 132         u8 set_ch;
 133 };
 134
 135 struct beacon_attr {
 136         u32 interval;
 137         u32 dtim_period;
 138         u32 head_len;
 139         u8 *head;
 140         u32 tail_len;
 141         u8 *tail;
 142 };
 143
 144 struct set_multicast {
 145         bool enabled;
 146         u32 cnt;
 147 };
 148
 149 struct del_all_sta {
 150         u8 del_all_sta[MAX_NUM_STA][ETH_ALEN];
 151         u8 assoc_sta;
 152 };
 153
 154 struct del_sta {
 155         u8 mac_addr[ETH_ALEN];
 156 };
 157
 158 struct power_mgmt_param {
 159         bool enabled;
 160         u32 timeout;
 161 };
 162
 163 struct set_ip_addr {
 164         u8 *ip_addr;
 165         u8 idx;
 166 };
 167
 168 struct sta_inactive_t {
 169         u8 mac[6];
 170 };
 171
 172 union message_body {
 173         struct scan_attr scan_info;
 174         struct connect_attr con_info;
 175         struct rcvd_net_info net_info;
 176         struct rcvd_async_info async_info;
 177         struct key_attr key_info;
 178         struct cfg_param_attr cfg_info;
 179         struct channel_attr channel_info;
 180         struct beacon_attr beacon_info;
 181         struct add_sta_param add_sta_info;
 182         struct del_sta del_sta_info;
 183         struct add_sta_param edit_sta_info;
 184         struct power_mgmt_param pwr_mgmt_info;
 185         struct sta_inactive_t mac_info;
 186         struct set_ip_addr ip_info;
 187         struct drv_handler drv;
 188         struct set_multicast multicast_info;
 189         struct op_mode mode;
 190         struct set_mac_addr set_mac_info;
 191         struct get_mac_addr get_mac_info;
 192         struct ba_session_info session_info;
 193         struct remain_ch remain_on_ch;
 194         struct reg_frame reg_frame;
 195         char *data;
 196         struct del_all_sta del_all_sta_info;
 197 };
 198
 199 struct host_if_msg {
 200         u16 id;
 201         union message_body body;
 202         struct host_if_drv *drv;
 203 };
 204
 205 struct join_bss_param {
 206         BSSTYPE_T bss_type;
 207         u8 dtim_period;
 208         u16 beacon_period;
 209         u16 cap_info;
 210         u8 au8bssid[6];
 211         char ssid[MAX_SSID_LEN];
 212         u8 ssid_len;
 213         u8 supp_rates[MAX_RATES_SUPPORTED + 1];
 214         u8 ht_capable;
 215         u8 wmm_cap;
 216         u8 uapsd_cap;
 217         bool rsn_found;
 218         u8 rsn_grp_policy;
 219         u8 mode_802_11i;
 220         u8 rsn_pcip_policy[3];
 221         u8 rsn_auth_policy[3];
 222         u8 rsn_cap[2];
 223         u32 tsf;
 224         u8 noa_enabled;
 225         u8 opp_enabled;
 226         u8 ct_window;
 227         u8 cnt;
 228         u8 idx;
 229         u8 duration[4];
 230         u8 interval[4];
 231         u8 start_time[4];
 232 };
 233
 234 static struct host_if_drv *wfidrv_list[NUM_CONCURRENT_IFC + 1];
 235 struct host_if_drv *terminated_handle;
 236 bool g_obtainingIP;
 237 u8 P2P_LISTEN_STATE;
 238 static struct task_struct *hif_thread_handler;
 239 static WILC_MsgQueueHandle hif_msg_q;
 240 static struct semaphore hif_sema_thread;
 241 static struct semaphore hif_sema_driver;
 242 static struct semaphore hif_sema_wait_response;
 243 static struct semaphore hif_sema_deinit;
 244 static struct timer_list periodic_rssi;
 245
 246 u8 multicast_mac_addr_list[WILC_MULTICAST_TABLE_SIZE][ETH_ALEN];
 247
 248 static u8 rcv_assoc_resp[MAX_ASSOC_RESP_FRAME_SIZE];
 249
 250 static bool scan_while_connected;
 251
 252 static s8 rssi;
 253 static s8 link_speed;
 254 static u8 ch_no;
 255 static u8 set_ip[2][4];
 256 static u8 get_ip[2][4];
 257 static u32 inactive_time;
 258 static u8 del_beacon;
 259 static u32 clients_count;
 260
 261 static u8 *join_req;
 262 u8 *info_element;
 263 static u8 mode_11i;
 264 u8 auth_type;
 265 u32 join_req_size;
 266 static u32 info_element_size;
 267 static struct host_if_drv *join_req_drv;
 268 #define REAL_JOIN_REQ 0
 269 #define FLUSHED_JOIN_REQ 1
 270 #define FLUSHED_BYTE_POS 79
 271
 272 static void *host_int_ParseJoinBssParam(tstrNetworkInfo *ptstrNetworkInfo);
 273
 274 extern int linux_wlan_get_num_conn_ifcs(void);
 275
 276 static int add_handler_in_list(struct host_if_drv *handler)
 277 {
 278         int i;
 279
 280         for (i = 1; i < ARRAY_SIZE(wfidrv_list); i++) {
 281                 if (!wfidrv_list[i]) {
 282                         wfidrv_list[i] = handler;
 283                         return 0;
 284                 }
 285         }
 286
 287         return -ENOBUFS;
 288 }
 289
 290 static int remove_handler_in_list(struct host_if_drv *handler)
 291 {
 292         int i;
 293
 294         for (i = 1; i < ARRAY_SIZE(wfidrv_list); i++) {
 295                 if (wfidrv_list[i] == handler) {
 296                         wfidrv_list[i] = NULL;
 297                         return 0;
 298                 }
 299         }
 300
 301         return -EINVAL;
 302 }
 303
 304 static int get_id_from_handler(struct host_if_drv *handler)
 305 {
 306         int i;
 307
 308         if (!handler)
 309                 return 0;
 310
 311         for (i = 1; i < ARRAY_SIZE(wfidrv_list); i++) {
 312                 if (wfidrv_list[i] == handler)
 313                         return i;
 314         }
 315
 316         return 0;
 317 }
 318
 319 static struct host_if_drv *get_handler_from_id(int id)
 320 {
 321         if (id <= 0 || id >= ARRAY_SIZE(wfidrv_list))
 322                 return NULL;
 323         return wfidrv_list[id];
 324 }
 325
 326 static s32 handle_set_channel(struct host_if_drv *hif_drv,
 327                               struct channel_attr *hif_set_ch)
 328 {
 329         s32 result = 0;
 330         struct wid wid;
 331
 332         wid.id = (u16)WID_CURRENT_CHANNEL;
 333         wid.type = WID_CHAR;
 334         wid.val = (char *)&hif_set_ch->set_ch;
 335         wid.size = sizeof(char);
 336
 337         PRINT_D(HOSTINF_DBG, "Setting channel\n");
 338
 339         result = send_config_pkt(SET_CFG, &wid, 1,
 340                                  get_id_from_handler(hif_drv));
 341
 342         if (result) {
 343                 PRINT_ER("Failed to set channel\n");
 344                 return -EINVAL;
 345         }
 346
 347         return result;
 348 }
 349
 350 static s32 handle_set_wfi_drv_handler(struct host_if_drv *hif_drv,
 351                                       struct drv_handler *hif_drv_handler)
 352 {
 353         s32 result = 0;
 354         struct wid wid;
 355
 356         wid.id = (u16)WID_SET_DRV_HANDLER;
 357         wid.type = WID_INT;
 358         wid.val = (s8 *)&hif_drv_handler->handler;
 359         wid.size = sizeof(u32);
 360
 361         result = send_config_pkt(SET_CFG, &wid, 1, hif_drv_handler->handler);
 362
 363         if (!hif_drv)
 364                 up(&hif_sema_driver);
 365
 366         if (result) {
 367                 PRINT_ER("Failed to set driver handler\n");
 368                 return -EINVAL;
 369         }
 370
 371         return result;
 372 }
 373
 374 static s32 handle_set_operation_mode(struct host_if_drv *hif_drv,
 375                                      struct op_mode *hif_op_mode)
 376 {
 377         s32 result = 0;
 378         struct wid wid;
 379
 380         wid.id = (u16)WID_SET_OPERATION_MODE;
 381         wid.type = WID_INT;
 382         wid.val = (s8 *)&hif_op_mode->mode;
 383         wid.size = sizeof(u32);
 384
 385         result = send_config_pkt(SET_CFG, &wid, 1,
 386                                  get_id_from_handler(hif_drv));
 387
 388         if ((hif_op_mode->mode) == IDLE_MODE)
 389                 up(&hif_sema_driver);
 390
 391         if (result) {
 392                 PRINT_ER("Failed to set driver handler\n");
 393                 return -EINVAL;
 394         }
 395
 396         return result;
 397 }
 398
 399 s32 handle_set_ip_address(struct host_if_drv *hif_drv, u8 *ip_addr, u8 idx)
 400 {
 401         s32 result = 0;
 402         struct wid wid;
 403         char firmware_ip_addr[4] = {0};
 404
 405         if (ip_addr[0] < 192)
 406                 ip_addr[0] = 0;
 407
 408         PRINT_INFO(HOSTINF_DBG, "Indx = %d, Handling set  IP = %pI4\n",
 409                    idx, ip_addr);
 410
 411         memcpy(set_ip[idx], ip_addr, IP_ALEN);
 412
 413         wid.id = (u16)WID_IP_ADDRESS;
 414         wid.type = WID_STR;
 415         wid.val = (u8 *)ip_addr;
 416         wid.size = IP_ALEN;
 417
 418         result = send_config_pkt(SET_CFG, &wid, 1,
 419                                  get_id_from_handler(hif_drv));
 420
 421         host_int_get_ipaddress(hif_drv, firmware_ip_addr, idx);
 422
 423         if (result) {
 424                 PRINT_ER("Failed to set IP address\n");
 425                 return -EINVAL;
 426         }
 427
 428         PRINT_INFO(HOSTINF_DBG, "IP address set\n");
 429
 430         return result;
 431 }
 432
 433 s32 handle_get_ip_address(struct host_if_drv *hif_drv, u8 idx)
 434 {
 435         s32 result = 0;
 436         struct wid wid;
 437
 438         wid.id = (u16)WID_IP_ADDRESS;
 439         wid.type = WID_STR;
 440         wid.val = kmalloc(IP_ALEN, GFP_KERNEL);
 441         wid.size = IP_ALEN;
 442
 443         result = send_config_pkt(GET_CFG, &wid, 1,
 444                                  get_id_from_handler(hif_drv));
 445
 446         PRINT_INFO(HOSTINF_DBG, "%pI4\n", wid.val);
 447
 448         memcpy(get_ip[idx], wid.val, IP_ALEN);
 449
 450         kfree(wid.val);
 451
 452         if (memcmp(get_ip[idx], set_ip[idx], IP_ALEN) != 0)
 453                 host_int_setup_ipaddress(hif_drv, set_ip[idx], idx);
 454
 455         if (result != 0) {
 456                 PRINT_ER("Failed to get IP address\n");
 457                 return -EINVAL;
 458         }
 459
 460         PRINT_INFO(HOSTINF_DBG, "IP address retrieved:: u8IfIdx = %d\n", idx);
 461         PRINT_INFO(HOSTINF_DBG, "%pI4\n", get_ip[idx]);
 462         PRINT_INFO(HOSTINF_DBG, "\n");
 463
 464         return result;
 465 }
 466
 467 static s32 handle_set_mac_address(struct host_if_drv *hif_drv,
 468                                   struct set_mac_addr *set_mac_addr)
 469 {
 470         s32 result = 0;
 471         struct wid wid;
 472         u8 *mac_buf = kmalloc(ETH_ALEN, GFP_KERNEL);
 473
 474         if (!mac_buf) {
 475                 PRINT_ER("No buffer to send mac address\n");
 476                 return -EFAULT;
 477         }
 478         memcpy(mac_buf, set_mac_addr->mac_addr, ETH_ALEN);
 479
 480         wid.id = (u16)WID_MAC_ADDR;
 481         wid.type = WID_STR;
 482         wid.val = mac_buf;
 483         wid.size = ETH_ALEN;
 484         PRINT_D(GENERIC_DBG, "mac addr = :%pM\n", wid.val);
 485
 486         result = send_config_pkt(SET_CFG, &wid, 1,
 487                                  get_id_from_handler(hif_drv));
 488         if (result) {
 489                 PRINT_ER("Failed to set mac address\n");
 490                 result = -EFAULT;
 491         }
 492
 493         kfree(mac_buf);
 494         return result;
 495 }
 496
 497 static s32 handle_get_mac_address(struct host_if_drv *hif_drv,
 498                                   struct get_mac_addr *get_mac_addr)
 499 {
 500         s32 result = 0;
 501         struct wid wid;
 502
 503         wid.id = (u16)WID_MAC_ADDR;
 504         wid.type = WID_STR;
 505         wid.val = get_mac_addr->mac_addr;
 506         wid.size = ETH_ALEN;
 507
 508         result = send_config_pkt(GET_CFG, &wid, 1,
 509                                  get_id_from_handler(hif_drv));
 510
 511         if (result) {
 512                 PRINT_ER("Failed to get mac address\n");
 513                 result = -EFAULT;
 514         }
 515         up(&hif_sema_wait_response);
 516
 517         return result;
 518 }
 519
 520 static s32 handle_cfg_param(struct host_if_drv *hif_drv,
 521                             struct cfg_param_attr *cfg_param_attr)
 522 {
 523         s32 result = 0;
 524         struct wid wid_list[32];
 525         u8 wid_cnt = 0;
 526
 527         down(&hif_drv->sem_cfg_values);
 528
 529         PRINT_D(HOSTINF_DBG, "Setting CFG params\n");
 530
 531         if (cfg_param_attr->cfg_attr_info.flag & BSS_TYPE) {
 532                 if (cfg_param_attr->cfg_attr_info.bss_type < 6) {
 533                         wid_list[wid_cnt].id = WID_BSS_TYPE;
 534                         wid_list[wid_cnt].val = (s8 *)&cfg_param_attr->cfg_attr_info.bss_type;
 535                         wid_list[wid_cnt].type = WID_CHAR;
 536                         wid_list[wid_cnt].size = sizeof(char);
 537                         hif_drv->cfg_values.bss_type = (u8)cfg_param_attr->cfg_attr_info.bss_type;
 538                 } else {
 539                         PRINT_ER("check value 6 over\n");
 540                         result = -EINVAL;
 541                         goto ERRORHANDLER;
 542                 }
 543                 wid_cnt++;
 544         }
 545         if (cfg_param_attr->cfg_attr_info.flag & AUTH_TYPE) {
 546                 if (cfg_param_attr->cfg_attr_info.auth_type == 1 ||
 547                     cfg_param_attr->cfg_attr_info.auth_type == 2 ||
 548                     cfg_param_attr->cfg_attr_info.auth_type == 5) {
 549                         wid_list[wid_cnt].id = WID_AUTH_TYPE;
 550                         wid_list[wid_cnt].val = (s8 *)&cfg_param_attr->cfg_attr_info.auth_type;
 551                         wid_list[wid_cnt].type = WID_CHAR;
 552                         wid_list[wid_cnt].size = sizeof(char);
 553                         hif_drv->cfg_values.auth_type = (u8)cfg_param_attr->cfg_attr_info.auth_type;
 554                 } else {
 555                         PRINT_ER("Impossible value \n");
 556                         result = -EINVAL;
 557                         goto ERRORHANDLER;
 558                 }
 559                 wid_cnt++;
 560         }
 561         if (cfg_param_attr->cfg_attr_info.flag & AUTHEN_TIMEOUT) {
 562                 if (cfg_param_attr->cfg_attr_info.auth_timeout > 0 &&
 563                     cfg_param_attr->cfg_attr_info.auth_timeout < 65536) {
 564                         wid_list[wid_cnt].id = WID_AUTH_TIMEOUT;
 565                         wid_list[wid_cnt].val = (s8 *)&cfg_param_attr->cfg_attr_info.auth_timeout;
 566                         wid_list[wid_cnt].type = WID_SHORT;
 567                         wid_list[wid_cnt].size = sizeof(u16);
 568                         hif_drv->cfg_values.auth_timeout = cfg_param_attr->cfg_attr_info.auth_timeout;
 569                 } else {
 570                         PRINT_ER("Range(1 ~ 65535) over\n");
 571                         result = -EINVAL;
 572                         goto ERRORHANDLER;
 573                 }
 574                 wid_cnt++;
 575         }
 576         if (cfg_param_attr->cfg_attr_info.flag & POWER_MANAGEMENT) {
 577                 if (cfg_param_attr->cfg_attr_info.power_mgmt_mode < 5) {
 578                         wid_list[wid_cnt].id = WID_POWER_MANAGEMENT;
 579                         wid_list[wid_cnt].val = (s8 *)&cfg_param_attr->cfg_attr_info.power_mgmt_mode;
 580                         wid_list[wid_cnt].type = WID_CHAR;
 581                         wid_list[wid_cnt].size = sizeof(char);
 582                         hif_drv->cfg_values.power_mgmt_mode = (u8)cfg_param_attr->cfg_attr_info.power_mgmt_mode;
 583                 } else {
 584                         PRINT_ER("Invalide power mode\n");
 585                         result = -EINVAL;
 586                         goto ERRORHANDLER;
 587                 }
 588                 wid_cnt++;
 589         }
 590         if (cfg_param_attr->cfg_attr_info.flag & RETRY_SHORT) {
 591                 if (cfg_param_attr->cfg_attr_info.short_retry_limit > 0 &&
 592                     cfg_param_attr->cfg_attr_info.short_retry_limit < 256) {
 593                         wid_list[wid_cnt].id = WID_SHORT_RETRY_LIMIT;
 594                         wid_list[wid_cnt].val = (s8 *)&cfg_param_attr->cfg_attr_info.short_retry_limit;
 595                         wid_list[wid_cnt].type = WID_SHORT;
 596                         wid_list[wid_cnt].size = sizeof(u16);
 597                         hif_drv->cfg_values.short_retry_limit = cfg_param_attr->cfg_attr_info.short_retry_limit;
 598                 } else {
 599                         PRINT_ER("Range(1~256) over\n");
 600                         result = -EINVAL;
 601                         goto ERRORHANDLER;
 602                 }
 603                 wid_cnt++;
 604         }
 605         if (cfg_param_attr->cfg_attr_info.flag & RETRY_LONG) {
 606                 if (cfg_param_attr->cfg_attr_info.long_retry_limit > 0 &&
 607                     cfg_param_attr->cfg_attr_info.long_retry_limit < 256) {
 608                         wid_list[wid_cnt].id = WID_LONG_RETRY_LIMIT;
 609                         wid_list[wid_cnt].val = (s8 *)&cfg_param_attr->cfg_attr_info.long_retry_limit;
 610                         wid_list[wid_cnt].type = WID_SHORT;
 611                         wid_list[wid_cnt].size = sizeof(u16);
 612                         hif_drv->cfg_values.long_retry_limit = cfg_param_attr->cfg_attr_info.long_retry_limit;
 613                 } else {
 614                         PRINT_ER("Range(1~256) over\n");
 615                         result = -EINVAL;
 616                         goto ERRORHANDLER;
 617                 }
 618                 wid_cnt++;
 619         }
 620         if (cfg_param_attr->cfg_attr_info.flag & FRAG_THRESHOLD) {
 621                 if (cfg_param_attr->cfg_attr_info.frag_threshold > 255 &&
 622                     cfg_param_attr->cfg_attr_info.frag_threshold < 7937) {
 623                         wid_list[wid_cnt].id = WID_FRAG_THRESHOLD;
 624                         wid_list[wid_cnt].val = (s8 *)&cfg_param_attr->cfg_attr_info.frag_threshold;
 625                         wid_list[wid_cnt].type = WID_SHORT;
 626                         wid_list[wid_cnt].size = sizeof(u16);
 627                         hif_drv->cfg_values.frag_threshold = cfg_param_attr->cfg_attr_info.frag_threshold;
 628                 } else {
 629                         PRINT_ER("Threshold Range fail\n");
 630                         result = -EINVAL;
 631                         goto ERRORHANDLER;
 632                 }
 633                 wid_cnt++;
 634         }
 635         if (cfg_param_attr->cfg_attr_info.flag & RTS_THRESHOLD) {
 636                 if (cfg_param_attr->cfg_attr_info.rts_threshold > 255 &&
 637                     cfg_param_attr->cfg_attr_info.rts_threshold < 65536) {
 638                         wid_list[wid_cnt].id = WID_RTS_THRESHOLD;
 639                         wid_list[wid_cnt].val = (s8 *)&cfg_param_attr->cfg_attr_info.rts_threshold;
 640                         wid_list[wid_cnt].type = WID_SHORT;
 641                         wid_list[wid_cnt].size = sizeof(u16);
 642                         hif_drv->cfg_values.rts_threshold = cfg_param_attr->cfg_attr_info.rts_threshold;
 643                 } else {
 644                         PRINT_ER("Threshold Range fail\n");
 645                         result = -EINVAL;
 646                         goto ERRORHANDLER;
 647                 }
 648                 wid_cnt++;
 649         }
 650         if (cfg_param_attr->cfg_attr_info.flag & PREAMBLE) {
 651                 if (cfg_param_attr->cfg_attr_info.preamble_type < 3) {
 652                         wid_list[wid_cnt].id = WID_PREAMBLE;
 653                         wid_list[wid_cnt].val = (s8 *)&cfg_param_attr->cfg_attr_info.preamble_type;
 654                         wid_list[wid_cnt].type = WID_CHAR;
 655                         wid_list[wid_cnt].size = sizeof(char);
 656                         hif_drv->cfg_values.preamble_type = cfg_param_attr->cfg_attr_info.preamble_type;
 657                 } else {
 658                         PRINT_ER("Preamle Range(0~2) over\n");
 659                         result = -EINVAL;
 660                         goto ERRORHANDLER;
 661                 }
 662                 wid_cnt++;
 663         }
 664         if (cfg_param_attr->cfg_attr_info.flag & SHORT_SLOT_ALLOWED) {
 665                 if (cfg_param_attr->cfg_attr_info.short_slot_allowed < 2) {
 666                         wid_list[wid_cnt].id = WID_SHORT_SLOT_ALLOWED;
 667                         wid_list[wid_cnt].val = (s8 *)&cfg_param_attr->cfg_attr_info.short_slot_allowed;
 668                         wid_list[wid_cnt].type = WID_CHAR;
 669                         wid_list[wid_cnt].size = sizeof(char);
 670                         hif_drv->cfg_values.short_slot_allowed = (u8)cfg_param_attr->cfg_attr_info.short_slot_allowed;
 671                 } else {
 672                         PRINT_ER("Short slot(2) over\n");
 673                         result = -EINVAL;
 674                         goto ERRORHANDLER;
 675                 }
 676                 wid_cnt++;
 677         }
 678         if (cfg_param_attr->cfg_attr_info.flag & TXOP_PROT_DISABLE) {
 679                 if (cfg_param_attr->cfg_attr_info.txop_prot_disabled < 2) {
 680                         wid_list[wid_cnt].id = WID_11N_TXOP_PROT_DISABLE;
 681                         wid_list[wid_cnt].val = (s8 *)&cfg_param_attr->cfg_attr_info.txop_prot_disabled;
 682                         wid_list[wid_cnt].type = WID_CHAR;
 683                         wid_list[wid_cnt].size = sizeof(char);
 684                         hif_drv->cfg_values.txop_prot_disabled = (u8)cfg_param_attr->cfg_attr_info.txop_prot_disabled;
 685                 } else {
 686                         PRINT_ER("TXOP prot disable\n");
 687                         result = -EINVAL;
 688                         goto ERRORHANDLER;
 689                 }
 690                 wid_cnt++;
 691         }
 692         if (cfg_param_attr->cfg_attr_info.flag & BEACON_INTERVAL) {
 693                 if (cfg_param_attr->cfg_attr_info.beacon_interval > 0 &&
 694                     cfg_param_attr->cfg_attr_info.beacon_interval < 65536) {
 695                         wid_list[wid_cnt].id = WID_BEACON_INTERVAL;
 696                         wid_list[wid_cnt].val = (s8 *)&cfg_param_attr->cfg_attr_info.beacon_interval;
 697                         wid_list[wid_cnt].type = WID_SHORT;
 698                         wid_list[wid_cnt].size = sizeof(u16);
 699                         hif_drv->cfg_values.beacon_interval = cfg_param_attr->cfg_attr_info.beacon_interval;
 700                 } else {
 701                         PRINT_ER("Beacon interval(1~65535) fail\n");
 702                         result = -EINVAL;
 703                         goto ERRORHANDLER;
 704                 }
 705                 wid_cnt++;
 706         }
 707         if (cfg_param_attr->cfg_attr_info.flag & DTIM_PERIOD) {
 708                 if (cfg_param_attr->cfg_attr_info.dtim_period > 0 &&
 709                     cfg_param_attr->cfg_attr_info.dtim_period < 256) {
 710                         wid_list[wid_cnt].id = WID_DTIM_PERIOD;
 711                         wid_list[wid_cnt].val = (s8 *)&cfg_param_attr->cfg_attr_info.dtim_period;
 712                         wid_list[wid_cnt].type = WID_CHAR;
 713                         wid_list[wid_cnt].size = sizeof(char);
 714                         hif_drv->cfg_values.dtim_period = cfg_param_attr->cfg_attr_info.dtim_period;
 715                 } else {
 716                         PRINT_ER("DTIM range(1~255) fail\n");
 717                         result = -EINVAL;
 718                         goto ERRORHANDLER;
 719                 }
 720                 wid_cnt++;
 721         }
 722         if (cfg_param_attr->cfg_attr_info.flag & SITE_SURVEY) {
 723                 if (cfg_param_attr->cfg_attr_info.site_survey_enabled < 3) {
 724                         wid_list[wid_cnt].id = WID_SITE_SURVEY;
 725                         wid_list[wid_cnt].val = (s8 *)&cfg_param_attr->cfg_attr_info.site_survey_enabled;
 726                         wid_list[wid_cnt].type = WID_CHAR;
 727                         wid_list[wid_cnt].size = sizeof(char);
 728                         hif_drv->cfg_values.site_survey_enabled = (u8)cfg_param_attr->cfg_attr_info.site_survey_enabled;
 729                 } else {
 730                         PRINT_ER("Site survey disable\n");
 731                         result = -EINVAL;
 732                         goto ERRORHANDLER;
 733                 }
 734                 wid_cnt++;
 735         }
 736         if (cfg_param_attr->cfg_attr_info.flag & SITE_SURVEY_SCAN_TIME) {
 737                 if (cfg_param_attr->cfg_attr_info.site_survey_scan_time > 0 &&
 738                     cfg_param_attr->cfg_attr_info.site_survey_scan_time < 65536) {
 739                         wid_list[wid_cnt].id = WID_SITE_SURVEY_SCAN_TIME;
 740                         wid_list[wid_cnt].val = (s8 *)&cfg_param_attr->cfg_attr_info.site_survey_scan_time;
 741                         wid_list[wid_cnt].type = WID_SHORT;
 742                         wid_list[wid_cnt].size = sizeof(u16);
 743                         hif_drv->cfg_values.site_survey_scan_time = cfg_param_attr->cfg_attr_info.site_survey_scan_time;
 744                 } else {
 745                         PRINT_ER("Site survey scan time(1~65535) over\n");
 746                         result = -EINVAL;
 747                         goto ERRORHANDLER;
 748                 }
 749                 wid_cnt++;
 750         }
 751         if (cfg_param_attr->cfg_attr_info.flag & ACTIVE_SCANTIME) {
 752                 if (cfg_param_attr->cfg_attr_info.active_scan_time > 0 &&
 753                     cfg_param_attr->cfg_attr_info.active_scan_time < 65536) {
 754                         wid_list[wid_cnt].id = WID_ACTIVE_SCAN_TIME;
 755                         wid_list[wid_cnt].val = (s8 *)&cfg_param_attr->cfg_attr_info.active_scan_time;
 756                         wid_list[wid_cnt].type = WID_SHORT;
 757                         wid_list[wid_cnt].size = sizeof(u16);
 758                         hif_drv->cfg_values.active_scan_time = cfg_param_attr->cfg_attr_info.active_scan_time;
 759                 } else {
 760                         PRINT_ER("Active scan time(1~65535) over\n");
 761                         result = -EINVAL;
 762                         goto ERRORHANDLER;
 763                 }
 764                 wid_cnt++;
 765         }
 766         if (cfg_param_attr->cfg_attr_info.flag & PASSIVE_SCANTIME) {
 767                 if (cfg_param_attr->cfg_attr_info.passive_scan_time > 0 &&
 768                     cfg_param_attr->cfg_attr_info.passive_scan_time < 65536) {
 769                         wid_list[wid_cnt].id = WID_PASSIVE_SCAN_TIME;
 770                         wid_list[wid_cnt].val = (s8 *)&cfg_param_attr->cfg_attr_info.passive_scan_time;
 771                         wid_list[wid_cnt].type = WID_SHORT;
 772                         wid_list[wid_cnt].size = sizeof(u16);
 773                         hif_drv->cfg_values.passive_scan_time = cfg_param_attr->cfg_attr_info.passive_scan_time;
 774                 } else {
 775                         PRINT_ER("Passive scan time(1~65535) over\n");
 776                         result = -EINVAL;
 777                         goto ERRORHANDLER;
 778                 }
 779                 wid_cnt++;
 780         }
 781         if (cfg_param_attr->cfg_attr_info.flag & CURRENT_TX_RATE) {
 782                 enum CURRENT_TXRATE curr_tx_rate = cfg_param_attr->cfg_attr_info.curr_tx_rate;
 783
 784                 if (curr_tx_rate == AUTORATE || curr_tx_rate == MBPS_1
 785                     || curr_tx_rate == MBPS_2 || curr_tx_rate == MBPS_5_5
 786                     || curr_tx_rate == MBPS_11 || curr_tx_rate == MBPS_6
 787                     || curr_tx_rate == MBPS_9 || curr_tx_rate == MBPS_12
 788                     || curr_tx_rate == MBPS_18 || curr_tx_rate == MBPS_24
 789                     || curr_tx_rate == MBPS_36 || curr_tx_rate == MBPS_48 || curr_tx_rate == MBPS_54) {
 790                         wid_list[wid_cnt].id = WID_CURRENT_TX_RATE;
 791                         wid_list[wid_cnt].val = (s8 *)&curr_tx_rate;
 792                         wid_list[wid_cnt].type = WID_SHORT;
 793                         wid_list[wid_cnt].size = sizeof(u16);
 794                         hif_drv->cfg_values.curr_tx_rate = (u8)curr_tx_rate;
 795                 } else {
 796                         PRINT_ER("out of TX rate\n");
 797                         result = -EINVAL;
 798                         goto ERRORHANDLER;
 799                 }
 800                 wid_cnt++;
 801         }
 802
 803         result = send_config_pkt(SET_CFG, wid_list, wid_cnt,
 804                                  get_id_from_handler(hif_drv));
 805
 806         if (result)
 807                 PRINT_ER("Error in setting CFG params\n");
 808
 809 ERRORHANDLER:
 810         up(&hif_drv->sem_cfg_values);
 811         return result;
 812 }
 813
 814 static void Handle_wait_msg_q_empty(void)
 815 {
 816         g_wilc_initialized = 0;
 817         up(&hif_sema_wait_response);
 818 }
 819
 820 static s32 Handle_Scan(struct host_if_drv *hif_drv,
 821                        struct scan_attr *pstrHostIFscanAttr)
 822 {
 823         s32 result = 0;
 824         struct wid strWIDList[5];
 825         u32 u32WidsCount = 0;
 826         u32 i;
 827         u8 *pu8Buffer;
 828         u8 valuesize = 0;
 829         u8 *pu8HdnNtwrksWidVal = NULL;
 830
 831         PRINT_D(HOSTINF_DBG, "Setting SCAN params\n");
 832         PRINT_D(HOSTINF_DBG, "Scanning: In [%d] state\n", hif_drv->hif_state);
 833
 834         hif_drv->usr_scan_req.scan_result = pstrHostIFscanAttr->result;
 835         hif_drv->usr_scan_req.arg = pstrHostIFscanAttr->arg;
 836
 837         if ((hif_drv->hif_state >= HOST_IF_SCANNING) &&
 838             (hif_drv->hif_state < HOST_IF_CONNECTED)) {
 839                 PRINT_D(GENERIC_DBG, "Don't scan already in [%d] state\n",
 840                         hif_drv->hif_state);
 841                 PRINT_ER("Already scan\n");
 842                 result = -EBUSY;
 843                 goto ERRORHANDLER;
 844         }
 845
 846         if (g_obtainingIP || connecting) {
 847                 PRINT_D(GENERIC_DBG, "[handle_scan]: Don't do obss scan until IP adresss is obtained\n");
 848                 PRINT_ER("Don't do obss scan\n");
 849                 result = -EBUSY;
 850                 goto ERRORHANDLER;
 851         }
 852
 853         PRINT_D(HOSTINF_DBG, "Setting SCAN params\n");
 854
 855         hif_drv->usr_scan_req.rcvd_ch_cnt = 0;
 856
 857         strWIDList[u32WidsCount].id = (u16)WID_SSID_PROBE_REQ;
 858         strWIDList[u32WidsCount].type = WID_STR;
 859
 860         for (i = 0; i < pstrHostIFscanAttr->hidden_network.u8ssidnum; i++)
 861                 valuesize += ((pstrHostIFscanAttr->hidden_network.pstrHiddenNetworkInfo[i].u8ssidlen) + 1);
 862         pu8HdnNtwrksWidVal = kmalloc(valuesize + 1, GFP_KERNEL);
 863         strWIDList[u32WidsCount].val = pu8HdnNtwrksWidVal;
 864         if (strWIDList[u32WidsCount].val) {
 865                 pu8Buffer = strWIDList[u32WidsCount].val;
 866
 867                 *pu8Buffer++ = pstrHostIFscanAttr->hidden_network.u8ssidnum;
 868
 869                 PRINT_D(HOSTINF_DBG, "In Handle_ProbeRequest number of ssid %d\n", pstrHostIFscanAttr->hidden_network.u8ssidnum);
 870
 871                 for (i = 0; i < pstrHostIFscanAttr->hidden_network.u8ssidnum; i++) {
 872                         *pu8Buffer++ = pstrHostIFscanAttr->hidden_network.pstrHiddenNetworkInfo[i].u8ssidlen;
 873                         memcpy(pu8Buffer, pstrHostIFscanAttr->hidden_network.pstrHiddenNetworkInfo[i].pu8ssid, pstrHostIFscanAttr->hidden_network.pstrHiddenNetworkInfo[i].u8ssidlen);
 874                         pu8Buffer += pstrHostIFscanAttr->hidden_network.pstrHiddenNetworkInfo[i].u8ssidlen;
 875                 }
 876
 877                 strWIDList[u32WidsCount].size = (s32)(valuesize + 1);
 878                 u32WidsCount++;
 879         }
 880
 881         {
 882                 strWIDList[u32WidsCount].id = WID_INFO_ELEMENT_PROBE;
 883                 strWIDList[u32WidsCount].type = WID_BIN_DATA;
 884                 strWIDList[u32WidsCount].val = pstrHostIFscanAttr->ies;
 885                 strWIDList[u32WidsCount].size = pstrHostIFscanAttr->ies_len;
 886                 u32WidsCount++;
 887         }
 888
 889         strWIDList[u32WidsCount].id = WID_SCAN_TYPE;
 890         strWIDList[u32WidsCount].type = WID_CHAR;
 891         strWIDList[u32WidsCount].size = sizeof(char);
 892         strWIDList[u32WidsCount].val = (s8 *)&pstrHostIFscanAttr->type;
 893         u32WidsCount++;
 894
 895         strWIDList[u32WidsCount].id = WID_SCAN_CHANNEL_LIST;
 896         strWIDList[u32WidsCount].type = WID_BIN_DATA;
 897
 898         if (pstrHostIFscanAttr->ch_freq_list &&
 899             pstrHostIFscanAttr->ch_list_len > 0) {
 900                 int i;
 901
 902                 for (i = 0; i < pstrHostIFscanAttr->ch_list_len; i++)   {
 903                         if (pstrHostIFscanAttr->ch_freq_list[i] > 0)
 904                                 pstrHostIFscanAttr->ch_freq_list[i] = pstrHostIFscanAttr->ch_freq_list[i] - 1;
 905                 }
 906         }
 907
 908         strWIDList[u32WidsCount].val = pstrHostIFscanAttr->ch_freq_list;
 909         strWIDList[u32WidsCount].size = pstrHostIFscanAttr->ch_list_len;
 910         u32WidsCount++;
 911
 912         strWIDList[u32WidsCount].id = WID_START_SCAN_REQ;
 913         strWIDList[u32WidsCount].type = WID_CHAR;
 914         strWIDList[u32WidsCount].size = sizeof(char);
 915         strWIDList[u32WidsCount].val = (s8 *)&pstrHostIFscanAttr->src;
 916         u32WidsCount++;
 917
 918         if (hif_drv->hif_state == HOST_IF_CONNECTED)
 919                 scan_while_connected = true;
 920         else if (hif_drv->hif_state == HOST_IF_IDLE)
 921                 scan_while_connected = false;
 922
 923         result = send_config_pkt(SET_CFG, strWIDList, u32WidsCount,
 924                                  get_id_from_handler(hif_drv));
 925
 926         if (result)
 927                 PRINT_ER("Failed to send scan paramters config packet\n");
 928         else
 929                 PRINT_D(HOSTINF_DBG, "Successfully sent SCAN params config packet\n");
 930
 931 ERRORHANDLER:
 932         if (result) {
 933                 del_timer(&hif_drv->scan_timer);
 934                 Handle_ScanDone(hif_drv, SCAN_EVENT_ABORTED);
 935         }
 936
 937         kfree(pstrHostIFscanAttr->ch_freq_list);
 938         pstrHostIFscanAttr->ch_freq_list = NULL;
 939
 940         kfree(pstrHostIFscanAttr->ies);
 941         pstrHostIFscanAttr->ies = NULL;
 942         kfree(pstrHostIFscanAttr->hidden_network.pstrHiddenNetworkInfo);
 943         pstrHostIFscanAttr->hidden_network.pstrHiddenNetworkInfo = NULL;
 944
 945         kfree(pu8HdnNtwrksWidVal);
 946
 947         return result;
 948 }
 949
 950 static s32 Handle_ScanDone(struct host_if_drv *hif_drv,
 951                            enum scan_event enuEvent)
 952 {
 953         s32 result = 0;
 954         u8 u8abort_running_scan;
 955         struct wid wid;
 956
 957         PRINT_D(HOSTINF_DBG, "in Handle_ScanDone()\n");
 958
 959         if (enuEvent == SCAN_EVENT_ABORTED) {
 960                 PRINT_D(GENERIC_DBG, "Abort running scan\n");
 961                 u8abort_running_scan = 1;
 962                 wid.id = (u16)WID_ABORT_RUNNING_SCAN;
 963                 wid.type = WID_CHAR;
 964                 wid.val = (s8 *)&u8abort_running_scan;
 965                 wid.size = sizeof(char);
 966
 967                 result = send_config_pkt(SET_CFG, &wid, 1,
 968                                          get_id_from_handler(hif_drv));
 969
 970                 if (result) {
 971                         PRINT_ER("Failed to set abort running scan\n");
 972                         result = -EFAULT;
 973                 }
 974         }
 975
 976         if (!hif_drv) {
 977                 PRINT_ER("Driver handler is NULL\n");
 978                 return result;
 979         }
 980
 981         if (hif_drv->usr_scan_req.scan_result) {
 982                 hif_drv->usr_scan_req.scan_result(enuEvent, NULL,
 983                                                   hif_drv->usr_scan_req.arg, NULL);
 984                 hif_drv->usr_scan_req.scan_result = NULL;
 985         }
 986
 987         return result;
 988 }
 989
 990 u8 u8ConnectedSSID[6] = {0};
 991 static s32 Handle_Connect(struct host_if_drv *hif_drv,
 992                           struct connect_attr *pstrHostIFconnectAttr)
 993 {
 994         s32 result = 0;
 995         struct wid strWIDList[8];
 996         u32 u32WidsCount = 0, dummyval = 0;
 997         u8 *pu8CurrByte = NULL;
 998         struct join_bss_param *ptstrJoinBssParam;
 999
1000         PRINT_D(GENERIC_DBG, "Handling connect request\n");
1001
1002         if (memcmp(pstrHostIFconnectAttr->bssid, u8ConnectedSSID, ETH_ALEN) == 0) {
1003                 result = 0;
1004                 PRINT_ER("Trying to connect to an already connected AP, Discard connect request\n");
1005                 return result;
1006         }
1007
1008         PRINT_INFO(HOSTINF_DBG, "Saving connection parameters in global structure\n");
1009
1010         ptstrJoinBssParam = (struct join_bss_param *)pstrHostIFconnectAttr->params;
1011         if (!ptstrJoinBssParam) {
1012                 PRINT_ER("Required BSSID not found\n");
1013                 result = -ENOENT;
1014                 goto ERRORHANDLER;
1015         }
1016
1017         if (pstrHostIFconnectAttr->bssid) {
1018                 hif_drv->usr_conn_req.pu8bssid = kmalloc(6, GFP_KERNEL);
1019                 memcpy(hif_drv->usr_conn_req.pu8bssid, pstrHostIFconnectAttr->bssid, 6);
1020         }
1021
1022         hif_drv->usr_conn_req.ssid_len = pstrHostIFconnectAttr->ssid_len;
1023         if (pstrHostIFconnectAttr->ssid) {
1024                 hif_drv->usr_conn_req.pu8ssid = kmalloc(pstrHostIFconnectAttr->ssid_len + 1, GFP_KERNEL);
1025                 memcpy(hif_drv->usr_conn_req.pu8ssid,
1026                        pstrHostIFconnectAttr->ssid,
1027                        pstrHostIFconnectAttr->ssid_len);
1028                 hif_drv->usr_conn_req.pu8ssid[pstrHostIFconnectAttr->ssid_len] = '\0';
1029         }
1030
1031         hif_drv->usr_conn_req.ies_len = pstrHostIFconnectAttr->ies_len;
1032         if (pstrHostIFconnectAttr->ies) {
1033                 hif_drv->usr_conn_req.ies = kmalloc(pstrHostIFconnectAttr->ies_len, GFP_KERNEL);
1034                 memcpy(hif_drv->usr_conn_req.ies,
1035                        pstrHostIFconnectAttr->ies,
1036                        pstrHostIFconnectAttr->ies_len);
1037         }
1038
1039         hif_drv->usr_conn_req.u8security = pstrHostIFconnectAttr->security;
1040         hif_drv->usr_conn_req.auth_type = pstrHostIFconnectAttr->auth_type;
1041         hif_drv->usr_conn_req.conn_result = pstrHostIFconnectAttr->result;
1042         hif_drv->usr_conn_req.arg = pstrHostIFconnectAttr->arg;
1043
1044         strWIDList[u32WidsCount].id = WID_SUCCESS_FRAME_COUNT;
1045         strWIDList[u32WidsCount].type = WID_INT;
1046         strWIDList[u32WidsCount].size = sizeof(u32);
1047         strWIDList[u32WidsCount].val = (s8 *)(&(dummyval));
1048         u32WidsCount++;
1049
1050         strWIDList[u32WidsCount].id = WID_RECEIVED_FRAGMENT_COUNT;
1051         strWIDList[u32WidsCount].type = WID_INT;
1052         strWIDList[u32WidsCount].size = sizeof(u32);
1053         strWIDList[u32WidsCount].val = (s8 *)(&(dummyval));
1054         u32WidsCount++;
1055
1056         strWIDList[u32WidsCount].id = WID_FAILED_COUNT;
1057         strWIDList[u32WidsCount].type = WID_INT;
1058         strWIDList[u32WidsCount].size = sizeof(u32);
1059         strWIDList[u32WidsCount].val = (s8 *)(&(dummyval));
1060         u32WidsCount++;
1061
1062         {
1063                 strWIDList[u32WidsCount].id = WID_INFO_ELEMENT_ASSOCIATE;
1064                 strWIDList[u32WidsCount].type = WID_BIN_DATA;
1065                 strWIDList[u32WidsCount].val = hif_drv->usr_conn_req.ies;
1066                 strWIDList[u32WidsCount].size = hif_drv->usr_conn_req.ies_len;
1067                 u32WidsCount++;
1068
1069                 if (memcmp("DIRECT-", pstrHostIFconnectAttr->ssid, 7)) {
1070                         info_element_size = hif_drv->usr_conn_req.ies_len;
1071                         info_element = kmalloc(info_element_size, GFP_KERNEL);
1072                         memcpy(info_element, hif_drv->usr_conn_req.ies,
1073                                info_element_size);
1074                 }
1075         }
1076         strWIDList[u32WidsCount].id = (u16)WID_11I_MODE;
1077         strWIDList[u32WidsCount].type = WID_CHAR;
1078         strWIDList[u32WidsCount].size = sizeof(char);
1079         strWIDList[u32WidsCount].val = (s8 *)&hif_drv->usr_conn_req.u8security;
1080         u32WidsCount++;
1081
1082         if (memcmp("DIRECT-", pstrHostIFconnectAttr->ssid, 7))
1083                 mode_11i = hif_drv->usr_conn_req.u8security;
1084
1085         PRINT_INFO(HOSTINF_DBG, "Encrypt Mode = %x\n", hif_drv->usr_conn_req.u8security);
1086
1087         strWIDList[u32WidsCount].id = (u16)WID_AUTH_TYPE;
1088         strWIDList[u32WidsCount].type = WID_CHAR;
1089         strWIDList[u32WidsCount].size = sizeof(char);
1090         strWIDList[u32WidsCount].val = (s8 *)&hif_drv->usr_conn_req.auth_type;
1091         u32WidsCount++;
1092
1093         if (memcmp("DIRECT-", pstrHostIFconnectAttr->ssid, 7))
1094                 auth_type = (u8)hif_drv->usr_conn_req.auth_type;
1095
1096         PRINT_INFO(HOSTINF_DBG, "Authentication Type = %x\n",
1097                    hif_drv->usr_conn_req.auth_type);
1098         PRINT_D(HOSTINF_DBG, "Connecting to network of SSID %s on channel %d\n",
1099                 hif_drv->usr_conn_req.pu8ssid, pstrHostIFconnectAttr->ch);
1100
1101         strWIDList[u32WidsCount].id = (u16)WID_JOIN_REQ_EXTENDED;
1102         strWIDList[u32WidsCount].type = WID_STR;
1103         strWIDList[u32WidsCount].size = 112;
1104         strWIDList[u32WidsCount].val = kmalloc(strWIDList[u32WidsCount].size, GFP_KERNEL);
1105
1106         if (memcmp("DIRECT-", pstrHostIFconnectAttr->ssid, 7)) {
1107                 join_req_size = strWIDList[u32WidsCount].size;
1108                 join_req = kmalloc(join_req_size, GFP_KERNEL);
1109         }
1110         if (!strWIDList[u32WidsCount].val) {
1111                 result = -EFAULT;
1112                 goto ERRORHANDLER;
1113         }
1114
1115         pu8CurrByte = strWIDList[u32WidsCount].val;
1116
1117         if (pstrHostIFconnectAttr->ssid) {
1118                 memcpy(pu8CurrByte, pstrHostIFconnectAttr->ssid, pstrHostIFconnectAttr->ssid_len);
1119                 pu8CurrByte[pstrHostIFconnectAttr->ssid_len] = '\0';
1120         }
1121         pu8CurrByte += MAX_SSID_LEN;
1122         *(pu8CurrByte++) = INFRASTRUCTURE;
1123
1124         if ((pstrHostIFconnectAttr->ch >= 1) && (pstrHostIFconnectAttr->ch <= 14)) {
1125                 *(pu8CurrByte++) = pstrHostIFconnectAttr->ch;
1126         } else {
1127                 PRINT_ER("Channel out of range\n");
1128                 *(pu8CurrByte++) = 0xFF;
1129         }
1130         *(pu8CurrByte++)  = (ptstrJoinBssParam->cap_info) & 0xFF;
1131         *(pu8CurrByte++)  = ((ptstrJoinBssParam->cap_info) >> 8) & 0xFF;
1132         PRINT_D(HOSTINF_DBG, "* Cap Info %0x*\n", (*(pu8CurrByte - 2) | ((*(pu8CurrByte - 1)) << 8)));
1133
1134         if (pstrHostIFconnectAttr->bssid)
1135                 memcpy(pu8CurrByte, pstrHostIFconnectAttr->bssid, 6);
1136         pu8CurrByte += 6;
1137
1138         if (pstrHostIFconnectAttr->bssid)
1139                 memcpy(pu8CurrByte, pstrHostIFconnectAttr->bssid, 6);
1140         pu8CurrByte += 6;
1141
1142         *(pu8CurrByte++)  = (ptstrJoinBssParam->beacon_period) & 0xFF;
1143         *(pu8CurrByte++)  = ((ptstrJoinBssParam->beacon_period) >> 8) & 0xFF;
1144         PRINT_D(HOSTINF_DBG, "* Beacon Period %d*\n", (*(pu8CurrByte - 2) | ((*(pu8CurrByte - 1)) << 8)));
1145         *(pu8CurrByte++)  =  ptstrJoinBssParam->dtim_period;
1146         PRINT_D(HOSTINF_DBG, "* DTIM Period %d*\n", (*(pu8CurrByte - 1)));
1147
1148         memcpy(pu8CurrByte, ptstrJoinBssParam->supp_rates, MAX_RATES_SUPPORTED + 1);
1149         pu8CurrByte += (MAX_RATES_SUPPORTED + 1);
1150
1151         *(pu8CurrByte++)  =  ptstrJoinBssParam->wmm_cap;
1152         PRINT_D(HOSTINF_DBG, "* wmm cap%d*\n", (*(pu8CurrByte - 1)));
1153         *(pu8CurrByte++)  = ptstrJoinBssParam->uapsd_cap;
1154
1155         *(pu8CurrByte++)  = ptstrJoinBssParam->ht_capable;
1156         hif_drv->usr_conn_req.ht_capable = ptstrJoinBssParam->ht_capable;
1157
1158         *(pu8CurrByte++)  =  ptstrJoinBssParam->rsn_found;
1159         PRINT_D(HOSTINF_DBG, "* rsn found %d*\n", *(pu8CurrByte - 1));
1160         *(pu8CurrByte++)  =  ptstrJoinBssParam->rsn_grp_policy;
1161         PRINT_D(HOSTINF_DBG, "* rsn group policy %0x*\n", (*(pu8CurrByte - 1)));
1162         *(pu8CurrByte++) =  ptstrJoinBssParam->mode_802_11i;
1163         PRINT_D(HOSTINF_DBG, "* mode_802_11i %d*\n", (*(pu8CurrByte - 1)));
1164
1165         memcpy(pu8CurrByte, ptstrJoinBssParam->rsn_pcip_policy, sizeof(ptstrJoinBssParam->rsn_pcip_policy));
1166         pu8CurrByte += sizeof(ptstrJoinBssParam->rsn_pcip_policy);
1167
1168         memcpy(pu8CurrByte, ptstrJoinBssParam->rsn_auth_policy, sizeof(ptstrJoinBssParam->rsn_auth_policy));
1169         pu8CurrByte += sizeof(ptstrJoinBssParam->rsn_auth_policy);
1170
1171         memcpy(pu8CurrByte, ptstrJoinBssParam->rsn_cap, sizeof(ptstrJoinBssParam->rsn_cap));
1172         pu8CurrByte += sizeof(ptstrJoinBssParam->rsn_cap);
1173
1174         *(pu8CurrByte++) = REAL_JOIN_REQ;
1175         *(pu8CurrByte++) = ptstrJoinBssParam->noa_enabled;
1176
1177         if (ptstrJoinBssParam->noa_enabled) {
1178                 PRINT_D(HOSTINF_DBG, "NOA present\n");
1179
1180                 *(pu8CurrByte++) = (ptstrJoinBssParam->tsf) & 0xFF;
1181                 *(pu8CurrByte++) = ((ptstrJoinBssParam->tsf) >> 8) & 0xFF;
1182                 *(pu8CurrByte++) = ((ptstrJoinBssParam->tsf) >> 16) & 0xFF;
1183                 *(pu8CurrByte++) = ((ptstrJoinBssParam->tsf) >> 24) & 0xFF;
1184
1185                 *(pu8CurrByte++) = ptstrJoinBssParam->opp_enabled;
1186                 *(pu8CurrByte++) = ptstrJoinBssParam->idx;
1187
1188                 if (ptstrJoinBssParam->opp_enabled)
1189                         *(pu8CurrByte++) = ptstrJoinBssParam->ct_window;
1190
1191                 *(pu8CurrByte++) = ptstrJoinBssParam->cnt;
1192
1193                 memcpy(pu8CurrByte, ptstrJoinBssParam->duration, sizeof(ptstrJoinBssParam->duration));
1194                 pu8CurrByte += sizeof(ptstrJoinBssParam->duration);
1195
1196                 memcpy(pu8CurrByte, ptstrJoinBssParam->interval, sizeof(ptstrJoinBssParam->interval));
1197                 pu8CurrByte += sizeof(ptstrJoinBssParam->interval);
1198
1199                 memcpy(pu8CurrByte, ptstrJoinBssParam->start_time, sizeof(ptstrJoinBssParam->start_time));
1200                 pu8CurrByte += sizeof(ptstrJoinBssParam->start_time);
1201         } else
1202                 PRINT_D(HOSTINF_DBG, "NOA not present\n");
1203
1204         pu8CurrByte = strWIDList[u32WidsCount].val;
1205         u32WidsCount++;
1206
1207         if (memcmp("DIRECT-", pstrHostIFconnectAttr->ssid, 7)) {
1208                 memcpy(join_req, pu8CurrByte, join_req_size);
1209                 join_req_drv = hif_drv;
1210         }
1211
1212         PRINT_D(GENERIC_DBG, "send HOST_IF_WAITING_CONN_RESP\n");
1213
1214         if (pstrHostIFconnectAttr->bssid) {
1215                 memcpy(u8ConnectedSSID, pstrHostIFconnectAttr->bssid, ETH_ALEN);
1216
1217                 PRINT_D(GENERIC_DBG, "save Bssid = %pM\n", pstrHostIFconnectAttr->bssid);
1218                 PRINT_D(GENERIC_DBG, "save bssid = %pM\n", u8ConnectedSSID);
1219         }
1220
1221         result = send_config_pkt(SET_CFG, strWIDList, u32WidsCount,
1222                                  get_id_from_handler(hif_drv));
1223         if (result) {
1224                 PRINT_ER("failed to send config packet\n");
1225                 result = -EFAULT;
1226                 goto ERRORHANDLER;
1227         } else {
1228                 PRINT_D(GENERIC_DBG, "set HOST_IF_WAITING_CONN_RESP\n");
1229                 hif_drv->hif_state = HOST_IF_WAITING_CONN_RESP;
1230         }
1231
1232 ERRORHANDLER:
1233         if (result) {
1234                 tstrConnectInfo strConnectInfo;
1235
1236                 del_timer(&hif_drv->connect_timer);
1237
1238                 PRINT_D(HOSTINF_DBG, "could not start connecting to the required network\n");
1239
1240                 memset(&strConnectInfo, 0, sizeof(tstrConnectInfo));
1241
1242                 if (pstrHostIFconnectAttr->result) {
1243                         if (pstrHostIFconnectAttr->bssid)
1244                                 memcpy(strConnectInfo.au8bssid, pstrHostIFconnectAttr->bssid, 6);
1245
1246                         if (pstrHostIFconnectAttr->ies) {
1247                                 strConnectInfo.ReqIEsLen = pstrHostIFconnectAttr->ies_len;
1248                                 strConnectInfo.pu8ReqIEs = kmalloc(pstrHostIFconnectAttr->ies_len, GFP_KERNEL);
1249                                 memcpy(strConnectInfo.pu8ReqIEs,
1250                                        pstrHostIFconnectAttr->ies,
1251                                        pstrHostIFconnectAttr->ies_len);
1252                         }
1253
1254                         pstrHostIFconnectAttr->result(CONN_DISCONN_EVENT_CONN_RESP,
1255                                                                &strConnectInfo,
1256                                                                MAC_DISCONNECTED,
1257                                                                NULL,
1258                                                                pstrHostIFconnectAttr->arg);
1259                         hif_drv->hif_state = HOST_IF_IDLE;
1260                         kfree(strConnectInfo.pu8ReqIEs);
1261                         strConnectInfo.pu8ReqIEs = NULL;
1262
1263                 } else {
1264                         PRINT_ER("Connect callback function pointer is NULL\n");
1265                 }
1266         }
1267
1268         PRINT_D(HOSTINF_DBG, "Deallocating connection parameters\n");
1269         kfree(pstrHostIFconnectAttr->bssid);
1270         pstrHostIFconnectAttr->bssid = NULL;
1271
1272         kfree(pstrHostIFconnectAttr->ssid);
1273         pstrHostIFconnectAttr->ssid = NULL;
1274
1275         kfree(pstrHostIFconnectAttr->ies);
1276         pstrHostIFconnectAttr->ies = NULL;
1277
1278         kfree(pu8CurrByte);
1279         return result;
1280 }
1281
1282 static s32 Handle_FlushConnect(struct host_if_drv *hif_drv)
1283 {
1284         s32 result = 0;
1285         struct wid strWIDList[5];
1286         u32 u32WidsCount = 0;
1287         u8 *pu8CurrByte = NULL;
1288
1289         strWIDList[u32WidsCount].id = WID_INFO_ELEMENT_ASSOCIATE;
1290         strWIDList[u32WidsCount].type = WID_BIN_DATA;
1291         strWIDList[u32WidsCount].val = info_element;
1292         strWIDList[u32WidsCount].size = info_element_size;
1293         u32WidsCount++;
1294
1295         strWIDList[u32WidsCount].id = (u16)WID_11I_MODE;
1296         strWIDList[u32WidsCount].type = WID_CHAR;
1297         strWIDList[u32WidsCount].size = sizeof(char);
1298         strWIDList[u32WidsCount].val = (s8 *)(&(mode_11i));
1299         u32WidsCount++;
1300
1301         strWIDList[u32WidsCount].id = (u16)WID_AUTH_TYPE;
1302         strWIDList[u32WidsCount].type = WID_CHAR;
1303         strWIDList[u32WidsCount].size = sizeof(char);
1304         strWIDList[u32WidsCount].val = (s8 *)(&auth_type);
1305         u32WidsCount++;
1306
1307         strWIDList[u32WidsCount].id = (u16)WID_JOIN_REQ_EXTENDED;
1308         strWIDList[u32WidsCount].type = WID_STR;
1309         strWIDList[u32WidsCount].size = join_req_size;
1310         strWIDList[u32WidsCount].val = (s8 *)join_req;
1311         pu8CurrByte = strWIDList[u32WidsCount].val;
1312
1313         pu8CurrByte += FLUSHED_BYTE_POS;
1314         *(pu8CurrByte) = FLUSHED_JOIN_REQ;
1315
1316         u32WidsCount++;
1317
1318         result = send_config_pkt(SET_CFG, strWIDList, u32WidsCount,
1319                                  get_id_from_handler(join_req_drv));
1320         if (result) {
1321                 PRINT_ER("failed to send config packet\n");
1322                 result = -EINVAL;
1323         }
1324
1325         return result;
1326 }
1327
1328 static s32 Handle_ConnectTimeout(struct host_if_drv *hif_drv)
1329 {
1330         s32 result = 0;
1331         tstrConnectInfo strConnectInfo;
1332         struct wid wid;
1333         u16 u16DummyReasonCode = 0;
1334
1335         if (!hif_drv) {
1336                 PRINT_ER("Driver handler is NULL\n");
1337                 return result;
1338         }
1339
1340         hif_drv->hif_state = HOST_IF_IDLE;
1341
1342         scan_while_connected = false;
1343
1344         memset(&strConnectInfo, 0, sizeof(tstrConnectInfo));
1345
1346         if (hif_drv->usr_conn_req.conn_result) {
1347                 if (hif_drv->usr_conn_req.pu8bssid) {
1348                         memcpy(strConnectInfo.au8bssid,
1349                                hif_drv->usr_conn_req.pu8bssid, 6);
1350                 }
1351
1352                 if (hif_drv->usr_conn_req.ies) {
1353                         strConnectInfo.ReqIEsLen = hif_drv->usr_conn_req.ies_len;
1354                         strConnectInfo.pu8ReqIEs = kmalloc(hif_drv->usr_conn_req.ies_len, GFP_KERNEL);
1355                         memcpy(strConnectInfo.pu8ReqIEs,
1356                                hif_drv->usr_conn_req.ies,
1357                                hif_drv->usr_conn_req.ies_len);
1358                 }
1359
1360                 hif_drv->usr_conn_req.conn_result(CONN_DISCONN_EVENT_CONN_RESP,
1361                                                   &strConnectInfo,
1362                                                   MAC_DISCONNECTED,
1363                                                   NULL,
1364                                                   hif_drv->usr_conn_req.arg);
1365
1366                 kfree(strConnectInfo.pu8ReqIEs);
1367                 strConnectInfo.pu8ReqIEs = NULL;
1368         } else {
1369                 PRINT_ER("Connect callback function pointer is NULL\n");
1370         }
1371
1372         wid.id = (u16)WID_DISCONNECT;
1373         wid.type = WID_CHAR;
1374         wid.val = (s8 *)&u16DummyReasonCode;
1375         wid.size = sizeof(char);
1376
1377         PRINT_D(HOSTINF_DBG, "Sending disconnect request\n");
1378
1379         result = send_config_pkt(SET_CFG, &wid, 1,
1380                                  get_id_from_handler(hif_drv));
1381         if (result)
1382                 PRINT_ER("Failed to send dissconect config packet\n");
1383
1384         hif_drv->usr_conn_req.ssid_len = 0;
1385         kfree(hif_drv->usr_conn_req.pu8ssid);
1386         kfree(hif_drv->usr_conn_req.pu8bssid);
1387         hif_drv->usr_conn_req.ies_len = 0;
1388         kfree(hif_drv->usr_conn_req.ies);
1389
1390         eth_zero_addr(u8ConnectedSSID);
1391
1392         if (join_req && join_req_drv == hif_drv) {
1393                 kfree(join_req);
1394                 join_req = NULL;
1395         }
1396
1397         if (info_element && join_req_drv == hif_drv) {
1398                 kfree(info_element);
1399                 info_element = NULL;
1400         }
1401
1402         return result;
1403 }
1404
1405 static s32 Handle_RcvdNtwrkInfo(struct host_if_drv *hif_drv,
1406                                 struct rcvd_net_info *pstrRcvdNetworkInfo)
1407 {
1408         u32 i;
1409         bool bNewNtwrkFound;
1410         s32 result = 0;
1411         tstrNetworkInfo *pstrNetworkInfo = NULL;
1412         void *pJoinParams = NULL;
1413
1414         bNewNtwrkFound = true;
1415         PRINT_INFO(HOSTINF_DBG, "Handling received network info\n");
1416
1417         if (hif_drv->usr_scan_req.scan_result) {
1418                 PRINT_D(HOSTINF_DBG, "State: Scanning, parsing network information received\n");
1419                 parse_network_info(pstrRcvdNetworkInfo->buffer, &pstrNetworkInfo);
1420                 if ((!pstrNetworkInfo) ||
1421                     (!hif_drv->usr_scan_req.scan_result)) {
1422                         PRINT_ER("driver is null\n");
1423                         result = -EINVAL;
1424                         goto done;
1425                 }
1426
1427                 for (i = 0; i < hif_drv->usr_scan_req.rcvd_ch_cnt; i++) {
1428                         if ((hif_drv->usr_scan_req.net_info[i].au8bssid) &&
1429                             (pstrNetworkInfo->au8bssid)) {
1430                                 if (memcmp(hif_drv->usr_scan_req.net_info[i].au8bssid,
1431                                            pstrNetworkInfo->au8bssid, 6) == 0) {
1432                                         if (pstrNetworkInfo->s8rssi <= hif_drv->usr_scan_req.net_info[i].s8rssi) {
1433                                                 PRINT_D(HOSTINF_DBG, "Network previously discovered\n");
1434                                                 goto done;
1435                                         } else {
1436                                                 hif_drv->usr_scan_req.net_info[i].s8rssi = pstrNetworkInfo->s8rssi;
1437                                                 bNewNtwrkFound = false;
1438                                                 break;
1439                                         }
1440                                 }
1441                         }
1442                 }
1443
1444                 if (bNewNtwrkFound) {
1445                         PRINT_D(HOSTINF_DBG, "New network found\n");
1446
1447                         if (hif_drv->usr_scan_req.rcvd_ch_cnt < MAX_NUM_SCANNED_NETWORKS) {
1448                                 hif_drv->usr_scan_req.net_info[hif_drv->usr_scan_req.rcvd_ch_cnt].s8rssi = pstrNetworkInfo->s8rssi;
1449
1450                                 if (hif_drv->usr_scan_req.net_info[hif_drv->usr_scan_req.rcvd_ch_cnt].au8bssid &&
1451                                     pstrNetworkInfo->au8bssid) {
1452                                         memcpy(hif_drv->usr_scan_req.net_info[hif_drv->usr_scan_req.rcvd_ch_cnt].au8bssid,
1453                                                pstrNetworkInfo->au8bssid, 6);
1454
1455                                         hif_drv->usr_scan_req.rcvd_ch_cnt++;
1456
1457                                         pstrNetworkInfo->bNewNetwork = true;
1458                                         pJoinParams = host_int_ParseJoinBssParam(pstrNetworkInfo);
1459
1460                                         hif_drv->usr_scan_req.scan_result(SCAN_EVENT_NETWORK_FOUND, pstrNetworkInfo,
1461                                                                           hif_drv->usr_scan_req.arg,
1462                                                                           pJoinParams);
1463                                 }
1464                         } else {
1465                                 PRINT_WRN(HOSTINF_DBG, "Discovered networks exceeded max. limit\n");
1466                         }
1467                 } else {
1468                         pstrNetworkInfo->bNewNetwork = false;
1469                         hif_drv->usr_scan_req.scan_result(SCAN_EVENT_NETWORK_FOUND, pstrNetworkInfo,
1470                                                           hif_drv->usr_scan_req.arg, NULL);
1471                 }
1472         }
1473
1474 done:
1475         kfree(pstrRcvdNetworkInfo->buffer);
1476         pstrRcvdNetworkInfo->buffer = NULL;
1477
1478         if (pstrNetworkInfo) {
1479                 DeallocateNetworkInfo(pstrNetworkInfo);
1480                 pstrNetworkInfo = NULL;
1481         }
1482
1483         return result;
1484 }
1485
1486 static s32 Handle_RcvdGnrlAsyncInfo(struct host_if_drv *hif_drv,
1487                                     struct rcvd_async_info *pstrRcvdGnrlAsyncInfo)
1488 {
1489         s32 result = 0;
1490         u8 u8MsgType = 0;
1491         u8 u8MsgID = 0;
1492         u16 u16MsgLen = 0;
1493         u16 u16WidID = (u16)WID_NIL;
1494         u8 u8WidLen  = 0;
1495         u8 u8MacStatus;
1496         u8 u8MacStatusReasonCode;
1497         u8 u8MacStatusAdditionalInfo;
1498         tstrConnectInfo strConnectInfo;
1499         tstrDisconnectNotifInfo strDisconnectNotifInfo;
1500         s32 s32Err = 0;
1501
1502         if (!hif_drv) {
1503                 PRINT_ER("Driver handler is NULL\n");
1504                 return -ENODEV;
1505         }
1506         PRINT_D(GENERIC_DBG, "Current State = %d,Received state = %d\n",
1507                 hif_drv->hif_state, pstrRcvdGnrlAsyncInfo->buffer[7]);
1508
1509         if ((hif_drv->hif_state == HOST_IF_WAITING_CONN_RESP) ||
1510             (hif_drv->hif_state == HOST_IF_CONNECTED) ||
1511             hif_drv->usr_scan_req.scan_result) {
1512                 if (!pstrRcvdGnrlAsyncInfo->buffer ||
1513                     !hif_drv->usr_conn_req.conn_result) {
1514                         PRINT_ER("driver is null\n");
1515                         return -EINVAL;
1516                 }
1517
1518                 u8MsgType = pstrRcvdGnrlAsyncInfo->buffer[0];
1519
1520                 if ('I' != u8MsgType) {
1521                         PRINT_ER("Received Message format incorrect.\n");
1522                         return -EFAULT;
1523                 }
1524
1525                 u8MsgID = pstrRcvdGnrlAsyncInfo->buffer[1];
1526                 u16MsgLen = MAKE_WORD16(pstrRcvdGnrlAsyncInfo->buffer[2], pstrRcvdGnrlAsyncInfo->buffer[3]);
1527                 u16WidID = MAKE_WORD16(pstrRcvdGnrlAsyncInfo->buffer[4], pstrRcvdGnrlAsyncInfo->buffer[5]);
1528                 u8WidLen = pstrRcvdGnrlAsyncInfo->buffer[6];
1529                 u8MacStatus  = pstrRcvdGnrlAsyncInfo->buffer[7];
1530                 u8MacStatusReasonCode = pstrRcvdGnrlAsyncInfo->buffer[8];
1531                 u8MacStatusAdditionalInfo = pstrRcvdGnrlAsyncInfo->buffer[9];
1532                 PRINT_INFO(HOSTINF_DBG, "Recieved MAC status = %d with Reason = %d , Info = %d\n", u8MacStatus, u8MacStatusReasonCode, u8MacStatusAdditionalInfo);
1533                 if (hif_drv->hif_state == HOST_IF_WAITING_CONN_RESP) {
1534                         u32 u32RcvdAssocRespInfoLen;
1535                         tstrConnectRespInfo *pstrConnectRespInfo = NULL;
1536
1537                         PRINT_D(HOSTINF_DBG, "Recieved MAC status = %d with Reason = %d , Code = %d\n", u8MacStatus, u8MacStatusReasonCode, u8MacStatusAdditionalInfo);
1538
1539                         memset(&strConnectInfo, 0, sizeof(tstrConnectInfo));
1540
1541                         if (u8MacStatus == MAC_CONNECTED) {
1542                                 memset(rcv_assoc_resp, 0, MAX_ASSOC_RESP_FRAME_SIZE);
1543
1544                                 host_int_get_assoc_res_info(hif_drv,
1545                                                             rcv_assoc_resp,
1546                                                             MAX_ASSOC_RESP_FRAME_SIZE,
1547                                                             &u32RcvdAssocRespInfoLen);
1548
1549                                 PRINT_INFO(HOSTINF_DBG, "Received association response with length = %d\n", u32RcvdAssocRespInfoLen);
1550
1551                                 if (u32RcvdAssocRespInfoLen != 0) {
1552                                         PRINT_D(HOSTINF_DBG, "Parsing association response\n");
1553                                         s32Err = ParseAssocRespInfo(rcv_assoc_resp, u32RcvdAssocRespInfoLen,
1554                                                                     &pstrConnectRespInfo);
1555                                         if (s32Err) {
1556                                                 PRINT_ER("ParseAssocRespInfo() returned error %d\n", s32Err);
1557                                         } else {
1558                                                 strConnectInfo.u16ConnectStatus = pstrConnectRespInfo->u16ConnectStatus;
1559
1560                                                 if (strConnectInfo.u16ConnectStatus == SUCCESSFUL_STATUSCODE) {
1561                                                         PRINT_INFO(HOSTINF_DBG, "Association response received : Successful connection status\n");
1562                                                         if (pstrConnectRespInfo->pu8RespIEs) {
1563                                                                 strConnectInfo.u16RespIEsLen = pstrConnectRespInfo->u16RespIEsLen;
1564                                                                 strConnectInfo.pu8RespIEs = kmalloc(pstrConnectRespInfo->u16RespIEsLen, GFP_KERNEL);
1565                                                                 memcpy(strConnectInfo.pu8RespIEs, pstrConnectRespInfo->pu8RespIEs,
1566                                                                             pstrConnectRespInfo->u16RespIEsLen);
1567                                                         }
1568                                                 }
1569
1570                                                 if (pstrConnectRespInfo) {
1571                                                         DeallocateAssocRespInfo(pstrConnectRespInfo);
1572                                                         pstrConnectRespInfo = NULL;
1573                                                 }
1574                                         }
1575                                 }
1576                         }
1577
1578                         if ((u8MacStatus == MAC_CONNECTED) &&
1579                             (strConnectInfo.u16ConnectStatus != SUCCESSFUL_STATUSCODE)) {
1580                                 PRINT_ER("Received MAC status is MAC_CONNECTED while the received status code in Asoc Resp is not SUCCESSFUL_STATUSCODE\n");
1581                                 eth_zero_addr(u8ConnectedSSID);
1582
1583                         } else if (u8MacStatus == MAC_DISCONNECTED)    {
1584                                 PRINT_ER("Received MAC status is MAC_DISCONNECTED\n");
1585                                 eth_zero_addr(u8ConnectedSSID);
1586                         }
1587
1588                         if (hif_drv->usr_conn_req.pu8bssid) {
1589                                 PRINT_D(HOSTINF_DBG, "Retrieving actual BSSID from AP\n");
1590                                 memcpy(strConnectInfo.au8bssid, hif_drv->usr_conn_req.pu8bssid, 6);
1591
1592                                 if ((u8MacStatus == MAC_CONNECTED) &&
1593                                     (strConnectInfo.u16ConnectStatus == SUCCESSFUL_STATUSCODE)) {
1594                                         memcpy(hif_drv->assoc_bssid,
1595                                                hif_drv->usr_conn_req.pu8bssid, ETH_ALEN);
1596                                 }
1597                         }
1598
1599                         if (hif_drv->usr_conn_req.ies) {
1600                                 strConnectInfo.ReqIEsLen = hif_drv->usr_conn_req.ies_len;
1601                                 strConnectInfo.pu8ReqIEs = kmalloc(hif_drv->usr_conn_req.ies_len, GFP_KERNEL);
1602                                 memcpy(strConnectInfo.pu8ReqIEs,
1603                                        hif_drv->usr_conn_req.ies,
1604                                        hif_drv->usr_conn_req.ies_len);
1605                         }
1606
1607                         del_timer(&hif_drv->connect_timer);
1608                         hif_drv->usr_conn_req.conn_result(CONN_DISCONN_EVENT_CONN_RESP,
1609                                                           &strConnectInfo,
1610                                                           u8MacStatus,
1611                                                           NULL,
1612                                                           hif_drv->usr_conn_req.arg);
1613
1614                         if ((u8MacStatus == MAC_CONNECTED) &&
1615                             (strConnectInfo.u16ConnectStatus == SUCCESSFUL_STATUSCODE)) {
1616                                 host_int_set_power_mgmt(hif_drv, 0, 0);
1617
1618                                 PRINT_D(HOSTINF_DBG, "MAC status : CONNECTED and Connect Status : Successful\n");
1619                                 hif_drv->hif_state = HOST_IF_CONNECTED;
1620
1621                                 PRINT_D(GENERIC_DBG, "Obtaining an IP, Disable Scan\n");
1622                                 g_obtainingIP = true;
1623                                 mod_timer(&hDuringIpTimer,
1624                                           jiffies + msecs_to_jiffies(10000));
1625                         } else {
1626                                 PRINT_D(HOSTINF_DBG, "MAC status : %d and Connect Status : %d\n", u8MacStatus, strConnectInfo.u16ConnectStatus);
1627                                 hif_drv->hif_state = HOST_IF_IDLE;
1628                                 scan_while_connected = false;
1629                         }
1630
1631                         kfree(strConnectInfo.pu8RespIEs);
1632                         strConnectInfo.pu8RespIEs = NULL;
1633
1634                         kfree(strConnectInfo.pu8ReqIEs);
1635                         strConnectInfo.pu8ReqIEs = NULL;
1636                         hif_drv->usr_conn_req.ssid_len = 0;
1637                         kfree(hif_drv->usr_conn_req.pu8ssid);
1638                         kfree(hif_drv->usr_conn_req.pu8bssid);
1639                         hif_drv->usr_conn_req.ies_len = 0;
1640                         kfree(hif_drv->usr_conn_req.ies);
1641                 } else if ((u8MacStatus == MAC_DISCONNECTED) &&
1642                            (hif_drv->hif_state == HOST_IF_CONNECTED)) {
1643                         PRINT_D(HOSTINF_DBG, "Received MAC_DISCONNECTED from the FW\n");
1644
1645                         memset(&strDisconnectNotifInfo, 0, sizeof(tstrDisconnectNotifInfo));
1646
1647                         if (hif_drv->usr_scan_req.scan_result) {
1648                                 PRINT_D(HOSTINF_DBG, "\n\n<< Abort the running OBSS Scan >>\n\n");
1649                                 del_timer(&hif_drv->scan_timer);
1650                                 Handle_ScanDone((void *)hif_drv, SCAN_EVENT_ABORTED);
1651                         }
1652
1653                         strDisconnectNotifInfo.u16reason = 0;
1654                         strDisconnectNotifInfo.ie = NULL;
1655                         strDisconnectNotifInfo.ie_len = 0;
1656
1657                         if (hif_drv->usr_conn_req.conn_result) {
1658                                 g_obtainingIP = false;
1659                                 host_int_set_power_mgmt(hif_drv, 0, 0);
1660
1661                                 hif_drv->usr_conn_req.conn_result(CONN_DISCONN_EVENT_DISCONN_NOTIF,
1662                                                                   NULL,
1663                                                                   0,
1664                                                                   &strDisconnectNotifInfo,
1665                                                                   hif_drv->usr_conn_req.arg);
1666                         } else {
1667                                 PRINT_ER("Connect result callback function is NULL\n");
1668                         }
1669
1670                         eth_zero_addr(hif_drv->assoc_bssid);
1671
1672                         hif_drv->usr_conn_req.ssid_len = 0;
1673                         kfree(hif_drv->usr_conn_req.pu8ssid);
1674                         kfree(hif_drv->usr_conn_req.pu8bssid);
1675                         hif_drv->usr_conn_req.ies_len = 0;
1676                         kfree(hif_drv->usr_conn_req.ies);
1677
1678                         if (join_req && join_req_drv == hif_drv) {
1679                                 kfree(join_req);
1680                                 join_req = NULL;
1681                         }
1682
1683                         if (info_element && join_req_drv == hif_drv) {
1684                                 kfree(info_element);
1685                                 info_element = NULL;
1686                         }
1687
1688                         hif_drv->hif_state = HOST_IF_IDLE;
1689                         scan_while_connected = false;
1690
1691                 } else if ((u8MacStatus == MAC_DISCONNECTED) &&
1692                            (hif_drv->usr_scan_req.scan_result)) {
1693                         PRINT_D(HOSTINF_DBG, "Received MAC_DISCONNECTED from the FW while scanning\n");
1694                         PRINT_D(HOSTINF_DBG, "\n\n<< Abort the running Scan >>\n\n");
1695
1696                         del_timer(&hif_drv->scan_timer);
1697                         if (hif_drv->usr_scan_req.scan_result)
1698                                 Handle_ScanDone(hif_drv, SCAN_EVENT_ABORTED);
1699                 }
1700         }
1701
1702         kfree(pstrRcvdGnrlAsyncInfo->buffer);
1703         pstrRcvdGnrlAsyncInfo->buffer = NULL;
1704
1705         return result;
1706 }
1707
1708 static int Handle_Key(struct host_if_drv *hif_drv,
1709                       struct key_attr *pstrHostIFkeyAttr)
1710 {
1711         s32 result = 0;
1712         struct wid wid;
1713         struct wid strWIDList[5];
1714         u8 i;
1715         u8 *pu8keybuf;
1716         s8 s8idxarray[1];
1717         s8 ret = 0;
1718
1719         switch (pstrHostIFkeyAttr->type) {
1720         case WEP:
1721
1722                 if (pstrHostIFkeyAttr->action & ADDKEY_AP) {
1723                         PRINT_D(HOSTINF_DBG, "Handling WEP key\n");
1724                         PRINT_D(GENERIC_DBG, "ID Hostint is %d\n", pstrHostIFkeyAttr->attr.wep.index);
1725                         strWIDList[0].id = (u16)WID_11I_MODE;
1726                         strWIDList[0].type = WID_CHAR;
1727                         strWIDList[0].size = sizeof(char);
1728                         strWIDList[0].val = (s8 *)&pstrHostIFkeyAttr->attr.wep.mode;
1729
1730                         strWIDList[1].id = WID_AUTH_TYPE;
1731                         strWIDList[1].type = WID_CHAR;
1732                         strWIDList[1].size = sizeof(char);
1733                         strWIDList[1].val = (s8 *)&pstrHostIFkeyAttr->attr.wep.auth_type;
1734
1735                         strWIDList[2].id = (u16)WID_KEY_ID;
1736                         strWIDList[2].type = WID_CHAR;
1737
1738                         strWIDList[2].val = (s8 *)&pstrHostIFkeyAttr->attr.wep.index;
1739                         strWIDList[2].size = sizeof(char);
1740
1741                         pu8keybuf = kmemdup(pstrHostIFkeyAttr->attr.wep.key,
1742                                             pstrHostIFkeyAttr->attr.wep.key_len,
1743                                             GFP_KERNEL);
1744
1745                         if (pu8keybuf == NULL) {
1746                                 PRINT_ER("No buffer to send Key\n");
1747                                 return -ENOMEM;
1748                         }
1749
1750                         kfree(pstrHostIFkeyAttr->attr.wep.key);
1751
1752                         strWIDList[3].id = (u16)WID_WEP_KEY_VALUE;
1753                         strWIDList[3].type = WID_STR;
1754                         strWIDList[3].size = pstrHostIFkeyAttr->attr.wep.key_len;
1755                         strWIDList[3].val = (s8 *)pu8keybuf;
1756
1757                         result = send_config_pkt(SET_CFG, strWIDList, 4,
1758                                                  get_id_from_handler(hif_drv));
1759                         kfree(pu8keybuf);
1760                 }
1761
1762                 if (pstrHostIFkeyAttr->action & ADDKEY) {
1763                         PRINT_D(HOSTINF_DBG, "Handling WEP key\n");
1764                         pu8keybuf = kmalloc(pstrHostIFkeyAttr->attr.wep.key_len + 2, GFP_KERNEL);
1765                         if (!pu8keybuf) {
1766                                 PRINT_ER("No buffer to send Key\n");
1767                                 return -ENOMEM;
1768                         }
1769                         pu8keybuf[0] = pstrHostIFkeyAttr->attr.wep.index;
1770                         memcpy(pu8keybuf + 1, &pstrHostIFkeyAttr->attr.wep.key_len, 1);
1771                         memcpy(pu8keybuf + 2, pstrHostIFkeyAttr->attr.wep.key,
1772                                pstrHostIFkeyAttr->attr.wep.key_len);
1773                         kfree(pstrHostIFkeyAttr->attr.wep.key);
1774
1775                         wid.id = (u16)WID_ADD_WEP_KEY;
1776                         wid.type = WID_STR;
1777                         wid.val = (s8 *)pu8keybuf;
1778                         wid.size = pstrHostIFkeyAttr->attr.wep.key_len + 2;
1779
1780                         result = send_config_pkt(SET_CFG, &wid, 1,
1781                                                  get_id_from_handler(hif_drv));
1782                         kfree(pu8keybuf);
1783                 } else if (pstrHostIFkeyAttr->action & REMOVEKEY) {
1784                         PRINT_D(HOSTINF_DBG, "Removing key\n");
1785                         wid.id = (u16)WID_REMOVE_WEP_KEY;
1786                         wid.type = WID_STR;
1787
1788                         s8idxarray[0] = (s8)pstrHostIFkeyAttr->attr.wep.index;
1789                         wid.val = s8idxarray;
1790                         wid.size = 1;
1791
1792                         result = send_config_pkt(SET_CFG, &wid, 1,
1793                                                  get_id_from_handler(hif_drv));
1794                 } else {
1795                         wid.id = (u16)WID_KEY_ID;
1796                         wid.type = WID_CHAR;
1797                         wid.val = (s8 *)&pstrHostIFkeyAttr->attr.wep.index;
1798                         wid.size = sizeof(char);
1799
1800                         PRINT_D(HOSTINF_DBG, "Setting default key index\n");
1801
1802                         result = send_config_pkt(SET_CFG, &wid, 1,
1803                                                  get_id_from_handler(hif_drv));
1804                 }
1805                 up(&hif_drv->sem_test_key_block);
1806                 break;
1807
1808         case WPA_RX_GTK:
1809                 if (pstrHostIFkeyAttr->action & ADDKEY_AP) {
1810                         pu8keybuf = kzalloc(RX_MIC_KEY_MSG_LEN, GFP_KERNEL);
1811                         if (!pu8keybuf) {
1812                                 PRINT_ER("No buffer to send RxGTK Key\n");
1813                                 ret = -ENOMEM;
1814                                 goto _WPARxGtk_end_case_;
1815                         }
1816
1817                         if (pstrHostIFkeyAttr->attr.wpa.seq)
1818                                 memcpy(pu8keybuf + 6, pstrHostIFkeyAttr->attr.wpa.seq, 8);
1819
1820                         memcpy(pu8keybuf + 14, &pstrHostIFkeyAttr->attr.wpa.index, 1);
1821                         memcpy(pu8keybuf + 15, &pstrHostIFkeyAttr->attr.wpa.key_len, 1);
1822                         memcpy(pu8keybuf + 16, pstrHostIFkeyAttr->attr.wpa.key,
1823                                pstrHostIFkeyAttr->attr.wpa.key_len);
1824
1825                         strWIDList[0].id = (u16)WID_11I_MODE;
1826                         strWIDList[0].type = WID_CHAR;
1827                         strWIDList[0].size = sizeof(char);
1828                         strWIDList[0].val = (s8 *)&pstrHostIFkeyAttr->attr.wpa.mode;
1829
1830                         strWIDList[1].id = (u16)WID_ADD_RX_GTK;
1831                         strWIDList[1].type = WID_STR;
1832                         strWIDList[1].val = (s8 *)pu8keybuf;
1833                         strWIDList[1].size = RX_MIC_KEY_MSG_LEN;
1834
1835                         result = send_config_pkt(SET_CFG, strWIDList, 2,
1836                                                  get_id_from_handler(hif_drv));
1837
1838                         kfree(pu8keybuf);
1839                         up(&hif_drv->sem_test_key_block);
1840                 }
1841
1842                 if (pstrHostIFkeyAttr->action & ADDKEY) {
1843                         PRINT_D(HOSTINF_DBG, "Handling group key(Rx) function\n");
1844
1845                         pu8keybuf = kzalloc(RX_MIC_KEY_MSG_LEN, GFP_KERNEL);
1846                         if (pu8keybuf == NULL) {
1847                                 PRINT_ER("No buffer to send RxGTK Key\n");
1848                                 ret = -ENOMEM;
1849                                 goto _WPARxGtk_end_case_;
1850                         }
1851
1852                         if (hif_drv->hif_state == HOST_IF_CONNECTED)
1853                                 memcpy(pu8keybuf, hif_drv->assoc_bssid, ETH_ALEN);
1854                         else
1855                                 PRINT_ER("Couldn't handle WPARxGtk while state is not HOST_IF_CONNECTED\n");
1856
1857                         memcpy(pu8keybuf + 6, pstrHostIFkeyAttr->attr.wpa.seq, 8);
1858                         memcpy(pu8keybuf + 14, &pstrHostIFkeyAttr->attr.wpa.index, 1);
1859                         memcpy(pu8keybuf + 15, &pstrHostIFkeyAttr->attr.wpa.key_len, 1);
1860                         memcpy(pu8keybuf + 16, pstrHostIFkeyAttr->attr.wpa.key,
1861                                pstrHostIFkeyAttr->attr.wpa.key_len);
1862
1863                         wid.id = (u16)WID_ADD_RX_GTK;
1864                         wid.type = WID_STR;
1865                         wid.val = (s8 *)pu8keybuf;
1866                         wid.size = RX_MIC_KEY_MSG_LEN;
1867
1868                         result = send_config_pkt(SET_CFG, &wid, 1,
1869                                                  get_id_from_handler(hif_drv));
1870
1871                         kfree(pu8keybuf);
1872                         up(&hif_drv->sem_test_key_block);
1873                 }
1874 _WPARxGtk_end_case_:
1875                 kfree(pstrHostIFkeyAttr->attr.wpa.key);
1876                 kfree(pstrHostIFkeyAttr->attr.wpa.seq);
1877                 if (ret)
1878                         return ret;
1879
1880                 break;
1881
1882         case WPA_PTK:
1883                 if (pstrHostIFkeyAttr->action & ADDKEY_AP) {
1884                         pu8keybuf = kmalloc(PTK_KEY_MSG_LEN + 1, GFP_KERNEL);
1885                         if (!pu8keybuf) {
1886                                 PRINT_ER("No buffer to send PTK Key\n");
1887                                 ret = -ENOMEM;
1888                                 goto _WPAPtk_end_case_;
1889                         }
1890
1891                         memcpy(pu8keybuf, pstrHostIFkeyAttr->attr.wpa.mac_addr, 6);
1892                         memcpy(pu8keybuf + 6, &pstrHostIFkeyAttr->attr.wpa.index, 1);
1893                         memcpy(pu8keybuf + 7, &pstrHostIFkeyAttr->attr.wpa.key_len, 1);
1894                         memcpy(pu8keybuf + 8, pstrHostIFkeyAttr->attr.wpa.key,
1895                                pstrHostIFkeyAttr->attr.wpa.key_len);
1896
1897                         strWIDList[0].id = (u16)WID_11I_MODE;
1898                         strWIDList[0].type = WID_CHAR;
1899                         strWIDList[0].size = sizeof(char);
1900                         strWIDList[0].val = (s8 *)&pstrHostIFkeyAttr->attr.wpa.mode;
1901
1902                         strWIDList[1].id = (u16)WID_ADD_PTK;
1903                         strWIDList[1].type = WID_STR;
1904                         strWIDList[1].val = (s8 *)pu8keybuf;
1905                         strWIDList[1].size = PTK_KEY_MSG_LEN + 1;
1906
1907                         result = send_config_pkt(SET_CFG, strWIDList, 2,
1908                                                  get_id_from_handler(hif_drv));
1909                         kfree(pu8keybuf);
1910                         up(&hif_drv->sem_test_key_block);
1911                 }
1912                 if (pstrHostIFkeyAttr->action & ADDKEY) {
1913                         pu8keybuf = kmalloc(PTK_KEY_MSG_LEN, GFP_KERNEL);
1914                         if (!pu8keybuf) {
1915                                 PRINT_ER("No buffer to send PTK Key\n");
1916                                 ret = -ENOMEM;
1917                                 goto _WPAPtk_end_case_;
1918                         }
1919
1920                         memcpy(pu8keybuf, pstrHostIFkeyAttr->attr.wpa.mac_addr, 6);
1921                         memcpy(pu8keybuf + 6, &pstrHostIFkeyAttr->attr.wpa.key_len, 1);
1922                         memcpy(pu8keybuf + 7, pstrHostIFkeyAttr->attr.wpa.key,
1923                                pstrHostIFkeyAttr->attr.wpa.key_len);
1924
1925                         wid.id = (u16)WID_ADD_PTK;
1926                         wid.type = WID_STR;
1927                         wid.val = (s8 *)pu8keybuf;
1928                         wid.size = PTK_KEY_MSG_LEN;
1929
1930                         result = send_config_pkt(SET_CFG, &wid, 1,
1931                                                  get_id_from_handler(hif_drv));
1932                         kfree(pu8keybuf);
1933                         up(&hif_drv->sem_test_key_block);
1934                 }
1935
1936 _WPAPtk_end_case_:
1937                 kfree(pstrHostIFkeyAttr->attr.wpa.key);
1938                 if (ret)
1939                         return ret;
1940
1941                 break;
1942
1943         case PMKSA:
1944
1945                 PRINT_D(HOSTINF_DBG, "Handling PMKSA key\n");
1946
1947                 pu8keybuf = kmalloc((pstrHostIFkeyAttr->attr.pmkid.numpmkid * PMKSA_KEY_LEN) + 1, GFP_KERNEL);
1948                 if (!pu8keybuf) {
1949                         PRINT_ER("No buffer to send PMKSA Key\n");
1950                         return -ENOMEM;
1951                 }
1952
1953                 pu8keybuf[0] = pstrHostIFkeyAttr->attr.pmkid.numpmkid;
1954
1955                 for (i = 0; i < pstrHostIFkeyAttr->attr.pmkid.numpmkid; i++) {
1956                         memcpy(pu8keybuf + ((PMKSA_KEY_LEN * i) + 1), pstrHostIFkeyAttr->attr.pmkid.pmkidlist[i].bssid, ETH_ALEN);
1957                         memcpy(pu8keybuf + ((PMKSA_KEY_LEN * i) + ETH_ALEN + 1), pstrHostIFkeyAttr->attr.pmkid.pmkidlist[i].pmkid, PMKID_LEN);
1958                 }
1959
1960                 wid.id = (u16)WID_PMKID_INFO;
1961                 wid.type = WID_STR;
1962                 wid.val = (s8 *)pu8keybuf;
1963                 wid.size = (pstrHostIFkeyAttr->attr.pmkid.numpmkid * PMKSA_KEY_LEN) + 1;
1964
1965                 result = send_config_pkt(SET_CFG, &wid, 1,
1966                                          get_id_from_handler(hif_drv));
1967
1968                 kfree(pu8keybuf);
1969                 break;
1970         }
1971
1972         if (result)
1973                 PRINT_ER("Failed to send key config packet\n");
1974
1975         return result;
1976 }
1977
1978 static void Handle_Disconnect(struct host_if_drv *hif_drv)
1979 {
1980         struct wid wid;
1981
1982         s32 result = 0;
1983         u16 u16DummyReasonCode = 0;
1984
1985         wid.id = (u16)WID_DISCONNECT;
1986         wid.type = WID_CHAR;
1987         wid.val = (s8 *)&u16DummyReasonCode;
1988         wid.size = sizeof(char);
1989
1990         PRINT_D(HOSTINF_DBG, "Sending disconnect request\n");
1991
1992         g_obtainingIP = false;
1993         host_int_set_power_mgmt(hif_drv, 0, 0);
1994
1995         eth_zero_addr(u8ConnectedSSID);
1996
1997         result = send_config_pkt(SET_CFG, &wid, 1,
1998                                  get_id_from_handler(hif_drv));
1999
2000         if (result) {
2001                 PRINT_ER("Failed to send dissconect config packet\n");
2002         } else {
2003                 tstrDisconnectNotifInfo strDisconnectNotifInfo;
2004
2005                 memset(&strDisconnectNotifInfo, 0, sizeof(tstrDisconnectNotifInfo));
2006
2007                 strDisconnectNotifInfo.u16reason = 0;
2008                 strDisconnectNotifInfo.ie = NULL;
2009                 strDisconnectNotifInfo.ie_len = 0;
2010
2011                 if (hif_drv->usr_scan_req.scan_result) {
2012                         del_timer(&hif_drv->scan_timer);
2013                         hif_drv->usr_scan_req.scan_result(SCAN_EVENT_ABORTED,
2014                                                           NULL,
2015                                                           hif_drv->usr_scan_req.arg,
2016                                                           NULL);
2017                         hif_drv->usr_scan_req.scan_result = NULL;
2018                 }
2019
2020                 if (hif_drv->usr_conn_req.conn_result) {
2021                         if (hif_drv->hif_state == HOST_IF_WAITING_CONN_RESP) {
2022                                 PRINT_D(HOSTINF_DBG, "Upper layer requested termination of connection\n");
2023                                 del_timer(&hif_drv->connect_timer);
2024                         }
2025
2026                         hif_drv->usr_conn_req.conn_result(CONN_DISCONN_EVENT_DISCONN_NOTIF,
2027                                                           NULL,
2028                                                           0,
2029                                                           &strDisconnectNotifInfo,
2030                                                           hif_drv->usr_conn_req.arg);
2031                 } else {
2032                         PRINT_ER("usr_conn_req.conn_result = NULL\n");
2033                 }
2034
2035                 scan_while_connected = false;
2036
2037                 hif_drv->hif_state = HOST_IF_IDLE;
2038
2039                 eth_zero_addr(hif_drv->assoc_bssid);
2040
2041                 hif_drv->usr_conn_req.ssid_len = 0;
2042                 kfree(hif_drv->usr_conn_req.pu8ssid);
2043                 kfree(hif_drv->usr_conn_req.pu8bssid);
2044                 hif_drv->usr_conn_req.ies_len = 0;
2045                 kfree(hif_drv->usr_conn_req.ies);
2046
2047                 if (join_req && join_req_drv == hif_drv) {
2048                         kfree(join_req);
2049                         join_req = NULL;
2050                 }
2051
2052                 if (info_element && join_req_drv == hif_drv) {
2053                         kfree(info_element);
2054                         info_element = NULL;
2055                 }
2056         }
2057
2058         up(&hif_drv->sem_test_disconn_block);
2059 }
2060
2061 void resolve_disconnect_aberration(struct host_if_drv *hif_drv)
2062 {
2063         if (!hif_drv)
2064                 return;
2065         if ((hif_drv->hif_state == HOST_IF_WAITING_CONN_RESP) ||
2066             (hif_drv->hif_state == HOST_IF_CONNECTING)) {
2067                 PRINT_D(HOSTINF_DBG, "\n\n<< correcting Supplicant state machine >>\n\n");
2068                 host_int_disconnect(hif_drv, 1);
2069         }
2070 }
2071
2072 static s32 Handle_GetChnl(struct host_if_drv *hif_drv)
2073 {
2074         s32 result = 0;
2075         struct wid wid;
2076
2077         wid.id = (u16)WID_CURRENT_CHANNEL;
2078         wid.type = WID_CHAR;
2079         wid.val = (s8 *)&ch_no;
2080         wid.size = sizeof(char);
2081
2082         PRINT_D(HOSTINF_DBG, "Getting channel value\n");
2083
2084         result = send_config_pkt(GET_CFG, &wid, 1,
2085                                  get_id_from_handler(hif_drv));
2086
2087         if (result) {
2088                 PRINT_ER("Failed to get channel number\n");
2089                 result = -EFAULT;
2090         }
2091
2092         up(&hif_drv->sem_get_chnl);
2093
2094         return result;
2095 }
2096
2097 static void Handle_GetRssi(struct host_if_drv *hif_drv)
2098 {
2099         s32 result = 0;
2100         struct wid wid;
2101
2102         wid.id = (u16)WID_RSSI;
2103         wid.type = WID_CHAR;
2104         wid.val = &rssi;
2105         wid.size = sizeof(char);
2106
2107         PRINT_D(HOSTINF_DBG, "Getting RSSI value\n");
2108
2109         result = send_config_pkt(GET_CFG, &wid, 1,
2110                                  get_id_from_handler(hif_drv));
2111         if (result) {
2112                 PRINT_ER("Failed to get RSSI value\n");
2113                 result = -EFAULT;
2114         }
2115
2116         up(&hif_drv->sem_get_rssi);
2117 }
2118
2119 static void Handle_GetLinkspeed(struct host_if_drv *hif_drv)
2120 {
2121         s32 result = 0;
2122         struct wid wid;
2123
2124         link_speed = 0;
2125
2126         wid.id = (u16)WID_LINKSPEED;
2127         wid.type = WID_CHAR;
2128         wid.val = &link_speed;
2129         wid.size = sizeof(char);
2130
2131         PRINT_D(HOSTINF_DBG, "Getting LINKSPEED value\n");
2132
2133         result = send_config_pkt(GET_CFG, &wid, 1,
2134                                  get_id_from_handler(hif_drv));
2135         if (result) {
2136                 PRINT_ER("Failed to get LINKSPEED value\n");
2137                 result = -EFAULT;
2138         }
2139
2140         up(&hif_drv->sem_get_link_speed);
2141 }
2142
2143 s32 Handle_GetStatistics(struct host_if_drv *hif_drv, struct rf_info *pstrStatistics)
2144 {
2145         struct wid strWIDList[5];
2146         u32 u32WidsCount = 0, result = 0;
2147
2148         strWIDList[u32WidsCount].id = WID_LINKSPEED;
2149         strWIDList[u32WidsCount].type = WID_CHAR;
2150         strWIDList[u32WidsCount].size = sizeof(char);
2151         strWIDList[u32WidsCount].val = (s8 *)&pstrStatistics->link_speed;
2152         u32WidsCount++;
2153
2154         strWIDList[u32WidsCount].id = WID_RSSI;
2155         strWIDList[u32WidsCount].type = WID_CHAR;
2156         strWIDList[u32WidsCount].size = sizeof(char);
2157         strWIDList[u32WidsCount].val = (s8 *)&pstrStatistics->rssi;
2158         u32WidsCount++;
2159
2160         strWIDList[u32WidsCount].id = WID_SUCCESS_FRAME_COUNT;
2161         strWIDList[u32WidsCount].type = WID_INT;
2162         strWIDList[u32WidsCount].size = sizeof(u32);
2163         strWIDList[u32WidsCount].val = (s8 *)&pstrStatistics->tx_cnt;
2164         u32WidsCount++;
2165
2166         strWIDList[u32WidsCount].id = WID_RECEIVED_FRAGMENT_COUNT;
2167         strWIDList[u32WidsCount].type = WID_INT;
2168         strWIDList[u32WidsCount].size = sizeof(u32);
2169         strWIDList[u32WidsCount].val = (s8 *)&pstrStatistics->rx_cnt;
2170         u32WidsCount++;
2171
2172         strWIDList[u32WidsCount].id = WID_FAILED_COUNT;
2173         strWIDList[u32WidsCount].type = WID_INT;
2174         strWIDList[u32WidsCount].size = sizeof(u32);
2175         strWIDList[u32WidsCount].val = (s8 *)&pstrStatistics->tx_fail_cnt;
2176         u32WidsCount++;
2177
2178         result = send_config_pkt(GET_CFG, strWIDList, u32WidsCount,
2179                                  get_id_from_handler(hif_drv));
2180
2181         if (result)
2182                 PRINT_ER("Failed to send scan paramters config packet\n");
2183
2184         up(&hif_sema_wait_response);
2185         return 0;
2186 }
2187
2188 static s32 Handle_Get_InActiveTime(struct host_if_drv *hif_drv,
2189                                    struct sta_inactive_t *strHostIfStaInactiveT)
2190 {
2191         s32 result = 0;
2192         u8 *stamac;
2193         struct wid wid;
2194
2195         wid.id = (u16)WID_SET_STA_MAC_INACTIVE_TIME;
2196         wid.type = WID_STR;
2197         wid.size = ETH_ALEN;
2198         wid.val = kmalloc(wid.size, GFP_KERNEL);
2199
2200         stamac = wid.val;
2201         memcpy(stamac, strHostIfStaInactiveT->mac, ETH_ALEN);
2202
2203         PRINT_D(CFG80211_DBG, "SETING STA inactive time\n");
2204
2205         result = send_config_pkt(SET_CFG, &wid, 1,
2206                                  get_id_from_handler(hif_drv));
2207
2208         if (result) {
2209                 PRINT_ER("Failed to SET incative time\n");
2210                 return -EFAULT;
2211         }
2212
2213         wid.id = (u16)WID_GET_INACTIVE_TIME;
2214         wid.type = WID_INT;
2215         wid.val = (s8 *)&inactive_time;
2216         wid.size = sizeof(u32);
2217
2218         result = send_config_pkt(GET_CFG, &wid, 1,
2219                                  get_id_from_handler(hif_drv));
2220
2221         if (result) {
2222                 PRINT_ER("Failed to get incative time\n");
2223                 return -EFAULT;
2224         }
2225
2226         PRINT_D(CFG80211_DBG, "Getting inactive time : %d\n", inactive_time);
2227
2228         up(&hif_drv->sem_inactive_time);
2229
2230         return result;
2231 }
2232
2233 static void Handle_AddBeacon(struct host_if_drv *hif_drv,
2234                              struct beacon_attr *pstrSetBeaconParam)
2235 {
2236         s32 result = 0;
2237         struct wid wid;
2238         u8 *pu8CurrByte;
2239
2240         PRINT_D(HOSTINF_DBG, "Adding BEACON\n");
2241
2242         wid.id = (u16)WID_ADD_BEACON;
2243         wid.type = WID_BIN;
2244         wid.size = pstrSetBeaconParam->head_len + pstrSetBeaconParam->tail_len + 16;
2245         wid.val = kmalloc(wid.size, GFP_KERNEL);
2246         if (!wid.val)
2247                 goto ERRORHANDLER;
2248
2249         pu8CurrByte = wid.val;
2250         *pu8CurrByte++ = (pstrSetBeaconParam->interval & 0xFF);
2251         *pu8CurrByte++ = ((pstrSetBeaconParam->interval >> 8) & 0xFF);
2252         *pu8CurrByte++ = ((pstrSetBeaconParam->interval >> 16) & 0xFF);
2253         *pu8CurrByte++ = ((pstrSetBeaconParam->interval >> 24) & 0xFF);
2254
2255         *pu8CurrByte++ = (pstrSetBeaconParam->dtim_period & 0xFF);
2256         *pu8CurrByte++ = ((pstrSetBeaconParam->dtim_period >> 8) & 0xFF);
2257         *pu8CurrByte++ = ((pstrSetBeaconParam->dtim_period >> 16) & 0xFF);
2258         *pu8CurrByte++ = ((pstrSetBeaconParam->dtim_period >> 24) & 0xFF);
2259
2260         *pu8CurrByte++ = (pstrSetBeaconParam->head_len & 0xFF);
2261         *pu8CurrByte++ = ((pstrSetBeaconParam->head_len >> 8) & 0xFF);
2262         *pu8CurrByte++ = ((pstrSetBeaconParam->head_len >> 16) & 0xFF);
2263         *pu8CurrByte++ = ((pstrSetBeaconParam->head_len >> 24) & 0xFF);
2264
2265         memcpy(pu8CurrByte, pstrSetBeaconParam->head, pstrSetBeaconParam->head_len);
2266         pu8CurrByte += pstrSetBeaconParam->head_len;
2267
2268         *pu8CurrByte++ = (pstrSetBeaconParam->tail_len & 0xFF);
2269         *pu8CurrByte++ = ((pstrSetBeaconParam->tail_len >> 8) & 0xFF);
2270         *pu8CurrByte++ = ((pstrSetBeaconParam->tail_len >> 16) & 0xFF);
2271         *pu8CurrByte++ = ((pstrSetBeaconParam->tail_len >> 24) & 0xFF);
2272
2273         if (pstrSetBeaconParam->tail > 0)
2274                 memcpy(pu8CurrByte, pstrSetBeaconParam->tail, pstrSetBeaconParam->tail_len);
2275         pu8CurrByte += pstrSetBeaconParam->tail_len;
2276
2277         result = send_config_pkt(SET_CFG, &wid, 1,
2278                                  get_id_from_handler(hif_drv));
2279         if (result)
2280                 PRINT_ER("Failed to send add beacon config packet\n");
2281
2282 ERRORHANDLER:
2283         kfree(wid.val);
2284         kfree(pstrSetBeaconParam->head);
2285         kfree(pstrSetBeaconParam->tail);
2286 }
2287
2288 static void Handle_DelBeacon(struct host_if_drv *hif_drv)
2289 {
2290         s32 result = 0;
2291         struct wid wid;
2292         u8 *pu8CurrByte;
2293
2294         wid.id = (u16)WID_DEL_BEACON;
2295         wid.type = WID_CHAR;
2296         wid.size = sizeof(char);
2297         wid.val = &del_beacon;
2298
2299         if (!wid.val)
2300                 return;
2301
2302         pu8CurrByte = wid.val;
2303
2304         PRINT_D(HOSTINF_DBG, "Deleting BEACON\n");
2305
2306         result = send_config_pkt(SET_CFG, &wid, 1,
2307                                  get_id_from_handler(hif_drv));
2308         if (result)
2309                 PRINT_ER("Failed to send delete beacon config packet\n");
2310 }
2311
2312 static u32 WILC_HostIf_PackStaParam(u8 *pu8Buffer,
2313                                     struct add_sta_param *pstrStationParam)
2314 {
2315         u8 *pu8CurrByte;
2316
2317         pu8CurrByte = pu8Buffer;
2318
2319         PRINT_D(HOSTINF_DBG, "Packing STA params\n");
2320         memcpy(pu8CurrByte, pstrStationParam->bssid, ETH_ALEN);
2321         pu8CurrByte +=  ETH_ALEN;
2322
2323         *pu8CurrByte++ = pstrStationParam->aid & 0xFF;
2324         *pu8CurrByte++ = (pstrStationParam->aid >> 8) & 0xFF;
2325
2326         *pu8CurrByte++ = pstrStationParam->rates_len;
2327         if (pstrStationParam->rates_len > 0)
2328                 memcpy(pu8CurrByte, pstrStationParam->rates,
2329                        pstrStationParam->rates_len);
2330         pu8CurrByte += pstrStationParam->rates_len;
2331
2332         *pu8CurrByte++ = pstrStationParam->ht_supported;
2333         *pu8CurrByte++ = pstrStationParam->ht_capa_info & 0xFF;
2334         *pu8CurrByte++ = (pstrStationParam->ht_capa_info >> 8) & 0xFF;
2335
2336         *pu8CurrByte++ = pstrStationParam->ht_ampdu_params;
2337         memcpy(pu8CurrByte, pstrStationParam->ht_supp_mcs_set,
2338                WILC_SUPP_MCS_SET_SIZE);
2339         pu8CurrByte += WILC_SUPP_MCS_SET_SIZE;
2340
2341         *pu8CurrByte++ = pstrStationParam->ht_ext_params & 0xFF;
2342         *pu8CurrByte++ = (pstrStationParam->ht_ext_params >> 8) & 0xFF;
2343
2344         *pu8CurrByte++ = pstrStationParam->ht_tx_bf_cap & 0xFF;
2345         *pu8CurrByte++ = (pstrStationParam->ht_tx_bf_cap >> 8) & 0xFF;
2346         *pu8CurrByte++ = (pstrStationParam->ht_tx_bf_cap >> 16) & 0xFF;
2347         *pu8CurrByte++ = (pstrStationParam->ht_tx_bf_cap >> 24) & 0xFF;
2348
2349         *pu8CurrByte++ = pstrStationParam->ht_ante_sel;
2350
2351         *pu8CurrByte++ = pstrStationParam->flags_mask & 0xFF;
2352         *pu8CurrByte++ = (pstrStationParam->flags_mask >> 8) & 0xFF;
2353
2354         *pu8CurrByte++ = pstrStationParam->flags_set & 0xFF;
2355         *pu8CurrByte++ = (pstrStationParam->flags_set >> 8) & 0xFF;
2356
2357         return pu8CurrByte - pu8Buffer;
2358 }
2359
2360 static void Handle_AddStation(struct host_if_drv *hif_drv,
2361                               struct add_sta_param *pstrStationParam)
2362 {
2363         s32 result = 0;
2364         struct wid wid;
2365         u8 *pu8CurrByte;
2366
2367         PRINT_D(HOSTINF_DBG, "Handling add station\n");
2368         wid.id = (u16)WID_ADD_STA;
2369         wid.type = WID_BIN;
2370         wid.size = WILC_ADD_STA_LENGTH + pstrStationParam->rates_len;
2371
2372         wid.val = kmalloc(wid.size, GFP_KERNEL);
2373         if (!wid.val)
2374                 goto ERRORHANDLER;
2375
2376         pu8CurrByte = wid.val;
2377         pu8CurrByte += WILC_HostIf_PackStaParam(pu8CurrByte, pstrStationParam);
2378
2379         result = send_config_pkt(SET_CFG, &wid, 1,
2380                                  get_id_from_handler(hif_drv));
2381         if (result != 0)
2382                 PRINT_ER("Failed to send add station config packet\n");
2383
2384 ERRORHANDLER:
2385         kfree(pstrStationParam->rates);
2386         kfree(wid.val);
2387 }
2388
2389 static void Handle_DelAllSta(struct host_if_drv *hif_drv,
2390                              struct del_all_sta *pstrDelAllStaParam)
2391 {
2392         s32 result = 0;
2393         struct wid wid;
2394         u8 *pu8CurrByte;
2395         u8 i;
2396         u8 au8Zero_Buff[6] = {0};
2397
2398         wid.id = (u16)WID_DEL_ALL_STA;
2399         wid.type = WID_STR;
2400         wid.size = (pstrDelAllStaParam->assoc_sta * ETH_ALEN) + 1;
2401
2402         PRINT_D(HOSTINF_DBG, "Handling delete station\n");
2403
2404         wid.val = kmalloc((pstrDelAllStaParam->assoc_sta * ETH_ALEN) + 1, GFP_KERNEL);
2405         if (!wid.val)
2406                 goto ERRORHANDLER;
2407
2408         pu8CurrByte = wid.val;
2409
2410         *(pu8CurrByte++) = pstrDelAllStaParam->assoc_sta;
2411
2412         for (i = 0; i < MAX_NUM_STA; i++) {
2413                 if (memcmp(pstrDelAllStaParam->del_all_sta[i], au8Zero_Buff, ETH_ALEN))
2414                         memcpy(pu8CurrByte, pstrDelAllStaParam->del_all_sta[i], ETH_ALEN);
2415                 else
2416                         continue;
2417
2418                 pu8CurrByte += ETH_ALEN;
2419         }
2420
2421         result = send_config_pkt(SET_CFG, &wid, 1,
2422                                  get_id_from_handler(hif_drv));
2423         if (result)
2424                 PRINT_ER("Failed to send add station config packet\n");
2425
2426 ERRORHANDLER:
2427         kfree(wid.val);
2428
2429         up(&hif_sema_wait_response);
2430 }
2431
2432 static void Handle_DelStation(struct host_if_drv *hif_drv,
2433                               struct del_sta *pstrDelStaParam)
2434 {
2435         s32 result = 0;
2436         struct wid wid;
2437         u8 *pu8CurrByte;
2438
2439         wid.id = (u16)WID_REMOVE_STA;
2440         wid.type = WID_BIN;
2441         wid.size = ETH_ALEN;
2442
2443         PRINT_D(HOSTINF_DBG, "Handling delete station\n");
2444
2445         wid.val = kmalloc(wid.size, GFP_KERNEL);
2446         if (!wid.val)
2447                 goto ERRORHANDLER;
2448
2449         pu8CurrByte = wid.val;
2450
2451         memcpy(pu8CurrByte, pstrDelStaParam->mac_addr, ETH_ALEN);
2452
2453         result = send_config_pkt(SET_CFG, &wid, 1,
2454                                  get_id_from_handler(hif_drv));
2455         if (result)
2456                 PRINT_ER("Failed to send add station config packet\n");
2457
2458 ERRORHANDLER:
2459         kfree(wid.val);
2460 }
2461
2462 static void Handle_EditStation(struct host_if_drv *hif_drv,
2463                                struct add_sta_param *pstrStationParam)
2464 {
2465         s32 result = 0;
2466         struct wid wid;
2467         u8 *pu8CurrByte;
2468
2469         wid.id = (u16)WID_EDIT_STA;
2470         wid.type = WID_BIN;
2471         wid.size = WILC_ADD_STA_LENGTH + pstrStationParam->rates_len;
2472
2473         PRINT_D(HOSTINF_DBG, "Handling edit station\n");
2474         wid.val = kmalloc(wid.size, GFP_KERNEL);
2475         if (!wid.val)
2476                 goto ERRORHANDLER;
2477
2478         pu8CurrByte = wid.val;
2479         pu8CurrByte += WILC_HostIf_PackStaParam(pu8CurrByte, pstrStationParam);
2480
2481         result = send_config_pkt(SET_CFG, &wid, 1,
2482                                  get_id_from_handler(hif_drv));
2483         if (result)
2484                 PRINT_ER("Failed to send edit station config packet\n");
2485
2486 ERRORHANDLER:
2487         kfree(pstrStationParam->rates);
2488         kfree(wid.val);
2489 }
2490
2491 static int Handle_RemainOnChan(struct host_if_drv *hif_drv,
2492                                struct remain_ch *pstrHostIfRemainOnChan)
2493 {
2494         s32 result = 0;
2495         u8 u8remain_on_chan_flag;
2496         struct wid wid;
2497
2498         if (!hif_drv->remain_on_ch_pending) {
2499                 hif_drv->remain_on_ch.arg = pstrHostIfRemainOnChan->arg;
2500                 hif_drv->remain_on_ch.expired = pstrHostIfRemainOnChan->expired;
2501                 hif_drv->remain_on_ch.ready = pstrHostIfRemainOnChan->ready;
2502                 hif_drv->remain_on_ch.ch = pstrHostIfRemainOnChan->ch;
2503                 hif_drv->remain_on_ch.id = pstrHostIfRemainOnChan->id;
2504         } else {
2505                 pstrHostIfRemainOnChan->ch = hif_drv->remain_on_ch.ch;
2506         }
2507
2508         if (hif_drv->usr_scan_req.scan_result) {
2509                 PRINT_INFO(GENERIC_DBG, "Required to remain on chan while scanning return\n");
2510                 hif_drv->remain_on_ch_pending = 1;
2511                 result = -EBUSY;
2512                 goto ERRORHANDLER;
2513         }
2514         if (hif_drv->hif_state == HOST_IF_WAITING_CONN_RESP) {
2515                 PRINT_INFO(GENERIC_DBG, "Required to remain on chan while connecting return\n");
2516                 result = -EBUSY;
2517                 goto ERRORHANDLER;
2518         }
2519
2520         if (g_obtainingIP || connecting) {
2521                 PRINT_D(GENERIC_DBG, "[handle_scan]: Don't do obss scan until IP adresss is obtained\n");
2522                 result = -EBUSY;
2523                 goto ERRORHANDLER;
2524         }
2525
2526         PRINT_D(HOSTINF_DBG, "Setting channel :%d\n",
2527                 pstrHostIfRemainOnChan->ch);
2528
2529         u8remain_on_chan_flag = true;
2530         wid.id = (u16)WID_REMAIN_ON_CHAN;
2531         wid.type = WID_STR;
2532         wid.size = 2;
2533         wid.val = kmalloc(wid.size, GFP_KERNEL);
2534         if (!wid.val) {
2535                 result = -ENOMEM;
2536                 goto ERRORHANDLER;
2537         }
2538
2539         wid.val[0] = u8remain_on_chan_flag;
2540         wid.val[1] = (s8)pstrHostIfRemainOnChan->ch;
2541
2542         result = send_config_pkt(SET_CFG, &wid, 1,
2543                                  get_id_from_handler(hif_drv));
2544         if (result != 0)
2545                 PRINT_ER("Failed to set remain on channel\n");
2546
2547 ERRORHANDLER:
2548         {
2549                 P2P_LISTEN_STATE = 1;
2550                 hif_drv->remain_on_ch_timer.data = (unsigned long)hif_drv;
2551                 mod_timer(&hif_drv->remain_on_ch_timer,
2552                           jiffies +
2553                           msecs_to_jiffies(pstrHostIfRemainOnChan->u32duration));
2554
2555                 if (hif_drv->remain_on_ch.ready)
2556                         hif_drv->remain_on_ch.ready(hif_drv->remain_on_ch.arg);
2557
2558                 if (hif_drv->remain_on_ch_pending)
2559                         hif_drv->remain_on_ch_pending = 0;
2560         }
2561
2562         return result;
2563 }
2564
2565 static int Handle_RegisterFrame(struct host_if_drv *hif_drv,
2566                                 struct reg_frame *pstrHostIfRegisterFrame)
2567 {
2568         s32 result = 0;
2569         struct wid wid;
2570         u8 *pu8CurrByte;
2571
2572         PRINT_D(HOSTINF_DBG, "Handling frame register : %d FrameType: %d\n",
2573                 pstrHostIfRegisterFrame->reg,
2574                 pstrHostIfRegisterFrame->frame_type);
2575
2576         wid.id = (u16)WID_REGISTER_FRAME;
2577         wid.type = WID_STR;
2578         wid.val = kmalloc(sizeof(u16) + 2, GFP_KERNEL);
2579         if (!wid.val)
2580                 return -ENOMEM;
2581
2582         pu8CurrByte = wid.val;
2583
2584         *pu8CurrByte++ = pstrHostIfRegisterFrame->reg;
2585         *pu8CurrByte++ = pstrHostIfRegisterFrame->reg_id;
2586         memcpy(pu8CurrByte, &pstrHostIfRegisterFrame->frame_type, sizeof(u16));
2587
2588         wid.size = sizeof(u16) + 2;
2589
2590         result = send_config_pkt(SET_CFG, &wid, 1,
2591                                  get_id_from_handler(hif_drv));
2592         if (result) {
2593                 PRINT_ER("Failed to frame register config packet\n");
2594                 result = -EINVAL;
2595         }
2596
2597         return result;
2598 }
2599
2600 static u32 Handle_ListenStateExpired(struct host_if_drv *hif_drv,
2601                                      struct remain_ch *pstrHostIfRemainOnChan)
2602 {
2603         u8 u8remain_on_chan_flag;
2604         struct wid wid;
2605         s32 result = 0;
2606
2607         PRINT_D(HOSTINF_DBG, "CANCEL REMAIN ON CHAN\n");
2608
2609         if (P2P_LISTEN_STATE) {
2610                 u8remain_on_chan_flag = false;
2611                 wid.id = (u16)WID_REMAIN_ON_CHAN;
2612                 wid.type = WID_STR;
2613                 wid.size = 2;
2614                 wid.val = kmalloc(wid.size, GFP_KERNEL);
2615
2616                 if (!wid.val)
2617                         PRINT_ER("Failed to allocate memory\n");
2618
2619                 wid.val[0] = u8remain_on_chan_flag;
2620                 wid.val[1] = FALSE_FRMWR_CHANNEL;
2621
2622                 result = send_config_pkt(SET_CFG, &wid, 1,
2623                                          get_id_from_handler(hif_drv));
2624                 if (result != 0) {
2625                         PRINT_ER("Failed to set remain on channel\n");
2626                         goto _done_;
2627                 }
2628
2629                 if (hif_drv->remain_on_ch.expired) {
2630                         hif_drv->remain_on_ch.expired(hif_drv->remain_on_ch.arg,
2631                                                       pstrHostIfRemainOnChan->id);
2632                 }
2633                 P2P_LISTEN_STATE = 0;
2634         } else {
2635                 PRINT_D(GENERIC_DBG, "Not in listen state\n");
2636                 result = -EFAULT;
2637         }
2638
2639 _done_:
2640         return result;
2641 }
2642
2643 static void ListenTimerCB(unsigned long arg)
2644 {
2645         s32 result = 0;
2646         struct host_if_msg msg;
2647         struct host_if_drv *hif_drv = (struct host_if_drv *)arg;
2648
2649         del_timer(&hif_drv->remain_on_ch_timer);
2650
2651         memset(&msg, 0, sizeof(struct host_if_msg));
2652         msg.id = HOST_IF_MSG_LISTEN_TIMER_FIRED;
2653         msg.drv = hif_drv;
2654         msg.body.remain_on_ch.id = hif_drv->remain_on_ch.id;
2655
2656         result = wilc_mq_send(&hif_msg_q, &msg, sizeof(struct host_if_msg));
2657         if (result)
2658                 PRINT_ER("wilc_mq_send fail\n");
2659 }
2660
2661 static void Handle_PowerManagement(struct host_if_drv *hif_drv,
2662                                    struct power_mgmt_param *strPowerMgmtParam)
2663 {
2664         s32 result = 0;
2665         struct wid wid;
2666         s8 s8PowerMode;
2667
2668         wid.id = (u16)WID_POWER_MANAGEMENT;
2669
2670         if (strPowerMgmtParam->enabled)
2671                 s8PowerMode = MIN_FAST_PS;
2672         else
2673                 s8PowerMode = NO_POWERSAVE;
2674         PRINT_D(HOSTINF_DBG, "Handling power mgmt to %d\n", s8PowerMode);
2675         wid.val = &s8PowerMode;
2676         wid.size = sizeof(char);
2677
2678         PRINT_D(HOSTINF_DBG, "Handling Power Management\n");
2679
2680         result = send_config_pkt(SET_CFG, &wid, 1,
2681                                  get_id_from_handler(hif_drv));
2682         if (result)
2683                 PRINT_ER("Failed to send power management config packet\n");
2684 }
2685
2686 static void Handle_SetMulticastFilter(struct host_if_drv *hif_drv,
2687                                       struct set_multicast *strHostIfSetMulti)
2688 {
2689         s32 result = 0;
2690         struct wid wid;
2691         u8 *pu8CurrByte;
2692
2693         PRINT_D(HOSTINF_DBG, "Setup Multicast Filter\n");
2694
2695         wid.id = (u16)WID_SETUP_MULTICAST_FILTER;
2696         wid.type = WID_BIN;
2697         wid.size = sizeof(struct set_multicast) + ((strHostIfSetMulti->cnt) * ETH_ALEN);
2698         wid.val = kmalloc(wid.size, GFP_KERNEL);
2699         if (!wid.val)
2700                 goto ERRORHANDLER;
2701
2702         pu8CurrByte = wid.val;
2703         *pu8CurrByte++ = (strHostIfSetMulti->enabled & 0xFF);
2704         *pu8CurrByte++ = ((strHostIfSetMulti->enabled >> 8) & 0xFF);
2705         *pu8CurrByte++ = ((strHostIfSetMulti->enabled >> 16) & 0xFF);
2706         *pu8CurrByte++ = ((strHostIfSetMulti->enabled >> 24) & 0xFF);
2707
2708         *pu8CurrByte++ = (strHostIfSetMulti->cnt & 0xFF);
2709         *pu8CurrByte++ = ((strHostIfSetMulti->cnt >> 8) & 0xFF);
2710         *pu8CurrByte++ = ((strHostIfSetMulti->cnt >> 16) & 0xFF);
2711         *pu8CurrByte++ = ((strHostIfSetMulti->cnt >> 24) & 0xFF);
2712
2713         if ((strHostIfSetMulti->cnt) > 0)
2714                 memcpy(pu8CurrByte, multicast_mac_addr_list,
2715                        ((strHostIfSetMulti->cnt) * ETH_ALEN));
2716
2717         result = send_config_pkt(SET_CFG, &wid, 1,
2718                                  get_id_from_handler(hif_drv));
2719         if (result)
2720                 PRINT_ER("Failed to send setup multicast config packet\n");
2721
2722 ERRORHANDLER:
2723         kfree(wid.val);
2724 }
2725
2726 static s32 Handle_AddBASession(struct host_if_drv *hif_drv,
2727                                struct ba_session_info *strHostIfBASessionInfo)
2728 {
2729         s32 result = 0;
2730         struct wid wid;
2731         int AddbaTimeout = 100;
2732         char *ptr = NULL;
2733
2734         PRINT_D(HOSTINF_DBG, "Opening Block Ack session with\nBSSID = %.2x:%.2x:%.2x\nTID=%d\nBufferSize == %d\nSessionTimeOut = %d\n",
2735                 strHostIfBASessionInfo->bssid[0],
2736                 strHostIfBASessionInfo->bssid[1],
2737                 strHostIfBASessionInfo->bssid[2],
2738                 strHostIfBASessionInfo->buf_size,
2739                 strHostIfBASessionInfo->time_out,
2740                 strHostIfBASessionInfo->tid);
2741
2742         wid.id = (u16)WID_11E_P_ACTION_REQ;
2743         wid.type = WID_STR;
2744         wid.val = kmalloc(BLOCK_ACK_REQ_SIZE, GFP_KERNEL);
2745         wid.size = BLOCK_ACK_REQ_SIZE;
2746         ptr = wid.val;
2747         *ptr++ = 0x14;
2748         *ptr++ = 0x3;
2749         *ptr++ = 0x0;
2750         memcpy(ptr, strHostIfBASessionInfo->bssid, ETH_ALEN);
2751         ptr += ETH_ALEN;
2752         *ptr++ = strHostIfBASessionInfo->tid;
2753         *ptr++ = 1;
2754         *ptr++ = (strHostIfBASessionInfo->buf_size & 0xFF);
2755         *ptr++ = ((strHostIfBASessionInfo->buf_size >> 16) & 0xFF);
2756         *ptr++ = (strHostIfBASessionInfo->time_out & 0xFF);
2757         *ptr++ = ((strHostIfBASessionInfo->time_out >> 16) & 0xFF);
2758         *ptr++ = (AddbaTimeout & 0xFF);
2759         *ptr++ = ((AddbaTimeout >> 16) & 0xFF);
2760         *ptr++ = 8;
2761         *ptr++ = 0;
2762
2763         result = send_config_pkt(SET_CFG, &wid, 1,
2764                                  get_id_from_handler(hif_drv));
2765         if (result)
2766                 PRINT_D(HOSTINF_DBG, "Couldn't open BA Session\n");
2767
2768         wid.id = (u16)WID_11E_P_ACTION_REQ;
2769         wid.type = WID_STR;
2770         wid.size = 15;
2771         ptr = wid.val;
2772         *ptr++ = 15;
2773         *ptr++ = 7;
2774         *ptr++ = 0x2;
2775         memcpy(ptr, strHostIfBASessionInfo->bssid, ETH_ALEN);
2776         ptr += ETH_ALEN;
2777         *ptr++ = strHostIfBASessionInfo->tid;
2778         *ptr++ = 8;
2779         *ptr++ = (strHostIfBASessionInfo->buf_size & 0xFF);
2780         *ptr++ = ((strHostIfBASessionInfo->time_out >> 16) & 0xFF);
2781         *ptr++ = 3;
2782         result = send_config_pkt(SET_CFG, &wid, 1,
2783                                  get_id_from_handler(hif_drv));
2784
2785         kfree(wid.val);
2786
2787         return result;
2788 }
2789
2790 static s32 Handle_DelAllRxBASessions(struct host_if_drv *hif_drv,
2791                                      struct ba_session_info *strHostIfBASessionInfo)
2792 {
2793         s32 result = 0;
2794         struct wid wid;
2795         char *ptr = NULL;
2796
2797         PRINT_D(GENERIC_DBG, "Delete Block Ack session with\nBSSID = %.2x:%.2x:%.2x\nTID=%d\n",
2798                 strHostIfBASessionInfo->bssid[0],
2799                 strHostIfBASessionInfo->bssid[1],
2800                 strHostIfBASessionInfo->bssid[2],
2801                 strHostIfBASessionInfo->tid);
2802
2803         wid.id = (u16)WID_DEL_ALL_RX_BA;
2804         wid.type = WID_STR;
2805         wid.val = kmalloc(BLOCK_ACK_REQ_SIZE, GFP_KERNEL);
2806         wid.size = BLOCK_ACK_REQ_SIZE;
2807         ptr = wid.val;
2808         *ptr++ = 0x14;
2809         *ptr++ = 0x3;
2810         *ptr++ = 0x2;
2811         memcpy(ptr, strHostIfBASessionInfo->bssid, ETH_ALEN);
2812         ptr += ETH_ALEN;
2813         *ptr++ = strHostIfBASessionInfo->tid;
2814         *ptr++ = 0;
2815         *ptr++ = 32;
2816
2817         result = send_config_pkt(SET_CFG, &wid, 1,
2818                                  get_id_from_handler(hif_drv));
2819         if (result)
2820                 PRINT_D(HOSTINF_DBG, "Couldn't delete BA Session\n");
2821
2822         kfree(wid.val);
2823
2824         up(&hif_sema_wait_response);
2825
2826         return result;
2827 }
2828
2829 static int hostIFthread(void *pvArg)
2830 {
2831         u32 u32Ret;
2832         struct host_if_msg msg;
2833         struct host_if_drv *hif_drv;
2834
2835         memset(&msg, 0, sizeof(struct host_if_msg));
2836
2837         while (1) {
2838                 wilc_mq_recv(&hif_msg_q, &msg, sizeof(struct host_if_msg), &u32Ret);
2839                 hif_drv = (struct host_if_drv *)msg.drv;
2840                 if (msg.id == HOST_IF_MSG_EXIT) {
2841                         PRINT_D(GENERIC_DBG, "THREAD: Exiting HostIfThread\n");
2842                         break;
2843                 }
2844
2845                 if ((!g_wilc_initialized)) {
2846                         PRINT_D(GENERIC_DBG, "--WAIT--");
2847                         usleep_range(200 * 1000, 200 * 1000);
2848                         wilc_mq_send(&hif_msg_q, &msg, sizeof(struct host_if_msg));
2849                         continue;
2850                 }
2851
2852                 if (msg.id == HOST_IF_MSG_CONNECT &&
2853                     hif_drv->usr_scan_req.scan_result) {
2854                         PRINT_D(HOSTINF_DBG, "Requeue connect request till scan done received\n");
2855                         wilc_mq_send(&hif_msg_q, &msg, sizeof(struct host_if_msg));
2856                         usleep_range(2 * 1000, 2 * 1000);
2857                         continue;
2858                 }
2859
2860                 switch (msg.id) {
2861                 case HOST_IF_MSG_Q_IDLE:
2862                         Handle_wait_msg_q_empty();
2863                         break;
2864
2865                 case HOST_IF_MSG_SCAN:
2866                         Handle_Scan(msg.drv, &msg.body.scan_info);
2867                         break;
2868
2869                 case HOST_IF_MSG_CONNECT:
2870                         Handle_Connect(msg.drv, &msg.body.con_info);
2871                         break;
2872
2873                 case HOST_IF_MSG_FLUSH_CONNECT:
2874                         Handle_FlushConnect(msg.drv);
2875                         break;
2876
2877                 case HOST_IF_MSG_RCVD_NTWRK_INFO:
2878                         Handle_RcvdNtwrkInfo(msg.drv, &msg.body.net_info);
2879                         break;
2880
2881                 case HOST_IF_MSG_RCVD_GNRL_ASYNC_INFO:
2882                         Handle_RcvdGnrlAsyncInfo(msg.drv, &msg.body.async_info);
2883                         break;
2884
2885                 case HOST_IF_MSG_KEY:
2886                         Handle_Key(msg.drv, &msg.body.key_info);
2887                         break;
2888
2889                 case HOST_IF_MSG_CFG_PARAMS:
2890                         handle_cfg_param(msg.drv, &msg.body.cfg_info);
2891                         break;
2892
2893                 case HOST_IF_MSG_SET_CHANNEL:
2894                         handle_set_channel(msg.drv, &msg.body.channel_info);
2895                         break;
2896
2897                 case HOST_IF_MSG_DISCONNECT:
2898                         Handle_Disconnect(msg.drv);
2899                         break;
2900
2901                 case HOST_IF_MSG_RCVD_SCAN_COMPLETE:
2902                         del_timer(&hif_drv->scan_timer);
2903                         PRINT_D(HOSTINF_DBG, "scan completed successfully\n");
2904
2905                         if (!linux_wlan_get_num_conn_ifcs())
2906                                 chip_sleep_manually();
2907
2908                         Handle_ScanDone(msg.drv, SCAN_EVENT_DONE);
2909
2910                         if (hif_drv->remain_on_ch_pending)
2911                                 Handle_RemainOnChan(msg.drv, &msg.body.remain_on_ch);
2912
2913                         break;
2914
2915                 case HOST_IF_MSG_GET_RSSI:
2916                         Handle_GetRssi(msg.drv);
2917                         break;
2918
2919                 case HOST_IF_MSG_GET_LINKSPEED:
2920                         Handle_GetLinkspeed(msg.drv);
2921                         break;
2922
2923                 case HOST_IF_MSG_GET_STATISTICS:
2924                         Handle_GetStatistics(msg.drv, (struct rf_info *)msg.body.data);
2925                         break;
2926
2927                 case HOST_IF_MSG_GET_CHNL:
2928                         Handle_GetChnl(msg.drv);
2929                         break;
2930
2931                 case HOST_IF_MSG_ADD_BEACON:
2932                         Handle_AddBeacon(msg.drv, &msg.body.beacon_info);
2933                         break;
2934
2935                 case HOST_IF_MSG_DEL_BEACON:
2936                         Handle_DelBeacon(msg.drv);
2937                         break;
2938
2939                 case HOST_IF_MSG_ADD_STATION:
2940                         Handle_AddStation(msg.drv, &msg.body.add_sta_info);
2941                         break;
2942
2943                 case HOST_IF_MSG_DEL_STATION:
2944                         Handle_DelStation(msg.drv, &msg.body.del_sta_info);
2945                         break;
2946
2947                 case HOST_IF_MSG_EDIT_STATION:
2948                         Handle_EditStation(msg.drv, &msg.body.edit_sta_info);
2949                         break;
2950
2951                 case HOST_IF_MSG_GET_INACTIVETIME:
2952                         Handle_Get_InActiveTime(msg.drv, &msg.body.mac_info);
2953                         break;
2954
2955                 case HOST_IF_MSG_SCAN_TIMER_FIRED:
2956                         PRINT_D(HOSTINF_DBG, "Scan Timeout\n");
2957
2958                         Handle_ScanDone(msg.drv, SCAN_EVENT_ABORTED);
2959                         break;
2960
2961                 case HOST_IF_MSG_CONNECT_TIMER_FIRED:
2962                         PRINT_D(HOSTINF_DBG, "Connect Timeout\n");
2963                         Handle_ConnectTimeout(msg.drv);
2964                         break;
2965
2966                 case HOST_IF_MSG_POWER_MGMT:
2967                         Handle_PowerManagement(msg.drv, &msg.body.pwr_mgmt_info);
2968                         break;
2969
2970                 case HOST_IF_MSG_SET_WFIDRV_HANDLER:
2971                         handle_set_wfi_drv_handler(msg.drv, &msg.body.drv);
2972                         break;
2973
2974                 case HOST_IF_MSG_SET_OPERATION_MODE:
2975                         handle_set_operation_mode(msg.drv, &msg.body.mode);
2976                         break;
2977
2978                 case HOST_IF_MSG_SET_IPADDRESS:
2979                         PRINT_D(HOSTINF_DBG, "HOST_IF_MSG_SET_IPADDRESS\n");
2980                         handle_set_ip_address(msg.drv,
2981                                               msg.body.ip_info.ip_addr,
2982                                               msg.body.ip_info.idx);
2983                         break;
2984
2985                 case HOST_IF_MSG_GET_IPADDRESS:
2986                         PRINT_D(HOSTINF_DBG, "HOST_IF_MSG_SET_IPADDRESS\n");
2987                         handle_get_ip_address(msg.drv, msg.body.ip_info.idx);
2988                         break;
2989
2990                 case HOST_IF_MSG_SET_MAC_ADDRESS:
2991                         handle_set_mac_address(msg.drv,
2992                                                &msg.body.set_mac_info);
2993                         break;
2994
2995                 case HOST_IF_MSG_GET_MAC_ADDRESS:
2996                         handle_get_mac_address(msg.drv,
2997                                                &msg.body.get_mac_info);
2998                         break;
2999
3000                 case HOST_IF_MSG_REMAIN_ON_CHAN:
3001                         PRINT_D(HOSTINF_DBG, "HOST_IF_MSG_REMAIN_ON_CHAN\n");
3002                         Handle_RemainOnChan(msg.drv, &msg.body.remain_on_ch);
3003                         break;
3004
3005                 case HOST_IF_MSG_REGISTER_FRAME:
3006                         PRINT_D(HOSTINF_DBG, "HOST_IF_MSG_REGISTER_FRAME\n");
3007                         Handle_RegisterFrame(msg.drv, &msg.body.reg_frame);
3008                         break;
3009
3010                 case HOST_IF_MSG_LISTEN_TIMER_FIRED:
3011                         Handle_ListenStateExpired(msg.drv, &msg.body.remain_on_ch);
3012                         break;
3013
3014                 case HOST_IF_MSG_SET_MULTICAST_FILTER:
3015                         PRINT_D(HOSTINF_DBG, "HOST_IF_MSG_SET_MULTICAST_FILTER\n");
3016                         Handle_SetMulticastFilter(msg.drv, &msg.body.multicast_info);
3017                         break;
3018
3019                 case HOST_IF_MSG_ADD_BA_SESSION:
3020                         Handle_AddBASession(msg.drv, &msg.body.session_info);
3021                         break;
3022
3023                 case HOST_IF_MSG_DEL_ALL_RX_BA_SESSIONS:
3024                         Handle_DelAllRxBASessions(msg.drv, &msg.body.session_info);
3025                         break;
3026
3027                 case HOST_IF_MSG_DEL_ALL_STA:
3028                         Handle_DelAllSta(msg.drv, &msg.body.del_all_sta_info);
3029                         break;
3030
3031                 default:
3032                         PRINT_ER("[Host Interface] undefined Received Msg ID\n");
3033                         break;
3034                 }
3035         }
3036
3037         PRINT_D(HOSTINF_DBG, "Releasing thread exit semaphore\n");
3038         up(&hif_sema_thread);
3039         return 0;
3040 }
3041
3042 static void TimerCB_Scan(unsigned long arg)
3043 {
3044         void *pvArg = (void *)arg;
3045         struct host_if_msg msg;
3046
3047         memset(&msg, 0, sizeof(struct host_if_msg));
3048         msg.drv = pvArg;
3049         msg.id = HOST_IF_MSG_SCAN_TIMER_FIRED;
3050
3051         wilc_mq_send(&hif_msg_q, &msg, sizeof(struct host_if_msg));
3052 }
3053
3054 static void TimerCB_Connect(unsigned long arg)
3055 {
3056         void *pvArg = (void *)arg;
3057         struct host_if_msg msg;
3058
3059         memset(&msg, 0, sizeof(struct host_if_msg));
3060         msg.drv = pvArg;
3061         msg.id = HOST_IF_MSG_CONNECT_TIMER_FIRED;
3062
3063         wilc_mq_send(&hif_msg_q, &msg, sizeof(struct host_if_msg));
3064 }
3065
3066 s32 host_int_remove_key(struct host_if_drv *hif_drv, const u8 *pu8StaAddress)
3067 {
3068         struct wid wid;
3069
3070         wid.id = (u16)WID_REMOVE_KEY;
3071         wid.type = WID_STR;
3072         wid.val = (s8 *)pu8StaAddress;
3073         wid.size = 6;
3074
3075         return 0;
3076 }
3077
3078 int host_int_remove_wep_key(struct host_if_drv *hif_drv, u8 index)
3079 {
3080         int result = 0;
3081         struct host_if_msg msg;
3082
3083         if (!hif_drv) {
3084                 result = -EFAULT;
3085                 PRINT_ER("Failed to send setup multicast config packet\n");
3086                 return result;
3087         }
3088
3089         memset(&msg, 0, sizeof(struct host_if_msg));
3090
3091         msg.id = HOST_IF_MSG_KEY;
3092         msg.body.key_info.type = WEP;
3093         msg.body.key_info.action = REMOVEKEY;
3094         msg.drv = hif_drv;
3095         msg.body.key_info.attr.wep.index = index;
3096
3097         result = wilc_mq_send(&hif_msg_q, &msg, sizeof(struct host_if_msg));
3098         if (result)
3099                 PRINT_ER("Error in sending message queue : Request to remove WEP key\n");
3100         down(&hif_drv->sem_test_key_block);
3101
3102         return result;
3103 }
3104
3105 int host_int_set_wep_default_key(struct host_if_drv *hif_drv, u8 index)
3106 {
3107         int result = 0;
3108         struct host_if_msg msg;
3109
3110         if (!hif_drv) {
3111                 result = -EFAULT;
3112                 PRINT_ER("driver is null\n");
3113                 return result;
3114         }
3115
3116         memset(&msg, 0, sizeof(struct host_if_msg));
3117
3118         msg.id = HOST_IF_MSG_KEY;
3119         msg.body.key_info.type = WEP;
3120         msg.body.key_info.action = DEFAULTKEY;
3121         msg.drv = hif_drv;
3122         msg.body.key_info.attr.wep.index = index;
3123
3124         result = wilc_mq_send(&hif_msg_q, &msg, sizeof(struct host_if_msg));
3125         if (result)
3126                 PRINT_ER("Error in sending message queue : Default key index\n");
3127         down(&hif_drv->sem_test_key_block);
3128
3129         return result;
3130 }
3131
3132 int host_int_add_wep_key_bss_sta(struct host_if_drv *hif_drv,
3133                                  const u8 *key,
3134                                  u8 len,
3135                                  u8 index)
3136 {
3137         int result = 0;
3138         struct host_if_msg msg;
3139
3140         if (!hif_drv) {
3141                 PRINT_ER("driver is null\n");
3142                 return -EFAULT;
3143         }
3144
3145         memset(&msg, 0, sizeof(struct host_if_msg));
3146
3147         msg.id = HOST_IF_MSG_KEY;
3148         msg.body.key_info.type = WEP;
3149         msg.body.key_info.action = ADDKEY;
3150         msg.drv = hif_drv;
3151         msg.body.key_info.attr.wep.key = kmemdup(key, len, GFP_KERNEL);
3152         if (!msg.body.key_info.attr.wep.key)
3153                 return -ENOMEM;
3154
3155         msg.body.key_info.attr.wep.key_len = len;
3156         msg.body.key_info.attr.wep.index = index;
3157
3158         result = wilc_mq_send(&hif_msg_q, &msg, sizeof(struct host_if_msg));
3159         if (result)
3160                 PRINT_ER("Error in sending message queue :WEP Key\n");
3161         down(&hif_drv->sem_test_key_block);
3162
3163         return result;
3164 }
3165
3166 int host_int_add_wep_key_bss_ap(struct host_if_drv *hif_drv,
3167                                 const u8 *key,
3168                                 u8 len,
3169                                 u8 index,
3170                                 u8 mode,
3171                                 enum AUTHTYPE auth_type)
3172 {
3173         int result = 0;
3174         struct host_if_msg msg;
3175         int i;
3176
3177         if (!hif_drv) {
3178                 PRINT_ER("driver is null\n");
3179                 return -EFAULT;
3180         }
3181
3182         memset(&msg, 0, sizeof(struct host_if_msg));
3183
3184         if (INFO) {
3185                 for (i = 0; i < len; i++)
3186                         PRINT_INFO(HOSTAPD_DBG, "KEY is %x\n", key[i]);
3187         }
3188         msg.id = HOST_IF_MSG_KEY;
3189         msg.body.key_info.type = WEP;
3190         msg.body.key_info.action = ADDKEY_AP;
3191         msg.drv = hif_drv;
3192         msg.body.key_info.attr.wep.key = kmemdup(key, len, GFP_KERNEL);
3193         if (!msg.body.key_info.attr.wep.key)
3194                 return -ENOMEM;
3195
3196         msg.body.key_info.attr.wep.key_len = len;
3197         msg.body.key_info.attr.wep.index = index;
3198         msg.body.key_info.attr.wep.mode = mode;
3199         msg.body.key_info.attr.wep.auth_type = auth_type;
3200
3201         result = wilc_mq_send(&hif_msg_q, &msg, sizeof(struct host_if_msg));
3202
3203         if (result)
3204                 PRINT_ER("Error in sending message queue :WEP Key\n");
3205         down(&hif_drv->sem_test_key_block);
3206
3207         return result;
3208 }
3209
3210 int host_int_add_ptk(struct host_if_drv *hif_drv, const u8 *ptk,
3211                      u8 ptk_key_len, const u8 *mac_addr,
3212                      const u8 *rx_mic, const u8 *tx_mic,
3213                      u8 mode, u8 cipher_mode, u8 index)
3214 {
3215         int result = 0;
3216         struct host_if_msg msg;
3217         u8 key_len = ptk_key_len;
3218         int i;
3219
3220         if (!hif_drv) {
3221                 PRINT_ER("driver is null\n");
3222                 return -EFAULT;
3223         }
3224
3225         if (rx_mic)
3226                 key_len += RX_MIC_KEY_LEN;
3227
3228         if (tx_mic)
3229                 key_len += TX_MIC_KEY_LEN;
3230
3231         memset(&msg, 0, sizeof(struct host_if_msg));
3232
3233         msg.id = HOST_IF_MSG_KEY;
3234         msg.body.key_info.type = WPA_PTK;
3235         if (mode == AP_MODE) {
3236                 msg.body.key_info.action = ADDKEY_AP;
3237                 msg.body.key_info.attr.wpa.index = index;
3238         }
3239         if (mode == STATION_MODE)
3240                 msg.body.key_info.action = ADDKEY;
3241
3242         msg.body.key_info.attr.wpa.key = kmemdup(ptk, ptk_key_len, GFP_KERNEL);
3243         if (!msg.body.key_info.attr.wpa.key)
3244                 return -ENOMEM;
3245
3246         if (rx_mic) {
3247                 memcpy(msg.body.key_info.attr.wpa.key + 16, rx_mic, RX_MIC_KEY_LEN);
3248                 if (INFO) {
3249                         for (i = 0; i < RX_MIC_KEY_LEN; i++)
3250                                 PRINT_INFO(CFG80211_DBG, "PairwiseRx[%d] = %x\n", i, rx_mic[i]);
3251                 }
3252         }
3253         if (tx_mic) {
3254                 memcpy(msg.body.key_info.attr.wpa.key + 24, tx_mic, TX_MIC_KEY_LEN);
3255                 if (INFO) {
3256                         for (i = 0; i < TX_MIC_KEY_LEN; i++)
3257                                 PRINT_INFO(CFG80211_DBG, "PairwiseTx[%d] = %x\n", i, tx_mic[i]);
3258                 }
3259         }
3260
3261         msg.body.key_info.attr.wpa.key_len = key_len;
3262         msg.body.key_info.attr.wpa.mac_addr = mac_addr;
3263         msg.body.key_info.attr.wpa.mode = cipher_mode;
3264         msg.drv = hif_drv;
3265
3266         result = wilc_mq_send(&hif_msg_q, &msg, sizeof(struct host_if_msg));
3267
3268         if (result)
3269                 PRINT_ER("Error in sending message queue:  PTK Key\n");
3270
3271         down(&hif_drv->sem_test_key_block);
3272
3273         return result;
3274 }
3275
3276 int host_int_add_rx_gtk(struct host_if_drv *hif_drv, const u8 *rx_gtk,
3277                         u8 u8GtkKeylen, u8 u8KeyIdx,
3278                         u32 u32KeyRSClen, const u8 *KeyRSC,
3279                         const u8 *pu8RxMic, const u8 *pu8TxMic,
3280                         u8 mode, u8 u8Ciphermode)
3281 {
3282         int result = 0;
3283         struct host_if_msg msg;
3284         u8 u8KeyLen = u8GtkKeylen;
3285
3286         if (!hif_drv) {
3287                 PRINT_ER("driver is null\n");
3288                 return -EFAULT;
3289         }
3290         memset(&msg, 0, sizeof(struct host_if_msg));
3291
3292         if (pu8RxMic)
3293                 u8KeyLen += RX_MIC_KEY_LEN;
3294
3295         if (pu8TxMic)
3296                 u8KeyLen += TX_MIC_KEY_LEN;
3297
3298         if (KeyRSC) {
3299                 msg.body.key_info.attr.wpa.seq = kmalloc(u32KeyRSClen, GFP_KERNEL);
3300                 memcpy(msg.body.key_info.attr.wpa.seq, KeyRSC, u32KeyRSClen);
3301         }
3302
3303         msg.id = HOST_IF_MSG_KEY;
3304         msg.body.key_info.type = WPA_RX_GTK;
3305         msg.drv = hif_drv;
3306
3307         if (mode == AP_MODE) {
3308                 msg.body.key_info.action = ADDKEY_AP;
3309                 msg.body.key_info.attr.wpa.mode = u8Ciphermode;
3310         }
3311         if (mode == STATION_MODE)
3312                 msg.body.key_info.action = ADDKEY;
3313
3314         msg.body.key_info.attr.wpa.key = kmalloc(u8KeyLen, GFP_KERNEL);
3315         memcpy(msg.body.key_info.attr.wpa.key, rx_gtk, u8GtkKeylen);
3316
3317         if (pu8RxMic)
3318                 memcpy(msg.body.key_info.attr.wpa.key + 16, pu8RxMic,
3319                        RX_MIC_KEY_LEN);
3320
3321         if (pu8TxMic)
3322                 memcpy(msg.body.key_info.attr.wpa.key + 24, pu8TxMic,
3323                        TX_MIC_KEY_LEN);
3324
3325         msg.body.key_info.attr.wpa.index = u8KeyIdx;
3326         msg.body.key_info.attr.wpa.key_len = u8KeyLen;
3327         msg.body.key_info.attr.wpa.seq_len = u32KeyRSClen;
3328
3329         result = wilc_mq_send(&hif_msg_q, &msg, sizeof(struct host_if_msg));
3330         if (result)
3331                 PRINT_ER("Error in sending message queue:  RX GTK\n");
3332
3333         down(&hif_drv->sem_test_key_block);
3334
3335         return result;
3336 }
3337
3338 s32 host_int_set_pmkid_info(struct host_if_drv *hif_drv, struct host_if_pmkid_attr *pu8PmkidInfoArray)
3339 {
3340         s32 result = 0;
3341         struct host_if_msg msg;
3342         u32 i;
3343
3344         if (!hif_drv) {
3345                 PRINT_ER("driver is null\n");
3346                 return -EFAULT;
3347         }
3348
3349         memset(&msg, 0, sizeof(struct host_if_msg));
3350
3351         msg.id = HOST_IF_MSG_KEY;
3352         msg.body.key_info.type = PMKSA;
3353         msg.body.key_info.action = ADDKEY;
3354         msg.drv = hif_drv;
3355
3356         for (i = 0; i < pu8PmkidInfoArray->numpmkid; i++) {
3357                 memcpy(msg.body.key_info.attr.pmkid.pmkidlist[i].bssid,
3358                        &pu8PmkidInfoArray->pmkidlist[i].bssid, ETH_ALEN);
3359                 memcpy(msg.body.key_info.attr.pmkid.pmkidlist[i].pmkid,
3360                        &pu8PmkidInfoArray->pmkidlist[i].pmkid, PMKID_LEN);
3361         }
3362
3363         result = wilc_mq_send(&hif_msg_q, &msg, sizeof(struct host_if_msg));
3364         if (result)
3365                 PRINT_ER(" Error in sending messagequeue: PMKID Info\n");
3366
3367         return result;
3368 }
3369
3370 s32 host_int_get_pmkid_info(struct host_if_drv *hif_drv,
3371                             u8 *pu8PmkidInfoArray,
3372                             u32 u32PmkidInfoLen)
3373 {
3374         struct wid wid;
3375
3376         wid.id = (u16)WID_PMKID_INFO;
3377         wid.type = WID_STR;
3378         wid.size = u32PmkidInfoLen;
3379         wid.val = pu8PmkidInfoArray;
3380
3381         return 0;
3382 }
3383
3384 s32 host_int_set_RSNAConfigPSKPassPhrase(struct host_if_drv *hif_drv,
3385                                          u8 *pu8PassPhrase,
3386                                          u8 u8Psklength)
3387 {
3388         struct wid wid;
3389
3390         if ((u8Psklength > 7) && (u8Psklength < 65)) {
3391                 wid.id = (u16)WID_11I_PSK;
3392                 wid.type = WID_STR;
3393                 wid.val = pu8PassPhrase;
3394                 wid.size = u8Psklength;
3395         }
3396
3397         return 0;
3398 }
3399
3400 s32 hif_get_mac_address(struct host_if_drv *hif_drv, u8 *pu8MacAddress)
3401 {
3402         s32 result = 0;
3403         struct host_if_msg msg;
3404
3405         memset(&msg, 0, sizeof(struct host_if_msg));
3406
3407         msg.id = HOST_IF_MSG_GET_MAC_ADDRESS;
3408         msg.body.get_mac_info.mac_addr = pu8MacAddress;
3409         msg.drv = hif_drv;
3410
3411         result = wilc_mq_send(&hif_msg_q, &msg, sizeof(struct host_if_msg));
3412         if (result) {
3413                 PRINT_ER("Failed to send get mac address\n");
3414                 return -EFAULT;
3415         }
3416
3417         down(&hif_sema_wait_response);
3418         return result;
3419 }
3420
3421 s32 host_int_set_MacAddress(struct host_if_drv *hif_drv, u8 *pu8MacAddress)
3422 {
3423         s32 result = 0;
3424         struct host_if_msg msg;
3425
3426         PRINT_D(GENERIC_DBG, "mac addr = %x:%x:%x\n", pu8MacAddress[0], pu8MacAddress[1], pu8MacAddress[2]);
3427
3428         memset(&msg, 0, sizeof(struct host_if_msg));
3429         msg.id = HOST_IF_MSG_SET_MAC_ADDRESS;
3430         memcpy(msg.body.set_mac_info.mac_addr, pu8MacAddress, ETH_ALEN);
3431         msg.drv = hif_drv;
3432
3433         result = wilc_mq_send(&hif_msg_q, &msg, sizeof(struct host_if_msg));
3434         if (result)
3435                 PRINT_ER("Failed to send message queue: Set mac address\n");
3436
3437         return result;
3438 }
3439
3440 s32 host_int_get_RSNAConfigPSKPassPhrase(struct host_if_drv *hif_drv,
3441                                          u8 *pu8PassPhrase, u8 u8Psklength)
3442 {
3443         struct wid wid;
3444
3445         wid.id = (u16)WID_11I_PSK;
3446         wid.type = WID_STR;
3447         wid.size = u8Psklength;
3448         wid.val = pu8PassPhrase;
3449
3450         return 0;
3451 }
3452
3453 s32 host_int_set_start_scan_req(struct host_if_drv *hif_drv, u8 scanSource)
3454 {
3455         struct wid wid;
3456
3457         wid.id = (u16)WID_START_SCAN_REQ;
3458         wid.type = WID_CHAR;
3459         wid.val = (s8 *)&scanSource;
3460         wid.size = sizeof(char);
3461
3462         return 0;
3463 }
3464
3465 s32 host_int_get_start_scan_req(struct host_if_drv *hif_drv, u8 *pu8ScanSource)
3466 {
3467         struct wid wid;
3468
3469         wid.id = (u16)WID_START_SCAN_REQ;
3470         wid.type = WID_CHAR;
3471         wid.val = (s8 *)pu8ScanSource;
3472         wid.size = sizeof(char);
3473
3474         return 0;
3475 }
3476
3477 s32 host_int_set_join_req(struct host_if_drv *hif_drv, u8 *pu8bssid,
3478                           const u8 *pu8ssid, size_t ssidLen,
3479                           const u8 *pu8IEs, size_t IEsLen,
3480                           wilc_connect_result pfConnectResult, void *pvUserArg,
3481                           u8 u8security, enum AUTHTYPE tenuAuth_type,
3482                           u8 u8channel, void *pJoinParams)
3483 {
3484         s32 result = 0;
3485         struct host_if_msg msg;
3486
3487         if (!hif_drv || !pfConnectResult) {
3488                 PRINT_ER("Driver is null\n");
3489                 return -EFAULT;
3490         }
3491
3492         if (!pJoinParams) {
3493                 PRINT_ER("Unable to Join - JoinParams is NULL\n");
3494                 return -EFAULT;
3495         }
3496
3497         memset(&msg, 0, sizeof(struct host_if_msg));
3498
3499         msg.id = HOST_IF_MSG_CONNECT;
3500
3501         msg.body.con_info.security = u8security;
3502         msg.body.con_info.auth_type = tenuAuth_type;
3503         msg.body.con_info.ch = u8channel;
3504         msg.body.con_info.result = pfConnectResult;
3505         msg.body.con_info.arg = pvUserArg;
3506         msg.body.con_info.params = pJoinParams;
3507         msg.drv = hif_drv ;
3508
3509         if (pu8bssid) {
3510                 msg.body.con_info.bssid = kmalloc(6, GFP_KERNEL);
3511                 memcpy(msg.body.con_info.bssid, pu8bssid, 6);
3512         }
3513
3514         if (pu8ssid) {
3515                 msg.body.con_info.ssid_len = ssidLen;
3516                 msg.body.con_info.ssid = kmalloc(ssidLen, GFP_KERNEL);
3517                 memcpy(msg.body.con_info.ssid, pu8ssid, ssidLen);
3518         }
3519
3520         if (pu8IEs) {
3521                 msg.body.con_info.ies_len = IEsLen;
3522                 msg.body.con_info.ies = kmalloc(IEsLen, GFP_KERNEL);
3523                 memcpy(msg.body.con_info.ies, pu8IEs, IEsLen);
3524         }
3525         if (hif_drv->hif_state < HOST_IF_CONNECTING)
3526                 hif_drv->hif_state = HOST_IF_CONNECTING;
3527         else
3528                 PRINT_D(GENERIC_DBG, "Don't set state to 'connecting' : %d\n",
3529                         hif_drv->hif_state);
3530
3531         result = wilc_mq_send(&hif_msg_q, &msg, sizeof(struct host_if_msg));
3532         if (result) {
3533                 PRINT_ER("Failed to send message queue: Set join request\n");
3534                 return -EFAULT;
3535         }
3536
3537         hif_drv->connect_timer.data = (unsigned long)hif_drv;
3538         mod_timer(&hif_drv->connect_timer,
3539                   jiffies + msecs_to_jiffies(HOST_IF_CONNECT_TIMEOUT));
3540
3541         return result;
3542 }
3543
3544 s32 host_int_flush_join_req(struct host_if_drv *hif_drv)
3545 {
3546         s32 result = 0;
3547         struct host_if_msg msg;
3548
3549         if (!join_req)
3550                 return -EFAULT;
3551
3552         if (!hif_drv) {
3553                 PRINT_ER("Driver is null\n");
3554                 return -EFAULT;
3555         }
3556
3557         msg.id = HOST_IF_MSG_FLUSH_CONNECT;
3558         msg.drv = hif_drv;
3559
3560         result = wilc_mq_send(&hif_msg_q, &msg, sizeof(struct host_if_msg));
3561         if (result) {
3562                 PRINT_ER("Failed to send message queue: Flush join request\n");
3563                 return -EFAULT;
3564         }
3565
3566         return result;
3567 }
3568
3569 s32 host_int_disconnect(struct host_if_drv *hif_drv, u16 u16ReasonCode)
3570 {
3571         s32 result = 0;
3572         struct host_if_msg msg;
3573
3574         if (!hif_drv) {
3575                 PRINT_ER("Driver is null\n");
3576                 return -EFAULT;
3577         }
3578
3579         memset(&msg, 0, sizeof(struct host_if_msg));
3580
3581         msg.id = HOST_IF_MSG_DISCONNECT;
3582         msg.drv = hif_drv;
3583
3584         result = wilc_mq_send(&hif_msg_q, &msg, sizeof(struct host_if_msg));
3585         if (result)
3586                 PRINT_ER("Failed to send message queue: disconnect\n");
3587
3588         down(&hif_drv->sem_test_disconn_block);
3589
3590         return result;
3591 }
3592
3593 s32 host_int_disconnect_station(struct host_if_drv *hif_drv, u8 assoc_id)
3594 {
3595         struct wid wid;
3596
3597         wid.id = (u16)WID_DISCONNECT;
3598         wid.type = WID_CHAR;
3599         wid.val = (s8 *)&assoc_id;
3600         wid.size = sizeof(char);
3601
3602         return 0;
3603 }
3604
3605 s32 host_int_get_assoc_req_info(struct host_if_drv *hif_drv,
3606                                 u8 *pu8AssocReqInfo,
3607                                 u32 u32AssocReqInfoLen)
3608 {
3609         struct wid wid;
3610
3611         wid.id = (u16)WID_ASSOC_REQ_INFO;
3612         wid.type = WID_STR;
3613         wid.val = pu8AssocReqInfo;
3614         wid.size = u32AssocReqInfoLen;
3615
3616         return 0;
3617 }
3618
3619 s32 host_int_get_assoc_res_info(struct host_if_drv *hif_drv,
3620                                 u8 *pu8AssocRespInfo,
3621                                 u32 u32MaxAssocRespInfoLen,
3622                                 u32 *pu32RcvdAssocRespInfoLen)
3623 {
3624         s32 result = 0;
3625         struct wid wid;
3626
3627         if (!hif_drv) {
3628                 PRINT_ER("Driver is null\n");
3629                 return -EFAULT;
3630         }
3631
3632         wid.id = (u16)WID_ASSOC_RES_INFO;
3633         wid.type = WID_STR;
3634         wid.val = pu8AssocRespInfo;
3635         wid.size = u32MaxAssocRespInfoLen;
3636
3637         result = send_config_pkt(GET_CFG, &wid, 1,
3638                                  get_id_from_handler(hif_drv));
3639         if (result) {
3640                 *pu32RcvdAssocRespInfoLen = 0;
3641                 PRINT_ER("Failed to send association response config packet\n");
3642                 return -EINVAL;
3643         } else {
3644                 *pu32RcvdAssocRespInfoLen = wid.size;
3645         }
3646
3647         return result;
3648 }
3649
3650 s32 host_int_get_rx_power_level(struct host_if_drv *hif_drv,
3651                                 u8 *pu8RxPowerLevel,
3652                                 u32 u32RxPowerLevelLen)
3653 {
3654         struct wid wid;
3655
3656         wid.id = (u16)WID_RX_POWER_LEVEL;
3657         wid.type = WID_STR;
3658         wid.val = pu8RxPowerLevel;
3659         wid.size = u32RxPowerLevelLen;
3660
3661         return 0;
3662 }
3663
3664 int host_int_set_mac_chnl_num(struct host_if_drv *hif_drv, u8 channel)
3665 {
3666         int result;
3667         struct host_if_msg msg;
3668
3669         if (!hif_drv) {
3670                 PRINT_ER("driver is null\n");
3671                 return -EFAULT;
3672         }
3673
3674         memset(&msg, 0, sizeof(struct host_if_msg));
3675         msg.id = HOST_IF_MSG_SET_CHANNEL;
3676         msg.body.channel_info.set_ch = channel;
3677         msg.drv = hif_drv;
3678
3679         result = wilc_mq_send(&hif_msg_q, &msg, sizeof(struct host_if_msg));
3680         if (result) {
3681                 PRINT_ER("wilc mq send fail\n");
3682                 return -EINVAL;
3683         }
3684
3685         return 0;
3686 }
3687
3688 int host_int_wait_msg_queue_idle(void)
3689 {
3690         int result = 0;
3691         struct host_if_msg msg;
3692
3693         memset(&msg, 0, sizeof(struct host_if_msg));
3694         msg.id = HOST_IF_MSG_Q_IDLE;
3695         result = wilc_mq_send(&hif_msg_q, &msg, sizeof(struct host_if_msg));
3696         if (result) {
3697                 PRINT_ER("wilc mq send fail\n");
3698                 result = -EINVAL;
3699         }
3700
3701         down(&hif_sema_wait_response);
3702
3703         return result;
3704 }
3705
3706 int host_int_set_wfi_drv_handler(struct host_if_drv *hif_drv)
3707 {
3708         int result = 0;
3709         struct host_if_msg msg;
3710
3711         memset(&msg, 0, sizeof(struct host_if_msg));
3712         msg.id = HOST_IF_MSG_SET_WFIDRV_HANDLER;
3713         msg.body.drv.handler = get_id_from_handler(hif_drv);
3714         msg.drv = hif_drv;
3715
3716         result = wilc_mq_send(&hif_msg_q, &msg, sizeof(struct host_if_msg));
3717         if (result) {
3718                 PRINT_ER("wilc mq send fail\n");
3719                 result = -EINVAL;
3720         }
3721
3722         return result;
3723 }
3724
3725 int host_int_set_operation_mode(struct host_if_drv *hif_drv, u32 mode)
3726 {
3727         int result = 0;
3728         struct host_if_msg msg;
3729
3730         memset(&msg, 0, sizeof(struct host_if_msg));
3731         msg.id = HOST_IF_MSG_SET_OPERATION_MODE;
3732         msg.body.mode.mode = mode;
3733         msg.drv = hif_drv;
3734
3735         result = wilc_mq_send(&hif_msg_q, &msg, sizeof(struct host_if_msg));
3736         if (result) {
3737                 PRINT_ER("wilc mq send fail\n");
3738                 result = -EINVAL;
3739         }
3740
3741         return result;
3742 }
3743
3744 s32 host_int_get_host_chnl_num(struct host_if_drv *hif_drv, u8 *pu8ChNo)
3745 {
3746         s32 result = 0;
3747         struct host_if_msg msg;
3748
3749         if (!hif_drv) {
3750                 PRINT_ER("driver is null\n");
3751                 return -EFAULT;
3752         }
3753
3754         memset(&msg, 0, sizeof(struct host_if_msg));
3755
3756         msg.id = HOST_IF_MSG_GET_CHNL;
3757         msg.drv = hif_drv;
3758
3759         result = wilc_mq_send(&hif_msg_q, &msg, sizeof(struct host_if_msg));
3760         if (result)
3761                 PRINT_ER("wilc mq send fail\n");
3762         down(&hif_drv->sem_get_chnl);
3763
3764         *pu8ChNo = ch_no;
3765
3766         return result;
3767 }
3768
3769 s32 host_int_get_inactive_time(struct host_if_drv *hif_drv,
3770                                const u8 *mac, u32 *pu32InactiveTime)
3771 {
3772         s32 result = 0;
3773         struct host_if_msg msg;
3774
3775         if (!hif_drv) {
3776                 PRINT_ER("driver is null\n");
3777                 return -EFAULT;
3778         }
3779
3780         memset(&msg, 0, sizeof(struct host_if_msg));
3781         memcpy(msg.body.mac_info.mac, mac, ETH_ALEN);
3782
3783         msg.id = HOST_IF_MSG_GET_INACTIVETIME;
3784         msg.drv = hif_drv;
3785
3786         result = wilc_mq_send(&hif_msg_q, &msg, sizeof(struct host_if_msg));
3787         if (result)
3788                 PRINT_ER("Failed to send get host channel param's message queue ");
3789
3790         down(&hif_drv->sem_inactive_time);
3791
3792         *pu32InactiveTime = inactive_time;
3793
3794         return result;
3795 }
3796
3797 s32 host_int_test_get_int_wid(struct host_if_drv *hif_drv, u32 *pu32TestMemAddr)
3798 {
3799         s32 result = 0;
3800         struct wid wid;
3801
3802         if (!hif_drv) {
3803                 PRINT_ER("driver is null\n");
3804                 return -EFAULT;
3805         }
3806
3807         wid.id = (u16)WID_MEMORY_ADDRESS;
3808         wid.type = WID_INT;
3809         wid.val = (s8 *)pu32TestMemAddr;
3810         wid.size = sizeof(u32);
3811
3812         result = send_config_pkt(GET_CFG, &wid, 1,
3813                                  get_id_from_handler(hif_drv));
3814
3815         if (result) {
3816                 PRINT_ER("Failed to get wid value\n");
3817                 return -EINVAL;
3818         } else {
3819                 PRINT_D(HOSTINF_DBG, "Successfully got wid value\n");
3820         }
3821
3822         return result;
3823 }
3824
3825 s32 host_int_get_rssi(struct host_if_drv *hif_drv, s8 *ps8Rssi)
3826 {
3827         s32 result = 0;
3828         struct host_if_msg msg;
3829
3830         memset(&msg, 0, sizeof(struct host_if_msg));
3831         msg.id = HOST_IF_MSG_GET_RSSI;
3832         msg.drv = hif_drv;
3833
3834         result = wilc_mq_send(&hif_msg_q, &msg, sizeof(struct host_if_msg));
3835         if (result) {
3836                 PRINT_ER("Failed to send get host channel param's message queue ");
3837                 return -EFAULT;
3838         }
3839
3840         down(&hif_drv->sem_get_rssi);
3841
3842         if (!ps8Rssi) {
3843                 PRINT_ER("RSS pointer value is null");
3844                 return -EFAULT;
3845         }
3846
3847         *ps8Rssi = rssi;
3848
3849         return result;
3850 }
3851
3852 s32 host_int_get_link_speed(struct host_if_drv *hif_drv, s8 *ps8lnkspd)
3853 {
3854         struct host_if_msg msg;
3855         s32 result = 0;
3856
3857         memset(&msg, 0, sizeof(struct host_if_msg));
3858         msg.id = HOST_IF_MSG_GET_LINKSPEED;
3859         msg.drv = hif_drv;
3860
3861         result = wilc_mq_send(&hif_msg_q, &msg, sizeof(struct host_if_msg));
3862         if (result) {
3863                 PRINT_ER("Failed to send GET_LINKSPEED to message queue ");
3864                 return -EFAULT;
3865         }
3866
3867         down(&hif_drv->sem_get_link_speed);
3868
3869         if (!ps8lnkspd) {
3870                 PRINT_ER("LINKSPEED pointer value is null");
3871                 return -EFAULT;
3872         }
3873
3874         *ps8lnkspd = link_speed;
3875
3876         return result;
3877 }
3878
3879 s32 host_int_get_statistics(struct host_if_drv *hif_drv, struct rf_info *pstrStatistics)
3880 {
3881         s32 result = 0;
3882         struct host_if_msg msg;
3883
3884         memset(&msg, 0, sizeof(struct host_if_msg));
3885         msg.id = HOST_IF_MSG_GET_STATISTICS;
3886         msg.body.data = (char *)pstrStatistics;
3887         msg.drv = hif_drv;
3888
3889         result = wilc_mq_send(&hif_msg_q, &msg, sizeof(struct host_if_msg));
3890         if (result) {
3891                 PRINT_ER("Failed to send get host channel param's message queue ");
3892                 return -EFAULT;
3893         }
3894
3895         down(&hif_sema_wait_response);
3896         return result;
3897 }
3898
3899 s32 host_int_scan(struct host_if_drv *hif_drv, u8 u8ScanSource,
3900                   u8 u8ScanType, u8 *pu8ChnlFreqList,
3901                   u8 u8ChnlListLen, const u8 *pu8IEs,
3902                   size_t IEsLen, wilc_scan_result ScanResult,
3903                   void *pvUserArg, struct hidden_network *pstrHiddenNetwork)
3904 {
3905         s32 result = 0;
3906         struct host_if_msg msg;
3907
3908         if (!hif_drv || !ScanResult) {
3909                 PRINT_ER("hif_drv or ScanResult = NULL\n");
3910                 return -EFAULT;
3911         }
3912
3913         memset(&msg, 0, sizeof(struct host_if_msg));
3914
3915         msg.id = HOST_IF_MSG_SCAN;
3916
3917         if (pstrHiddenNetwork) {
3918                 msg.body.scan_info.hidden_network.pstrHiddenNetworkInfo = pstrHiddenNetwork->pstrHiddenNetworkInfo;
3919                 msg.body.scan_info.hidden_network.u8ssidnum = pstrHiddenNetwork->u8ssidnum;
3920
3921         } else
3922                 PRINT_D(HOSTINF_DBG, "pstrHiddenNetwork IS EQUAL TO NULL\n");
3923
3924         msg.drv = hif_drv;
3925         msg.body.scan_info.src = u8ScanSource;
3926         msg.body.scan_info.type = u8ScanType;
3927         msg.body.scan_info.result = ScanResult;
3928         msg.body.scan_info.arg = pvUserArg;
3929
3930         msg.body.scan_info.ch_list_len = u8ChnlListLen;
3931         msg.body.scan_info.ch_freq_list = kmalloc(u8ChnlListLen, GFP_KERNEL);
3932         memcpy(msg.body.scan_info.ch_freq_list, pu8ChnlFreqList, u8ChnlListLen);
3933
3934         msg.body.scan_info.ies_len = IEsLen;
3935         msg.body.scan_info.ies = kmalloc(IEsLen, GFP_KERNEL);
3936         memcpy(msg.body.scan_info.ies, pu8IEs, IEsLen);
3937
3938         result = wilc_mq_send(&hif_msg_q, &msg, sizeof(struct host_if_msg));
3939         if (result) {
3940                 PRINT_ER("Error in sending message queue\n");
3941                 return -EINVAL;
3942         }
3943
3944         PRINT_D(HOSTINF_DBG, ">> Starting the SCAN timer\n");
3945         hif_drv->scan_timer.data = (unsigned long)hif_drv;
3946         mod_timer(&hif_drv->scan_timer,
3947                   jiffies + msecs_to_jiffies(HOST_IF_SCAN_TIMEOUT));
3948
3949         return result;
3950 }
3951
3952 s32 hif_set_cfg(struct host_if_drv *hif_drv,
3953                 struct cfg_param_val *pstrCfgParamVal)
3954 {
3955         s32 result = 0;
3956         struct host_if_msg msg;
3957
3958         if (!hif_drv) {
3959                 PRINT_ER("hif_drv NULL\n");
3960                 return -EFAULT;
3961         }
3962
3963         memset(&msg, 0, sizeof(struct host_if_msg));
3964         msg.id = HOST_IF_MSG_CFG_PARAMS;
3965         msg.body.cfg_info.cfg_attr_info = *pstrCfgParamVal;
3966         msg.drv = hif_drv;
3967
3968         result = wilc_mq_send(&hif_msg_q, &msg, sizeof(struct host_if_msg));
3969
3970         return result;
3971 }
3972
3973 s32 hif_get_cfg(struct host_if_drv *hif_drv, u16 u16WID, u16 *pu16WID_Value)
3974 {
3975         s32 result = 0;
3976
3977         down(&hif_drv->sem_cfg_values);
3978
3979         if (!hif_drv) {
3980                 PRINT_ER("hif_drv NULL\n");
3981                 return -EFAULT;
3982         }
3983         PRINT_D(HOSTINF_DBG, "Getting configuration parameters\n");
3984         switch (u16WID) {
3985         case WID_BSS_TYPE:
3986                 *pu16WID_Value = (u16)hif_drv->cfg_values.bss_type;
3987                 break;
3988
3989         case WID_AUTH_TYPE:
3990                 *pu16WID_Value = (u16)hif_drv->cfg_values.auth_type;
3991                 break;
3992
3993         case WID_AUTH_TIMEOUT:
3994                 *pu16WID_Value = hif_drv->cfg_values.auth_timeout;
3995                 break;
3996
3997         case WID_POWER_MANAGEMENT:
3998                 *pu16WID_Value = (u16)hif_drv->cfg_values.power_mgmt_mode;
3999                 break;
4000
4001         case WID_SHORT_RETRY_LIMIT:
4002                 *pu16WID_Value = hif_drv->cfg_values.short_retry_limit;
4003                 break;
4004
4005         case WID_LONG_RETRY_LIMIT:
4006                 *pu16WID_Value = hif_drv->cfg_values.long_retry_limit;
4007                 break;
4008
4009         case WID_FRAG_THRESHOLD:
4010                 *pu16WID_Value = hif_drv->cfg_values.frag_threshold;
4011                 break;
4012
4013         case WID_RTS_THRESHOLD:
4014                 *pu16WID_Value = hif_drv->cfg_values.rts_threshold;
4015                 break;
4016
4017         case WID_PREAMBLE:
4018                 *pu16WID_Value = (u16)hif_drv->cfg_values.preamble_type;
4019                 break;
4020
4021         case WID_SHORT_SLOT_ALLOWED:
4022                 *pu16WID_Value = (u16)hif_drv->cfg_values.short_slot_allowed;
4023                 break;
4024
4025         case WID_11N_TXOP_PROT_DISABLE:
4026                 *pu16WID_Value = (u16)hif_drv->cfg_values.txop_prot_disabled;
4027                 break;
4028
4029         case WID_BEACON_INTERVAL:
4030                 *pu16WID_Value = hif_drv->cfg_values.beacon_interval;
4031                 break;
4032
4033         case WID_DTIM_PERIOD:
4034                 *pu16WID_Value = (u16)hif_drv->cfg_values.dtim_period;
4035                 break;
4036
4037         case WID_SITE_SURVEY:
4038                 *pu16WID_Value = (u16)hif_drv->cfg_values.site_survey_enabled;
4039                 break;
4040
4041         case WID_SITE_SURVEY_SCAN_TIME:
4042                 *pu16WID_Value = hif_drv->cfg_values.site_survey_scan_time;
4043                 break;
4044
4045         case WID_ACTIVE_SCAN_TIME:
4046                 *pu16WID_Value = hif_drv->cfg_values.active_scan_time;
4047                 break;
4048
4049         case WID_PASSIVE_SCAN_TIME:
4050                 *pu16WID_Value = hif_drv->cfg_values.passive_scan_time;
4051                 break;
4052
4053         case WID_CURRENT_TX_RATE:
4054                 *pu16WID_Value = hif_drv->cfg_values.curr_tx_rate;
4055                 break;
4056
4057         default:
4058                 break;
4059         }
4060
4061         up(&hif_drv->sem_cfg_values);
4062
4063         return result;
4064 }
4065
4066 static void GetPeriodicRSSI(unsigned long arg)
4067 {
4068         struct host_if_drv *hif_drv = (struct host_if_drv *)arg;
4069
4070         if (!hif_drv)   {
4071                 PRINT_ER("Driver handler is NULL\n");
4072                 return;
4073         }
4074
4075         if (hif_drv->hif_state == HOST_IF_CONNECTED) {
4076                 s32 result = 0;
4077                 struct host_if_msg msg;
4078
4079                 memset(&msg, 0, sizeof(struct host_if_msg));
4080
4081                 msg.id = HOST_IF_MSG_GET_RSSI;
4082                 msg.drv = hif_drv;
4083
4084                 result = wilc_mq_send(&hif_msg_q, &msg, sizeof(struct host_if_msg));
4085                 if (result) {
4086                         PRINT_ER("Failed to send get host channel param's message queue ");
4087                         return;
4088                 }
4089         }
4090         periodic_rssi.data = (unsigned long)hif_drv;
4091         mod_timer(&periodic_rssi, jiffies + msecs_to_jiffies(5000));
4092 }
4093
4094 s32 host_int_init(struct net_device *dev, struct host_if_drv **hif_drv_handler)
4095 {
4096         s32 result = 0;
4097         struct host_if_drv *hif_drv;
4098         int err;
4099         perInterface_wlan_t *nic;
4100         struct wilc *wilc;
4101
4102         nic = netdev_priv(dev);
4103         wilc = nic->wilc;
4104
4105         PRINT_D(HOSTINF_DBG, "Initializing host interface for client %d\n", clients_count + 1);
4106
4107         scan_while_connected = false;
4108
4109         sema_init(&hif_sema_wait_response, 0);
4110
4111         hif_drv  = kzalloc(sizeof(struct host_if_drv), GFP_KERNEL);
4112         if (!hif_drv) {
4113                 result = -ENOMEM;
4114                 goto _fail_;
4115         }
4116         *hif_drv_handler = hif_drv;
4117         err = add_handler_in_list(hif_drv);
4118         if (err) {
4119                 result = -EFAULT;
4120                 goto _fail_timer_2;
4121         }
4122
4123         g_obtainingIP = false;
4124
4125         PRINT_D(HOSTINF_DBG, "Global handle pointer value=%p\n", hif_drv);
4126         if (clients_count == 0) {
4127                 sema_init(&hif_sema_thread, 0);
4128                 sema_init(&hif_sema_driver, 0);
4129                 sema_init(&hif_sema_deinit, 1);
4130         }
4131
4132         sema_init(&hif_drv->sem_test_key_block, 0);
4133         sema_init(&hif_drv->sem_test_disconn_block, 0);
4134         sema_init(&hif_drv->sem_get_rssi, 0);
4135         sema_init(&hif_drv->sem_get_link_speed, 0);
4136         sema_init(&hif_drv->sem_get_chnl, 0);
4137         sema_init(&hif_drv->sem_inactive_time, 0);
4138
4139         PRINT_D(HOSTINF_DBG, "INIT: CLIENT COUNT %d\n", clients_count);
4140
4141         if (clients_count == 0) {
4142                 result = wilc_mq_create(&hif_msg_q);
4143
4144                 if (result < 0) {
4145                         PRINT_ER("Failed to creat MQ\n");
4146                         goto _fail_;
4147                 }
4148
4149                 hif_thread_handler = kthread_run(hostIFthread, wilc,
4150                                                  "WILC_kthread");
4151
4152                 if (IS_ERR(hif_thread_handler)) {
4153                         PRINT_ER("Failed to creat Thread\n");
4154                         result = -EFAULT;
4155                         goto _fail_mq_;
4156                 }
4157                 setup_timer(&periodic_rssi, GetPeriodicRSSI,
4158                             (unsigned long)hif_drv);
4159                 mod_timer(&periodic_rssi, jiffies + msecs_to_jiffies(5000));
4160         }
4161
4162         setup_timer(&hif_drv->scan_timer, TimerCB_Scan, 0);
4163         setup_timer(&hif_drv->connect_timer, TimerCB_Connect, 0);
4164         setup_timer(&hif_drv->remain_on_ch_timer, ListenTimerCB, 0);
4165
4166         sema_init(&hif_drv->sem_cfg_values, 1);
4167         down(&hif_drv->sem_cfg_values);
4168
4169         hif_drv->hif_state = HOST_IF_IDLE;
4170         hif_drv->cfg_values.site_survey_enabled = SITE_SURVEY_OFF;
4171         hif_drv->cfg_values.scan_source = DEFAULT_SCAN;
4172         hif_drv->cfg_values.active_scan_time = ACTIVE_SCAN_TIME;
4173         hif_drv->cfg_values.passive_scan_time = PASSIVE_SCAN_TIME;
4174         hif_drv->cfg_values.curr_tx_rate = AUTORATE;
4175
4176         hif_drv->p2p_timeout = 0;
4177
4178         PRINT_INFO(HOSTINF_DBG, "Initialization values, Site survey value: %d\n Scan source: %d\n Active scan time: %d\n Passive scan time: %d\nCurrent tx Rate = %d\n",
4179                    hif_drv->cfg_values.site_survey_enabled,
4180                    hif_drv->cfg_values.scan_source,
4181                    hif_drv->cfg_values.active_scan_time,
4182                    hif_drv->cfg_values.passive_scan_time,
4183                    hif_drv->cfg_values.curr_tx_rate);
4184
4185         up(&hif_drv->sem_cfg_values);
4186
4187         clients_count++;
4188
4189         return result;
4190
4191 _fail_timer_2:
4192         up(&hif_drv->sem_cfg_values);
4193         del_timer_sync(&hif_drv->connect_timer);
4194         del_timer_sync(&hif_drv->scan_timer);
4195         kthread_stop(hif_thread_handler);
4196 _fail_mq_:
4197         wilc_mq_destroy(&hif_msg_q);
4198 _fail_:
4199         return result;
4200 }
4201
4202 s32 host_int_deinit(struct host_if_drv *hif_drv)
4203 {
4204         s32 result = 0;
4205         struct host_if_msg msg;
4206         int ret;
4207
4208         if (!hif_drv)   {
4209                 PRINT_ER("hif_drv = NULL\n");
4210                 return 0;
4211         }
4212
4213         down(&hif_sema_deinit);
4214
4215         terminated_handle = hif_drv;
4216         PRINT_D(HOSTINF_DBG, "De-initializing host interface for client %d\n", clients_count);
4217
4218         if (del_timer_sync(&hif_drv->scan_timer))
4219                 PRINT_D(HOSTINF_DBG, ">> Scan timer is active\n");
4220
4221         if (del_timer_sync(&hif_drv->connect_timer))
4222                 PRINT_D(HOSTINF_DBG, ">> Connect timer is active\n");
4223
4224         if (del_timer_sync(&periodic_rssi))
4225                 PRINT_D(HOSTINF_DBG, ">> Connect timer is active\n");
4226
4227         del_timer_sync(&hif_drv->remain_on_ch_timer);
4228
4229         host_int_set_wfi_drv_handler(NULL);
4230         down(&hif_sema_driver);
4231
4232         if (hif_drv->usr_scan_req.scan_result) {
4233                 hif_drv->usr_scan_req.scan_result(SCAN_EVENT_ABORTED, NULL,
4234                                                   hif_drv->usr_scan_req.arg, NULL);
4235                 hif_drv->usr_scan_req.scan_result = NULL;
4236         }
4237
4238         hif_drv->hif_state = HOST_IF_IDLE;
4239
4240         scan_while_connected = false;
4241
4242         memset(&msg, 0, sizeof(struct host_if_msg));
4243
4244         if (clients_count == 1) {
4245                 if (del_timer_sync(&periodic_rssi))
4246                         PRINT_D(HOSTINF_DBG, ">> Connect timer is active\n");
4247
4248                 msg.id = HOST_IF_MSG_EXIT;
4249                 msg.drv = hif_drv;
4250
4251                 result = wilc_mq_send(&hif_msg_q, &msg, sizeof(struct host_if_msg));
4252                 if (result != 0)
4253                         PRINT_ER("Error in sending deinit's message queue message function: Error(%d)\n", result);
4254
4255                 down(&hif_sema_thread);
4256
4257                 wilc_mq_destroy(&hif_msg_q);
4258         }
4259
4260         down(&hif_drv->sem_cfg_values);
4261
4262         ret = remove_handler_in_list(hif_drv);
4263         if (ret)
4264                 result = -ENOENT;
4265
4266         kfree(hif_drv);
4267
4268         clients_count--;
4269         terminated_handle = NULL;
4270         up(&hif_sema_deinit);
4271         return result;
4272 }
4273
4274 void NetworkInfoReceived(u8 *pu8Buffer, u32 u32Length)
4275 {
4276         s32 result = 0;
4277         struct host_if_msg msg;
4278         int id;
4279         struct host_if_drv *hif_drv = NULL;
4280
4281         id = ((pu8Buffer[u32Length - 4]) | (pu8Buffer[u32Length - 3] << 8) | (pu8Buffer[u32Length - 2] << 16) | (pu8Buffer[u32Length - 1] << 24));
4282         hif_drv = get_handler_from_id(id);
4283
4284         if (!hif_drv || hif_drv == terminated_handle)   {
4285                 PRINT_ER("NetworkInfo received but driver not init[%p]\n", hif_drv);
4286                 return;
4287         }
4288
4289         memset(&msg, 0, sizeof(struct host_if_msg));
4290
4291         msg.id = HOST_IF_MSG_RCVD_NTWRK_INFO;
4292         msg.drv = hif_drv;
4293
4294         msg.body.net_info.len = u32Length;
4295         msg.body.net_info.buffer = kmalloc(u32Length, GFP_KERNEL);
4296         memcpy(msg.body.net_info.buffer, pu8Buffer, u32Length);
4297
4298         result = wilc_mq_send(&hif_msg_q, &msg, sizeof(struct host_if_msg));
4299         if (result)
4300                 PRINT_ER("Error in sending network info message queue message parameters: Error(%d)\n", result);
4301 }
4302
4303 void GnrlAsyncInfoReceived(u8 *pu8Buffer, u32 u32Length)
4304 {
4305         s32 result = 0;
4306         struct host_if_msg msg;
4307         int id;
4308         struct host_if_drv *hif_drv = NULL;
4309
4310         down(&hif_sema_deinit);
4311
4312         id = ((pu8Buffer[u32Length - 4]) | (pu8Buffer[u32Length - 3] << 8) | (pu8Buffer[u32Length - 2] << 16) | (pu8Buffer[u32Length - 1] << 24));
4313         hif_drv = get_handler_from_id(id);
4314         PRINT_D(HOSTINF_DBG, "General asynchronous info packet received\n");
4315
4316         if (!hif_drv || hif_drv == terminated_handle) {
4317                 PRINT_D(HOSTINF_DBG, "Wifi driver handler is equal to NULL\n");
4318                 up(&hif_sema_deinit);
4319                 return;
4320         }
4321
4322         if (!hif_drv->usr_conn_req.conn_result) {
4323                 PRINT_ER("Received mac status is not needed when there is no current Connect Reques\n");
4324                 up(&hif_sema_deinit);
4325                 return;
4326         }
4327
4328         memset(&msg, 0, sizeof(struct host_if_msg));
4329
4330         msg.id = HOST_IF_MSG_RCVD_GNRL_ASYNC_INFO;
4331         msg.drv = hif_drv;
4332
4333         msg.body.async_info.len = u32Length;
4334         msg.body.async_info.buffer = kmalloc(u32Length, GFP_KERNEL);
4335         memcpy(msg.body.async_info.buffer, pu8Buffer, u32Length);
4336
4337         result = wilc_mq_send(&hif_msg_q, &msg, sizeof(struct host_if_msg));
4338         if (result)
4339                 PRINT_ER("Error in sending message queue asynchronous message info: Error(%d)\n", result);
4340
4341         up(&hif_sema_deinit);
4342 }
4343
4344 void host_int_ScanCompleteReceived(u8 *pu8Buffer, u32 u32Length)
4345 {
4346         s32 result = 0;
4347         struct host_if_msg msg;
4348         int id;
4349         struct host_if_drv *hif_drv = NULL;
4350
4351         id = ((pu8Buffer[u32Length - 4]) | (pu8Buffer[u32Length - 3] << 8) | (pu8Buffer[u32Length - 2] << 16) | (pu8Buffer[u32Length - 1] << 24));
4352         hif_drv = get_handler_from_id(id);
4353
4354         PRINT_D(GENERIC_DBG, "Scan notification received %p\n", hif_drv);
4355
4356         if (!hif_drv || hif_drv == terminated_handle)
4357                 return;
4358
4359         if (hif_drv->usr_scan_req.scan_result) {
4360                 memset(&msg, 0, sizeof(struct host_if_msg));
4361
4362                 msg.id = HOST_IF_MSG_RCVD_SCAN_COMPLETE;
4363                 msg.drv = hif_drv;
4364
4365                 result = wilc_mq_send(&hif_msg_q, &msg, sizeof(struct host_if_msg));
4366                 if (result)
4367                         PRINT_ER("Error in sending message queue scan complete parameters: Error(%d)\n", result);
4368         }
4369
4370         return;
4371 }
4372
4373 s32 host_int_remain_on_channel(struct host_if_drv *hif_drv, u32 u32SessionID,
4374                                u32 u32duration, u16 chan,
4375                                wilc_remain_on_chan_expired RemainOnChanExpired,
4376                                wilc_remain_on_chan_ready RemainOnChanReady,
4377                                void *pvUserArg)
4378 {
4379         s32 result = 0;
4380         struct host_if_msg msg;
4381
4382         if (!hif_drv) {
4383                 PRINT_ER("driver is null\n");
4384                 return -EFAULT;
4385         }
4386
4387         memset(&msg, 0, sizeof(struct host_if_msg));
4388
4389         msg.id = HOST_IF_MSG_REMAIN_ON_CHAN;
4390         msg.body.remain_on_ch.ch = chan;
4391         msg.body.remain_on_ch.expired = RemainOnChanExpired;
4392         msg.body.remain_on_ch.ready = RemainOnChanReady;
4393         msg.body.remain_on_ch.arg = pvUserArg;
4394         msg.body.remain_on_ch.u32duration = u32duration;
4395         msg.body.remain_on_ch.id = u32SessionID;
4396         msg.drv = hif_drv;
4397
4398         result = wilc_mq_send(&hif_msg_q, &msg, sizeof(struct host_if_msg));
4399         if (result)
4400                 PRINT_ER("wilc mq send fail\n");
4401
4402         return result;
4403 }
4404
4405 s32 host_int_ListenStateExpired(struct host_if_drv *hif_drv, u32 u32SessionID)
4406 {
4407         s32 result = 0;
4408         struct host_if_msg msg;
4409
4410         if (!hif_drv) {
4411                 PRINT_ER("driver is null\n");
4412                 return -EFAULT;
4413         }
4414
4415         del_timer(&hif_drv->remain_on_ch_timer);
4416
4417         memset(&msg, 0, sizeof(struct host_if_msg));
4418         msg.id = HOST_IF_MSG_LISTEN_TIMER_FIRED;
4419         msg.drv = hif_drv;
4420         msg.body.remain_on_ch.id = u32SessionID;
4421
4422         result = wilc_mq_send(&hif_msg_q, &msg, sizeof(struct host_if_msg));
4423         if (result)
4424                 PRINT_ER("wilc mq send fail\n");
4425
4426         return result;
4427 }
4428
4429 s32 host_int_frame_register(struct host_if_drv *hif_drv, u16 u16FrameType, bool bReg)
4430 {
4431         s32 result = 0;
4432         struct host_if_msg msg;
4433
4434         if (!hif_drv) {
4435                 PRINT_ER("driver is null\n");
4436                 return -EFAULT;
4437         }
4438
4439         memset(&msg, 0, sizeof(struct host_if_msg));
4440
4441         msg.id = HOST_IF_MSG_REGISTER_FRAME;
4442         switch (u16FrameType) {
4443         case ACTION:
4444                 PRINT_D(HOSTINF_DBG, "ACTION\n");
4445                 msg.body.reg_frame.reg_id = ACTION_FRM_IDX;
4446                 break;
4447
4448         case PROBE_REQ:
4449                 PRINT_D(HOSTINF_DBG, "PROBE REQ\n");
4450                 msg.body.reg_frame.reg_id = PROBE_REQ_IDX;
4451                 break;
4452
4453         default:
4454                 PRINT_D(HOSTINF_DBG, "Not valid frame type\n");
4455                 break;
4456         }
4457         msg.body.reg_frame.frame_type = u16FrameType;
4458         msg.body.reg_frame.reg = bReg;
4459         msg.drv = hif_drv;
4460
4461         result = wilc_mq_send(&hif_msg_q, &msg, sizeof(struct host_if_msg));
4462         if (result)
4463                 PRINT_ER("wilc mq send fail\n");
4464
4465         return result;
4466 }
4467
4468 s32 host_int_add_beacon(struct host_if_drv *hif_drv, u32 u32Interval,
4469                         u32 u32DTIMPeriod, u32 u32HeadLen, u8 *pu8Head,
4470                         u32 u32TailLen, u8 *pu8Tail)
4471 {
4472         s32 result = 0;
4473         struct host_if_msg msg;
4474         struct beacon_attr *pstrSetBeaconParam = &msg.body.beacon_info;
4475
4476         if (!hif_drv) {
4477                 PRINT_ER("driver is null\n");
4478                 return -EFAULT;
4479         }
4480
4481         memset(&msg, 0, sizeof(struct host_if_msg));
4482
4483         PRINT_D(HOSTINF_DBG, "Setting adding beacon message queue params\n");
4484
4485         msg.id = HOST_IF_MSG_ADD_BEACON;
4486         msg.drv = hif_drv;
4487         pstrSetBeaconParam->interval = u32Interval;
4488         pstrSetBeaconParam->dtim_period = u32DTIMPeriod;
4489         pstrSetBeaconParam->head_len = u32HeadLen;
4490         pstrSetBeaconParam->head = kmemdup(pu8Head, u32HeadLen, GFP_KERNEL);
4491         if (!pstrSetBeaconParam->head) {
4492                 result = -ENOMEM;
4493                 goto ERRORHANDLER;
4494         }
4495         pstrSetBeaconParam->tail_len = u32TailLen;
4496
4497         if (u32TailLen > 0) {
4498                 pstrSetBeaconParam->tail = kmemdup(pu8Tail, u32TailLen,
4499                                                    GFP_KERNEL);
4500                 if (!pstrSetBeaconParam->tail) {
4501                         result = -ENOMEM;
4502                         goto ERRORHANDLER;
4503                 }
4504         } else {
4505                 pstrSetBeaconParam->tail = NULL;
4506         }
4507
4508         result = wilc_mq_send(&hif_msg_q, &msg, sizeof(struct host_if_msg));
4509         if (result)
4510                 PRINT_ER("wilc mq send fail\n");
4511
4512 ERRORHANDLER:
4513         if (result) {
4514                 kfree(pstrSetBeaconParam->head);
4515
4516                 kfree(pstrSetBeaconParam->tail);
4517         }
4518
4519         return result;
4520 }
4521
4522 int host_int_del_beacon(struct host_if_drv *hif_drv)
4523 {
4524         int result = 0;
4525         struct host_if_msg msg;
4526
4527         if (!hif_drv) {
4528                 PRINT_ER("driver is null\n");
4529                 return -EFAULT;
4530         }
4531
4532         msg.id = HOST_IF_MSG_DEL_BEACON;
4533         msg.drv = hif_drv;
4534         PRINT_D(HOSTINF_DBG, "Setting deleting beacon message queue params\n");
4535
4536         result = wilc_mq_send(&hif_msg_q, &msg, sizeof(struct host_if_msg));
4537         if (result)
4538                 PRINT_ER("wilc_mq_send fail\n");
4539
4540         return result;
4541 }
4542
4543 int host_int_add_station(struct host_if_drv *hif_drv,
4544                          struct add_sta_param *sta_param)
4545 {
4546         int result = 0;
4547         struct host_if_msg msg;
4548         struct add_sta_param *add_sta_info = &msg.body.add_sta_info;
4549
4550         if (!hif_drv) {
4551                 PRINT_ER("driver is null\n");
4552                 return -EFAULT;
4553         }
4554
4555         memset(&msg, 0, sizeof(struct host_if_msg));
4556
4557         PRINT_D(HOSTINF_DBG, "Setting adding station message queue params\n");
4558
4559         msg.id = HOST_IF_MSG_ADD_STATION;
4560         msg.drv = hif_drv;
4561
4562         memcpy(add_sta_info, sta_param, sizeof(struct add_sta_param));
4563         if (add_sta_info->rates_len > 0) {
4564                 add_sta_info->rates = kmemdup(sta_param->rates,
4565                                       add_sta_info->rates_len,
4566                                       GFP_KERNEL);
4567                 if (!add_sta_info->rates)
4568                         return -ENOMEM;
4569         }
4570
4571         result = wilc_mq_send(&hif_msg_q, &msg, sizeof(struct host_if_msg));
4572         if (result)
4573                 PRINT_ER("wilc_mq_send fail\n");
4574         return result;
4575 }
4576
4577 int host_int_del_station(struct host_if_drv *hif_drv, const u8 *mac_addr)
4578 {
4579         int result = 0;
4580         struct host_if_msg msg;
4581         struct del_sta *del_sta_info = &msg.body.del_sta_info;
4582
4583         if (!hif_drv) {
4584                 PRINT_ER("driver is null\n");
4585                 return -EFAULT;
4586         }
4587
4588         memset(&msg, 0, sizeof(struct host_if_msg));
4589
4590         PRINT_D(HOSTINF_DBG, "Setting deleting station message queue params\n");
4591
4592         msg.id = HOST_IF_MSG_DEL_STATION;
4593         msg.drv = hif_drv;
4594
4595         if (!mac_addr)
4596                 eth_broadcast_addr(del_sta_info->mac_addr);
4597         else
4598                 memcpy(del_sta_info->mac_addr, mac_addr, ETH_ALEN);
4599
4600         result = wilc_mq_send(&hif_msg_q, &msg, sizeof(struct host_if_msg));
4601         if (result)
4602                 PRINT_ER("wilc_mq_send fail\n");
4603         return result;
4604 }
4605
4606 s32 host_int_del_allstation(struct host_if_drv *hif_drv,
4607                             u8 pu8MacAddr[][ETH_ALEN])
4608 {
4609         s32 result = 0;
4610         struct host_if_msg msg;
4611         struct del_all_sta *pstrDelAllStationMsg = &msg.body.del_all_sta_info;
4612         u8 au8Zero_Buff[ETH_ALEN] = {0};
4613         u32 i;
4614         u8 u8AssocNumb = 0;
4615
4616         if (!hif_drv) {
4617                 PRINT_ER("driver is null\n");
4618                 return -EFAULT;
4619         }
4620
4621         memset(&msg, 0, sizeof(struct host_if_msg));
4622
4623         PRINT_D(HOSTINF_DBG, "Setting deauthenticating station message queue params\n");
4624
4625         msg.id = HOST_IF_MSG_DEL_ALL_STA;
4626         msg.drv = hif_drv;
4627
4628         for (i = 0; i < MAX_NUM_STA; i++) {
4629                 if (memcmp(pu8MacAddr[i], au8Zero_Buff, ETH_ALEN)) {
4630                         memcpy(pstrDelAllStationMsg->del_all_sta[i], pu8MacAddr[i], ETH_ALEN);
4631                         PRINT_D(CFG80211_DBG, "BSSID = %x%x%x%x%x%x\n",
4632                                 pstrDelAllStationMsg->del_all_sta[i][0],
4633                                 pstrDelAllStationMsg->del_all_sta[i][1],
4634                                 pstrDelAllStationMsg->del_all_sta[i][2],
4635                                 pstrDelAllStationMsg->del_all_sta[i][3],
4636                                 pstrDelAllStationMsg->del_all_sta[i][4],
4637                                 pstrDelAllStationMsg->del_all_sta[i][5]);
4638                         u8AssocNumb++;
4639                 }
4640         }
4641         if (!u8AssocNumb) {
4642                 PRINT_D(CFG80211_DBG, "NO ASSOCIATED STAS\n");
4643                 return result;
4644         }
4645
4646         pstrDelAllStationMsg->assoc_sta = u8AssocNumb;
4647         result = wilc_mq_send(&hif_msg_q, &msg, sizeof(struct host_if_msg));
4648
4649         if (result)
4650                 PRINT_ER("wilc_mq_send fail\n");
4651
4652         down(&hif_sema_wait_response);
4653
4654         return result;
4655 }
4656
4657 s32 host_int_edit_station(struct host_if_drv *hif_drv,
4658                           struct add_sta_param *pstrStaParams)
4659 {
4660         s32 result = 0;
4661         struct host_if_msg msg;
4662         struct add_sta_param *pstrAddStationMsg = &msg.body.add_sta_info;
4663
4664         if (!hif_drv) {
4665                 PRINT_ER("driver is null\n");
4666                 return -EFAULT;
4667         }
4668
4669         PRINT_D(HOSTINF_DBG, "Setting editing station message queue params\n");
4670
4671         memset(&msg, 0, sizeof(struct host_if_msg));
4672
4673         msg.id = HOST_IF_MSG_EDIT_STATION;
4674         msg.drv = hif_drv;
4675
4676         memcpy(pstrAddStationMsg, pstrStaParams, sizeof(struct add_sta_param));
4677         if (pstrAddStationMsg->rates_len > 0) {
4678                 u8 *rates = kmalloc(pstrAddStationMsg->rates_len, GFP_KERNEL);
4679
4680                 if (!rates)
4681                         return -ENOMEM;
4682
4683                 memcpy(rates, pstrStaParams->rates,
4684                        pstrAddStationMsg->rates_len);
4685                 pstrAddStationMsg->rates = rates;
4686         }
4687
4688         result = wilc_mq_send(&hif_msg_q, &msg, sizeof(struct host_if_msg));
4689         if (result)
4690                 PRINT_ER("wilc_mq_send fail\n");
4691
4692         return result;
4693 }
4694
4695 s32 host_int_set_power_mgmt(struct host_if_drv *hif_drv,
4696                             bool bIsEnabled,
4697                             u32 u32Timeout)
4698 {
4699         s32 result = 0;
4700         struct host_if_msg msg;
4701         struct power_mgmt_param *pstrPowerMgmtParam = &msg.body.pwr_mgmt_info;
4702
4703         PRINT_INFO(HOSTINF_DBG, "\n\n>> Setting PS to %d <<\n\n", bIsEnabled);
4704
4705         if (!hif_drv) {
4706                 PRINT_ER("driver is null\n");
4707                 return -EFAULT;
4708         }
4709
4710         PRINT_D(HOSTINF_DBG, "Setting Power management message queue params\n");
4711
4712         memset(&msg, 0, sizeof(struct host_if_msg));
4713
4714         msg.id = HOST_IF_MSG_POWER_MGMT;
4715         msg.drv = hif_drv;
4716
4717         pstrPowerMgmtParam->enabled = bIsEnabled;
4718         pstrPowerMgmtParam->timeout = u32Timeout;
4719
4720         result = wilc_mq_send(&hif_msg_q, &msg, sizeof(struct host_if_msg));
4721         if (result)
4722                 PRINT_ER("wilc_mq_send fail\n");
4723         return result;
4724 }
4725
4726 s32 host_int_setup_multicast_filter(struct host_if_drv *hif_drv,
4727                                     bool bIsEnabled,
4728                                     u32 u32count)
4729 {
4730         s32 result = 0;
4731         struct host_if_msg msg;
4732         struct set_multicast *pstrMulticastFilterParam = &msg.body.multicast_info;
4733
4734         if (!hif_drv) {
4735                 PRINT_ER("driver is null\n");
4736                 return -EFAULT;
4737         }
4738
4739         PRINT_D(HOSTINF_DBG, "Setting Multicast Filter params\n");
4740
4741         memset(&msg, 0, sizeof(struct host_if_msg));
4742
4743         msg.id = HOST_IF_MSG_SET_MULTICAST_FILTER;
4744         msg.drv = hif_drv;
4745
4746         pstrMulticastFilterParam->enabled = bIsEnabled;
4747         pstrMulticastFilterParam->cnt = u32count;
4748
4749         result = wilc_mq_send(&hif_msg_q, &msg, sizeof(struct host_if_msg));
4750         if (result)
4751                 PRINT_ER("wilc_mq_send fail\n");
4752         return result;
4753 }
4754
4755 static void *host_int_ParseJoinBssParam(tstrNetworkInfo *ptstrNetworkInfo)
4756 {
4757         struct join_bss_param *pNewJoinBssParam = NULL;
4758         u8 *pu8IEs;
4759         u16 u16IEsLen;
4760         u16 index = 0;
4761         u8 suppRatesNo = 0;
4762         u8 extSuppRatesNo;
4763         u16 jumpOffset;
4764         u8 pcipherCount;
4765         u8 authCount;
4766         u8 pcipherTotalCount = 0;
4767         u8 authTotalCount = 0;
4768         u8 i, j;
4769
4770         pu8IEs = ptstrNetworkInfo->pu8IEs;
4771         u16IEsLen = ptstrNetworkInfo->u16IEsLen;
4772
4773         pNewJoinBssParam = kzalloc(sizeof(struct join_bss_param), GFP_KERNEL);
4774         if (pNewJoinBssParam) {
4775                 pNewJoinBssParam->dtim_period = ptstrNetworkInfo->u8DtimPeriod;
4776                 pNewJoinBssParam->beacon_period = ptstrNetworkInfo->u16BeaconPeriod;
4777                 pNewJoinBssParam->cap_info = ptstrNetworkInfo->u16CapInfo;
4778                 memcpy(pNewJoinBssParam->au8bssid, ptstrNetworkInfo->au8bssid, 6);
4779                 memcpy((u8 *)pNewJoinBssParam->ssid, ptstrNetworkInfo->au8ssid, ptstrNetworkInfo->u8SsidLen + 1);
4780                 pNewJoinBssParam->ssid_len = ptstrNetworkInfo->u8SsidLen;
4781                 memset(pNewJoinBssParam->rsn_pcip_policy, 0xFF, 3);
4782                 memset(pNewJoinBssParam->rsn_auth_policy, 0xFF, 3);
4783
4784                 while (index < u16IEsLen) {
4785                         if (pu8IEs[index] == SUPP_RATES_IE) {
4786                                 suppRatesNo = pu8IEs[index + 1];
4787                                 pNewJoinBssParam->supp_rates[0] = suppRatesNo;
4788                                 index += 2;
4789
4790                                 for (i = 0; i < suppRatesNo; i++)
4791                                         pNewJoinBssParam->supp_rates[i + 1] = pu8IEs[index + i];
4792
4793                                 index += suppRatesNo;
4794                                 continue;
4795                         } else if (pu8IEs[index] == EXT_SUPP_RATES_IE) {
4796                                 extSuppRatesNo = pu8IEs[index + 1];
4797                                 if (extSuppRatesNo > (MAX_RATES_SUPPORTED - suppRatesNo))
4798                                         pNewJoinBssParam->supp_rates[0] = MAX_RATES_SUPPORTED;
4799                                 else
4800                                         pNewJoinBssParam->supp_rates[0] += extSuppRatesNo;
4801                                 index += 2;
4802                                 for (i = 0; i < (pNewJoinBssParam->supp_rates[0] - suppRatesNo); i++)
4803                                         pNewJoinBssParam->supp_rates[suppRatesNo + i + 1] = pu8IEs[index + i];
4804
4805                                 index += extSuppRatesNo;
4806                                 continue;
4807                         } else if (pu8IEs[index] == HT_CAPABILITY_IE) {
4808                                 pNewJoinBssParam->ht_capable = true;
4809                                 index += pu8IEs[index + 1] + 2;
4810                                 continue;
4811                         } else if ((pu8IEs[index] == WMM_IE) &&
4812                                    (pu8IEs[index + 2] == 0x00) && (pu8IEs[index + 3] == 0x50) &&
4813                                    (pu8IEs[index + 4] == 0xF2) &&
4814                                    (pu8IEs[index + 5] == 0x02) &&
4815                                    ((pu8IEs[index + 6] == 0x00) || (pu8IEs[index + 6] == 0x01)) &&
4816                                    (pu8IEs[index + 7] == 0x01)) {
4817                                 pNewJoinBssParam->wmm_cap = true;
4818
4819                                 if (pu8IEs[index + 8] & BIT(7))
4820                                         pNewJoinBssParam->uapsd_cap = true;
4821                                 index += pu8IEs[index + 1] + 2;
4822                                 continue;
4823                         } else if ((pu8IEs[index] == P2P_IE) &&
4824                                  (pu8IEs[index + 2] == 0x50) && (pu8IEs[index + 3] == 0x6f) &&
4825                                  (pu8IEs[index + 4] == 0x9a) &&
4826                                  (pu8IEs[index + 5] == 0x09) && (pu8IEs[index + 6] == 0x0c)) {
4827                                 u16 u16P2P_count;
4828
4829                                 pNewJoinBssParam->tsf = ptstrNetworkInfo->u32Tsf;
4830                                 pNewJoinBssParam->noa_enabled = 1;
4831                                 pNewJoinBssParam->idx = pu8IEs[index + 9];
4832
4833                                 if (pu8IEs[index + 10] & BIT(7)) {
4834                                         pNewJoinBssParam->opp_enabled = 1;
4835                                         pNewJoinBssParam->ct_window = pu8IEs[index + 10];
4836                                 } else {
4837                                         pNewJoinBssParam->opp_enabled = 0;
4838                                 }
4839
4840                                 PRINT_D(GENERIC_DBG, "P2P Dump\n");
4841                                 for (i = 0; i < pu8IEs[index + 7]; i++)
4842                                         PRINT_D(GENERIC_DBG, " %x\n", pu8IEs[index + 9 + i]);
4843
4844                                 pNewJoinBssParam->cnt = pu8IEs[index + 11];
4845                                 u16P2P_count = index + 12;
4846
4847                                 memcpy(pNewJoinBssParam->duration, pu8IEs + u16P2P_count, 4);
4848                                 u16P2P_count += 4;
4849
4850                                 memcpy(pNewJoinBssParam->interval, pu8IEs + u16P2P_count, 4);
4851                                 u16P2P_count += 4;
4852
4853                                 memcpy(pNewJoinBssParam->start_time, pu8IEs + u16P2P_count, 4);
4854
4855                                 index += pu8IEs[index + 1] + 2;
4856                                 continue;
4857
4858                         } else if ((pu8IEs[index] == RSN_IE) ||
4859                                  ((pu8IEs[index] == WPA_IE) && (pu8IEs[index + 2] == 0x00) &&
4860                                   (pu8IEs[index + 3] == 0x50) && (pu8IEs[index + 4] == 0xF2) &&
4861                                   (pu8IEs[index + 5] == 0x01))) {
4862                                 u16 rsnIndex = index;
4863
4864                                 if (pu8IEs[rsnIndex] == RSN_IE) {
4865                                         pNewJoinBssParam->mode_802_11i = 2;
4866                                 } else {
4867                                         if (pNewJoinBssParam->mode_802_11i == 0)
4868                                                 pNewJoinBssParam->mode_802_11i = 1;
4869                                         rsnIndex += 4;
4870                                 }
4871
4872                                 rsnIndex += 7;
4873                                 pNewJoinBssParam->rsn_grp_policy = pu8IEs[rsnIndex];
4874                                 rsnIndex++;
4875                                 jumpOffset = pu8IEs[rsnIndex] * 4;
4876                                 pcipherCount = (pu8IEs[rsnIndex] > 3) ? 3 : pu8IEs[rsnIndex];
4877                                 rsnIndex += 2;
4878
4879                                 for (i = pcipherTotalCount, j = 0; i < pcipherCount + pcipherTotalCount && i < 3; i++, j++)
4880                                         pNewJoinBssParam->rsn_pcip_policy[i] = pu8IEs[rsnIndex + ((j + 1) * 4) - 1];
4881
4882                                 pcipherTotalCount += pcipherCount;
4883                                 rsnIndex += jumpOffset;
4884
4885                                 jumpOffset = pu8IEs[rsnIndex] * 4;
4886
4887                                 authCount = (pu8IEs[rsnIndex] > 3) ? 3 : pu8IEs[rsnIndex];
4888                                 rsnIndex += 2;
4889
4890                                 for (i = authTotalCount, j = 0; i < authTotalCount + authCount; i++, j++)
4891                                         pNewJoinBssParam->rsn_auth_policy[i] = pu8IEs[rsnIndex + ((j + 1) * 4) - 1];
4892
4893                                 authTotalCount += authCount;
4894                                 rsnIndex += jumpOffset;
4895
4896                                 if (pu8IEs[index] == RSN_IE) {
4897                                         pNewJoinBssParam->rsn_cap[0] = pu8IEs[rsnIndex];
4898                                         pNewJoinBssParam->rsn_cap[1] = pu8IEs[rsnIndex + 1];
4899                                         rsnIndex += 2;
4900                                 }
4901                                 pNewJoinBssParam->rsn_found = true;
4902                                 index += pu8IEs[index + 1] + 2;
4903                                 continue;
4904                         } else
4905                                 index += pu8IEs[index + 1] + 2;
4906                 }
4907         }
4908
4909         return (void *)pNewJoinBssParam;
4910 }
4911
4912 void host_int_freeJoinParams(void *pJoinParams)
4913 {
4914         if ((struct bss_param *)pJoinParams)
4915                 kfree((struct bss_param *)pJoinParams);
4916         else
4917                 PRINT_ER("Unable to FREE null pointer\n");
4918 }
4919
4920 s32 host_int_delBASession(struct host_if_drv *hif_drv, char *pBSSID, char TID)
4921 {
4922         s32 result = 0;
4923         struct host_if_msg msg;
4924         struct ba_session_info *pBASessionInfo = &msg.body.session_info;
4925
4926         if (!hif_drv) {
4927                 PRINT_ER("driver is null\n");
4928                 return -EFAULT;
4929         }
4930
4931         memset(&msg, 0, sizeof(struct host_if_msg));
4932
4933         msg.id = HOST_IF_MSG_DEL_BA_SESSION;
4934
4935         memcpy(pBASessionInfo->bssid, pBSSID, ETH_ALEN);
4936         pBASessionInfo->tid = TID;
4937         msg.drv = hif_drv;
4938
4939         result = wilc_mq_send(&hif_msg_q, &msg, sizeof(struct host_if_msg));
4940         if (result)
4941                 PRINT_ER("wilc_mq_send fail\n");
4942
4943         down(&hif_sema_wait_response);
4944
4945         return result;
4946 }
4947
4948 s32 host_int_del_All_Rx_BASession(struct host_if_drv *hif_drv,
4949                                   char *pBSSID,
4950                                   char TID)
4951 {
4952         s32 result = 0;
4953         struct host_if_msg msg;
4954         struct ba_session_info *pBASessionInfo = &msg.body.session_info;
4955
4956         if (!hif_drv) {
4957                 PRINT_ER("driver is null\n");
4958                 return -EFAULT;
4959         }
4960
4961         memset(&msg, 0, sizeof(struct host_if_msg));
4962
4963         msg.id = HOST_IF_MSG_DEL_ALL_RX_BA_SESSIONS;
4964
4965         memcpy(pBASessionInfo->bssid, pBSSID, ETH_ALEN);
4966         pBASessionInfo->tid = TID;
4967         msg.drv = hif_drv;
4968
4969         result = wilc_mq_send(&hif_msg_q, &msg, sizeof(struct host_if_msg));
4970         if (result)
4971                 PRINT_ER("wilc_mq_send fail\n");
4972
4973         down(&hif_sema_wait_response);
4974
4975         return result;
4976 }
4977
4978 s32 host_int_setup_ipaddress(struct host_if_drv *hif_drv, u8 *u16ipadd, u8 idx)
4979 {
4980         s32 result = 0;
4981         struct host_if_msg msg;
4982
4983         return 0;
4984
4985         if (!hif_drv) {
4986                 PRINT_ER("driver is null\n");
4987                 return -EFAULT;
4988         }
4989
4990         memset(&msg, 0, sizeof(struct host_if_msg));
4991
4992         msg.id = HOST_IF_MSG_SET_IPADDRESS;
4993
4994         msg.body.ip_info.ip_addr = u16ipadd;
4995         msg.drv = hif_drv;
4996         msg.body.ip_info.idx = idx;
4997
4998         result = wilc_mq_send(&hif_msg_q, &msg, sizeof(struct host_if_msg));
4999         if (result)
5000                 PRINT_ER("wilc_mq_send fail\n");
5001
5002         return result;
5003 }
5004
5005 s32 host_int_get_ipaddress(struct host_if_drv *hif_drv, u8 *u16ipadd, u8 idx)
5006 {
5007         s32 result = 0;
5008         struct host_if_msg msg;
5009
5010         if (!hif_drv) {
5011                 PRINT_ER("driver is null\n");
5012                 return -EFAULT;
5013         }
5014
5015         memset(&msg, 0, sizeof(struct host_if_msg));
5016
5017         msg.id = HOST_IF_MSG_GET_IPADDRESS;
5018
5019         msg.body.ip_info.ip_addr = u16ipadd;
5020         msg.drv = hif_drv;
5021         msg.body.ip_info.idx = idx;
5022
5023         result = wilc_mq_send(&hif_msg_q, &msg, sizeof(struct host_if_msg));
5024         if (result)
5025                 PRINT_ER("wilc_mq_send fail\n");
5026
5027         return result;
5028 }