Quelle  usb_sdio.c   Sprache: C

// SPDX-License-Identifier: ISC
/* Copyright (C) 2020 MediaTek Inc.
 *
 * Author: Lorenzo Bianconi <lorenzo@kernel.org>
 *    Sean Wang <sean.wang@mediatek.com>
 */

#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/usb.h>

#include "mt7615.h"
#include "mac.h"
#include "mcu.h"
#include "regs.h"

const u32 mt7663_usb_sdio_reg_map[] = {
 [MT_TOP_CFG_BASE] = 0x80020000,
 [MT_HW_BASE]  = 0x80000000,
 [MT_DMA_SHDL_BASE] = 0x5000a000,
 [MT_HIF_BASE]  = 0x50000000,
 [MT_CSR_BASE]  = 0x40000000,
 [MT_EFUSE_ADDR_BASE] = 0x78011000,
 [MT_TOP_MISC_BASE] = 0x81020000,
 [MT_PLE_BASE]  = 0x82060000,
 [MT_PSE_BASE]  = 0x82068000,
 [MT_PP_BASE]  = 0x8206c000,
 [MT_WTBL_BASE_ADDR] = 0x820e0000,
 [MT_CFG_BASE]  = 0x820f0000,
 [MT_AGG_BASE]  = 0x820f2000,
 [MT_ARB_BASE]  = 0x820f3000,
 [MT_TMAC_BASE]  = 0x820f4000,
 [MT_RMAC_BASE]  = 0x820f5000,
 [MT_DMA_BASE]  = 0x820f7000,
 [MT_PF_BASE]  = 0x820f8000,
 [MT_WTBL_BASE_ON] = 0x820f9000,
 [MT_WTBL_BASE_OFF] = 0x820f9800,
 [MT_LPON_BASE]  = 0x820fb000,
 [MT_MIB_BASE]  = 0x820fd000,
};
EXPORT_SYMBOL_GPL(mt7663_usb_sdio_reg_map);

static void
mt7663_usb_sdio_write_txwi(struct mt7615_dev *dev, struct mt76_wcid *wcid,
      enum mt76_txq_id qid, struct ieee80211_sta *sta,
      struct ieee80211_key_conf *key, int pid,
      struct sk_buff *skb)
{
 __le32 *txwi = (__le32 *)(skb->data - MT_USB_TXD_SIZE);

 memset(txwi, 0, MT_USB_TXD_SIZE);
 mt7615_mac_write_txwi(dev, txwi, skb, wcid, sta, pid, key, qid, false);
 skb_push(skb, MT_USB_TXD_SIZE);
}

static int mt7663_usb_sdio_set_rates(struct mt7615_dev *dev,
         struct mt7615_wtbl_rate_desc *wrd)
{
 struct mt7615_rate_desc *rate = &wrd->rate;
 struct mt7615_sta *sta = wrd->sta;
 u32 w5, w27, addr, val;
 u16 idx;

 lockdep_assert_held(&dev->mt76.mutex);

 if (!sta)
  return -EINVAL;

 if (!mt76_poll(dev, MT_WTBL_UPDATE, MT_WTBL_UPDATE_BUSY, 0, 5000))
  return -ETIMEDOUT;

 addr = mt7615_mac_wtbl_addr(dev, sta->wcid.idx);

 w27 = mt76_rr(dev, addr + 27 * 4);
 w27 &= ~MT_WTBL_W27_CC_BW_SEL;
 w27 |= FIELD_PREP(MT_WTBL_W27_CC_BW_SEL, rate->bw);

 w5 = mt76_rr(dev, addr + 5 * 4);
 w5 &= ~(MT_WTBL_W5_BW_CAP | MT_WTBL_W5_CHANGE_BW_RATE |
  MT_WTBL_W5_MPDU_OK_COUNT |
  MT_WTBL_W5_MPDU_FAIL_COUNT |
  MT_WTBL_W5_RATE_IDX);
 w5 |= FIELD_PREP(MT_WTBL_W5_BW_CAP, rate->bw) |
       FIELD_PREP(MT_WTBL_W5_CHANGE_BW_RATE,
    rate->bw_idx ? rate->bw_idx - 1 : 7);

 mt76_wr(dev, MT_WTBL_RIUCR0, w5);

