xref: /openwifi/driver/tx_intf/tx_intf.c (revision 0cbb6873878354a120b0b75fe1bfb8ab2387f09f)
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 */
292ee67178SXianjun Jiao static inline u32 reg_read(u32 reg)
302ee67178SXianjun Jiao {
312ee67178SXianjun Jiao 	return ioread32(base_addr + reg);
322ee67178SXianjun Jiao }
332ee67178SXianjun Jiao 
342ee67178SXianjun Jiao static inline void reg_write(u32 reg, u32 value)
352ee67178SXianjun Jiao {
362ee67178SXianjun Jiao 	iowrite32(value, base_addr + reg);
372ee67178SXianjun Jiao }
382ee67178SXianjun Jiao 
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 
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 
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 
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 
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 
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 
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 
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 
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 
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 
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 
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 
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 
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 
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 
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 
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 
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 
1112d12c07dSmmehari static inline u32 TX_INTF_REG_PKT_INFO1_read(void){
1122d12c07dSmmehari 	return reg_read(TX_INTF_REG_PKT_INFO1_ADDR);
1132d12c07dSmmehari }
1142d12c07dSmmehari 
1152d12c07dSmmehari static inline u32 TX_INTF_REG_PKT_INFO2_read(void){
1162d12c07dSmmehari 	return reg_read(TX_INTF_REG_PKT_INFO2_ADDR);
1172d12c07dSmmehari }
1182d12c07dSmmehari 
1192d12c07dSmmehari static inline u32 TX_INTF_REG_PKT_INFO3_read(void){
1202d12c07dSmmehari 	return reg_read(TX_INTF_REG_PKT_INFO3_ADDR);
1212d12c07dSmmehari }
1222d12c07dSmmehari 
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 
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 
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 
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 
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 
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 
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 
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 
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 
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 
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 
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 
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 
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 
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 
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 
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 
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 
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 
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 
2052d12c07dSmmehari static inline void TX_INTF_REG_PKT_INFO1_write(u32 value){
2062d12c07dSmmehari 	reg_write(TX_INTF_REG_PKT_INFO1_ADDR,value);
2072d12c07dSmmehari }
2082d12c07dSmmehari 
2092d12c07dSmmehari static inline void TX_INTF_REG_PKT_INFO2_write(u32 value){
2102d12c07dSmmehari 	reg_write(TX_INTF_REG_PKT_INFO2_ADDR,value);
2112d12c07dSmmehari }
2122d12c07dSmmehari 
2132d12c07dSmmehari static inline void TX_INTF_REG_PKT_INFO3_write(u32 value){
2142d12c07dSmmehari 	reg_write(TX_INTF_REG_PKT_INFO3_ADDR,value);
2152d12c07dSmmehari }
2162d12c07dSmmehari 
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;
2282ee67178SXianjun Jiao static struct tx_intf_driver_api *tx_intf_api = &tx_intf_driver_api_inst;
2292ee67178SXianjun Jiao EXPORT_SYMBOL(tx_intf_api);
2302ee67178SXianjun Jiao 
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
2460c0d5d82Smmehari 		tx_intf_api->TX_INTF_REG_S_AXIS_FIFO_TH_write(8192-200); // when only 200 DMA symbol room left in fifo, stop Linux queue
2470c0d5d82Smmehari 	else if(fpga_type == SMALL_FPGA)	// SMALL FPGA: MAX_NUM_DMA_SYMBOL = 4096
2480c0d5d82Smmehari 		tx_intf_api->TX_INTF_REG_S_AXIS_FIFO_TH_write(4096-200); // when only 200 DMA symbol room left in fifo, stop Linux queue
2490c0d5d82Smmehari 
2502ee67178SXianjun Jiao 	switch(mode)
2512ee67178SXianjun Jiao 	{
2522ee67178SXianjun Jiao 		case TX_INTF_AXIS_LOOP_BACK:
2532ee67178SXianjun Jiao 			printk("%s hw_init mode TX_INTF_AXIS_LOOP_BACK\n", tx_intf_compatible_str);
2542ee67178SXianjun Jiao 			break;
2552ee67178SXianjun Jiao 
2562ee67178SXianjun Jiao 		case TX_INTF_BW_20MHZ_AT_0MHZ_ANT0:
2572ee67178SXianjun Jiao 			printk("%s hw_init mode TX_INTF_BW_20MHZ_AT_0MHZ_ANT0\n", tx_intf_compatible_str);
2582ee67178SXianjun Jiao 			mixer_cfg = 0x2001F400;
2592ee67178SXianjun Jiao 			ant_sel=1;
2602ee67178SXianjun Jiao 			break;
2612ee67178SXianjun Jiao 
262469b96d3SXianjun Jiao 		case TX_INTF_BW_20MHZ_AT_0MHZ_ANT_BOTH:
263469b96d3SXianjun Jiao 			printk("%s hw_init mode TX_INTF_BW_20MHZ_AT_0MHZ_ANT0\n", tx_intf_compatible_str);
264469b96d3SXianjun Jiao 			mixer_cfg = 0x2001F400;
265469b96d3SXianjun Jiao 			ant_sel=0x11;
266469b96d3SXianjun Jiao 			break;
267469b96d3SXianjun Jiao 
2682ee67178SXianjun Jiao 		case TX_INTF_BW_20MHZ_AT_N_10MHZ_ANT0:
2692ee67178SXianjun Jiao 			printk("%s hw_init mode TX_INTF_BW_20MHZ_AT_N_10MHZ_ANT0\n", tx_intf_compatible_str);
2702ee67178SXianjun Jiao 			mixer_cfg = 0x2001F602;
2712ee67178SXianjun Jiao 			ant_sel=1;
2722ee67178SXianjun Jiao 			break;
2732ee67178SXianjun Jiao 
2742ee67178SXianjun Jiao 		case TX_INTF_BW_20MHZ_AT_P_10MHZ_ANT0:
2752ee67178SXianjun Jiao 			printk("%s hw_init mode TX_INTF_BW_20MHZ_AT_P_10MHZ_ANT0\n", tx_intf_compatible_str);
2762ee67178SXianjun Jiao 			mixer_cfg = 0x200202F6;
2772ee67178SXianjun Jiao 			ant_sel=1;
2782ee67178SXianjun Jiao 			break;
2792ee67178SXianjun Jiao 
2802ee67178SXianjun Jiao 		case TX_INTF_BW_20MHZ_AT_0MHZ_ANT1:
2812ee67178SXianjun Jiao 			printk("%s hw_init mode TX_INTF_BW_20MHZ_AT_0MHZ_ANT1\n", tx_intf_compatible_str);
2822ee67178SXianjun Jiao 			mixer_cfg = 0x2001F400;
2832ee67178SXianjun Jiao 			ant_sel=2;
2842ee67178SXianjun Jiao 			break;
2852ee67178SXianjun Jiao 
2862ee67178SXianjun Jiao 		case TX_INTF_BW_20MHZ_AT_N_10MHZ_ANT1:
2872ee67178SXianjun Jiao 			printk("%s hw_init mode TX_INTF_BW_20MHZ_AT_N_10MHZ_ANT1\n", tx_intf_compatible_str);
2882ee67178SXianjun Jiao 			mixer_cfg = 0x2001F602;
2892ee67178SXianjun Jiao 			ant_sel=2;
2902ee67178SXianjun Jiao 			break;
2912ee67178SXianjun Jiao 
2922ee67178SXianjun Jiao 		case TX_INTF_BW_20MHZ_AT_P_10MHZ_ANT1:
2932ee67178SXianjun Jiao 			printk("%s hw_init mode TX_INTF_BW_20MHZ_AT_P_10MHZ_ANT1\n", tx_intf_compatible_str);
2942ee67178SXianjun Jiao 			mixer_cfg = 0x200202F6;
2952ee67178SXianjun Jiao 			ant_sel=2;
2962ee67178SXianjun Jiao 			break;
2972ee67178SXianjun Jiao 
2982ee67178SXianjun Jiao 		case TX_INTF_BYPASS:
2992ee67178SXianjun Jiao 			printk("%s hw_init mode TX_INTF_BYPASS\n", tx_intf_compatible_str);
3002ee67178SXianjun Jiao 			mixer_cfg = 0x200202F6;
3012ee67178SXianjun Jiao 			ant_sel=2;
3022ee67178SXianjun Jiao 			break;
3032ee67178SXianjun Jiao 
3042ee67178SXianjun Jiao 		default:
3052ee67178SXianjun Jiao 			printk("%s hw_init mode %d is wrong!\n", tx_intf_compatible_str, mode);
3062ee67178SXianjun Jiao 			err=1;
3072ee67178SXianjun Jiao 	}
3082ee67178SXianjun Jiao 
3092ee67178SXianjun Jiao 	if (mode!=TX_INTF_AXIS_LOOP_BACK) {
3102ee67178SXianjun Jiao 		tx_intf_api->TX_INTF_REG_MULTI_RST_write(0);
311d14d06e5SXianjun Jiao 		tx_intf_api->TX_INTF_REG_CSI_FUZZER_write(0);
312febc5adfSXianjun Jiao 		tx_intf_api->TX_INTF_REG_CTS_TOSELF_WAIT_SIFS_TOP_write( ((16*10)<<16)|(10*10) );//high 16bit 5GHz; low 16 bit 2.4GHz. counter speed 10MHz is assumed
3132ee67178SXianjun Jiao 
314f738aefaSmmehari 		tx_intf_api->TX_INTF_REG_TX_CONFIG_write(tx_config);
3152ee67178SXianjun Jiao 		tx_intf_api->TX_INTF_REG_NUM_DMA_SYMBOL_TO_PS_write(num_dma_symbol_to_ps);
3162ee67178SXianjun Jiao 		tx_intf_api->TX_INTF_REG_CFG_DATA_TO_ANT_write(0);
317febc5adfSXianjun Jiao 		tx_intf_api->TX_INTF_REG_TX_HOLD_THRESHOLD_write(420);
31822dd0cc4SXianjun 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
31922dd0cc4SXianjun Jiao 		tx_intf_api->TX_INTF_REG_INTERRUPT_SEL_write(0x30004); //disable interrupt
320*0cbb6873SXianjun Jiao 
321*0cbb6873SXianjun Jiao 		// tx_intf_api->TX_INTF_REG_BB_GAIN_write(100); // value for old design with DUC (FIR + MIXER) -- obsolete due to DUC removal
322*0cbb6873SXianjun Jiao 		// New test on new design (unified RF BB clock; No DUC)
323*0cbb6873SXianjun Jiao 		// 5220MHz bb_gain power   EVM
324*0cbb6873SXianjun Jiao         //         400     -6dBm   -34/35
325*0cbb6873SXianjun Jiao         //         350     -7.2dBm -34/35/36
326*0cbb6873SXianjun Jiao         //         300     -8.5dBm -35/36/37 EVM
327*0cbb6873SXianjun Jiao 
328*0cbb6873SXianjun Jiao         // 2437MHz bb_gain power    EVM
329*0cbb6873SXianjun Jiao         //         400     -3.2dBm -36/37
330*0cbb6873SXianjun Jiao         //         350     -4.4dBm -37/38/39
331*0cbb6873SXianjun Jiao         //         300     -5.7dBm -39/40
332*0cbb6873SXianjun Jiao         //         less    less    -40/41/42!
333*0cbb6873SXianjun Jiao 
334*0cbb6873SXianjun Jiao 		// According to above and more detailed test:
335*0cbb6873SXianjun Jiao 		// Need to be 290. Otherwise some ofdm symbol's EVM jump high, when there are lots of ofdm symbols in one WiFi packet
336*0cbb6873SXianjun Jiao 
337*0cbb6873SXianjun Jiao 		// 2022-03-04 detailed test result:
338*0cbb6873SXianjun Jiao 		// bb_gain 290 work for 11a/g all mcs
339*0cbb6873SXianjun Jiao 		// bb_gain 290 work for 11n mcs 1~7 (aggr and non aggr)
340*0cbb6873SXianjun Jiao 		// bb_gain 290 destroy  11n mcs 0 long (MTU 1500) tx pkt due to high PAPR (Peak to Average Power Ratio)!
341*0cbb6873SXianjun Jiao 		// bb_gain 250 work for 11n mcs 0
342*0cbb6873SXianjun Jiao 		// So, a conservative bb_gain 250 should be used
343*0cbb6873SXianjun Jiao 		tx_intf_api->TX_INTF_REG_BB_GAIN_write(250);
344*0cbb6873SXianjun Jiao 
3452ee67178SXianjun Jiao 		tx_intf_api->TX_INTF_REG_ANT_SEL_write(ant_sel);
3462ee67178SXianjun Jiao 		tx_intf_api->TX_INTF_REG_WIFI_TX_MODE_write((1<<3)|(2<<4));
3472ee67178SXianjun Jiao 		tx_intf_api->TX_INTF_REG_MULTI_RST_write(0x434);
3482ee67178SXianjun Jiao 		tx_intf_api->TX_INTF_REG_MULTI_RST_write(0);
3492ee67178SXianjun Jiao 	}
3502ee67178SXianjun Jiao 
3512ee67178SXianjun Jiao 	if (mode == TX_INTF_BYPASS) {
3522ee67178SXianjun Jiao 		tx_intf_api->TX_INTF_REG_CFG_DATA_TO_ANT_write(0x100); //slv_reg10[8]
3532ee67178SXianjun Jiao 	}
3542ee67178SXianjun Jiao 
3552ee67178SXianjun Jiao 	printk("%s hw_init err %d\n", tx_intf_compatible_str, err);
3562ee67178SXianjun Jiao 	return(err);
3572ee67178SXianjun Jiao }
3582ee67178SXianjun Jiao 
3592ee67178SXianjun Jiao static int dev_probe(struct platform_device *pdev)
3602ee67178SXianjun Jiao {
3612ee67178SXianjun Jiao 	struct device_node *np = pdev->dev.of_node;
3622ee67178SXianjun Jiao 	struct resource *io;
3632ee67178SXianjun Jiao 	int err=1;
3642ee67178SXianjun Jiao 
3652ee67178SXianjun Jiao 	printk("\n");
3662ee67178SXianjun Jiao 
3672ee67178SXianjun Jiao 	if (np) {
3682ee67178SXianjun Jiao 		const struct of_device_id *match;
3692ee67178SXianjun Jiao 
3702ee67178SXianjun Jiao 		match = of_match_node(dev_of_ids, np);
3712ee67178SXianjun Jiao 		if (match) {
3722ee67178SXianjun Jiao 			printk("%s dev_probe match!\n", tx_intf_compatible_str);
3732ee67178SXianjun Jiao 			err = 0;
3742ee67178SXianjun Jiao 		}
3752ee67178SXianjun Jiao 	}
3762ee67178SXianjun Jiao 
3772ee67178SXianjun Jiao 	if (err)
3782ee67178SXianjun Jiao 		return err;
3792ee67178SXianjun Jiao 
3802ee67178SXianjun Jiao 	tx_intf_api->hw_init=hw_init;
3812ee67178SXianjun Jiao 
3822ee67178SXianjun Jiao 	tx_intf_api->reg_read=reg_read;
3832ee67178SXianjun Jiao 	tx_intf_api->reg_write=reg_write;
3842ee67178SXianjun Jiao 
3852ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_MULTI_RST_read=TX_INTF_REG_MULTI_RST_read;
386469b96d3SXianjun Jiao 	tx_intf_api->TX_INTF_REG_ARBITRARY_IQ_read=TX_INTF_REG_ARBITRARY_IQ_read;
3872ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_WIFI_TX_MODE_read=TX_INTF_REG_WIFI_TX_MODE_read;
3882ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_CTS_TOSELF_CONFIG_read=TX_INTF_REG_CTS_TOSELF_CONFIG_read;
389d14d06e5SXianjun Jiao 	tx_intf_api->TX_INTF_REG_CSI_FUZZER_read=TX_INTF_REG_CSI_FUZZER_read;
3902ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_CTS_TOSELF_WAIT_SIFS_TOP_read=TX_INTF_REG_CTS_TOSELF_WAIT_SIFS_TOP_read;
391469b96d3SXianjun Jiao 	tx_intf_api->TX_INTF_REG_ARBITRARY_IQ_CTL_read=TX_INTF_REG_ARBITRARY_IQ_CTL_read;
392f738aefaSmmehari 	tx_intf_api->TX_INTF_REG_TX_CONFIG_read=TX_INTF_REG_TX_CONFIG_read;
3932ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_NUM_DMA_SYMBOL_TO_PS_read=TX_INTF_REG_NUM_DMA_SYMBOL_TO_PS_read;
3942ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_CFG_DATA_TO_ANT_read=TX_INTF_REG_CFG_DATA_TO_ANT_read;
395838a9007SXianjun Jiao 	tx_intf_api->TX_INTF_REG_S_AXIS_FIFO_TH_read=TX_INTF_REG_S_AXIS_FIFO_TH_read;
396febc5adfSXianjun Jiao 	tx_intf_api->TX_INTF_REG_TX_HOLD_THRESHOLD_read=TX_INTF_REG_TX_HOLD_THRESHOLD_read;
3972ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_INTERRUPT_SEL_read=TX_INTF_REG_INTERRUPT_SEL_read;
398f738aefaSmmehari 	tx_intf_api->TX_INTF_REG_AMPDU_ACTION_CONFIG_read=TX_INTF_REG_AMPDU_ACTION_CONFIG_read;
3992ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_BB_GAIN_read=TX_INTF_REG_BB_GAIN_read;
4002ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_ANT_SEL_read=TX_INTF_REG_ANT_SEL_read;
401f738aefaSmmehari 	tx_intf_api->TX_INTF_REG_PHY_HDR_CONFIG_read=TX_INTF_REG_PHY_HDR_CONFIG_read;
402838a9007SXianjun Jiao 	tx_intf_api->TX_INTF_REG_S_AXIS_FIFO_NO_ROOM_read=TX_INTF_REG_S_AXIS_FIFO_NO_ROOM_read;
4032d12c07dSmmehari 	tx_intf_api->TX_INTF_REG_PKT_INFO1_read=TX_INTF_REG_PKT_INFO1_read;
4042d12c07dSmmehari 	tx_intf_api->TX_INTF_REG_PKT_INFO2_read=TX_INTF_REG_PKT_INFO2_read;
4052d12c07dSmmehari 	tx_intf_api->TX_INTF_REG_PKT_INFO3_read=TX_INTF_REG_PKT_INFO3_read;
4062d12c07dSmmehari 	tx_intf_api->TX_INTF_REG_PKT_INFO4_read=TX_INTF_REG_PKT_INFO4_read;
4072ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_QUEUE_FIFO_DATA_COUNT_read=TX_INTF_REG_QUEUE_FIFO_DATA_COUNT_read;
4082ee67178SXianjun Jiao 
4092ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_MULTI_RST_write=TX_INTF_REG_MULTI_RST_write;
410469b96d3SXianjun Jiao 	tx_intf_api->TX_INTF_REG_ARBITRARY_IQ_write=TX_INTF_REG_ARBITRARY_IQ_write;
4112ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_WIFI_TX_MODE_write=TX_INTF_REG_WIFI_TX_MODE_write;
4122ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_CTS_TOSELF_CONFIG_write=TX_INTF_REG_CTS_TOSELF_CONFIG_write;
413d14d06e5SXianjun Jiao 	tx_intf_api->TX_INTF_REG_CSI_FUZZER_write=TX_INTF_REG_CSI_FUZZER_write;
4142ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_CTS_TOSELF_WAIT_SIFS_TOP_write=TX_INTF_REG_CTS_TOSELF_WAIT_SIFS_TOP_write;
415469b96d3SXianjun Jiao 	tx_intf_api->TX_INTF_REG_ARBITRARY_IQ_CTL_write=TX_INTF_REG_ARBITRARY_IQ_CTL_write;
416f738aefaSmmehari 	tx_intf_api->TX_INTF_REG_TX_CONFIG_write=TX_INTF_REG_TX_CONFIG_write;
4172ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_NUM_DMA_SYMBOL_TO_PS_write=TX_INTF_REG_NUM_DMA_SYMBOL_TO_PS_write;
4182ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_CFG_DATA_TO_ANT_write=TX_INTF_REG_CFG_DATA_TO_ANT_write;
419838a9007SXianjun Jiao 	tx_intf_api->TX_INTF_REG_S_AXIS_FIFO_TH_write=TX_INTF_REG_S_AXIS_FIFO_TH_write;
420febc5adfSXianjun Jiao 	tx_intf_api->TX_INTF_REG_TX_HOLD_THRESHOLD_write=TX_INTF_REG_TX_HOLD_THRESHOLD_write;
4212ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_INTERRUPT_SEL_write=TX_INTF_REG_INTERRUPT_SEL_write;
422f738aefaSmmehari 	tx_intf_api->TX_INTF_REG_AMPDU_ACTION_CONFIG_write=TX_INTF_REG_AMPDU_ACTION_CONFIG_write;
4232ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_BB_GAIN_write=TX_INTF_REG_BB_GAIN_write;
4242ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_ANT_SEL_write=TX_INTF_REG_ANT_SEL_write;
425f738aefaSmmehari 	tx_intf_api->TX_INTF_REG_PHY_HDR_CONFIG_write=TX_INTF_REG_PHY_HDR_CONFIG_write;
426838a9007SXianjun Jiao 	tx_intf_api->TX_INTF_REG_S_AXIS_FIFO_NO_ROOM_write=TX_INTF_REG_S_AXIS_FIFO_NO_ROOM_write;
4272d12c07dSmmehari 	tx_intf_api->TX_INTF_REG_PKT_INFO1_write=TX_INTF_REG_PKT_INFO1_write;
4282d12c07dSmmehari 	tx_intf_api->TX_INTF_REG_PKT_INFO2_write=TX_INTF_REG_PKT_INFO2_write;
4292d12c07dSmmehari 	tx_intf_api->TX_INTF_REG_PKT_INFO3_write=TX_INTF_REG_PKT_INFO3_write;
4302d12c07dSmmehari 	tx_intf_api->TX_INTF_REG_PKT_INFO4_write=TX_INTF_REG_PKT_INFO4_write;
4312ee67178SXianjun Jiao 
4322ee67178SXianjun Jiao 	/* Request and map I/O memory */
4332ee67178SXianjun Jiao 	io = platform_get_resource(pdev, IORESOURCE_MEM, 0);
4342ee67178SXianjun Jiao 	base_addr = devm_ioremap_resource(&pdev->dev, io);
4352ee67178SXianjun Jiao 	if (IS_ERR(base_addr))
4362ee67178SXianjun Jiao 		return PTR_ERR(base_addr);
4372ee67178SXianjun Jiao 
4382d12c07dSmmehari 	printk("%s dev_probe io start 0x%08llx end 0x%08llx 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);
439febc5adfSXianjun Jiao 	printk("%s dev_probe base_addr 0x%p\n", tx_intf_compatible_str,(void*)base_addr);
440febc5adfSXianjun Jiao 	printk("%s dev_probe tx_intf_driver_api_inst 0x%p\n", tx_intf_compatible_str, (void*)(&tx_intf_driver_api_inst) );
441febc5adfSXianjun Jiao 	printk("%s dev_probe             tx_intf_api 0x%p\n", tx_intf_compatible_str, (void*)tx_intf_api);
4422ee67178SXianjun Jiao 
4432ee67178SXianjun Jiao 	printk("%s dev_probe succeed!\n", tx_intf_compatible_str);
4442ee67178SXianjun Jiao 
4450c0d5d82Smmehari 	//err = hw_init(TX_INTF_BW_20MHZ_AT_P_10MHZ_ANT1, 8, 8, SMALL_FPGA);
4460c0d5d82Smmehari 	//err = hw_init(TX_INTF_BYPASS, 8, 8, SMALL_FPGA);
4470c0d5d82Smmehari 	err = hw_init(TX_INTF_BW_20MHZ_AT_N_10MHZ_ANT1, 8, 8, SMALL_FPGA); // make sure dac is connected to original ad9361 dma
4482ee67178SXianjun Jiao 
4492ee67178SXianjun Jiao 	return err;
4502ee67178SXianjun Jiao }
4512ee67178SXianjun Jiao 
4522ee67178SXianjun Jiao static int dev_remove(struct platform_device *pdev)
4532ee67178SXianjun Jiao {
4542ee67178SXianjun Jiao 	printk("\n");
4552ee67178SXianjun Jiao 
456febc5adfSXianjun Jiao 	printk("%s dev_remove base_addr 0x%p\n", tx_intf_compatible_str,(void*)base_addr);
457febc5adfSXianjun Jiao 	printk("%s dev_remove tx_intf_driver_api_inst 0x%p\n", tx_intf_compatible_str, (void*)(&tx_intf_driver_api_inst) );
458febc5adfSXianjun Jiao 	printk("%s dev_remove             tx_intf_api 0x%p\n", tx_intf_compatible_str, (void*)tx_intf_api);
4592ee67178SXianjun Jiao 
4602ee67178SXianjun Jiao 	printk("%s dev_remove succeed!\n", tx_intf_compatible_str);
4612ee67178SXianjun Jiao 	return 0;
4622ee67178SXianjun Jiao }
4632ee67178SXianjun Jiao 
4642ee67178SXianjun Jiao static struct platform_driver dev_driver = {
4652ee67178SXianjun Jiao 	.driver = {
4662ee67178SXianjun Jiao 		.name = "sdr,tx_intf",
4672ee67178SXianjun Jiao 		.owner = THIS_MODULE,
4682ee67178SXianjun Jiao 		.of_match_table = dev_of_ids,
4692ee67178SXianjun Jiao 	},
4702ee67178SXianjun Jiao 	.probe = dev_probe,
4712ee67178SXianjun Jiao 	.remove = dev_remove,
4722ee67178SXianjun Jiao };
4732ee67178SXianjun Jiao 
4742ee67178SXianjun Jiao module_platform_driver(dev_driver);
4752ee67178SXianjun Jiao 
4762ee67178SXianjun Jiao MODULE_AUTHOR("Xianjun Jiao");
4772ee67178SXianjun Jiao MODULE_DESCRIPTION("sdr,tx_intf");
4782ee67178SXianjun Jiao MODULE_LICENSE("GPL v2");
479