Commit dc804058 authored by Felix Fietkau's avatar Felix Fietkau
Browse files

mt76: mt7615: add support for accessing RF registers via MCU 



Includes debugfs files for testing it.
Will be used for testmode support.

Signed-off-by: default avatarFelix Fietkau <nbd@nbd.name>
parent 557b5a17

drivers/net/wireless/mediatek/mt76/mt7615/debugfs.c

+28 −0
Original line number Diff line number Diff line
@@ -285,6 +285,29 @@ mt7615_queues_read(struct seq_file *s, void *data) 
	return 0;

}



static int

mt7615_rf_reg_set(void *data, u64 val)

{

	struct mt7615_dev *dev = data;



	mt7615_rf_wr(dev, dev->debugfs_rf_wf, dev->debugfs_rf_reg, val);



	return 0;

}



static int

mt7615_rf_reg_get(void *data, u64 *val)

{

	struct mt7615_dev *dev = data;



	*val = mt7615_rf_rr(dev, dev->debugfs_rf_wf, dev->debugfs_rf_reg);



	return 0;

}



DEFINE_DEBUGFS_ATTRIBUTE(fops_rf_reg, mt7615_rf_reg_get, mt7615_rf_reg_set,

			 "0x%08llx\n");



int mt7615_init_debugfs(struct mt7615_dev *dev)

{

	struct dentry *dir;
@@ -324,6 +347,11 @@ int mt7615_init_debugfs(struct mt7615_dev *dev) 
	debugfs_create_devm_seqfile(dev->mt76.dev, "temperature", dir,

				    mt7615_read_temperature);



	debugfs_create_u32("rf_wfidx", 0600, dir, &dev->debugfs_rf_wf);

	debugfs_create_u32("rf_regidx", 0600, dir, &dev->debugfs_rf_reg);

	debugfs_create_file_unsafe("rf_regval", 0600, dir, dev,

				   &fops_rf_reg);



	return 0;

}

EXPORT_SYMBOL_GPL(mt7615_init_debugfs);

drivers/net/wireless/mediatek/mt76/mt7615/mcu.c

+41 −2
Original line number Diff line number Diff line
@@ -151,8 +151,11 @@ void mt7615_mcu_fill_msg(struct mt7615_dev *dev, struct sk_buff *skb, 
		break;

	default:

		mcu_txd->cid = MCU_CMD_EXT_CID;

		if (cmd & MCU_QUERY_PREFIX)

			mcu_txd->set_query = MCU_Q_QUERY;

		else

			mcu_txd->set_query = MCU_Q_SET;

		mcu_txd->ext_cid = cmd;

		mcu_txd->ext_cid = mcu_cmd;

		mcu_txd->ext_cid_ack = 1;

		break;

	}
@@ -192,6 +195,10 @@ mt7615_mcu_parse_response(struct mt7615_dev *dev, int cmd, 
		skb_pull(skb, sizeof(*rxd));

		ret = le32_to_cpu(*(__le32 *)skb->data);

		break;

	case MCU_EXT_CMD_RF_REG_ACCESS | MCU_QUERY_PREFIX:

		skb_pull(skb, sizeof(*rxd));

		ret = le32_to_cpu(*(__le32 *)&skb->data[8]);

		break;

	case MCU_UNI_CMD_DEV_INFO_UPDATE:

	case MCU_UNI_CMD_BSS_INFO_UPDATE:

	case MCU_UNI_CMD_STA_REC_UPDATE:
@@ -271,6 +278,38 @@ int mt7615_mcu_msg_send(struct mt76_dev *mdev, int cmd, const void *data, 
}

EXPORT_SYMBOL_GPL(mt7615_mcu_msg_send);



u32 mt7615_rf_rr(struct mt7615_dev *dev, u32 wf, u32 reg)

{

	struct {

		__le32 wifi_stream;

		__le32 address;

		__le32 data;

	} req = {

		.wifi_stream = cpu_to_le32(wf),

		.address = cpu_to_le32(reg),

	};



	return __mt76_mcu_send_msg(&dev->mt76,

				   MCU_EXT_CMD_RF_REG_ACCESS | MCU_QUERY_PREFIX,

				   &req, sizeof(req), true);

}



int mt7615_rf_wr(struct mt7615_dev *dev, u32 wf, u32 reg, u32 val)

{

	struct {

		__le32 wifi_stream;

		__le32 address;

		__le32 data;

	} req = {

		.wifi_stream = cpu_to_le32(wf),

		.address = cpu_to_le32(reg),

		.data = cpu_to_le32(val),

	};



	return __mt76_mcu_send_msg(&dev->mt76, MCU_EXT_CMD_RF_REG_ACCESS, &req,

				   sizeof(req), false);

}



static void

mt7615_mcu_csa_finish(void *priv, u8 *mac, struct ieee80211_vif *vif)

{

drivers/net/wireless/mediatek/mt76/mt7615/mcu.h

+3 −1
Original line number Diff line number Diff line
@@ -238,8 +238,9 @@ enum { 
#define MCU_FW_PREFIX		BIT(31)

#define MCU_UNI_PREFIX		BIT(30)

#define MCU_CE_PREFIX		BIT(29)

#define MCU_QUERY_PREFIX	BIT(28)

#define MCU_CMD_MASK		~(MCU_FW_PREFIX | MCU_UNI_PREFIX |	\

				  MCU_CE_PREFIX)

				  MCU_CE_PREFIX | MCU_QUERY_PREFIX)



enum {

	MCU_CMD_TARGET_ADDRESS_LEN_REQ = MCU_FW_PREFIX | 0x01,
@@ -254,6 +255,7 @@ enum { 
};



enum {

	MCU_EXT_CMD_RF_REG_ACCESS = 0x02,

	MCU_EXT_CMD_PM_STATE_CTRL = 0x07,

	MCU_EXT_CMD_CHANNEL_SWITCH = 0x08,

	MCU_EXT_CMD_SET_TX_POWER_CTRL = 0x11,

drivers/net/wireless/mediatek/mt76/mt7615/mt7615.h

+5 −0
Original line number Diff line number Diff line
@@ -281,6 +281,9 @@ struct mt7615_dev { 


	struct work_struct wtbl_work;

	struct list_head wd_head;



	u32 debugfs_rf_wf;

	u32 debugfs_rf_reg;

};



enum tx_pkt_queue_idx {
@@ -522,6 +525,8 @@ u32 mt7615_mac_get_sta_tid_sn(struct mt7615_dev *dev, int wcid, u8 tid); 
int mt7615_mcu_wait_response(struct mt7615_dev *dev, int cmd, int seq);

int mt7615_mcu_msg_send(struct mt76_dev *mdev, int cmd, const void *data,

			int len, bool wait_resp);

u32 mt7615_rf_rr(struct mt7615_dev *dev, u32 wf, u32 reg);

int mt7615_rf_wr(struct mt7615_dev *dev, u32 wf, u32 reg, u32 val);

int mt7615_mcu_set_dbdc(struct mt7615_dev *dev);

int mt7615_mcu_set_eeprom(struct mt7615_dev *dev);

int mt7615_mcu_set_mac_enable(struct mt7615_dev *dev, int band, bool enable);