 mt76_wr(dev, MT_WTBL_RIUCR1,
  FIELD_PREP(MT_WTBL_RIUCR1_RATE0, rate->probe_val) |
  FIELD_PREP(MT_WTBL_RIUCR1_RATE1, rate->val[0]) |
  FIELD_PREP(MT_WTBL_RIUCR1_RATE2_LO, rate->val[1]));

 mt76_wr(dev, MT_WTBL_RIUCR2,
  FIELD_PREP(MT_WTBL_RIUCR2_RATE2_HI, rate->val[1] >> 8) |
  FIELD_PREP(MT_WTBL_RIUCR2_RATE3, rate->val[1]) |
  FIELD_PREP(MT_WTBL_RIUCR2_RATE4, rate->val[2]) |
  FIELD_PREP(MT_WTBL_RIUCR2_RATE5_LO, rate->val[2]));

 mt76_wr(dev, MT_WTBL_RIUCR3,
  FIELD_PREP(MT_WTBL_RIUCR3_RATE5_HI, rate->val[2] >> 4) |
  FIELD_PREP(MT_WTBL_RIUCR3_RATE6, rate->val[3]) |
  FIELD_PREP(MT_WTBL_RIUCR3_RATE7, rate->val[3]));

 mt76_wr(dev, MT_WTBL_UPDATE,
  FIELD_PREP(MT_WTBL_UPDATE_WLAN_IDX, sta->wcid.idx) |
  MT_WTBL_UPDATE_RATE_UPDATE |
  MT_WTBL_UPDATE_TX_COUNT_CLEAR);

 mt76_wr(dev, addr + 27 * 4, w27);

 sta->rate_probe = sta->rateset[rate->rateset].probe_rate.idx != -1;

 idx = sta->vif->mt76.omac_idx;
 idx = idx > HW_BSSID_MAX ? HW_BSSID_0 : idx;
 addr = idx > 1 ? MT_LPON_TCR2(idx): MT_LPON_TCR0(idx);

 mt76_rmw(dev, addr, MT_LPON_TCR_MODE, MT_LPON_TCR_READ); /* TSF read */
 val = mt76_rr(dev, MT_LPON_UTTR0);
 sta->rate_set_tsf = (val & ~BIT(0)) | rate->rateset;

 if (!(sta->wcid.tx_info & MT_WCID_TX_INFO_SET))
  mt76_poll(dev, MT_WTBL_UPDATE, MT_WTBL_UPDATE_BUSY, 0, 5000);

 sta->rate_count = 2 * MT7615_RATE_RETRY * sta->n_rates;
 sta->wcid.tx_info |= MT_WCID_TX_INFO_SET;

 return 0;
}

static void mt7663_usb_sdio_rate_work(struct work_struct *work)
{
 struct mt7615_wtbl_rate_desc *wrd, *wrd_next;
 struct list_head wrd_list;
 struct mt7615_dev *dev;

 dev = (struct mt7615_dev *)container_of(work, struct mt7615_dev,
      rate_work);

 INIT_LIST_HEAD(&wrd_list);
 spin_lock_bh(&dev->mt76.lock);
 list_splice_init(&dev->wrd_head, &wrd_list);
 spin_unlock_bh(&dev->mt76.lock);

 list_for_each_entry_safe(wrd, wrd_next, &wrd_list, node) {
  list_del(&wrd->node);

  mt7615_mutex_acquire(dev);
  mt7663_usb_sdio_set_rates(dev, wrd);
  mt7615_mutex_release(dev);

  kfree(wrd);
 }
}

bool mt7663_usb_sdio_tx_status_data(struct mt76_dev *mdev, u8 *update)
{
 struct mt7615_dev *dev = container_of(mdev, struct mt7615_dev, mt76);

 mt7615_mutex_acquire(dev);
 mt7615_mac_sta_poll(dev);
 mt7615_mutex_release(dev);

 return false;
}
EXPORT_SYMBOL_GPL(mt7663_usb_sdio_tx_status_data);

void mt7663_usb_sdio_tx_complete_skb(struct mt76_dev *mdev,
         struct mt76_queue_entry *e)
{
 unsigned int headroom = MT_USB_TXD_SIZE;

 if (mt76_is_usb(mdev))
  headroom += MT_USB_HDR_SIZE;
 skb_pull(e->skb, headroom);

