These changes are the raw update to linux-4.4.6-rt14. Kernel sources
[kvmfornfv.git] / kernel / drivers / staging / rtl8192e / rtl8192e / rtl_wx.c
1 /******************************************************************************
2  * Copyright(c) 2008 - 2010 Realtek Corporation. All rights reserved.
3  *
4  * This program is distributed in the hope that it will be useful, but WITHOUT
5  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
6  * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
7  * more details.
8  *
9  * The full GNU General Public License is included in this distribution in the
10  * file called LICENSE.
11  *
12  * Contact Information:
13  * wlanfae <wlanfae@realtek.com>
14 ******************************************************************************/
15
16 #include <linux/string.h>
17 #include "rtl_core.h"
18 #include "rtl_wx.h"
19
20 #define RATE_COUNT 12
21 static u32 rtl8192_rates[] = {
22         1000000, 2000000, 5500000, 11000000, 6000000, 9000000, 12000000,
23         18000000, 24000000, 36000000, 48000000, 54000000
24 };
25
26 #ifndef ENETDOWN
27 #define ENETDOWN 1
28 #endif
29
30 static int _rtl92e_wx_get_freq(struct net_device *dev,
31                                struct iw_request_info *a,
32                                union iwreq_data *wrqu, char *b)
33 {
34         struct r8192_priv *priv = rtllib_priv(dev);
35
36         return rtllib_wx_get_freq(priv->rtllib, a, wrqu, b);
37 }
38
39
40 static int _rtl92e_wx_get_mode(struct net_device *dev,
41                                struct iw_request_info *a,
42                                union iwreq_data *wrqu, char *b)
43 {
44         struct r8192_priv *priv = rtllib_priv(dev);
45
46         return rtllib_wx_get_mode(priv->rtllib, a, wrqu, b);
47 }
48
49 static int _rtl92e_wx_get_rate(struct net_device *dev,
50                                struct iw_request_info *info,
51                                union iwreq_data *wrqu, char *extra)
52 {
53         struct r8192_priv *priv = rtllib_priv(dev);
54
55         return rtllib_wx_get_rate(priv->rtllib, info, wrqu, extra);
56 }
57
58 static int _rtl92e_wx_set_rate(struct net_device *dev,
59                                struct iw_request_info *info,
60                                union iwreq_data *wrqu, char *extra)
61 {
62         int ret;
63         struct r8192_priv *priv = rtllib_priv(dev);
64
65         if (priv->bHwRadioOff)
66                 return 0;
67
68         down(&priv->wx_sem);
69
70         ret = rtllib_wx_set_rate(priv->rtllib, info, wrqu, extra);
71
72         up(&priv->wx_sem);
73
74         return ret;
75 }
76
77 static int _rtl92e_wx_set_rts(struct net_device *dev,
78                               struct iw_request_info *info,
79                               union iwreq_data *wrqu, char *extra)
80 {
81         int ret;
82         struct r8192_priv *priv = rtllib_priv(dev);
83
84         if (priv->bHwRadioOff)
85                 return 0;
86
87         down(&priv->wx_sem);
88
89         ret = rtllib_wx_set_rts(priv->rtllib, info, wrqu, extra);
90
91         up(&priv->wx_sem);
92
93         return ret;
94 }
95
96 static int _rtl92e_wx_get_rts(struct net_device *dev,
97                               struct iw_request_info *info,
98                               union iwreq_data *wrqu, char *extra)
99 {
100         struct r8192_priv *priv = rtllib_priv(dev);
101
102         return rtllib_wx_get_rts(priv->rtllib, info, wrqu, extra);
103 }
104
105 static int _rtl92e_wx_set_power(struct net_device *dev,
106                                 struct iw_request_info *info,
107                                 union iwreq_data *wrqu, char *extra)
108 {
109         int ret;
110         struct r8192_priv *priv = rtllib_priv(dev);
111
112         if (priv->bHwRadioOff) {
113                 netdev_warn(dev, "%s(): Can't set Power: Radio is Off.\n",
114                             __func__);
115                 return 0;
116         }
117         down(&priv->wx_sem);
118
119         ret = rtllib_wx_set_power(priv->rtllib, info, wrqu, extra);
120
121         up(&priv->wx_sem);
122
123         return ret;
124 }
125
126 static int _rtl92e_wx_get_power(struct net_device *dev,
127                                 struct iw_request_info *info,
128                                 union iwreq_data *wrqu, char *extra)
129 {
130         struct r8192_priv *priv = rtllib_priv(dev);
131
132         return rtllib_wx_get_power(priv->rtllib, info, wrqu, extra);
133 }
134
135 static int _rtl92e_wx_set_rawtx(struct net_device *dev,
136                                 struct iw_request_info *info,
137                                 union iwreq_data *wrqu, char *extra)
138 {
139         struct r8192_priv *priv = rtllib_priv(dev);
140         int ret;
141
142         if (priv->bHwRadioOff)
143                 return 0;
144
145         down(&priv->wx_sem);
146
147         ret = rtllib_wx_set_rawtx(priv->rtllib, info, wrqu, extra);
148
149         up(&priv->wx_sem);
150
151         return ret;
152
153 }
154
155 static int _rtl92e_wx_force_reset(struct net_device *dev,
156                                   struct iw_request_info *info,
157                                   union iwreq_data *wrqu, char *extra)
158 {
159         struct r8192_priv *priv = rtllib_priv(dev);
160
161         down(&priv->wx_sem);
162
163         RT_TRACE(COMP_DBG, "%s(): force reset ! extra is %d\n",
164                  __func__, *extra);
165         priv->force_reset = *extra;
166         up(&priv->wx_sem);
167         return 0;
168
169 }
170
171 static int _rtl92e_wx_adapter_power_status(struct net_device *dev,
172                                            struct iw_request_info *info,
173                                            union iwreq_data *wrqu, char *extra)
174 {
175         struct r8192_priv *priv = rtllib_priv(dev);
176         struct rt_pwr_save_ctrl *pPSC = (struct rt_pwr_save_ctrl *)
177                                         (&(priv->rtllib->PowerSaveControl));
178         struct rtllib_device *ieee = priv->rtllib;
179
180         down(&priv->wx_sem);
181
182         RT_TRACE(COMP_POWER, "%s(): %s\n", __func__, (*extra == 6) ?
183                  "DC power" : "AC power");
184         if (*extra || priv->force_lps) {
185                 priv->ps_force = false;
186                 pPSC->bLeisurePs = true;
187         } else {
188                 if (priv->rtllib->state == RTLLIB_LINKED)
189                         rtl92e_leisure_ps_leave(dev);
190
191                 priv->ps_force = true;
192                 pPSC->bLeisurePs = false;
193                 ieee->ps = *extra;
194         }
195
196         up(&priv->wx_sem);
197
198         return 0;
199 }
200
201 static int _rtl92e_wx_set_lps_awake_interval(struct net_device *dev,
202                                              struct iw_request_info *info,
203                                              union iwreq_data *wrqu,
204                                              char *extra)
205 {
206         struct r8192_priv *priv = rtllib_priv(dev);
207         struct rt_pwr_save_ctrl *pPSC = (struct rt_pwr_save_ctrl *)
208                                         (&(priv->rtllib->PowerSaveControl));
209
210         down(&priv->wx_sem);
211
212         netdev_info(dev, "%s(): set lps awake interval ! extra is %d\n",
213                     __func__, *extra);
214
215         pPSC->RegMaxLPSAwakeIntvl = *extra;
216         up(&priv->wx_sem);
217         return 0;
218 }
219
220 static int _rtl92e_wx_set_force_lps(struct net_device *dev,
221                                     struct iw_request_info *info,
222                                     union iwreq_data *wrqu, char *extra)
223 {
224         struct r8192_priv *priv = rtllib_priv(dev);
225
226         down(&priv->wx_sem);
227
228         netdev_info(dev,
229                     "%s(): force LPS ! extra is %d (1 is open 0 is close)\n",
230                     __func__, *extra);
231         priv->force_lps = *extra;
232         up(&priv->wx_sem);
233         return 0;
234
235 }
236
237 static int _rtl92e_wx_set_debug(struct net_device *dev,
238                                 struct iw_request_info *info,
239                                 union iwreq_data *wrqu, char *extra)
240 {
241         struct r8192_priv *priv = rtllib_priv(dev);
242         u8 c = *extra;
243
244         if (priv->bHwRadioOff)
245                 return 0;
246
247         netdev_info(dev, "=====>%s(), *extra:%x, debugflag:%x\n", __func__,
248                     *extra, rt_global_debug_component);
249         if (c > 0)
250                 rt_global_debug_component |= (1<<c);
251         else
252                 rt_global_debug_component &= BIT31;
253         return 0;
254 }
255
256 static int _rtl92e_wx_set_mode(struct net_device *dev,
257                                struct iw_request_info *a,
258                                union iwreq_data *wrqu, char *b)
259 {
260         struct r8192_priv *priv = rtllib_priv(dev);
261         struct rtllib_device *ieee = netdev_priv_rsl(dev);
262
263         enum rt_rf_power_state rtState;
264         int ret;
265
266         if (priv->bHwRadioOff)
267                 return 0;
268         rtState = priv->rtllib->eRFPowerState;
269         down(&priv->wx_sem);
270         if (wrqu->mode == IW_MODE_ADHOC || wrqu->mode == IW_MODE_MONITOR ||
271             ieee->bNetPromiscuousMode) {
272                 if (priv->rtllib->PowerSaveControl.bInactivePs) {
273                         if (rtState == eRfOff) {
274                                 if (priv->rtllib->RfOffReason >
275                                     RF_CHANGE_BY_IPS) {
276                                         netdev_warn(dev, "%s(): RF is OFF.\n",
277                                                     __func__);
278                                         up(&priv->wx_sem);
279                                         return -1;
280                                 }
281                                 netdev_info(dev,
282                                             "=========>%s(): rtl92e_ips_leave\n",
283                                             __func__);
284                                 down(&priv->rtllib->ips_sem);
285                                 rtl92e_ips_leave(dev);
286                                 up(&priv->rtllib->ips_sem);
287                         }
288                 }
289         }
290         ret = rtllib_wx_set_mode(priv->rtllib, a, wrqu, b);
291
292         up(&priv->wx_sem);
293         return ret;
294 }
295
296 struct  iw_range_with_scan_capa {
297         /* Informative stuff (to choose between different interface) */
298         __u32      throughput;     /* To give an idea... */
299         /* In theory this value should be the maximum benchmarked
300          * TCP/IP throughput, because with most of these devices the
301          * bit rate is meaningless (overhead an co) to estimate how
302          * fast the connection will go and pick the fastest one.
303          * I suggest people to play with Netperf or any benchmark...
304          */
305
306         /* NWID (or domain id) */
307         __u32      min_nwid;    /* Minimal NWID we are able to set */
308         __u32      max_nwid;    /* Maximal NWID we are able to set */
309
310         /* Old Frequency (backward compat - moved lower ) */
311         __u16      old_num_channels;
312         __u8        old_num_frequency;
313
314         /* Scan capabilities */
315         __u8        scan_capa;
316 };
317
318 static int _rtl92e_wx_get_range(struct net_device *dev,
319                                 struct iw_request_info *info,
320                                 union iwreq_data *wrqu, char *extra)
321 {
322         struct iw_range *range = (struct iw_range *)extra;
323         struct r8192_priv *priv = rtllib_priv(dev);
324         u16 val;
325         int i;
326
327         wrqu->data.length = sizeof(*range);
328         memset(range, 0, sizeof(*range));
329
330         /* ~130 Mb/s real (802.11n) */
331         range->throughput = 130 * 1000 * 1000;
332
333         if (priv->rf_set_sens != NULL)
334                 /* signal level threshold range */
335                 range->sensitivity = priv->max_sens;
336
337         range->max_qual.qual = 100;
338         range->max_qual.level = 0;
339         range->max_qual.noise = 0;
340         range->max_qual.updated = 7; /* Updated all three */
341
342         range->avg_qual.qual = 70; /* > 8% missed beacons is 'bad' */
343         range->avg_qual.level = 0;
344         range->avg_qual.noise = 0;
345         range->avg_qual.updated = 7; /* Updated all three */
346
347         range->num_bitrates = min(RATE_COUNT, IW_MAX_BITRATES);
348
349         for (i = 0; i < range->num_bitrates; i++)
350                 range->bitrate[i] = rtl8192_rates[i];
351
352         range->max_rts = DEFAULT_RTS_THRESHOLD;
353         range->min_frag = MIN_FRAG_THRESHOLD;
354         range->max_frag = MAX_FRAG_THRESHOLD;
355
356         range->min_pmp = 0;
357         range->max_pmp = 5000000;
358         range->min_pmt = 0;
359         range->max_pmt = 65535*1000;
360         range->pmp_flags = IW_POWER_PERIOD;
361         range->pmt_flags = IW_POWER_TIMEOUT;
362         range->pm_capa = IW_POWER_PERIOD | IW_POWER_TIMEOUT | IW_POWER_ALL_R;
363         range->we_version_compiled = WIRELESS_EXT;
364         range->we_version_source = 18;
365
366         for (i = 0, val = 0; i < 14; i++) {
367                 if ((priv->rtllib->active_channel_map)[i+1]) {
368                         range->freq[val].i = i + 1;
369                         range->freq[val].m = rtllib_wlan_frequencies[i] *
370                                              100000;
371                         range->freq[val].e = 1;
372                         val++;
373                 }
374
375                 if (val == IW_MAX_FREQUENCIES)
376                         break;
377         }
378         range->num_frequency = val;
379         range->num_channels = val;
380         range->enc_capa = IW_ENC_CAPA_WPA|IW_ENC_CAPA_WPA2|
381                           IW_ENC_CAPA_CIPHER_TKIP|IW_ENC_CAPA_CIPHER_CCMP;
382         range->scan_capa = IW_SCAN_CAPA_ESSID | IW_SCAN_CAPA_TYPE;
383
384         /* Event capability (kernel + driver) */
385
386         return 0;
387 }
388
389 static int _rtl92e_wx_set_scan(struct net_device *dev,
390                                struct iw_request_info *a,
391                                union iwreq_data *wrqu, char *b)
392 {
393         struct r8192_priv *priv = rtllib_priv(dev);
394         struct rtllib_device *ieee = priv->rtllib;
395         enum rt_rf_power_state rtState;
396         int ret;
397
398         if (!(ieee->softmac_features & IEEE_SOFTMAC_SCAN)) {
399                 if ((ieee->state >= RTLLIB_ASSOCIATING) &&
400                     (ieee->state <= RTLLIB_ASSOCIATING_AUTHENTICATED))
401                         return 0;
402                 if ((priv->rtllib->state == RTLLIB_LINKED) &&
403                     (priv->rtllib->CntAfterLink < 2))
404                         return 0;
405         }
406
407         if (priv->bHwRadioOff) {
408                 netdev_info(dev, "================>%s(): hwradio off\n",
409                             __func__);
410                 return 0;
411         }
412         rtState = priv->rtllib->eRFPowerState;
413         if (!priv->up)
414                 return -ENETDOWN;
415         if (priv->rtllib->LinkDetectInfo.bBusyTraffic == true)
416                 return -EAGAIN;
417
418         if (wrqu->data.flags & IW_SCAN_THIS_ESSID) {
419                 struct iw_scan_req *req = (struct iw_scan_req *)b;
420
421                 if (req->essid_len) {
422                         ieee->current_network.ssid_len = req->essid_len;
423                         memcpy(ieee->current_network.ssid, req->essid,
424                                req->essid_len);
425                 }
426         }
427
428         down(&priv->wx_sem);
429
430         priv->rtllib->FirstIe_InScan = true;
431
432         if (priv->rtllib->state != RTLLIB_LINKED) {
433                 if (priv->rtllib->PowerSaveControl.bInactivePs) {
434                         if (rtState == eRfOff) {
435                                 if (priv->rtllib->RfOffReason >
436                                     RF_CHANGE_BY_IPS) {
437                                         netdev_warn(dev, "%s(): RF is OFF.\n",
438                                                     __func__);
439                                         up(&priv->wx_sem);
440                                         return -1;
441                                 }
442                                 RT_TRACE(COMP_PS,
443                                          "=========>%s(): rtl92e_ips_leave\n",
444                                          __func__);
445                                 down(&priv->rtllib->ips_sem);
446                                 rtl92e_ips_leave(dev);
447                                 up(&priv->rtllib->ips_sem);
448                         }
449                 }
450                 rtllib_stop_scan(priv->rtllib);
451                 if (priv->rtllib->LedControlHandler)
452                         priv->rtllib->LedControlHandler(dev,
453                                                          LED_CTL_SITE_SURVEY);
454
455                 if (priv->rtllib->eRFPowerState != eRfOff) {
456                         priv->rtllib->actscanning = true;
457
458                         if (ieee->ScanOperationBackupHandler)
459                                 ieee->ScanOperationBackupHandler(ieee->dev,
460                                                          SCAN_OPT_BACKUP);
461
462                         rtllib_start_scan_syncro(priv->rtllib, 0);
463
464                         if (ieee->ScanOperationBackupHandler)
465                                 ieee->ScanOperationBackupHandler(ieee->dev,
466                                                          SCAN_OPT_RESTORE);
467                 }
468                 ret = 0;
469         } else {
470                 priv->rtllib->actscanning = true;
471                 ret = rtllib_wx_set_scan(priv->rtllib, a, wrqu, b);
472         }
473
474         up(&priv->wx_sem);
475         return ret;
476 }
477
478
479 static int _rtl92e_wx_get_scan(struct net_device *dev,
480                                struct iw_request_info *a,
481                                union iwreq_data *wrqu, char *b)
482 {
483
484         int ret;
485         struct r8192_priv *priv = rtllib_priv(dev);
486
487         if (!priv->up)
488                 return -ENETDOWN;
489
490         if (priv->bHwRadioOff)
491                 return 0;
492
493
494         down(&priv->wx_sem);
495
496         ret = rtllib_wx_get_scan(priv->rtllib, a, wrqu, b);
497
498         up(&priv->wx_sem);
499
500         return ret;
501 }
502
503 static int _rtl92e_wx_set_essid(struct net_device *dev,
504                                 struct iw_request_info *a,
505                                 union iwreq_data *wrqu, char *b)
506 {
507         struct r8192_priv *priv = rtllib_priv(dev);
508         int ret;
509
510         if (priv->bHwRadioOff) {
511                 netdev_info(dev,
512                             "=========>%s():hw radio off,or Rf state is eRfOff, return\n",
513                             __func__);
514                 return 0;
515         }
516         down(&priv->wx_sem);
517         ret = rtllib_wx_set_essid(priv->rtllib, a, wrqu, b);
518
519         up(&priv->wx_sem);
520
521         return ret;
522 }
523
524 static int _rtl92e_wx_get_essid(struct net_device *dev,
525                                 struct iw_request_info *a,
526                                 union iwreq_data *wrqu, char *b)
527 {
528         int ret;
529         struct r8192_priv *priv = rtllib_priv(dev);
530
531         down(&priv->wx_sem);
532
533         ret = rtllib_wx_get_essid(priv->rtllib, a, wrqu, b);
534
535         up(&priv->wx_sem);
536
537         return ret;
538 }
539
540 static int _rtl92e_wx_set_nick(struct net_device *dev,
541                                struct iw_request_info *info,
542                                union iwreq_data *wrqu, char *extra)
543 {
544         struct r8192_priv *priv = rtllib_priv(dev);
545
546         if (wrqu->data.length > IW_ESSID_MAX_SIZE)
547                 return -E2BIG;
548         down(&priv->wx_sem);
549         wrqu->data.length = min_t(size_t, wrqu->data.length,
550                                   sizeof(priv->nick));
551         memset(priv->nick, 0, sizeof(priv->nick));
552         memcpy(priv->nick, extra, wrqu->data.length);
553         up(&priv->wx_sem);
554         return 0;
555
556 }
557
558 static int _rtl92e_wx_get_nick(struct net_device *dev,
559                                struct iw_request_info *info,
560                                union iwreq_data *wrqu, char *extra)
561 {
562         struct r8192_priv *priv = rtllib_priv(dev);
563
564         down(&priv->wx_sem);
565         wrqu->data.length = strlen(priv->nick);
566         memcpy(extra, priv->nick, wrqu->data.length);
567         wrqu->data.flags = 1;   /* active */
568         up(&priv->wx_sem);
569         return 0;
570 }
571
572 static int _rtl92e_wx_set_freq(struct net_device *dev,
573                                struct iw_request_info *a,
574                                union iwreq_data *wrqu, char *b)
575 {
576         int ret;
577         struct r8192_priv *priv = rtllib_priv(dev);
578
579         if (priv->bHwRadioOff)
580                 return 0;
581
582         down(&priv->wx_sem);
583
584         ret = rtllib_wx_set_freq(priv->rtllib, a, wrqu, b);
585
586         up(&priv->wx_sem);
587         return ret;
588 }
589
590 static int _rtl92e_wx_get_name(struct net_device *dev,
591                                struct iw_request_info *info,
592                                union iwreq_data *wrqu, char *extra)
593 {
594         struct r8192_priv *priv = rtllib_priv(dev);
595
596         return rtllib_wx_get_name(priv->rtllib, info, wrqu, extra);
597 }
598
599
600 static int _rtl92e_wx_set_frag(struct net_device *dev,
601                                struct iw_request_info *info,
602                                union iwreq_data *wrqu, char *extra)
603 {
604         struct r8192_priv *priv = rtllib_priv(dev);
605
606         if (priv->bHwRadioOff)
607                 return 0;
608
609         if (wrqu->frag.disabled)
610                 priv->rtllib->fts = DEFAULT_FRAG_THRESHOLD;
611         else {
612                 if (wrqu->frag.value < MIN_FRAG_THRESHOLD ||
613                     wrqu->frag.value > MAX_FRAG_THRESHOLD)
614                         return -EINVAL;
615
616                 priv->rtllib->fts = wrqu->frag.value & ~0x1;
617         }
618
619         return 0;
620 }
621
622
623 static int _rtl92e_wx_get_frag(struct net_device *dev,
624                                struct iw_request_info *info,
625                                union iwreq_data *wrqu, char *extra)
626 {
627         struct r8192_priv *priv = rtllib_priv(dev);
628
629         wrqu->frag.value = priv->rtllib->fts;
630         wrqu->frag.fixed = 0;   /* no auto select */
631         wrqu->frag.disabled = (wrqu->frag.value == DEFAULT_FRAG_THRESHOLD);
632
633         return 0;
634 }
635
636
637 static int _rtl92e_wx_set_wap(struct net_device *dev,
638                               struct iw_request_info *info,
639                               union iwreq_data *awrq, char *extra)
640 {
641         int ret;
642         struct r8192_priv *priv = rtllib_priv(dev);
643
644         if (priv->bHwRadioOff)
645                 return 0;
646
647         down(&priv->wx_sem);
648
649         ret = rtllib_wx_set_wap(priv->rtllib, info, awrq, extra);
650
651         up(&priv->wx_sem);
652
653         return ret;
654
655 }
656
657
658 static int _rtl92e_wx_get_wap(struct net_device *dev,
659                               struct iw_request_info *info,
660                               union iwreq_data *wrqu, char *extra)
661 {
662         struct r8192_priv *priv = rtllib_priv(dev);
663
664         return rtllib_wx_get_wap(priv->rtllib, info, wrqu, extra);
665 }
666
667
668 static int _rtl92e_wx_get_enc(struct net_device *dev,
669                               struct iw_request_info *info,
670                               union iwreq_data *wrqu, char *key)
671 {
672         struct r8192_priv *priv = rtllib_priv(dev);
673
674         return rtllib_wx_get_encode(priv->rtllib, info, wrqu, key);
675 }
676
677 static int _rtl92e_wx_set_enc(struct net_device *dev,
678                               struct iw_request_info *info,
679                               union iwreq_data *wrqu, char *key)
680 {
681         struct r8192_priv *priv = rtllib_priv(dev);
682         int ret;
683
684         struct rtllib_device *ieee = priv->rtllib;
685         u32 hwkey[4] = {0, 0, 0, 0};
686         u8 mask = 0xff;
687         u32 key_idx = 0;
688         u8 zero_addr[4][6] = {{0x00, 0x00, 0x00, 0x00, 0x00, 0x00},
689                              {0x00, 0x00, 0x00, 0x00, 0x00, 0x01},
690                              {0x00, 0x00, 0x00, 0x00, 0x00, 0x02},
691                              {0x00, 0x00, 0x00, 0x00, 0x00, 0x03} };
692         int i;
693
694         if (priv->bHwRadioOff)
695                 return 0;
696
697         if (!priv->up)
698                 return -ENETDOWN;
699
700         priv->rtllib->wx_set_enc = 1;
701         down(&priv->rtllib->ips_sem);
702         rtl92e_ips_leave(dev);
703         up(&priv->rtllib->ips_sem);
704         down(&priv->wx_sem);
705
706         RT_TRACE(COMP_SEC, "Setting SW wep key");
707         ret = rtllib_wx_set_encode(priv->rtllib, info, wrqu, key);
708         up(&priv->wx_sem);
709
710
711         if (wrqu->encoding.flags & IW_ENCODE_DISABLED) {
712                 ieee->pairwise_key_type = ieee->group_key_type = KEY_TYPE_NA;
713                 rtl92e_cam_reset(dev);
714                 memset(priv->rtllib->swcamtable, 0,
715                        sizeof(struct sw_cam_table) * 32);
716                 goto end_hw_sec;
717         }
718         if (wrqu->encoding.length != 0) {
719
720                 for (i = 0; i < 4; i++) {
721                         hwkey[i] |=  key[4*i+0]&mask;
722                         if (i == 1 && (4 * i + 1) == wrqu->encoding.length)
723                                 mask = 0x00;
724                         if (i == 3 && (4 * i + 1) == wrqu->encoding.length)
725                                 mask = 0x00;
726                         hwkey[i] |= (key[4 * i + 1] & mask) << 8;
727                         hwkey[i] |= (key[4 * i + 2] & mask) << 16;
728                         hwkey[i] |= (key[4 * i + 3] & mask) << 24;
729                 }
730
731                 switch (wrqu->encoding.flags & IW_ENCODE_INDEX) {
732                 case 0:
733                         key_idx = ieee->crypt_info.tx_keyidx;
734                         break;
735                 case 1:
736                         key_idx = 0;
737                         break;
738                 case 2:
739                         key_idx = 1;
740                         break;
741                 case 3:
742                         key_idx = 2;
743                         break;
744                 case 4:
745                         key_idx = 3;
746                         break;
747                 default:
748                         break;
749                 }
750                 if (wrqu->encoding.length == 0x5) {
751                         ieee->pairwise_key_type = KEY_TYPE_WEP40;
752                         rtl92e_enable_hw_security_config(dev);
753                 }
754
755                 else if (wrqu->encoding.length == 0xd) {
756                         ieee->pairwise_key_type = KEY_TYPE_WEP104;
757                                 rtl92e_enable_hw_security_config(dev);
758                         rtl92e_set_key(dev, key_idx, key_idx, KEY_TYPE_WEP104,
759                                        zero_addr[key_idx], 0, hwkey);
760                         rtl92e_set_swcam(dev, key_idx, key_idx, KEY_TYPE_WEP104,
761                                          zero_addr[key_idx], 0, hwkey, 0);
762                 } else {
763                         netdev_info(dev,
764                                     "wrong type in WEP, not WEP40 and WEP104\n");
765                 }
766         }
767
768 end_hw_sec:
769         priv->rtllib->wx_set_enc = 0;
770         return ret;
771 }
772
773 static int _rtl92e_wx_set_scan_type(struct net_device *dev,
774                                     struct iw_request_info *aa,
775                                     union iwreq_data *wrqu, char *p)
776 {
777         struct r8192_priv *priv = rtllib_priv(dev);
778         int *parms = (int *)p;
779         int mode = parms[0];
780
781         if (priv->bHwRadioOff)
782                 return 0;
783
784         priv->rtllib->active_scan = mode;
785
786         return 1;
787 }
788
789
790
791 #define R8192_MAX_RETRY 255
792 static int _rtl92e_wx_set_retry(struct net_device *dev,
793                                 struct iw_request_info *info,
794                                 union iwreq_data *wrqu, char *extra)
795 {
796         struct r8192_priv *priv = rtllib_priv(dev);
797         int err = 0;
798
799         if (priv->bHwRadioOff)
800                 return 0;
801
802         down(&priv->wx_sem);
803
804         if (wrqu->retry.flags & IW_RETRY_LIFETIME ||
805             wrqu->retry.disabled) {
806                 err = -EINVAL;
807                 goto exit;
808         }
809         if (!(wrqu->retry.flags & IW_RETRY_LIMIT)) {
810                 err = -EINVAL;
811                 goto exit;
812         }
813
814         if (wrqu->retry.value > R8192_MAX_RETRY) {
815                 err = -EINVAL;
816                 goto exit;
817         }
818         if (wrqu->retry.flags & IW_RETRY_MAX)
819                 priv->retry_rts = wrqu->retry.value;
820         else
821                 priv->retry_data = wrqu->retry.value;
822
823         rtl92e_commit(dev);
824 exit:
825         up(&priv->wx_sem);
826
827         return err;
828 }
829
830 static int _rtl92e_wx_get_retry(struct net_device *dev,
831                                 struct iw_request_info *info,
832                                 union iwreq_data *wrqu, char *extra)
833 {
834         struct r8192_priv *priv = rtllib_priv(dev);
835
836
837         wrqu->retry.disabled = 0; /* can't be disabled */
838
839         if ((wrqu->retry.flags & IW_RETRY_TYPE) ==
840             IW_RETRY_LIFETIME)
841                 return -EINVAL;
842
843         if (wrqu->retry.flags & IW_RETRY_MAX) {
844                 wrqu->retry.flags = IW_RETRY_LIMIT | IW_RETRY_MAX;
845                 wrqu->retry.value = priv->retry_rts;
846         } else {
847                 wrqu->retry.flags = IW_RETRY_LIMIT | IW_RETRY_MIN;
848                 wrqu->retry.value = priv->retry_data;
849         }
850         return 0;
851 }
852
853 static int _rtl92e_wx_get_sens(struct net_device *dev,
854                                struct iw_request_info *info,
855                                union iwreq_data *wrqu, char *extra)
856 {
857         struct r8192_priv *priv = rtllib_priv(dev);
858
859         if (priv->rf_set_sens == NULL)
860                 return -1; /* we have not this support for this radio */
861         wrqu->sens.value = priv->sens;
862         return 0;
863 }
864
865
866 static int _rtl92e_wx_set_sens(struct net_device *dev,
867                                struct iw_request_info *info,
868                                union iwreq_data *wrqu, char *extra)
869 {
870
871         struct r8192_priv *priv = rtllib_priv(dev);
872
873         short err = 0;
874
875         if (priv->bHwRadioOff)
876                 return 0;
877
878         down(&priv->wx_sem);
879         if (priv->rf_set_sens == NULL) {
880                 err = -1; /* we have not this support for this radio */
881                 goto exit;
882         }
883         if (priv->rf_set_sens(dev, wrqu->sens.value) == 0)
884                 priv->sens = wrqu->sens.value;
885         else
886                 err = -EINVAL;
887
888 exit:
889         up(&priv->wx_sem);
890
891         return err;
892 }
893
894 static int _rtl92e_wx_set_encode_ext(struct net_device *dev,
895                                      struct iw_request_info *info,
896                                      union iwreq_data *wrqu, char *extra)
897 {
898         int ret = 0;
899         struct r8192_priv *priv = rtllib_priv(dev);
900         struct rtllib_device *ieee = priv->rtllib;
901
902         if (priv->bHwRadioOff)
903                 return 0;
904
905         down(&priv->wx_sem);
906
907         priv->rtllib->wx_set_enc = 1;
908         down(&priv->rtllib->ips_sem);
909         rtl92e_ips_leave(dev);
910         up(&priv->rtllib->ips_sem);
911
912         ret = rtllib_wx_set_encode_ext(ieee, info, wrqu, extra);
913         {
914                 const u8 broadcast_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff};
915                 const u8 zero[ETH_ALEN] = {0};
916                 u32 key[4] = {0};
917                 struct iw_encode_ext *ext = (struct iw_encode_ext *)extra;
918                 struct iw_point *encoding = &wrqu->encoding;
919                 u8 idx = 0, alg = 0, group = 0;
920
921                 if ((encoding->flags & IW_ENCODE_DISABLED) ||
922                      ext->alg == IW_ENCODE_ALG_NONE) {
923                         ieee->pairwise_key_type = ieee->group_key_type
924                                                 = KEY_TYPE_NA;
925                         rtl92e_cam_reset(dev);
926                         memset(priv->rtllib->swcamtable, 0,
927                                sizeof(struct sw_cam_table) * 32);
928                         goto end_hw_sec;
929                 }
930                 alg = (ext->alg == IW_ENCODE_ALG_CCMP) ? KEY_TYPE_CCMP :
931                       ext->alg;
932                 idx = encoding->flags & IW_ENCODE_INDEX;
933                 if (idx)
934                         idx--;
935                 group = ext->ext_flags & IW_ENCODE_EXT_GROUP_KEY;
936
937                 if ((!group) || (ieee->iw_mode == IW_MODE_ADHOC) ||
938                     (alg ==  KEY_TYPE_WEP40)) {
939                         if ((ext->key_len == 13) && (alg == KEY_TYPE_WEP40))
940                                 alg = KEY_TYPE_WEP104;
941                         ieee->pairwise_key_type = alg;
942                         rtl92e_enable_hw_security_config(dev);
943                 }
944                 memcpy((u8 *)key, ext->key, 16);
945
946                 if ((alg & KEY_TYPE_WEP40) && (ieee->auth_mode != 2)) {
947                         if (ext->key_len == 13)
948                                 ieee->pairwise_key_type = alg = KEY_TYPE_WEP104;
949                         rtl92e_set_key(dev, idx, idx, alg, zero, 0, key);
950                         rtl92e_set_swcam(dev, idx, idx, alg, zero, 0, key, 0);
951                 } else if (group) {
952                         ieee->group_key_type = alg;
953                         rtl92e_set_key(dev, idx, idx, alg, broadcast_addr, 0,
954                                        key);
955                         rtl92e_set_swcam(dev, idx, idx, alg, broadcast_addr, 0,
956                                          key, 0);
957                 } else {
958                         if ((ieee->pairwise_key_type == KEY_TYPE_CCMP) &&
959                              ieee->pHTInfo->bCurrentHTSupport)
960                                 rtl92e_writeb(dev, 0x173, 1);
961                         rtl92e_set_key(dev, 4, idx, alg,
962                                        (u8 *)ieee->ap_mac_addr, 0, key);
963                         rtl92e_set_swcam(dev, 4, idx, alg,
964                                          (u8 *)ieee->ap_mac_addr, 0, key, 0);
965                 }
966
967
968         }
969
970 end_hw_sec:
971         priv->rtllib->wx_set_enc = 0;
972         up(&priv->wx_sem);
973         return ret;
974
975 }
976
977 static int _rtl92e_wx_set_auth(struct net_device *dev,
978                                struct iw_request_info *info,
979                                union iwreq_data *data, char *extra)
980 {
981         int ret = 0;
982
983         struct r8192_priv *priv = rtllib_priv(dev);
984
985         if (priv->bHwRadioOff)
986                 return 0;
987
988         down(&priv->wx_sem);
989         ret = rtllib_wx_set_auth(priv->rtllib, info, &(data->param), extra);
990         up(&priv->wx_sem);
991         return ret;
992 }
993
994 static int _rtl92e_wx_set_mlme(struct net_device *dev,
995                                struct iw_request_info *info,
996                                union iwreq_data *wrqu, char *extra)
997 {
998
999         int ret = 0;
1000
1001         struct r8192_priv *priv = rtllib_priv(dev);
1002
1003         if (priv->bHwRadioOff)
1004                 return 0;
1005
1006         down(&priv->wx_sem);
1007         ret = rtllib_wx_set_mlme(priv->rtllib, info, wrqu, extra);
1008         up(&priv->wx_sem);
1009         return ret;
1010 }
1011
1012 static int _rtl92e_wx_set_gen_ie(struct net_device *dev,
1013                                  struct iw_request_info *info,
1014                                  union iwreq_data *data, char *extra)
1015 {
1016         int ret = 0;
1017
1018         struct r8192_priv *priv = rtllib_priv(dev);
1019
1020         if (priv->bHwRadioOff)
1021                 return 0;
1022
1023         down(&priv->wx_sem);
1024         ret = rtllib_wx_set_gen_ie(priv->rtllib, extra, data->data.length);
1025         up(&priv->wx_sem);
1026         return ret;
1027 }
1028
1029 static int _rtl92e_wx_get_gen_ie(struct net_device *dev,
1030                                  struct iw_request_info *info,
1031                                  union iwreq_data *data, char *extra)
1032 {
1033         int ret = 0;
1034         struct r8192_priv *priv = rtllib_priv(dev);
1035         struct rtllib_device *ieee = priv->rtllib;
1036
1037         if (ieee->wpa_ie_len == 0 || ieee->wpa_ie == NULL) {
1038                 data->data.length = 0;
1039                 return 0;
1040         }
1041
1042         if (data->data.length < ieee->wpa_ie_len)
1043                 return -E2BIG;
1044
1045         data->data.length = ieee->wpa_ie_len;
1046         memcpy(extra, ieee->wpa_ie, ieee->wpa_ie_len);
1047         return ret;
1048 }
1049
1050 #define OID_RT_INTEL_PROMISCUOUS_MODE   0xFF0101F6
1051
1052 static int _rtl92e_wx_set_promisc_mode(struct net_device *dev,
1053                                        struct iw_request_info *info,
1054                                        union iwreq_data *wrqu, char *extra)
1055 {
1056         struct r8192_priv *priv = rtllib_priv(dev);
1057         struct rtllib_device *ieee = priv->rtllib;
1058
1059         u32 info_buf[3];
1060
1061         u32 oid;
1062         u32 bPromiscuousOn;
1063         u32 bFilterSourceStationFrame;
1064
1065         if (copy_from_user(info_buf, wrqu->data.pointer, sizeof(info_buf)))
1066                 return -EFAULT;
1067
1068         oid = info_buf[0];
1069         bPromiscuousOn = info_buf[1];
1070         bFilterSourceStationFrame = info_buf[2];
1071
1072         if (oid == OID_RT_INTEL_PROMISCUOUS_MODE) {
1073                 ieee->IntelPromiscuousModeInfo.bPromiscuousOn =
1074                                         (bPromiscuousOn) ? (true) : (false);
1075                 ieee->IntelPromiscuousModeInfo.bFilterSourceStationFrame =
1076                         (bFilterSourceStationFrame) ? (true) : (false);
1077                         (bPromiscuousOn) ?
1078                         (rtllib_EnableIntelPromiscuousMode(dev, false)) :
1079                         (rtllib_DisableIntelPromiscuousMode(dev, false));
1080
1081                 netdev_info(dev,
1082                             "=======>%s(), on = %d, filter src sta = %d\n",
1083                             __func__, bPromiscuousOn,
1084                             bFilterSourceStationFrame);
1085         } else {
1086                 return -1;
1087         }
1088
1089         return 0;
1090 }
1091
1092
1093 static int _rtl92e_wx_get_promisc_mode(struct net_device *dev,
1094                                        struct iw_request_info *info,
1095                                        union iwreq_data *wrqu, char *extra)
1096 {
1097         struct r8192_priv *priv = rtllib_priv(dev);
1098         struct rtllib_device *ieee = priv->rtllib;
1099
1100         down(&priv->wx_sem);
1101
1102         snprintf(extra, 45, "PromiscuousMode:%d, FilterSrcSTAFrame:%d",
1103                  ieee->IntelPromiscuousModeInfo.bPromiscuousOn,
1104                  ieee->IntelPromiscuousModeInfo.bFilterSourceStationFrame);
1105         wrqu->data.length = strlen(extra) + 1;
1106
1107         up(&priv->wx_sem);
1108
1109         return 0;
1110 }
1111
1112
1113 #define IW_IOCTL(x) ((x) - SIOCSIWCOMMIT)
1114 static iw_handler r8192_wx_handlers[] = {
1115         [IW_IOCTL(SIOCGIWNAME)] = _rtl92e_wx_get_name,
1116         [IW_IOCTL(SIOCSIWFREQ)] = _rtl92e_wx_set_freq,
1117         [IW_IOCTL(SIOCGIWFREQ)] = _rtl92e_wx_get_freq,
1118         [IW_IOCTL(SIOCSIWMODE)] = _rtl92e_wx_set_mode,
1119         [IW_IOCTL(SIOCGIWMODE)] = _rtl92e_wx_get_mode,
1120         [IW_IOCTL(SIOCSIWSENS)] = _rtl92e_wx_set_sens,
1121         [IW_IOCTL(SIOCGIWSENS)] = _rtl92e_wx_get_sens,
1122         [IW_IOCTL(SIOCGIWRANGE)] = _rtl92e_wx_get_range,
1123         [IW_IOCTL(SIOCSIWAP)] = _rtl92e_wx_set_wap,
1124         [IW_IOCTL(SIOCGIWAP)] = _rtl92e_wx_get_wap,
1125         [IW_IOCTL(SIOCSIWSCAN)] = _rtl92e_wx_set_scan,
1126         [IW_IOCTL(SIOCGIWSCAN)] = _rtl92e_wx_get_scan,
1127         [IW_IOCTL(SIOCSIWESSID)] = _rtl92e_wx_set_essid,
1128         [IW_IOCTL(SIOCGIWESSID)] = _rtl92e_wx_get_essid,
1129         [IW_IOCTL(SIOCSIWNICKN)] = _rtl92e_wx_set_nick,
1130         [IW_IOCTL(SIOCGIWNICKN)] = _rtl92e_wx_get_nick,
1131         [IW_IOCTL(SIOCSIWRATE)] = _rtl92e_wx_set_rate,
1132         [IW_IOCTL(SIOCGIWRATE)] = _rtl92e_wx_get_rate,
1133         [IW_IOCTL(SIOCSIWRTS)] = _rtl92e_wx_set_rts,
1134         [IW_IOCTL(SIOCGIWRTS)] = _rtl92e_wx_get_rts,
1135         [IW_IOCTL(SIOCSIWFRAG)] = _rtl92e_wx_set_frag,
1136         [IW_IOCTL(SIOCGIWFRAG)] = _rtl92e_wx_get_frag,
1137         [IW_IOCTL(SIOCSIWRETRY)] = _rtl92e_wx_set_retry,
1138         [IW_IOCTL(SIOCGIWRETRY)] = _rtl92e_wx_get_retry,
1139         [IW_IOCTL(SIOCSIWENCODE)] = _rtl92e_wx_set_enc,
1140         [IW_IOCTL(SIOCGIWENCODE)] = _rtl92e_wx_get_enc,
1141         [IW_IOCTL(SIOCSIWPOWER)] = _rtl92e_wx_set_power,
1142         [IW_IOCTL(SIOCGIWPOWER)] = _rtl92e_wx_get_power,
1143         [IW_IOCTL(SIOCSIWGENIE)] = _rtl92e_wx_set_gen_ie,
1144         [IW_IOCTL(SIOCGIWGENIE)] = _rtl92e_wx_get_gen_ie,
1145         [IW_IOCTL(SIOCSIWMLME)] = _rtl92e_wx_set_mlme,
1146         [IW_IOCTL(SIOCSIWAUTH)] = _rtl92e_wx_set_auth,
1147         [IW_IOCTL(SIOCSIWENCODEEXT)] = _rtl92e_wx_set_encode_ext,
1148 };
1149
1150 /* the following rule need to be following,
1151  * Odd : get (world access),
1152  * even : set (root access)
1153  */
1154 static const struct iw_priv_args r8192_private_args[] = {
1155         {
1156                 SIOCIWFIRSTPRIV + 0x0,
1157                 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "set_debugflag"
1158         }, {
1159                 SIOCIWFIRSTPRIV + 0x1,
1160                 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "activescan"
1161         }, {
1162                 SIOCIWFIRSTPRIV + 0x2,
1163                 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "rawtx"
1164         }, {
1165                 SIOCIWFIRSTPRIV + 0x3,
1166                 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "forcereset"
1167         }, {
1168                 SIOCIWFIRSTPRIV + 0x6,
1169                 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED|1, IW_PRIV_TYPE_NONE,
1170                 "set_power"
1171         }, {
1172                 SIOCIWFIRSTPRIV + 0xa,
1173                 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED|1, IW_PRIV_TYPE_NONE,
1174                 "lps_interv"
1175         }, {
1176                 SIOCIWFIRSTPRIV + 0xb,
1177                 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED|1, IW_PRIV_TYPE_NONE,
1178                 "lps_force"
1179         }, {
1180                 SIOCIWFIRSTPRIV + 0x16,
1181                 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 3, 0, "setpromisc"
1182         }, {
1183                 SIOCIWFIRSTPRIV + 0x17,
1184                 0, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | 45, "getpromisc"
1185         }
1186
1187 };
1188
1189 static iw_handler r8192_private_handler[] = {
1190         (iw_handler)_rtl92e_wx_set_debug,   /*SIOCIWSECONDPRIV*/
1191         (iw_handler)_rtl92e_wx_set_scan_type,
1192         (iw_handler)_rtl92e_wx_set_rawtx,
1193         (iw_handler)_rtl92e_wx_force_reset,
1194         (iw_handler)NULL,
1195         (iw_handler)NULL,
1196         (iw_handler)_rtl92e_wx_adapter_power_status,
1197         (iw_handler)NULL,
1198         (iw_handler)NULL,
1199         (iw_handler)NULL,
1200         (iw_handler)_rtl92e_wx_set_lps_awake_interval,
1201         (iw_handler)_rtl92e_wx_set_force_lps,
1202         (iw_handler)NULL,
1203         (iw_handler)NULL,
1204         (iw_handler)NULL,
1205         (iw_handler)NULL,
1206         (iw_handler)NULL,
1207         (iw_handler)NULL,
1208         (iw_handler)NULL,
1209         (iw_handler)NULL,
1210         (iw_handler)NULL,
1211         (iw_handler)NULL,
1212         (iw_handler)_rtl92e_wx_set_promisc_mode,
1213         (iw_handler)_rtl92e_wx_get_promisc_mode,
1214 };
1215
1216 static struct iw_statistics *_rtl92e_get_wireless_stats(struct net_device *dev)
1217 {
1218         struct r8192_priv *priv = rtllib_priv(dev);
1219         struct rtllib_device *ieee = priv->rtllib;
1220         struct iw_statistics *wstats = &priv->wstats;
1221         int tmp_level = 0;
1222         int tmp_qual = 0;
1223         int tmp_noise = 0;
1224
1225         if (ieee->state < RTLLIB_LINKED) {
1226                 wstats->qual.qual = 10;
1227                 wstats->qual.level = 0;
1228                 wstats->qual.noise = 0x100 - 100;       /* -100 dBm */
1229                 wstats->qual.updated = IW_QUAL_ALL_UPDATED | IW_QUAL_DBM;
1230                 return wstats;
1231         }
1232
1233         tmp_level = (&ieee->current_network)->stats.rssi;
1234         tmp_qual = (&ieee->current_network)->stats.signal;
1235         tmp_noise = (&ieee->current_network)->stats.noise;
1236
1237         wstats->qual.level = tmp_level;
1238         wstats->qual.qual = tmp_qual;
1239         wstats->qual.noise = tmp_noise;
1240         wstats->qual.updated = IW_QUAL_ALL_UPDATED | IW_QUAL_DBM;
1241         return wstats;
1242 }
1243
1244 const struct iw_handler_def r8192_wx_handlers_def = {
1245         .standard = r8192_wx_handlers,
1246         .num_standard = ARRAY_SIZE(r8192_wx_handlers),
1247         .private = r8192_private_handler,
1248         .num_private = ARRAY_SIZE(r8192_private_handler),
1249         .num_private_args = sizeof(r8192_private_args) /
1250                             sizeof(struct iw_priv_args),
1251         .get_wireless_stats = _rtl92e_get_wireless_stats,
1252         .private_args = (struct iw_priv_args *)r8192_private_args,
1253 };