projects / deliverable / linux.git / blob
? search:


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