| /* |
| * Copyright (C) 2016 Felix Fietkau <nbd@nbd.name> |
| * |
| * Permission to use, copy, modify, and/or distribute this software for any |
| * purpose with or without fee is hereby granted, provided that the above |
| * copyright notice and this permission notice appear in all copies. |
| * |
| * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES |
| * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF |
| * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR |
| * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES |
| * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN |
| * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF |
| * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. |
| */ |
| |
| #include "mt76x2.h" |
| |
| static int |
| mt76x2_start(struct ieee80211_hw *hw) |
| { |
| struct mt76x2_dev *dev = hw->priv; |
| int ret; |
| |
| mutex_lock(&dev->mutex); |
| |
| ret = mt76x2_mac_start(dev); |
| if (ret) |
| goto out; |
| |
| ret = mt76x2_phy_start(dev); |
| if (ret) |
| goto out; |
| |
| ieee80211_queue_delayed_work(mt76_hw(dev), &dev->mac_work, |
| MT_CALIBRATE_INTERVAL); |
| |
| set_bit(MT76_STATE_RUNNING, &dev->mt76.state); |
| |
| out: |
| mutex_unlock(&dev->mutex); |
| return ret; |
| } |
| |
| static void |
| mt76x2_stop(struct ieee80211_hw *hw) |
| { |
| struct mt76x2_dev *dev = hw->priv; |
| |
| mutex_lock(&dev->mutex); |
| clear_bit(MT76_STATE_RUNNING, &dev->mt76.state); |
| mt76x2_stop_hardware(dev); |
| mutex_unlock(&dev->mutex); |
| } |
| |
| static int |
| mt76x2_add_interface(struct ieee80211_hw *hw, struct ieee80211_vif *vif) |
| { |
| struct mt76x2_dev *dev = hw->priv; |
| struct mt76x2_vif *mvif = (struct mt76x2_vif *) vif->drv_priv; |
| unsigned int idx = 0; |
| |
| if (vif->addr[0] & BIT(1)) |
| idx = 1 + (((dev->mt76.macaddr[0] ^ vif->addr[0]) >> 2) & 7); |
| |
| /* |
| * Client mode typically only has one configurable BSSID register, |
| * which is used for bssidx=0. This is linked to the MAC address. |
| * Since mac80211 allows changing interface types, and we cannot |
| * force the use of the primary MAC address for a station mode |
| * interface, we need some other way of configuring a per-interface |
| * remote BSSID. |
| * The hardware provides an AP-Client feature, where bssidx 0-7 are |
| * used for AP mode and bssidx 8-15 for client mode. |
| * We shift the station interface bss index by 8 to force the |
| * hardware to recognize the BSSID. |
| * The resulting bssidx mismatch for unicast frames is ignored by hw. |
| */ |
| if (vif->type == NL80211_IFTYPE_STATION) |
| idx += 8; |
| |
| mvif->idx = idx; |
| mvif->group_wcid.idx = MT_VIF_WCID(idx); |
| mvif->group_wcid.hw_key_idx = -1; |
| mt76x2_txq_init(dev, vif->txq); |
| |
| return 0; |
| } |
| |
| static int |
| mt76x2_set_channel(struct mt76x2_dev *dev, struct cfg80211_chan_def *chandef) |
| { |
| int ret; |
| |
| cancel_delayed_work_sync(&dev->cal_work); |
| |
| set_bit(MT76_RESET, &dev->mt76.state); |
| |
| mt76_set_channel(&dev->mt76); |
| |
| tasklet_disable(&dev->pre_tbtt_tasklet); |
| tasklet_disable(&dev->dfs_pd.dfs_tasklet); |
| |
| mt76x2_mac_stop(dev, true); |
| ret = mt76x2_phy_set_channel(dev, chandef); |
| |
| /* channel cycle counters read-and-clear */ |
| mt76_rr(dev, MT_CH_IDLE); |
| mt76_rr(dev, MT_CH_BUSY); |
| |
| mt76x2_dfs_init_params(dev); |
| |
| mt76x2_mac_resume(dev); |
| tasklet_enable(&dev->dfs_pd.dfs_tasklet); |
| tasklet_enable(&dev->pre_tbtt_tasklet); |
| |
| clear_bit(MT76_RESET, &dev->mt76.state); |
| |
| mt76_txq_schedule_all(&dev->mt76); |
| |
| return ret; |
| } |
| |
| static int |
| mt76x2_config(struct ieee80211_hw *hw, u32 changed) |
| { |
| struct mt76x2_dev *dev = hw->priv; |
| int ret = 0; |
| |
| mutex_lock(&dev->mutex); |
| |
| if (changed & IEEE80211_CONF_CHANGE_MONITOR) { |
| if (!(hw->conf.flags & IEEE80211_CONF_MONITOR)) |
| dev->rxfilter |= MT_RX_FILTR_CFG_PROMISC; |
| else |
| dev->rxfilter &= ~MT_RX_FILTR_CFG_PROMISC; |
| |
| mt76_wr(dev, MT_RX_FILTR_CFG, dev->rxfilter); |
| } |
| |
| if (changed & IEEE80211_CONF_CHANGE_POWER) { |
| dev->txpower_conf = hw->conf.power_level * 2; |
| |
| /* convert to per-chain power for 2x2 devices */ |
| dev->txpower_conf -= 6; |
| |
| if (test_bit(MT76_STATE_RUNNING, &dev->mt76.state)) { |
| mt76x2_phy_set_txpower(dev); |
| mt76x2_tx_set_txpwr_auto(dev, dev->txpower_conf); |
| } |
| } |
| |
| if (changed & IEEE80211_CONF_CHANGE_CHANNEL) { |
| ieee80211_stop_queues(hw); |
| ret = mt76x2_set_channel(dev, &hw->conf.chandef); |
| ieee80211_wake_queues(hw); |
| } |
| |
| mutex_unlock(&dev->mutex); |
| |
| return ret; |
| } |
| |
| static void |
| mt76x2_bss_info_changed(struct ieee80211_hw *hw, struct ieee80211_vif *vif, |
| struct ieee80211_bss_conf *info, u32 changed) |
| { |
| struct mt76x2_dev *dev = hw->priv; |
| struct mt76x2_vif *mvif = (struct mt76x2_vif *) vif->drv_priv; |
| |
| mutex_lock(&dev->mutex); |
| |
| if (changed & BSS_CHANGED_BSSID) |
| mt76x2_mac_set_bssid(dev, mvif->idx, info->bssid); |
| |
| if (changed & BSS_CHANGED_BEACON_INT) { |
| mt76_rmw_field(dev, MT_BEACON_TIME_CFG, |
| MT_BEACON_TIME_CFG_INTVAL, |
| info->beacon_int << 4); |
| dev->beacon_int = info->beacon_int; |
| dev->tbtt_count = 0; |
| } |
| |
| if (changed & BSS_CHANGED_BEACON_ENABLED) { |
| tasklet_disable(&dev->pre_tbtt_tasklet); |
| mt76x2_mac_set_beacon_enable(dev, mvif->idx, |
| info->enable_beacon); |
| tasklet_enable(&dev->pre_tbtt_tasklet); |
| } |
| |
| if (changed & BSS_CHANGED_ERP_SLOT) { |
| int slottime = info->use_short_slot ? 9 : 20; |
| |
| dev->slottime = slottime; |
| mt76x2_set_tx_ackto(dev); |
| } |
| |
| mutex_unlock(&dev->mutex); |
| } |
| |
| void |
| mt76x2_sta_ps(struct mt76_dev *mdev, struct ieee80211_sta *sta, bool ps) |
| { |
| struct mt76x2_sta *msta = (struct mt76x2_sta *) sta->drv_priv; |
| struct mt76x2_dev *dev = container_of(mdev, struct mt76x2_dev, mt76); |
| int idx = msta->wcid.idx; |
| |
| mt76_stop_tx_queues(&dev->mt76, sta, true); |
| mt76x2_mac_wcid_set_drop(dev, idx, ps); |
| } |
| |
| static void |
| mt76x2_sw_scan(struct ieee80211_hw *hw, struct ieee80211_vif *vif, |
| const u8 *mac) |
| { |
| struct mt76x2_dev *dev = hw->priv; |
| |
| tasklet_disable(&dev->pre_tbtt_tasklet); |
| set_bit(MT76_SCANNING, &dev->mt76.state); |
| } |
| |
| static void |
| mt76x2_sw_scan_complete(struct ieee80211_hw *hw, struct ieee80211_vif *vif) |
| { |
| struct mt76x2_dev *dev = hw->priv; |
| |
| clear_bit(MT76_SCANNING, &dev->mt76.state); |
| tasklet_enable(&dev->pre_tbtt_tasklet); |
| } |
| |
| static void |
| mt76x2_flush(struct ieee80211_hw *hw, struct ieee80211_vif *vif, |
| u32 queues, bool drop) |
| { |
| } |
| |
| static int |
| mt76x2_get_txpower(struct ieee80211_hw *hw, struct ieee80211_vif *vif, int *dbm) |
| { |
| struct mt76x2_dev *dev = hw->priv; |
| |
| *dbm = dev->txpower_cur / 2; |
| |
| /* convert from per-chain power to combined output on 2x2 devices */ |
| *dbm += 3; |
| |
| return 0; |
| } |
| |
| static void mt76x2_set_coverage_class(struct ieee80211_hw *hw, |
| s16 coverage_class) |
| { |
| struct mt76x2_dev *dev = hw->priv; |
| |
| mutex_lock(&dev->mutex); |
| dev->coverage_class = coverage_class; |
| mt76x2_set_tx_ackto(dev); |
| mutex_unlock(&dev->mutex); |
| } |
| |
| static int |
| mt76x2_set_tim(struct ieee80211_hw *hw, struct ieee80211_sta *sta, bool set) |
| { |
| return 0; |
| } |
| |
| static int mt76x2_set_antenna(struct ieee80211_hw *hw, u32 tx_ant, |
| u32 rx_ant) |
| { |
| struct mt76x2_dev *dev = hw->priv; |
| |
| if (!tx_ant || tx_ant > 3 || tx_ant != rx_ant) |
| return -EINVAL; |
| |
| mutex_lock(&dev->mutex); |
| |
| dev->chainmask = (tx_ant == 3) ? 0x202 : 0x101; |
| dev->mt76.antenna_mask = tx_ant; |
| |
| mt76_set_stream_caps(&dev->mt76, true); |
| mt76x2_phy_set_antenna(dev); |
| |
| mutex_unlock(&dev->mutex); |
| |
| return 0; |
| } |
| |
| static int mt76x2_get_antenna(struct ieee80211_hw *hw, u32 *tx_ant, |
| u32 *rx_ant) |
| { |
| struct mt76x2_dev *dev = hw->priv; |
| |
| mutex_lock(&dev->mutex); |
| *tx_ant = dev->mt76.antenna_mask; |
| *rx_ant = dev->mt76.antenna_mask; |
| mutex_unlock(&dev->mutex); |
| |
| return 0; |
| } |
| |
| static int |
| mt76x2_set_rts_threshold(struct ieee80211_hw *hw, u32 val) |
| { |
| struct mt76x2_dev *dev = hw->priv; |
| |
| if (val != ~0 && val > 0xffff) |
| return -EINVAL; |
| |
| mutex_lock(&dev->mutex); |
| mt76x2_mac_set_tx_protection(dev, val); |
| mutex_unlock(&dev->mutex); |
| |
| return 0; |
| } |
| |
| const struct ieee80211_ops mt76x2_ops = { |
| .tx = mt76x2_tx, |
| .start = mt76x2_start, |
| .stop = mt76x2_stop, |
| .add_interface = mt76x2_add_interface, |
| .remove_interface = mt76x2_remove_interface, |
| .config = mt76x2_config, |
| .configure_filter = mt76x2_configure_filter, |
| .bss_info_changed = mt76x2_bss_info_changed, |
| .sta_add = mt76x2_sta_add, |
| .sta_remove = mt76x2_sta_remove, |
| .set_key = mt76x2_set_key, |
| .conf_tx = mt76x2_conf_tx, |
| .sw_scan_start = mt76x2_sw_scan, |
| .sw_scan_complete = mt76x2_sw_scan_complete, |
| .flush = mt76x2_flush, |
| .ampdu_action = mt76x2_ampdu_action, |
| .get_txpower = mt76x2_get_txpower, |
| .wake_tx_queue = mt76_wake_tx_queue, |
| .sta_rate_tbl_update = mt76x2_sta_rate_tbl_update, |
| .release_buffered_frames = mt76_release_buffered_frames, |
| .set_coverage_class = mt76x2_set_coverage_class, |
| .get_survey = mt76_get_survey, |
| .set_tim = mt76x2_set_tim, |
| .set_antenna = mt76x2_set_antenna, |
| .get_antenna = mt76x2_get_antenna, |
| .set_rts_threshold = mt76x2_set_rts_threshold, |
| }; |
| |