1 /* 2 * Copyright (c) 2016-2018 The Linux Foundation. All rights reserved. 3 * 4 * Permission to use, copy, modify, and/or distribute this software for 5 * any purpose with or without fee is hereby granted, provided that the 6 * above copyright notice and this permission notice appear in all 7 * copies. 8 * 9 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL 10 * WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED 11 * WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE 12 * AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL 13 * DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR 14 * PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER 15 * TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR 16 * PERFORMANCE OF THIS SOFTWARE. 17 */ 18 19 #include "tcl_data_cmd.h" 20 #include "mac_tcl_reg_seq_hwioreg.h" 21 #include "phyrx_rssi_legacy.h" 22 #include "hal_hw_headers.h" 23 #include "hal_internal.h" 24 #include "cdp_txrx_mon_struct.h" 25 #include "qdf_trace.h" 26 #include "hal_rx.h" 27 #include "hal_tx.h" 28 #include "dp_types.h" 29 #include "hal_api_mon.h" 30 31 /** 32 * hal_tx_desc_set_dscp_tid_table_id_6290() - Sets DSCP to TID conversion 33 * table ID 34 * @desc: Handle to Tx Descriptor 35 * @id: DSCP to tid conversion table to be used for this frame 36 * 37 * Return: void 38 */ 39 #if defined(QCA_WIFI_QCA6290_11AX) 40 static void hal_tx_desc_set_dscp_tid_table_id_6290(void *desc, 41 uint8_t id) 42 { 43 HAL_SET_FLD(desc, TCL_DATA_CMD_5, 44 DSCP_TID_TABLE_NUM) |= 45 HAL_TX_SM(TCL_DATA_CMD_5, 46 DSCP_TID_TABLE_NUM, id); 47 } 48 #else 49 #ifdef CONFIG_MCL 50 static void hal_tx_desc_set_dscp_tid_table_id_6290(void *desc, 51 uint8_t id) 52 { 53 HAL_SET_FLD(desc, TCL_DATA_CMD_3, 54 DSCP_TO_TID_PRIORITY_TABLE_ID) |= 55 HAL_TX_SM(TCL_DATA_CMD_3, 56 DSCP_TO_TID_PRIORITY_TABLE_ID, id); 57 } 58 #endif 59 #endif 60 61 62 #define DSCP_TID_TABLE_SIZE 24 63 #define NUM_WORDS_PER_DSCP_TID_TABLE (DSCP_TID_TABLE_SIZE / 4) 64 65 #if defined(QCA_WIFI_QCA6290_11AX) 66 /** 67 * hal_tx_set_dscp_tid_map_6290() - Configure default DSCP to TID map table 68 * @soc: HAL SoC context 69 * @map: DSCP-TID mapping table 70 * @id: mapping table ID - 0-31 71 * 72 * DSCP are mapped to 8 TID values using TID values programmed 73 * in any of the 32 DSCP_TID_MAPS (id = 0-31). 74 * 75 * Return: none 76 */ 77 static void hal_tx_set_dscp_tid_map_6290(void *hal_soc, uint8_t *map, 78 uint8_t id) 79 { 80 int i; 81 uint32_t addr, cmn_reg_addr; 82 uint32_t value = 0, regval; 83 uint8_t val[DSCP_TID_TABLE_SIZE], cnt = 0; 84 85 struct hal_soc *soc = (struct hal_soc *)hal_soc; 86 87 if (id >= HAL_MAX_HW_DSCP_TID_MAPS_11AX) 88 return; 89 90 cmn_reg_addr = HWIO_TCL_R0_CONS_RING_CMN_CTRL_REG_ADDR( 91 SEQ_WCSS_UMAC_MAC_TCL_REG_OFFSET); 92 93 addr = HWIO_TCL_R0_DSCP_TID_MAP_n_ADDR( 94 SEQ_WCSS_UMAC_MAC_TCL_REG_OFFSET, 95 id * NUM_WORDS_PER_DSCP_TID_TABLE); 96 97 /* Enable read/write access */ 98 regval = HAL_REG_READ(soc, cmn_reg_addr); 99 regval |= 100 (1 << HWIO_TCL_R0_CONS_RING_CMN_CTRL_REG_DSCP_TID_MAP_PROGRAM_EN_SHFT); 101 102 HAL_REG_WRITE(soc, cmn_reg_addr, regval); 103 104 /* Write 8 (24 bits) DSCP-TID mappings in each interation */ 105 for (i = 0; i < 64; i += 8) { 106 value = (map[i] | 107 (map[i + 1] << 0x3) | 108 (map[i + 2] << 0x6) | 109 (map[i + 3] << 0x9) | 110 (map[i + 4] << 0xc) | 111 (map[i + 5] << 0xf) | 112 (map[i + 6] << 0x12) | 113 (map[i + 7] << 0x15)); 114 115 qdf_mem_copy(&val[cnt], (void *)&value, 3); 116 cnt += 3; 117 } 118 119 for (i = 0; i < DSCP_TID_TABLE_SIZE; i += 4) { 120 regval = *(uint32_t *)(val + i); 121 HAL_REG_WRITE(soc, addr, 122 (regval & HWIO_TCL_R0_DSCP_TID_MAP_n_RMSK)); 123 addr += 4; 124 } 125 126 /* Diasble read/write access */ 127 regval = HAL_REG_READ(soc, cmn_reg_addr); 128 regval &= 129 ~(HWIO_TCL_R0_CONS_RING_CMN_CTRL_REG_DSCP_TID_MAP_PROGRAM_EN_BMSK); 130 131 HAL_REG_WRITE(soc, cmn_reg_addr, regval); 132 } 133 #else 134 static void hal_tx_set_dscp_tid_map_6290(void *hal_soc, uint8_t *map, 135 uint8_t id) 136 { 137 int i; 138 uint32_t addr; 139 uint32_t value; 140 141 struct hal_soc *soc = (struct hal_soc *)hal_soc; 142 143 if (id == HAL_TX_DSCP_TID_MAP_TABLE_DEFAULT) { 144 addr = 145 HWIO_TCL_R0_DSCP_TID1_MAP_0_ADDR( 146 SEQ_WCSS_UMAC_MAC_TCL_REG_OFFSET); 147 } else { 148 addr = 149 HWIO_TCL_R0_DSCP_TID2_MAP_0_ADDR( 150 SEQ_WCSS_UMAC_MAC_TCL_REG_OFFSET); 151 } 152 153 for (i = 0; i < 64; i += 10) { 154 value = (map[i] | 155 (map[i+1] << HWIO_TCL_R0_DSCP_TID1_MAP_0_DSCP_1_SHFT) | 156 (map[i+2] << HWIO_TCL_R0_DSCP_TID1_MAP_0_DSCP_2_SHFT) | 157 (map[i+3] << HWIO_TCL_R0_DSCP_TID1_MAP_0_DSCP_3_SHFT) | 158 (map[i+4] << HWIO_TCL_R0_DSCP_TID1_MAP_0_DSCP_4_SHFT) | 159 (map[i+5] << HWIO_TCL_R0_DSCP_TID1_MAP_0_DSCP_5_SHFT) | 160 (map[i+6] << HWIO_TCL_R0_DSCP_TID1_MAP_0_DSCP_6_SHFT) | 161 (map[i+7] << HWIO_TCL_R0_DSCP_TID1_MAP_0_DSCP_7_SHFT) | 162 (map[i+8] << HWIO_TCL_R0_DSCP_TID1_MAP_0_DSCP_8_SHFT) | 163 (map[i+9] << HWIO_TCL_R0_DSCP_TID1_MAP_0_DSCP_9_SHFT)); 164 165 HAL_REG_WRITE(soc, addr, 166 (value & HWIO_TCL_R0_DSCP_TID1_MAP_1_RMSK)); 167 168 addr += 4; 169 } 170 } 171 #endif 172 173 #ifdef QCA_WIFI_QCA6290_11AX 174 /** 175 * hal_tx_update_dscp_tid_6290() - Update the dscp tid map table as updated 176 * by the user 177 * @soc: HAL SoC context 178 * @map: DSCP-TID mapping table 179 * @id : MAP ID 180 * @dscp: DSCP_TID map index 181 * 182 * Return: void 183 */ 184 static void hal_tx_update_dscp_tid_6290(void *hal_soc, uint8_t tid, 185 uint8_t id, uint8_t dscp) 186 { 187 int index; 188 uint32_t addr; 189 uint32_t value; 190 uint32_t regval; 191 struct hal_soc *soc = (struct hal_soc *)hal_soc; 192 193 addr = HWIO_TCL_R0_DSCP_TID_MAP_n_ADDR( 194 SEQ_WCSS_UMAC_MAC_TCL_REG_OFFSET, id); 195 196 index = dscp % HAL_TX_NUM_DSCP_PER_REGISTER; 197 addr += 4 * (dscp / HAL_TX_NUM_DSCP_PER_REGISTER); 198 value = tid << (HAL_TX_BITS_PER_TID * index); 199 200 regval = HAL_REG_READ(soc, addr); 201 regval &= ~(HAL_TX_TID_BITS_MASK << (HAL_TX_BITS_PER_TID * index)); 202 regval |= value; 203 204 HAL_REG_WRITE(soc, addr, (regval & HWIO_TCL_R0_DSCP_TID_MAP_n_RMSK)); 205 } 206 #else 207 static void hal_tx_update_dscp_tid_6290(void *hal_soc, uint8_t tid, 208 uint8_t id, uint8_t dscp) 209 { 210 int index; 211 uint32_t addr; 212 uint32_t value; 213 uint32_t regval; 214 215 struct hal_soc *soc = (struct hal_soc *)hal_soc; 216 217 if (id == HAL_TX_DSCP_TID_MAP_TABLE_DEFAULT) 218 addr = 219 HWIO_TCL_R0_DSCP_TID1_MAP_0_ADDR( 220 SEQ_WCSS_UMAC_MAC_TCL_REG_OFFSET); 221 else 222 addr = 223 HWIO_TCL_R0_DSCP_TID2_MAP_0_ADDR( 224 SEQ_WCSS_UMAC_MAC_TCL_REG_OFFSET); 225 226 index = dscp % HAL_TX_NUM_DSCP_PER_REGISTER; 227 addr += 4 * (dscp/HAL_TX_NUM_DSCP_PER_REGISTER); 228 value = tid << (HAL_TX_BITS_PER_TID * index); 229 230 /* Read back previous DSCP TID config and update 231 * with new config. 232 */ 233 regval = HAL_REG_READ(soc, addr); 234 regval &= ~(HAL_TX_TID_BITS_MASK << (HAL_TX_BITS_PER_TID * index)); 235 regval |= value; 236 237 HAL_REG_WRITE(soc, addr, 238 (regval & HWIO_TCL_R0_DSCP_TID1_MAP_1_RMSK)); 239 } 240 #endif 241 242 #ifdef QCA_WIFI_QCA6290_11AX 243 /** 244 * hal_tx_desc_set_lmac_id - Set the lmac_id value 245 * @desc: Handle to Tx Descriptor 246 * @lmac_id: mac Id to ast matching 247 * b00 – mac 0 248 * b01 – mac 1 249 * b10 – mac 2 250 * b11 – all macs (legacy HK way) 251 * 252 * Return: void 253 */ 254 static void hal_tx_desc_set_lmac_id_6290(void *desc, uint8_t lmac_id) 255 { 256 HAL_SET_FLD(desc, TCL_DATA_CMD_4, LMAC_ID) |= 257 HAL_TX_SM(TCL_DATA_CMD_4, LMAC_ID, lmac_id); 258 } 259 #else 260 static void hal_tx_desc_set_lmac_id_6290(void *desc, uint8_t lmac_id) 261 { 262 } 263 #endif 264