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 24654c67c7aSXianjun Jiao // tx_intf_api->TX_INTF_REG_S_AXIS_FIFO_TH_write(8192-(210*5)); // threshold is for room to hold the last 4 packets from 4 queue before stop 24754c67c7aSXianjun Jiao tx_intf_api->TX_INTF_REG_S_AXIS_FIFO_TH_write(8192-(210*2)); 2480c0d5d82Smmehari else if(fpga_type == SMALL_FPGA) // SMALL FPGA: MAX_NUM_DMA_SYMBOL = 4096 24954c67c7aSXianjun Jiao // tx_intf_api->TX_INTF_REG_S_AXIS_FIFO_TH_write(4096-(210*5)); // threshold is for room to hold the last 4 packets from 4 queue before stop 25054c67c7aSXianjun Jiao tx_intf_api->TX_INTF_REG_S_AXIS_FIFO_TH_write(4096-(210*2)); 2510c0d5d82Smmehari 2522ee67178SXianjun Jiao switch(mode) 2532ee67178SXianjun Jiao { 2542ee67178SXianjun Jiao case TX_INTF_AXIS_LOOP_BACK: 2552ee67178SXianjun Jiao printk("%s hw_init mode TX_INTF_AXIS_LOOP_BACK\n", tx_intf_compatible_str); 2562ee67178SXianjun Jiao break; 2572ee67178SXianjun Jiao 2582ee67178SXianjun Jiao case TX_INTF_BW_20MHZ_AT_0MHZ_ANT0: 2592ee67178SXianjun Jiao printk("%s hw_init mode TX_INTF_BW_20MHZ_AT_0MHZ_ANT0\n", tx_intf_compatible_str); 2602ee67178SXianjun Jiao mixer_cfg = 0x2001F400; 2612ee67178SXianjun Jiao ant_sel=1; 2622ee67178SXianjun Jiao break; 2632ee67178SXianjun Jiao 264469b96d3SXianjun Jiao case TX_INTF_BW_20MHZ_AT_0MHZ_ANT_BOTH: 265*849c3b5eSXianjun Jiao printk("%s hw_init mode TX_INTF_BW_20MHZ_AT_0MHZ_ANT_BOTH\n", tx_intf_compatible_str); 266469b96d3SXianjun Jiao mixer_cfg = 0x2001F400; 267469b96d3SXianjun Jiao ant_sel=0x11; 268469b96d3SXianjun Jiao break; 269469b96d3SXianjun Jiao 2702ee67178SXianjun Jiao case TX_INTF_BW_20MHZ_AT_N_10MHZ_ANT0: 2712ee67178SXianjun Jiao printk("%s hw_init mode TX_INTF_BW_20MHZ_AT_N_10MHZ_ANT0\n", tx_intf_compatible_str); 2722ee67178SXianjun Jiao mixer_cfg = 0x2001F602; 2732ee67178SXianjun Jiao ant_sel=1; 2742ee67178SXianjun Jiao break; 2752ee67178SXianjun Jiao 2762ee67178SXianjun Jiao case TX_INTF_BW_20MHZ_AT_P_10MHZ_ANT0: 2772ee67178SXianjun Jiao printk("%s hw_init mode TX_INTF_BW_20MHZ_AT_P_10MHZ_ANT0\n", tx_intf_compatible_str); 2782ee67178SXianjun Jiao mixer_cfg = 0x200202F6; 2792ee67178SXianjun Jiao ant_sel=1; 2802ee67178SXianjun Jiao break; 2812ee67178SXianjun Jiao 2822ee67178SXianjun Jiao case TX_INTF_BW_20MHZ_AT_0MHZ_ANT1: 2832ee67178SXianjun Jiao printk("%s hw_init mode TX_INTF_BW_20MHZ_AT_0MHZ_ANT1\n", tx_intf_compatible_str); 2842ee67178SXianjun Jiao mixer_cfg = 0x2001F400; 2852ee67178SXianjun Jiao ant_sel=2; 2862ee67178SXianjun Jiao break; 2872ee67178SXianjun Jiao 2882ee67178SXianjun Jiao case TX_INTF_BW_20MHZ_AT_N_10MHZ_ANT1: 2892ee67178SXianjun Jiao printk("%s hw_init mode TX_INTF_BW_20MHZ_AT_N_10MHZ_ANT1\n", tx_intf_compatible_str); 2902ee67178SXianjun Jiao mixer_cfg = 0x2001F602; 2912ee67178SXianjun Jiao ant_sel=2; 2922ee67178SXianjun Jiao break; 2932ee67178SXianjun Jiao 2942ee67178SXianjun Jiao case TX_INTF_BW_20MHZ_AT_P_10MHZ_ANT1: 2952ee67178SXianjun Jiao printk("%s hw_init mode TX_INTF_BW_20MHZ_AT_P_10MHZ_ANT1\n", tx_intf_compatible_str); 2962ee67178SXianjun Jiao mixer_cfg = 0x200202F6; 2972ee67178SXianjun Jiao ant_sel=2; 2982ee67178SXianjun Jiao break; 2992ee67178SXianjun Jiao 3002ee67178SXianjun Jiao case TX_INTF_BYPASS: 3012ee67178SXianjun Jiao printk("%s hw_init mode TX_INTF_BYPASS\n", tx_intf_compatible_str); 3022ee67178SXianjun Jiao mixer_cfg = 0x200202F6; 3032ee67178SXianjun Jiao ant_sel=2; 3042ee67178SXianjun Jiao break; 3052ee67178SXianjun Jiao 3062ee67178SXianjun Jiao default: 3072ee67178SXianjun Jiao printk("%s hw_init mode %d is wrong!\n", tx_intf_compatible_str, mode); 3082ee67178SXianjun Jiao err=1; 3092ee67178SXianjun Jiao } 3102ee67178SXianjun Jiao 3112ee67178SXianjun Jiao if (mode!=TX_INTF_AXIS_LOOP_BACK) { 3122ee67178SXianjun Jiao tx_intf_api->TX_INTF_REG_MULTI_RST_write(0); 313d14d06e5SXianjun Jiao tx_intf_api->TX_INTF_REG_CSI_FUZZER_write(0); 314d4c3d810SXianjun Jiao tx_intf_api->TX_INTF_REG_CTS_TOSELF_WAIT_SIFS_TOP_write( ((16*10)<<16)|(16*10) );//high 16bit 5GHz; low 16 bit 2.4GHz. counter speed 10MHz is assumed 3152ee67178SXianjun Jiao 316f738aefaSmmehari tx_intf_api->TX_INTF_REG_TX_CONFIG_write(tx_config); 3172ee67178SXianjun Jiao tx_intf_api->TX_INTF_REG_NUM_DMA_SYMBOL_TO_PS_write(num_dma_symbol_to_ps); 3182ee67178SXianjun Jiao tx_intf_api->TX_INTF_REG_CFG_DATA_TO_ANT_write(0); 319febc5adfSXianjun Jiao tx_intf_api->TX_INTF_REG_TX_HOLD_THRESHOLD_write(420); 32022dd0cc4SXianjun Jiao tx_intf_api->TX_INTF_REG_INTERRUPT_SEL_write(0x4); //.src_sel(slv_reg14[2:0]), 0-s00_axis_tlast,1-ap_start,2-tx_start_from_acc,3-tx_end_from_acc,4-tx_try_complete from xpu 32122dd0cc4SXianjun Jiao tx_intf_api->TX_INTF_REG_INTERRUPT_SEL_write(0x30004); //disable interrupt 3220cbb6873SXianjun Jiao 3230cbb6873SXianjun Jiao // tx_intf_api->TX_INTF_REG_BB_GAIN_write(100); // value for old design with DUC (FIR + MIXER) -- obsolete due to DUC removal 3240cbb6873SXianjun Jiao // New test on new design (unified RF BB clock; No DUC) 3250cbb6873SXianjun Jiao // 5220MHz bb_gain power EVM 3260cbb6873SXianjun Jiao // 400 -6dBm -34/35 3270cbb6873SXianjun Jiao // 350 -7.2dBm -34/35/36 3280cbb6873SXianjun Jiao // 300 -8.5dBm -35/36/37 EVM 3290cbb6873SXianjun Jiao 3300cbb6873SXianjun Jiao // 2437MHz bb_gain power EVM 3310cbb6873SXianjun Jiao // 400 -3.2dBm -36/37 3320cbb6873SXianjun Jiao // 350 -4.4dBm -37/38/39 3330cbb6873SXianjun Jiao // 300 -5.7dBm -39/40 3340cbb6873SXianjun Jiao // less less -40/41/42! 3350cbb6873SXianjun Jiao 3360cbb6873SXianjun Jiao // According to above and more detailed test: 3370cbb6873SXianjun Jiao // Need to be 290. Otherwise some ofdm symbol's EVM jump high, when there are lots of ofdm symbols in one WiFi packet 3380cbb6873SXianjun Jiao 3390cbb6873SXianjun Jiao // 2022-03-04 detailed test result: 3400cbb6873SXianjun Jiao // bb_gain 290 work for 11a/g all mcs 3410cbb6873SXianjun Jiao // bb_gain 290 work for 11n mcs 1~7 (aggr and non aggr) 3420cbb6873SXianjun Jiao // bb_gain 290 destroy 11n mcs 0 long (MTU 1500) tx pkt due to high PAPR (Peak to Average Power Ratio)! 3430cbb6873SXianjun Jiao // bb_gain 250 work for 11n mcs 0 3440cbb6873SXianjun Jiao // So, a conservative bb_gain 250 should be used 3450cbb6873SXianjun Jiao tx_intf_api->TX_INTF_REG_BB_GAIN_write(250); 3460cbb6873SXianjun Jiao 3472ee67178SXianjun Jiao tx_intf_api->TX_INTF_REG_ANT_SEL_write(ant_sel); 3482ee67178SXianjun Jiao tx_intf_api->TX_INTF_REG_WIFI_TX_MODE_write((1<<3)|(2<<4)); 3492ee67178SXianjun Jiao tx_intf_api->TX_INTF_REG_MULTI_RST_write(0x434); 3502ee67178SXianjun Jiao tx_intf_api->TX_INTF_REG_MULTI_RST_write(0); 3512ee67178SXianjun Jiao } 3522ee67178SXianjun Jiao 35375d924e0SXianjun Jiao // if (mode == TX_INTF_BYPASS) { 35475d924e0SXianjun Jiao // tx_intf_api->TX_INTF_REG_CFG_DATA_TO_ANT_write(0x100); //slv_reg10[8] -- bit 8 not used anymore. only bit0/1 are still reserved. 35575d924e0SXianjun Jiao // } 3562ee67178SXianjun Jiao 3572ee67178SXianjun Jiao printk("%s hw_init err %d\n", tx_intf_compatible_str, err); 3582ee67178SXianjun Jiao return(err); 3592ee67178SXianjun Jiao } 3602ee67178SXianjun Jiao 3612ee67178SXianjun Jiao static int dev_probe(struct platform_device *pdev) 3622ee67178SXianjun Jiao { 3632ee67178SXianjun Jiao struct device_node *np = pdev->dev.of_node; 3642ee67178SXianjun Jiao struct resource *io; 3652ee67178SXianjun Jiao int err=1; 3662ee67178SXianjun Jiao 3672ee67178SXianjun Jiao printk("\n"); 3682ee67178SXianjun Jiao 3692ee67178SXianjun Jiao if (np) { 3702ee67178SXianjun Jiao const struct of_device_id *match; 3712ee67178SXianjun Jiao 3722ee67178SXianjun Jiao match = of_match_node(dev_of_ids, np); 3732ee67178SXianjun Jiao if (match) { 3742ee67178SXianjun Jiao printk("%s dev_probe match!\n", tx_intf_compatible_str); 3752ee67178SXianjun Jiao err = 0; 3762ee67178SXianjun Jiao } 3772ee67178SXianjun Jiao } 3782ee67178SXianjun Jiao 3792ee67178SXianjun Jiao if (err) 3802ee67178SXianjun Jiao return err; 3812ee67178SXianjun Jiao 3822ee67178SXianjun Jiao tx_intf_api->hw_init=hw_init; 3832ee67178SXianjun Jiao 3842ee67178SXianjun Jiao tx_intf_api->reg_read=reg_read; 3852ee67178SXianjun Jiao tx_intf_api->reg_write=reg_write; 3862ee67178SXianjun Jiao 3872ee67178SXianjun Jiao tx_intf_api->TX_INTF_REG_MULTI_RST_read=TX_INTF_REG_MULTI_RST_read; 388469b96d3SXianjun Jiao tx_intf_api->TX_INTF_REG_ARBITRARY_IQ_read=TX_INTF_REG_ARBITRARY_IQ_read; 3892ee67178SXianjun Jiao tx_intf_api->TX_INTF_REG_WIFI_TX_MODE_read=TX_INTF_REG_WIFI_TX_MODE_read; 3902ee67178SXianjun Jiao tx_intf_api->TX_INTF_REG_CTS_TOSELF_CONFIG_read=TX_INTF_REG_CTS_TOSELF_CONFIG_read; 391d14d06e5SXianjun Jiao tx_intf_api->TX_INTF_REG_CSI_FUZZER_read=TX_INTF_REG_CSI_FUZZER_read; 3922ee67178SXianjun Jiao tx_intf_api->TX_INTF_REG_CTS_TOSELF_WAIT_SIFS_TOP_read=TX_INTF_REG_CTS_TOSELF_WAIT_SIFS_TOP_read; 393469b96d3SXianjun Jiao tx_intf_api->TX_INTF_REG_ARBITRARY_IQ_CTL_read=TX_INTF_REG_ARBITRARY_IQ_CTL_read; 394f738aefaSmmehari tx_intf_api->TX_INTF_REG_TX_CONFIG_read=TX_INTF_REG_TX_CONFIG_read; 3952ee67178SXianjun Jiao tx_intf_api->TX_INTF_REG_NUM_DMA_SYMBOL_TO_PS_read=TX_INTF_REG_NUM_DMA_SYMBOL_TO_PS_read; 3962ee67178SXianjun Jiao tx_intf_api->TX_INTF_REG_CFG_DATA_TO_ANT_read=TX_INTF_REG_CFG_DATA_TO_ANT_read; 397838a9007SXianjun Jiao tx_intf_api->TX_INTF_REG_S_AXIS_FIFO_TH_read=TX_INTF_REG_S_AXIS_FIFO_TH_read; 398febc5adfSXianjun Jiao tx_intf_api->TX_INTF_REG_TX_HOLD_THRESHOLD_read=TX_INTF_REG_TX_HOLD_THRESHOLD_read; 3992ee67178SXianjun Jiao tx_intf_api->TX_INTF_REG_INTERRUPT_SEL_read=TX_INTF_REG_INTERRUPT_SEL_read; 400f738aefaSmmehari tx_intf_api->TX_INTF_REG_AMPDU_ACTION_CONFIG_read=TX_INTF_REG_AMPDU_ACTION_CONFIG_read; 4012ee67178SXianjun Jiao tx_intf_api->TX_INTF_REG_BB_GAIN_read=TX_INTF_REG_BB_GAIN_read; 4022ee67178SXianjun Jiao tx_intf_api->TX_INTF_REG_ANT_SEL_read=TX_INTF_REG_ANT_SEL_read; 403f738aefaSmmehari tx_intf_api->TX_INTF_REG_PHY_HDR_CONFIG_read=TX_INTF_REG_PHY_HDR_CONFIG_read; 404838a9007SXianjun Jiao tx_intf_api->TX_INTF_REG_S_AXIS_FIFO_NO_ROOM_read=TX_INTF_REG_S_AXIS_FIFO_NO_ROOM_read; 4052d12c07dSmmehari tx_intf_api->TX_INTF_REG_PKT_INFO1_read=TX_INTF_REG_PKT_INFO1_read; 4062d12c07dSmmehari tx_intf_api->TX_INTF_REG_PKT_INFO2_read=TX_INTF_REG_PKT_INFO2_read; 4072d12c07dSmmehari tx_intf_api->TX_INTF_REG_PKT_INFO3_read=TX_INTF_REG_PKT_INFO3_read; 4082d12c07dSmmehari tx_intf_api->TX_INTF_REG_PKT_INFO4_read=TX_INTF_REG_PKT_INFO4_read; 4092ee67178SXianjun Jiao tx_intf_api->TX_INTF_REG_QUEUE_FIFO_DATA_COUNT_read=TX_INTF_REG_QUEUE_FIFO_DATA_COUNT_read; 4102ee67178SXianjun Jiao 4112ee67178SXianjun Jiao tx_intf_api->TX_INTF_REG_MULTI_RST_write=TX_INTF_REG_MULTI_RST_write; 412469b96d3SXianjun Jiao tx_intf_api->TX_INTF_REG_ARBITRARY_IQ_write=TX_INTF_REG_ARBITRARY_IQ_write; 4132ee67178SXianjun Jiao tx_intf_api->TX_INTF_REG_WIFI_TX_MODE_write=TX_INTF_REG_WIFI_TX_MODE_write; 4142ee67178SXianjun Jiao tx_intf_api->TX_INTF_REG_CTS_TOSELF_CONFIG_write=TX_INTF_REG_CTS_TOSELF_CONFIG_write; 415d14d06e5SXianjun Jiao tx_intf_api->TX_INTF_REG_CSI_FUZZER_write=TX_INTF_REG_CSI_FUZZER_write; 4162ee67178SXianjun Jiao tx_intf_api->TX_INTF_REG_CTS_TOSELF_WAIT_SIFS_TOP_write=TX_INTF_REG_CTS_TOSELF_WAIT_SIFS_TOP_write; 417469b96d3SXianjun Jiao tx_intf_api->TX_INTF_REG_ARBITRARY_IQ_CTL_write=TX_INTF_REG_ARBITRARY_IQ_CTL_write; 418f738aefaSmmehari tx_intf_api->TX_INTF_REG_TX_CONFIG_write=TX_INTF_REG_TX_CONFIG_write; 4192ee67178SXianjun Jiao tx_intf_api->TX_INTF_REG_NUM_DMA_SYMBOL_TO_PS_write=TX_INTF_REG_NUM_DMA_SYMBOL_TO_PS_write; 4202ee67178SXianjun Jiao tx_intf_api->TX_INTF_REG_CFG_DATA_TO_ANT_write=TX_INTF_REG_CFG_DATA_TO_ANT_write; 421838a9007SXianjun Jiao tx_intf_api->TX_INTF_REG_S_AXIS_FIFO_TH_write=TX_INTF_REG_S_AXIS_FIFO_TH_write; 422febc5adfSXianjun Jiao tx_intf_api->TX_INTF_REG_TX_HOLD_THRESHOLD_write=TX_INTF_REG_TX_HOLD_THRESHOLD_write; 4232ee67178SXianjun Jiao tx_intf_api->TX_INTF_REG_INTERRUPT_SEL_write=TX_INTF_REG_INTERRUPT_SEL_write; 424f738aefaSmmehari tx_intf_api->TX_INTF_REG_AMPDU_ACTION_CONFIG_write=TX_INTF_REG_AMPDU_ACTION_CONFIG_write; 4252ee67178SXianjun Jiao tx_intf_api->TX_INTF_REG_BB_GAIN_write=TX_INTF_REG_BB_GAIN_write; 4262ee67178SXianjun Jiao tx_intf_api->TX_INTF_REG_ANT_SEL_write=TX_INTF_REG_ANT_SEL_write; 427f738aefaSmmehari tx_intf_api->TX_INTF_REG_PHY_HDR_CONFIG_write=TX_INTF_REG_PHY_HDR_CONFIG_write; 428838a9007SXianjun Jiao tx_intf_api->TX_INTF_REG_S_AXIS_FIFO_NO_ROOM_write=TX_INTF_REG_S_AXIS_FIFO_NO_ROOM_write; 4292d12c07dSmmehari tx_intf_api->TX_INTF_REG_PKT_INFO1_write=TX_INTF_REG_PKT_INFO1_write; 4302d12c07dSmmehari tx_intf_api->TX_INTF_REG_PKT_INFO2_write=TX_INTF_REG_PKT_INFO2_write; 4312d12c07dSmmehari tx_intf_api->TX_INTF_REG_PKT_INFO3_write=TX_INTF_REG_PKT_INFO3_write; 4322d12c07dSmmehari tx_intf_api->TX_INTF_REG_PKT_INFO4_write=TX_INTF_REG_PKT_INFO4_write; 4332ee67178SXianjun Jiao 4342ee67178SXianjun Jiao /* Request and map I/O memory */ 4352ee67178SXianjun Jiao io = platform_get_resource(pdev, IORESOURCE_MEM, 0); 4362ee67178SXianjun Jiao base_addr = devm_ioremap_resource(&pdev->dev, io); 4372ee67178SXianjun Jiao if (IS_ERR(base_addr)) 4382ee67178SXianjun Jiao return PTR_ERR(base_addr); 4392ee67178SXianjun Jiao 4402d12c07dSmmehari 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); 441febc5adfSXianjun Jiao printk("%s dev_probe base_addr 0x%p\n", tx_intf_compatible_str,(void*)base_addr); 442febc5adfSXianjun Jiao printk("%s dev_probe tx_intf_driver_api_inst 0x%p\n", tx_intf_compatible_str, (void*)(&tx_intf_driver_api_inst) ); 443febc5adfSXianjun Jiao printk("%s dev_probe tx_intf_api 0x%p\n", tx_intf_compatible_str, (void*)tx_intf_api); 4442ee67178SXianjun Jiao 4452ee67178SXianjun Jiao printk("%s dev_probe succeed!\n", tx_intf_compatible_str); 4462ee67178SXianjun Jiao 4470c0d5d82Smmehari //err = hw_init(TX_INTF_BW_20MHZ_AT_P_10MHZ_ANT1, 8, 8, SMALL_FPGA); 4480c0d5d82Smmehari //err = hw_init(TX_INTF_BYPASS, 8, 8, SMALL_FPGA); 4490c0d5d82Smmehari err = hw_init(TX_INTF_BW_20MHZ_AT_N_10MHZ_ANT1, 8, 8, SMALL_FPGA); // make sure dac is connected to original ad9361 dma 4502ee67178SXianjun Jiao 4512ee67178SXianjun Jiao return err; 4522ee67178SXianjun Jiao } 4532ee67178SXianjun Jiao 4542ee67178SXianjun Jiao static int dev_remove(struct platform_device *pdev) 4552ee67178SXianjun Jiao { 4562ee67178SXianjun Jiao printk("\n"); 4572ee67178SXianjun Jiao 458febc5adfSXianjun Jiao printk("%s dev_remove base_addr 0x%p\n", tx_intf_compatible_str,(void*)base_addr); 459febc5adfSXianjun Jiao printk("%s dev_remove tx_intf_driver_api_inst 0x%p\n", tx_intf_compatible_str, (void*)(&tx_intf_driver_api_inst) ); 460febc5adfSXianjun Jiao printk("%s dev_remove tx_intf_api 0x%p\n", tx_intf_compatible_str, (void*)tx_intf_api); 4612ee67178SXianjun Jiao 4622ee67178SXianjun Jiao printk("%s dev_remove succeed!\n", tx_intf_compatible_str); 4632ee67178SXianjun Jiao return 0; 4642ee67178SXianjun Jiao } 4652ee67178SXianjun Jiao 4662ee67178SXianjun Jiao static struct platform_driver dev_driver = { 4672ee67178SXianjun Jiao .driver = { 4682ee67178SXianjun Jiao .name = "sdr,tx_intf", 4692ee67178SXianjun Jiao .owner = THIS_MODULE, 4702ee67178SXianjun Jiao .of_match_table = dev_of_ids, 4712ee67178SXianjun Jiao }, 4722ee67178SXianjun Jiao .probe = dev_probe, 4732ee67178SXianjun Jiao .remove = dev_remove, 4742ee67178SXianjun Jiao }; 4752ee67178SXianjun Jiao 4762ee67178SXianjun Jiao module_platform_driver(dev_driver); 4772ee67178SXianjun Jiao 4782ee67178SXianjun Jiao MODULE_AUTHOR("Xianjun Jiao"); 4792ee67178SXianjun Jiao MODULE_DESCRIPTION("sdr,tx_intf"); 4802ee67178SXianjun Jiao MODULE_LICENSE("GPL v2"); 481