1 /* IEEE 802.11 SoftMAC layer
2 * Copyright (c) 2005 Andrea Merello <andrea.merello@gmail.com>
4 * Mostly extracted from the rtl8180-sa2400 driver for the
5 * in-kernel generic ieee802.11 stack.
7 * Some pieces of code might be stolen from ipw2100 driver
8 * copyright of who own it's copyright ;-)
10 * PS wx handler mostly stolen from hostap, copyright who
11 * own it's copyright ;-)
13 * released under the GPL
17 #include <linux/etherdevice.h>
21 /* FIXME: add A freqs */
23 const long rtllib_wlan_frequencies[] = {
24 2412, 2417, 2422, 2427,
25 2432, 2437, 2442, 2447,
26 2452, 2457, 2462, 2467,
29 EXPORT_SYMBOL(rtllib_wlan_frequencies);
32 int rtllib_wx_set_freq(struct rtllib_device *ieee, struct iw_request_info *a,
33 union iwreq_data *wrqu, char *b)
36 struct iw_freq *fwrq = &wrqu->freq;
40 if (ieee->iw_mode == IW_MODE_INFRA) {
45 /* if setting by freq convert to channel */
47 if ((fwrq->m >= (int) 2.412e8 &&
48 fwrq->m <= (int) 2.487e8)) {
49 int f = fwrq->m / 100000;
52 while ((c < 14) && (f != rtllib_wlan_frequencies[c]))
55 /* hack to fall through */
61 if (fwrq->e > 0 || fwrq->m > 14 || fwrq->m < 1) {
65 } else { /* Set the channel */
67 if (ieee->active_channel_map[fwrq->m] != 1) {
71 ieee->current_network.channel = fwrq->m;
72 ieee->set_chan(ieee->dev, ieee->current_network.channel);
74 if (ieee->iw_mode == IW_MODE_ADHOC ||
75 ieee->iw_mode == IW_MODE_MASTER)
76 if (ieee->state == RTLLIB_LINKED) {
77 rtllib_stop_send_beacons(ieee);
78 rtllib_start_send_beacons(ieee);
87 EXPORT_SYMBOL(rtllib_wx_set_freq);
90 int rtllib_wx_get_freq(struct rtllib_device *ieee,
91 struct iw_request_info *a,
92 union iwreq_data *wrqu, char *b)
94 struct iw_freq *fwrq = &wrqu->freq;
96 if (ieee->current_network.channel == 0)
98 fwrq->m = rtllib_wlan_frequencies[ieee->current_network.channel-1] *
103 EXPORT_SYMBOL(rtllib_wx_get_freq);
105 int rtllib_wx_get_wap(struct rtllib_device *ieee,
106 struct iw_request_info *info,
107 union iwreq_data *wrqu, char *extra)
111 wrqu->ap_addr.sa_family = ARPHRD_ETHER;
113 if (ieee->iw_mode == IW_MODE_MONITOR)
116 /* We want avoid to give to the user inconsistent infos*/
117 spin_lock_irqsave(&ieee->lock, flags);
119 if (ieee->state != RTLLIB_LINKED &&
120 ieee->state != RTLLIB_LINKED_SCANNING &&
123 eth_zero_addr(wrqu->ap_addr.sa_data);
125 memcpy(wrqu->ap_addr.sa_data,
126 ieee->current_network.bssid, ETH_ALEN);
128 spin_unlock_irqrestore(&ieee->lock, flags);
132 EXPORT_SYMBOL(rtllib_wx_get_wap);
135 int rtllib_wx_set_wap(struct rtllib_device *ieee,
136 struct iw_request_info *info,
137 union iwreq_data *awrq,
144 short ifup = ieee->proto_started;
145 struct sockaddr *temp = (struct sockaddr *)awrq;
147 rtllib_stop_scan_syncro(ieee);
150 /* use ifconfig hw ether */
151 if (ieee->iw_mode == IW_MODE_MASTER) {
156 if (temp->sa_family != ARPHRD_ETHER) {
161 if (is_zero_ether_addr(temp->sa_data)) {
162 spin_lock_irqsave(&ieee->lock, flags);
163 memcpy(ieee->current_network.bssid, temp->sa_data, ETH_ALEN);
165 spin_unlock_irqrestore(&ieee->lock, flags);
172 rtllib_stop_protocol(ieee, true);
174 /* just to avoid to give inconsistent infos in the
175 * get wx method. not really needed otherwise
177 spin_lock_irqsave(&ieee->lock, flags);
179 ieee->cannot_notify = false;
180 memcpy(ieee->current_network.bssid, temp->sa_data, ETH_ALEN);
181 ieee->wap_set = !is_zero_ether_addr(temp->sa_data);
183 spin_unlock_irqrestore(&ieee->lock, flags);
186 rtllib_start_protocol(ieee);
191 EXPORT_SYMBOL(rtllib_wx_set_wap);
193 int rtllib_wx_get_essid(struct rtllib_device *ieee, struct iw_request_info *a,
194 union iwreq_data *wrqu, char *b)
199 if (ieee->iw_mode == IW_MODE_MONITOR)
202 /* We want avoid to give to the user inconsistent infos*/
203 spin_lock_irqsave(&ieee->lock, flags);
205 if (ieee->current_network.ssid[0] == '\0' ||
206 ieee->current_network.ssid_len == 0) {
211 if (ieee->state != RTLLIB_LINKED &&
212 ieee->state != RTLLIB_LINKED_SCANNING &&
213 ieee->ssid_set == 0) {
217 len = ieee->current_network.ssid_len;
218 wrqu->essid.length = len;
219 strncpy(b, ieee->current_network.ssid, len);
220 wrqu->essid.flags = 1;
223 spin_unlock_irqrestore(&ieee->lock, flags);
228 EXPORT_SYMBOL(rtllib_wx_get_essid);
230 int rtllib_wx_set_rate(struct rtllib_device *ieee,
231 struct iw_request_info *info,
232 union iwreq_data *wrqu, char *extra)
235 u32 target_rate = wrqu->bitrate.value;
237 ieee->rate = target_rate/100000;
240 EXPORT_SYMBOL(rtllib_wx_set_rate);
242 int rtllib_wx_get_rate(struct rtllib_device *ieee,
243 struct iw_request_info *info,
244 union iwreq_data *wrqu, char *extra)
248 tmp_rate = TxCountToDataRate(ieee,
249 ieee->softmac_stats.CurrentShowTxate);
250 wrqu->bitrate.value = tmp_rate * 500000;
254 EXPORT_SYMBOL(rtllib_wx_get_rate);
257 int rtllib_wx_set_rts(struct rtllib_device *ieee,
258 struct iw_request_info *info,
259 union iwreq_data *wrqu, char *extra)
261 if (wrqu->rts.disabled || !wrqu->rts.fixed)
262 ieee->rts = DEFAULT_RTS_THRESHOLD;
264 if (wrqu->rts.value < MIN_RTS_THRESHOLD ||
265 wrqu->rts.value > MAX_RTS_THRESHOLD)
267 ieee->rts = wrqu->rts.value;
271 EXPORT_SYMBOL(rtllib_wx_set_rts);
273 int rtllib_wx_get_rts(struct rtllib_device *ieee,
274 struct iw_request_info *info,
275 union iwreq_data *wrqu, char *extra)
277 wrqu->rts.value = ieee->rts;
278 wrqu->rts.fixed = 0; /* no auto select */
279 wrqu->rts.disabled = (wrqu->rts.value == DEFAULT_RTS_THRESHOLD);
282 EXPORT_SYMBOL(rtllib_wx_get_rts);
284 int rtllib_wx_set_mode(struct rtllib_device *ieee, struct iw_request_info *a,
285 union iwreq_data *wrqu, char *b)
287 int set_mode_status = 0;
289 rtllib_stop_scan_syncro(ieee);
291 switch (wrqu->mode) {
292 case IW_MODE_MONITOR:
297 wrqu->mode = IW_MODE_INFRA;
300 set_mode_status = -EINVAL;
304 if (wrqu->mode == ieee->iw_mode)
307 if (wrqu->mode == IW_MODE_MONITOR) {
308 ieee->dev->type = ARPHRD_IEEE80211;
309 rtllib_EnableNetMonitorMode(ieee->dev, false);
311 ieee->dev->type = ARPHRD_ETHER;
312 if (ieee->iw_mode == IW_MODE_MONITOR)
313 rtllib_DisableNetMonitorMode(ieee->dev, false);
316 if (!ieee->proto_started) {
317 ieee->iw_mode = wrqu->mode;
319 rtllib_stop_protocol(ieee, true);
320 ieee->iw_mode = wrqu->mode;
321 rtllib_start_protocol(ieee);
326 return set_mode_status;
328 EXPORT_SYMBOL(rtllib_wx_set_mode);
330 void rtllib_wx_sync_scan_wq(void *data)
332 struct rtllib_device *ieee = container_of_work_rsl(data,
333 struct rtllib_device, wx_sync_scan_wq);
335 enum ht_extchnl_offset chan_offset = 0;
336 enum ht_channel_width bandwidth = 0;
339 if (!(ieee->softmac_features & IEEE_SOFTMAC_SCAN)) {
340 rtllib_start_scan_syncro(ieee, 0);
344 chan = ieee->current_network.channel;
346 if (ieee->LeisurePSLeave)
347 ieee->LeisurePSLeave(ieee->dev);
348 /* notify AP to be in PS mode */
349 rtllib_sta_ps_send_null_frame(ieee, 1);
350 rtllib_sta_ps_send_null_frame(ieee, 1);
352 rtllib_stop_all_queues(ieee);
354 if (ieee->data_hard_stop)
355 ieee->data_hard_stop(ieee->dev);
356 rtllib_stop_send_beacons(ieee);
357 ieee->state = RTLLIB_LINKED_SCANNING;
358 ieee->link_change(ieee->dev);
359 /* wait for ps packet to be kicked out successfully */
362 if (ieee->ScanOperationBackupHandler)
363 ieee->ScanOperationBackupHandler(ieee->dev, SCAN_OPT_BACKUP);
365 if (ieee->pHTInfo->bCurrentHTSupport && ieee->pHTInfo->bEnableHT &&
366 ieee->pHTInfo->bCurBW40MHz) {
368 chan_offset = ieee->pHTInfo->CurSTAExtChnlOffset;
369 bandwidth = (enum ht_channel_width)ieee->pHTInfo->bCurBW40MHz;
370 RT_TRACE(COMP_DBG, "Scan in 40M, force to 20M first:%d, %d\n",
371 chan_offset, bandwidth);
372 ieee->SetBWModeHandler(ieee->dev, HT_CHANNEL_WIDTH_20,
373 HT_EXTCHNL_OFFSET_NO_EXT);
376 rtllib_start_scan_syncro(ieee, 0);
379 RT_TRACE(COMP_DBG, "Scan in 20M, back to 40M\n");
380 if (chan_offset == HT_EXTCHNL_OFFSET_UPPER)
381 ieee->set_chan(ieee->dev, chan + 2);
382 else if (chan_offset == HT_EXTCHNL_OFFSET_LOWER)
383 ieee->set_chan(ieee->dev, chan - 2);
385 ieee->set_chan(ieee->dev, chan);
386 ieee->SetBWModeHandler(ieee->dev, bandwidth, chan_offset);
388 ieee->set_chan(ieee->dev, chan);
391 if (ieee->ScanOperationBackupHandler)
392 ieee->ScanOperationBackupHandler(ieee->dev, SCAN_OPT_RESTORE);
394 ieee->state = RTLLIB_LINKED;
395 ieee->link_change(ieee->dev);
397 /* Notify AP that I wake up again */
398 rtllib_sta_ps_send_null_frame(ieee, 0);
400 if (ieee->LinkDetectInfo.NumRecvBcnInPeriod == 0 ||
401 ieee->LinkDetectInfo.NumRecvDataInPeriod == 0) {
402 ieee->LinkDetectInfo.NumRecvBcnInPeriod = 1;
403 ieee->LinkDetectInfo.NumRecvDataInPeriod = 1;
406 if (ieee->data_hard_resume)
407 ieee->data_hard_resume(ieee->dev);
409 if (ieee->iw_mode == IW_MODE_ADHOC || ieee->iw_mode == IW_MODE_MASTER)
410 rtllib_start_send_beacons(ieee);
412 rtllib_wake_all_queues(ieee);
419 int rtllib_wx_set_scan(struct rtllib_device *ieee, struct iw_request_info *a,
420 union iwreq_data *wrqu, char *b)
426 if (ieee->iw_mode == IW_MODE_MONITOR || !(ieee->proto_started)) {
431 if (ieee->state == RTLLIB_LINKED) {
432 queue_work_rsl(ieee->wq, &ieee->wx_sync_scan_wq);
433 /* intentionally forget to up sem */
441 EXPORT_SYMBOL(rtllib_wx_set_scan);
443 int rtllib_wx_set_essid(struct rtllib_device *ieee,
444 struct iw_request_info *a,
445 union iwreq_data *wrqu, char *extra)
452 rtllib_stop_scan_syncro(ieee);
455 proto_started = ieee->proto_started;
457 len = (wrqu->essid.length < IW_ESSID_MAX_SIZE) ? wrqu->essid.length :
460 if (len > IW_ESSID_MAX_SIZE) {
465 if (ieee->iw_mode == IW_MODE_MONITOR) {
470 for (i = 0; i < len; i++) {
478 rtllib_stop_protocol(ieee, true);
481 /* this is just to be sure that the GET wx callback
482 * has consistent infos. not needed otherwise
484 spin_lock_irqsave(&ieee->lock, flags);
486 if (wrqu->essid.flags && wrqu->essid.length) {
487 strncpy(ieee->current_network.ssid, extra, len);
488 ieee->current_network.ssid_len = len;
489 ieee->cannot_notify = false;
493 ieee->current_network.ssid[0] = '\0';
494 ieee->current_network.ssid_len = 0;
496 spin_unlock_irqrestore(&ieee->lock, flags);
499 rtllib_start_protocol(ieee);
504 EXPORT_SYMBOL(rtllib_wx_set_essid);
506 int rtllib_wx_get_mode(struct rtllib_device *ieee, struct iw_request_info *a,
507 union iwreq_data *wrqu, char *b)
509 wrqu->mode = ieee->iw_mode;
512 EXPORT_SYMBOL(rtllib_wx_get_mode);
514 int rtllib_wx_set_rawtx(struct rtllib_device *ieee,
515 struct iw_request_info *info,
516 union iwreq_data *wrqu, char *extra)
519 int *parms = (int *)extra;
520 int enable = (parms[0] > 0);
521 short prev = ieee->raw_tx;
530 netdev_info(ieee->dev, "raw TX is %s\n",
531 ieee->raw_tx ? "enabled" : "disabled");
533 if (ieee->iw_mode == IW_MODE_MONITOR) {
534 if (prev == 0 && ieee->raw_tx) {
535 if (ieee->data_hard_resume)
536 ieee->data_hard_resume(ieee->dev);
538 netif_carrier_on(ieee->dev);
541 if (prev && ieee->raw_tx == 1)
542 netif_carrier_off(ieee->dev);
549 EXPORT_SYMBOL(rtllib_wx_set_rawtx);
551 int rtllib_wx_get_name(struct rtllib_device *ieee,
552 struct iw_request_info *info,
553 union iwreq_data *wrqu, char *extra)
555 strcpy(wrqu->name, "802.11");
557 if (ieee->modulation & RTLLIB_CCK_MODULATION)
558 strcat(wrqu->name, "b");
559 if (ieee->modulation & RTLLIB_OFDM_MODULATION)
560 strcat(wrqu->name, "g");
561 if (ieee->mode & (IEEE_N_24G | IEEE_N_5G))
562 strcat(wrqu->name, "n");
565 EXPORT_SYMBOL(rtllib_wx_get_name);
568 /* this is mostly stolen from hostap */
569 int rtllib_wx_set_power(struct rtllib_device *ieee,
570 struct iw_request_info *info,
571 union iwreq_data *wrqu, char *extra)
575 if ((!ieee->sta_wake_up) ||
576 (!ieee->enter_sleep_state) ||
577 (!ieee->ps_is_queue_empty)) {
578 RTLLIB_DEBUG(RTLLIB_DL_ERR,
579 "%s(): PS mode is tried to be use but driver missed a callback\n\n",
586 if (wrqu->power.disabled) {
587 RT_TRACE(COMP_DBG, "===>%s(): power disable\n", __func__);
588 ieee->ps = RTLLIB_PS_DISABLED;
591 if (wrqu->power.flags & IW_POWER_TIMEOUT) {
592 ieee->ps_timeout = wrqu->power.value / 1000;
593 RT_TRACE(COMP_DBG, "===>%s():ps_timeout is %d\n", __func__,
597 if (wrqu->power.flags & IW_POWER_PERIOD)
598 ieee->ps_period = wrqu->power.value / 1000;
600 switch (wrqu->power.flags & IW_POWER_MODE) {
601 case IW_POWER_UNICAST_R:
602 ieee->ps = RTLLIB_PS_UNICAST;
604 case IW_POWER_MULTICAST_R:
605 ieee->ps = RTLLIB_PS_MBCAST;
608 ieee->ps = RTLLIB_PS_UNICAST | RTLLIB_PS_MBCAST;
624 EXPORT_SYMBOL(rtllib_wx_set_power);
626 /* this is stolen from hostap */
627 int rtllib_wx_get_power(struct rtllib_device *ieee,
628 struct iw_request_info *info,
629 union iwreq_data *wrqu, char *extra)
633 if (ieee->ps == RTLLIB_PS_DISABLED) {
634 wrqu->power.disabled = 1;
638 wrqu->power.disabled = 0;
640 if ((wrqu->power.flags & IW_POWER_TYPE) == IW_POWER_TIMEOUT) {
641 wrqu->power.flags = IW_POWER_TIMEOUT;
642 wrqu->power.value = ieee->ps_timeout * 1000;
644 wrqu->power.flags = IW_POWER_PERIOD;
645 wrqu->power.value = ieee->ps_period * 1000;
648 if ((ieee->ps & (RTLLIB_PS_MBCAST | RTLLIB_PS_UNICAST)) ==
649 (RTLLIB_PS_MBCAST | RTLLIB_PS_UNICAST))
650 wrqu->power.flags |= IW_POWER_ALL_R;
651 else if (ieee->ps & RTLLIB_PS_MBCAST)
652 wrqu->power.flags |= IW_POWER_MULTICAST_R;
654 wrqu->power.flags |= IW_POWER_UNICAST_R;
661 EXPORT_SYMBOL(rtllib_wx_get_power);