123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119 |
- // SPDX-License-Identifier: ISC
- /* Copyright (C) 2020 MediaTek Inc. */
- #include "mt76_connac.h"
- int mt76_connac_pm_wake(struct mt76_phy *phy, struct mt76_connac_pm *pm)
- {
- struct mt76_dev *dev = phy->dev;
- if (!pm->enable)
- return 0;
- if (!mt76_is_mmio(dev))
- return 0;
- if (!test_bit(MT76_STATE_PM, &phy->state))
- return 0;
- if (test_bit(MT76_HW_SCANNING, &phy->state) ||
- test_bit(MT76_HW_SCHED_SCANNING, &phy->state))
- return 0;
- if (queue_work(dev->wq, &pm->wake_work))
- reinit_completion(&pm->wake_cmpl);
- if (!wait_for_completion_timeout(&pm->wake_cmpl, 3 * HZ)) {
- ieee80211_wake_queues(phy->hw);
- return -ETIMEDOUT;
- }
- return 0;
- }
- EXPORT_SYMBOL_GPL(mt76_connac_pm_wake);
- void mt76_connac_power_save_sched(struct mt76_phy *phy,
- struct mt76_connac_pm *pm)
- {
- struct mt76_dev *dev = phy->dev;
- if (!mt76_is_mmio(dev))
- return;
- if (!pm->enable || !test_bit(MT76_STATE_RUNNING, &phy->state))
- return;
- pm->last_activity = jiffies;
- if (test_bit(MT76_HW_SCANNING, &phy->state) ||
- test_bit(MT76_HW_SCHED_SCANNING, &phy->state))
- return;
- if (!test_bit(MT76_STATE_PM, &phy->state))
- queue_delayed_work(dev->wq, &pm->ps_work, pm->idle_timeout);
- }
- EXPORT_SYMBOL_GPL(mt76_connac_power_save_sched);
- void mt76_connac_free_pending_tx_skbs(struct mt76_connac_pm *pm,
- struct mt76_wcid *wcid)
- {
- int i;
- spin_lock_bh(&pm->txq_lock);
- for (i = 0; i < IEEE80211_NUM_ACS; i++) {
- if (wcid && pm->tx_q[i].wcid != wcid)
- continue;
- dev_kfree_skb(pm->tx_q[i].skb);
- pm->tx_q[i].skb = NULL;
- }
- spin_unlock_bh(&pm->txq_lock);
- }
- EXPORT_SYMBOL_GPL(mt76_connac_free_pending_tx_skbs);
- void mt76_connac_pm_queue_skb(struct ieee80211_hw *hw,
- struct mt76_connac_pm *pm,
- struct mt76_wcid *wcid,
- struct sk_buff *skb)
- {
- int qid = skb_get_queue_mapping(skb);
- struct mt76_phy *phy = hw->priv;
- spin_lock_bh(&pm->txq_lock);
- if (!pm->tx_q[qid].skb) {
- ieee80211_stop_queues(hw);
- pm->tx_q[qid].wcid = wcid;
- pm->tx_q[qid].skb = skb;
- queue_work(phy->dev->wq, &pm->wake_work);
- } else {
- dev_kfree_skb(skb);
- }
- spin_unlock_bh(&pm->txq_lock);
- }
- EXPORT_SYMBOL_GPL(mt76_connac_pm_queue_skb);
- void mt76_connac_pm_dequeue_skbs(struct mt76_phy *phy,
- struct mt76_connac_pm *pm)
- {
- int i;
- spin_lock_bh(&pm->txq_lock);
- for (i = 0; i < IEEE80211_NUM_ACS; i++) {
- struct mt76_wcid *wcid = pm->tx_q[i].wcid;
- struct ieee80211_sta *sta = NULL;
- if (!pm->tx_q[i].skb)
- continue;
- if (wcid && wcid->sta)
- sta = container_of((void *)wcid, struct ieee80211_sta,
- drv_priv);
- mt76_tx(phy, sta, wcid, pm->tx_q[i].skb);
- pm->tx_q[i].skb = NULL;
- }
- spin_unlock_bh(&pm->txq_lock);
- mt76_worker_schedule(&phy->dev->tx_worker);
- }
- EXPORT_SYMBOL_GPL(mt76_connac_pm_dequeue_skbs);
|