mt76x0: pci: add mt76x0e_{start/stop} callbacks

Introduce mt76x0e_start and mt76x0e_stop mac80211
callbacks to start/stop device mac opening/closing
the netdevice

Signed-off-by: Lorenzo Bianconi <lorenzo.bianconi@redhat.com>
Signed-off-by: Felix Fietkau <nbd@nbd.name>

diff --git a/drivers/net/wireless/mediatek/mt76/mt76x0/pci.c b/drivers/net/wireless/mediatek/mt76/mt76x0/pci.c
index 8c020aaf1f0cca349556d528b1d822ed4aa0c2a4..876291dd3c1e1bfbc7a0763d5eb4bc9c15e6d21a 100644 (file)
--- a/drivers/net/wireless/mediatek/mt76/mt76x0/pci.c
+++ b/drivers/net/wireless/mediatek/mt76/mt76x0/pci.c
@@ -25,11 +25,45 @@
 
 static int mt76x0e_start(struct ieee80211_hw *hw)
 {
+       struct mt76x0_dev *dev = hw->priv;
+
+       mutex_lock(&dev->mt76.mutex);
+
+       mt76x02_mac_start(&dev->mt76);
+       ieee80211_queue_delayed_work(dev->mt76.hw, &dev->mac_work,
+                                    MT_CALIBRATE_INTERVAL);
+       ieee80211_queue_delayed_work(dev->mt76.hw, &dev->cal_work,
+                                    MT_CALIBRATE_INTERVAL);
+       set_bit(MT76_STATE_RUNNING, &dev->mt76.state);
+
+       mutex_unlock(&dev->mt76.mutex);
+
        return 0;
 }
 
 static void mt76x0e_stop(struct ieee80211_hw *hw)
 {
+       struct mt76x0_dev *dev = hw->priv;
+
+       mutex_lock(&dev->mt76.mutex);
+
+       clear_bit(MT76_STATE_RUNNING, &dev->mt76.state);
+       cancel_delayed_work_sync(&dev->cal_work);
+       cancel_delayed_work_sync(&dev->mac_work);
+
+       if (!mt76_poll(dev, MT_WPDMA_GLO_CFG, MT_WPDMA_GLO_CFG_TX_DMA_BUSY,
+                      0, 1000))
+               dev_warn(dev->mt76.dev, "TX DMA did not stop\n");
+       mt76_clear(dev, MT_WPDMA_GLO_CFG, MT_WPDMA_GLO_CFG_TX_DMA_EN);
+
+       mt76x0_mac_stop(dev);
+
+       if (!mt76_poll(dev, MT_WPDMA_GLO_CFG, MT_WPDMA_GLO_CFG_RX_DMA_BUSY,
+                      0, 1000))
+               dev_warn(dev->mt76.dev, "TX DMA did not stop\n");
+       mt76_clear(dev, MT_WPDMA_GLO_CFG, MT_WPDMA_GLO_CFG_RX_DMA_EN);
+
+       mutex_unlock(&dev->mt76.mutex);
 }
 
 static const struct ieee80211_ops mt76x0e_ops = {