main.c

 1// SPDX-License-Identifier: GPL-2.0-only
 2/*
 3 * Copyright (C) 2014 Felix Fietkau <nbd@openwrt.org>
 4 * Copyright (C) 2015 Jakub Kicinski <kubakici@wp.pl>
 5 * Copyright (C) 2018 Stanislaw Gruszka <stf_xl@wp.pl>
 6 */
 7
 8#include <linux/etherdevice.h>
 9#include "mt76x0.h"
10
11int mt76x0_set_channel(struct mt76_phy *mphy)
12{
13	struct mt76x02_dev *dev = container_of(mphy->dev, struct mt76x02_dev, mt76);
14
15	mt76x02_pre_tbtt_enable(dev, false);
16	if (mt76_is_mmio(&dev->mt76))
17		tasklet_disable(&dev->dfs_pd.dfs_tasklet);
18
19	mt76x0_phy_set_channel(dev, &mphy->chandef);
20
21	mt76x02_mac_cc_reset(dev);
22	mt76x02_edcca_init(dev);
23
24	if (mt76_is_mmio(&dev->mt76)) {
25		mt76x02_dfs_init_params(dev);
26		tasklet_enable(&dev->dfs_pd.dfs_tasklet);
27	}
28	mt76x02_pre_tbtt_enable(dev, true);
29
30	return 0;
31}
32EXPORT_SYMBOL_GPL(mt76x0_set_channel);
33
34int mt76x0_set_sar_specs(struct ieee80211_hw *hw,
35			 const struct cfg80211_sar_specs *sar)
36{
37	int err = -EINVAL, power = hw->conf.power_level * 2;
38	struct mt76x02_dev *dev = hw->priv;
39	struct mt76_phy *mphy = &dev->mphy;
40
41	mutex_lock(&dev->mt76.mutex);
42	if (!cfg80211_chandef_valid(&mphy->chandef))
43		goto out;
44
45	err = mt76_init_sar_power(hw, sar);
46	if (err)
47		goto out;
48
49	dev->txpower_conf = mt76_get_sar_power(mphy, mphy->chandef.chan,
50					       power);
51	if (test_bit(MT76_STATE_RUNNING, &mphy->state))
52		mt76x0_phy_set_txpower(dev);
53out:
54	mutex_unlock(&dev->mt76.mutex);
55
56	return err;
57}
58EXPORT_SYMBOL_GPL(mt76x0_set_sar_specs);
59
60int mt76x0_config(struct ieee80211_hw *hw, int radio_idx, u32 changed)
61{
62	struct mt76x02_dev *dev = hw->priv;
63
64	if (changed & IEEE80211_CONF_CHANGE_CHANNEL)
65		mt76_update_channel(&dev->mphy);
66
67	mutex_lock(&dev->mt76.mutex);
68
69	if (changed & IEEE80211_CONF_CHANGE_POWER) {
70		struct mt76_phy *mphy = &dev->mphy;
71
72		dev->txpower_conf = hw->conf.power_level * 2;
73		dev->txpower_conf = mt76_get_sar_power(mphy,
74						       mphy->chandef.chan,
75						       dev->txpower_conf);
76		if (test_bit(MT76_STATE_RUNNING, &mphy->state))
77			mt76x0_phy_set_txpower(dev);
78	}
79
80	if (changed & IEEE80211_CONF_CHANGE_MONITOR) {
81		if (!(hw->conf.flags & IEEE80211_CONF_MONITOR))
82			dev->mt76.rxfilter |= MT_RX_FILTR_CFG_PROMISC;
83		else
84			dev->mt76.rxfilter &= ~MT_RX_FILTR_CFG_PROMISC;
85
86		mt76_wr(dev, MT_RX_FILTR_CFG, dev->mt76.rxfilter);
87	}
88
89	mutex_unlock(&dev->mt76.mutex);
90
91	return 0;
92}
93EXPORT_SYMBOL_GPL(mt76x0_config);