cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

scan.c (4067B)


      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}