xref: /openwifi/driver/tx_intf/tx_intf.c (revision 2d12c07d4d5c6657c5c80bf9fdd0100dfbba0cee)
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 
432ee67178SXianjun Jiao static inline u32 TX_INTF_REG_MIXER_CFG_read(void){
442ee67178SXianjun Jiao 	return reg_read(TX_INTF_REG_MIXER_CFG_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_IQ_SRC_SEL_read(void){
522ee67178SXianjun Jiao 	return reg_read(TX_INTF_REG_IQ_SRC_SEL_ADDR);
532ee67178SXianjun Jiao }
542ee67178SXianjun Jiao 
552ee67178SXianjun Jiao static inline u32 TX_INTF_REG_CTS_TOSELF_CONFIG_read(void){
562ee67178SXianjun Jiao 	return reg_read(TX_INTF_REG_CTS_TOSELF_CONFIG_ADDR);
572ee67178SXianjun Jiao }
582ee67178SXianjun Jiao 
59d14d06e5SXianjun Jiao static inline u32 TX_INTF_REG_CSI_FUZZER_read(void){
60d14d06e5SXianjun Jiao 	return reg_read(TX_INTF_REG_CSI_FUZZER_ADDR);
612ee67178SXianjun Jiao }
622ee67178SXianjun Jiao 
632ee67178SXianjun Jiao static inline u32 TX_INTF_REG_CTS_TOSELF_WAIT_SIFS_TOP_read(void){
642ee67178SXianjun Jiao 	return reg_read(TX_INTF_REG_CTS_TOSELF_WAIT_SIFS_TOP_ADDR);
652ee67178SXianjun Jiao }
662ee67178SXianjun Jiao 
672ee67178SXianjun Jiao static inline u32 TX_INTF_REG_MISC_SEL_read(void){
682ee67178SXianjun Jiao 	return reg_read(TX_INTF_REG_MISC_SEL_ADDR);
692ee67178SXianjun Jiao }
702ee67178SXianjun Jiao 
71f738aefaSmmehari static inline u32 TX_INTF_REG_TX_CONFIG_read(void){
72f738aefaSmmehari 	return reg_read(TX_INTF_REG_TX_CONFIG_ADDR);
732ee67178SXianjun Jiao }
742ee67178SXianjun Jiao 
752ee67178SXianjun Jiao static inline u32 TX_INTF_REG_NUM_DMA_SYMBOL_TO_PS_read(void){
762ee67178SXianjun Jiao 	return reg_read(TX_INTF_REG_NUM_DMA_SYMBOL_TO_PS_ADDR);
772ee67178SXianjun Jiao }
782ee67178SXianjun Jiao 
792ee67178SXianjun Jiao static inline u32 TX_INTF_REG_CFG_DATA_TO_ANT_read(void){
802ee67178SXianjun Jiao 	return reg_read(TX_INTF_REG_CFG_DATA_TO_ANT_ADDR);
812ee67178SXianjun Jiao }
822ee67178SXianjun Jiao 
83838a9007SXianjun Jiao static inline u32 TX_INTF_REG_S_AXIS_FIFO_TH_read(void){
84838a9007SXianjun Jiao 	return reg_read(TX_INTF_REG_S_AXIS_FIFO_TH_ADDR);
85838a9007SXianjun Jiao }
86838a9007SXianjun Jiao 
87febc5adfSXianjun Jiao static inline u32 TX_INTF_REG_TX_HOLD_THRESHOLD_read(void){
88febc5adfSXianjun Jiao 	return reg_read(TX_INTF_REG_TX_HOLD_THRESHOLD_ADDR);
89febc5adfSXianjun Jiao }
90febc5adfSXianjun Jiao 
912ee67178SXianjun Jiao static inline u32 TX_INTF_REG_INTERRUPT_SEL_read(void){
922ee67178SXianjun Jiao 	return reg_read(TX_INTF_REG_INTERRUPT_SEL_ADDR);
932ee67178SXianjun Jiao }
942ee67178SXianjun Jiao 
95f738aefaSmmehari static inline u32 TX_INTF_REG_AMPDU_ACTION_CONFIG_read(void){
96f738aefaSmmehari 	return reg_read(TX_INTF_REG_AMPDU_ACTION_CONFIG_ADDR);
97f738aefaSmmehari }
98f738aefaSmmehari 
992ee67178SXianjun Jiao static inline u32 TX_INTF_REG_BB_GAIN_read(void){
1002ee67178SXianjun Jiao 	return reg_read(TX_INTF_REG_BB_GAIN_ADDR);
1012ee67178SXianjun Jiao }
1022ee67178SXianjun Jiao 
1032ee67178SXianjun Jiao static inline u32 TX_INTF_REG_ANT_SEL_read(void){
1042ee67178SXianjun Jiao 	return reg_read(TX_INTF_REG_ANT_SEL_ADDR);
1052ee67178SXianjun Jiao }
1062ee67178SXianjun Jiao 
107f738aefaSmmehari static inline u32 TX_INTF_REG_PHY_HDR_CONFIG_read(void){
108f738aefaSmmehari 	return reg_read(TX_INTF_REG_PHY_HDR_CONFIG_ADDR);
109f738aefaSmmehari }
110f738aefaSmmehari 
111838a9007SXianjun Jiao static inline u32 TX_INTF_REG_S_AXIS_FIFO_NO_ROOM_read(void){
112838a9007SXianjun Jiao 	return reg_read(TX_INTF_REG_S_AXIS_FIFO_NO_ROOM_ADDR);
1132ee67178SXianjun Jiao }
1142ee67178SXianjun Jiao 
115*2d12c07dSmmehari static inline u32 TX_INTF_REG_PKT_INFO1_read(void){
116*2d12c07dSmmehari 	return reg_read(TX_INTF_REG_PKT_INFO1_ADDR);
117*2d12c07dSmmehari }
118*2d12c07dSmmehari 
119*2d12c07dSmmehari static inline u32 TX_INTF_REG_PKT_INFO2_read(void){
120*2d12c07dSmmehari 	return reg_read(TX_INTF_REG_PKT_INFO2_ADDR);
121*2d12c07dSmmehari }
122*2d12c07dSmmehari 
123*2d12c07dSmmehari static inline u32 TX_INTF_REG_PKT_INFO3_read(void){
124*2d12c07dSmmehari 	return reg_read(TX_INTF_REG_PKT_INFO3_ADDR);
125*2d12c07dSmmehari }
126*2d12c07dSmmehari 
127*2d12c07dSmmehari static inline u32 TX_INTF_REG_PKT_INFO4_read(void){
128*2d12c07dSmmehari 	return reg_read(TX_INTF_REG_PKT_INFO4_ADDR);
1292ee67178SXianjun Jiao }
1302ee67178SXianjun Jiao 
1312ee67178SXianjun Jiao static inline u32 TX_INTF_REG_QUEUE_FIFO_DATA_COUNT_read(void){
1322ee67178SXianjun Jiao 	return reg_read(TX_INTF_REG_QUEUE_FIFO_DATA_COUNT_ADDR);
1332ee67178SXianjun Jiao }
1342ee67178SXianjun Jiao 
1352ee67178SXianjun Jiao //--------------------------------------------------------
1362ee67178SXianjun Jiao 
1372ee67178SXianjun Jiao static inline void TX_INTF_REG_MULTI_RST_write(u32 value){
1382ee67178SXianjun Jiao 	reg_write(TX_INTF_REG_MULTI_RST_ADDR, value);
1392ee67178SXianjun Jiao }
1402ee67178SXianjun Jiao 
1412ee67178SXianjun Jiao static inline void TX_INTF_REG_MIXER_CFG_write(u32 value){
1422ee67178SXianjun Jiao 	reg_write(TX_INTF_REG_MIXER_CFG_ADDR, value);
1432ee67178SXianjun Jiao }
1442ee67178SXianjun Jiao 
1452ee67178SXianjun Jiao static inline void TX_INTF_REG_WIFI_TX_MODE_write(u32 value){
1462ee67178SXianjun Jiao 	reg_write(TX_INTF_REG_WIFI_TX_MODE_ADDR, value);
1472ee67178SXianjun Jiao }
1482ee67178SXianjun Jiao 
1492ee67178SXianjun Jiao static inline void TX_INTF_REG_IQ_SRC_SEL_write(u32 value){
1502ee67178SXianjun Jiao 	reg_write(TX_INTF_REG_IQ_SRC_SEL_ADDR, value);
1512ee67178SXianjun Jiao }
1522ee67178SXianjun Jiao 
1532ee67178SXianjun Jiao static inline void TX_INTF_REG_CTS_TOSELF_CONFIG_write(u32 value){
1542ee67178SXianjun Jiao 	reg_write(TX_INTF_REG_CTS_TOSELF_CONFIG_ADDR, value);
1552ee67178SXianjun Jiao }
1562ee67178SXianjun Jiao 
157d14d06e5SXianjun Jiao static inline void TX_INTF_REG_CSI_FUZZER_write(u32 value){
158d14d06e5SXianjun Jiao 	reg_write(TX_INTF_REG_CSI_FUZZER_ADDR, value);
1592ee67178SXianjun Jiao }
1602ee67178SXianjun Jiao 
1612ee67178SXianjun Jiao static inline void TX_INTF_REG_CTS_TOSELF_WAIT_SIFS_TOP_write(u32 value){
1622ee67178SXianjun Jiao 	reg_write(TX_INTF_REG_CTS_TOSELF_WAIT_SIFS_TOP_ADDR, value);
1632ee67178SXianjun Jiao }
1642ee67178SXianjun Jiao 
1652ee67178SXianjun Jiao static inline void TX_INTF_REG_MISC_SEL_write(u32 value){
1662ee67178SXianjun Jiao 	reg_write(TX_INTF_REG_MISC_SEL_ADDR, value);
1672ee67178SXianjun Jiao }
1682ee67178SXianjun Jiao 
169f738aefaSmmehari static inline void TX_INTF_REG_TX_CONFIG_write(u32 value){
170f738aefaSmmehari 	reg_write(TX_INTF_REG_TX_CONFIG_ADDR, value);
1712ee67178SXianjun Jiao }
1722ee67178SXianjun Jiao 
1732ee67178SXianjun Jiao static inline void TX_INTF_REG_NUM_DMA_SYMBOL_TO_PS_write(u32 value){
1742ee67178SXianjun Jiao 	reg_write(TX_INTF_REG_NUM_DMA_SYMBOL_TO_PS_ADDR, value);
1752ee67178SXianjun Jiao }
1762ee67178SXianjun Jiao 
1772ee67178SXianjun Jiao static inline void TX_INTF_REG_CFG_DATA_TO_ANT_write(u32 value){
1782ee67178SXianjun Jiao 	reg_write(TX_INTF_REG_CFG_DATA_TO_ANT_ADDR, value);
1792ee67178SXianjun Jiao }
1802ee67178SXianjun Jiao 
181838a9007SXianjun Jiao static inline void TX_INTF_REG_S_AXIS_FIFO_TH_write(u32 value){
182838a9007SXianjun Jiao 	reg_write(TX_INTF_REG_S_AXIS_FIFO_TH_ADDR, value);
183838a9007SXianjun Jiao }
184838a9007SXianjun Jiao 
185febc5adfSXianjun Jiao static inline void TX_INTF_REG_TX_HOLD_THRESHOLD_write(u32 value){
186febc5adfSXianjun Jiao 	reg_write(TX_INTF_REG_TX_HOLD_THRESHOLD_ADDR, value);
187febc5adfSXianjun Jiao }
188febc5adfSXianjun Jiao 
1892ee67178SXianjun Jiao static inline void TX_INTF_REG_INTERRUPT_SEL_write(u32 value){
1902ee67178SXianjun Jiao 	reg_write(TX_INTF_REG_INTERRUPT_SEL_ADDR, value);
1912ee67178SXianjun Jiao }
1922ee67178SXianjun Jiao 
193f738aefaSmmehari static inline void TX_INTF_REG_AMPDU_ACTION_CONFIG_write(u32 value){
194f738aefaSmmehari 	reg_write(TX_INTF_REG_AMPDU_ACTION_CONFIG_ADDR, value);
195f738aefaSmmehari }
196f738aefaSmmehari 
1972ee67178SXianjun Jiao static inline void TX_INTF_REG_BB_GAIN_write(u32 value){
1982ee67178SXianjun Jiao 	reg_write(TX_INTF_REG_BB_GAIN_ADDR, value);
1992ee67178SXianjun Jiao }
2002ee67178SXianjun Jiao 
2012ee67178SXianjun Jiao static inline void TX_INTF_REG_ANT_SEL_write(u32 value){
2022ee67178SXianjun Jiao 	reg_write(TX_INTF_REG_ANT_SEL_ADDR, value);
2032ee67178SXianjun Jiao }
2042ee67178SXianjun Jiao 
205f738aefaSmmehari static inline void TX_INTF_REG_PHY_HDR_CONFIG_write(u32 value){
206f738aefaSmmehari 	reg_write(TX_INTF_REG_PHY_HDR_CONFIG_ADDR, value);
207f738aefaSmmehari }
208f738aefaSmmehari 
209838a9007SXianjun Jiao static inline void TX_INTF_REG_S_AXIS_FIFO_NO_ROOM_write(u32 value){
210838a9007SXianjun Jiao 	reg_write(TX_INTF_REG_S_AXIS_FIFO_NO_ROOM_ADDR, value);
2112ee67178SXianjun Jiao }
2122ee67178SXianjun Jiao 
213*2d12c07dSmmehari static inline void TX_INTF_REG_PKT_INFO1_write(u32 value){
214*2d12c07dSmmehari 	reg_write(TX_INTF_REG_PKT_INFO1_ADDR,value);
215*2d12c07dSmmehari }
216*2d12c07dSmmehari 
217*2d12c07dSmmehari static inline void TX_INTF_REG_PKT_INFO2_write(u32 value){
218*2d12c07dSmmehari 	reg_write(TX_INTF_REG_PKT_INFO2_ADDR,value);
219*2d12c07dSmmehari }
220*2d12c07dSmmehari 
221*2d12c07dSmmehari static inline void TX_INTF_REG_PKT_INFO3_write(u32 value){
222*2d12c07dSmmehari 	reg_write(TX_INTF_REG_PKT_INFO3_ADDR,value);
223*2d12c07dSmmehari }
224*2d12c07dSmmehari 
225*2d12c07dSmmehari static inline void TX_INTF_REG_PKT_INFO4_write(u32 value){
226*2d12c07dSmmehari 	reg_write(TX_INTF_REG_PKT_INFO4_ADDR,value);
2272ee67178SXianjun Jiao }
2282ee67178SXianjun Jiao 
2292ee67178SXianjun Jiao static const struct of_device_id dev_of_ids[] = {
2302ee67178SXianjun Jiao 	{ .compatible = "sdr,tx_intf", },
2312ee67178SXianjun Jiao 	{}
2322ee67178SXianjun Jiao };
2332ee67178SXianjun Jiao MODULE_DEVICE_TABLE(of, dev_of_ids);
2342ee67178SXianjun Jiao 
2352ee67178SXianjun Jiao static struct tx_intf_driver_api tx_intf_driver_api_inst;
2362ee67178SXianjun Jiao static struct tx_intf_driver_api *tx_intf_api = &tx_intf_driver_api_inst;
2372ee67178SXianjun Jiao EXPORT_SYMBOL(tx_intf_api);
2382ee67178SXianjun Jiao 
239f738aefaSmmehari static inline u32 hw_init(enum tx_intf_mode mode, u32 tx_config, u32 num_dma_symbol_to_ps){
240838a9007SXianjun Jiao 	int err=0, i;
241838a9007SXianjun Jiao 	u32 mixer_cfg=0, duc_input_ch_sel = 0, ant_sel=0;
2422ee67178SXianjun Jiao 
2432ee67178SXianjun Jiao 	printk("%s hw_init mode %d\n", tx_intf_compatible_str, mode);
2442ee67178SXianjun Jiao 
245838a9007SXianjun Jiao 	//rst
246838a9007SXianjun Jiao 	for (i=0;i<8;i++)
247838a9007SXianjun Jiao 		tx_intf_api->TX_INTF_REG_MULTI_RST_write(0);
248838a9007SXianjun Jiao 	for (i=0;i<32;i++)
2492ee67178SXianjun Jiao 		tx_intf_api->TX_INTF_REG_MULTI_RST_write(0xFFFFFFFF);
250838a9007SXianjun Jiao 	for (i=0;i<8;i++)
2512ee67178SXianjun Jiao 		tx_intf_api->TX_INTF_REG_MULTI_RST_write(0);
2522ee67178SXianjun Jiao 
2532ee67178SXianjun Jiao 	switch(mode)
2542ee67178SXianjun Jiao 	{
2552ee67178SXianjun Jiao 		case TX_INTF_AXIS_LOOP_BACK:
2562ee67178SXianjun Jiao 			tx_intf_api->TX_INTF_REG_MISC_SEL_write(0<<1);// bit1: 0-connect dac to ADI dma; 1-connect dac to our intf
2572ee67178SXianjun Jiao 			printk("%s hw_init mode TX_INTF_AXIS_LOOP_BACK\n", tx_intf_compatible_str);
2582ee67178SXianjun Jiao 			break;
2592ee67178SXianjun Jiao 
2602ee67178SXianjun Jiao 		case TX_INTF_BW_20MHZ_AT_0MHZ_ANT0:
2612ee67178SXianjun Jiao 			printk("%s hw_init mode TX_INTF_BW_20MHZ_AT_0MHZ_ANT0\n", tx_intf_compatible_str);
2622ee67178SXianjun Jiao 			mixer_cfg = 0x2001F400;
2632ee67178SXianjun Jiao 			duc_input_ch_sel = 0;
2642ee67178SXianjun Jiao 			ant_sel=1;
2652ee67178SXianjun Jiao 			break;
2662ee67178SXianjun Jiao 
2672ee67178SXianjun Jiao 		case TX_INTF_BW_20MHZ_AT_N_10MHZ_ANT0:
2682ee67178SXianjun Jiao 			printk("%s hw_init mode TX_INTF_BW_20MHZ_AT_N_10MHZ_ANT0\n", tx_intf_compatible_str);
2692ee67178SXianjun Jiao 			mixer_cfg = 0x2001F602;
2702ee67178SXianjun Jiao 			duc_input_ch_sel = 0;
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 			duc_input_ch_sel = 0;
2782ee67178SXianjun Jiao 			ant_sel=1;
2792ee67178SXianjun Jiao 			break;
2802ee67178SXianjun Jiao 
2812ee67178SXianjun Jiao 		case TX_INTF_BW_20MHZ_AT_0MHZ_ANT1:
2822ee67178SXianjun Jiao 			printk("%s hw_init mode TX_INTF_BW_20MHZ_AT_0MHZ_ANT1\n", tx_intf_compatible_str);
2832ee67178SXianjun Jiao 			mixer_cfg = 0x2001F400;
2842ee67178SXianjun Jiao 			duc_input_ch_sel = 0;
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 			duc_input_ch_sel = 0;
2922ee67178SXianjun Jiao 			ant_sel=2;
2932ee67178SXianjun Jiao 			break;
2942ee67178SXianjun Jiao 
2952ee67178SXianjun Jiao 		case TX_INTF_BW_20MHZ_AT_P_10MHZ_ANT1:
2962ee67178SXianjun Jiao 			printk("%s hw_init mode TX_INTF_BW_20MHZ_AT_P_10MHZ_ANT1\n", tx_intf_compatible_str);
2972ee67178SXianjun Jiao 			mixer_cfg = 0x200202F6;
2982ee67178SXianjun Jiao 			duc_input_ch_sel = 0;
2992ee67178SXianjun Jiao 			ant_sel=2;
3002ee67178SXianjun Jiao 			break;
3012ee67178SXianjun Jiao 
3022ee67178SXianjun Jiao 		case TX_INTF_BYPASS:
3032ee67178SXianjun Jiao 			printk("%s hw_init mode TX_INTF_BYPASS\n", tx_intf_compatible_str);
3042ee67178SXianjun Jiao 			mixer_cfg = 0x200202F6;
3052ee67178SXianjun Jiao 			duc_input_ch_sel = 0;
3062ee67178SXianjun Jiao 			ant_sel=2;
3072ee67178SXianjun Jiao 			break;
3082ee67178SXianjun Jiao 
3092ee67178SXianjun Jiao 		default:
3102ee67178SXianjun Jiao 			printk("%s hw_init mode %d is wrong!\n", tx_intf_compatible_str, mode);
3112ee67178SXianjun Jiao 			err=1;
3122ee67178SXianjun Jiao 	}
3132ee67178SXianjun Jiao 
3142ee67178SXianjun Jiao 	if (mode!=TX_INTF_AXIS_LOOP_BACK) {
3152ee67178SXianjun Jiao 		tx_intf_api->TX_INTF_REG_MISC_SEL_write(1<<1);// bit1: 0-connect dac to ADI dma; 1-connect dac to our intf
3162ee67178SXianjun Jiao 
3172ee67178SXianjun Jiao 		tx_intf_api->TX_INTF_REG_MIXER_CFG_write(mixer_cfg);
3182ee67178SXianjun Jiao 		tx_intf_api->TX_INTF_REG_MULTI_RST_write(0);
3192ee67178SXianjun Jiao 		tx_intf_api->TX_INTF_REG_IQ_SRC_SEL_write(duc_input_ch_sel);
320d14d06e5SXianjun Jiao 		tx_intf_api->TX_INTF_REG_CSI_FUZZER_write(0);
321febc5adfSXianjun 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
3222ee67178SXianjun Jiao 
323f738aefaSmmehari 		tx_intf_api->TX_INTF_REG_TX_CONFIG_write(tx_config);
3242ee67178SXianjun Jiao 		tx_intf_api->TX_INTF_REG_NUM_DMA_SYMBOL_TO_PS_write(num_dma_symbol_to_ps);
3252ee67178SXianjun Jiao 		tx_intf_api->TX_INTF_REG_CFG_DATA_TO_ANT_write(0);
326febc5adfSXianjun Jiao 		tx_intf_api->TX_INTF_REG_TX_HOLD_THRESHOLD_write(420);
32722dd0cc4SXianjun 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
32822dd0cc4SXianjun Jiao 		tx_intf_api->TX_INTF_REG_INTERRUPT_SEL_write(0x30004); //disable interrupt
329b73660adSXianjun Jiao 		tx_intf_api->TX_INTF_REG_BB_GAIN_write(100);
3302ee67178SXianjun Jiao 		tx_intf_api->TX_INTF_REG_ANT_SEL_write(ant_sel);
3312ee67178SXianjun Jiao 		tx_intf_api->TX_INTF_REG_WIFI_TX_MODE_write((1<<3)|(2<<4));
3322ee67178SXianjun Jiao 		tx_intf_api->TX_INTF_REG_MULTI_RST_write(0x434);
3332ee67178SXianjun Jiao 		tx_intf_api->TX_INTF_REG_MULTI_RST_write(0);
3342ee67178SXianjun Jiao 	}
3352ee67178SXianjun Jiao 
3362ee67178SXianjun Jiao 	if (mode == TX_INTF_BYPASS) {
3372ee67178SXianjun Jiao 		tx_intf_api->TX_INTF_REG_CFG_DATA_TO_ANT_write(0x100); //slv_reg10[8]
3382ee67178SXianjun Jiao 	}
3392ee67178SXianjun Jiao 
3402ee67178SXianjun Jiao 	printk("%s hw_init err %d\n", tx_intf_compatible_str, err);
3412ee67178SXianjun Jiao 	return(err);
3422ee67178SXianjun Jiao }
3432ee67178SXianjun Jiao 
3442ee67178SXianjun Jiao static int dev_probe(struct platform_device *pdev)
3452ee67178SXianjun Jiao {
3462ee67178SXianjun Jiao 	struct device_node *np = pdev->dev.of_node;
3472ee67178SXianjun Jiao 	struct resource *io;
3482ee67178SXianjun Jiao 	int err=1;
3492ee67178SXianjun Jiao 
3502ee67178SXianjun Jiao 	printk("\n");
3512ee67178SXianjun Jiao 
3522ee67178SXianjun Jiao 	if (np) {
3532ee67178SXianjun Jiao 		const struct of_device_id *match;
3542ee67178SXianjun Jiao 
3552ee67178SXianjun Jiao 		match = of_match_node(dev_of_ids, np);
3562ee67178SXianjun Jiao 		if (match) {
3572ee67178SXianjun Jiao 			printk("%s dev_probe match!\n", tx_intf_compatible_str);
3582ee67178SXianjun Jiao 			err = 0;
3592ee67178SXianjun Jiao 		}
3602ee67178SXianjun Jiao 	}
3612ee67178SXianjun Jiao 
3622ee67178SXianjun Jiao 	if (err)
3632ee67178SXianjun Jiao 		return err;
3642ee67178SXianjun Jiao 
3652ee67178SXianjun Jiao 	tx_intf_api->hw_init=hw_init;
3662ee67178SXianjun Jiao 
3672ee67178SXianjun Jiao 	tx_intf_api->reg_read=reg_read;
3682ee67178SXianjun Jiao 	tx_intf_api->reg_write=reg_write;
3692ee67178SXianjun Jiao 
3702ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_MULTI_RST_read=TX_INTF_REG_MULTI_RST_read;
3712ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_MIXER_CFG_read=TX_INTF_REG_MIXER_CFG_read;
3722ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_WIFI_TX_MODE_read=TX_INTF_REG_WIFI_TX_MODE_read;
3732ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_IQ_SRC_SEL_read=TX_INTF_REG_IQ_SRC_SEL_read;
3742ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_CTS_TOSELF_CONFIG_read=TX_INTF_REG_CTS_TOSELF_CONFIG_read;
375d14d06e5SXianjun Jiao 	tx_intf_api->TX_INTF_REG_CSI_FUZZER_read=TX_INTF_REG_CSI_FUZZER_read;
3762ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_CTS_TOSELF_WAIT_SIFS_TOP_read=TX_INTF_REG_CTS_TOSELF_WAIT_SIFS_TOP_read;
3772ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_MISC_SEL_read=TX_INTF_REG_MISC_SEL_read;
378f738aefaSmmehari 	tx_intf_api->TX_INTF_REG_TX_CONFIG_read=TX_INTF_REG_TX_CONFIG_read;
3792ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_NUM_DMA_SYMBOL_TO_PS_read=TX_INTF_REG_NUM_DMA_SYMBOL_TO_PS_read;
3802ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_CFG_DATA_TO_ANT_read=TX_INTF_REG_CFG_DATA_TO_ANT_read;
381838a9007SXianjun Jiao 	tx_intf_api->TX_INTF_REG_S_AXIS_FIFO_TH_read=TX_INTF_REG_S_AXIS_FIFO_TH_read;
382febc5adfSXianjun Jiao 	tx_intf_api->TX_INTF_REG_TX_HOLD_THRESHOLD_read=TX_INTF_REG_TX_HOLD_THRESHOLD_read;
3832ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_INTERRUPT_SEL_read=TX_INTF_REG_INTERRUPT_SEL_read;
384f738aefaSmmehari 	tx_intf_api->TX_INTF_REG_AMPDU_ACTION_CONFIG_read=TX_INTF_REG_AMPDU_ACTION_CONFIG_read;
3852ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_BB_GAIN_read=TX_INTF_REG_BB_GAIN_read;
3862ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_ANT_SEL_read=TX_INTF_REG_ANT_SEL_read;
387f738aefaSmmehari 	tx_intf_api->TX_INTF_REG_PHY_HDR_CONFIG_read=TX_INTF_REG_PHY_HDR_CONFIG_read;
388838a9007SXianjun Jiao 	tx_intf_api->TX_INTF_REG_S_AXIS_FIFO_NO_ROOM_read=TX_INTF_REG_S_AXIS_FIFO_NO_ROOM_read;
389*2d12c07dSmmehari 	tx_intf_api->TX_INTF_REG_PKT_INFO1_read=TX_INTF_REG_PKT_INFO1_read;
390*2d12c07dSmmehari 	tx_intf_api->TX_INTF_REG_PKT_INFO2_read=TX_INTF_REG_PKT_INFO2_read;
391*2d12c07dSmmehari 	tx_intf_api->TX_INTF_REG_PKT_INFO3_read=TX_INTF_REG_PKT_INFO3_read;
392*2d12c07dSmmehari 	tx_intf_api->TX_INTF_REG_PKT_INFO4_read=TX_INTF_REG_PKT_INFO4_read;
3932ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_QUEUE_FIFO_DATA_COUNT_read=TX_INTF_REG_QUEUE_FIFO_DATA_COUNT_read;
3942ee67178SXianjun Jiao 
3952ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_MULTI_RST_write=TX_INTF_REG_MULTI_RST_write;
3962ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_MIXER_CFG_write=TX_INTF_REG_MIXER_CFG_write;
3972ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_WIFI_TX_MODE_write=TX_INTF_REG_WIFI_TX_MODE_write;
3982ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_IQ_SRC_SEL_write=TX_INTF_REG_IQ_SRC_SEL_write;
3992ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_CTS_TOSELF_CONFIG_write=TX_INTF_REG_CTS_TOSELF_CONFIG_write;
400d14d06e5SXianjun Jiao 	tx_intf_api->TX_INTF_REG_CSI_FUZZER_write=TX_INTF_REG_CSI_FUZZER_write;
4012ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_CTS_TOSELF_WAIT_SIFS_TOP_write=TX_INTF_REG_CTS_TOSELF_WAIT_SIFS_TOP_write;
4022ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_MISC_SEL_write=TX_INTF_REG_MISC_SEL_write;
403f738aefaSmmehari 	tx_intf_api->TX_INTF_REG_TX_CONFIG_write=TX_INTF_REG_TX_CONFIG_write;
4042ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_NUM_DMA_SYMBOL_TO_PS_write=TX_INTF_REG_NUM_DMA_SYMBOL_TO_PS_write;
4052ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_CFG_DATA_TO_ANT_write=TX_INTF_REG_CFG_DATA_TO_ANT_write;
406838a9007SXianjun Jiao 	tx_intf_api->TX_INTF_REG_S_AXIS_FIFO_TH_write=TX_INTF_REG_S_AXIS_FIFO_TH_write;
407febc5adfSXianjun Jiao 	tx_intf_api->TX_INTF_REG_TX_HOLD_THRESHOLD_write=TX_INTF_REG_TX_HOLD_THRESHOLD_write;
4082ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_INTERRUPT_SEL_write=TX_INTF_REG_INTERRUPT_SEL_write;
409f738aefaSmmehari 	tx_intf_api->TX_INTF_REG_AMPDU_ACTION_CONFIG_write=TX_INTF_REG_AMPDU_ACTION_CONFIG_write;
4102ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_BB_GAIN_write=TX_INTF_REG_BB_GAIN_write;
4112ee67178SXianjun Jiao 	tx_intf_api->TX_INTF_REG_ANT_SEL_write=TX_INTF_REG_ANT_SEL_write;
412f738aefaSmmehari 	tx_intf_api->TX_INTF_REG_PHY_HDR_CONFIG_write=TX_INTF_REG_PHY_HDR_CONFIG_write;
413838a9007SXianjun Jiao 	tx_intf_api->TX_INTF_REG_S_AXIS_FIFO_NO_ROOM_write=TX_INTF_REG_S_AXIS_FIFO_NO_ROOM_write;
414*2d12c07dSmmehari 	tx_intf_api->TX_INTF_REG_PKT_INFO1_write=TX_INTF_REG_PKT_INFO1_write;
415*2d12c07dSmmehari 	tx_intf_api->TX_INTF_REG_PKT_INFO2_write=TX_INTF_REG_PKT_INFO2_write;
416*2d12c07dSmmehari 	tx_intf_api->TX_INTF_REG_PKT_INFO3_write=TX_INTF_REG_PKT_INFO3_write;
417*2d12c07dSmmehari 	tx_intf_api->TX_INTF_REG_PKT_INFO4_write=TX_INTF_REG_PKT_INFO4_write;
4182ee67178SXianjun Jiao 
4192ee67178SXianjun Jiao 	/* Request and map I/O memory */
4202ee67178SXianjun Jiao 	io = platform_get_resource(pdev, IORESOURCE_MEM, 0);
4212ee67178SXianjun Jiao 	base_addr = devm_ioremap_resource(&pdev->dev, io);
4222ee67178SXianjun Jiao 	if (IS_ERR(base_addr))
4232ee67178SXianjun Jiao 		return PTR_ERR(base_addr);
4242ee67178SXianjun Jiao 
425*2d12c07dSmmehari 	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);
426febc5adfSXianjun Jiao 	printk("%s dev_probe base_addr 0x%p\n", tx_intf_compatible_str,(void*)base_addr);
427febc5adfSXianjun Jiao 	printk("%s dev_probe tx_intf_driver_api_inst 0x%p\n", tx_intf_compatible_str, (void*)(&tx_intf_driver_api_inst) );
428febc5adfSXianjun Jiao 	printk("%s dev_probe             tx_intf_api 0x%p\n", tx_intf_compatible_str, (void*)tx_intf_api);
4292ee67178SXianjun Jiao 
4302ee67178SXianjun Jiao 	printk("%s dev_probe succeed!\n", tx_intf_compatible_str);
4312ee67178SXianjun Jiao 
432*2d12c07dSmmehari 	//err = hw_init(TX_INTF_BW_20MHZ_AT_P_10MHZ_ANT1, 8, 8);
433*2d12c07dSmmehari 	//err = hw_init(TX_INTF_BYPASS, 8, 8);
434*2d12c07dSmmehari 	err = hw_init(TX_INTF_BW_20MHZ_AT_N_10MHZ_ANT1, 8, 8); // make sure dac is connected to original ad9361 dma
4352ee67178SXianjun Jiao 
4362ee67178SXianjun Jiao 	return err;
4372ee67178SXianjun Jiao }
4382ee67178SXianjun Jiao 
4392ee67178SXianjun Jiao static int dev_remove(struct platform_device *pdev)
4402ee67178SXianjun Jiao {
4412ee67178SXianjun Jiao 	printk("\n");
4422ee67178SXianjun Jiao 
443febc5adfSXianjun Jiao 	printk("%s dev_remove base_addr 0x%p\n", tx_intf_compatible_str,(void*)base_addr);
444febc5adfSXianjun Jiao 	printk("%s dev_remove tx_intf_driver_api_inst 0x%p\n", tx_intf_compatible_str, (void*)(&tx_intf_driver_api_inst) );
445febc5adfSXianjun Jiao 	printk("%s dev_remove             tx_intf_api 0x%p\n", tx_intf_compatible_str, (void*)tx_intf_api);
4462ee67178SXianjun Jiao 
4472ee67178SXianjun Jiao 	printk("%s dev_remove succeed!\n", tx_intf_compatible_str);
4482ee67178SXianjun Jiao 	return 0;
4492ee67178SXianjun Jiao }
4502ee67178SXianjun Jiao 
4512ee67178SXianjun Jiao static struct platform_driver dev_driver = {
4522ee67178SXianjun Jiao 	.driver = {
4532ee67178SXianjun Jiao 		.name = "sdr,tx_intf",
4542ee67178SXianjun Jiao 		.owner = THIS_MODULE,
4552ee67178SXianjun Jiao 		.of_match_table = dev_of_ids,
4562ee67178SXianjun Jiao 	},
4572ee67178SXianjun Jiao 	.probe = dev_probe,
4582ee67178SXianjun Jiao 	.remove = dev_remove,
4592ee67178SXianjun Jiao };
4602ee67178SXianjun Jiao 
4612ee67178SXianjun Jiao module_platform_driver(dev_driver);
4622ee67178SXianjun Jiao 
4632ee67178SXianjun Jiao MODULE_AUTHOR("Xianjun Jiao");
4642ee67178SXianjun Jiao MODULE_DESCRIPTION("sdr,tx_intf");
4652ee67178SXianjun Jiao MODULE_LICENSE("GPL v2");
466