1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * Scan related functions.
4 *
5 * Copyright (c) 2017-2020, Silicon Laboratories, Inc.
6 * Copyright (c) 2010, ST-Ericsson
7 */
8 #include <net/mac80211.h>
9
10 #include "scan.h"
11 #include "wfx.h"
12 #include "sta.h"
13 #include "hif_tx_mib.h"
14
__ieee80211_scan_completed_compat(struct ieee80211_hw * hw,bool aborted)15 static void __ieee80211_scan_completed_compat(struct ieee80211_hw *hw,
16 bool aborted)
17 {
18 struct cfg80211_scan_info info = {
19 .aborted = aborted,
20 };
21
22 ieee80211_scan_completed(hw, &info);
23 }
24
update_probe_tmpl(struct wfx_vif * wvif,struct cfg80211_scan_request * req)25 static int update_probe_tmpl(struct wfx_vif *wvif,
26 struct cfg80211_scan_request *req)
27 {
28 struct sk_buff *skb;
29
30 skb = ieee80211_probereq_get(wvif->wdev->hw, wvif->vif->addr,
31 NULL, 0, req->ie_len);
32 if (!skb)
33 return -ENOMEM;
34
35 skb_put_data(skb, req->ie, req->ie_len);
36 hif_set_template_frame(wvif, skb, HIF_TMPLT_PRBREQ, 0);
37 dev_kfree_skb(skb);
38 return 0;
39 }
40
send_scan_req(struct wfx_vif * wvif,struct cfg80211_scan_request * req,int start_idx)41 static int send_scan_req(struct wfx_vif *wvif,
42 struct cfg80211_scan_request *req, int start_idx)
43 {
44 int i, ret, timeout;
45 struct ieee80211_channel *ch_start, *ch_cur;
46
47 for (i = start_idx; i < req->n_channels; i++) {
48 ch_start = req->channels[start_idx];
49 ch_cur = req->channels[i];
50 WARN(ch_cur->band != NL80211_BAND_2GHZ, "band not supported");
51 if (ch_cur->max_power != ch_start->max_power)
52 break;
53 if ((ch_cur->flags ^ ch_start->flags) & IEEE80211_CHAN_NO_IR)
54 break;
55 }
56 wfx_tx_lock_flush(wvif->wdev);
57 wvif->scan_abort = false;
58 reinit_completion(&wvif->scan_complete);
59 ret = hif_scan(wvif, req, start_idx, i - start_idx, &timeout);
60 if (ret) {
61 wfx_tx_unlock(wvif->wdev);
62 return -EIO;
63 }
64 ret = wait_for_completion_timeout(&wvif->scan_complete, timeout);
65 if (req->channels[start_idx]->max_power != wvif->vif->bss_conf.txpower)
66 hif_set_output_power(wvif, wvif->vif->bss_conf.txpower);
67 wfx_tx_unlock(wvif->wdev);
68 if (!ret) {
69 dev_notice(wvif->wdev->dev, "scan timeout\n");
70 hif_stop_scan(wvif);
71 return -ETIMEDOUT;
72 }
73 if (wvif->scan_abort) {
74 dev_notice(wvif->wdev->dev, "scan abort\n");
75 return -ECONNABORTED;
76 }
77 return i - start_idx;
78 }
79
80 /*
81 * It is not really necessary to run scan request asynchronously. However,
82 * there is a bug in "iw scan" when ieee80211_scan_completed() is called before
83 * wfx_hw_scan() return
84 */
wfx_hw_scan_work(struct work_struct * work)85 void wfx_hw_scan_work(struct work_struct *work)
86 {
87 struct wfx_vif *wvif = container_of(work, struct wfx_vif, scan_work);
88 struct ieee80211_scan_request *hw_req = wvif->scan_req;
89 int chan_cur, ret;
90
91 mutex_lock(&wvif->wdev->conf_mutex);
92 mutex_lock(&wvif->scan_lock);
93 if (wvif->join_in_progress) {
94 dev_info(wvif->wdev->dev, "%s: abort in-progress REQ_JOIN",
95 __func__);
96 wfx_reset(wvif);
97 }
98 update_probe_tmpl(wvif, &hw_req->req);
99 chan_cur = 0;
100 do {
101 ret = send_scan_req(wvif, &hw_req->req, chan_cur);
102 if (ret > 0)
103 chan_cur += ret;
104 } while (ret > 0 && chan_cur < hw_req->req.n_channels);
105 mutex_unlock(&wvif->scan_lock);
106 mutex_unlock(&wvif->wdev->conf_mutex);
107 __ieee80211_scan_completed_compat(wvif->wdev->hw, ret < 0);
108 }
109
wfx_hw_scan(struct ieee80211_hw * hw,struct ieee80211_vif * vif,struct ieee80211_scan_request * hw_req)110 int wfx_hw_scan(struct ieee80211_hw *hw, struct ieee80211_vif *vif,
111 struct ieee80211_scan_request *hw_req)
112 {
113 struct wfx_vif *wvif = (struct wfx_vif *)vif->drv_priv;
114
115 WARN_ON(hw_req->req.n_channels > HIF_API_MAX_NB_CHANNELS);
116 wvif->scan_req = hw_req;
117 schedule_work(&wvif->scan_work);
118 return 0;
119 }
120
wfx_cancel_hw_scan(struct ieee80211_hw * hw,struct ieee80211_vif * vif)121 void wfx_cancel_hw_scan(struct ieee80211_hw *hw, struct ieee80211_vif *vif)
122 {
123 struct wfx_vif *wvif = (struct wfx_vif *)vif->drv_priv;
124
125 wvif->scan_abort = true;
126 hif_stop_scan(wvif);
127 }
128
wfx_scan_complete(struct wfx_vif * wvif)129 void wfx_scan_complete(struct wfx_vif *wvif)
130 {
131 complete(&wvif->scan_complete);
132 }
133