drivers/net/wireless/mediatek/mt76-6e-usb/mt7921/pci_mcu.c

   1 // SPDX-License-Identifier: ISC
   2 /* Copyright (C) 2021 MediaTek Inc. */
   3
   4 #include "mt7921.h"
   5 #include "mcu.h"
   6
   7 int mt7921e_driver_own(struct mt7921_dev *dev)
   8 {
   9         u32 reg = mt7921_reg_map_l1(dev, MT_TOP_LPCR_HOST_BAND0);
  10
  11         mt76_wr(dev, reg, MT_TOP_LPCR_HOST_DRV_OWN);
  12         if (!mt76_poll_msec(dev, reg, MT_TOP_LPCR_HOST_FW_OWN,
  13                             0, 500)) {
  14                 dev_err(dev->mt76.dev, "Timeout for driver own\n");
  15                 return -EIO;
  16         }
  17
  18         return 0;
  19 }
  20
  21 static int
  22 mt7921_mcu_send_message(struct mt76_dev *mdev, struct sk_buff *skb,
  23                         int cmd, int *seq)
  24 {
  25         struct mt7921_dev *dev = container_of(mdev, struct mt7921_dev, mt76);
  26         enum mt76_mcuq_id txq = MT_MCUQ_WM;
  27         int ret;
  28
  29         ret = mt7921_mcu_fill_message(mdev, skb, cmd, seq);
  30         if (ret)
  31                 return ret;
  32
  33         if (cmd == MCU_CMD(FW_SCATTER))
  34                 txq = MT_MCUQ_FWDL;
  35
  36         return mt76_tx_queue_skb_raw(dev, mdev->q_mcu[txq], skb, 0);
  37 }
  38
  39 int mt7921e_mcu_init(struct mt7921_dev *dev)
  40 {
  41         static const struct mt76_mcu_ops mt7921_mcu_ops = {
  42                 .headroom = sizeof(struct mt7921_mcu_txd),
  43                 .mcu_skb_send_msg = mt7921_mcu_send_message,
  44                 .mcu_parse_response = mt7921_mcu_parse_response,
  45                 .mcu_restart = mt76_connac_mcu_restart,
  46         };
  47         int err;
  48
  49         dev->mt76.mcu_ops = &mt7921_mcu_ops;
  50
  51         err = mt7921e_driver_own(dev);
  52         if (err)
  53                 return err;
  54
  55         err = mt7921_run_firmware(dev);
  56
  57         mt76_queue_tx_cleanup(dev, dev->mt76.q_mcu[MT_MCUQ_FWDL], false);
  58
  59         return err;
  60 }
  61
  62 int __mt7921e_mcu_drv_pmctrl(struct mt7921_dev *dev)
  63 {
  64         int i, err = 0;
  65
  66         for (i = 0; i < MT7921_DRV_OWN_RETRY_COUNT; i++) {
  67                 mt76_wr(dev, MT_CONN_ON_LPCTL, PCIE_LPCR_HOST_CLR_OWN);
  68                 if (mt76_poll_msec(dev, MT_CONN_ON_LPCTL,
  69                                    PCIE_LPCR_HOST_OWN_SYNC, 0, 50))
  70                         break;
  71         }
  72
  73         if (i == MT7921_DRV_OWN_RETRY_COUNT) {
  74                 dev_err(dev->mt76.dev, "driver own failed\n");
  75                 err = -EIO;
  76         }
  77
  78         return err;
  79 }
  80
  81 int mt7921e_mcu_drv_pmctrl(struct mt7921_dev *dev)
  82 {
  83         struct mt76_phy *mphy = &dev->mt76.phy;
  84         struct mt76_connac_pm *pm = &dev->pm;
  85         int err;
  86
  87         err = __mt7921e_mcu_drv_pmctrl(dev);
  88         if (err < 0)
  89                 goto out;
  90
  91         mt7921_wpdma_reinit_cond(dev);
  92         clear_bit(MT76_STATE_PM, &mphy->state);
  93
  94         pm->stats.last_wake_event = jiffies;
  95         pm->stats.doze_time += pm->stats.last_wake_event -
  96                                pm->stats.last_doze_event;
  97 out:
  98         return err;
  99 }
 100
 101 int mt7921e_mcu_fw_pmctrl(struct mt7921_dev *dev)
 102 {
 103         struct mt76_phy *mphy = &dev->mt76.phy;
 104         struct mt76_connac_pm *pm = &dev->pm;
 105         int i;
 106
 107         for (i = 0; i < MT7921_DRV_OWN_RETRY_COUNT; i++) {
 108                 mt76_wr(dev, MT_CONN_ON_LPCTL, PCIE_LPCR_HOST_SET_OWN);
 109                 if (mt76_poll_msec(dev, MT_CONN_ON_LPCTL,
 110                                    PCIE_LPCR_HOST_OWN_SYNC, 4, 50))
 111                         break;
 112         }
 113
 114         if (i == MT7921_DRV_OWN_RETRY_COUNT) {
 115                 dev_err(dev->mt76.dev, "firmware own failed\n");
 116                 clear_bit(MT76_STATE_PM, &mphy->state);
 117                 return -EIO;
 118         }
 119
 120         pm->stats.last_doze_event = jiffies;
 121         pm->stats.awake_time += pm->stats.last_doze_event -
 122                                 pm->stats.last_wake_event;
 123
 124         return 0;
 125 }