123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132 |
- // SPDX-License-Identifier: GPL-2.0-only
- /*
- * Scan related functions.
- *
- * Copyright (c) 2017-2020, Silicon Laboratories, Inc.
- * Copyright (c) 2010, ST-Ericsson
- */
- #include <net/mac80211.h>
- #include "scan.h"
- #include "wfx.h"
- #include "sta.h"
- #include "hif_tx_mib.h"
- static void __ieee80211_scan_completed_compat(struct ieee80211_hw *hw,
- bool aborted)
- {
- struct cfg80211_scan_info info = {
- .aborted = aborted,
- };
- ieee80211_scan_completed(hw, &info);
- }
- static int update_probe_tmpl(struct wfx_vif *wvif,
- struct cfg80211_scan_request *req)
- {
- struct sk_buff *skb;
- skb = ieee80211_probereq_get(wvif->wdev->hw, wvif->vif->addr,
- NULL, 0, req->ie_len);
- if (!skb)
- return -ENOMEM;
- skb_put_data(skb, req->ie, req->ie_len);
- hif_set_template_frame(wvif, skb, HIF_TMPLT_PRBREQ, 0);
- dev_kfree_skb(skb);
- return 0;
- }
- static int send_scan_req(struct wfx_vif *wvif,
- struct cfg80211_scan_request *req, int start_idx)
- {
- int i, ret, timeout;
- struct ieee80211_channel *ch_start, *ch_cur;
- for (i = start_idx; i < req->n_channels; i++) {
- ch_start = req->channels[start_idx];
- ch_cur = req->channels[i];
- WARN(ch_cur->band != NL80211_BAND_2GHZ, "band not supported");
- if (ch_cur->max_power != ch_start->max_power)
- break;
- if ((ch_cur->flags ^ ch_start->flags) & IEEE80211_CHAN_NO_IR)
- break;
- }
- wfx_tx_lock_flush(wvif->wdev);
- wvif->scan_abort = false;
- reinit_completion(&wvif->scan_complete);
- ret = hif_scan(wvif, req, start_idx, i - start_idx, &timeout);
- if (ret) {
- wfx_tx_unlock(wvif->wdev);
- return -EIO;
- }
- ret = wait_for_completion_timeout(&wvif->scan_complete, timeout);
- if (req->channels[start_idx]->max_power != wvif->vif->bss_conf.txpower)
- hif_set_output_power(wvif, wvif->vif->bss_conf.txpower);
- wfx_tx_unlock(wvif->wdev);
- if (!ret) {
- dev_notice(wvif->wdev->dev, "scan timeout\n");
- hif_stop_scan(wvif);
- return -ETIMEDOUT;
- }
- if (wvif->scan_abort) {
- dev_notice(wvif->wdev->dev, "scan abort\n");
- return -ECONNABORTED;
- }
- return i - start_idx;
- }
- /*
- * It is not really necessary to run scan request asynchronously. However,
- * there is a bug in "iw scan" when ieee80211_scan_completed() is called before
- * wfx_hw_scan() return
- */
- void wfx_hw_scan_work(struct work_struct *work)
- {
- struct wfx_vif *wvif = container_of(work, struct wfx_vif, scan_work);
- struct ieee80211_scan_request *hw_req = wvif->scan_req;
- int chan_cur, ret;
- mutex_lock(&wvif->wdev->conf_mutex);
- mutex_lock(&wvif->scan_lock);
- if (wvif->join_in_progress) {
- dev_info(wvif->wdev->dev, "%s: abort in-progress REQ_JOIN",
- __func__);
- wfx_reset(wvif);
- }
- update_probe_tmpl(wvif, &hw_req->req);
- chan_cur = 0;
- do {
- ret = send_scan_req(wvif, &hw_req->req, chan_cur);
- if (ret > 0)
- chan_cur += ret;
- } while (ret > 0 && chan_cur < hw_req->req.n_channels);
- mutex_unlock(&wvif->scan_lock);
- mutex_unlock(&wvif->wdev->conf_mutex);
- __ieee80211_scan_completed_compat(wvif->wdev->hw, ret < 0);
- }
- int wfx_hw_scan(struct ieee80211_hw *hw, struct ieee80211_vif *vif,
- struct ieee80211_scan_request *hw_req)
- {
- struct wfx_vif *wvif = (struct wfx_vif *)vif->drv_priv;
- WARN_ON(hw_req->req.n_channels > HIF_API_MAX_NB_CHANNELS);
- wvif->scan_req = hw_req;
- schedule_work(&wvif->scan_work);
- return 0;
- }
- void wfx_cancel_hw_scan(struct ieee80211_hw *hw, struct ieee80211_vif *vif)
- {
- struct wfx_vif *wvif = (struct wfx_vif *)vif->drv_priv;
- wvif->scan_abort = true;
- hif_stop_scan(wvif);
- }
- void wfx_scan_complete(struct wfx_vif *wvif)
- {
- complete(&wvif->scan_complete);
- }
|