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