1 // SPDX-License-Identifier: ISC
3 * Copyright (C) 2016 Felix Fietkau <nbd@nbd.name>
4 * Copyright (C) 2018 Lorenzo Bianconi <lorenzo.bianconi83@gmail.com>
7 #include <linux/kernel.h>
8 #include <linux/firmware.h>
9 #include <linux/delay.h>
11 #include "mt76x02_mcu.h"
13 int mt76x02_mcu_parse_response(struct mt76_dev *mdev, int cmd,
14 struct sk_buff *skb, int seq)
16 struct mt76x02_dev *dev = container_of(mdev, struct mt76x02_dev, mt76);
20 dev_err(mdev->dev, "MCU message %02x (seq %d) timed out\n",
26 rxfce = (u32 *)skb->cb;
27 if (seq != FIELD_GET(MT_RX_FCE_INFO_CMD_SEQ, *rxfce))
32 EXPORT_SYMBOL_GPL(mt76x02_mcu_parse_response);
34 int mt76x02_mcu_msg_send(struct mt76_dev *mdev, int cmd, const void *data,
35 int len, bool wait_resp)
37 struct mt76x02_dev *dev = container_of(mdev, struct mt76x02_dev, mt76);
38 unsigned long expires = jiffies + HZ;
47 skb = mt76_mcu_msg_alloc(mdev, data, len);
51 mutex_lock(&mdev->mcu.mutex);
53 seq = ++mdev->mcu.msg_seq & 0xf;
55 seq = ++mdev->mcu.msg_seq & 0xf;
57 tx_info = MT_MCU_MSG_TYPE_CMD |
58 FIELD_PREP(MT_MCU_MSG_CMD_TYPE, cmd) |
59 FIELD_PREP(MT_MCU_MSG_CMD_SEQ, seq) |
60 FIELD_PREP(MT_MCU_MSG_PORT, CPU_TX_PORT) |
61 FIELD_PREP(MT_MCU_MSG_LEN, skb->len);
63 ret = mt76_tx_queue_skb_raw(dev, mdev->q_mcu[MT_MCUQ_WM], skb, tx_info);
68 skb = mt76_mcu_get_response(&dev->mt76, expires);
69 ret = mt76x02_mcu_parse_response(mdev, cmd, skb, seq);
76 mutex_unlock(&mdev->mcu.mutex);
80 EXPORT_SYMBOL_GPL(mt76x02_mcu_msg_send);
82 int mt76x02_mcu_function_select(struct mt76x02_dev *dev, enum mcu_function func,
88 } __packed __aligned(4) msg = {
89 .id = cpu_to_le32(func),
90 .value = cpu_to_le32(val),
97 return mt76_mcu_send_msg(&dev->mt76, CMD_FUN_SET_OP, &msg,
100 EXPORT_SYMBOL_GPL(mt76x02_mcu_function_select);
102 int mt76x02_mcu_set_radio_state(struct mt76x02_dev *dev, bool on)
107 } __packed __aligned(4) msg = {
108 .mode = cpu_to_le32(on ? RADIO_ON : RADIO_OFF),
109 .level = cpu_to_le32(0),
112 return mt76_mcu_send_msg(&dev->mt76, CMD_POWER_SAVING_OP, &msg,
115 EXPORT_SYMBOL_GPL(mt76x02_mcu_set_radio_state);
117 int mt76x02_mcu_calibrate(struct mt76x02_dev *dev, int type, u32 param)
122 } __packed __aligned(4) msg = {
123 .id = cpu_to_le32(type),
124 .value = cpu_to_le32(param),
126 bool is_mt76x2e = mt76_is_mmio(&dev->mt76) && is_mt76x2(dev);
130 mt76_rmw(dev, MT_MCU_COM_REG0, BIT(31), 0);
132 ret = mt76_mcu_send_msg(&dev->mt76, CMD_CALIBRATION_OP, &msg,
138 WARN_ON(!mt76_poll_msec(dev, MT_MCU_COM_REG0,
139 BIT(31), BIT(31), 100)))
144 EXPORT_SYMBOL_GPL(mt76x02_mcu_calibrate);
146 int mt76x02_mcu_cleanup(struct mt76x02_dev *dev)
150 mt76_wr(dev, MT_MCU_INT_LEVEL, 1);
151 usleep_range(20000, 30000);
153 while ((skb = skb_dequeue(&dev->mt76.mcu.res_q)) != NULL)
158 EXPORT_SYMBOL_GPL(mt76x02_mcu_cleanup);
160 void mt76x02_set_ethtool_fwver(struct mt76x02_dev *dev,
161 const struct mt76x02_fw_header *h)
163 u16 bld = le16_to_cpu(h->build_ver);
164 u16 ver = le16_to_cpu(h->fw_ver);
166 snprintf(dev->mt76.hw->wiphy->fw_version,
167 sizeof(dev->mt76.hw->wiphy->fw_version),
169 (ver >> 12) & 0xf, (ver >> 8) & 0xf, ver & 0xf, bld);
171 EXPORT_SYMBOL_GPL(mt76x02_set_ethtool_fwver);