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