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
 15static void wfx_ieee80211_scan_completed_compat(struct ieee80211_hw *hw, bool aborted)
 16{
 17	struct cfg80211_scan_info info = {
 18		.aborted = aborted,
 19	};
 20
 21	ieee80211_scan_completed(hw, &info);
 22}
 23
 24static int update_probe_tmpl(struct wfx_vif *wvif, struct cfg80211_scan_request *req)
 25{
 26	struct ieee80211_vif *vif = wvif_to_vif(wvif);
 27	struct sk_buff *skb;
 28
 29	skb = ieee80211_probereq_get(wvif->wdev->hw, vif->addr, NULL, 0,
 30				     req->ie_len);
 31	if (!skb)
 32		return -ENOMEM;
 33
 34	skb_put_data(skb, req->ie, req->ie_len);
 35	wfx_hif_set_template_frame(wvif, skb, HIF_TMPLT_PRBREQ, 0);
 36	dev_kfree_skb(skb);
 37	return 0;
 38}
 39
 40static int send_scan_req(struct wfx_vif *wvif, struct cfg80211_scan_request *req, int start_idx)
 41{
 42	struct ieee80211_vif *vif = wvif_to_vif(wvif);
 43	struct ieee80211_channel *ch_start, *ch_cur;
 44	int i, ret;
 45
 46	for (i = start_idx; i < req->n_channels; i++) {
 47		ch_start = req->channels[start_idx];
 48		ch_cur = req->channels[i];
 49		WARN(ch_cur->band != NL80211_BAND_2GHZ, "band not supported");
 50		if (ch_cur->max_power != ch_start->max_power)
 51			break;
 52		if ((ch_cur->flags ^ ch_start->flags) & IEEE80211_CHAN_NO_IR)
 53			break;
 54	}
 55	wfx_tx_lock_flush(wvif->wdev);
 56	wvif->scan_abort = false;
 57	reinit_completion(&wvif->scan_complete);
 58	ret = wfx_hif_scan(wvif, req, start_idx, i - start_idx);
 59	if (ret) {
 60		wfx_tx_unlock(wvif->wdev);
 61		return -EIO;
 62	}
 63	ret = wait_for_completion_timeout(&wvif->scan_complete, 1 * HZ);
 64	if (!ret) {
 65		wfx_hif_stop_scan(wvif);
 66		ret = wait_for_completion_timeout(&wvif->scan_complete, 1 * HZ);
 67		dev_dbg(wvif->wdev->dev, "scan timeout (%d channels done)\n",
 68			wvif->scan_nb_chan_done);
 69	}
 70	if (!ret) {
 71		dev_err(wvif->wdev->dev, "scan didn't stop\n");
 72		ret = -ETIMEDOUT;
 73	} else if (wvif->scan_abort) {
 74		dev_notice(wvif->wdev->dev, "scan abort\n");
 75		ret = -ECONNABORTED;
 76	} else if (wvif->scan_nb_chan_done > i - start_idx) {
 77		ret = -EIO;
 78	} else {
 79		ret = wvif->scan_nb_chan_done;
 80	}
 81	if (req->channels[start_idx]->max_power != vif->bss_conf.txpower)
 82		wfx_hif_set_output_power(wvif, vif->bss_conf.txpower);
 83	wfx_tx_unlock(wvif->wdev);
 84	return ret;
 85}
 86
 87/* It is not really necessary to run scan request asynchronously. However,
 88 * there is a bug in "iw scan" when ieee80211_scan_completed() is called before
 89 * wfx_hw_scan() return
 90 */
 91void wfx_hw_scan_work(struct work_struct *work)
 92{
 93	struct wfx_vif *wvif = container_of(work, struct wfx_vif, scan_work);
 94	struct ieee80211_scan_request *hw_req = wvif->scan_req;
 95	int chan_cur, ret, err;
 96
 97	mutex_lock(&wvif->wdev->conf_mutex);
 98	mutex_lock(&wvif->scan_lock);
 99	if (wvif->join_in_progress) {
100		dev_info(wvif->wdev->dev, "abort in-progress REQ_JOIN");
101		wfx_reset(wvif);
102	}
103	update_probe_tmpl(wvif, &hw_req->req);
104	chan_cur = 0;
105	err = 0;
106	do {
107		ret = send_scan_req(wvif, &hw_req->req, chan_cur);
108		if (ret > 0) {
109			chan_cur += ret;
110			err = 0;
111		}
112		if (!ret)
113			err++;
114		if (err > 2) {
115			dev_err(wvif->wdev->dev, "scan has not been able to start\n");
116			ret = -ETIMEDOUT;
117		}
118	} while (ret >= 0 && chan_cur < hw_req->req.n_channels);
119	mutex_unlock(&wvif->scan_lock);
120	mutex_unlock(&wvif->wdev->conf_mutex);
121	wfx_ieee80211_scan_completed_compat(wvif->wdev->hw, ret < 0);
122}
123
124int wfx_hw_scan(struct ieee80211_hw *hw, struct ieee80211_vif *vif,
125		struct ieee80211_scan_request *hw_req)
126{
127	struct wfx_vif *wvif = (struct wfx_vif *)vif->drv_priv;
128
129	WARN_ON(hw_req->req.n_channels > HIF_API_MAX_NB_CHANNELS);
130	wvif->scan_req = hw_req;
131	schedule_work(&wvif->scan_work);
132	return 0;
133}
134
135void wfx_cancel_hw_scan(struct ieee80211_hw *hw, struct ieee80211_vif *vif)
136{
137	struct wfx_vif *wvif = (struct wfx_vif *)vif->drv_priv;
138
139	wvif->scan_abort = true;
140	wfx_hif_stop_scan(wvif);
141}
142
143void wfx_scan_complete(struct wfx_vif *wvif, int nb_chan_done)
144{
145	wvif->scan_nb_chan_done = nb_chan_done;
146	complete(&wvif->scan_complete);
147}