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