 mt76_tx_complete_skb(mdev, e->wcid, e->skb);
}
EXPORT_SYMBOL_GPL(mt7663_usb_sdio_tx_complete_skb);

int mt7663_usb_sdio_tx_prepare_skb(struct mt76_dev *mdev, void *txwi_ptr,
       enum mt76_txq_id qid, struct mt76_wcid *wcid,
       struct ieee80211_sta *sta,
       struct mt76_tx_info *tx_info)
{
 struct mt7615_dev *dev = container_of(mdev, struct mt7615_dev, mt76);
 struct sk_buff *skb = tx_info->skb;
 struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
 struct ieee80211_key_conf *key = info->control.hw_key;
 struct mt7615_sta *msta;
 int pad, err, pktid;

 msta = wcid ? container_of(wcid, struct mt7615_sta, wcid) : NULL;
 if (!wcid)
  wcid = &dev->mt76.global_wcid;

 if ((info->flags & IEEE80211_TX_CTL_RATE_CTRL_PROBE) &&
     msta && !msta->rate_probe) {
  /* request to configure sampling rate */
  spin_lock_bh(&dev->mt76.lock);
  mt7615_mac_set_rates(&dev->phy, msta, &info->control.rates[0],
         msta->rates);
  spin_unlock_bh(&dev->mt76.lock);
 }

 pktid = mt76_tx_status_skb_add(&dev->mt76, wcid, skb);
 mt7663_usb_sdio_write_txwi(dev, wcid, qid, sta, key, pktid, skb);
 if (mt76_is_usb(mdev)) {
  u32 len = skb->len;

  put_unaligned_le32(len, skb_push(skb, sizeof(len)));
  pad = round_up(skb->len, 4) + 4 - skb->len;
 } else {
  pad = round_up(skb->len, 4) - skb->len;
 }

 err = mt76_skb_adjust_pad(skb, pad);
 if (err)
  /* Release pktid in case of error. */
  idr_remove(&wcid->pktid, pktid);

 return err;
}
EXPORT_SYMBOL_GPL(mt7663_usb_sdio_tx_prepare_skb);

static int mt7663u_dma_sched_init(struct mt7615_dev *dev)
{
 int i;

 mt76_rmw(dev, MT_DMA_SHDL(MT_DMASHDL_PKT_MAX_SIZE),
   MT_DMASHDL_PKT_MAX_SIZE_PLE | MT_DMASHDL_PKT_MAX_SIZE_PSE,
   FIELD_PREP(MT_DMASHDL_PKT_MAX_SIZE_PLE, 1) |
   FIELD_PREP(MT_DMASHDL_PKT_MAX_SIZE_PSE, 8));

 /* disable refill group 5 - group 15 and raise group 2
 * and 3 as high priority.
 */
 mt76_wr(dev, MT_DMA_SHDL(MT_DMASHDL_REFILL), 0xffe00006);
 mt76_clear(dev, MT_DMA_SHDL(MT_DMASHDL_PAGE), BIT(16));

 for (i = 0; i < 5; i++)
  mt76_wr(dev, MT_DMA_SHDL(MT_DMASHDL_GROUP_QUOTA(i)),
   FIELD_PREP(MT_DMASHDL_GROUP_QUOTA_MIN, 0x3) |
   FIELD_PREP(MT_DMASHDL_GROUP_QUOTA_MAX, 0x1ff));

 mt76_wr(dev, MT_DMA_SHDL(MT_DMASHDL_Q_MAP(0)), 0x42104210);
 mt76_wr(dev, MT_DMA_SHDL(MT_DMASHDL_Q_MAP(1)), 0x42104210);

 mt76_wr(dev, MT_DMA_SHDL(MT_DMASHDL_Q_MAP(2)), 0x4444);

 /* group pririority from high to low:
 * 15 (cmd groups) > 4 > 3 > 2 > 1 > 0.
 */
 mt76_wr(dev, MT_DMA_SHDL(MT_DMASHDL_SCHED_SET0), 0x6501234f);
 mt76_wr(dev, MT_DMA_SHDL(MT_DMASHDL_SCHED_SET1), 0xedcba987);
 mt76_wr(dev, MT_DMA_SHDL(MT_DMASHDL_OPTIONAL), 0x7004801c);

 mt76_wr(dev, MT_UDMA_WLCFG_1,
  FIELD_PREP(MT_WL_TX_TMOUT_LMT, 80000) |
  FIELD_PREP(MT_WL_RX_AGG_PKT_LMT, 1));

 /* setup UDMA Rx Flush */
 mt76_clear(dev, MT_UDMA_WLCFG_0, MT_WL_RX_FLUSH);
 /* hif reset */
 mt76_set(dev, MT_HIF_RST, MT_HIF_LOGIC_RST_N);

 mt76_set(dev, MT_UDMA_WLCFG_0,
   MT_WL_RX_AGG_EN | MT_WL_RX_EN | MT_WL_TX_EN |
   MT_WL_RX_MPSZ_PAD0 | MT_TICK_1US_EN |
   MT_WL_TX_TMOUT_FUNC_EN);
 mt76_rmw(dev, MT_UDMA_WLCFG_0, MT_WL_RX_AGG_LMT | MT_WL_RX_AGG_TO,
   FIELD_PREP(MT_WL_RX_AGG_LMT, 32) |
   FIELD_PREP(MT_WL_RX_AGG_TO, 100));

 return 0;
}

