xref: /openwifi/driver/tx_intf/tx_intf.c (revision db8c69b6aa4437ad8f8929a3c5137b8df20faeea)
12ee67178SXianjun Jiao /*
22ee67178SXianjun Jiao  * axi lite register access driver
3c4306a8bSJiao Xianjun  * Author: Xianjun Jiao, Michael Mehari, Wei Liu
4c4306a8bSJiao Xianjun  * SPDX-FileCopyrightText: 2019 UGent
5a6085186SLina Ceballos  * SPDX-License-Identifier: AGPL-3.0-or-later
62ee67178SXianjun Jiao */
72ee67178SXianjun Jiao 
82ee67178SXianjun Jiao #include <linux/bitops.h>
92ee67178SXianjun Jiao #include <linux/dmapool.h>
102ee67178SXianjun Jiao #include <linux/dma/xilinx_dma.h>
112ee67178SXianjun Jiao #include <linux/init.h>
122ee67178SXianjun Jiao #include <linux/interrupt.h>
132ee67178SXianjun Jiao #include <linux/io.h>
142ee67178SXianjun Jiao #include <linux/iopoll.h>
152ee67178SXianjun Jiao #include <linux/module.h>
162ee67178SXianjun Jiao #include <linux/of_address.h>
172ee67178SXianjun Jiao #include <linux/of_dma.h>
182ee67178SXianjun Jiao #include <linux/of_platform.h>
192ee67178SXianjun Jiao #include <linux/of_irq.h>
202ee67178SXianjun Jiao #include <linux/slab.h>
212ee67178SXianjun Jiao #include <linux/clk.h>
222ee67178SXianjun Jiao #include <linux/io-64-nonatomic-lo-hi.h>
232ee67178SXianjun Jiao 
242ee67178SXianjun Jiao #include "../hw_def.h"
252ee67178SXianjun Jiao 
262ee67178SXianjun Jiao static void __iomem *base_addr; // to store driver specific base address needed for mmu to translate virtual address to physical address in our FPGA design
272ee67178SXianjun Jiao 
282ee67178SXianjun Jiao /* IO accessors */
reg_read(u32 reg)292ee67178SXianjun Jiao static inline u32 reg_read(u32 reg)
302ee67178SXianjun Jiao {
312ee67178SXianjun Jiao 	return ioread32(base_addr + reg);
322ee67178SXianjun Jiao }
332ee67178SXianjun Jiao 
reg_write(u32 reg,u32 value)342ee67178SXianjun Jiao static inline void reg_write(u32 reg, u32 value)
352ee67178SXianjun Jiao {
362ee67178SXianjun Jiao 	iowrite32(value, base_addr + reg);
372ee67178SXianjun Jiao }
382ee67178SXianjun Jiao 
TX_INTF_REG_MULTI_RST_read(void)392ee67178SXianjun Jiao static inline u32 TX_INTF_REG_MULTI_RST_read(void){
402ee67178SXianjun Jiao 	return reg_read(TX_INTF_REG_MULTI_RST_ADDR);
412ee67178SXianjun Jiao }
422ee67178SXianjun Jiao 
TX_INTF_REG_ARBITRARY_IQ_read(void)43469b96d3SXianjun Jiao static inline u32 TX_INTF_REG_ARBITRARY_IQ_read(void){
44469b96d3SXianjun Jiao 	return reg_read(TX_INTF_REG_ARBITRARY_IQ_ADDR);
452ee67178SXianjun Jiao }
462ee67178SXianjun Jiao 
TX_INTF_REG_WIFI_TX_MODE_read(void)472ee67178SXianjun Jiao static inline u32 TX_INTF_REG_WIFI_TX_MODE_read(void){
482ee67178SXianjun Jiao 	return reg_read(TX_INTF_REG_WIFI_TX_MODE_ADDR);
492ee67178SXianjun Jiao }
502ee67178SXianjun Jiao 
TX_INTF_REG_CTS_TOSELF_CONFIG_read(void)512ee67178SXianjun Jiao static inline u32 TX_INTF_REG_CTS_TOSELF_CONFIG_read(void){
522ee67178SXianjun Jiao 	return reg_read(TX_INTF_REG_CTS_TOSELF_CONFIG_ADDR);
532ee67178SXianjun Jiao }
542ee67178SXianjun Jiao 
TX_INTF_REG_CSI_FUZZER_read(void)55d14d06e5SXianjun Jiao static inline u32 TX_INTF_REG_CSI_FUZZER_read(void){
56d14d06e5SXianjun Jiao 	return reg_read(TX_INTF_REG_CSI_FUZZER_ADDR);
572ee67178SXianjun Jiao }
582ee67178SXianjun Jiao 
TX_INTF_REG_CTS_TOSELF_WAIT_SIFS_TOP_read(void)592ee67178SXianjun Jiao static inline u32 TX_INTF_REG_CTS_TOSELF_WAIT_SIFS_TOP_read(void){
602ee67178SXianjun Jiao 	return reg_read(TX_INTF_REG_CTS_TOSELF_WAIT_SIFS_TOP_ADDR);
612ee67178SXianjun Jiao }
622ee67178SXianjun Jiao 
TX_INTF_REG_ARBITRARY_IQ_CTL_read(void)63469b96d3SXianjun Jiao static inline u32 TX_INTF_REG_ARBITRARY_IQ_CTL_read(void){
64469b96d3SXianjun Jiao 	return reg_read(TX_INTF_REG_ARBITRARY_IQ_CTL_ADDR);
652ee67178SXianjun Jiao }
662ee67178SXianjun Jiao 
TX_INTF_REG_TX_CONFIG_read(void)67f738aefaSmmehari static inline u32 TX_INTF_REG_TX_CONFIG_read(void){
68f738aefaSmmehari 	return reg_read(TX_INTF_REG_TX_CONFIG_ADDR);
692ee67178SXianjun Jiao }
702ee67178SXianjun Jiao 
TX_INTF_REG_NUM_DMA_SYMBOL_TO_PS_read(void)712ee67178SXianjun Jiao static inline u32 TX_INTF_REG_NUM_DMA_SYMBOL_TO_PS_read(void){
722ee67178SXianjun Jiao 	return reg_read(TX_INTF_REG_NUM_DMA_SYMBOL_TO_PS_ADDR);
732ee67178SXianjun Jiao }
742ee67178SXianjun Jiao 
TX_INTF_REG_CFG_DATA_TO_ANT_read(void)752ee67178SXianjun Jiao static inline u32 TX_INTF_REG_CFG_DATA_TO_ANT_read(void){
762ee67178SXianjun Jiao 	return reg_read(TX_INTF_REG_CFG_DATA_TO_ANT_ADDR);
772ee67178SXianjun Jiao }
782ee67178SXianjun Jiao 
TX_INTF_REG_S_AXIS_FIFO_TH_read(void)79838a9007SXianjun Jiao static inline u32 TX_INTF_REG_S_AXIS_FIFO_TH_read(void){
80838a9007SXianjun Jiao 	return reg_read(TX_INTF_REG_S_AXIS_FIFO_TH_ADDR);
81838a9007SXianjun Jiao }
82838a9007SXianjun Jiao 
TX_INTF_REG_TX_HOLD_THRESHOLD_read(void)83febc5adfSXianjun Jiao static inline u32 TX_INTF_REG_TX_HOLD_THRESHOLD_read(void){
84febc5adfSXianjun Jiao 	return reg_read(TX_INTF_REG_TX_HOLD_THRESHOLD_ADDR);
85febc5adfSXianjun Jiao }
86febc5adfSXianjun Jiao 
TX_INTF_REG_INTERRUPT_SEL_read(void)872ee67178SXianjun Jiao static inline u32 TX_INTF_REG_INTERRUPT_SEL_read(void){
882ee67178SXianjun Jiao 	return reg_read(TX_INTF_REG_INTERRUPT_SEL_ADDR);
892ee67178SXianjun Jiao }
902ee67178SXianjun Jiao 
TX_INTF_REG_AMPDU_ACTION_CONFIG_read(void)91f738aefaSmmehari static inline u32 TX_INTF_REG_AMPDU_ACTION_CONFIG_read(void){
92f738aefaSmmehari 	return reg_read(TX_INTF_REG_AMPDU_ACTION_CONFIG_ADDR);
93f738aefaSmmehari }
94f738aefaSmmehari 
TX_INTF_REG_BB_GAIN_read(void)952ee67178SXianjun Jiao static inline u32 TX_INTF_REG_BB_GAIN_read(void){
962ee67178SXianjun Jiao 	return reg_read(TX_INTF_REG_BB_GAIN_ADDR);
972ee67178SXianjun Jiao }
982ee67178SXianjun Jiao 
TX_INTF_REG_ANT_SEL_read(void)992ee67178SXianjun Jiao static inline u32 TX_INTF_REG_ANT_SEL_read(void){
1002ee67178SXianjun Jiao 	return reg_read(TX_INTF_REG_ANT_SEL_ADDR);
1012ee67178SXianjun Jiao }
1022ee67178SXianjun Jiao 
TX_INTF_REG_PHY_HDR_CONFIG_read(void)103f738aefaSmmehari static inline u32 TX_INTF_REG_PHY_HDR_CONFIG_read(void){
104f738aefaSmmehari 	return reg_read(TX_INTF_REG_PHY_HDR_CONFIG_ADDR);
105f738aefaSmmehari }
106f738aefaSmmehari 
TX_INTF_REG_S_AXIS_FIFO_NO_ROOM_read(void)107838a9007SXianjun Jiao static inline u32 TX_INTF_REG_S_AXIS_FIFO_NO_ROOM_read(void){
108838a9007SXianjun Jiao 	return reg_read(TX_INTF_REG_S_AXIS_FIFO_NO_ROOM_ADDR);
1092ee67178SXianjun Jiao }
1102ee67178SXianjun Jiao 
TX_INTF_REG_PKT_INFO1_read(void)1112d12c07dSmmehari static inline u32 TX_INTF_REG_PKT_INFO1_read(void){
1122d12c07dSmmehari 	return reg_read(TX_INTF_REG_PKT_INFO1_ADDR);
1132d12c07dSmmehari }
1142d12c07dSmmehari 
TX_INTF_REG_PKT_INFO2_read(void)1152d12c07dSmmehari static inline u32 TX_INTF_REG_PKT_INFO2_read(void){
1162d12c07dSmmehari 	return reg_read(TX_INTF_REG_PKT_INFO2_ADDR);
1172d12c07dSmmehari }
1182d12c07dSmmehari 
TX_INTF_REG_PKT_INFO3_read(void)1192d12c07dSmmehari static inline u32 TX_INTF_REG_PKT_INFO3_read(void){
1202d12c07dSmmehari 	return reg_read(TX_INTF_REG_PKT_INFO3_ADDR);
1212d12c07dSmmehari }
1222d12c07dSmmehari 
TX_INTF_REG_PKT_INFO4_read(void)1232d12c07dSmmehari static inline u32 TX_INTF_REG_PKT_INFO4_read(void){
1242d12c07dSmmehari 	return reg_read(TX_INTF_REG_PKT_INFO4_ADDR);
1252ee67178SXianjun Jiao }
1262ee67178SXianjun Jiao 
TX_INTF_REG_QUEUE_FIFO_DATA_COUNT_read(void)1272ee67178SXianjun Jiao static inline u32 TX_INTF_REG_QUEUE_FIFO_DATA_COUNT_read(void){
1282ee67178SXianjun Jiao 	return reg_read(TX_INTF_REG_QUEUE_FIFO_DATA_COUNT_ADDR);
1292ee67178SXianjun Jiao }
1302ee67178SXianjun Jiao 
1312ee67178SXianjun Jiao //--------------------------------------------------------
1322ee67178SXianjun Jiao 
TX_INTF_REG_MULTI_RST_write(u32 value)1332ee67178SXianjun Jiao static inline void TX_INTF_REG_MULTI_RST_write(u32 value){
1342ee67178SXianjun Jiao 	reg_write(TX_INTF_REG_MULTI_RST_ADDR, value);
1352ee67178SXianjun Jiao }
1362ee67178SXianjun Jiao 
TX_INTF_REG_ARBITRARY_IQ_write(u32 value)137469b96d3SXianjun Jiao static inline void TX_INTF_REG_ARBITRARY_IQ_write(u32 value){
138469b96d3SXianjun Jiao 	reg_write(TX_INTF_REG_ARBITRARY_IQ_ADDR, value);
1392ee67178SXianjun Jiao }
1402ee67178SXianjun Jiao 
TX_INTF_REG_WIFI_TX_MODE_write(u32 value)1412ee67178SXianjun Jiao static inline void TX_INTF_REG_WIFI_TX_MODE_write(u32 value){
1422ee67178SXianjun Jiao 	reg_write(TX_INTF_REG_WIFI_TX_MODE_ADDR, value);
1432ee67178SXianjun Jiao }
1442ee67178SXianjun Jiao 
TX_INTF_REG_CTS_TOSELF_CONFIG_write(u32 value)1452ee67178SXianjun Jiao static inline void TX_INTF_REG_CTS_TOSELF_CONFIG_write(u32 value){
1462ee67178SXianjun Jiao 	reg_write(TX_INTF_REG_CTS_TOSELF_CONFIG_ADDR, value);
1472ee67178SXianjun Jiao }
1482ee67178SXianjun Jiao 
TX_INTF_REG_CSI_FUZZER_write(u32 value)149d14d06e5SXianjun Jiao static inline void TX_INTF_REG_CSI_FUZZER_write(u32 value){
150d14d06e5SXianjun Jiao 	reg_write(TX_INTF_REG_CSI_FUZZER_ADDR, value);
1512ee67178SXianjun Jiao }
1522ee67178SXianjun Jiao 
TX_INTF_REG_CTS_TOSELF_WAIT_SIFS_TOP_write(u32 value)1532ee67178SXianjun Jiao static inline void TX_INTF_REG_CTS_TOSELF_WAIT_SIFS_TOP_write(u32 value){
1542ee67178SXianjun Jiao 	reg_write(TX_INTF_REG_CTS_TOSELF_WAIT_SIFS_TOP_ADDR, value);
1552ee67178SXianjun Jiao }
1562ee67178SXianjun Jiao 
TX_INTF_REG_ARBITRARY_IQ_CTL_write(u32 value)157469b96d3SXianjun Jiao static inline void TX_INTF_REG_ARBITRARY_IQ_CTL_write(u32 value){
158469b96d3SXianjun Jiao 	reg_write(TX_INTF_REG_ARBITRARY_IQ_CTL_ADDR, value);
1592ee67178SXianjun Jiao }
1602ee67178SXianjun Jiao 
TX_INTF_REG_TX_CONFIG_write(u32 value)161f738aefaSmmehari static inline void TX_INTF_REG_TX_CONFIG_write(u32 value){
162f738aefaSmmehari 	reg_write(TX_INTF_REG_TX_CONFIG_ADDR, value);
1632ee67178SXianjun Jiao }
1642ee67178SXianjun Jiao 
TX_INTF_REG_NUM_DMA_SYMBOL_TO_PS_write(u32 value)1652ee67178SXianjun Jiao static inline void TX_INTF_REG_NUM_DMA_SYMBOL_TO_PS_write(u32 value){
1662ee67178SXianjun Jiao 	reg_write(TX_INTF_REG_NUM_DMA_SYMBOL_TO_PS_ADDR, value);
1672ee67178SXianjun Jiao }
1682ee67178SXianjun Jiao 
TX_INTF_REG_CFG_DATA_TO_ANT_write(u32 value)1692ee67178SXianjun Jiao static inline void TX_INTF_REG_CFG_DATA_TO_ANT_write(u32 value){
1702ee67178SXianjun Jiao 	reg_write(TX_INTF_REG_CFG_DATA_TO_ANT_ADDR, value);
1712ee67178SXianjun Jiao }
1722ee67178SXianjun Jiao 
TX_INTF_REG_S_AXIS_FIFO_TH_write(u32 value)173838a9007SXianjun Jiao static inline void TX_INTF_REG_S_AXIS_FIFO_TH_write(u32 value){
174838a9007SXianjun Jiao 	reg_write(TX_INTF_REG_S_AXIS_FIFO_TH_ADDR, value);
175838a9007SXianjun Jiao }
176838a9007SXianjun Jiao 
TX_INTF_REG_TX_HOLD_THRESHOLD_write(u32 value)177febc5adfSXianjun Jiao static inline void TX_INTF_REG_TX_HOLD_THRESHOLD_write(u32 value){
178febc5adfSXianjun Jiao 	reg_write(TX_INTF_REG_TX_HOLD_THRESHOLD_ADDR, value);
179febc5adfSXianjun Jiao }
180febc5adfSXianjun Jiao 
TX_INTF_REG_INTERRUPT_SEL_write(u32 value)1812ee67178SXianjun Jiao static inline void TX_INTF_REG_INTERRUPT_SEL_write(u32 value){
1822ee67178SXianjun Jiao 	reg_write(TX_INTF_REG_INTERRUPT_SEL_ADDR, value);
1832ee67178SXianjun Jiao }
1842ee67178SXianjun Jiao 
TX_INTF_REG_AMPDU_ACTION_CONFIG_write(u32 value)185f738aefaSmmehari static inline void TX_INTF_REG_AMPDU_ACTION_CONFIG_write(u32 value){
186f738aefaSmmehari 	reg_write(TX_INTF_REG_AMPDU_ACTION_CONFIG_ADDR, value);
187f738aefaSmmehari }
188f738aefaSmmehari 
TX_INTF_REG_BB_GAIN_write(u32 value)1892ee67178SXianjun Jiao static inline void TX_INTF_REG_BB_GAIN_write(u32 value){
1902ee67178SXianjun Jiao 	reg_write(TX_INTF_REG_BB_GAIN_ADDR, value);
1912ee67178SXianjun Jiao }
1922ee67178SXianjun Jiao 
TX_INTF_REG_ANT_SEL_write(u32 value)1932ee67178SXianjun Jiao static inline void TX_INTF_REG_ANT_SEL_write(u32 value){
1942ee67178SXianjun Jiao 	reg_write(TX_INTF_REG_ANT_SEL_ADDR, value);
1952ee67178SXianjun Jiao }
1962ee67178SXianjun Jiao 
TX_INTF_REG_PHY_HDR_CONFIG_write(u32 value)197f738aefaSmmehari static inline void TX_INTF_REG_PHY_HDR_CONFIG_write(u32 value){
198f738aefaSmmehari 	reg_write(TX_INTF_REG_PHY_HDR_CONFIG_ADDR, value);
199f738aefaSmmehari }
200f738aefaSmmehari 
TX_INTF_REG_S_AXIS_FIFO_NO_ROOM_write(u32 value)201838a9007SXianjun Jiao static inline void TX_INTF_REG_S_AXIS_FIFO_NO_ROOM_write(u32 value){
202838a9007SXianjun Jiao 	reg_write(TX_INTF_REG_S_AXIS_FIFO_NO_ROOM_ADDR, value);
2032ee67178SXianjun Jiao }
2042ee67178SXianjun Jiao 
TX_INTF_REG_PKT_INFO1_write(u32 value)2052d12c07dSmmehari static inline void TX_INTF_REG_PKT_INFO1_write(u32 value){
2062d12c07dSmmehari 	reg_write(TX_INTF_REG_PKT_INFO1_ADDR,value);
2072d12c07dSmmehari }
2082d12c07dSmmehari 
TX_INTF_REG_PKT_INFO2_write(u32 value)2092d12c07dSmmehari static inline void TX_INTF_REG_PKT_INFO2_write(u32 value){
2102d12c07dSmmehari 	reg_write(TX_INTF_REG_PKT_INFO2_ADDR,value);
2112d12c07dSmmehari }
2122d12c07dSmmehari 
TX_INTF_REG_PKT_INFO3_write(u32 value)2132d12c07dSmmehari static inline void TX_INTF_REG_PKT_INFO3_write(u32 value){
2142d12c07dSmmehari 	reg_write(TX_INTF_REG_PKT_INFO3_ADDR,value);
2152d12c07dSmmehari }
2162d12c07dSmmehari 
TX_INTF_REG_PKT_INFO4_write(u32 value)2172d12c07dSmmehari static inline void TX_INTF_REG_PKT_INFO4_write(u32 value){
2182d12c07dSmmehari 	reg_write(TX_INTF_REG_PKT_INFO4_ADDR,value);
2192ee67178SXianjun Jiao }
2202ee67178SXianjun Jiao 
2212ee67178SXianjun Jiao static const struct of_device_id dev_of_ids[] = {
2222ee67178SXianjun Jiao 	{ .compatible = "sdr,tx_intf", },
2232ee67178SXianjun Jiao 	{}
2242ee67178SXianjun Jiao };
2252ee67178SXianjun Jiao MODULE_DEVICE_TABLE(of, dev_of_ids);
2262ee67178SXianjun Jiao 
2272ee67178SXianjun Jiao static struct tx_intf_driver_api tx_intf_driver_api_inst;
228*db8c69b6Srobgar2001 struct tx_intf_driver_api *tx_intf_api = &tx_intf_driver_api_inst;
2292ee67178SXianjun Jiao EXPORT_SYMBOL(tx_intf_api);
2302ee67178SXianjun Jiao 
hw_init(enum tx_intf_mode mode,u32 tx_config,u32 num_dma_symbol_to_ps,enum openwifi_fpga_type fpga_type)2310c0d5d82Smmehari static inline u32 hw_init(enum tx_intf_mode mode, u32 tx_config, u32 num_dma_symbol_to_ps, enum openwifi_fpga_type fpga_type){
232838a9007SXianjun Jiao 	int err=0, i;
233469b96d3SXianjun Jiao 	u32 mixer_cfg=0, ant_sel=0;
2342ee67178SXianjun Jiao 
2352ee67178SXianjun Jiao 	printk("%s hw_init mode %d\n", tx_intf_compatible_str, mode);
2362ee67178SXianjun Jiao 
237838a9007SXianjun Jiao 	//rst
238838a9007SXianjun Jiao 	for (i=0;i<8;i++)
239838a9007SXianjun Jiao 		tx_intf_api->TX_INTF_REG_MULTI_RST_write(0);
240838a9007SXianjun Jiao 	for (i=0;i<32;i++)
2412ee67178SXianjun Jiao 		tx_intf_api->TX_INTF_REG_MULTI_RST_write(0xFFFFFFFF);
242838a9007SXianjun Jiao 	for (i=0;i<8;i++)
2432ee67178SXianjun Jiao 		tx_intf_api->TX_INTF_REG_MULTI_RST_write(0);
2442ee67178SXianjun Jiao 
2450c0d5d82Smmehari 	if(fpga_type == LARGE_FPGA)	// LARGE FPGA: MAX_NUM_DMA_SYMBOL = 8192
24654c67c7aSXianjun Jiao 		// tx_intf_api->TX_INTF_REG_S_AXIS_FIFO_TH_write(8192-(210*5)); // threshold is for room to hold the last 4 packets from 4 queue before stop
24754c67c7aSXianjun Jiao 		tx_intf_api->TX_INTF_REG_S_AXIS_FIFO_TH_write(8192-(210*2));
2480c0d5d82Smmehari 	else if(fpga_type == SMALL_FPGA)	// SMALL FPGA: MAX_NUM_DMA_SYMBOL = 4096
24954c67c7aSXianjun Jiao 		// tx_intf_api->TX_INTF_REG_S_AXIS_FIFO_TH_write(4096-(210*5)); // threshold is for room to hold the last 4 packets from 4 queue before stop
25054c67c7aSXianjun Jiao 		tx_intf_api->TX_INTF_REG_S_AXIS_FIFO_TH_write(4096-(210*2));
2510c0d5d82Smmehari 
2522ee67178SXianjun Jiao 	switch(mode)
2532ee67178SXianjun Jiao 	{
2542ee67178SXianjun Jiao 		case TX_INTF_AXIS_LOOP_BACK:
2552ee67178SXianjun Jiao 			printk("%s hw_init mode TX_INTF_AXIS_LOOP_BACK\n", tx_intf_compatible_str);
2562ee67178SXianjun Jiao 			break;
2572ee67178SXianjun Jiao 
2582ee67178SXianjun Jiao 		case TX_INTF_BW_20MHZ_AT_0MHZ_ANT0:
2592ee67178SXianjun Jiao 			printk("%s hw_init mode TX_INTF_BW_20MHZ_AT_0MHZ_ANT0\n", tx_intf_compatible_str);
2602ee67178SXianjun Jiao 			mixer_cfg = 0x2001F400;
2612ee67178SXianjun Jiao 			ant_sel=1;
2622ee67178SXianjun Jiao 			break;
2632ee67178SXianjun Jiao 
264469b96d3SXianjun Jiao 		case TX_INTF_BW_20MHZ_AT_0MHZ_ANT_BOTH:
265849c3b5eSXianjun Jiao 			printk("%s hw_init mode TX_INTF_BW_20MHZ_AT_0MHZ_ANT_BOTH\n", tx_intf_compatible_str);
266469b96d3SXianjun Jiao 			mixer_cfg = 0x2001F400;
267469b96d3SXianjun Jiao 			ant_sel=0x11;
268469b96d3SXianjun Jiao 			break;
269469b96d3SXianjun Jiao 
2702ee67178SXianjun Jiao 		case TX_INTF_BW_20MHZ_AT_N_10MHZ_ANT0:
2712ee67178SXianjun Jiao 			printk("%s hw_init mode TX_INTF_BW_20MHZ_AT_N_10MHZ_ANT0\n", tx_intf_compatible_str);
2722ee67178SXianjun Jiao 			mixer_cfg = 0x2001F602;
2732ee67178SXianjun Jiao 			ant_sel=1;
2742ee67178SXianjun Jiao 			break;
2752ee67178SXianjun Jiao 
2762ee67178SXianjun Jiao 		case TX_INTF_BW_20MHZ_AT_P_10MHZ_ANT0:
2772ee67178SXianjun Jiao 			printk("%s hw_init mode TX_INTF_BW_20MHZ_AT_P_10MHZ_ANT0\n", tx_intf_compatible_str);
2782ee67178SXianjun Jiao 			mixer_cfg = 0x200202F6;
2792ee67178SXianjun Jiao 			ant_sel=1;
2802ee67178SXianjun Jiao 			break;
2812ee67178SXianjun Jiao 
2822ee67178SXianjun Jiao 		case TX_INTF_BW_20MHZ_AT_0MHZ_ANT1:
2832ee67178SXianjun Jiao 			printk("%s hw_init mode TX_INTF_BW_20MHZ_AT_0MHZ_ANT1\n", tx_intf_compatible_str);
2842ee67178SXianjun Jiao 			mixer_cfg = 0x2001F400;
2852ee67178SXianjun Jiao 			ant_sel=2;
2862ee67178SXianjun Jiao 			break;
2872ee67178SXianjun Jiao 
2882ee67178SXianjun Jiao 		case TX_INTF_BW_20MHZ_AT_N_10MHZ_ANT1:
2892ee67178SXianjun Jiao 			printk("%s hw_init mode TX_INTF_BW_20MHZ_AT_N_10MHZ_ANT1\n", tx_intf_compatible_str);
2902ee67178SXianjun Jiao 			mixer_cfg = 0x2001F602;
2912ee67178SXianjun Jiao 			ant_sel=2;
2922ee67178SXianjun Jiao 			break;
2932ee67178SXianjun Jiao 
2942ee67178SXianjun Jiao 		case TX_INTF_BW_20MHZ_AT_P_10MHZ_ANT1:
2952ee67178SXianjun Jiao 			printk("%s hw_init mode TX_INTF_BW_20MHZ_AT_P_10MHZ_ANT1\n", tx_intf_compatible_str);
2962ee67178SXianjun Jiao 			mixer_cfg = 0x200202F6;
2972ee67178SXianjun Jiao 			ant_sel=2;
2982ee67178SXianjun Jiao 			break;
2992ee67178SXianjun Jiao 
3002ee67178SXianjun Jiao 		case TX_INTF_BYPASS:
3012ee67178SXianjun Jiao 			printk("%s hw_init mode TX_INTF_BYPASS\n", tx_intf_compatible_str);
3022ee67178SXianjun Jiao 			mixer_cfg = 0x200202F6;
3032ee67178SXianjun Jiao 			ant_sel=2;
3042ee67178SXianjun Jiao 			break;
3052ee67178SXianjun Jiao 
3062ee67178SXianjun Jiao 		default:
3072ee67178SXianjun Jiao 			printk("%s hw_init mode %d is wrong!\n", tx_intf_compatible_str, mode);
3082ee67178SXianjun Jiao 			err=1;
3092ee67178SXianjun Jiao 	}
3102ee67178SXianjun Jiao 
3112ee67178SXianjun Jiao 	if (mode!=TX_INTF_AXIS_LOOP_BACK) {
3122ee67178SXianjun Jiao 		tx_intf_api->TX_INTF_REG_MULTI_RST_write(0);
313d14d06e5SXianjun Jiao 		tx_intf_api->TX_INTF_REG_CSI_FUZZER_write(0);
314d4c3d810SXianjun Jiao 		tx_intf_api->TX_INTF_REG_CTS_TOSELF_WAIT_SIFS_TOP_write( ((16*10)<<16)|(16*10) );//high 16bit 5GHz; low 16 bit 2.4GHz. counter speed 10MHz is assumed
3152ee67178SXianjun Jiao 
316f738aefaSmmehari 		tx_intf_api->TX_INTF_REG_TX_CONFIG_write(tx_config);
3172ee67178SXianjun Jiao 		tx_intf_api->TX_INTF_REG_NUM_DMA_SYMBOL_TO_PS_write(num_dma_symbol_to_ps);
3182ee67178SXianjun Jiao 		tx_intf_api->TX_INTF_REG_CFG_DATA_TO_ANT_write(0);
319febc5adfSXianjun Jiao 		tx_intf_api->TX_INTF_REG_TX_HOLD_THRESHOLD_write(420);
32022dd0cc4SXianjun Jiao 		tx_intf_api->TX_INTF_REG_INTERRUPT_SEL_write(0x4); //.src_sel(slv_reg14[2:0]), 0-s00_axis_tlast,1-ap_start,2-tx_start_from_acc,3-tx_end_from_acc,4-tx_try_complete from xpu
32122dd0cc4SXianjun Jiao 		tx_intf_api->TX_INTF_REG_INTERRUPT_SEL_write(0x30004); //disable interrupt
3220cbb6873SXianjun Jiao 
3230cbb6873SXianjun Jiao 		// tx_intf_api->TX_INTF_REG_BB_GAIN_write(100); // value for old design with DUC (FIR + MIXER) -- obsolete due to DUC removal
3240cbb6873SXianjun Jiao 		// New test on new design (unified RF BB clock; No DUC)
3250cbb6873SXianjun Jiao 		// 5220MHz bb_gain power   EVM
3260cbb6873SXianjun Jiao         //         400     -6dBm   -34/35
3270cbb6873SXianjun Jiao         //         350     -7.2dBm -34/35/36
3280cbb6873SXianjun Jiao         //         300     -8.5dBm -35/36/37 EVM
3290cbb6873SXianjun Jiao 
3300cbb6873SXianjun Jiao         // 2437MHz bb_gain power    EVM
3310cbb6873SXianjun Jiao         //         400     -3.2dBm -36/37
3320cbb6873SXianjun Jiao         //         350     -4.4dBm -37/38/39
3330cbb6873SXianjun Jiao         //         300     -5.7dBm -39/40
3340cbb6873SXianjun Jiao         //         less    less    -40/41/42!
3350cbb6873SXianjun Jiao 
3360cbb6873SXianjun Jiao 		// According to above and more detailed test:
3370cbb6873SXianjun Jiao 		// Need to be 290. Otherwise some ofdm symbol's EVM jump high, when there are lots of ofdm symbols in one WiFi packet
3380cbb6873SXianjun Jiao 
3390cbb6873SXianjun Jiao 		// 2022-03-04 detailed test result:
3400cbb6873SXianjun Jiao 		// bb_gain 290 work for 11a/g all mcs
3410cbb6873SXianjun Jiao 		// bb_gain 290 work for 11n mcs 1~7 (aggr and non aggr)
3420cbb6873SXianjun Jiao 		// bb_gain 290 destroy  11n mcs 0 long (MTU 1500) tx pkt due to high PAPR (Peak to Average Power Ratio)!
3430cbb6873SXianjun Jiao 		// bb_gain 250 work for 11n mcs 0
3440cbb6873SXianjun Jiao 		// So, a conservative bb_gain 250 should be used
3450cbb6873SXianjun Jiao 		tx_intf_api->TX_INTF_REG_BB_GAIN_write(250);
3460cbb6873SXianjun Jiao 
3472ee67178SXianjun Jiao 		tx_intf_api->TX_INTF_REG_ANT_SEL_write(ant_sel);
3482ee67178SXianjun Jiao 		tx_intf_api->TX_INTF_REG_WIFI_TX_MODE_write((1<<3)|(2<<4));
3492ee67178SXianjun Jiao 		tx_intf_api->TX_INTF_REG_MULTI_RST_write(0x434);
3502ee67178SXianjun Jiao 		tx_intf_api->TX_INTF_REG_MULTI_RST_write(0);
3512ee67178SXianjun Jiao 	}
3522ee67178SXianjun Jiao 
35375d924e0SXianjun Jiao 	// if (mode == TX_INTF_BYPASS) {
35475d924e0SXianjun Jiao 	// 	tx_intf_api->TX_INTF_REG_CFG_DATA_TO_ANT_write(0x100); //slv_reg10[8] -- bit 8 not used anymore. only bit0/1 are still reserved.
35575d924e0SXianjun Jiao 	// }
3562ee67178SXianjun Jiao 
3572ee67178SXianjun Jiao 	printk("%s hw_init err %d\n", tx_intf_compatible_str, err);
3582ee67178SXianjun Jiao 	return(err);
3592ee67178SXianjun Jiao }
3602ee67178SXianjun Jiao 
dev_probe(struct platform_device * pdev)3612ee67178SXianjun Jiao static int dev_probe(struct platform_device *pdev)
3622ee67178SXianjun Jiao {
3632ee67178SXianjun Jiao 	struct device_node *np = pdev->dev.of_node;
3642ee67178SXianjun Jiao 	struct resource *io;
3652ee67178SXianjun Jiao 	int err=1;
3662ee67178SXianjun Jiao 
3672ee67178SXianjun Jiao 	printk("\n");
3682ee67178SXianjun Jiao 
3692ee67178SXianjun Jiao 	if (np) {
3702ee67178SXianjun Jiao 		const struct of_device_id *match;
3712ee67178SXianjun Jiao 
3722ee67178SXianjun Jiao 		match = of_match_node(dev_of_ids, np);
3732ee67178SXianjun Jiao 		if (match) {
3742ee67178SXianjun Jiao 			printk("%s dev_probe match!\n", tx_intf_compatible_str);
3752ee67178SXianjun Jiao 			err = 0;
3762ee67178SXianjun Jiao 		}
3772ee67178SXianjun Jiao 	}
3782ee67178SXianjun Jiao 
3792ee67178SXianjun Jiao 	if (err)
3802ee67178SXianjun Jiao 		return err;
3812ee67178SXianjun Jiao 
3822ee67178SXianjun Jiao 	tx_intf_api->hw_init=hw_init;
3832ee67178SXianjun Jiao 
3842ee67178SXianjun Jiao 	tx_intf_api->reg_read=reg_read;
3852ee67178SXianjun Jiao 	tx_intf_api->reg_write=reg_write;
3862ee67178SXianjun Jiao 
3872ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_MULTI_RST_read=TX_INTF_REG_MULTI_RST_read;
388469b96d3SXianjun Jiao 	tx_intf_api->TX_INTF_REG_ARBITRARY_IQ_read=TX_INTF_REG_ARBITRARY_IQ_read;
3892ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_WIFI_TX_MODE_read=TX_INTF_REG_WIFI_TX_MODE_read;
3902ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_CTS_TOSELF_CONFIG_read=TX_INTF_REG_CTS_TOSELF_CONFIG_read;
391d14d06e5SXianjun Jiao 	tx_intf_api->TX_INTF_REG_CSI_FUZZER_read=TX_INTF_REG_CSI_FUZZER_read;
3922ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_CTS_TOSELF_WAIT_SIFS_TOP_read=TX_INTF_REG_CTS_TOSELF_WAIT_SIFS_TOP_read;
393469b96d3SXianjun Jiao 	tx_intf_api->TX_INTF_REG_ARBITRARY_IQ_CTL_read=TX_INTF_REG_ARBITRARY_IQ_CTL_read;
394f738aefaSmmehari 	tx_intf_api->TX_INTF_REG_TX_CONFIG_read=TX_INTF_REG_TX_CONFIG_read;
3952ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_NUM_DMA_SYMBOL_TO_PS_read=TX_INTF_REG_NUM_DMA_SYMBOL_TO_PS_read;
3962ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_CFG_DATA_TO_ANT_read=TX_INTF_REG_CFG_DATA_TO_ANT_read;
397838a9007SXianjun Jiao 	tx_intf_api->TX_INTF_REG_S_AXIS_FIFO_TH_read=TX_INTF_REG_S_AXIS_FIFO_TH_read;
398febc5adfSXianjun Jiao 	tx_intf_api->TX_INTF_REG_TX_HOLD_THRESHOLD_read=TX_INTF_REG_TX_HOLD_THRESHOLD_read;
3992ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_INTERRUPT_SEL_read=TX_INTF_REG_INTERRUPT_SEL_read;
400f738aefaSmmehari 	tx_intf_api->TX_INTF_REG_AMPDU_ACTION_CONFIG_read=TX_INTF_REG_AMPDU_ACTION_CONFIG_read;
4012ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_BB_GAIN_read=TX_INTF_REG_BB_GAIN_read;
4022ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_ANT_SEL_read=TX_INTF_REG_ANT_SEL_read;
403f738aefaSmmehari 	tx_intf_api->TX_INTF_REG_PHY_HDR_CONFIG_read=TX_INTF_REG_PHY_HDR_CONFIG_read;
404838a9007SXianjun Jiao 	tx_intf_api->TX_INTF_REG_S_AXIS_FIFO_NO_ROOM_read=TX_INTF_REG_S_AXIS_FIFO_NO_ROOM_read;
4052d12c07dSmmehari 	tx_intf_api->TX_INTF_REG_PKT_INFO1_read=TX_INTF_REG_PKT_INFO1_read;
4062d12c07dSmmehari 	tx_intf_api->TX_INTF_REG_PKT_INFO2_read=TX_INTF_REG_PKT_INFO2_read;
4072d12c07dSmmehari 	tx_intf_api->TX_INTF_REG_PKT_INFO3_read=TX_INTF_REG_PKT_INFO3_read;
4082d12c07dSmmehari 	tx_intf_api->TX_INTF_REG_PKT_INFO4_read=TX_INTF_REG_PKT_INFO4_read;
4092ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_QUEUE_FIFO_DATA_COUNT_read=TX_INTF_REG_QUEUE_FIFO_DATA_COUNT_read;
4102ee67178SXianjun Jiao 
4112ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_MULTI_RST_write=TX_INTF_REG_MULTI_RST_write;
412469b96d3SXianjun Jiao 	tx_intf_api->TX_INTF_REG_ARBITRARY_IQ_write=TX_INTF_REG_ARBITRARY_IQ_write;
4132ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_WIFI_TX_MODE_write=TX_INTF_REG_WIFI_TX_MODE_write;
4142ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_CTS_TOSELF_CONFIG_write=TX_INTF_REG_CTS_TOSELF_CONFIG_write;
415d14d06e5SXianjun Jiao 	tx_intf_api->TX_INTF_REG_CSI_FUZZER_write=TX_INTF_REG_CSI_FUZZER_write;
4162ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_CTS_TOSELF_WAIT_SIFS_TOP_write=TX_INTF_REG_CTS_TOSELF_WAIT_SIFS_TOP_write;
417469b96d3SXianjun Jiao 	tx_intf_api->TX_INTF_REG_ARBITRARY_IQ_CTL_write=TX_INTF_REG_ARBITRARY_IQ_CTL_write;
418f738aefaSmmehari 	tx_intf_api->TX_INTF_REG_TX_CONFIG_write=TX_INTF_REG_TX_CONFIG_write;
4192ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_NUM_DMA_SYMBOL_TO_PS_write=TX_INTF_REG_NUM_DMA_SYMBOL_TO_PS_write;
4202ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_CFG_DATA_TO_ANT_write=TX_INTF_REG_CFG_DATA_TO_ANT_write;
421838a9007SXianjun Jiao 	tx_intf_api->TX_INTF_REG_S_AXIS_FIFO_TH_write=TX_INTF_REG_S_AXIS_FIFO_TH_write;
422febc5adfSXianjun Jiao 	tx_intf_api->TX_INTF_REG_TX_HOLD_THRESHOLD_write=TX_INTF_REG_TX_HOLD_THRESHOLD_write;
4232ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_INTERRUPT_SEL_write=TX_INTF_REG_INTERRUPT_SEL_write;
424f738aefaSmmehari 	tx_intf_api->TX_INTF_REG_AMPDU_ACTION_CONFIG_write=TX_INTF_REG_AMPDU_ACTION_CONFIG_write;
4252ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_BB_GAIN_write=TX_INTF_REG_BB_GAIN_write;
4262ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_ANT_SEL_write=TX_INTF_REG_ANT_SEL_write;
427f738aefaSmmehari 	tx_intf_api->TX_INTF_REG_PHY_HDR_CONFIG_write=TX_INTF_REG_PHY_HDR_CONFIG_write;
428838a9007SXianjun Jiao 	tx_intf_api->TX_INTF_REG_S_AXIS_FIFO_NO_ROOM_write=TX_INTF_REG_S_AXIS_FIFO_NO_ROOM_write;
4292d12c07dSmmehari 	tx_intf_api->TX_INTF_REG_PKT_INFO1_write=TX_INTF_REG_PKT_INFO1_write;
4302d12c07dSmmehari 	tx_intf_api->TX_INTF_REG_PKT_INFO2_write=TX_INTF_REG_PKT_INFO2_write;
4312d12c07dSmmehari 	tx_intf_api->TX_INTF_REG_PKT_INFO3_write=TX_INTF_REG_PKT_INFO3_write;
4322d12c07dSmmehari 	tx_intf_api->TX_INTF_REG_PKT_INFO4_write=TX_INTF_REG_PKT_INFO4_write;
4332ee67178SXianjun Jiao 
4342ee67178SXianjun Jiao 	/* Request and map I/O memory */
4352ee67178SXianjun Jiao 	io = platform_get_resource(pdev, IORESOURCE_MEM, 0);
4362ee67178SXianjun Jiao 	base_addr = devm_ioremap_resource(&pdev->dev, io);
4372ee67178SXianjun Jiao 	if (IS_ERR(base_addr))
4382ee67178SXianjun Jiao 		return PTR_ERR(base_addr);
4392ee67178SXianjun Jiao 
440*db8c69b6Srobgar2001 	printk("%s dev_probe io start 0x%08x end 0x%08x name %s flags 0x%08x desc 0x%08x\n", tx_intf_compatible_str,io->start,io->end,io->name,(u32)io->flags,(u32)io->desc);
441febc5adfSXianjun Jiao 	printk("%s dev_probe base_addr 0x%p\n", tx_intf_compatible_str,(void*)base_addr);
442febc5adfSXianjun Jiao 	printk("%s dev_probe tx_intf_driver_api_inst 0x%p\n", tx_intf_compatible_str, (void*)(&tx_intf_driver_api_inst) );
443febc5adfSXianjun Jiao 	printk("%s dev_probe             tx_intf_api 0x%p\n", tx_intf_compatible_str, (void*)tx_intf_api);
4442ee67178SXianjun Jiao 
4452ee67178SXianjun Jiao 	printk("%s dev_probe succeed!\n", tx_intf_compatible_str);
4462ee67178SXianjun Jiao 
4470c0d5d82Smmehari 	//err = hw_init(TX_INTF_BW_20MHZ_AT_P_10MHZ_ANT1, 8, 8, SMALL_FPGA);
4480c0d5d82Smmehari 	//err = hw_init(TX_INTF_BYPASS, 8, 8, SMALL_FPGA);
4490c0d5d82Smmehari 	err = hw_init(TX_INTF_BW_20MHZ_AT_N_10MHZ_ANT1, 8, 8, SMALL_FPGA); // make sure dac is connected to original ad9361 dma
4502ee67178SXianjun Jiao 
4512ee67178SXianjun Jiao 	return err;
4522ee67178SXianjun Jiao }
4532ee67178SXianjun Jiao 
dev_remove(struct platform_device * pdev)4542ee67178SXianjun Jiao static int dev_remove(struct platform_device *pdev)
4552ee67178SXianjun Jiao {
4562ee67178SXianjun Jiao 	printk("\n");
4572ee67178SXianjun Jiao 
458febc5adfSXianjun Jiao 	printk("%s dev_remove base_addr 0x%p\n", tx_intf_compatible_str,(void*)base_addr);
459febc5adfSXianjun Jiao 	printk("%s dev_remove tx_intf_driver_api_inst 0x%p\n", tx_intf_compatible_str, (void*)(&tx_intf_driver_api_inst) );
460febc5adfSXianjun Jiao 	printk("%s dev_remove             tx_intf_api 0x%p\n", tx_intf_compatible_str, (void*)tx_intf_api);
4612ee67178SXianjun Jiao 
4622ee67178SXianjun Jiao 	printk("%s dev_remove succeed!\n", tx_intf_compatible_str);
4632ee67178SXianjun Jiao 	return 0;
4642ee67178SXianjun Jiao }
4652ee67178SXianjun Jiao 
4662ee67178SXianjun Jiao static struct platform_driver dev_driver = {
4672ee67178SXianjun Jiao 	.driver = {
4682ee67178SXianjun Jiao 		.name = "sdr,tx_intf",
4692ee67178SXianjun Jiao 		.owner = THIS_MODULE,
4702ee67178SXianjun Jiao 		.of_match_table = dev_of_ids,
4712ee67178SXianjun Jiao 	},
4722ee67178SXianjun Jiao 	.probe = dev_probe,
4732ee67178SXianjun Jiao 	.remove = dev_remove,
4742ee67178SXianjun Jiao };
4752ee67178SXianjun Jiao 
4762ee67178SXianjun Jiao module_platform_driver(dev_driver);
4772ee67178SXianjun Jiao 
4782ee67178SXianjun Jiao MODULE_AUTHOR("Xianjun Jiao");
4792ee67178SXianjun Jiao MODULE_DESCRIPTION("sdr,tx_intf");
4802ee67178SXianjun Jiao MODULE_LICENSE("GPL v2");
481