Gitiles
Code Review Sign In
git01.mediatek.com / openwrt / feeds / mtk-openwrt-feeds / 4a339e84a751910cc0cba5e99751a141cc359063 / . / autobuild_mac80211_release / mt7988_mt7996_mac80211 / package / kernel / mt76 / src / mt76x2 / mcu.c
blob: ac83ce5f3e8b6c7e06c8ba2b8611bea226f4b550 [file] [log] [blame]
developer0f312e82022-11-01 12:31:52 +0800[diff] [blame]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 "mt76x2.h"
12#include "mcu.h"
13#include "eeprom.h"
14
15int mt76x2_mcu_set_channel(struct mt76x02_dev *dev, u8 channel, u8 bw,
16 u8 bw_index, bool scan)
17{
18 struct {
19 u8 idx;
20 u8 scan;
21 u8 bw;
22 u8 _pad0;
23
24 __le16 chainmask;
25 u8 ext_chan;
26 u8 _pad1;
27
28 } __packed __aligned(4) msg = {
29 .idx = channel,
30 .scan = scan,
31 .bw = bw,
32 .chainmask = cpu_to_le16(dev->mphy.chainmask),
33 };
34
35 /* first set the channel without the extension channel info */
36 mt76_mcu_send_msg(&dev->mt76, CMD_SWITCH_CHANNEL_OP, &msg,
37 sizeof(msg), true);
38
39 usleep_range(5000, 10000);
40
41 msg.ext_chan = 0xe0 + bw_index;
42 return mt76_mcu_send_msg(&dev->mt76, CMD_SWITCH_CHANNEL_OP, &msg,
43 sizeof(msg), true);
44}
45EXPORT_SYMBOL_GPL(mt76x2_mcu_set_channel);
46
47int mt76x2_mcu_load_cr(struct mt76x02_dev *dev, u8 type, u8 temp_level,
48 u8 channel)
49{
50 struct {
51 u8 cr_mode;
52 u8 temp;
53 u8 ch;
54 u8 _pad0;
55
56 __le32 cfg;
57 } __packed __aligned(4) msg = {
58 .cr_mode = type,
59 .temp = temp_level,
60 .ch = channel,
61 };
62 u32 val;
63
64 val = BIT(31);
65 val |= (mt76x02_eeprom_get(dev, MT_EE_NIC_CONF_0) >> 8) & 0x00ff;
66 val |= (mt76x02_eeprom_get(dev, MT_EE_NIC_CONF_1) << 8) & 0xff00;
67 msg.cfg = cpu_to_le32(val);
68
69 /* first set the channel without the extension channel info */
70 return mt76_mcu_send_msg(&dev->mt76, CMD_LOAD_CR, &msg, sizeof(msg),
71 true);
72}
73EXPORT_SYMBOL_GPL(mt76x2_mcu_load_cr);
74
75int mt76x2_mcu_init_gain(struct mt76x02_dev *dev, u8 channel, u32 gain,
76 bool force)
77{
78 struct {
79 __le32 channel;
80 __le32 gain_val;
81 } __packed __aligned(4) msg = {
82 .channel = cpu_to_le32(channel),
83 .gain_val = cpu_to_le32(gain),
84 };
85
86 if (force)
87 msg.channel |= cpu_to_le32(BIT(31));
88
89 return mt76_mcu_send_msg(&dev->mt76, CMD_INIT_GAIN_OP, &msg,
90 sizeof(msg), true);
91}
92EXPORT_SYMBOL_GPL(mt76x2_mcu_init_gain);
93
94int mt76x2_mcu_tssi_comp(struct mt76x02_dev *dev,
95 struct mt76x2_tssi_comp *tssi_data)
96{
97 struct {
98 __le32 id;
99 struct mt76x2_tssi_comp data;
100 } __packed __aligned(4) msg = {
101 .id = cpu_to_le32(MCU_CAL_TSSI_COMP),
102 .data = *tssi_data,
103 };
104
105 return mt76_mcu_send_msg(&dev->mt76, CMD_CALIBRATION_OP, &msg,
106 sizeof(msg), true);
107}
108EXPORT_SYMBOL_GPL(mt76x2_mcu_tssi_comp);