181 lines · c
1// SPDX-License-Identifier: GPL-2.02/* Copyright (C) 2020 MediaTek Inc.3 *4 * Author: Felix Fietkau <nbd@nbd.name>5 * Lorenzo Bianconi <lorenzo@kernel.org>6 * Sean Wang <sean.wang@mediatek.com>7 */8#include <linux/kernel.h>9#include <linux/mmc/sdio_func.h>10#include <linux/module.h>11#include <linux/iopoll.h>12 13#include "../sdio.h"14#include "mt7615.h"15#include "mac.h"16#include "mcu.h"17#include "regs.h"18 19static int mt7663s_mcu_init_sched(struct mt7615_dev *dev)20{21 struct mt76_sdio *sdio = &dev->mt76.sdio;22 u32 txdwcnt;23 24 sdio->sched.pse_data_quota = mt76_get_field(dev, MT_PSE_PG_HIF0_GROUP,25 MT_HIF0_MIN_QUOTA);26 sdio->sched.pse_mcu_quota = mt76_get_field(dev, MT_PSE_PG_HIF1_GROUP,27 MT_HIF1_MIN_QUOTA);28 sdio->sched.ple_data_quota = mt76_get_field(dev, MT_PLE_PG_HIF0_GROUP,29 MT_HIF0_MIN_QUOTA);30 sdio->sched.pse_page_size = MT_PSE_PAGE_SZ;31 txdwcnt = mt76_get_field(dev, MT_PP_TXDWCNT,32 MT_PP_TXDWCNT_TX1_ADD_DW_CNT);33 sdio->sched.deficit = txdwcnt << 2;34 35 return 0;36}37 38static int39mt7663s_mcu_send_message(struct mt76_dev *mdev, struct sk_buff *skb,40 int cmd, int *seq)41{42 struct mt7615_dev *dev = container_of(mdev, struct mt7615_dev, mt76);43 int ret;44 45 mt7615_mcu_fill_msg(dev, skb, cmd, seq);46 ret = mt76_tx_queue_skb_raw(dev, mdev->q_mcu[MT_MCUQ_WM], skb, 0);47 if (ret)48 return ret;49 50 mt76_queue_kick(dev, mdev->q_mcu[MT_MCUQ_WM]);51 52 return ret;53}54 55static int __mt7663s_mcu_drv_pmctrl(struct mt7615_dev *dev)56{57 struct sdio_func *func = dev->mt76.sdio.func;58 struct mt76_phy *mphy = &dev->mt76.phy;59 struct mt76_connac_pm *pm = &dev->pm;60 u32 status;61 int ret;62 63 sdio_claim_host(func);64 65 sdio_writel(func, WHLPCR_FW_OWN_REQ_CLR, MCR_WHLPCR, NULL);66 67 ret = readx_poll_timeout(mt76s_read_pcr, &dev->mt76, status,68 status & WHLPCR_IS_DRIVER_OWN, 2000, 1000000);69 if (ret < 0) {70 dev_err(dev->mt76.dev, "Cannot get ownership from device");71 } else {72 clear_bit(MT76_STATE_PM, &mphy->state);73 74 pm->stats.last_wake_event = jiffies;75 pm->stats.doze_time += pm->stats.last_wake_event -76 pm->stats.last_doze_event;77 }78 sdio_release_host(func);79 80 return ret;81}82 83static int mt7663s_mcu_drv_pmctrl(struct mt7615_dev *dev)84{85 struct mt76_phy *mphy = &dev->mt76.phy;86 int ret = 0;87 88 mutex_lock(&dev->pm.mutex);89 90 if (test_bit(MT76_STATE_PM, &mphy->state))91 ret = __mt7663s_mcu_drv_pmctrl(dev);92 93 mutex_unlock(&dev->pm.mutex);94 95 return ret;96}97 98static int mt7663s_mcu_fw_pmctrl(struct mt7615_dev *dev)99{100 struct sdio_func *func = dev->mt76.sdio.func;101 struct mt76_phy *mphy = &dev->mt76.phy;102 struct mt76_connac_pm *pm = &dev->pm;103 int ret = 0;104 u32 status;105 106 mutex_lock(&pm->mutex);107 108 if (mt76_connac_skip_fw_pmctrl(mphy, pm))109 goto out;110 111 sdio_claim_host(func);112 113 sdio_writel(func, WHLPCR_FW_OWN_REQ_SET, MCR_WHLPCR, NULL);114 115 ret = readx_poll_timeout(mt76s_read_pcr, &dev->mt76, status,116 !(status & WHLPCR_IS_DRIVER_OWN), 2000, 1000000);117 if (ret < 0) {118 dev_err(dev->mt76.dev, "Cannot set ownership to device");119 clear_bit(MT76_STATE_PM, &mphy->state);120 } else {121 pm->stats.last_doze_event = jiffies;122 pm->stats.awake_time += pm->stats.last_doze_event -123 pm->stats.last_wake_event;124 }125 126 sdio_release_host(func);127out:128 mutex_unlock(&pm->mutex);129 130 return ret;131}132 133int mt7663s_mcu_init(struct mt7615_dev *dev)134{135 static const struct mt76_mcu_ops mt7663s_mcu_ops = {136 .headroom = sizeof(struct mt7615_mcu_txd),137 .tailroom = MT_USB_TAIL_SIZE,138 .mcu_skb_send_msg = mt7663s_mcu_send_message,139 .mcu_parse_response = mt7615_mcu_parse_response,140 .mcu_rr = mt76_connac_mcu_reg_rr,141 .mcu_wr = mt76_connac_mcu_reg_wr,142 };143 struct mt7615_mcu_ops *mcu_ops;144 int ret;145 146 ret = __mt7663s_mcu_drv_pmctrl(dev);147 if (ret)148 return ret;149 150 dev->mt76.mcu_ops = &mt7663s_mcu_ops,151 152 ret = mt76_get_field(dev, MT_CONN_ON_MISC, MT_TOP_MISC2_FW_N9_RDY);153 if (ret) {154 mt7615_mcu_restart(&dev->mt76);155 if (!mt76_poll_msec(dev, MT_CONN_ON_MISC,156 MT_TOP_MISC2_FW_N9_RDY, 0, 500))157 return -EIO;158 }159 160 ret = __mt7663_load_firmware(dev);161 if (ret)162 return ret;163 164 mcu_ops = devm_kmemdup(dev->mt76.dev, dev->mcu_ops, sizeof(*mcu_ops),165 GFP_KERNEL);166 if (!mcu_ops)167 return -ENOMEM;168 169 mcu_ops->set_drv_ctrl = mt7663s_mcu_drv_pmctrl;170 mcu_ops->set_fw_ctrl = mt7663s_mcu_fw_pmctrl;171 dev->mcu_ops = mcu_ops;172 173 ret = mt7663s_mcu_init_sched(dev);174 if (ret)175 return ret;176 177 set_bit(MT76_STATE_MCU_RUNNING, &dev->mphy.state);178 179 return 0;180}181