318 lines · c
1// SPDX-License-Identifier: ISC2/* Copyright (C) 2023 MediaTek Inc.3 *4 * Author: Lorenzo Bianconi <lorenzo@kernel.org>5 */6 7#include <linux/kernel.h>8#include <linux/module.h>9#include <linux/usb.h>10 11#include "mt792x.h"12#include "mt76_connac2_mac.h"13 14u32 mt792xu_rr(struct mt76_dev *dev, u32 addr)15{16 u32 ret;17 18 mutex_lock(&dev->usb.usb_ctrl_mtx);19 ret = ___mt76u_rr(dev, MT_VEND_READ_EXT,20 USB_DIR_IN | MT_USB_TYPE_VENDOR, addr);21 mutex_unlock(&dev->usb.usb_ctrl_mtx);22 23 return ret;24}25EXPORT_SYMBOL_GPL(mt792xu_rr);26 27void mt792xu_wr(struct mt76_dev *dev, u32 addr, u32 val)28{29 mutex_lock(&dev->usb.usb_ctrl_mtx);30 ___mt76u_wr(dev, MT_VEND_WRITE_EXT,31 USB_DIR_OUT | MT_USB_TYPE_VENDOR, addr, val);32 mutex_unlock(&dev->usb.usb_ctrl_mtx);33}34EXPORT_SYMBOL_GPL(mt792xu_wr);35 36u32 mt792xu_rmw(struct mt76_dev *dev, u32 addr, u32 mask, u32 val)37{38 mutex_lock(&dev->usb.usb_ctrl_mtx);39 val |= ___mt76u_rr(dev, MT_VEND_READ_EXT,40 USB_DIR_IN | MT_USB_TYPE_VENDOR, addr) & ~mask;41 ___mt76u_wr(dev, MT_VEND_WRITE_EXT,42 USB_DIR_OUT | MT_USB_TYPE_VENDOR, addr, val);43 mutex_unlock(&dev->usb.usb_ctrl_mtx);44 45 return val;46}47EXPORT_SYMBOL_GPL(mt792xu_rmw);48 49void mt792xu_copy(struct mt76_dev *dev, u32 offset, const void *data, int len)50{51 struct mt76_usb *usb = &dev->usb;52 int ret, i = 0, batch_len;53 const u8 *val = data;54 55 len = round_up(len, 4);56 57 mutex_lock(&usb->usb_ctrl_mtx);58 while (i < len) {59 batch_len = min_t(int, usb->data_len, len - i);60 memcpy(usb->data, val + i, batch_len);61 ret = __mt76u_vendor_request(dev, MT_VEND_WRITE_EXT,62 USB_DIR_OUT | MT_USB_TYPE_VENDOR,63 (offset + i) >> 16, offset + i,64 usb->data, batch_len);65 if (ret < 0)66 break;67 68 i += batch_len;69 }70 mutex_unlock(&usb->usb_ctrl_mtx);71}72EXPORT_SYMBOL_GPL(mt792xu_copy);73 74int mt792xu_mcu_power_on(struct mt792x_dev *dev)75{76 int ret;77 78 ret = mt76u_vendor_request(&dev->mt76, MT_VEND_POWER_ON,79 USB_DIR_OUT | MT_USB_TYPE_VENDOR,80 0x0, 0x1, NULL, 0);81 if (ret)82 return ret;83 84 if (!mt76_poll_msec(dev, MT_CONN_ON_MISC, MT_TOP_MISC2_FW_PWR_ON,85 MT_TOP_MISC2_FW_PWR_ON, 500)) {86 dev_err(dev->mt76.dev, "Timeout for power on\n");87 ret = -EIO;88 }89 90 return ret;91}92EXPORT_SYMBOL_GPL(mt792xu_mcu_power_on);93 94static void mt792xu_cleanup(struct mt792x_dev *dev)95{96 clear_bit(MT76_STATE_INITIALIZED, &dev->mphy.state);97 mt792xu_wfsys_reset(dev);98 skb_queue_purge(&dev->mt76.mcu.res_q);99 mt76u_queues_deinit(&dev->mt76);100}101 102static u32 mt792xu_uhw_rr(struct mt76_dev *dev, u32 addr)103{104 u32 ret;105 106 mutex_lock(&dev->usb.usb_ctrl_mtx);107 ret = ___mt76u_rr(dev, MT_VEND_DEV_MODE,108 USB_DIR_IN | MT_USB_TYPE_UHW_VENDOR, addr);109 mutex_unlock(&dev->usb.usb_ctrl_mtx);110 111 return ret;112}113 114static void mt792xu_uhw_wr(struct mt76_dev *dev, u32 addr, u32 val)115{116 mutex_lock(&dev->usb.usb_ctrl_mtx);117 ___mt76u_wr(dev, MT_VEND_WRITE,118 USB_DIR_OUT | MT_USB_TYPE_UHW_VENDOR, addr, val);119 mutex_unlock(&dev->usb.usb_ctrl_mtx);120}121 122static void mt792xu_dma_prefetch(struct mt792x_dev *dev)123{124#define DMA_PREFETCH_CONF(_idx_, _cnt_, _base_) \125 mt76_rmw(dev, MT_UWFDMA0_TX_RING_EXT_CTRL((_idx_)), \126 MT_WPDMA0_MAX_CNT_MASK | MT_WPDMA0_BASE_PTR_MASK, \127 FIELD_PREP(MT_WPDMA0_MAX_CNT_MASK, (_cnt_)) | \128 FIELD_PREP(MT_WPDMA0_BASE_PTR_MASK, (_base_)))129 130 DMA_PREFETCH_CONF(0, 4, 0x080);131 DMA_PREFETCH_CONF(1, 4, 0x0c0);132 DMA_PREFETCH_CONF(2, 4, 0x100);133 DMA_PREFETCH_CONF(3, 4, 0x140);134 DMA_PREFETCH_CONF(4, 4, 0x180);135 DMA_PREFETCH_CONF(16, 4, 0x280);136 DMA_PREFETCH_CONF(17, 4, 0x2c0);137}138 139static void mt792xu_wfdma_init(struct mt792x_dev *dev)140{141 int i;142 143 mt792xu_dma_prefetch(dev);144 145 mt76_clear(dev, MT_UWFDMA0_GLO_CFG, MT_WFDMA0_GLO_CFG_OMIT_RX_INFO);146 mt76_set(dev, MT_UWFDMA0_GLO_CFG,147 MT_WFDMA0_GLO_CFG_OMIT_TX_INFO |148 MT_WFDMA0_GLO_CFG_OMIT_RX_INFO_PFET2 |149 MT_WFDMA0_GLO_CFG_FW_DWLD_BYPASS_DMASHDL |150 MT_WFDMA0_GLO_CFG_TX_DMA_EN |151 MT_WFDMA0_GLO_CFG_RX_DMA_EN);152 153 mt76_rmw(dev, MT_DMASHDL_REFILL, MT_DMASHDL_REFILL_MASK, 0xffe00000);154 mt76_clear(dev, MT_DMASHDL_PAGE, MT_DMASHDL_GROUP_SEQ_ORDER);155 mt76_rmw(dev, MT_DMASHDL_PKT_MAX_SIZE,156 MT_DMASHDL_PKT_MAX_SIZE_PLE | MT_DMASHDL_PKT_MAX_SIZE_PSE,157 FIELD_PREP(MT_DMASHDL_PKT_MAX_SIZE_PLE, 1) |158 FIELD_PREP(MT_DMASHDL_PKT_MAX_SIZE_PSE, 0));159 for (i = 0; i < 5; i++)160 mt76_wr(dev, MT_DMASHDL_GROUP_QUOTA(i),161 FIELD_PREP(MT_DMASHDL_GROUP_QUOTA_MIN, 0x3) |162 FIELD_PREP(MT_DMASHDL_GROUP_QUOTA_MAX, 0xfff));163 for (i = 5; i < 16; i++)164 mt76_wr(dev, MT_DMASHDL_GROUP_QUOTA(i),165 FIELD_PREP(MT_DMASHDL_GROUP_QUOTA_MIN, 0x0) |166 FIELD_PREP(MT_DMASHDL_GROUP_QUOTA_MAX, 0x0));167 mt76_wr(dev, MT_DMASHDL_Q_MAP(0), 0x32013201);168 mt76_wr(dev, MT_DMASHDL_Q_MAP(1), 0x32013201);169 mt76_wr(dev, MT_DMASHDL_Q_MAP(2), 0x55555444);170 mt76_wr(dev, MT_DMASHDL_Q_MAP(3), 0x55555444);171 172 mt76_wr(dev, MT_DMASHDL_SCHED_SET(0), 0x76540132);173 mt76_wr(dev, MT_DMASHDL_SCHED_SET(1), 0xFEDCBA98);174 175 mt76_set(dev, MT_WFDMA_DUMMY_CR, MT_WFDMA_NEED_REINIT);176}177 178static int mt792xu_dma_rx_evt_ep4(struct mt792x_dev *dev)179{180 if (!mt76_poll(dev, MT_UWFDMA0_GLO_CFG,181 MT_WFDMA0_GLO_CFG_RX_DMA_BUSY, 0, 1000))182 return -ETIMEDOUT;183 184 mt76_clear(dev, MT_UWFDMA0_GLO_CFG, MT_WFDMA0_GLO_CFG_RX_DMA_EN);185 mt76_set(dev, MT_WFDMA_HOST_CONFIG,186 MT_WFDMA_HOST_CONFIG_USB_RXEVT_EP4_EN);187 mt76_set(dev, MT_UWFDMA0_GLO_CFG, MT_WFDMA0_GLO_CFG_RX_DMA_EN);188 189 return 0;190}191 192static void mt792xu_epctl_rst_opt(struct mt792x_dev *dev, bool reset)193{194 u32 val;195 196 /* usb endpoint reset opt197 * bits[4,9]: out blk ep 4-9198 * bits[20,21]: in blk ep 4-5199 * bits[22]: in int ep 6200 */201 val = mt792xu_uhw_rr(&dev->mt76, MT_SSUSB_EPCTL_CSR_EP_RST_OPT);202 if (reset)203 val |= GENMASK(9, 4) | GENMASK(22, 20);204 else205 val &= ~(GENMASK(9, 4) | GENMASK(22, 20));206 mt792xu_uhw_wr(&dev->mt76, MT_SSUSB_EPCTL_CSR_EP_RST_OPT, val);207}208 209int mt792xu_dma_init(struct mt792x_dev *dev, bool resume)210{211 int err;212 213 mt792xu_wfdma_init(dev);214 215 mt76_clear(dev, MT_UDMA_WLCFG_0, MT_WL_RX_FLUSH);216 217 mt76_set(dev, MT_UDMA_WLCFG_0,218 MT_WL_RX_EN | MT_WL_TX_EN |219 MT_WL_RX_MPSZ_PAD0 | MT_TICK_1US_EN);220 mt76_clear(dev, MT_UDMA_WLCFG_0,221 MT_WL_RX_AGG_TO | MT_WL_RX_AGG_LMT);222 mt76_clear(dev, MT_UDMA_WLCFG_1, MT_WL_RX_AGG_PKT_LMT);223 224 if (resume)225 return 0;226 227 err = mt792xu_dma_rx_evt_ep4(dev);228 if (err)229 return err;230 231 mt792xu_epctl_rst_opt(dev, false);232 233 return 0;234}235EXPORT_SYMBOL_GPL(mt792xu_dma_init);236 237int mt792xu_wfsys_reset(struct mt792x_dev *dev)238{239 u32 val;240 int i;241 242 mt792xu_epctl_rst_opt(dev, false);243 244 val = mt792xu_uhw_rr(&dev->mt76, MT_CBTOP_RGU_WF_SUBSYS_RST);245 val |= MT_CBTOP_RGU_WF_SUBSYS_RST_WF_WHOLE_PATH;246 mt792xu_uhw_wr(&dev->mt76, MT_CBTOP_RGU_WF_SUBSYS_RST, val);247 248 usleep_range(10, 20);249 250 val = mt792xu_uhw_rr(&dev->mt76, MT_CBTOP_RGU_WF_SUBSYS_RST);251 val &= ~MT_CBTOP_RGU_WF_SUBSYS_RST_WF_WHOLE_PATH;252 mt792xu_uhw_wr(&dev->mt76, MT_CBTOP_RGU_WF_SUBSYS_RST, val);253 254 mt792xu_uhw_wr(&dev->mt76, MT_UDMA_CONN_INFRA_STATUS_SEL, 0);255 for (i = 0; i < MT792x_WFSYS_INIT_RETRY_COUNT; i++) {256 val = mt792xu_uhw_rr(&dev->mt76, MT_UDMA_CONN_INFRA_STATUS);257 if (val & MT_UDMA_CONN_WFSYS_INIT_DONE)258 break;259 260 msleep(100);261 }262 263 if (i == MT792x_WFSYS_INIT_RETRY_COUNT)264 return -ETIMEDOUT;265 266 return 0;267}268EXPORT_SYMBOL_GPL(mt792xu_wfsys_reset);269 270int mt792xu_init_reset(struct mt792x_dev *dev)271{272 set_bit(MT76_RESET, &dev->mphy.state);273 274 wake_up(&dev->mt76.mcu.wait);275 skb_queue_purge(&dev->mt76.mcu.res_q);276 277 mt76u_stop_rx(&dev->mt76);278 mt76u_stop_tx(&dev->mt76);279 280 mt792xu_wfsys_reset(dev);281 282 clear_bit(MT76_RESET, &dev->mphy.state);283 284 return mt76u_resume_rx(&dev->mt76);285}286EXPORT_SYMBOL_GPL(mt792xu_init_reset);287 288void mt792xu_stop(struct ieee80211_hw *hw, bool suspend)289{290 struct mt792x_dev *dev = mt792x_hw_dev(hw);291 292 mt76u_stop_tx(&dev->mt76);293 mt792x_stop(hw, false);294}295EXPORT_SYMBOL_GPL(mt792xu_stop);296 297void mt792xu_disconnect(struct usb_interface *usb_intf)298{299 struct mt792x_dev *dev = usb_get_intfdata(usb_intf);300 301 cancel_work_sync(&dev->init_work);302 if (!test_bit(MT76_STATE_INITIALIZED, &dev->mphy.state))303 return;304 305 mt76_unregister_device(&dev->mt76);306 mt792xu_cleanup(dev);307 308 usb_set_intfdata(usb_intf, NULL);309 usb_put_dev(interface_to_usbdev(usb_intf));310 311 mt76_free_device(&dev->mt76);312}313EXPORT_SYMBOL_GPL(mt792xu_disconnect);314 315MODULE_DESCRIPTION("MediaTek MT792x USB helpers");316MODULE_LICENSE("Dual BSD/GPL");317MODULE_AUTHOR("Lorenzo Bianconi <lorenzo@kernel.org>");318