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
13int 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}
32EXPORT_SYMBOL_GPL(mt76x02_mcu_parse_response);
33
34int 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
75out:
76	mutex_unlock(&mdev->mcu.mutex);
77
78	return ret;
79}
80EXPORT_SYMBOL_GPL(mt76x02_mcu_msg_send);
81
82int 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}
100EXPORT_SYMBOL_GPL(mt76x02_mcu_function_select);
101
102int 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}
115EXPORT_SYMBOL_GPL(mt76x02_mcu_set_radio_state);
116
117int 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}
144EXPORT_SYMBOL_GPL(mt76x02_mcu_calibrate);
145
146int 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}
158EXPORT_SYMBOL_GPL(mt76x02_mcu_cleanup);
159
160void 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}
171EXPORT_SYMBOL_GPL(mt76x02_set_ethtool_fwver);
172