static int mt7663_usb_sdio_init_hardware(struct mt7615_dev *dev)
{
 int ret, idx;

 ret = mt7615_eeprom_init(dev, MT_EFUSE_BASE);
 if (ret < 0)
  return ret;

 if (mt76_is_usb(&dev->mt76)) {
  ret = mt7663u_dma_sched_init(dev);
  if (ret)
   return ret;
 }

 set_bit(MT76_STATE_INITIALIZED, &dev->mphy.state);

 /* Beacon and mgmt frames should occupy wcid 0 */
 idx = mt76_wcid_alloc(dev->mt76.wcid_mask, MT7615_WTBL_STA - 1);
 if (idx)
  return -ENOSPC;

 dev->mt76.global_wcid.idx = idx;
 dev->mt76.global_wcid.hw_key_idx = -1;
 rcu_assign_pointer(dev->mt76.wcid[idx], &dev->mt76.global_wcid);

 return 0;
}

int mt7663_usb_sdio_register_device(struct mt7615_dev *dev)
{
 struct ieee80211_hw *hw = mt76_hw(dev);
 int err;

 INIT_WORK(&dev->rate_work, mt7663_usb_sdio_rate_work);
 INIT_LIST_HEAD(&dev->wrd_head);
 mt7615_init_device(dev);

 err = mt7663_usb_sdio_init_hardware(dev);
 if (err)
  return err;

 hw->extra_tx_headroom += MT_USB_TXD_SIZE;
 if (mt76_is_usb(&dev->mt76)) {
  hw->extra_tx_headroom += MT_USB_HDR_SIZE;
  /* check hw sg support in order to enable AMSDU */
  if (dev->mt76.usb.sg_en)
   hw->max_tx_fragments = MT_HW_TXP_MAX_BUF_NUM;
  else
   hw->max_tx_fragments = 1;
 }

 err = mt76_register_device(&dev->mt76, true, mt76_rates,
       ARRAY_SIZE(mt76_rates));
 if (err < 0)
  return err;

 if (!dev->mt76.usb.sg_en) {
  struct ieee80211_sta_vht_cap *vht_cap;

  /* decrease max A-MSDU size if SG is not supported */
  vht_cap = &dev->mphy.sband_5g.sband.vht_cap;
  vht_cap->cap &= ~IEEE80211_VHT_CAP_MAX_MPDU_LENGTH_11454;
 }

 ieee80211_queue_work(hw, &dev->mcu_work);
 mt7615_init_txpower(dev, &dev->mphy.sband_2g.sband);
 mt7615_init_txpower(dev, &dev->mphy.sband_5g.sband);

 return mt7615_init_debugfs(dev);
}
EXPORT_SYMBOL_GPL(mt7663_usb_sdio_register_device);

MODULE_AUTHOR("Lorenzo Bianconi ");
MODULE_AUTHOR("Sean Wang ");
MODULE_DESCRIPTION("MediaTek MT7663 SDIO/USB helpers");
MODULE_LICENSE("Dual BSD/GPL");