This source file includes following definitions.
- mt76x02_mcu_msg_send
- mt76x02_mcu_function_select
- mt76x02_mcu_set_radio_state
- mt76x02_mcu_calibrate
- mt76x02_mcu_cleanup
- mt76x02_set_ethtool_fwver
1
2
3
4
5
6
7 #include <linux/kernel.h>
8 #include <linux/firmware.h>
9 #include <linux/delay.h>
10
11 #include "mt76x02_mcu.h"
12
13 int mt76x02_mcu_msg_send(struct mt76_dev *mdev, int cmd, const void *data,
14 int len, bool wait_resp)
15 {
16 struct mt76x02_dev *dev = container_of(mdev, struct mt76x02_dev, mt76);
17 unsigned long expires = jiffies + HZ;
18 struct sk_buff *skb;
19 u32 tx_info;
20 int ret;
21 u8 seq;
22
23 skb = mt76x02_mcu_msg_alloc(data, len);
24 if (!skb)
25 return -ENOMEM;
26
27 mutex_lock(&mdev->mmio.mcu.mutex);
28
29 seq = ++mdev->mmio.mcu.msg_seq & 0xf;
30 if (!seq)
31 seq = ++mdev->mmio.mcu.msg_seq & 0xf;
32
33 tx_info = MT_MCU_MSG_TYPE_CMD |
34 FIELD_PREP(MT_MCU_MSG_CMD_TYPE, cmd) |
35 FIELD_PREP(MT_MCU_MSG_CMD_SEQ, seq) |
36 FIELD_PREP(MT_MCU_MSG_PORT, CPU_TX_PORT) |
37 FIELD_PREP(MT_MCU_MSG_LEN, skb->len);
38
39 ret = mt76_tx_queue_skb_raw(dev, MT_TXQ_MCU, skb, tx_info);
40 if (ret)
41 goto out;
42
43 while (wait_resp) {
44 u32 *rxfce;
45 bool check_seq = false;
46
47 skb = mt76_mcu_get_response(&dev->mt76, expires);
48 if (!skb) {
49 dev_err(mdev->dev,
50 "MCU message %d (seq %d) timed out\n", cmd,
51 seq);
52 ret = -ETIMEDOUT;
53 dev->mcu_timeout = 1;
54 break;
55 }
56
57 rxfce = (u32 *)skb->cb;
58
59 if (seq == FIELD_GET(MT_RX_FCE_INFO_CMD_SEQ, *rxfce))
60 check_seq = true;
61
62 dev_kfree_skb(skb);
63 if (check_seq)
64 break;
65 }
66
67 out:
68 mutex_unlock(&mdev->mmio.mcu.mutex);
69
70 return ret;
71 }
72 EXPORT_SYMBOL_GPL(mt76x02_mcu_msg_send);
73
74 int mt76x02_mcu_function_select(struct mt76x02_dev *dev, enum mcu_function func,
75 u32 val)
76 {
77 struct {
78 __le32 id;
79 __le32 value;
80 } __packed __aligned(4) msg = {
81 .id = cpu_to_le32(func),
82 .value = cpu_to_le32(val),
83 };
84 bool wait = false;
85
86 if (func != Q_SELECT)
87 wait = true;
88
89 return mt76_mcu_send_msg(dev, CMD_FUN_SET_OP, &msg, sizeof(msg), wait);
90 }
91 EXPORT_SYMBOL_GPL(mt76x02_mcu_function_select);
92
93 int mt76x02_mcu_set_radio_state(struct mt76x02_dev *dev, bool on)
94 {
95 struct {
96 __le32 mode;
97 __le32 level;
98 } __packed __aligned(4) msg = {
99 .mode = cpu_to_le32(on ? RADIO_ON : RADIO_OFF),
100 .level = cpu_to_le32(0),
101 };
102
103 return mt76_mcu_send_msg(dev, CMD_POWER_SAVING_OP, &msg, sizeof(msg),
104 false);
105 }
106 EXPORT_SYMBOL_GPL(mt76x02_mcu_set_radio_state);
107
108 int mt76x02_mcu_calibrate(struct mt76x02_dev *dev, int type, u32 param)
109 {
110 struct {
111 __le32 id;
112 __le32 value;
113 } __packed __aligned(4) msg = {
114 .id = cpu_to_le32(type),
115 .value = cpu_to_le32(param),
116 };
117 bool is_mt76x2e = mt76_is_mmio(dev) && is_mt76x2(dev);
118 int ret;
119
120 if (is_mt76x2e)
121 mt76_rmw(dev, MT_MCU_COM_REG0, BIT(31), 0);
122
123 ret = mt76_mcu_send_msg(dev, CMD_CALIBRATION_OP, &msg, sizeof(msg),
124 true);
125 if (ret)
126 return ret;
127
128 if (is_mt76x2e &&
129 WARN_ON(!mt76_poll_msec(dev, MT_MCU_COM_REG0,
130 BIT(31), BIT(31), 100)))
131 return -ETIMEDOUT;
132
133 return 0;
134 }
135 EXPORT_SYMBOL_GPL(mt76x02_mcu_calibrate);
136
137 int mt76x02_mcu_cleanup(struct mt76x02_dev *dev)
138 {
139 struct sk_buff *skb;
140
141 mt76_wr(dev, MT_MCU_INT_LEVEL, 1);
142 usleep_range(20000, 30000);
143
144 while ((skb = skb_dequeue(&dev->mt76.mmio.mcu.res_q)) != NULL)
145 dev_kfree_skb(skb);
146
147 return 0;
148 }
149 EXPORT_SYMBOL_GPL(mt76x02_mcu_cleanup);
150
151 void mt76x02_set_ethtool_fwver(struct mt76x02_dev *dev,
152 const struct mt76x02_fw_header *h)
153 {
154 u16 bld = le16_to_cpu(h->build_ver);
155 u16 ver = le16_to_cpu(h->fw_ver);
156
157 snprintf(dev->mt76.hw->wiphy->fw_version,
158 sizeof(dev->mt76.hw->wiphy->fw_version),
159 "%d.%d.%02d-b%x",
160 (ver >> 12) & 0xf, (ver >> 8) & 0xf, ver & 0xf, bld);
161 }
162 EXPORT_SYMBOL_GPL(mt76x02_set_ethtool_fwver);