drivers/net/wireless/mediatek/mt76/mt76x0/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
  11 int 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 }
  32 EXPORT_SYMBOL_GPL(mt76x0_set_channel);
  33
  34 int 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);
  53 out:
  54         mutex_unlock(&dev->mt76.mutex);
  55
  56         return err;
  57 }
  58 EXPORT_SYMBOL_GPL(mt76x0_set_sar_specs);
  59
  60 int mt76x0_config(struct ieee80211_hw *hw, 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 }
  93 EXPORT_SYMBOL_GPL(mt76x0_config);