1 #include <linux/slab.h>
2 #include <linux/time.h>
3 #include <linux/kthread.h>
4 #include <linux/delay.h>
5 #include <linux/completion.h>
6 #include <linux/list.h>
7 #include <linux/workqueue.h>
8 #include "host_interface.h"
9 #include <linux/spinlock.h>
10 #include <linux/errno.h>
11 #include "coreconfigurator.h"
12 #include "wilc_wlan.h"
13 #include "wilc_wlan_if.h"
14 #include <linux/etherdevice.h>
15 #include "wilc_wfi_netdevice.h"
16
17 #define HOST_IF_MSG_SCAN 0
18 #define HOST_IF_MSG_CONNECT 1
19 #define HOST_IF_MSG_RCVD_GNRL_ASYNC_INFO 2
20 #define HOST_IF_MSG_KEY 3
21 #define HOST_IF_MSG_RCVD_NTWRK_INFO 4
22 #define HOST_IF_MSG_RCVD_SCAN_COMPLETE 5
23 #define HOST_IF_MSG_CFG_PARAMS 6
24 #define HOST_IF_MSG_SET_CHANNEL 7
25 #define HOST_IF_MSG_DISCONNECT 8
26 #define HOST_IF_MSG_GET_RSSI 9
27 #define HOST_IF_MSG_ADD_BEACON 11
28 #define HOST_IF_MSG_DEL_BEACON 12
29 #define HOST_IF_MSG_ADD_STATION 13
30 #define HOST_IF_MSG_DEL_STATION 14
31 #define HOST_IF_MSG_EDIT_STATION 15
32 #define HOST_IF_MSG_SCAN_TIMER_FIRED 16
33 #define HOST_IF_MSG_CONNECT_TIMER_FIRED 17
34 #define HOST_IF_MSG_POWER_MGMT 18
35 #define HOST_IF_MSG_GET_INACTIVETIME 19
36 #define HOST_IF_MSG_REMAIN_ON_CHAN 20
37 #define HOST_IF_MSG_REGISTER_FRAME 21
38 #define HOST_IF_MSG_LISTEN_TIMER_FIRED 22
39 #define HOST_IF_MSG_SET_WFIDRV_HANDLER 24
40 #define HOST_IF_MSG_GET_MAC_ADDRESS 26
41 #define HOST_IF_MSG_SET_OPERATION_MODE 27
42 #define HOST_IF_MSG_SET_IPADDRESS 28
43 #define HOST_IF_MSG_GET_IPADDRESS 29
44 #define HOST_IF_MSG_GET_STATISTICS 31
45 #define HOST_IF_MSG_SET_MULTICAST_FILTER 32
46 #define HOST_IF_MSG_DEL_BA_SESSION 34
47 #define HOST_IF_MSG_DEL_ALL_STA 36
48 #define HOST_IF_MSG_SET_TX_POWER 38
49 #define HOST_IF_MSG_GET_TX_POWER 39
50 #define HOST_IF_MSG_EXIT 100
51
52 #define HOST_IF_SCAN_TIMEOUT 4000
53 #define HOST_IF_CONNECT_TIMEOUT 9500
54
55 #define BA_SESSION_DEFAULT_BUFFER_SIZE 16
56 #define BA_SESSION_DEFAULT_TIMEOUT 1000
57 #define BLOCK_ACK_REQ_SIZE 0x14
58 #define FALSE_FRMWR_CHANNEL 100
59
60 #define TCP_ACK_FILTER_LINK_SPEED_THRESH 54
61 #define DEFAULT_LINK_SPEED 72
62
63 struct host_if_wpa_attr {
64 u8 *key;
65 const u8 *mac_addr;
66 u8 *seq;
67 u8 seq_len;
68 u8 index;
69 u8 key_len;
70 u8 mode;
71 };
72
73 struct host_if_wep_attr {
74 u8 *key;
75 u8 key_len;
76 u8 index;
77 u8 mode;
78 enum AUTHTYPE auth_type;
79 };
80
81 union host_if_key_attr {
82 struct host_if_wep_attr wep;
83 struct host_if_wpa_attr wpa;
84 struct host_if_pmkid_attr pmkid;
85 };
86
87 struct key_attr {
88 enum KEY_TYPE type;
89 u8 action;
90 union host_if_key_attr attr;
91 };
92
93 struct scan_attr {
94 u8 src;
95 u8 type;
96 u8 *ch_freq_list;
97 u8 ch_list_len;
98 u8 *ies;
99 size_t ies_len;
100 wilc_scan_result result;
101 void *arg;
102 struct hidden_network hidden_network;
103 };
104
105 struct connect_attr {
106 u8 *bssid;
107 u8 *ssid;
108 size_t ssid_len;
109 u8 *ies;
110 size_t ies_len;
111 u8 security;
112 wilc_connect_result result;
113 void *arg;
114 enum AUTHTYPE auth_type;
115 u8 ch;
116 void *params;
117 };
118
119 struct rcvd_async_info {
120 u8 *buffer;
121 u32 len;
122 };
123
124 struct channel_attr {
125 u8 set_ch;
126 };
127
128 struct beacon_attr {
129 u32 interval;
130 u32 dtim_period;
131 u32 head_len;
132 u8 *head;
133 u32 tail_len;
134 u8 *tail;
135 };
136
137 struct set_multicast {
138 bool enabled;
139 u32 cnt;
140 };
141
142 struct del_all_sta {
143 u8 del_all_sta[MAX_NUM_STA][ETH_ALEN];
144 u8 assoc_sta;
145 };
146
147 struct del_sta {
148 u8 mac_addr[ETH_ALEN];
149 };
150
151 struct power_mgmt_param {
152 bool enabled;
153 u32 timeout;
154 };
155
156 struct set_ip_addr {
157 u8 *ip_addr;
158 u8 idx;
159 };
160
161 struct sta_inactive_t {
162 u8 mac[6];
163 };
164
165 struct tx_power {
166 u8 tx_pwr;
167 };
168
169 union message_body {
170 struct scan_attr scan_info;
171 struct connect_attr con_info;
172 struct rcvd_net_info net_info;
173 struct rcvd_async_info async_info;
174 struct key_attr key_info;
175 struct cfg_param_attr cfg_info;
176 struct channel_attr channel_info;
177 struct beacon_attr beacon_info;
178 struct add_sta_param add_sta_info;
179 struct del_sta del_sta_info;
180 struct add_sta_param edit_sta_info;
181 struct power_mgmt_param pwr_mgmt_info;
182 struct sta_inactive_t mac_info;
183 struct set_ip_addr ip_info;
184 struct drv_handler drv;
185 struct set_multicast multicast_info;
186 struct op_mode mode;
187 struct get_mac_addr get_mac_info;
188 struct ba_session_info session_info;
189 struct remain_ch remain_on_ch;
190 struct reg_frame reg_frame;
191 char *data;
192 struct del_all_sta del_all_sta_info;
193 struct tx_power tx_power;
194 };
195
196 struct host_if_msg {
197 u16 id;
198 union message_body body;
199 struct wilc_vif *vif;
200 struct work_struct work;
201 };
202
203 struct join_bss_param {
204 BSSTYPE_T bss_type;
205 u8 dtim_period;
206 u16 beacon_period;
207 u16 cap_info;
208 u8 bssid[6];
209 char ssid[MAX_SSID_LEN];
210 u8 ssid_len;
211 u8 supp_rates[MAX_RATES_SUPPORTED + 1];
212 u8 ht_capable;
213 u8 wmm_cap;
214 u8 uapsd_cap;
215 bool rsn_found;
216 u8 rsn_grp_policy;
217 u8 mode_802_11i;
218 u8 rsn_pcip_policy[3];
219 u8 rsn_auth_policy[3];
220 u8 rsn_cap[2];
221 u32 tsf;
222 u8 noa_enabled;
223 u8 opp_enabled;
224 u8 ct_window;
225 u8 cnt;
226 u8 idx;
227 u8 duration[4];
228 u8 interval[4];
229 u8 start_time[4];
230 };
231
232 static struct host_if_drv *terminated_handle;
233 bool wilc_optaining_ip;
234 static u8 P2P_LISTEN_STATE;
235 static struct workqueue_struct *hif_workqueue;
236 static struct completion hif_thread_comp;
237 static struct completion hif_driver_comp;
238 static struct completion hif_wait_response;
239 static struct mutex hif_deinit_lock;
240 static struct timer_list periodic_rssi;
241
242 u8 wilc_multicast_mac_addr_list[WILC_MULTICAST_TABLE_SIZE][ETH_ALEN];
243
244 static u8 rcv_assoc_resp[MAX_ASSOC_RESP_FRAME_SIZE];
245
246 static bool scan_while_connected;
247
248 static s8 rssi;
249 static u8 set_ip[2][4];
250 static u8 get_ip[2][4];
251 static u32 inactive_time;
252 static u8 del_beacon;
253 static u32 clients_count;
254
255 static u8 *join_req;
256 static u8 *info_element;
257 static u8 mode_11i;
258 static u8 auth_type;
259 static u32 join_req_size;
260 static u32 info_element_size;
261 static struct wilc_vif *join_req_vif;
262 #define REAL_JOIN_REQ 0
263 #define FLUSHED_JOIN_REQ 1
264 #define FLUSHED_BYTE_POS 79
265
266 static void *host_int_ParseJoinBssParam(struct network_info *ptstrNetworkInfo);
267 static int host_int_get_ipaddress(struct wilc_vif *vif, u8 *ip_addr, u8 idx);
268 static s32 Handle_ScanDone(struct wilc_vif *vif, enum scan_event enuEvent);
269 static void host_if_work(struct work_struct *work);
270
271 /*!
272 * @author syounan
273 * @date 1 Sep 2010
274 * @note copied from FLO glue implementatuion
275 * @version 1.0
276 */
wilc_enqueue_cmd(struct host_if_msg * msg)277 static int wilc_enqueue_cmd(struct host_if_msg *msg)
278 {
279 struct host_if_msg *new_msg;
280
281 new_msg = kmemdup(msg, sizeof(*new_msg), GFP_ATOMIC);
282 if (!new_msg)
283 return -ENOMEM;
284
285 INIT_WORK(&new_msg->work, host_if_work);
286 queue_work(hif_workqueue, &new_msg->work);
287 return 0;
288 }
289
290
291 /* The u8IfIdx starts from 0 to NUM_CONCURRENT_IFC -1, but 0 index used as
292 * special purpose in wilc device, so we add 1 to the index to starts from 1.
293 * As a result, the returned index will be 1 to NUM_CONCURRENT_IFC.
294 */
wilc_get_vif_idx(struct wilc_vif * vif)295 int wilc_get_vif_idx(struct wilc_vif *vif)
296 {
297 return vif->idx + 1;
298 }
299
300 /* We need to minus 1 from idx which is from wilc device to get real index
301 * of wilc->vif[], because we add 1 when pass to wilc device in the function
302 * wilc_get_vif_idx.
303 * As a result, the index should be between 0 and NUM_CONCURRENT_IFC -1.
304 */
wilc_get_vif_from_idx(struct wilc * wilc,int idx)305 static struct wilc_vif *wilc_get_vif_from_idx(struct wilc *wilc, int idx)
306 {
307 int index = idx - 1;
308
309 if (index < 0 || index >= NUM_CONCURRENT_IFC)
310 return NULL;
311
312 return wilc->vif[index];
313 }
314
handle_set_channel(struct wilc_vif * vif,struct channel_attr * hif_set_ch)315 static void handle_set_channel(struct wilc_vif *vif,
316 struct channel_attr *hif_set_ch)
317 {
318 int ret = 0;
319 struct wid wid;
320
321 wid.id = (u16)WID_CURRENT_CHANNEL;
322 wid.type = WID_CHAR;
323 wid.val = (char *)&hif_set_ch->set_ch;
324 wid.size = sizeof(char);
325
326 ret = wilc_send_config_pkt(vif, SET_CFG, &wid, 1,
327 wilc_get_vif_idx(vif));
328
329 if (ret)
330 netdev_err(vif->ndev, "Failed to set channel\n");
331 }
332
handle_set_wfi_drv_handler(struct wilc_vif * vif,struct drv_handler * hif_drv_handler)333 static void handle_set_wfi_drv_handler(struct wilc_vif *vif,
334 struct drv_handler *hif_drv_handler)
335 {
336 int ret = 0;
337 struct wid wid;
338
339 wid.id = (u16)WID_SET_DRV_HANDLER;
340 wid.type = WID_STR;
341 wid.val = (s8 *)hif_drv_handler;
342 wid.size = sizeof(*hif_drv_handler);
343
344 ret = wilc_send_config_pkt(vif, SET_CFG, &wid, 1,
345 hif_drv_handler->handler);
346
347 if (!hif_drv_handler->handler)
348 complete(&hif_driver_comp);
349
350 if (ret)
351 netdev_err(vif->ndev, "Failed to set driver handler\n");
352 }
353
handle_set_operation_mode(struct wilc_vif * vif,struct op_mode * hif_op_mode)354 static void handle_set_operation_mode(struct wilc_vif *vif,
355 struct op_mode *hif_op_mode)
356 {
357 int ret = 0;
358 struct wid wid;
359
360 wid.id = (u16)WID_SET_OPERATION_MODE;
361 wid.type = WID_INT;
362 wid.val = (s8 *)&hif_op_mode->mode;
363 wid.size = sizeof(u32);
364
365 ret = wilc_send_config_pkt(vif, SET_CFG, &wid, 1,
366 wilc_get_vif_idx(vif));
367
368 if ((hif_op_mode->mode) == IDLE_MODE)
369 complete(&hif_driver_comp);
370
371 if (ret)
372 netdev_err(vif->ndev, "Failed to set driver handler\n");
373 }
374
handle_set_ip_address(struct wilc_vif * vif,u8 * ip_addr,u8 idx)375 static void handle_set_ip_address(struct wilc_vif *vif, u8 *ip_addr, u8 idx)
376 {
377 int ret = 0;
378 struct wid wid;
379 char firmware_ip_addr[4] = {0};
380
381 if (ip_addr[0] < 192)
382 ip_addr[0] = 0;
383
384 memcpy(set_ip[idx], ip_addr, IP_ALEN);
385
386 wid.id = (u16)WID_IP_ADDRESS;
387 wid.type = WID_STR;
388 wid.val = (u8 *)ip_addr;
389 wid.size = IP_ALEN;
390
391 ret = wilc_send_config_pkt(vif, SET_CFG, &wid, 1,
392 wilc_get_vif_idx(vif));
393
394 host_int_get_ipaddress(vif, firmware_ip_addr, idx);
395
396 if (ret)
397 netdev_err(vif->ndev, "Failed to set IP address\n");
398 }
399
handle_get_ip_address(struct wilc_vif * vif,u8 idx)400 static void handle_get_ip_address(struct wilc_vif *vif, u8 idx)
401 {
402 int ret = 0;
403 struct wid wid;
404
405 wid.id = (u16)WID_IP_ADDRESS;
406 wid.type = WID_STR;
407 wid.val = kmalloc(IP_ALEN, GFP_KERNEL);
408 wid.size = IP_ALEN;
409
410 ret = wilc_send_config_pkt(vif, GET_CFG, &wid, 1,
411 wilc_get_vif_idx(vif));
412
413 memcpy(get_ip[idx], wid.val, IP_ALEN);
414
415 kfree(wid.val);
416
417 if (memcmp(get_ip[idx], set_ip[idx], IP_ALEN) != 0)
418 wilc_setup_ipaddress(vif, set_ip[idx], idx);
419
420 if (ret)
421 netdev_err(vif->ndev, "Failed to get IP address\n");
422 }
423
handle_get_mac_address(struct wilc_vif * vif,struct get_mac_addr * get_mac_addr)424 static void handle_get_mac_address(struct wilc_vif *vif,
425 struct get_mac_addr *get_mac_addr)
426 {
427 int ret = 0;
428 struct wid wid;
429
430 wid.id = (u16)WID_MAC_ADDR;
431 wid.type = WID_STR;
432 wid.val = get_mac_addr->mac_addr;
433 wid.size = ETH_ALEN;
434
435 ret = wilc_send_config_pkt(vif, GET_CFG, &wid, 1,
436 wilc_get_vif_idx(vif));
437
438 if (ret)
439 netdev_err(vif->ndev, "Failed to get mac address\n");
440 complete(&hif_wait_response);
441 }
442
handle_cfg_param(struct wilc_vif * vif,struct cfg_param_attr * cfg_param_attr)443 static void handle_cfg_param(struct wilc_vif *vif,
444 struct cfg_param_attr *cfg_param_attr)
445 {
446 int ret = 0;
447 struct wid wid_list[32];
448 struct host_if_drv *hif_drv = vif->hif_drv;
449 int i = 0;
450
451 mutex_lock(&hif_drv->cfg_values_lock);
452
453 if (cfg_param_attr->flag & BSS_TYPE) {
454 u8 bss_type = cfg_param_attr->bss_type;
455
456 if (bss_type < 6) {
457 wid_list[i].id = WID_BSS_TYPE;
458 wid_list[i].val = (s8 *)&bss_type;
459 wid_list[i].type = WID_CHAR;
460 wid_list[i].size = sizeof(char);
461 hif_drv->cfg_values.bss_type = bss_type;
462 } else {
463 netdev_err(vif->ndev, "check value 6 over\n");
464 goto unlock;
465 }
466 i++;
467 }
468 if (cfg_param_attr->flag & AUTH_TYPE) {
469 if (cfg_param_attr->auth_type == 1 ||
470 cfg_param_attr->auth_type == 2 ||
471 cfg_param_attr->auth_type == 5) {
472 wid_list[i].id = WID_AUTH_TYPE;
473 wid_list[i].val = (s8 *)&cfg_param_attr->auth_type;
474 wid_list[i].type = WID_CHAR;
475 wid_list[i].size = sizeof(char);
476 hif_drv->cfg_values.auth_type = (u8)cfg_param_attr->auth_type;
477 } else {
478 netdev_err(vif->ndev, "Impossible value\n");
479 goto unlock;
480 }
481 i++;
482 }
483 if (cfg_param_attr->flag & AUTHEN_TIMEOUT) {
484 if (cfg_param_attr->auth_timeout > 0 &&
485 cfg_param_attr->auth_timeout < 65536) {
486 wid_list[i].id = WID_AUTH_TIMEOUT;
487 wid_list[i].val = (s8 *)&cfg_param_attr->auth_timeout;
488 wid_list[i].type = WID_SHORT;
489 wid_list[i].size = sizeof(u16);
490 hif_drv->cfg_values.auth_timeout = cfg_param_attr->auth_timeout;
491 } else {
492 netdev_err(vif->ndev, "Range(1 ~ 65535) over\n");
493 goto unlock;
494 }
495 i++;
496 }
497 if (cfg_param_attr->flag & POWER_MANAGEMENT) {
498 if (cfg_param_attr->power_mgmt_mode < 5) {
499 wid_list[i].id = WID_POWER_MANAGEMENT;
500 wid_list[i].val = (s8 *)&cfg_param_attr->power_mgmt_mode;
501 wid_list[i].type = WID_CHAR;
502 wid_list[i].size = sizeof(char);
503 hif_drv->cfg_values.power_mgmt_mode = (u8)cfg_param_attr->power_mgmt_mode;
504 } else {
505 netdev_err(vif->ndev, "Invalid power mode\n");
506 goto unlock;
507 }
508 i++;
509 }
510 if (cfg_param_attr->flag & RETRY_SHORT) {
511 if (cfg_param_attr->short_retry_limit > 0 &&
512 cfg_param_attr->short_retry_limit < 256) {
513 wid_list[i].id = WID_SHORT_RETRY_LIMIT;
514 wid_list[i].val = (s8 *)&cfg_param_attr->short_retry_limit;
515 wid_list[i].type = WID_SHORT;
516 wid_list[i].size = sizeof(u16);
517 hif_drv->cfg_values.short_retry_limit = cfg_param_attr->short_retry_limit;
518 } else {
519 netdev_err(vif->ndev, "Range(1~256) over\n");
520 goto unlock;
521 }
522 i++;
523 }
524 if (cfg_param_attr->flag & RETRY_LONG) {
525 if (cfg_param_attr->long_retry_limit > 0 &&
526 cfg_param_attr->long_retry_limit < 256) {
527 wid_list[i].id = WID_LONG_RETRY_LIMIT;
528 wid_list[i].val = (s8 *)&cfg_param_attr->long_retry_limit;
529 wid_list[i].type = WID_SHORT;
530 wid_list[i].size = sizeof(u16);
531 hif_drv->cfg_values.long_retry_limit = cfg_param_attr->long_retry_limit;
532 } else {
533 netdev_err(vif->ndev, "Range(1~256) over\n");
534 goto unlock;
535 }
536 i++;
537 }
538 if (cfg_param_attr->flag & FRAG_THRESHOLD) {
539 if (cfg_param_attr->frag_threshold > 255 &&
540 cfg_param_attr->frag_threshold < 7937) {
541 wid_list[i].id = WID_FRAG_THRESHOLD;
542 wid_list[i].val = (s8 *)&cfg_param_attr->frag_threshold;
543 wid_list[i].type = WID_SHORT;
544 wid_list[i].size = sizeof(u16);
545 hif_drv->cfg_values.frag_threshold = cfg_param_attr->frag_threshold;
546 } else {
547 netdev_err(vif->ndev, "Threshold Range fail\n");
548 goto unlock;
549 }
550 i++;
551 }
552 if (cfg_param_attr->flag & RTS_THRESHOLD) {
553 if (cfg_param_attr->rts_threshold > 255 &&
554 cfg_param_attr->rts_threshold < 65536) {
555 wid_list[i].id = WID_RTS_THRESHOLD;
556 wid_list[i].val = (s8 *)&cfg_param_attr->rts_threshold;
557 wid_list[i].type = WID_SHORT;
558 wid_list[i].size = sizeof(u16);
559 hif_drv->cfg_values.rts_threshold = cfg_param_attr->rts_threshold;
560 } else {
561 netdev_err(vif->ndev, "Threshold Range fail\n");
562 goto unlock;
563 }
564 i++;
565 }
566 if (cfg_param_attr->flag & PREAMBLE) {
567 if (cfg_param_attr->preamble_type < 3) {
568 wid_list[i].id = WID_PREAMBLE;
569 wid_list[i].val = (s8 *)&cfg_param_attr->preamble_type;
570 wid_list[i].type = WID_CHAR;
571 wid_list[i].size = sizeof(char);
572 hif_drv->cfg_values.preamble_type = cfg_param_attr->preamble_type;
573 } else {
574 netdev_err(vif->ndev, "Preamle Range(0~2) over\n");
575 goto unlock;
576 }
577 i++;
578 }
579 if (cfg_param_attr->flag & SHORT_SLOT_ALLOWED) {
580 if (cfg_param_attr->short_slot_allowed < 2) {
581 wid_list[i].id = WID_SHORT_SLOT_ALLOWED;
582 wid_list[i].val = (s8 *)&cfg_param_attr->short_slot_allowed;
583 wid_list[i].type = WID_CHAR;
584 wid_list[i].size = sizeof(char);
585 hif_drv->cfg_values.short_slot_allowed = (u8)cfg_param_attr->short_slot_allowed;
586 } else {
587 netdev_err(vif->ndev, "Short slot(2) over\n");
588 goto unlock;
589 }
590 i++;
591 }
592 if (cfg_param_attr->flag & TXOP_PROT_DISABLE) {
593 if (cfg_param_attr->txop_prot_disabled < 2) {
594 wid_list[i].id = WID_11N_TXOP_PROT_DISABLE;
595 wid_list[i].val = (s8 *)&cfg_param_attr->txop_prot_disabled;
596 wid_list[i].type = WID_CHAR;
597 wid_list[i].size = sizeof(char);
598 hif_drv->cfg_values.txop_prot_disabled = (u8)cfg_param_attr->txop_prot_disabled;
599 } else {
600 netdev_err(vif->ndev, "TXOP prot disable\n");
601 goto unlock;
602 }
603 i++;
604 }
605 if (cfg_param_attr->flag & BEACON_INTERVAL) {
606 if (cfg_param_attr->beacon_interval > 0 &&
607 cfg_param_attr->beacon_interval < 65536) {
608 wid_list[i].id = WID_BEACON_INTERVAL;
609 wid_list[i].val = (s8 *)&cfg_param_attr->beacon_interval;
610 wid_list[i].type = WID_SHORT;
611 wid_list[i].size = sizeof(u16);
612 hif_drv->cfg_values.beacon_interval = cfg_param_attr->beacon_interval;
613 } else {
614 netdev_err(vif->ndev, "Beacon interval(1~65535)fail\n");
615 goto unlock;
616 }
617 i++;
618 }
619 if (cfg_param_attr->flag & DTIM_PERIOD) {
620 if (cfg_param_attr->dtim_period > 0 &&
621 cfg_param_attr->dtim_period < 256) {
622 wid_list[i].id = WID_DTIM_PERIOD;
623 wid_list[i].val = (s8 *)&cfg_param_attr->dtim_period;
624 wid_list[i].type = WID_CHAR;
625 wid_list[i].size = sizeof(char);
626 hif_drv->cfg_values.dtim_period = cfg_param_attr->dtim_period;
627 } else {
628 netdev_err(vif->ndev, "DTIM range(1~255) fail\n");
629 goto unlock;
630 }
631 i++;
632 }
633 if (cfg_param_attr->flag & SITE_SURVEY) {
634 if (cfg_param_attr->site_survey_enabled < 3) {
635 wid_list[i].id = WID_SITE_SURVEY;
636 wid_list[i].val = (s8 *)&cfg_param_attr->site_survey_enabled;
637 wid_list[i].type = WID_CHAR;
638 wid_list[i].size = sizeof(char);
639 hif_drv->cfg_values.site_survey_enabled = (u8)cfg_param_attr->site_survey_enabled;
640 } else {
641 netdev_err(vif->ndev, "Site survey disable\n");
642 goto unlock;
643 }
644 i++;
645 }
646 if (cfg_param_attr->flag & SITE_SURVEY_SCAN_TIME) {
647 if (cfg_param_attr->site_survey_scan_time > 0 &&
648 cfg_param_attr->site_survey_scan_time < 65536) {
649 wid_list[i].id = WID_SITE_SURVEY_SCAN_TIME;
650 wid_list[i].val = (s8 *)&cfg_param_attr->site_survey_scan_time;
651 wid_list[i].type = WID_SHORT;
652 wid_list[i].size = sizeof(u16);
653 hif_drv->cfg_values.site_survey_scan_time = cfg_param_attr->site_survey_scan_time;
654 } else {
655 netdev_err(vif->ndev, "Site scan time(1~65535) over\n");
656 goto unlock;
657 }
658 i++;
659 }
660 if (cfg_param_attr->flag & ACTIVE_SCANTIME) {
661 if (cfg_param_attr->active_scan_time > 0 &&
662 cfg_param_attr->active_scan_time < 65536) {
663 wid_list[i].id = WID_ACTIVE_SCAN_TIME;
664 wid_list[i].val = (s8 *)&cfg_param_attr->active_scan_time;
665 wid_list[i].type = WID_SHORT;
666 wid_list[i].size = sizeof(u16);
667 hif_drv->cfg_values.active_scan_time = cfg_param_attr->active_scan_time;
668 } else {
669 netdev_err(vif->ndev, "Active time(1~65535) over\n");
670 goto unlock;
671 }
672 i++;
673 }
674 if (cfg_param_attr->flag & PASSIVE_SCANTIME) {
675 if (cfg_param_attr->passive_scan_time > 0 &&
676 cfg_param_attr->passive_scan_time < 65536) {
677 wid_list[i].id = WID_PASSIVE_SCAN_TIME;
678 wid_list[i].val = (s8 *)&cfg_param_attr->passive_scan_time;
679 wid_list[i].type = WID_SHORT;
680 wid_list[i].size = sizeof(u16);
681 hif_drv->cfg_values.passive_scan_time = cfg_param_attr->passive_scan_time;
682 } else {
683 netdev_err(vif->ndev, "Passive time(1~65535) over\n");
684 goto unlock;
685 }
686 i++;
687 }
688 if (cfg_param_attr->flag & CURRENT_TX_RATE) {
689 enum CURRENT_TXRATE curr_tx_rate = cfg_param_attr->curr_tx_rate;
690
691 if (curr_tx_rate == AUTORATE || curr_tx_rate == MBPS_1 ||
692 curr_tx_rate == MBPS_2 || curr_tx_rate == MBPS_5_5 ||
693 curr_tx_rate == MBPS_11 || curr_tx_rate == MBPS_6 ||
694 curr_tx_rate == MBPS_9 || curr_tx_rate == MBPS_12 ||
695 curr_tx_rate == MBPS_18 || curr_tx_rate == MBPS_24 ||
696 curr_tx_rate == MBPS_36 || curr_tx_rate == MBPS_48 ||
697 curr_tx_rate == MBPS_54) {
698 wid_list[i].id = WID_CURRENT_TX_RATE;
699 wid_list[i].val = (s8 *)&curr_tx_rate;
700 wid_list[i].type = WID_SHORT;
701 wid_list[i].size = sizeof(u16);
702 hif_drv->cfg_values.curr_tx_rate = (u8)curr_tx_rate;
703 } else {
704 netdev_err(vif->ndev, "out of TX rate\n");
705 goto unlock;
706 }
707 i++;
708 }
709
710 ret = wilc_send_config_pkt(vif, SET_CFG, wid_list,
711 i, wilc_get_vif_idx(vif));
712
713 if (ret)
714 netdev_err(vif->ndev, "Error in setting CFG params\n");
715
716 unlock:
717 mutex_unlock(&hif_drv->cfg_values_lock);
718 }
719
handle_scan(struct wilc_vif * vif,struct scan_attr * scan_info)720 static s32 handle_scan(struct wilc_vif *vif, struct scan_attr *scan_info)
721 {
722 s32 result = 0;
723 struct wid wid_list[5];
724 u32 index = 0;
725 u32 i;
726 u8 *buffer;
727 u8 valuesize = 0;
728 u8 *pu8HdnNtwrksWidVal = NULL;
729 struct host_if_drv *hif_drv = vif->hif_drv;
730
731 hif_drv->usr_scan_req.scan_result = scan_info->result;
732 hif_drv->usr_scan_req.arg = scan_info->arg;
733
734 if ((hif_drv->hif_state >= HOST_IF_SCANNING) &&
735 (hif_drv->hif_state < HOST_IF_CONNECTED)) {
736 netdev_err(vif->ndev, "Already scan\n");
737 result = -EBUSY;
738 goto ERRORHANDLER;
739 }
740
741 if (wilc_optaining_ip || wilc_connecting) {
742 netdev_err(vif->ndev, "Don't do obss scan\n");
743 result = -EBUSY;
744 goto ERRORHANDLER;
745 }
746
747 hif_drv->usr_scan_req.rcvd_ch_cnt = 0;
748
749 wid_list[index].id = (u16)WID_SSID_PROBE_REQ;
750 wid_list[index].type = WID_STR;
751
752 for (i = 0; i < scan_info->hidden_network.n_ssids; i++)
753 valuesize += ((scan_info->hidden_network.net_info[i].ssid_len) + 1);
754 pu8HdnNtwrksWidVal = kmalloc(valuesize + 1, GFP_KERNEL);
755 wid_list[index].val = pu8HdnNtwrksWidVal;
756 if (wid_list[index].val) {
757 buffer = wid_list[index].val;
758
759 *buffer++ = scan_info->hidden_network.n_ssids;
760
761 for (i = 0; i < scan_info->hidden_network.n_ssids; i++) {
762 *buffer++ = scan_info->hidden_network.net_info[i].ssid_len;
763 memcpy(buffer, scan_info->hidden_network.net_info[i].ssid, scan_info->hidden_network.net_info[i].ssid_len);
764 buffer += scan_info->hidden_network.net_info[i].ssid_len;
765 }
766
767 wid_list[index].size = (s32)(valuesize + 1);
768 index++;
769 }
770
771 wid_list[index].id = WID_INFO_ELEMENT_PROBE;
772 wid_list[index].type = WID_BIN_DATA;
773 wid_list[index].val = scan_info->ies;
774 wid_list[index].size = scan_info->ies_len;
775 index++;
776
777 wid_list[index].id = WID_SCAN_TYPE;
778 wid_list[index].type = WID_CHAR;
779 wid_list[index].size = sizeof(char);
780 wid_list[index].val = (s8 *)&scan_info->type;
781 index++;
782
783 wid_list[index].id = WID_SCAN_CHANNEL_LIST;
784 wid_list[index].type = WID_BIN_DATA;
785
786 if (scan_info->ch_freq_list &&
787 scan_info->ch_list_len > 0) {
788 int i;
789
790 for (i = 0; i < scan_info->ch_list_len; i++) {
791 if (scan_info->ch_freq_list[i] > 0)
792 scan_info->ch_freq_list[i] = scan_info->ch_freq_list[i] - 1;
793 }
794 }
795
796 wid_list[index].val = scan_info->ch_freq_list;
797 wid_list[index].size = scan_info->ch_list_len;
798 index++;
799
800 wid_list[index].id = WID_START_SCAN_REQ;
801 wid_list[index].type = WID_CHAR;
802 wid_list[index].size = sizeof(char);
803 wid_list[index].val = (s8 *)&scan_info->src;
804 index++;
805
806 if (hif_drv->hif_state == HOST_IF_CONNECTED)
807 scan_while_connected = true;
808 else if (hif_drv->hif_state == HOST_IF_IDLE)
809 scan_while_connected = false;
810
811 result = wilc_send_config_pkt(vif, SET_CFG, wid_list,
812 index,
813 wilc_get_vif_idx(vif));
814
815 if (result)
816 netdev_err(vif->ndev, "Failed to send scan parameters\n");
817
818 ERRORHANDLER:
819 if (result) {
820 del_timer(&hif_drv->scan_timer);
821 Handle_ScanDone(vif, SCAN_EVENT_ABORTED);
822 }
823
824 kfree(scan_info->ch_freq_list);
825 scan_info->ch_freq_list = NULL;
826
827 kfree(scan_info->ies);
828 scan_info->ies = NULL;
829 kfree(scan_info->hidden_network.net_info);
830 scan_info->hidden_network.net_info = NULL;
831
832 kfree(pu8HdnNtwrksWidVal);
833
834 return result;
835 }
836
Handle_ScanDone(struct wilc_vif * vif,enum scan_event enuEvent)837 static s32 Handle_ScanDone(struct wilc_vif *vif,
838 enum scan_event enuEvent)
839 {
840 s32 result = 0;
841 u8 u8abort_running_scan;
842 struct wid wid;
843 struct host_if_drv *hif_drv = vif->hif_drv;
844
845 if (enuEvent == SCAN_EVENT_ABORTED) {
846 u8abort_running_scan = 1;
847 wid.id = (u16)WID_ABORT_RUNNING_SCAN;
848 wid.type = WID_CHAR;
849 wid.val = (s8 *)&u8abort_running_scan;
850 wid.size = sizeof(char);
851
852 result = wilc_send_config_pkt(vif, SET_CFG, &wid, 1,
853 wilc_get_vif_idx(vif));
854
855 if (result) {
856 netdev_err(vif->ndev, "Failed to set abort running\n");
857 result = -EFAULT;
858 }
859 }
860
861 if (!hif_drv) {
862 netdev_err(vif->ndev, "Driver handler is NULL\n");
863 return result;
864 }
865
866 if (hif_drv->usr_scan_req.scan_result) {
867 hif_drv->usr_scan_req.scan_result(enuEvent, NULL,
868 hif_drv->usr_scan_req.arg, NULL);
869 hif_drv->usr_scan_req.scan_result = NULL;
870 }
871
872 return result;
873 }
874
875 u8 wilc_connected_ssid[6] = {0};
Handle_Connect(struct wilc_vif * vif,struct connect_attr * pstrHostIFconnectAttr)876 static s32 Handle_Connect(struct wilc_vif *vif,
877 struct connect_attr *pstrHostIFconnectAttr)
878 {
879 s32 result = 0;
880 struct wid strWIDList[8];
881 u32 u32WidsCount = 0, dummyval = 0;
882 u8 *pu8CurrByte = NULL;
883 struct join_bss_param *ptstrJoinBssParam;
884 struct host_if_drv *hif_drv = vif->hif_drv;
885
886 if (memcmp(pstrHostIFconnectAttr->bssid, wilc_connected_ssid, ETH_ALEN) == 0) {
887 result = 0;
888 netdev_err(vif->ndev, "Discard connect request\n");
889 return result;
890 }
891
892 ptstrJoinBssParam = pstrHostIFconnectAttr->params;
893 if (!ptstrJoinBssParam) {
894 netdev_err(vif->ndev, "Required BSSID not found\n");
895 result = -ENOENT;
896 goto ERRORHANDLER;
897 }
898
899 if (pstrHostIFconnectAttr->bssid) {
900 hif_drv->usr_conn_req.bssid = kmalloc(6, GFP_KERNEL);
901 memcpy(hif_drv->usr_conn_req.bssid, pstrHostIFconnectAttr->bssid, 6);
902 }
903
904 hif_drv->usr_conn_req.ssid_len = pstrHostIFconnectAttr->ssid_len;
905 if (pstrHostIFconnectAttr->ssid) {
906 hif_drv->usr_conn_req.ssid = kmalloc(pstrHostIFconnectAttr->ssid_len + 1, GFP_KERNEL);
907 memcpy(hif_drv->usr_conn_req.ssid,
908 pstrHostIFconnectAttr->ssid,
909 pstrHostIFconnectAttr->ssid_len);
910 hif_drv->usr_conn_req.ssid[pstrHostIFconnectAttr->ssid_len] = '\0';
911 }
912
913 hif_drv->usr_conn_req.ies_len = pstrHostIFconnectAttr->ies_len;
914 if (pstrHostIFconnectAttr->ies) {
915 hif_drv->usr_conn_req.ies = kmalloc(pstrHostIFconnectAttr->ies_len, GFP_KERNEL);
916 memcpy(hif_drv->usr_conn_req.ies,
917 pstrHostIFconnectAttr->ies,
918 pstrHostIFconnectAttr->ies_len);
919 }
920
921 hif_drv->usr_conn_req.security = pstrHostIFconnectAttr->security;
922 hif_drv->usr_conn_req.auth_type = pstrHostIFconnectAttr->auth_type;
923 hif_drv->usr_conn_req.conn_result = pstrHostIFconnectAttr->result;
924 hif_drv->usr_conn_req.arg = pstrHostIFconnectAttr->arg;
925
926 strWIDList[u32WidsCount].id = WID_SUCCESS_FRAME_COUNT;
927 strWIDList[u32WidsCount].type = WID_INT;
928 strWIDList[u32WidsCount].size = sizeof(u32);
929 strWIDList[u32WidsCount].val = (s8 *)(&(dummyval));
930 u32WidsCount++;
931
932 strWIDList[u32WidsCount].id = WID_RECEIVED_FRAGMENT_COUNT;
933 strWIDList[u32WidsCount].type = WID_INT;
934 strWIDList[u32WidsCount].size = sizeof(u32);
935 strWIDList[u32WidsCount].val = (s8 *)(&(dummyval));
936 u32WidsCount++;
937
938 strWIDList[u32WidsCount].id = WID_FAILED_COUNT;
939 strWIDList[u32WidsCount].type = WID_INT;
940 strWIDList[u32WidsCount].size = sizeof(u32);
941 strWIDList[u32WidsCount].val = (s8 *)(&(dummyval));
942 u32WidsCount++;
943
944 {
945 strWIDList[u32WidsCount].id = WID_INFO_ELEMENT_ASSOCIATE;
946 strWIDList[u32WidsCount].type = WID_BIN_DATA;
947 strWIDList[u32WidsCount].val = hif_drv->usr_conn_req.ies;
948 strWIDList[u32WidsCount].size = hif_drv->usr_conn_req.ies_len;
949 u32WidsCount++;
950
951 if (memcmp("DIRECT-", pstrHostIFconnectAttr->ssid, 7)) {
952 info_element_size = hif_drv->usr_conn_req.ies_len;
953 info_element = kmalloc(info_element_size, GFP_KERNEL);
954 memcpy(info_element, hif_drv->usr_conn_req.ies,
955 info_element_size);
956 }
957 }
958 strWIDList[u32WidsCount].id = (u16)WID_11I_MODE;
959 strWIDList[u32WidsCount].type = WID_CHAR;
960 strWIDList[u32WidsCount].size = sizeof(char);
961 strWIDList[u32WidsCount].val = (s8 *)&hif_drv->usr_conn_req.security;
962 u32WidsCount++;
963
964 if (memcmp("DIRECT-", pstrHostIFconnectAttr->ssid, 7))
965 mode_11i = hif_drv->usr_conn_req.security;
966
967 strWIDList[u32WidsCount].id = (u16)WID_AUTH_TYPE;
968 strWIDList[u32WidsCount].type = WID_CHAR;
969 strWIDList[u32WidsCount].size = sizeof(char);
970 strWIDList[u32WidsCount].val = (s8 *)&hif_drv->usr_conn_req.auth_type;
971 u32WidsCount++;
972
973 if (memcmp("DIRECT-", pstrHostIFconnectAttr->ssid, 7))
974 auth_type = (u8)hif_drv->usr_conn_req.auth_type;
975
976 strWIDList[u32WidsCount].id = (u16)WID_JOIN_REQ_EXTENDED;
977 strWIDList[u32WidsCount].type = WID_STR;
978 strWIDList[u32WidsCount].size = 112;
979 strWIDList[u32WidsCount].val = kmalloc(strWIDList[u32WidsCount].size, GFP_KERNEL);
980
981 if (memcmp("DIRECT-", pstrHostIFconnectAttr->ssid, 7)) {
982 join_req_size = strWIDList[u32WidsCount].size;
983 join_req = kmalloc(join_req_size, GFP_KERNEL);
984 }
985 if (!strWIDList[u32WidsCount].val) {
986 result = -EFAULT;
987 goto ERRORHANDLER;
988 }
989
990 pu8CurrByte = strWIDList[u32WidsCount].val;
991
992 if (pstrHostIFconnectAttr->ssid) {
993 memcpy(pu8CurrByte, pstrHostIFconnectAttr->ssid, pstrHostIFconnectAttr->ssid_len);
994 pu8CurrByte[pstrHostIFconnectAttr->ssid_len] = '\0';
995 }
996 pu8CurrByte += MAX_SSID_LEN;
997 *(pu8CurrByte++) = INFRASTRUCTURE;
998
999 if ((pstrHostIFconnectAttr->ch >= 1) && (pstrHostIFconnectAttr->ch <= 14)) {
1000 *(pu8CurrByte++) = pstrHostIFconnectAttr->ch;
1001 } else {
1002 netdev_err(vif->ndev, "Channel out of range\n");
1003 *(pu8CurrByte++) = 0xFF;
1004 }
1005 *(pu8CurrByte++) = (ptstrJoinBssParam->cap_info) & 0xFF;
1006 *(pu8CurrByte++) = ((ptstrJoinBssParam->cap_info) >> 8) & 0xFF;
1007
1008 if (pstrHostIFconnectAttr->bssid)
1009 memcpy(pu8CurrByte, pstrHostIFconnectAttr->bssid, 6);
1010 pu8CurrByte += 6;
1011
1012 if (pstrHostIFconnectAttr->bssid)
1013 memcpy(pu8CurrByte, pstrHostIFconnectAttr->bssid, 6);
1014 pu8CurrByte += 6;
1015
1016 *(pu8CurrByte++) = (ptstrJoinBssParam->beacon_period) & 0xFF;
1017 *(pu8CurrByte++) = ((ptstrJoinBssParam->beacon_period) >> 8) & 0xFF;
1018 *(pu8CurrByte++) = ptstrJoinBssParam->dtim_period;
1019
1020 memcpy(pu8CurrByte, ptstrJoinBssParam->supp_rates, MAX_RATES_SUPPORTED + 1);
1021 pu8CurrByte += (MAX_RATES_SUPPORTED + 1);
1022
1023 *(pu8CurrByte++) = ptstrJoinBssParam->wmm_cap;
1024 *(pu8CurrByte++) = ptstrJoinBssParam->uapsd_cap;
1025
1026 *(pu8CurrByte++) = ptstrJoinBssParam->ht_capable;
1027 hif_drv->usr_conn_req.ht_capable = ptstrJoinBssParam->ht_capable;
1028
1029 *(pu8CurrByte++) = ptstrJoinBssParam->rsn_found;
1030 *(pu8CurrByte++) = ptstrJoinBssParam->rsn_grp_policy;
1031 *(pu8CurrByte++) = ptstrJoinBssParam->mode_802_11i;
1032
1033 memcpy(pu8CurrByte, ptstrJoinBssParam->rsn_pcip_policy, sizeof(ptstrJoinBssParam->rsn_pcip_policy));
1034 pu8CurrByte += sizeof(ptstrJoinBssParam->rsn_pcip_policy);
1035
1036 memcpy(pu8CurrByte, ptstrJoinBssParam->rsn_auth_policy, sizeof(ptstrJoinBssParam->rsn_auth_policy));
1037 pu8CurrByte += sizeof(ptstrJoinBssParam->rsn_auth_policy);
1038
1039 memcpy(pu8CurrByte, ptstrJoinBssParam->rsn_cap, sizeof(ptstrJoinBssParam->rsn_cap));
1040 pu8CurrByte += sizeof(ptstrJoinBssParam->rsn_cap);
1041
1042 *(pu8CurrByte++) = REAL_JOIN_REQ;
1043 *(pu8CurrByte++) = ptstrJoinBssParam->noa_enabled;
1044
1045 if (ptstrJoinBssParam->noa_enabled) {
1046 *(pu8CurrByte++) = (ptstrJoinBssParam->tsf) & 0xFF;
1047 *(pu8CurrByte++) = ((ptstrJoinBssParam->tsf) >> 8) & 0xFF;
1048 *(pu8CurrByte++) = ((ptstrJoinBssParam->tsf) >> 16) & 0xFF;
1049 *(pu8CurrByte++) = ((ptstrJoinBssParam->tsf) >> 24) & 0xFF;
1050
1051 *(pu8CurrByte++) = ptstrJoinBssParam->opp_enabled;
1052 *(pu8CurrByte++) = ptstrJoinBssParam->idx;
1053
1054 if (ptstrJoinBssParam->opp_enabled)
1055 *(pu8CurrByte++) = ptstrJoinBssParam->ct_window;
1056
1057 *(pu8CurrByte++) = ptstrJoinBssParam->cnt;
1058
1059 memcpy(pu8CurrByte, ptstrJoinBssParam->duration, sizeof(ptstrJoinBssParam->duration));
1060 pu8CurrByte += sizeof(ptstrJoinBssParam->duration);
1061
1062 memcpy(pu8CurrByte, ptstrJoinBssParam->interval, sizeof(ptstrJoinBssParam->interval));
1063 pu8CurrByte += sizeof(ptstrJoinBssParam->interval);
1064
1065 memcpy(pu8CurrByte, ptstrJoinBssParam->start_time, sizeof(ptstrJoinBssParam->start_time));
1066 pu8CurrByte += sizeof(ptstrJoinBssParam->start_time);
1067 }
1068
1069 pu8CurrByte = strWIDList[u32WidsCount].val;
1070 u32WidsCount++;
1071
1072 if (memcmp("DIRECT-", pstrHostIFconnectAttr->ssid, 7)) {
1073 memcpy(join_req, pu8CurrByte, join_req_size);
1074 join_req_vif = vif;
1075 }
1076
1077 if (pstrHostIFconnectAttr->bssid)
1078 memcpy(wilc_connected_ssid,
1079 pstrHostIFconnectAttr->bssid, ETH_ALEN);
1080
1081 result = wilc_send_config_pkt(vif, SET_CFG, strWIDList,
1082 u32WidsCount,
1083 wilc_get_vif_idx(vif));
1084 if (result) {
1085 netdev_err(vif->ndev, "failed to send config packet\n");
1086 result = -EFAULT;
1087 goto ERRORHANDLER;
1088 } else {
1089 hif_drv->hif_state = HOST_IF_WAITING_CONN_RESP;
1090 }
1091
1092 ERRORHANDLER:
1093 if (result) {
1094 struct connect_info strConnectInfo;
1095
1096 del_timer(&hif_drv->connect_timer);
1097
1098 memset(&strConnectInfo, 0, sizeof(struct connect_info));
1099
1100 if (pstrHostIFconnectAttr->result) {
1101 if (pstrHostIFconnectAttr->bssid)
1102 memcpy(strConnectInfo.bssid, pstrHostIFconnectAttr->bssid, 6);
1103
1104 if (pstrHostIFconnectAttr->ies) {
1105 strConnectInfo.req_ies_len = pstrHostIFconnectAttr->ies_len;
1106 strConnectInfo.req_ies = kmalloc(pstrHostIFconnectAttr->ies_len, GFP_KERNEL);
1107 memcpy(strConnectInfo.req_ies,
1108 pstrHostIFconnectAttr->ies,
1109 pstrHostIFconnectAttr->ies_len);
1110 }
1111
1112 pstrHostIFconnectAttr->result(CONN_DISCONN_EVENT_CONN_RESP,
1113 &strConnectInfo,
1114 MAC_DISCONNECTED,
1115 NULL,
1116 pstrHostIFconnectAttr->arg);
1117 hif_drv->hif_state = HOST_IF_IDLE;
1118 kfree(strConnectInfo.req_ies);
1119 strConnectInfo.req_ies = NULL;
1120
1121 } else {
1122 netdev_err(vif->ndev, "Connect callback is NULL\n");
1123 }
1124 }
1125
1126 kfree(pstrHostIFconnectAttr->bssid);
1127 pstrHostIFconnectAttr->bssid = NULL;
1128
1129 kfree(pstrHostIFconnectAttr->ssid);
1130 pstrHostIFconnectAttr->ssid = NULL;
1131
1132 kfree(pstrHostIFconnectAttr->ies);
1133 pstrHostIFconnectAttr->ies = NULL;
1134
1135 kfree(pu8CurrByte);
1136 return result;
1137 }
1138
Handle_ConnectTimeout(struct wilc_vif * vif)1139 static s32 Handle_ConnectTimeout(struct wilc_vif *vif)
1140 {
1141 s32 result = 0;
1142 struct connect_info strConnectInfo;
1143 struct wid wid;
1144 u16 u16DummyReasonCode = 0;
1145 struct host_if_drv *hif_drv = vif->hif_drv;
1146
1147 if (!hif_drv) {
1148 netdev_err(vif->ndev, "Driver handler is NULL\n");
1149 return result;
1150 }
1151
1152 hif_drv->hif_state = HOST_IF_IDLE;
1153
1154 scan_while_connected = false;
1155
1156 memset(&strConnectInfo, 0, sizeof(struct connect_info));
1157
1158 if (hif_drv->usr_conn_req.conn_result) {
1159 if (hif_drv->usr_conn_req.bssid) {
1160 memcpy(strConnectInfo.bssid,
1161 hif_drv->usr_conn_req.bssid, 6);
1162 }
1163
1164 if (hif_drv->usr_conn_req.ies) {
1165 strConnectInfo.req_ies_len = hif_drv->usr_conn_req.ies_len;
1166 strConnectInfo.req_ies = kmalloc(hif_drv->usr_conn_req.ies_len, GFP_KERNEL);
1167 memcpy(strConnectInfo.req_ies,
1168 hif_drv->usr_conn_req.ies,
1169 hif_drv->usr_conn_req.ies_len);
1170 }
1171
1172 hif_drv->usr_conn_req.conn_result(CONN_DISCONN_EVENT_CONN_RESP,
1173 &strConnectInfo,
1174 MAC_DISCONNECTED,
1175 NULL,
1176 hif_drv->usr_conn_req.arg);
1177
1178 kfree(strConnectInfo.req_ies);
1179 strConnectInfo.req_ies = NULL;
1180 } else {
1181 netdev_err(vif->ndev, "Connect callback is NULL\n");
1182 }
1183
1184 wid.id = (u16)WID_DISCONNECT;
1185 wid.type = WID_CHAR;
1186 wid.val = (s8 *)&u16DummyReasonCode;
1187 wid.size = sizeof(char);
1188
1189 result = wilc_send_config_pkt(vif, SET_CFG, &wid, 1,
1190 wilc_get_vif_idx(vif));
1191 if (result)
1192 netdev_err(vif->ndev, "Failed to send dissconect\n");
1193
1194 hif_drv->usr_conn_req.ssid_len = 0;
1195 kfree(hif_drv->usr_conn_req.ssid);
1196 hif_drv->usr_conn_req.ssid = NULL;
1197 kfree(hif_drv->usr_conn_req.bssid);
1198 hif_drv->usr_conn_req.bssid = NULL;
1199 hif_drv->usr_conn_req.ies_len = 0;
1200 kfree(hif_drv->usr_conn_req.ies);
1201 hif_drv->usr_conn_req.ies = NULL;
1202
1203 eth_zero_addr(wilc_connected_ssid);
1204
1205 if (join_req && join_req_vif == vif) {
1206 kfree(join_req);
1207 join_req = NULL;
1208 }
1209
1210 if (info_element && join_req_vif == vif) {
1211 kfree(info_element);
1212 info_element = NULL;
1213 }
1214
1215 return result;
1216 }
1217
Handle_RcvdNtwrkInfo(struct wilc_vif * vif,struct rcvd_net_info * pstrRcvdNetworkInfo)1218 static s32 Handle_RcvdNtwrkInfo(struct wilc_vif *vif,
1219 struct rcvd_net_info *pstrRcvdNetworkInfo)
1220 {
1221 u32 i;
1222 bool bNewNtwrkFound;
1223 s32 result = 0;
1224 struct network_info *pstrNetworkInfo = NULL;
1225 void *pJoinParams = NULL;
1226 struct host_if_drv *hif_drv = vif->hif_drv;
1227
1228 bNewNtwrkFound = true;
1229
1230 if (hif_drv->usr_scan_req.scan_result) {
1231 wilc_parse_network_info(pstrRcvdNetworkInfo->buffer, &pstrNetworkInfo);
1232 if ((!pstrNetworkInfo) ||
1233 (!hif_drv->usr_scan_req.scan_result)) {
1234 netdev_err(vif->ndev, "driver is null\n");
1235 result = -EINVAL;
1236 goto done;
1237 }
1238
1239 for (i = 0; i < hif_drv->usr_scan_req.rcvd_ch_cnt; i++) {
1240 if (memcmp(hif_drv->usr_scan_req.net_info[i].bssid,
1241 pstrNetworkInfo->bssid, 6) == 0) {
1242 if (pstrNetworkInfo->rssi <= hif_drv->usr_scan_req.net_info[i].rssi) {
1243 goto done;
1244 } else {
1245 hif_drv->usr_scan_req.net_info[i].rssi = pstrNetworkInfo->rssi;
1246 bNewNtwrkFound = false;
1247 break;
1248 }
1249 }
1250 }
1251
1252 if (bNewNtwrkFound) {
1253 if (hif_drv->usr_scan_req.rcvd_ch_cnt < MAX_NUM_SCANNED_NETWORKS) {
1254 hif_drv->usr_scan_req.net_info[hif_drv->usr_scan_req.rcvd_ch_cnt].rssi = pstrNetworkInfo->rssi;
1255
1256 memcpy(hif_drv->usr_scan_req.net_info[hif_drv->usr_scan_req.rcvd_ch_cnt].bssid,
1257 pstrNetworkInfo->bssid, 6);
1258
1259 hif_drv->usr_scan_req.rcvd_ch_cnt++;
1260
1261 pstrNetworkInfo->new_network = true;
1262 pJoinParams = host_int_ParseJoinBssParam(pstrNetworkInfo);
1263
1264 hif_drv->usr_scan_req.scan_result(SCAN_EVENT_NETWORK_FOUND, pstrNetworkInfo,
1265 hif_drv->usr_scan_req.arg,
1266 pJoinParams);
1267 }
1268 } else {
1269 pstrNetworkInfo->new_network = false;
1270 hif_drv->usr_scan_req.scan_result(SCAN_EVENT_NETWORK_FOUND, pstrNetworkInfo,
1271 hif_drv->usr_scan_req.arg, NULL);
1272 }
1273 }
1274
1275 done:
1276 kfree(pstrRcvdNetworkInfo->buffer);
1277 pstrRcvdNetworkInfo->buffer = NULL;
1278
1279 if (pstrNetworkInfo) {
1280 kfree(pstrNetworkInfo->ies);
1281 kfree(pstrNetworkInfo);
1282 }
1283
1284 return result;
1285 }
1286
1287 static s32 host_int_get_assoc_res_info(struct wilc_vif *vif,
1288 u8 *pu8AssocRespInfo,
1289 u32 u32MaxAssocRespInfoLen,
1290 u32 *pu32RcvdAssocRespInfoLen);
1291
Handle_RcvdGnrlAsyncInfo(struct wilc_vif * vif,struct rcvd_async_info * pstrRcvdGnrlAsyncInfo)1292 static s32 Handle_RcvdGnrlAsyncInfo(struct wilc_vif *vif,
1293 struct rcvd_async_info *pstrRcvdGnrlAsyncInfo)
1294 {
1295 s32 result = 0;
1296 u8 u8MsgType = 0;
1297 u8 u8MsgID = 0;
1298 u16 u16MsgLen = 0;
1299 u16 u16WidID = (u16)WID_NIL;
1300 u8 u8WidLen = 0;
1301 u8 u8MacStatus;
1302 u8 u8MacStatusReasonCode;
1303 u8 u8MacStatusAdditionalInfo;
1304 struct connect_info strConnectInfo;
1305 struct disconnect_info strDisconnectNotifInfo;
1306 s32 s32Err = 0;
1307 struct host_if_drv *hif_drv = vif->hif_drv;
1308
1309 if (!hif_drv) {
1310 netdev_err(vif->ndev, "Driver handler is NULL\n");
1311 return -ENODEV;
1312 }
1313
1314 if ((hif_drv->hif_state == HOST_IF_WAITING_CONN_RESP) ||
1315 (hif_drv->hif_state == HOST_IF_CONNECTED) ||
1316 hif_drv->usr_scan_req.scan_result) {
1317 if (!pstrRcvdGnrlAsyncInfo->buffer ||
1318 !hif_drv->usr_conn_req.conn_result) {
1319 netdev_err(vif->ndev, "driver is null\n");
1320 return -EINVAL;
1321 }
1322
1323 u8MsgType = pstrRcvdGnrlAsyncInfo->buffer[0];
1324
1325 if ('I' != u8MsgType) {
1326 netdev_err(vif->ndev, "Received Message incorrect.\n");
1327 return -EFAULT;
1328 }
1329
1330 u8MsgID = pstrRcvdGnrlAsyncInfo->buffer[1];
1331 u16MsgLen = MAKE_WORD16(pstrRcvdGnrlAsyncInfo->buffer[2], pstrRcvdGnrlAsyncInfo->buffer[3]);
1332 u16WidID = MAKE_WORD16(pstrRcvdGnrlAsyncInfo->buffer[4], pstrRcvdGnrlAsyncInfo->buffer[5]);
1333 u8WidLen = pstrRcvdGnrlAsyncInfo->buffer[6];
1334 u8MacStatus = pstrRcvdGnrlAsyncInfo->buffer[7];
1335 u8MacStatusReasonCode = pstrRcvdGnrlAsyncInfo->buffer[8];
1336 u8MacStatusAdditionalInfo = pstrRcvdGnrlAsyncInfo->buffer[9];
1337 if (hif_drv->hif_state == HOST_IF_WAITING_CONN_RESP) {
1338 u32 u32RcvdAssocRespInfoLen = 0;
1339 struct connect_resp_info *pstrConnectRespInfo = NULL;
1340
1341 memset(&strConnectInfo, 0, sizeof(struct connect_info));
1342
1343 if (u8MacStatus == MAC_CONNECTED) {
1344 memset(rcv_assoc_resp, 0, MAX_ASSOC_RESP_FRAME_SIZE);
1345
1346 host_int_get_assoc_res_info(vif,
1347 rcv_assoc_resp,
1348 MAX_ASSOC_RESP_FRAME_SIZE,
1349 &u32RcvdAssocRespInfoLen);
1350
1351 if (u32RcvdAssocRespInfoLen != 0) {
1352 s32Err = wilc_parse_assoc_resp_info(rcv_assoc_resp, u32RcvdAssocRespInfoLen,
1353 &pstrConnectRespInfo);
1354 if (s32Err) {
1355 netdev_err(vif->ndev, "wilc_parse_assoc_resp_info() returned error %d\n", s32Err);
1356 } else {
1357 strConnectInfo.status = pstrConnectRespInfo->status;
1358
1359 if (strConnectInfo.status == SUCCESSFUL_STATUSCODE) {
1360 if (pstrConnectRespInfo->ies) {
1361 strConnectInfo.resp_ies_len = pstrConnectRespInfo->ies_len;
1362 strConnectInfo.resp_ies = kmalloc(pstrConnectRespInfo->ies_len, GFP_KERNEL);
1363 memcpy(strConnectInfo.resp_ies, pstrConnectRespInfo->ies,
1364 pstrConnectRespInfo->ies_len);
1365 }
1366 }
1367
1368 if (pstrConnectRespInfo) {
1369 kfree(pstrConnectRespInfo->ies);
1370 kfree(pstrConnectRespInfo);
1371 }
1372 }
1373 }
1374 }
1375
1376 if ((u8MacStatus == MAC_CONNECTED) &&
1377 (strConnectInfo.status != SUCCESSFUL_STATUSCODE)) {
1378 netdev_err(vif->ndev, "Received MAC status is MAC_CONNECTED while the received status code in Asoc Resp is not SUCCESSFUL_STATUSCODE\n");
1379 eth_zero_addr(wilc_connected_ssid);
1380 } else if (u8MacStatus == MAC_DISCONNECTED) {
1381 netdev_err(vif->ndev, "Received MAC status is MAC_DISCONNECTED\n");
1382 eth_zero_addr(wilc_connected_ssid);
1383 }
1384
1385 if (hif_drv->usr_conn_req.bssid) {
1386 memcpy(strConnectInfo.bssid, hif_drv->usr_conn_req.bssid, 6);
1387
1388 if ((u8MacStatus == MAC_CONNECTED) &&
1389 (strConnectInfo.status == SUCCESSFUL_STATUSCODE)) {
1390 memcpy(hif_drv->assoc_bssid,
1391 hif_drv->usr_conn_req.bssid, ETH_ALEN);
1392 }
1393 }
1394
1395 if (hif_drv->usr_conn_req.ies) {
1396 strConnectInfo.req_ies_len = hif_drv->usr_conn_req.ies_len;
1397 strConnectInfo.req_ies = kmalloc(hif_drv->usr_conn_req.ies_len, GFP_KERNEL);
1398 memcpy(strConnectInfo.req_ies,
1399 hif_drv->usr_conn_req.ies,
1400 hif_drv->usr_conn_req.ies_len);
1401 }
1402
1403 del_timer(&hif_drv->connect_timer);
1404 hif_drv->usr_conn_req.conn_result(CONN_DISCONN_EVENT_CONN_RESP,
1405 &strConnectInfo,
1406 u8MacStatus,
1407 NULL,
1408 hif_drv->usr_conn_req.arg);
1409
1410 if ((u8MacStatus == MAC_CONNECTED) &&
1411 (strConnectInfo.status == SUCCESSFUL_STATUSCODE)) {
1412 wilc_set_power_mgmt(vif, 0, 0);
1413
1414 hif_drv->hif_state = HOST_IF_CONNECTED;
1415
1416 wilc_optaining_ip = true;
1417 mod_timer(&wilc_during_ip_timer,
1418 jiffies + msecs_to_jiffies(10000));
1419 } else {
1420 hif_drv->hif_state = HOST_IF_IDLE;
1421 scan_while_connected = false;
1422 }
1423
1424 kfree(strConnectInfo.resp_ies);
1425 strConnectInfo.resp_ies = NULL;
1426
1427 kfree(strConnectInfo.req_ies);
1428 strConnectInfo.req_ies = NULL;
1429 hif_drv->usr_conn_req.ssid_len = 0;
1430 kfree(hif_drv->usr_conn_req.ssid);
1431 hif_drv->usr_conn_req.ssid = NULL;
1432 kfree(hif_drv->usr_conn_req.bssid);
1433 hif_drv->usr_conn_req.bssid = NULL;
1434 hif_drv->usr_conn_req.ies_len = 0;
1435 kfree(hif_drv->usr_conn_req.ies);
1436 hif_drv->usr_conn_req.ies = NULL;
1437 } else if ((u8MacStatus == MAC_DISCONNECTED) &&
1438 (hif_drv->hif_state == HOST_IF_CONNECTED)) {
1439 memset(&strDisconnectNotifInfo, 0, sizeof(struct disconnect_info));
1440
1441 if (hif_drv->usr_scan_req.scan_result) {
1442 del_timer(&hif_drv->scan_timer);
1443 Handle_ScanDone(vif, SCAN_EVENT_ABORTED);
1444 }
1445
1446 strDisconnectNotifInfo.reason = 0;
1447 strDisconnectNotifInfo.ie = NULL;
1448 strDisconnectNotifInfo.ie_len = 0;
1449
1450 if (hif_drv->usr_conn_req.conn_result) {
1451 wilc_optaining_ip = false;
1452 wilc_set_power_mgmt(vif, 0, 0);
1453
1454 hif_drv->usr_conn_req.conn_result(CONN_DISCONN_EVENT_DISCONN_NOTIF,
1455 NULL,
1456 0,
1457 &strDisconnectNotifInfo,
1458 hif_drv->usr_conn_req.arg);
1459 } else {
1460 netdev_err(vif->ndev, "Connect result NULL\n");
1461 }
1462
1463 eth_zero_addr(hif_drv->assoc_bssid);
1464
1465 hif_drv->usr_conn_req.ssid_len = 0;
1466 kfree(hif_drv->usr_conn_req.ssid);
1467 hif_drv->usr_conn_req.ssid = NULL;
1468 kfree(hif_drv->usr_conn_req.bssid);
1469 hif_drv->usr_conn_req.bssid = NULL;
1470 hif_drv->usr_conn_req.ies_len = 0;
1471 kfree(hif_drv->usr_conn_req.ies);
1472 hif_drv->usr_conn_req.ies = NULL;
1473
1474 if (join_req && join_req_vif == vif) {
1475 kfree(join_req);
1476 join_req = NULL;
1477 }
1478
1479 if (info_element && join_req_vif == vif) {
1480 kfree(info_element);
1481 info_element = NULL;
1482 }
1483
1484 hif_drv->hif_state = HOST_IF_IDLE;
1485 scan_while_connected = false;
1486
1487 } else if ((u8MacStatus == MAC_DISCONNECTED) &&
1488 (hif_drv->usr_scan_req.scan_result)) {
1489 del_timer(&hif_drv->scan_timer);
1490 if (hif_drv->usr_scan_req.scan_result)
1491 Handle_ScanDone(vif, SCAN_EVENT_ABORTED);
1492 }
1493 }
1494
1495 kfree(pstrRcvdGnrlAsyncInfo->buffer);
1496 pstrRcvdGnrlAsyncInfo->buffer = NULL;
1497
1498 return result;
1499 }
1500
Handle_Key(struct wilc_vif * vif,struct key_attr * pstrHostIFkeyAttr)1501 static int Handle_Key(struct wilc_vif *vif,
1502 struct key_attr *pstrHostIFkeyAttr)
1503 {
1504 s32 result = 0;
1505 struct wid wid;
1506 struct wid strWIDList[5];
1507 u8 i;
1508 u8 *pu8keybuf;
1509 s8 s8idxarray[1];
1510 s8 ret = 0;
1511 struct host_if_drv *hif_drv = vif->hif_drv;
1512
1513 switch (pstrHostIFkeyAttr->type) {
1514 case WEP:
1515
1516 if (pstrHostIFkeyAttr->action & ADDKEY_AP) {
1517 strWIDList[0].id = (u16)WID_11I_MODE;
1518 strWIDList[0].type = WID_CHAR;
1519 strWIDList[0].size = sizeof(char);
1520 strWIDList[0].val = (s8 *)&pstrHostIFkeyAttr->attr.wep.mode;
1521
1522 strWIDList[1].id = WID_AUTH_TYPE;
1523 strWIDList[1].type = WID_CHAR;
1524 strWIDList[1].size = sizeof(char);
1525 strWIDList[1].val = (s8 *)&pstrHostIFkeyAttr->attr.wep.auth_type;
1526
1527 pu8keybuf = kmalloc(pstrHostIFkeyAttr->attr.wep.key_len + 2,
1528 GFP_KERNEL);
1529 if (!pu8keybuf)
1530 return -ENOMEM;
1531
1532 pu8keybuf[0] = pstrHostIFkeyAttr->attr.wep.index;
1533 pu8keybuf[1] = pstrHostIFkeyAttr->attr.wep.key_len;
1534
1535 memcpy(&pu8keybuf[2], pstrHostIFkeyAttr->attr.wep.key,
1536 pstrHostIFkeyAttr->attr.wep.key_len);
1537
1538 kfree(pstrHostIFkeyAttr->attr.wep.key);
1539
1540 strWIDList[2].id = (u16)WID_WEP_KEY_VALUE;
1541 strWIDList[2].type = WID_STR;
1542 strWIDList[2].size = pstrHostIFkeyAttr->attr.wep.key_len + 2;
1543 strWIDList[2].val = (s8 *)pu8keybuf;
1544
1545 result = wilc_send_config_pkt(vif, SET_CFG,
1546 strWIDList, 3,
1547 wilc_get_vif_idx(vif));
1548 kfree(pu8keybuf);
1549 } else if (pstrHostIFkeyAttr->action & ADDKEY) {
1550 pu8keybuf = kmalloc(pstrHostIFkeyAttr->attr.wep.key_len + 2, GFP_KERNEL);
1551 if (!pu8keybuf)
1552 return -ENOMEM;
1553 pu8keybuf[0] = pstrHostIFkeyAttr->attr.wep.index;
1554 memcpy(pu8keybuf + 1, &pstrHostIFkeyAttr->attr.wep.key_len, 1);
1555 memcpy(pu8keybuf + 2, pstrHostIFkeyAttr->attr.wep.key,
1556 pstrHostIFkeyAttr->attr.wep.key_len);
1557 kfree(pstrHostIFkeyAttr->attr.wep.key);
1558
1559 wid.id = (u16)WID_ADD_WEP_KEY;
1560 wid.type = WID_STR;
1561 wid.val = (s8 *)pu8keybuf;
1562 wid.size = pstrHostIFkeyAttr->attr.wep.key_len + 2;
1563
1564 result = wilc_send_config_pkt(vif, SET_CFG,
1565 &wid, 1,
1566 wilc_get_vif_idx(vif));
1567 kfree(pu8keybuf);
1568 } else if (pstrHostIFkeyAttr->action & REMOVEKEY) {
1569 wid.id = (u16)WID_REMOVE_WEP_KEY;
1570 wid.type = WID_STR;
1571
1572 s8idxarray[0] = (s8)pstrHostIFkeyAttr->attr.wep.index;
1573 wid.val = s8idxarray;
1574 wid.size = 1;
1575
1576 result = wilc_send_config_pkt(vif, SET_CFG,
1577 &wid, 1,
1578 wilc_get_vif_idx(vif));
1579 } else if (pstrHostIFkeyAttr->action & DEFAULTKEY) {
1580 wid.id = (u16)WID_KEY_ID;
1581 wid.type = WID_CHAR;
1582 wid.val = (s8 *)&pstrHostIFkeyAttr->attr.wep.index;
1583 wid.size = sizeof(char);
1584
1585 result = wilc_send_config_pkt(vif, SET_CFG,
1586 &wid, 1,
1587 wilc_get_vif_idx(vif));
1588 }
1589 complete(&hif_drv->comp_test_key_block);
1590 break;
1591
1592 case WPA_RX_GTK:
1593 if (pstrHostIFkeyAttr->action & ADDKEY_AP) {
1594 pu8keybuf = kzalloc(RX_MIC_KEY_MSG_LEN, GFP_KERNEL);
1595 if (!pu8keybuf) {
1596 ret = -ENOMEM;
1597 goto _WPARxGtk_end_case_;
1598 }
1599
1600 if (pstrHostIFkeyAttr->attr.wpa.seq)
1601 memcpy(pu8keybuf + 6, pstrHostIFkeyAttr->attr.wpa.seq, 8);
1602
1603 memcpy(pu8keybuf + 14, &pstrHostIFkeyAttr->attr.wpa.index, 1);
1604 memcpy(pu8keybuf + 15, &pstrHostIFkeyAttr->attr.wpa.key_len, 1);
1605 memcpy(pu8keybuf + 16, pstrHostIFkeyAttr->attr.wpa.key,
1606 pstrHostIFkeyAttr->attr.wpa.key_len);
1607
1608 strWIDList[0].id = (u16)WID_11I_MODE;
1609 strWIDList[0].type = WID_CHAR;
1610 strWIDList[0].size = sizeof(char);
1611 strWIDList[0].val = (s8 *)&pstrHostIFkeyAttr->attr.wpa.mode;
1612
1613 strWIDList[1].id = (u16)WID_ADD_RX_GTK;
1614 strWIDList[1].type = WID_STR;
1615 strWIDList[1].val = (s8 *)pu8keybuf;
1616 strWIDList[1].size = RX_MIC_KEY_MSG_LEN;
1617
1618 result = wilc_send_config_pkt(vif, SET_CFG,
1619 strWIDList, 2,
1620 wilc_get_vif_idx(vif));
1621
1622 kfree(pu8keybuf);
1623 complete(&hif_drv->comp_test_key_block);
1624 } else if (pstrHostIFkeyAttr->action & ADDKEY) {
1625 pu8keybuf = kzalloc(RX_MIC_KEY_MSG_LEN, GFP_KERNEL);
1626 if (!pu8keybuf) {
1627 ret = -ENOMEM;
1628 goto _WPARxGtk_end_case_;
1629 }
1630
1631 if (hif_drv->hif_state == HOST_IF_CONNECTED)
1632 memcpy(pu8keybuf, hif_drv->assoc_bssid, ETH_ALEN);
1633 else
1634 netdev_err(vif->ndev, "Couldn't handle\n");
1635
1636 memcpy(pu8keybuf + 6, pstrHostIFkeyAttr->attr.wpa.seq, 8);
1637 memcpy(pu8keybuf + 14, &pstrHostIFkeyAttr->attr.wpa.index, 1);
1638 memcpy(pu8keybuf + 15, &pstrHostIFkeyAttr->attr.wpa.key_len, 1);
1639 memcpy(pu8keybuf + 16, pstrHostIFkeyAttr->attr.wpa.key,
1640 pstrHostIFkeyAttr->attr.wpa.key_len);
1641
1642 wid.id = (u16)WID_ADD_RX_GTK;
1643 wid.type = WID_STR;
1644 wid.val = (s8 *)pu8keybuf;
1645 wid.size = RX_MIC_KEY_MSG_LEN;
1646
1647 result = wilc_send_config_pkt(vif, SET_CFG,
1648 &wid, 1,
1649 wilc_get_vif_idx(vif));
1650
1651 kfree(pu8keybuf);
1652 complete(&hif_drv->comp_test_key_block);
1653 }
1654 _WPARxGtk_end_case_:
1655 kfree(pstrHostIFkeyAttr->attr.wpa.key);
1656 kfree(pstrHostIFkeyAttr->attr.wpa.seq);
1657 if (ret)
1658 return ret;
1659
1660 break;
1661
1662 case WPA_PTK:
1663 if (pstrHostIFkeyAttr->action & ADDKEY_AP) {
1664 pu8keybuf = kmalloc(PTK_KEY_MSG_LEN + 1, GFP_KERNEL);
1665 if (!pu8keybuf) {
1666 ret = -ENOMEM;
1667 goto _WPAPtk_end_case_;
1668 }
1669
1670 memcpy(pu8keybuf, pstrHostIFkeyAttr->attr.wpa.mac_addr, 6);
1671 memcpy(pu8keybuf + 6, &pstrHostIFkeyAttr->attr.wpa.index, 1);
1672 memcpy(pu8keybuf + 7, &pstrHostIFkeyAttr->attr.wpa.key_len, 1);
1673 memcpy(pu8keybuf + 8, pstrHostIFkeyAttr->attr.wpa.key,
1674 pstrHostIFkeyAttr->attr.wpa.key_len);
1675
1676 strWIDList[0].id = (u16)WID_11I_MODE;
1677 strWIDList[0].type = WID_CHAR;
1678 strWIDList[0].size = sizeof(char);
1679 strWIDList[0].val = (s8 *)&pstrHostIFkeyAttr->attr.wpa.mode;
1680
1681 strWIDList[1].id = (u16)WID_ADD_PTK;
1682 strWIDList[1].type = WID_STR;
1683 strWIDList[1].val = (s8 *)pu8keybuf;
1684 strWIDList[1].size = PTK_KEY_MSG_LEN + 1;
1685
1686 result = wilc_send_config_pkt(vif, SET_CFG,
1687 strWIDList, 2,
1688 wilc_get_vif_idx(vif));
1689 kfree(pu8keybuf);
1690 complete(&hif_drv->comp_test_key_block);
1691 } else if (pstrHostIFkeyAttr->action & ADDKEY) {
1692 pu8keybuf = kmalloc(PTK_KEY_MSG_LEN, GFP_KERNEL);
1693 if (!pu8keybuf) {
1694 netdev_err(vif->ndev, "No buffer send PTK\n");
1695 ret = -ENOMEM;
1696 goto _WPAPtk_end_case_;
1697 }
1698
1699 memcpy(pu8keybuf, pstrHostIFkeyAttr->attr.wpa.mac_addr, 6);
1700 memcpy(pu8keybuf + 6, &pstrHostIFkeyAttr->attr.wpa.key_len, 1);
1701 memcpy(pu8keybuf + 7, pstrHostIFkeyAttr->attr.wpa.key,
1702 pstrHostIFkeyAttr->attr.wpa.key_len);
1703
1704 wid.id = (u16)WID_ADD_PTK;
1705 wid.type = WID_STR;
1706 wid.val = (s8 *)pu8keybuf;
1707 wid.size = PTK_KEY_MSG_LEN;
1708
1709 result = wilc_send_config_pkt(vif, SET_CFG,
1710 &wid, 1,
1711 wilc_get_vif_idx(vif));
1712 kfree(pu8keybuf);
1713 complete(&hif_drv->comp_test_key_block);
1714 }
1715
1716 _WPAPtk_end_case_:
1717 kfree(pstrHostIFkeyAttr->attr.wpa.key);
1718 if (ret)
1719 return ret;
1720
1721 break;
1722
1723 case PMKSA:
1724 pu8keybuf = kmalloc((pstrHostIFkeyAttr->attr.pmkid.numpmkid * PMKSA_KEY_LEN) + 1, GFP_KERNEL);
1725 if (!pu8keybuf) {
1726 netdev_err(vif->ndev, "No buffer to send PMKSA Key\n");
1727 return -ENOMEM;
1728 }
1729
1730 pu8keybuf[0] = pstrHostIFkeyAttr->attr.pmkid.numpmkid;
1731
1732 for (i = 0; i < pstrHostIFkeyAttr->attr.pmkid.numpmkid; i++) {
1733 memcpy(pu8keybuf + ((PMKSA_KEY_LEN * i) + 1), pstrHostIFkeyAttr->attr.pmkid.pmkidlist[i].bssid, ETH_ALEN);
1734 memcpy(pu8keybuf + ((PMKSA_KEY_LEN * i) + ETH_ALEN + 1), pstrHostIFkeyAttr->attr.pmkid.pmkidlist[i].pmkid, PMKID_LEN);
1735 }
1736
1737 wid.id = (u16)WID_PMKID_INFO;
1738 wid.type = WID_STR;
1739 wid.val = (s8 *)pu8keybuf;
1740 wid.size = (pstrHostIFkeyAttr->attr.pmkid.numpmkid * PMKSA_KEY_LEN) + 1;
1741
1742 result = wilc_send_config_pkt(vif, SET_CFG, &wid, 1,
1743 wilc_get_vif_idx(vif));
1744
1745 kfree(pu8keybuf);
1746 break;
1747 }
1748
1749 if (result)
1750 netdev_err(vif->ndev, "Failed to send key config packet\n");
1751
1752 return result;
1753 }
1754
Handle_Disconnect(struct wilc_vif * vif)1755 static void Handle_Disconnect(struct wilc_vif *vif)
1756 {
1757 struct wid wid;
1758 struct host_if_drv *hif_drv = vif->hif_drv;
1759
1760 s32 result = 0;
1761 u16 u16DummyReasonCode = 0;
1762
1763 wid.id = (u16)WID_DISCONNECT;
1764 wid.type = WID_CHAR;
1765 wid.val = (s8 *)&u16DummyReasonCode;
1766 wid.size = sizeof(char);
1767
1768 wilc_optaining_ip = false;
1769 wilc_set_power_mgmt(vif, 0, 0);
1770
1771 eth_zero_addr(wilc_connected_ssid);
1772
1773 result = wilc_send_config_pkt(vif, SET_CFG, &wid, 1,
1774 wilc_get_vif_idx(vif));
1775
1776 if (result) {
1777 netdev_err(vif->ndev, "Failed to send dissconect\n");
1778 } else {
1779 struct disconnect_info strDisconnectNotifInfo;
1780
1781 memset(&strDisconnectNotifInfo, 0, sizeof(struct disconnect_info));
1782
1783 strDisconnectNotifInfo.reason = 0;
1784 strDisconnectNotifInfo.ie = NULL;
1785 strDisconnectNotifInfo.ie_len = 0;
1786
1787 if (hif_drv->usr_scan_req.scan_result) {
1788 del_timer(&hif_drv->scan_timer);
1789 hif_drv->usr_scan_req.scan_result(SCAN_EVENT_ABORTED,
1790 NULL,
1791 hif_drv->usr_scan_req.arg,
1792 NULL);
1793 hif_drv->usr_scan_req.scan_result = NULL;
1794 }
1795
1796 if (hif_drv->usr_conn_req.conn_result) {
1797 if (hif_drv->hif_state == HOST_IF_WAITING_CONN_RESP)
1798 del_timer(&hif_drv->connect_timer);
1799
1800 hif_drv->usr_conn_req.conn_result(CONN_DISCONN_EVENT_DISCONN_NOTIF,
1801 NULL,
1802 0,
1803 &strDisconnectNotifInfo,
1804 hif_drv->usr_conn_req.arg);
1805 } else {
1806 netdev_err(vif->ndev, "conn_result = NULL\n");
1807 }
1808
1809 scan_while_connected = false;
1810
1811 hif_drv->hif_state = HOST_IF_IDLE;
1812
1813 eth_zero_addr(hif_drv->assoc_bssid);
1814
1815 hif_drv->usr_conn_req.ssid_len = 0;
1816 kfree(hif_drv->usr_conn_req.ssid);
1817 hif_drv->usr_conn_req.ssid = NULL;
1818 kfree(hif_drv->usr_conn_req.bssid);
1819 hif_drv->usr_conn_req.bssid = NULL;
1820 hif_drv->usr_conn_req.ies_len = 0;
1821 kfree(hif_drv->usr_conn_req.ies);
1822 hif_drv->usr_conn_req.ies = NULL;
1823
1824 if (join_req && join_req_vif == vif) {
1825 kfree(join_req);
1826 join_req = NULL;
1827 }
1828
1829 if (info_element && join_req_vif == vif) {
1830 kfree(info_element);
1831 info_element = NULL;
1832 }
1833 }
1834
1835 complete(&hif_drv->comp_test_disconn_block);
1836 }
1837
wilc_resolve_disconnect_aberration(struct wilc_vif * vif)1838 void wilc_resolve_disconnect_aberration(struct wilc_vif *vif)
1839 {
1840 if (!vif->hif_drv)
1841 return;
1842 if ((vif->hif_drv->hif_state == HOST_IF_WAITING_CONN_RESP) ||
1843 (vif->hif_drv->hif_state == HOST_IF_CONNECTING))
1844 wilc_disconnect(vif, 1);
1845 }
1846
Handle_GetRssi(struct wilc_vif * vif)1847 static void Handle_GetRssi(struct wilc_vif *vif)
1848 {
1849 s32 result = 0;
1850 struct wid wid;
1851
1852 wid.id = (u16)WID_RSSI;
1853 wid.type = WID_CHAR;
1854 wid.val = &rssi;
1855 wid.size = sizeof(char);
1856
1857 result = wilc_send_config_pkt(vif, GET_CFG, &wid, 1,
1858 wilc_get_vif_idx(vif));
1859 if (result) {
1860 netdev_err(vif->ndev, "Failed to get RSSI value\n");
1861 result = -EFAULT;
1862 }
1863
1864 complete(&vif->hif_drv->comp_get_rssi);
1865 }
1866
Handle_GetStatistics(struct wilc_vif * vif,struct rf_info * pstrStatistics)1867 static s32 Handle_GetStatistics(struct wilc_vif *vif,
1868 struct rf_info *pstrStatistics)
1869 {
1870 struct wid strWIDList[5];
1871 u32 u32WidsCount = 0, result = 0;
1872
1873 strWIDList[u32WidsCount].id = WID_LINKSPEED;
1874 strWIDList[u32WidsCount].type = WID_CHAR;
1875 strWIDList[u32WidsCount].size = sizeof(char);
1876 strWIDList[u32WidsCount].val = (s8 *)&pstrStatistics->link_speed;
1877 u32WidsCount++;
1878
1879 strWIDList[u32WidsCount].id = WID_RSSI;
1880 strWIDList[u32WidsCount].type = WID_CHAR;
1881 strWIDList[u32WidsCount].size = sizeof(char);
1882 strWIDList[u32WidsCount].val = (s8 *)&pstrStatistics->rssi;
1883 u32WidsCount++;
1884
1885 strWIDList[u32WidsCount].id = WID_SUCCESS_FRAME_COUNT;
1886 strWIDList[u32WidsCount].type = WID_INT;
1887 strWIDList[u32WidsCount].size = sizeof(u32);
1888 strWIDList[u32WidsCount].val = (s8 *)&pstrStatistics->tx_cnt;
1889 u32WidsCount++;
1890
1891 strWIDList[u32WidsCount].id = WID_RECEIVED_FRAGMENT_COUNT;
1892 strWIDList[u32WidsCount].type = WID_INT;
1893 strWIDList[u32WidsCount].size = sizeof(u32);
1894 strWIDList[u32WidsCount].val = (s8 *)&pstrStatistics->rx_cnt;
1895 u32WidsCount++;
1896
1897 strWIDList[u32WidsCount].id = WID_FAILED_COUNT;
1898 strWIDList[u32WidsCount].type = WID_INT;
1899 strWIDList[u32WidsCount].size = sizeof(u32);
1900 strWIDList[u32WidsCount].val = (s8 *)&pstrStatistics->tx_fail_cnt;
1901 u32WidsCount++;
1902
1903 result = wilc_send_config_pkt(vif, GET_CFG, strWIDList,
1904 u32WidsCount,
1905 wilc_get_vif_idx(vif));
1906
1907 if (result)
1908 netdev_err(vif->ndev, "Failed to send scan parameters\n");
1909
1910 if (pstrStatistics->link_speed > TCP_ACK_FILTER_LINK_SPEED_THRESH &&
1911 pstrStatistics->link_speed != DEFAULT_LINK_SPEED)
1912 wilc_enable_tcp_ack_filter(true);
1913 else if (pstrStatistics->link_speed != DEFAULT_LINK_SPEED)
1914 wilc_enable_tcp_ack_filter(false);
1915
1916 if (pstrStatistics != &vif->wilc->dummy_statistics)
1917 complete(&hif_wait_response);
1918 return 0;
1919 }
1920
Handle_Get_InActiveTime(struct wilc_vif * vif,struct sta_inactive_t * strHostIfStaInactiveT)1921 static s32 Handle_Get_InActiveTime(struct wilc_vif *vif,
1922 struct sta_inactive_t *strHostIfStaInactiveT)
1923 {
1924 s32 result = 0;
1925 u8 *stamac;
1926 struct wid wid;
1927 struct host_if_drv *hif_drv = vif->hif_drv;
1928
1929 wid.id = (u16)WID_SET_STA_MAC_INACTIVE_TIME;
1930 wid.type = WID_STR;
1931 wid.size = ETH_ALEN;
1932 wid.val = kmalloc(wid.size, GFP_KERNEL);
1933 if (!wid.val)
1934 return -ENOMEM;
1935
1936 stamac = wid.val;
1937 memcpy(stamac, strHostIfStaInactiveT->mac, ETH_ALEN);
1938
1939 result = wilc_send_config_pkt(vif, SET_CFG, &wid, 1,
1940 wilc_get_vif_idx(vif));
1941
1942 if (result) {
1943 netdev_err(vif->ndev, "Failed to SET incative time\n");
1944 return -EFAULT;
1945 }
1946
1947 wid.id = (u16)WID_GET_INACTIVE_TIME;
1948 wid.type = WID_INT;
1949 wid.val = (s8 *)&inactive_time;
1950 wid.size = sizeof(u32);
1951
1952 result = wilc_send_config_pkt(vif, GET_CFG, &wid, 1,
1953 wilc_get_vif_idx(vif));
1954
1955 if (result) {
1956 netdev_err(vif->ndev, "Failed to get incative time\n");
1957 return -EFAULT;
1958 }
1959
1960 complete(&hif_drv->comp_inactive_time);
1961
1962 return result;
1963 }
1964
Handle_AddBeacon(struct wilc_vif * vif,struct beacon_attr * pstrSetBeaconParam)1965 static void Handle_AddBeacon(struct wilc_vif *vif,
1966 struct beacon_attr *pstrSetBeaconParam)
1967 {
1968 s32 result = 0;
1969 struct wid wid;
1970 u8 *pu8CurrByte;
1971
1972 wid.id = (u16)WID_ADD_BEACON;
1973 wid.type = WID_BIN;
1974 wid.size = pstrSetBeaconParam->head_len + pstrSetBeaconParam->tail_len + 16;
1975 wid.val = kmalloc(wid.size, GFP_KERNEL);
1976 if (!wid.val)
1977 goto ERRORHANDLER;
1978
1979 pu8CurrByte = wid.val;
1980 *pu8CurrByte++ = (pstrSetBeaconParam->interval & 0xFF);
1981 *pu8CurrByte++ = ((pstrSetBeaconParam->interval >> 8) & 0xFF);
1982 *pu8CurrByte++ = ((pstrSetBeaconParam->interval >> 16) & 0xFF);
1983 *pu8CurrByte++ = ((pstrSetBeaconParam->interval >> 24) & 0xFF);
1984
1985 *pu8CurrByte++ = (pstrSetBeaconParam->dtim_period & 0xFF);
1986 *pu8CurrByte++ = ((pstrSetBeaconParam->dtim_period >> 8) & 0xFF);
1987 *pu8CurrByte++ = ((pstrSetBeaconParam->dtim_period >> 16) & 0xFF);
1988 *pu8CurrByte++ = ((pstrSetBeaconParam->dtim_period >> 24) & 0xFF);
1989
1990 *pu8CurrByte++ = (pstrSetBeaconParam->head_len & 0xFF);
1991 *pu8CurrByte++ = ((pstrSetBeaconParam->head_len >> 8) & 0xFF);
1992 *pu8CurrByte++ = ((pstrSetBeaconParam->head_len >> 16) & 0xFF);
1993 *pu8CurrByte++ = ((pstrSetBeaconParam->head_len >> 24) & 0xFF);
1994
1995 memcpy(pu8CurrByte, pstrSetBeaconParam->head, pstrSetBeaconParam->head_len);
1996 pu8CurrByte += pstrSetBeaconParam->head_len;
1997
1998 *pu8CurrByte++ = (pstrSetBeaconParam->tail_len & 0xFF);
1999 *pu8CurrByte++ = ((pstrSetBeaconParam->tail_len >> 8) & 0xFF);
2000 *pu8CurrByte++ = ((pstrSetBeaconParam->tail_len >> 16) & 0xFF);
2001 *pu8CurrByte++ = ((pstrSetBeaconParam->tail_len >> 24) & 0xFF);
2002
2003 if (pstrSetBeaconParam->tail)
2004 memcpy(pu8CurrByte, pstrSetBeaconParam->tail, pstrSetBeaconParam->tail_len);
2005 pu8CurrByte += pstrSetBeaconParam->tail_len;
2006
2007 result = wilc_send_config_pkt(vif, SET_CFG, &wid, 1,
2008 wilc_get_vif_idx(vif));
2009 if (result)
2010 netdev_err(vif->ndev, "Failed to send add beacon\n");
2011
2012 ERRORHANDLER:
2013 kfree(wid.val);
2014 kfree(pstrSetBeaconParam->head);
2015 kfree(pstrSetBeaconParam->tail);
2016 }
2017
Handle_DelBeacon(struct wilc_vif * vif)2018 static void Handle_DelBeacon(struct wilc_vif *vif)
2019 {
2020 s32 result = 0;
2021 struct wid wid;
2022 u8 *pu8CurrByte;
2023
2024 wid.id = (u16)WID_DEL_BEACON;
2025 wid.type = WID_CHAR;
2026 wid.size = sizeof(char);
2027 wid.val = &del_beacon;
2028
2029 if (!wid.val)
2030 return;
2031
2032 pu8CurrByte = wid.val;
2033
2034 result = wilc_send_config_pkt(vif, SET_CFG, &wid, 1,
2035 wilc_get_vif_idx(vif));
2036 if (result)
2037 netdev_err(vif->ndev, "Failed to send delete beacon\n");
2038 }
2039
WILC_HostIf_PackStaParam(u8 * pu8Buffer,struct add_sta_param * pstrStationParam)2040 static u32 WILC_HostIf_PackStaParam(u8 *pu8Buffer,
2041 struct add_sta_param *pstrStationParam)
2042 {
2043 u8 *pu8CurrByte;
2044
2045 pu8CurrByte = pu8Buffer;
2046
2047 memcpy(pu8CurrByte, pstrStationParam->bssid, ETH_ALEN);
2048 pu8CurrByte += ETH_ALEN;
2049
2050 *pu8CurrByte++ = pstrStationParam->aid & 0xFF;
2051 *pu8CurrByte++ = (pstrStationParam->aid >> 8) & 0xFF;
2052
2053 *pu8CurrByte++ = pstrStationParam->rates_len;
2054 if (pstrStationParam->rates_len > 0)
2055 memcpy(pu8CurrByte, pstrStationParam->rates,
2056 pstrStationParam->rates_len);
2057 pu8CurrByte += pstrStationParam->rates_len;
2058
2059 *pu8CurrByte++ = pstrStationParam->ht_supported;
2060 *pu8CurrByte++ = pstrStationParam->ht_capa_info & 0xFF;
2061 *pu8CurrByte++ = (pstrStationParam->ht_capa_info >> 8) & 0xFF;
2062
2063 *pu8CurrByte++ = pstrStationParam->ht_ampdu_params;
2064 memcpy(pu8CurrByte, pstrStationParam->ht_supp_mcs_set,
2065 WILC_SUPP_MCS_SET_SIZE);
2066 pu8CurrByte += WILC_SUPP_MCS_SET_SIZE;
2067
2068 *pu8CurrByte++ = pstrStationParam->ht_ext_params & 0xFF;
2069 *pu8CurrByte++ = (pstrStationParam->ht_ext_params >> 8) & 0xFF;
2070
2071 *pu8CurrByte++ = pstrStationParam->ht_tx_bf_cap & 0xFF;
2072 *pu8CurrByte++ = (pstrStationParam->ht_tx_bf_cap >> 8) & 0xFF;
2073 *pu8CurrByte++ = (pstrStationParam->ht_tx_bf_cap >> 16) & 0xFF;
2074 *pu8CurrByte++ = (pstrStationParam->ht_tx_bf_cap >> 24) & 0xFF;
2075
2076 *pu8CurrByte++ = pstrStationParam->ht_ante_sel;
2077
2078 *pu8CurrByte++ = pstrStationParam->flags_mask & 0xFF;
2079 *pu8CurrByte++ = (pstrStationParam->flags_mask >> 8) & 0xFF;
2080
2081 *pu8CurrByte++ = pstrStationParam->flags_set & 0xFF;
2082 *pu8CurrByte++ = (pstrStationParam->flags_set >> 8) & 0xFF;
2083
2084 return pu8CurrByte - pu8Buffer;
2085 }
2086
Handle_AddStation(struct wilc_vif * vif,struct add_sta_param * pstrStationParam)2087 static void Handle_AddStation(struct wilc_vif *vif,
2088 struct add_sta_param *pstrStationParam)
2089 {
2090 s32 result = 0;
2091 struct wid wid;
2092 u8 *pu8CurrByte;
2093
2094 wid.id = (u16)WID_ADD_STA;
2095 wid.type = WID_BIN;
2096 wid.size = WILC_ADD_STA_LENGTH + pstrStationParam->rates_len;
2097
2098 wid.val = kmalloc(wid.size, GFP_KERNEL);
2099 if (!wid.val)
2100 goto ERRORHANDLER;
2101
2102 pu8CurrByte = wid.val;
2103 pu8CurrByte += WILC_HostIf_PackStaParam(pu8CurrByte, pstrStationParam);
2104
2105 result = wilc_send_config_pkt(vif, SET_CFG, &wid, 1,
2106 wilc_get_vif_idx(vif));
2107 if (result != 0)
2108 netdev_err(vif->ndev, "Failed to send add station\n");
2109
2110 ERRORHANDLER:
2111 kfree(pstrStationParam->rates);
2112 kfree(wid.val);
2113 }
2114
Handle_DelAllSta(struct wilc_vif * vif,struct del_all_sta * pstrDelAllStaParam)2115 static void Handle_DelAllSta(struct wilc_vif *vif,
2116 struct del_all_sta *pstrDelAllStaParam)
2117 {
2118 s32 result = 0;
2119 struct wid wid;
2120 u8 *pu8CurrByte;
2121 u8 i;
2122 u8 au8Zero_Buff[6] = {0};
2123
2124 wid.id = (u16)WID_DEL_ALL_STA;
2125 wid.type = WID_STR;
2126 wid.size = (pstrDelAllStaParam->assoc_sta * ETH_ALEN) + 1;
2127
2128 wid.val = kmalloc((pstrDelAllStaParam->assoc_sta * ETH_ALEN) + 1, GFP_KERNEL);
2129 if (!wid.val)
2130 goto ERRORHANDLER;
2131
2132 pu8CurrByte = wid.val;
2133
2134 *(pu8CurrByte++) = pstrDelAllStaParam->assoc_sta;
2135
2136 for (i = 0; i < MAX_NUM_STA; i++) {
2137 if (memcmp(pstrDelAllStaParam->del_all_sta[i], au8Zero_Buff, ETH_ALEN))
2138 memcpy(pu8CurrByte, pstrDelAllStaParam->del_all_sta[i], ETH_ALEN);
2139 else
2140 continue;
2141
2142 pu8CurrByte += ETH_ALEN;
2143 }
2144
2145 result = wilc_send_config_pkt(vif, SET_CFG, &wid, 1,
2146 wilc_get_vif_idx(vif));
2147 if (result)
2148 netdev_err(vif->ndev, "Failed to send add station\n");
2149
2150 ERRORHANDLER:
2151 kfree(wid.val);
2152
2153 complete(&hif_wait_response);
2154 }
2155
Handle_DelStation(struct wilc_vif * vif,struct del_sta * pstrDelStaParam)2156 static void Handle_DelStation(struct wilc_vif *vif,
2157 struct del_sta *pstrDelStaParam)
2158 {
2159 s32 result = 0;
2160 struct wid wid;
2161 u8 *pu8CurrByte;
2162
2163 wid.id = (u16)WID_REMOVE_STA;
2164 wid.type = WID_BIN;
2165 wid.size = ETH_ALEN;
2166
2167 wid.val = kmalloc(wid.size, GFP_KERNEL);
2168 if (!wid.val)
2169 goto ERRORHANDLER;
2170
2171 pu8CurrByte = wid.val;
2172
2173 memcpy(pu8CurrByte, pstrDelStaParam->mac_addr, ETH_ALEN);
2174
2175 result = wilc_send_config_pkt(vif, SET_CFG, &wid, 1,
2176 wilc_get_vif_idx(vif));
2177 if (result)
2178 netdev_err(vif->ndev, "Failed to send add station\n");
2179
2180 ERRORHANDLER:
2181 kfree(wid.val);
2182 }
2183
Handle_EditStation(struct wilc_vif * vif,struct add_sta_param * pstrStationParam)2184 static void Handle_EditStation(struct wilc_vif *vif,
2185 struct add_sta_param *pstrStationParam)
2186 {
2187 s32 result = 0;
2188 struct wid wid;
2189 u8 *pu8CurrByte;
2190
2191 wid.id = (u16)WID_EDIT_STA;
2192 wid.type = WID_BIN;
2193 wid.size = WILC_ADD_STA_LENGTH + pstrStationParam->rates_len;
2194
2195 wid.val = kmalloc(wid.size, GFP_KERNEL);
2196 if (!wid.val)
2197 goto ERRORHANDLER;
2198
2199 pu8CurrByte = wid.val;
2200 pu8CurrByte += WILC_HostIf_PackStaParam(pu8CurrByte, pstrStationParam);
2201
2202 result = wilc_send_config_pkt(vif, SET_CFG, &wid, 1,
2203 wilc_get_vif_idx(vif));
2204 if (result)
2205 netdev_err(vif->ndev, "Failed to send edit station\n");
2206
2207 ERRORHANDLER:
2208 kfree(pstrStationParam->rates);
2209 kfree(wid.val);
2210 }
2211
Handle_RemainOnChan(struct wilc_vif * vif,struct remain_ch * pstrHostIfRemainOnChan)2212 static int Handle_RemainOnChan(struct wilc_vif *vif,
2213 struct remain_ch *pstrHostIfRemainOnChan)
2214 {
2215 s32 result = 0;
2216 u8 u8remain_on_chan_flag;
2217 struct wid wid;
2218 struct host_if_drv *hif_drv = vif->hif_drv;
2219
2220 if (!hif_drv->remain_on_ch_pending) {
2221 hif_drv->remain_on_ch.arg = pstrHostIfRemainOnChan->arg;
2222 hif_drv->remain_on_ch.expired = pstrHostIfRemainOnChan->expired;
2223 hif_drv->remain_on_ch.ready = pstrHostIfRemainOnChan->ready;
2224 hif_drv->remain_on_ch.ch = pstrHostIfRemainOnChan->ch;
2225 hif_drv->remain_on_ch.id = pstrHostIfRemainOnChan->id;
2226 } else {
2227 pstrHostIfRemainOnChan->ch = hif_drv->remain_on_ch.ch;
2228 }
2229
2230 if (hif_drv->usr_scan_req.scan_result) {
2231 hif_drv->remain_on_ch_pending = 1;
2232 result = -EBUSY;
2233 goto ERRORHANDLER;
2234 }
2235 if (hif_drv->hif_state == HOST_IF_WAITING_CONN_RESP) {
2236 result = -EBUSY;
2237 goto ERRORHANDLER;
2238 }
2239
2240 if (wilc_optaining_ip || wilc_connecting) {
2241 result = -EBUSY;
2242 goto ERRORHANDLER;
2243 }
2244
2245 u8remain_on_chan_flag = true;
2246 wid.id = (u16)WID_REMAIN_ON_CHAN;
2247 wid.type = WID_STR;
2248 wid.size = 2;
2249 wid.val = kmalloc(wid.size, GFP_KERNEL);
2250 if (!wid.val) {
2251 result = -ENOMEM;
2252 goto ERRORHANDLER;
2253 }
2254
2255 wid.val[0] = u8remain_on_chan_flag;
2256 wid.val[1] = (s8)pstrHostIfRemainOnChan->ch;
2257
2258 result = wilc_send_config_pkt(vif, SET_CFG, &wid, 1,
2259 wilc_get_vif_idx(vif));
2260 if (result != 0)
2261 netdev_err(vif->ndev, "Failed to set remain on channel\n");
2262
2263 ERRORHANDLER:
2264 {
2265 P2P_LISTEN_STATE = 1;
2266 hif_drv->remain_on_ch_timer.data = (unsigned long)vif;
2267 mod_timer(&hif_drv->remain_on_ch_timer,
2268 jiffies +
2269 msecs_to_jiffies(pstrHostIfRemainOnChan->duration));
2270
2271 if (hif_drv->remain_on_ch.ready)
2272 hif_drv->remain_on_ch.ready(hif_drv->remain_on_ch.arg);
2273
2274 if (hif_drv->remain_on_ch_pending)
2275 hif_drv->remain_on_ch_pending = 0;
2276 }
2277
2278 return result;
2279 }
2280
Handle_RegisterFrame(struct wilc_vif * vif,struct reg_frame * pstrHostIfRegisterFrame)2281 static int Handle_RegisterFrame(struct wilc_vif *vif,
2282 struct reg_frame *pstrHostIfRegisterFrame)
2283 {
2284 s32 result = 0;
2285 struct wid wid;
2286 u8 *pu8CurrByte;
2287
2288 wid.id = (u16)WID_REGISTER_FRAME;
2289 wid.type = WID_STR;
2290 wid.val = kmalloc(sizeof(u16) + 2, GFP_KERNEL);
2291 if (!wid.val)
2292 return -ENOMEM;
2293
2294 pu8CurrByte = wid.val;
2295
2296 *pu8CurrByte++ = pstrHostIfRegisterFrame->reg;
2297 *pu8CurrByte++ = pstrHostIfRegisterFrame->reg_id;
2298 memcpy(pu8CurrByte, &pstrHostIfRegisterFrame->frame_type, sizeof(u16));
2299
2300 wid.size = sizeof(u16) + 2;
2301
2302 result = wilc_send_config_pkt(vif, SET_CFG, &wid, 1,
2303 wilc_get_vif_idx(vif));
2304 if (result) {
2305 netdev_err(vif->ndev, "Failed to frame register\n");
2306 result = -EINVAL;
2307 }
2308
2309 return result;
2310 }
2311
Handle_ListenStateExpired(struct wilc_vif * vif,struct remain_ch * pstrHostIfRemainOnChan)2312 static u32 Handle_ListenStateExpired(struct wilc_vif *vif,
2313 struct remain_ch *pstrHostIfRemainOnChan)
2314 {
2315 u8 u8remain_on_chan_flag;
2316 struct wid wid;
2317 s32 result = 0;
2318 struct host_if_drv *hif_drv = vif->hif_drv;
2319
2320 if (P2P_LISTEN_STATE) {
2321 u8remain_on_chan_flag = false;
2322 wid.id = (u16)WID_REMAIN_ON_CHAN;
2323 wid.type = WID_STR;
2324 wid.size = 2;
2325 wid.val = kmalloc(wid.size, GFP_KERNEL);
2326
2327 if (!wid.val) {
2328 netdev_err(vif->ndev, "Failed to allocate memory\n");
2329 return -ENOMEM;
2330 }
2331
2332 wid.val[0] = u8remain_on_chan_flag;
2333 wid.val[1] = FALSE_FRMWR_CHANNEL;
2334
2335 result = wilc_send_config_pkt(vif, SET_CFG, &wid, 1,
2336 wilc_get_vif_idx(vif));
2337 if (result != 0) {
2338 netdev_err(vif->ndev, "Failed to set remain channel\n");
2339 goto _done_;
2340 }
2341
2342 if (hif_drv->remain_on_ch.expired) {
2343 hif_drv->remain_on_ch.expired(hif_drv->remain_on_ch.arg,
2344 pstrHostIfRemainOnChan->id);
2345 }
2346 P2P_LISTEN_STATE = 0;
2347 } else {
2348 netdev_dbg(vif->ndev, "Not in listen state\n");
2349 result = -EFAULT;
2350 }
2351
2352 _done_:
2353 return result;
2354 }
2355
ListenTimerCB(unsigned long arg)2356 static void ListenTimerCB(unsigned long arg)
2357 {
2358 s32 result = 0;
2359 struct host_if_msg msg;
2360 struct wilc_vif *vif = (struct wilc_vif *)arg;
2361
2362 del_timer(&vif->hif_drv->remain_on_ch_timer);
2363
2364 memset(&msg, 0, sizeof(struct host_if_msg));
2365 msg.id = HOST_IF_MSG_LISTEN_TIMER_FIRED;
2366 msg.vif = vif;
2367 msg.body.remain_on_ch.id = vif->hif_drv->remain_on_ch.id;
2368
2369 result = wilc_enqueue_cmd(&msg);
2370 if (result)
2371 netdev_err(vif->ndev, "wilc_mq_send fail\n");
2372 }
2373
Handle_PowerManagement(struct wilc_vif * vif,struct power_mgmt_param * strPowerMgmtParam)2374 static void Handle_PowerManagement(struct wilc_vif *vif,
2375 struct power_mgmt_param *strPowerMgmtParam)
2376 {
2377 s32 result = 0;
2378 struct wid wid;
2379 s8 s8PowerMode;
2380
2381 wid.id = (u16)WID_POWER_MANAGEMENT;
2382
2383 if (strPowerMgmtParam->enabled)
2384 s8PowerMode = MIN_FAST_PS;
2385 else
2386 s8PowerMode = NO_POWERSAVE;
2387
2388 wid.val = &s8PowerMode;
2389 wid.size = sizeof(char);
2390
2391 result = wilc_send_config_pkt(vif, SET_CFG, &wid, 1,
2392 wilc_get_vif_idx(vif));
2393 if (result)
2394 netdev_err(vif->ndev, "Failed to send power management\n");
2395 }
2396
Handle_SetMulticastFilter(struct wilc_vif * vif,struct set_multicast * strHostIfSetMulti)2397 static void Handle_SetMulticastFilter(struct wilc_vif *vif,
2398 struct set_multicast *strHostIfSetMulti)
2399 {
2400 s32 result = 0;
2401 struct wid wid;
2402 u8 *pu8CurrByte;
2403
2404 wid.id = (u16)WID_SETUP_MULTICAST_FILTER;
2405 wid.type = WID_BIN;
2406 wid.size = sizeof(struct set_multicast) + ((strHostIfSetMulti->cnt) * ETH_ALEN);
2407 wid.val = kmalloc(wid.size, GFP_KERNEL);
2408 if (!wid.val)
2409 goto ERRORHANDLER;
2410
2411 pu8CurrByte = wid.val;
2412 *pu8CurrByte++ = (strHostIfSetMulti->enabled & 0xFF);
2413 *pu8CurrByte++ = 0;
2414 *pu8CurrByte++ = 0;
2415 *pu8CurrByte++ = 0;
2416
2417 *pu8CurrByte++ = (strHostIfSetMulti->cnt & 0xFF);
2418 *pu8CurrByte++ = ((strHostIfSetMulti->cnt >> 8) & 0xFF);
2419 *pu8CurrByte++ = ((strHostIfSetMulti->cnt >> 16) & 0xFF);
2420 *pu8CurrByte++ = ((strHostIfSetMulti->cnt >> 24) & 0xFF);
2421
2422 if ((strHostIfSetMulti->cnt) > 0)
2423 memcpy(pu8CurrByte, wilc_multicast_mac_addr_list,
2424 ((strHostIfSetMulti->cnt) * ETH_ALEN));
2425
2426 result = wilc_send_config_pkt(vif, SET_CFG, &wid, 1,
2427 wilc_get_vif_idx(vif));
2428 if (result)
2429 netdev_err(vif->ndev, "Failed to send setup multicast\n");
2430
2431 ERRORHANDLER:
2432 kfree(wid.val);
2433 }
2434
handle_set_tx_pwr(struct wilc_vif * vif,u8 tx_pwr)2435 static void handle_set_tx_pwr(struct wilc_vif *vif, u8 tx_pwr)
2436 {
2437 int ret;
2438 struct wid wid;
2439
2440 wid.id = (u16)WID_TX_POWER;
2441 wid.type = WID_CHAR;
2442 wid.val = &tx_pwr;
2443 wid.size = sizeof(char);
2444
2445 ret = wilc_send_config_pkt(vif, SET_CFG, &wid, 1,
2446 wilc_get_vif_idx(vif));
2447 if (ret)
2448 netdev_err(vif->ndev, "Failed to set TX PWR\n");
2449 }
2450
handle_get_tx_pwr(struct wilc_vif * vif,u8 * tx_pwr)2451 static void handle_get_tx_pwr(struct wilc_vif *vif, u8 *tx_pwr)
2452 {
2453 int ret = 0;
2454 struct wid wid;
2455
2456 wid.id = (u16)WID_TX_POWER;
2457 wid.type = WID_CHAR;
2458 wid.val = (s8 *)tx_pwr;
2459 wid.size = sizeof(char);
2460
2461 ret = wilc_send_config_pkt(vif, GET_CFG, &wid, 1,
2462 wilc_get_vif_idx(vif));
2463 if (ret)
2464 netdev_err(vif->ndev, "Failed to get TX PWR\n");
2465
2466 complete(&hif_wait_response);
2467 }
2468
host_if_work(struct work_struct * work)2469 static void host_if_work(struct work_struct *work)
2470 {
2471 struct host_if_msg *msg;
2472 struct wilc *wilc;
2473
2474 msg = container_of(work, struct host_if_msg, work);
2475 wilc = msg->vif->wilc;
2476
2477 if (msg->id == HOST_IF_MSG_CONNECT &&
2478 msg->vif->hif_drv->usr_scan_req.scan_result) {
2479 wilc_enqueue_cmd(msg);
2480 usleep_range(2 * 1000, 2 * 1000);
2481 goto free_msg;
2482 }
2483 switch (msg->id) {
2484 case HOST_IF_MSG_SCAN:
2485 handle_scan(msg->vif, &msg->body.scan_info);
2486 break;
2487
2488 case HOST_IF_MSG_CONNECT:
2489 Handle_Connect(msg->vif, &msg->body.con_info);
2490 break;
2491
2492 case HOST_IF_MSG_RCVD_NTWRK_INFO:
2493 Handle_RcvdNtwrkInfo(msg->vif, &msg->body.net_info);
2494 break;
2495
2496 case HOST_IF_MSG_RCVD_GNRL_ASYNC_INFO:
2497 Handle_RcvdGnrlAsyncInfo(msg->vif,
2498 &msg->body.async_info);
2499 break;
2500
2501 case HOST_IF_MSG_KEY:
2502 Handle_Key(msg->vif, &msg->body.key_info);
2503 break;
2504
2505 case HOST_IF_MSG_CFG_PARAMS:
2506 handle_cfg_param(msg->vif, &msg->body.cfg_info);
2507 break;
2508
2509 case HOST_IF_MSG_SET_CHANNEL:
2510 handle_set_channel(msg->vif, &msg->body.channel_info);
2511 break;
2512
2513 case HOST_IF_MSG_DISCONNECT:
2514 Handle_Disconnect(msg->vif);
2515 break;
2516
2517 case HOST_IF_MSG_RCVD_SCAN_COMPLETE:
2518 del_timer(&msg->vif->hif_drv->scan_timer);
2519
2520 if (!wilc_wlan_get_num_conn_ifcs(wilc))
2521 wilc_chip_sleep_manually(wilc);
2522
2523 Handle_ScanDone(msg->vif, SCAN_EVENT_DONE);
2524
2525 if (msg->vif->hif_drv->remain_on_ch_pending)
2526 Handle_RemainOnChan(msg->vif,
2527 &msg->body.remain_on_ch);
2528
2529 break;
2530
2531 case HOST_IF_MSG_GET_RSSI:
2532 Handle_GetRssi(msg->vif);
2533 break;
2534
2535 case HOST_IF_MSG_GET_STATISTICS:
2536 Handle_GetStatistics(msg->vif,
2537 (struct rf_info *)msg->body.data);
2538 break;
2539
2540 case HOST_IF_MSG_ADD_BEACON:
2541 Handle_AddBeacon(msg->vif, &msg->body.beacon_info);
2542 break;
2543
2544 case HOST_IF_MSG_DEL_BEACON:
2545 Handle_DelBeacon(msg->vif);
2546 break;
2547
2548 case HOST_IF_MSG_ADD_STATION:
2549 Handle_AddStation(msg->vif, &msg->body.add_sta_info);
2550 break;
2551
2552 case HOST_IF_MSG_DEL_STATION:
2553 Handle_DelStation(msg->vif, &msg->body.del_sta_info);
2554 break;
2555
2556 case HOST_IF_MSG_EDIT_STATION:
2557 Handle_EditStation(msg->vif, &msg->body.edit_sta_info);
2558 break;
2559
2560 case HOST_IF_MSG_GET_INACTIVETIME:
2561 Handle_Get_InActiveTime(msg->vif, &msg->body.mac_info);
2562 break;
2563
2564 case HOST_IF_MSG_SCAN_TIMER_FIRED:
2565 Handle_ScanDone(msg->vif, SCAN_EVENT_ABORTED);
2566 break;
2567
2568 case HOST_IF_MSG_CONNECT_TIMER_FIRED:
2569 Handle_ConnectTimeout(msg->vif);
2570 break;
2571
2572 case HOST_IF_MSG_POWER_MGMT:
2573 Handle_PowerManagement(msg->vif,
2574 &msg->body.pwr_mgmt_info);
2575 break;
2576
2577 case HOST_IF_MSG_SET_WFIDRV_HANDLER:
2578 handle_set_wfi_drv_handler(msg->vif, &msg->body.drv);
2579 break;
2580
2581 case HOST_IF_MSG_SET_OPERATION_MODE:
2582 handle_set_operation_mode(msg->vif, &msg->body.mode);
2583 break;
2584
2585 case HOST_IF_MSG_SET_IPADDRESS:
2586 handle_set_ip_address(msg->vif,
2587 msg->body.ip_info.ip_addr,
2588 msg->body.ip_info.idx);
2589 break;
2590
2591 case HOST_IF_MSG_GET_IPADDRESS:
2592 handle_get_ip_address(msg->vif, msg->body.ip_info.idx);
2593 break;
2594
2595 case HOST_IF_MSG_GET_MAC_ADDRESS:
2596 handle_get_mac_address(msg->vif,
2597 &msg->body.get_mac_info);
2598 break;
2599
2600 case HOST_IF_MSG_REMAIN_ON_CHAN:
2601 Handle_RemainOnChan(msg->vif, &msg->body.remain_on_ch);
2602 break;
2603
2604 case HOST_IF_MSG_REGISTER_FRAME:
2605 Handle_RegisterFrame(msg->vif, &msg->body.reg_frame);
2606 break;
2607
2608 case HOST_IF_MSG_LISTEN_TIMER_FIRED:
2609 Handle_ListenStateExpired(msg->vif, &msg->body.remain_on_ch);
2610 break;
2611
2612 case HOST_IF_MSG_SET_MULTICAST_FILTER:
2613 Handle_SetMulticastFilter(msg->vif, &msg->body.multicast_info);
2614 break;
2615
2616 case HOST_IF_MSG_DEL_ALL_STA:
2617 Handle_DelAllSta(msg->vif, &msg->body.del_all_sta_info);
2618 break;
2619
2620 case HOST_IF_MSG_SET_TX_POWER:
2621 handle_set_tx_pwr(msg->vif, msg->body.tx_power.tx_pwr);
2622 break;
2623
2624 case HOST_IF_MSG_GET_TX_POWER:
2625 handle_get_tx_pwr(msg->vif, &msg->body.tx_power.tx_pwr);
2626 break;
2627 default:
2628 netdev_err(msg->vif->ndev, "[Host Interface] undefined\n");
2629 break;
2630 }
2631 free_msg:
2632 kfree(msg);
2633 complete(&hif_thread_comp);
2634 }
2635
TimerCB_Scan(unsigned long arg)2636 static void TimerCB_Scan(unsigned long arg)
2637 {
2638 struct wilc_vif *vif = (struct wilc_vif *)arg;
2639 struct host_if_msg msg;
2640
2641 memset(&msg, 0, sizeof(struct host_if_msg));
2642 msg.vif = vif;
2643 msg.id = HOST_IF_MSG_SCAN_TIMER_FIRED;
2644
2645 wilc_enqueue_cmd(&msg);
2646 }
2647
TimerCB_Connect(unsigned long arg)2648 static void TimerCB_Connect(unsigned long arg)
2649 {
2650 struct wilc_vif *vif = (struct wilc_vif *)arg;
2651 struct host_if_msg msg;
2652
2653 memset(&msg, 0, sizeof(struct host_if_msg));
2654 msg.vif = vif;
2655 msg.id = HOST_IF_MSG_CONNECT_TIMER_FIRED;
2656
2657 wilc_enqueue_cmd(&msg);
2658 }
2659
wilc_remove_key(struct host_if_drv * hif_drv,const u8 * pu8StaAddress)2660 s32 wilc_remove_key(struct host_if_drv *hif_drv, const u8 *pu8StaAddress)
2661 {
2662 struct wid wid;
2663
2664 wid.id = (u16)WID_REMOVE_KEY;
2665 wid.type = WID_STR;
2666 wid.val = (s8 *)pu8StaAddress;
2667 wid.size = 6;
2668
2669 return 0;
2670 }
2671
wilc_remove_wep_key(struct wilc_vif * vif,u8 index)2672 int wilc_remove_wep_key(struct wilc_vif *vif, u8 index)
2673 {
2674 int result = 0;
2675 struct host_if_msg msg;
2676 struct host_if_drv *hif_drv = vif->hif_drv;
2677
2678 if (!hif_drv) {
2679 result = -EFAULT;
2680 netdev_err(vif->ndev, "Failed to send setup multicast\n");
2681 return result;
2682 }
2683
2684 memset(&msg, 0, sizeof(struct host_if_msg));
2685
2686 msg.id = HOST_IF_MSG_KEY;
2687 msg.body.key_info.type = WEP;
2688 msg.body.key_info.action = REMOVEKEY;
2689 msg.vif = vif;
2690 msg.body.key_info.attr.wep.index = index;
2691
2692 result = wilc_enqueue_cmd(&msg);
2693 if (result)
2694 netdev_err(vif->ndev, "Request to remove WEP key\n");
2695 else
2696 wait_for_completion(&hif_drv->comp_test_key_block);
2697
2698 return result;
2699 }
2700
wilc_set_wep_default_keyid(struct wilc_vif * vif,u8 index)2701 int wilc_set_wep_default_keyid(struct wilc_vif *vif, u8 index)
2702 {
2703 int result = 0;
2704 struct host_if_msg msg;
2705 struct host_if_drv *hif_drv = vif->hif_drv;
2706
2707 if (!hif_drv) {
2708 result = -EFAULT;
2709 netdev_err(vif->ndev, "driver is null\n");
2710 return result;
2711 }
2712
2713 memset(&msg, 0, sizeof(struct host_if_msg));
2714
2715 msg.id = HOST_IF_MSG_KEY;
2716 msg.body.key_info.type = WEP;
2717 msg.body.key_info.action = DEFAULTKEY;
2718 msg.vif = vif;
2719 msg.body.key_info.attr.wep.index = index;
2720
2721 result = wilc_enqueue_cmd(&msg);
2722 if (result)
2723 netdev_err(vif->ndev, "Default key index\n");
2724 else
2725 wait_for_completion(&hif_drv->comp_test_key_block);
2726
2727 return result;
2728 }
2729
wilc_add_wep_key_bss_sta(struct wilc_vif * vif,const u8 * key,u8 len,u8 index)2730 int wilc_add_wep_key_bss_sta(struct wilc_vif *vif, const u8 *key, u8 len,
2731 u8 index)
2732 {
2733 int result = 0;
2734 struct host_if_msg msg;
2735 struct host_if_drv *hif_drv = vif->hif_drv;
2736
2737 if (!hif_drv) {
2738 netdev_err(vif->ndev, "driver is null\n");
2739 return -EFAULT;
2740 }
2741
2742 memset(&msg, 0, sizeof(struct host_if_msg));
2743
2744 msg.id = HOST_IF_MSG_KEY;
2745 msg.body.key_info.type = WEP;
2746 msg.body.key_info.action = ADDKEY;
2747 msg.vif = vif;
2748 msg.body.key_info.attr.wep.key = kmemdup(key, len, GFP_KERNEL);
2749 if (!msg.body.key_info.attr.wep.key)
2750 return -ENOMEM;
2751
2752 msg.body.key_info.attr.wep.key_len = len;
2753 msg.body.key_info.attr.wep.index = index;
2754
2755 result = wilc_enqueue_cmd(&msg);
2756 if (result)
2757 netdev_err(vif->ndev, "STA - WEP Key\n");
2758 wait_for_completion(&hif_drv->comp_test_key_block);
2759
2760 return result;
2761 }
2762
wilc_add_wep_key_bss_ap(struct wilc_vif * vif,const u8 * key,u8 len,u8 index,u8 mode,enum AUTHTYPE auth_type)2763 int wilc_add_wep_key_bss_ap(struct wilc_vif *vif, const u8 *key, u8 len,
2764 u8 index, u8 mode, enum AUTHTYPE auth_type)
2765 {
2766 int result = 0;
2767 struct host_if_msg msg;
2768 struct host_if_drv *hif_drv = vif->hif_drv;
2769
2770 if (!hif_drv) {
2771 netdev_err(vif->ndev, "driver is null\n");
2772 return -EFAULT;
2773 }
2774
2775 memset(&msg, 0, sizeof(struct host_if_msg));
2776
2777 msg.id = HOST_IF_MSG_KEY;
2778 msg.body.key_info.type = WEP;
2779 msg.body.key_info.action = ADDKEY_AP;
2780 msg.vif = vif;
2781 msg.body.key_info.attr.wep.key = kmemdup(key, len, GFP_KERNEL);
2782 if (!msg.body.key_info.attr.wep.key)
2783 return -ENOMEM;
2784
2785 msg.body.key_info.attr.wep.key_len = len;
2786 msg.body.key_info.attr.wep.index = index;
2787 msg.body.key_info.attr.wep.mode = mode;
2788 msg.body.key_info.attr.wep.auth_type = auth_type;
2789
2790 result = wilc_enqueue_cmd(&msg);
2791
2792 if (result)
2793 netdev_err(vif->ndev, "AP - WEP Key\n");
2794 else
2795 wait_for_completion(&hif_drv->comp_test_key_block);
2796
2797 return result;
2798 }
2799
wilc_add_ptk(struct wilc_vif * vif,const u8 * ptk,u8 ptk_key_len,const u8 * mac_addr,const u8 * rx_mic,const u8 * tx_mic,u8 mode,u8 cipher_mode,u8 index)2800 int wilc_add_ptk(struct wilc_vif *vif, const u8 *ptk, u8 ptk_key_len,
2801 const u8 *mac_addr, const u8 *rx_mic, const u8 *tx_mic,
2802 u8 mode, u8 cipher_mode, u8 index)
2803 {
2804 int result = 0;
2805 struct host_if_msg msg;
2806 struct host_if_drv *hif_drv = vif->hif_drv;
2807 u8 key_len = ptk_key_len;
2808
2809 if (!hif_drv) {
2810 netdev_err(vif->ndev, "driver is null\n");
2811 return -EFAULT;
2812 }
2813
2814 if (rx_mic)
2815 key_len += RX_MIC_KEY_LEN;
2816
2817 if (tx_mic)
2818 key_len += TX_MIC_KEY_LEN;
2819
2820 memset(&msg, 0, sizeof(struct host_if_msg));
2821
2822 msg.id = HOST_IF_MSG_KEY;
2823 msg.body.key_info.type = WPA_PTK;
2824 if (mode == AP_MODE) {
2825 msg.body.key_info.action = ADDKEY_AP;
2826 msg.body.key_info.attr.wpa.index = index;
2827 }
2828 if (mode == STATION_MODE)
2829 msg.body.key_info.action = ADDKEY;
2830
2831 msg.body.key_info.attr.wpa.key = kmemdup(ptk, ptk_key_len, GFP_KERNEL);
2832 if (!msg.body.key_info.attr.wpa.key)
2833 return -ENOMEM;
2834
2835 if (rx_mic)
2836 memcpy(msg.body.key_info.attr.wpa.key + 16, rx_mic, RX_MIC_KEY_LEN);
2837
2838 if (tx_mic)
2839 memcpy(msg.body.key_info.attr.wpa.key + 24, tx_mic, TX_MIC_KEY_LEN);
2840
2841 msg.body.key_info.attr.wpa.key_len = key_len;
2842 msg.body.key_info.attr.wpa.mac_addr = mac_addr;
2843 msg.body.key_info.attr.wpa.mode = cipher_mode;
2844 msg.vif = vif;
2845
2846 result = wilc_enqueue_cmd(&msg);
2847
2848 if (result)
2849 netdev_err(vif->ndev, "PTK Key\n");
2850 else
2851 wait_for_completion(&hif_drv->comp_test_key_block);
2852
2853 return result;
2854 }
2855
wilc_add_rx_gtk(struct wilc_vif * vif,const u8 * rx_gtk,u8 gtk_key_len,u8 index,u32 key_rsc_len,const u8 * key_rsc,const u8 * rx_mic,const u8 * tx_mic,u8 mode,u8 cipher_mode)2856 int wilc_add_rx_gtk(struct wilc_vif *vif, const u8 *rx_gtk, u8 gtk_key_len,
2857 u8 index, u32 key_rsc_len, const u8 *key_rsc,
2858 const u8 *rx_mic, const u8 *tx_mic, u8 mode,
2859 u8 cipher_mode)
2860 {
2861 int result = 0;
2862 struct host_if_msg msg;
2863 struct host_if_drv *hif_drv = vif->hif_drv;
2864 u8 key_len = gtk_key_len;
2865
2866 if (!hif_drv) {
2867 netdev_err(vif->ndev, "driver is null\n");
2868 return -EFAULT;
2869 }
2870 memset(&msg, 0, sizeof(struct host_if_msg));
2871
2872 if (rx_mic)
2873 key_len += RX_MIC_KEY_LEN;
2874
2875 if (tx_mic)
2876 key_len += TX_MIC_KEY_LEN;
2877
2878 if (key_rsc) {
2879 msg.body.key_info.attr.wpa.seq = kmemdup(key_rsc,
2880 key_rsc_len,
2881 GFP_KERNEL);
2882 if (!msg.body.key_info.attr.wpa.seq)
2883 return -ENOMEM;
2884 }
2885
2886 msg.id = HOST_IF_MSG_KEY;
2887 msg.body.key_info.type = WPA_RX_GTK;
2888 msg.vif = vif;
2889
2890 if (mode == AP_MODE) {
2891 msg.body.key_info.action = ADDKEY_AP;
2892 msg.body.key_info.attr.wpa.mode = cipher_mode;
2893 }
2894 if (mode == STATION_MODE)
2895 msg.body.key_info.action = ADDKEY;
2896
2897 msg.body.key_info.attr.wpa.key = kmemdup(rx_gtk,
2898 key_len,
2899 GFP_KERNEL);
2900 if (!msg.body.key_info.attr.wpa.key)
2901 return -ENOMEM;
2902
2903 if (rx_mic)
2904 memcpy(msg.body.key_info.attr.wpa.key + 16, rx_mic,
2905 RX_MIC_KEY_LEN);
2906
2907 if (tx_mic)
2908 memcpy(msg.body.key_info.attr.wpa.key + 24, tx_mic,
2909 TX_MIC_KEY_LEN);
2910
2911 msg.body.key_info.attr.wpa.index = index;
2912 msg.body.key_info.attr.wpa.key_len = key_len;
2913 msg.body.key_info.attr.wpa.seq_len = key_rsc_len;
2914
2915 result = wilc_enqueue_cmd(&msg);
2916 if (result)
2917 netdev_err(vif->ndev, "RX GTK\n");
2918 else
2919 wait_for_completion(&hif_drv->comp_test_key_block);
2920
2921 return result;
2922 }
2923
wilc_set_pmkid_info(struct wilc_vif * vif,struct host_if_pmkid_attr * pmkid)2924 int wilc_set_pmkid_info(struct wilc_vif *vif,
2925 struct host_if_pmkid_attr *pmkid)
2926 {
2927 int result = 0;
2928 struct host_if_msg msg;
2929 int i;
2930
2931 memset(&msg, 0, sizeof(struct host_if_msg));
2932
2933 msg.id = HOST_IF_MSG_KEY;
2934 msg.body.key_info.type = PMKSA;
2935 msg.body.key_info.action = ADDKEY;
2936 msg.vif = vif;
2937
2938 for (i = 0; i < pmkid->numpmkid; i++) {
2939 memcpy(msg.body.key_info.attr.pmkid.pmkidlist[i].bssid,
2940 &pmkid->pmkidlist[i].bssid, ETH_ALEN);
2941 memcpy(msg.body.key_info.attr.pmkid.pmkidlist[i].pmkid,
2942 &pmkid->pmkidlist[i].pmkid, PMKID_LEN);
2943 }
2944
2945 result = wilc_enqueue_cmd(&msg);
2946 if (result)
2947 netdev_err(vif->ndev, "PMKID Info\n");
2948
2949 return result;
2950 }
2951
wilc_get_mac_address(struct wilc_vif * vif,u8 * mac_addr)2952 int wilc_get_mac_address(struct wilc_vif *vif, u8 *mac_addr)
2953 {
2954 int result = 0;
2955 struct host_if_msg msg;
2956
2957 memset(&msg, 0, sizeof(struct host_if_msg));
2958
2959 msg.id = HOST_IF_MSG_GET_MAC_ADDRESS;
2960 msg.body.get_mac_info.mac_addr = mac_addr;
2961 msg.vif = vif;
2962
2963 result = wilc_enqueue_cmd(&msg);
2964 if (result) {
2965 netdev_err(vif->ndev, "Failed to send get mac address\n");
2966 return -EFAULT;
2967 }
2968
2969 wait_for_completion(&hif_wait_response);
2970 return result;
2971 }
2972
wilc_set_join_req(struct wilc_vif * vif,u8 * bssid,const u8 * ssid,size_t ssid_len,const u8 * ies,size_t ies_len,wilc_connect_result connect_result,void * user_arg,u8 security,enum AUTHTYPE auth_type,u8 channel,void * join_params)2973 int wilc_set_join_req(struct wilc_vif *vif, u8 *bssid, const u8 *ssid,
2974 size_t ssid_len, const u8 *ies, size_t ies_len,
2975 wilc_connect_result connect_result, void *user_arg,
2976 u8 security, enum AUTHTYPE auth_type,
2977 u8 channel, void *join_params)
2978 {
2979 int result = 0;
2980 struct host_if_msg msg;
2981 struct host_if_drv *hif_drv = vif->hif_drv;
2982
2983 if (!hif_drv || !connect_result) {
2984 netdev_err(vif->ndev, "Driver is null\n");
2985 return -EFAULT;
2986 }
2987
2988 if (!join_params) {
2989 netdev_err(vif->ndev, "Unable to Join - JoinParams is NULL\n");
2990 return -EFAULT;
2991 }
2992
2993 memset(&msg, 0, sizeof(struct host_if_msg));
2994
2995 msg.id = HOST_IF_MSG_CONNECT;
2996
2997 msg.body.con_info.security = security;
2998 msg.body.con_info.auth_type = auth_type;
2999 msg.body.con_info.ch = channel;
3000 msg.body.con_info.result = connect_result;
3001 msg.body.con_info.arg = user_arg;
3002 msg.body.con_info.params = join_params;
3003 msg.vif = vif;
3004
3005 if (bssid) {
3006 msg.body.con_info.bssid = kmemdup(bssid, 6, GFP_KERNEL);
3007 if (!msg.body.con_info.bssid)
3008 return -ENOMEM;
3009 }
3010
3011 if (ssid) {
3012 msg.body.con_info.ssid_len = ssid_len;
3013 msg.body.con_info.ssid = kmemdup(ssid, ssid_len, GFP_KERNEL);
3014 if (!msg.body.con_info.ssid)
3015 return -ENOMEM;
3016 }
3017
3018 if (ies) {
3019 msg.body.con_info.ies_len = ies_len;
3020 msg.body.con_info.ies = kmemdup(ies, ies_len, GFP_KERNEL);
3021 if (!msg.body.con_info.ies)
3022 return -ENOMEM;
3023 }
3024 if (hif_drv->hif_state < HOST_IF_CONNECTING)
3025 hif_drv->hif_state = HOST_IF_CONNECTING;
3026
3027 result = wilc_enqueue_cmd(&msg);
3028 if (result) {
3029 netdev_err(vif->ndev, "send message: Set join request\n");
3030 return -EFAULT;
3031 }
3032
3033 hif_drv->connect_timer.data = (unsigned long)vif;
3034 mod_timer(&hif_drv->connect_timer,
3035 jiffies + msecs_to_jiffies(HOST_IF_CONNECT_TIMEOUT));
3036
3037 return result;
3038 }
3039
wilc_disconnect(struct wilc_vif * vif,u16 reason_code)3040 int wilc_disconnect(struct wilc_vif *vif, u16 reason_code)
3041 {
3042 int result = 0;
3043 struct host_if_msg msg;
3044 struct host_if_drv *hif_drv = vif->hif_drv;
3045
3046 if (!hif_drv) {
3047 netdev_err(vif->ndev, "Driver is null\n");
3048 return -EFAULT;
3049 }
3050
3051 memset(&msg, 0, sizeof(struct host_if_msg));
3052
3053 msg.id = HOST_IF_MSG_DISCONNECT;
3054 msg.vif = vif;
3055
3056 result = wilc_enqueue_cmd(&msg);
3057 if (result)
3058 netdev_err(vif->ndev, "Failed to send message: disconnect\n");
3059 else
3060 wait_for_completion(&hif_drv->comp_test_disconn_block);
3061
3062 return result;
3063 }
3064
host_int_get_assoc_res_info(struct wilc_vif * vif,u8 * pu8AssocRespInfo,u32 u32MaxAssocRespInfoLen,u32 * pu32RcvdAssocRespInfoLen)3065 static s32 host_int_get_assoc_res_info(struct wilc_vif *vif,
3066 u8 *pu8AssocRespInfo,
3067 u32 u32MaxAssocRespInfoLen,
3068 u32 *pu32RcvdAssocRespInfoLen)
3069 {
3070 s32 result = 0;
3071 struct wid wid;
3072
3073 wid.id = (u16)WID_ASSOC_RES_INFO;
3074 wid.type = WID_STR;
3075 wid.val = pu8AssocRespInfo;
3076 wid.size = u32MaxAssocRespInfoLen;
3077
3078 result = wilc_send_config_pkt(vif, GET_CFG, &wid, 1,
3079 wilc_get_vif_idx(vif));
3080 if (result) {
3081 *pu32RcvdAssocRespInfoLen = 0;
3082 netdev_err(vif->ndev, "Failed to send association response\n");
3083 return -EINVAL;
3084 }
3085
3086 *pu32RcvdAssocRespInfoLen = wid.size;
3087 return result;
3088 }
3089
wilc_set_mac_chnl_num(struct wilc_vif * vif,u8 channel)3090 int wilc_set_mac_chnl_num(struct wilc_vif *vif, u8 channel)
3091 {
3092 int result;
3093 struct host_if_msg msg;
3094
3095 memset(&msg, 0, sizeof(struct host_if_msg));
3096 msg.id = HOST_IF_MSG_SET_CHANNEL;
3097 msg.body.channel_info.set_ch = channel;
3098 msg.vif = vif;
3099
3100 result = wilc_enqueue_cmd(&msg);
3101 if (result) {
3102 netdev_err(vif->ndev, "wilc mq send fail\n");
3103 return -EINVAL;
3104 }
3105
3106 return 0;
3107 }
3108
wilc_set_wfi_drv_handler(struct wilc_vif * vif,int index,u8 mac_idx)3109 int wilc_set_wfi_drv_handler(struct wilc_vif *vif, int index, u8 mac_idx)
3110 {
3111 int result = 0;
3112 struct host_if_msg msg;
3113
3114 memset(&msg, 0, sizeof(struct host_if_msg));
3115 msg.id = HOST_IF_MSG_SET_WFIDRV_HANDLER;
3116 msg.body.drv.handler = index;
3117 msg.body.drv.mac_idx = mac_idx;
3118 msg.vif = vif;
3119
3120 result = wilc_enqueue_cmd(&msg);
3121 if (result) {
3122 netdev_err(vif->ndev, "wilc mq send fail\n");
3123 result = -EINVAL;
3124 }
3125
3126 return result;
3127 }
3128
wilc_set_operation_mode(struct wilc_vif * vif,u32 mode)3129 int wilc_set_operation_mode(struct wilc_vif *vif, u32 mode)
3130 {
3131 int result = 0;
3132 struct host_if_msg msg;
3133
3134 memset(&msg, 0, sizeof(struct host_if_msg));
3135 msg.id = HOST_IF_MSG_SET_OPERATION_MODE;
3136 msg.body.mode.mode = mode;
3137 msg.vif = vif;
3138
3139 result = wilc_enqueue_cmd(&msg);
3140 if (result) {
3141 netdev_err(vif->ndev, "wilc mq send fail\n");
3142 result = -EINVAL;
3143 }
3144
3145 return result;
3146 }
3147
wilc_get_inactive_time(struct wilc_vif * vif,const u8 * mac,u32 * pu32InactiveTime)3148 s32 wilc_get_inactive_time(struct wilc_vif *vif, const u8 *mac,
3149 u32 *pu32InactiveTime)
3150 {
3151 s32 result = 0;
3152 struct host_if_msg msg;
3153 struct host_if_drv *hif_drv = vif->hif_drv;
3154
3155 if (!hif_drv) {
3156 netdev_err(vif->ndev, "driver is null\n");
3157 return -EFAULT;
3158 }
3159
3160 memset(&msg, 0, sizeof(struct host_if_msg));
3161 memcpy(msg.body.mac_info.mac, mac, ETH_ALEN);
3162
3163 msg.id = HOST_IF_MSG_GET_INACTIVETIME;
3164 msg.vif = vif;
3165
3166 result = wilc_enqueue_cmd(&msg);
3167 if (result)
3168 netdev_err(vif->ndev, "Failed to send get host ch param\n");
3169 else
3170 wait_for_completion(&hif_drv->comp_inactive_time);
3171
3172 *pu32InactiveTime = inactive_time;
3173
3174 return result;
3175 }
3176
wilc_get_rssi(struct wilc_vif * vif,s8 * rssi_level)3177 int wilc_get_rssi(struct wilc_vif *vif, s8 *rssi_level)
3178 {
3179 int result = 0;
3180 struct host_if_msg msg;
3181 struct host_if_drv *hif_drv = vif->hif_drv;
3182
3183 memset(&msg, 0, sizeof(struct host_if_msg));
3184 msg.id = HOST_IF_MSG_GET_RSSI;
3185 msg.vif = vif;
3186
3187 result = wilc_enqueue_cmd(&msg);
3188 if (result) {
3189 netdev_err(vif->ndev, "Failed to send get host ch param\n");
3190 return -EFAULT;
3191 }
3192
3193 wait_for_completion(&hif_drv->comp_get_rssi);
3194
3195 if (!rssi_level) {
3196 netdev_err(vif->ndev, "RSS pointer value is null\n");
3197 return -EFAULT;
3198 }
3199
3200 *rssi_level = rssi;
3201
3202 return result;
3203 }
3204
wilc_get_statistics(struct wilc_vif * vif,struct rf_info * stats)3205 int wilc_get_statistics(struct wilc_vif *vif, struct rf_info *stats)
3206 {
3207 int result = 0;
3208 struct host_if_msg msg;
3209
3210 memset(&msg, 0, sizeof(struct host_if_msg));
3211 msg.id = HOST_IF_MSG_GET_STATISTICS;
3212 msg.body.data = (char *)stats;
3213 msg.vif = vif;
3214
3215 result = wilc_enqueue_cmd(&msg);
3216 if (result) {
3217 netdev_err(vif->ndev, "Failed to send get host channel\n");
3218 return -EFAULT;
3219 }
3220
3221 if (stats != &vif->wilc->dummy_statistics)
3222 wait_for_completion(&hif_wait_response);
3223 return result;
3224 }
3225
wilc_scan(struct wilc_vif * vif,u8 scan_source,u8 scan_type,u8 * ch_freq_list,u8 ch_list_len,const u8 * ies,size_t ies_len,wilc_scan_result scan_result,void * user_arg,struct hidden_network * hidden_network)3226 int wilc_scan(struct wilc_vif *vif, u8 scan_source, u8 scan_type,
3227 u8 *ch_freq_list, u8 ch_list_len, const u8 *ies,
3228 size_t ies_len, wilc_scan_result scan_result, void *user_arg,
3229 struct hidden_network *hidden_network)
3230 {
3231 int result = 0;
3232 struct host_if_msg msg;
3233 struct scan_attr *scan_info = &msg.body.scan_info;
3234 struct host_if_drv *hif_drv = vif->hif_drv;
3235
3236 if (!hif_drv || !scan_result) {
3237 netdev_err(vif->ndev, "hif_drv or scan_result = NULL\n");
3238 return -EFAULT;
3239 }
3240
3241 memset(&msg, 0, sizeof(struct host_if_msg));
3242
3243 msg.id = HOST_IF_MSG_SCAN;
3244
3245 if (hidden_network) {
3246 scan_info->hidden_network.net_info = hidden_network->net_info;
3247 scan_info->hidden_network.n_ssids = hidden_network->n_ssids;
3248 }
3249
3250 msg.vif = vif;
3251 scan_info->src = scan_source;
3252 scan_info->type = scan_type;
3253 scan_info->result = scan_result;
3254 scan_info->arg = user_arg;
3255
3256 scan_info->ch_list_len = ch_list_len;
3257 scan_info->ch_freq_list = kmemdup(ch_freq_list,
3258 ch_list_len,
3259 GFP_KERNEL);
3260 if (!scan_info->ch_freq_list)
3261 return -ENOMEM;
3262
3263 scan_info->ies_len = ies_len;
3264 scan_info->ies = kmemdup(ies, ies_len, GFP_KERNEL);
3265 if (!scan_info->ies)
3266 return -ENOMEM;
3267
3268 result = wilc_enqueue_cmd(&msg);
3269 if (result) {
3270 netdev_err(vif->ndev, "Error in sending message queue\n");
3271 return -EINVAL;
3272 }
3273
3274 hif_drv->scan_timer.data = (unsigned long)vif;
3275 mod_timer(&hif_drv->scan_timer,
3276 jiffies + msecs_to_jiffies(HOST_IF_SCAN_TIMEOUT));
3277
3278 return result;
3279 }
3280
wilc_hif_set_cfg(struct wilc_vif * vif,struct cfg_param_attr * cfg_param)3281 int wilc_hif_set_cfg(struct wilc_vif *vif,
3282 struct cfg_param_attr *cfg_param)
3283 {
3284 struct host_if_msg msg;
3285 struct host_if_drv *hif_drv = vif->hif_drv;
3286
3287 if (!hif_drv) {
3288 netdev_err(vif->ndev, "hif_drv NULL\n");
3289 return -EFAULT;
3290 }
3291
3292 memset(&msg, 0, sizeof(struct host_if_msg));
3293 msg.id = HOST_IF_MSG_CFG_PARAMS;
3294 msg.body.cfg_info = *cfg_param;
3295 msg.vif = vif;
3296
3297 return wilc_enqueue_cmd(&msg);
3298 }
3299
GetPeriodicRSSI(unsigned long arg)3300 static void GetPeriodicRSSI(unsigned long arg)
3301 {
3302 struct wilc_vif *vif = (struct wilc_vif *)arg;
3303
3304 if (!vif->hif_drv) {
3305 netdev_err(vif->ndev, "Driver handler is NULL\n");
3306 return;
3307 }
3308
3309 if (vif->hif_drv->hif_state == HOST_IF_CONNECTED)
3310 wilc_get_statistics(vif, &vif->wilc->dummy_statistics);
3311
3312 periodic_rssi.data = (unsigned long)vif;
3313 mod_timer(&periodic_rssi, jiffies + msecs_to_jiffies(5000));
3314 }
3315
wilc_init(struct net_device * dev,struct host_if_drv ** hif_drv_handler)3316 int wilc_init(struct net_device *dev, struct host_if_drv **hif_drv_handler)
3317 {
3318 int result = 0;
3319 struct host_if_drv *hif_drv;
3320 struct wilc_vif *vif;
3321 struct wilc *wilc;
3322 int i;
3323
3324 vif = netdev_priv(dev);
3325 wilc = vif->wilc;
3326
3327 scan_while_connected = false;
3328
3329 init_completion(&hif_wait_response);
3330
3331 hif_drv = kzalloc(sizeof(*hif_drv), GFP_KERNEL);
3332 if (!hif_drv) {
3333 result = -ENOMEM;
3334 goto _fail_;
3335 }
3336 *hif_drv_handler = hif_drv;
3337 for (i = 0; i < wilc->vif_num; i++)
3338 if (dev == wilc->vif[i]->ndev) {
3339 wilc->vif[i]->hif_drv = hif_drv;
3340 break;
3341 }
3342
3343 wilc_optaining_ip = false;
3344
3345 if (clients_count == 0) {
3346 init_completion(&hif_thread_comp);
3347 init_completion(&hif_driver_comp);
3348 mutex_init(&hif_deinit_lock);
3349 }
3350
3351 init_completion(&hif_drv->comp_test_key_block);
3352 init_completion(&hif_drv->comp_test_disconn_block);
3353 init_completion(&hif_drv->comp_get_rssi);
3354 init_completion(&hif_drv->comp_inactive_time);
3355
3356 if (clients_count == 0) {
3357 if (result < 0) {
3358 netdev_err(vif->ndev, "Failed to creat MQ\n");
3359 goto _fail_;
3360 }
3361 hif_workqueue = create_singlethread_workqueue("WILC_wq");
3362 if (!hif_workqueue) {
3363 netdev_err(vif->ndev, "Failed to create workqueue\n");
3364 result = -ENOMEM;
3365 goto _fail_;
3366 }
3367
3368 setup_timer(&periodic_rssi, GetPeriodicRSSI,
3369 (unsigned long)vif);
3370 mod_timer(&periodic_rssi, jiffies + msecs_to_jiffies(5000));
3371 }
3372
3373 setup_timer(&hif_drv->scan_timer, TimerCB_Scan, 0);
3374 setup_timer(&hif_drv->connect_timer, TimerCB_Connect, 0);
3375 setup_timer(&hif_drv->remain_on_ch_timer, ListenTimerCB, 0);
3376
3377 mutex_init(&hif_drv->cfg_values_lock);
3378 mutex_lock(&hif_drv->cfg_values_lock);
3379
3380 hif_drv->hif_state = HOST_IF_IDLE;
3381 hif_drv->cfg_values.site_survey_enabled = SITE_SURVEY_OFF;
3382 hif_drv->cfg_values.scan_source = DEFAULT_SCAN;
3383 hif_drv->cfg_values.active_scan_time = ACTIVE_SCAN_TIME;
3384 hif_drv->cfg_values.passive_scan_time = PASSIVE_SCAN_TIME;
3385 hif_drv->cfg_values.curr_tx_rate = AUTORATE;
3386
3387 hif_drv->p2p_timeout = 0;
3388
3389 mutex_unlock(&hif_drv->cfg_values_lock);
3390
3391 clients_count++;
3392
3393 _fail_:
3394 return result;
3395 }
3396
wilc_deinit(struct wilc_vif * vif)3397 int wilc_deinit(struct wilc_vif *vif)
3398 {
3399 int result = 0;
3400 struct host_if_msg msg;
3401 struct host_if_drv *hif_drv = vif->hif_drv;
3402
3403 if (!hif_drv) {
3404 netdev_err(vif->ndev, "hif_drv = NULL\n");
3405 return -EFAULT;
3406 }
3407
3408 mutex_lock(&hif_deinit_lock);
3409
3410 terminated_handle = hif_drv;
3411
3412 del_timer_sync(&hif_drv->scan_timer);
3413 del_timer_sync(&hif_drv->connect_timer);
3414 del_timer_sync(&periodic_rssi);
3415 del_timer_sync(&hif_drv->remain_on_ch_timer);
3416
3417 wilc_set_wfi_drv_handler(vif, 0, 0);
3418 wait_for_completion(&hif_driver_comp);
3419
3420 if (hif_drv->usr_scan_req.scan_result) {
3421 hif_drv->usr_scan_req.scan_result(SCAN_EVENT_ABORTED, NULL,
3422 hif_drv->usr_scan_req.arg, NULL);
3423 hif_drv->usr_scan_req.scan_result = NULL;
3424 }
3425
3426 hif_drv->hif_state = HOST_IF_IDLE;
3427
3428 scan_while_connected = false;
3429
3430 memset(&msg, 0, sizeof(struct host_if_msg));
3431
3432 if (clients_count == 1) {
3433 msg.id = HOST_IF_MSG_EXIT;
3434 msg.vif = vif;
3435
3436 result = wilc_enqueue_cmd(&msg);
3437 if (result != 0)
3438 netdev_err(vif->ndev, "deinit : Error(%d)\n", result);
3439 else
3440 wait_for_completion(&hif_thread_comp);
3441
3442 destroy_workqueue(hif_workqueue);
3443 }
3444
3445 kfree(hif_drv);
3446
3447 clients_count--;
3448 terminated_handle = NULL;
3449 mutex_unlock(&hif_deinit_lock);
3450 return result;
3451 }
3452
wilc_network_info_received(struct wilc * wilc,u8 * pu8Buffer,u32 u32Length)3453 void wilc_network_info_received(struct wilc *wilc, u8 *pu8Buffer,
3454 u32 u32Length)
3455 {
3456 s32 result = 0;
3457 struct host_if_msg msg;
3458 int id;
3459 struct host_if_drv *hif_drv = NULL;
3460 struct wilc_vif *vif;
3461
3462 id = ((pu8Buffer[u32Length - 4]) | (pu8Buffer[u32Length - 3] << 8) | (pu8Buffer[u32Length - 2] << 16) | (pu8Buffer[u32Length - 1] << 24));
3463 vif = wilc_get_vif_from_idx(wilc, id);
3464 if (!vif)
3465 return;
3466 hif_drv = vif->hif_drv;
3467
3468 if (!hif_drv || hif_drv == terminated_handle) {
3469 netdev_err(vif->ndev, "driver not init[%p]\n", hif_drv);
3470 return;
3471 }
3472
3473 memset(&msg, 0, sizeof(struct host_if_msg));
3474
3475 msg.id = HOST_IF_MSG_RCVD_NTWRK_INFO;
3476 msg.vif = vif;
3477
3478 msg.body.net_info.len = u32Length;
3479 msg.body.net_info.buffer = kmalloc(u32Length, GFP_KERNEL);
3480 memcpy(msg.body.net_info.buffer, pu8Buffer, u32Length);
3481
3482 result = wilc_enqueue_cmd(&msg);
3483 if (result)
3484 netdev_err(vif->ndev, "message parameters (%d)\n", result);
3485 }
3486
wilc_gnrl_async_info_received(struct wilc * wilc,u8 * pu8Buffer,u32 u32Length)3487 void wilc_gnrl_async_info_received(struct wilc *wilc, u8 *pu8Buffer,
3488 u32 u32Length)
3489 {
3490 s32 result = 0;
3491 struct host_if_msg msg;
3492 int id;
3493 struct host_if_drv *hif_drv = NULL;
3494 struct wilc_vif *vif;
3495
3496 mutex_lock(&hif_deinit_lock);
3497
3498 id = ((pu8Buffer[u32Length - 4]) | (pu8Buffer[u32Length - 3] << 8) | (pu8Buffer[u32Length - 2] << 16) | (pu8Buffer[u32Length - 1] << 24));
3499 vif = wilc_get_vif_from_idx(wilc, id);
3500 if (!vif) {
3501 mutex_unlock(&hif_deinit_lock);
3502 return;
3503 }
3504
3505 hif_drv = vif->hif_drv;
3506
3507 if (!hif_drv || hif_drv == terminated_handle) {
3508 mutex_unlock(&hif_deinit_lock);
3509 return;
3510 }
3511
3512 if (!hif_drv->usr_conn_req.conn_result) {
3513 netdev_err(vif->ndev, "there is no current Connect Request\n");
3514 mutex_unlock(&hif_deinit_lock);
3515 return;
3516 }
3517
3518 memset(&msg, 0, sizeof(struct host_if_msg));
3519
3520 msg.id = HOST_IF_MSG_RCVD_GNRL_ASYNC_INFO;
3521 msg.vif = vif;
3522
3523 msg.body.async_info.len = u32Length;
3524 msg.body.async_info.buffer = kmalloc(u32Length, GFP_KERNEL);
3525 memcpy(msg.body.async_info.buffer, pu8Buffer, u32Length);
3526
3527 result = wilc_enqueue_cmd(&msg);
3528 if (result)
3529 netdev_err(vif->ndev, "synchronous info (%d)\n", result);
3530
3531 mutex_unlock(&hif_deinit_lock);
3532 }
3533
wilc_scan_complete_received(struct wilc * wilc,u8 * pu8Buffer,u32 u32Length)3534 void wilc_scan_complete_received(struct wilc *wilc, u8 *pu8Buffer,
3535 u32 u32Length)
3536 {
3537 s32 result = 0;
3538 struct host_if_msg msg;
3539 int id;
3540 struct host_if_drv *hif_drv = NULL;
3541 struct wilc_vif *vif;
3542
3543 id = ((pu8Buffer[u32Length - 4]) | (pu8Buffer[u32Length - 3] << 8) | (pu8Buffer[u32Length - 2] << 16) | (pu8Buffer[u32Length - 1] << 24));
3544 vif = wilc_get_vif_from_idx(wilc, id);
3545 if (!vif)
3546 return;
3547 hif_drv = vif->hif_drv;
3548
3549 if (!hif_drv || hif_drv == terminated_handle)
3550 return;
3551
3552 if (hif_drv->usr_scan_req.scan_result) {
3553 memset(&msg, 0, sizeof(struct host_if_msg));
3554
3555 msg.id = HOST_IF_MSG_RCVD_SCAN_COMPLETE;
3556 msg.vif = vif;
3557
3558 result = wilc_enqueue_cmd(&msg);
3559 if (result)
3560 netdev_err(vif->ndev, "complete param (%d)\n", result);
3561 }
3562 }
3563
wilc_remain_on_channel(struct wilc_vif * vif,u32 session_id,u32 duration,u16 chan,wilc_remain_on_chan_expired expired,wilc_remain_on_chan_ready ready,void * user_arg)3564 int wilc_remain_on_channel(struct wilc_vif *vif, u32 session_id,
3565 u32 duration, u16 chan,
3566 wilc_remain_on_chan_expired expired,
3567 wilc_remain_on_chan_ready ready,
3568 void *user_arg)
3569 {
3570 int result = 0;
3571 struct host_if_msg msg;
3572
3573 memset(&msg, 0, sizeof(struct host_if_msg));
3574
3575 msg.id = HOST_IF_MSG_REMAIN_ON_CHAN;
3576 msg.body.remain_on_ch.ch = chan;
3577 msg.body.remain_on_ch.expired = expired;
3578 msg.body.remain_on_ch.ready = ready;
3579 msg.body.remain_on_ch.arg = user_arg;
3580 msg.body.remain_on_ch.duration = duration;
3581 msg.body.remain_on_ch.id = session_id;
3582 msg.vif = vif;
3583
3584 result = wilc_enqueue_cmd(&msg);
3585 if (result)
3586 netdev_err(vif->ndev, "wilc mq send fail\n");
3587
3588 return result;
3589 }
3590
wilc_listen_state_expired(struct wilc_vif * vif,u32 session_id)3591 int wilc_listen_state_expired(struct wilc_vif *vif, u32 session_id)
3592 {
3593 int result = 0;
3594 struct host_if_msg msg;
3595 struct host_if_drv *hif_drv = vif->hif_drv;
3596
3597 if (!hif_drv) {
3598 netdev_err(vif->ndev, "driver is null\n");
3599 return -EFAULT;
3600 }
3601
3602 del_timer(&hif_drv->remain_on_ch_timer);
3603
3604 memset(&msg, 0, sizeof(struct host_if_msg));
3605 msg.id = HOST_IF_MSG_LISTEN_TIMER_FIRED;
3606 msg.vif = vif;
3607 msg.body.remain_on_ch.id = session_id;
3608
3609 result = wilc_enqueue_cmd(&msg);
3610 if (result)
3611 netdev_err(vif->ndev, "wilc mq send fail\n");
3612
3613 return result;
3614 }
3615
wilc_frame_register(struct wilc_vif * vif,u16 frame_type,bool reg)3616 int wilc_frame_register(struct wilc_vif *vif, u16 frame_type, bool reg)
3617 {
3618 int result = 0;
3619 struct host_if_msg msg;
3620
3621 memset(&msg, 0, sizeof(struct host_if_msg));
3622
3623 msg.id = HOST_IF_MSG_REGISTER_FRAME;
3624 switch (frame_type) {
3625 case ACTION:
3626 msg.body.reg_frame.reg_id = ACTION_FRM_IDX;
3627 break;
3628
3629 case PROBE_REQ:
3630 msg.body.reg_frame.reg_id = PROBE_REQ_IDX;
3631 break;
3632
3633 default:
3634 break;
3635 }
3636 msg.body.reg_frame.frame_type = frame_type;
3637 msg.body.reg_frame.reg = reg;
3638 msg.vif = vif;
3639
3640 result = wilc_enqueue_cmd(&msg);
3641 if (result)
3642 netdev_err(vif->ndev, "wilc mq send fail\n");
3643
3644 return result;
3645 }
3646
wilc_add_beacon(struct wilc_vif * vif,u32 interval,u32 dtim_period,u32 head_len,u8 * head,u32 tail_len,u8 * tail)3647 int wilc_add_beacon(struct wilc_vif *vif, u32 interval, u32 dtim_period,
3648 u32 head_len, u8 *head, u32 tail_len, u8 *tail)
3649 {
3650 int result = 0;
3651 struct host_if_msg msg;
3652 struct beacon_attr *beacon_info = &msg.body.beacon_info;
3653
3654 memset(&msg, 0, sizeof(struct host_if_msg));
3655
3656 msg.id = HOST_IF_MSG_ADD_BEACON;
3657 msg.vif = vif;
3658 beacon_info->interval = interval;
3659 beacon_info->dtim_period = dtim_period;
3660 beacon_info->head_len = head_len;
3661 beacon_info->head = kmemdup(head, head_len, GFP_KERNEL);
3662 if (!beacon_info->head) {
3663 result = -ENOMEM;
3664 goto ERRORHANDLER;
3665 }
3666 beacon_info->tail_len = tail_len;
3667
3668 if (tail_len > 0) {
3669 beacon_info->tail = kmemdup(tail, tail_len, GFP_KERNEL);
3670 if (!beacon_info->tail) {
3671 result = -ENOMEM;
3672 goto ERRORHANDLER;
3673 }
3674 } else {
3675 beacon_info->tail = NULL;
3676 }
3677
3678 result = wilc_enqueue_cmd(&msg);
3679 if (result)
3680 netdev_err(vif->ndev, "wilc mq send fail\n");
3681
3682 ERRORHANDLER:
3683 if (result) {
3684 kfree(beacon_info->head);
3685
3686 kfree(beacon_info->tail);
3687 }
3688
3689 return result;
3690 }
3691
wilc_del_beacon(struct wilc_vif * vif)3692 int wilc_del_beacon(struct wilc_vif *vif)
3693 {
3694 int result = 0;
3695 struct host_if_msg msg;
3696
3697 msg.id = HOST_IF_MSG_DEL_BEACON;
3698 msg.vif = vif;
3699
3700 result = wilc_enqueue_cmd(&msg);
3701 if (result)
3702 netdev_err(vif->ndev, "wilc_mq_send fail\n");
3703
3704 return result;
3705 }
3706
wilc_add_station(struct wilc_vif * vif,struct add_sta_param * sta_param)3707 int wilc_add_station(struct wilc_vif *vif, struct add_sta_param *sta_param)
3708 {
3709 int result = 0;
3710 struct host_if_msg msg;
3711 struct add_sta_param *add_sta_info = &msg.body.add_sta_info;
3712
3713 memset(&msg, 0, sizeof(struct host_if_msg));
3714
3715 msg.id = HOST_IF_MSG_ADD_STATION;
3716 msg.vif = vif;
3717
3718 memcpy(add_sta_info, sta_param, sizeof(struct add_sta_param));
3719 if (add_sta_info->rates_len > 0) {
3720 add_sta_info->rates = kmemdup(sta_param->rates,
3721 add_sta_info->rates_len,
3722 GFP_KERNEL);
3723 if (!add_sta_info->rates)
3724 return -ENOMEM;
3725 }
3726
3727 result = wilc_enqueue_cmd(&msg);
3728 if (result)
3729 netdev_err(vif->ndev, "wilc_mq_send fail\n");
3730 return result;
3731 }
3732
wilc_del_station(struct wilc_vif * vif,const u8 * mac_addr)3733 int wilc_del_station(struct wilc_vif *vif, const u8 *mac_addr)
3734 {
3735 int result = 0;
3736 struct host_if_msg msg;
3737 struct del_sta *del_sta_info = &msg.body.del_sta_info;
3738
3739 memset(&msg, 0, sizeof(struct host_if_msg));
3740
3741 msg.id = HOST_IF_MSG_DEL_STATION;
3742 msg.vif = vif;
3743
3744 if (!mac_addr)
3745 eth_broadcast_addr(del_sta_info->mac_addr);
3746 else
3747 memcpy(del_sta_info->mac_addr, mac_addr, ETH_ALEN);
3748
3749 result = wilc_enqueue_cmd(&msg);
3750 if (result)
3751 netdev_err(vif->ndev, "wilc_mq_send fail\n");
3752 return result;
3753 }
3754
wilc_del_allstation(struct wilc_vif * vif,u8 mac_addr[][ETH_ALEN])3755 int wilc_del_allstation(struct wilc_vif *vif, u8 mac_addr[][ETH_ALEN])
3756 {
3757 int result = 0;
3758 struct host_if_msg msg;
3759 struct del_all_sta *del_all_sta_info = &msg.body.del_all_sta_info;
3760 u8 zero_addr[ETH_ALEN] = {0};
3761 int i;
3762 u8 assoc_sta = 0;
3763
3764 memset(&msg, 0, sizeof(struct host_if_msg));
3765
3766 msg.id = HOST_IF_MSG_DEL_ALL_STA;
3767 msg.vif = vif;
3768
3769 for (i = 0; i < MAX_NUM_STA; i++) {
3770 if (memcmp(mac_addr[i], zero_addr, ETH_ALEN)) {
3771 memcpy(del_all_sta_info->del_all_sta[i], mac_addr[i], ETH_ALEN);
3772 assoc_sta++;
3773 }
3774 }
3775 if (!assoc_sta)
3776 return result;
3777
3778 del_all_sta_info->assoc_sta = assoc_sta;
3779 result = wilc_enqueue_cmd(&msg);
3780
3781 if (result)
3782 netdev_err(vif->ndev, "wilc_mq_send fail\n");
3783 else
3784 wait_for_completion(&hif_wait_response);
3785
3786 return result;
3787 }
3788
wilc_edit_station(struct wilc_vif * vif,struct add_sta_param * sta_param)3789 int wilc_edit_station(struct wilc_vif *vif,
3790 struct add_sta_param *sta_param)
3791 {
3792 int result = 0;
3793 struct host_if_msg msg;
3794 struct add_sta_param *add_sta_info = &msg.body.add_sta_info;
3795
3796 memset(&msg, 0, sizeof(struct host_if_msg));
3797
3798 msg.id = HOST_IF_MSG_EDIT_STATION;
3799 msg.vif = vif;
3800
3801 memcpy(add_sta_info, sta_param, sizeof(struct add_sta_param));
3802 if (add_sta_info->rates_len > 0) {
3803 add_sta_info->rates = kmemdup(sta_param->rates,
3804 add_sta_info->rates_len,
3805 GFP_KERNEL);
3806 if (!add_sta_info->rates)
3807 return -ENOMEM;
3808 }
3809
3810 result = wilc_enqueue_cmd(&msg);
3811 if (result)
3812 netdev_err(vif->ndev, "wilc_mq_send fail\n");
3813
3814 return result;
3815 }
3816
wilc_set_power_mgmt(struct wilc_vif * vif,bool enabled,u32 timeout)3817 int wilc_set_power_mgmt(struct wilc_vif *vif, bool enabled, u32 timeout)
3818 {
3819 int result = 0;
3820 struct host_if_msg msg;
3821 struct power_mgmt_param *pwr_mgmt_info = &msg.body.pwr_mgmt_info;
3822
3823 if (wilc_wlan_get_num_conn_ifcs(vif->wilc) == 2 && enabled)
3824 return 0;
3825
3826 memset(&msg, 0, sizeof(struct host_if_msg));
3827
3828 msg.id = HOST_IF_MSG_POWER_MGMT;
3829 msg.vif = vif;
3830
3831 pwr_mgmt_info->enabled = enabled;
3832 pwr_mgmt_info->timeout = timeout;
3833
3834 result = wilc_enqueue_cmd(&msg);
3835 if (result)
3836 netdev_err(vif->ndev, "wilc_mq_send fail\n");
3837 return result;
3838 }
3839
wilc_setup_multicast_filter(struct wilc_vif * vif,bool enabled,u32 count)3840 int wilc_setup_multicast_filter(struct wilc_vif *vif, bool enabled,
3841 u32 count)
3842 {
3843 int result = 0;
3844 struct host_if_msg msg;
3845 struct set_multicast *multicast_filter_param = &msg.body.multicast_info;
3846
3847 memset(&msg, 0, sizeof(struct host_if_msg));
3848
3849 msg.id = HOST_IF_MSG_SET_MULTICAST_FILTER;
3850 msg.vif = vif;
3851
3852 multicast_filter_param->enabled = enabled;
3853 multicast_filter_param->cnt = count;
3854
3855 result = wilc_enqueue_cmd(&msg);
3856 if (result)
3857 netdev_err(vif->ndev, "wilc_mq_send fail\n");
3858 return result;
3859 }
3860
host_int_ParseJoinBssParam(struct network_info * ptstrNetworkInfo)3861 static void *host_int_ParseJoinBssParam(struct network_info *ptstrNetworkInfo)
3862 {
3863 struct join_bss_param *pNewJoinBssParam = NULL;
3864 u8 *pu8IEs;
3865 u16 u16IEsLen;
3866 u16 index = 0;
3867 u8 suppRatesNo = 0;
3868 u8 extSuppRatesNo;
3869 u16 jumpOffset;
3870 u8 pcipherCount;
3871 u8 authCount;
3872 u8 pcipherTotalCount = 0;
3873 u8 authTotalCount = 0;
3874 u8 i, j;
3875
3876 pu8IEs = ptstrNetworkInfo->ies;
3877 u16IEsLen = ptstrNetworkInfo->ies_len;
3878
3879 pNewJoinBssParam = kzalloc(sizeof(*pNewJoinBssParam), GFP_KERNEL);
3880 if (pNewJoinBssParam) {
3881 pNewJoinBssParam->dtim_period = ptstrNetworkInfo->dtim_period;
3882 pNewJoinBssParam->beacon_period = ptstrNetworkInfo->beacon_period;
3883 pNewJoinBssParam->cap_info = ptstrNetworkInfo->cap_info;
3884 memcpy(pNewJoinBssParam->bssid, ptstrNetworkInfo->bssid, 6);
3885 memcpy((u8 *)pNewJoinBssParam->ssid, ptstrNetworkInfo->ssid,
3886 ptstrNetworkInfo->ssid_len + 1);
3887 pNewJoinBssParam->ssid_len = ptstrNetworkInfo->ssid_len;
3888 memset(pNewJoinBssParam->rsn_pcip_policy, 0xFF, 3);
3889 memset(pNewJoinBssParam->rsn_auth_policy, 0xFF, 3);
3890
3891 while (index < u16IEsLen) {
3892 if (pu8IEs[index] == SUPP_RATES_IE) {
3893 suppRatesNo = pu8IEs[index + 1];
3894 pNewJoinBssParam->supp_rates[0] = suppRatesNo;
3895 index += 2;
3896
3897 for (i = 0; i < suppRatesNo; i++)
3898 pNewJoinBssParam->supp_rates[i + 1] = pu8IEs[index + i];
3899
3900 index += suppRatesNo;
3901 continue;
3902 } else if (pu8IEs[index] == EXT_SUPP_RATES_IE) {
3903 extSuppRatesNo = pu8IEs[index + 1];
3904 if (extSuppRatesNo > (MAX_RATES_SUPPORTED - suppRatesNo))
3905 pNewJoinBssParam->supp_rates[0] = MAX_RATES_SUPPORTED;
3906 else
3907 pNewJoinBssParam->supp_rates[0] += extSuppRatesNo;
3908 index += 2;
3909 for (i = 0; i < (pNewJoinBssParam->supp_rates[0] - suppRatesNo); i++)
3910 pNewJoinBssParam->supp_rates[suppRatesNo + i + 1] = pu8IEs[index + i];
3911
3912 index += extSuppRatesNo;
3913 continue;
3914 } else if (pu8IEs[index] == HT_CAPABILITY_IE) {
3915 pNewJoinBssParam->ht_capable = true;
3916 index += pu8IEs[index + 1] + 2;
3917 continue;
3918 } else if ((pu8IEs[index] == WMM_IE) &&
3919 (pu8IEs[index + 2] == 0x00) && (pu8IEs[index + 3] == 0x50) &&
3920 (pu8IEs[index + 4] == 0xF2) &&
3921 (pu8IEs[index + 5] == 0x02) &&
3922 ((pu8IEs[index + 6] == 0x00) || (pu8IEs[index + 6] == 0x01)) &&
3923 (pu8IEs[index + 7] == 0x01)) {
3924 pNewJoinBssParam->wmm_cap = true;
3925
3926 if (pu8IEs[index + 8] & BIT(7))
3927 pNewJoinBssParam->uapsd_cap = true;
3928 index += pu8IEs[index + 1] + 2;
3929 continue;
3930 } else if ((pu8IEs[index] == P2P_IE) &&
3931 (pu8IEs[index + 2] == 0x50) && (pu8IEs[index + 3] == 0x6f) &&
3932 (pu8IEs[index + 4] == 0x9a) &&
3933 (pu8IEs[index + 5] == 0x09) && (pu8IEs[index + 6] == 0x0c)) {
3934 u16 u16P2P_count;
3935
3936 pNewJoinBssParam->tsf = ptstrNetworkInfo->tsf_lo;
3937 pNewJoinBssParam->noa_enabled = 1;
3938 pNewJoinBssParam->idx = pu8IEs[index + 9];
3939
3940 if (pu8IEs[index + 10] & BIT(7)) {
3941 pNewJoinBssParam->opp_enabled = 1;
3942 pNewJoinBssParam->ct_window = pu8IEs[index + 10];
3943 } else {
3944 pNewJoinBssParam->opp_enabled = 0;
3945 }
3946
3947 pNewJoinBssParam->cnt = pu8IEs[index + 11];
3948 u16P2P_count = index + 12;
3949
3950 memcpy(pNewJoinBssParam->duration, pu8IEs + u16P2P_count, 4);
3951 u16P2P_count += 4;
3952
3953 memcpy(pNewJoinBssParam->interval, pu8IEs + u16P2P_count, 4);
3954 u16P2P_count += 4;
3955
3956 memcpy(pNewJoinBssParam->start_time, pu8IEs + u16P2P_count, 4);
3957
3958 index += pu8IEs[index + 1] + 2;
3959 continue;
3960
3961 } else if ((pu8IEs[index] == RSN_IE) ||
3962 ((pu8IEs[index] == WPA_IE) && (pu8IEs[index + 2] == 0x00) &&
3963 (pu8IEs[index + 3] == 0x50) && (pu8IEs[index + 4] == 0xF2) &&
3964 (pu8IEs[index + 5] == 0x01))) {
3965 u16 rsnIndex = index;
3966
3967 if (pu8IEs[rsnIndex] == RSN_IE) {
3968 pNewJoinBssParam->mode_802_11i = 2;
3969 } else {
3970 if (pNewJoinBssParam->mode_802_11i == 0)
3971 pNewJoinBssParam->mode_802_11i = 1;
3972 rsnIndex += 4;
3973 }
3974
3975 rsnIndex += 7;
3976 pNewJoinBssParam->rsn_grp_policy = pu8IEs[rsnIndex];
3977 rsnIndex++;
3978 jumpOffset = pu8IEs[rsnIndex] * 4;
3979 pcipherCount = (pu8IEs[rsnIndex] > 3) ? 3 : pu8IEs[rsnIndex];
3980 rsnIndex += 2;
3981
3982 for (i = pcipherTotalCount, j = 0; i < pcipherCount + pcipherTotalCount && i < 3; i++, j++)
3983 pNewJoinBssParam->rsn_pcip_policy[i] = pu8IEs[rsnIndex + ((j + 1) * 4) - 1];
3984
3985 pcipherTotalCount += pcipherCount;
3986 rsnIndex += jumpOffset;
3987
3988 jumpOffset = pu8IEs[rsnIndex] * 4;
3989
3990 authCount = (pu8IEs[rsnIndex] > 3) ? 3 : pu8IEs[rsnIndex];
3991 rsnIndex += 2;
3992
3993 for (i = authTotalCount, j = 0; i < authTotalCount + authCount; i++, j++)
3994 pNewJoinBssParam->rsn_auth_policy[i] = pu8IEs[rsnIndex + ((j + 1) * 4) - 1];
3995
3996 authTotalCount += authCount;
3997 rsnIndex += jumpOffset;
3998
3999 if (pu8IEs[index] == RSN_IE) {
4000 pNewJoinBssParam->rsn_cap[0] = pu8IEs[rsnIndex];
4001 pNewJoinBssParam->rsn_cap[1] = pu8IEs[rsnIndex + 1];
4002 rsnIndex += 2;
4003 }
4004 pNewJoinBssParam->rsn_found = true;
4005 index += pu8IEs[index + 1] + 2;
4006 continue;
4007 } else
4008 index += pu8IEs[index + 1] + 2;
4009 }
4010 }
4011
4012 return (void *)pNewJoinBssParam;
4013 }
4014
wilc_setup_ipaddress(struct wilc_vif * vif,u8 * ip_addr,u8 idx)4015 int wilc_setup_ipaddress(struct wilc_vif *vif, u8 *ip_addr, u8 idx)
4016 {
4017 int result = 0;
4018 struct host_if_msg msg;
4019
4020 memset(&msg, 0, sizeof(struct host_if_msg));
4021
4022 msg.id = HOST_IF_MSG_SET_IPADDRESS;
4023
4024 msg.body.ip_info.ip_addr = ip_addr;
4025 msg.vif = vif;
4026 msg.body.ip_info.idx = idx;
4027
4028 result = wilc_enqueue_cmd(&msg);
4029 if (result)
4030 netdev_err(vif->ndev, "wilc_mq_send fail\n");
4031
4032 return result;
4033 }
4034
host_int_get_ipaddress(struct wilc_vif * vif,u8 * ip_addr,u8 idx)4035 static int host_int_get_ipaddress(struct wilc_vif *vif, u8 *ip_addr, u8 idx)
4036 {
4037 int result = 0;
4038 struct host_if_msg msg;
4039
4040 memset(&msg, 0, sizeof(struct host_if_msg));
4041
4042 msg.id = HOST_IF_MSG_GET_IPADDRESS;
4043
4044 msg.body.ip_info.ip_addr = ip_addr;
4045 msg.vif = vif;
4046 msg.body.ip_info.idx = idx;
4047
4048 result = wilc_enqueue_cmd(&msg);
4049 if (result)
4050 netdev_err(vif->ndev, "wilc_mq_send fail\n");
4051
4052 return result;
4053 }
4054
wilc_set_tx_power(struct wilc_vif * vif,u8 tx_power)4055 int wilc_set_tx_power(struct wilc_vif *vif, u8 tx_power)
4056 {
4057 int ret = 0;
4058 struct host_if_msg msg;
4059
4060 memset(&msg, 0, sizeof(struct host_if_msg));
4061
4062 msg.id = HOST_IF_MSG_SET_TX_POWER;
4063 msg.body.tx_power.tx_pwr = tx_power;
4064 msg.vif = vif;
4065
4066 ret = wilc_enqueue_cmd(&msg);
4067 if (ret)
4068 netdev_err(vif->ndev, "wilc_mq_send fail\n");
4069
4070 return ret;
4071 }
4072
wilc_get_tx_power(struct wilc_vif * vif,u8 * tx_power)4073 int wilc_get_tx_power(struct wilc_vif *vif, u8 *tx_power)
4074 {
4075 int ret = 0;
4076 struct host_if_msg msg;
4077
4078 memset(&msg, 0, sizeof(struct host_if_msg));
4079
4080 msg.id = HOST_IF_MSG_GET_TX_POWER;
4081 msg.vif = vif;
4082
4083 ret = wilc_enqueue_cmd(&msg);
4084 if (ret)
4085 netdev_err(vif->ndev, "Failed to get TX PWR\n");
4086
4087 wait_for_completion(&hif_wait_response);
4088 *tx_power = msg.body.tx_power.tx_pwr;
4089
4090 return ret;
4091 }
4092