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 #include "tcl_data_cmd.h" 19 #include "mac_tcl_reg_seq_hwioreg.h" 20 #include "phyrx_rssi_legacy.h" 21 #include "hal_hw_headers.h" 22 #include "hal_internal.h" 23 #include "cdp_txrx_mon_struct.h" 24 #include "qdf_trace.h" 25 #include "hal_rx.h" 26 #include "hal_tx.h" 27 #include "dp_types.h" 28 #include "hal_api_mon.h" 29 30 /** 31 * hal_tx_desc_set_dscp_tid_table_id_6390() - Sets DSCP to TID conversion 32 * table ID 33 * @desc: Handle to Tx Descriptor 34 * @id: DSCP to tid conversion table to be used for this frame 35 * 36 * Return: void 37 */ 38 static void hal_tx_desc_set_dscp_tid_table_id_6390(void *desc, uint8_t id) 39 { 40 HAL_SET_FLD(desc, TCL_DATA_CMD_5, 41 DSCP_TID_TABLE_NUM) |= 42 HAL_TX_SM(TCL_DATA_CMD_5, 43 DSCP_TID_TABLE_NUM, id); 44 } 45 46 #define DSCP_TID_TABLE_SIZE 24 47 #define NUM_WORDS_PER_DSCP_TID_TABLE (DSCP_TID_TABLE_SIZE / 4) 48 49 /** 50 * hal_tx_set_dscp_tid_map_6390() - Configure default DSCP to TID map table 51 * @soc: HAL SoC context 52 * @map: DSCP-TID mapping table 53 * @id: mapping table ID - 0-31 54 * 55 * DSCP are mapped to 8 TID values using TID values programmed 56 * in any of the 32 DSCP_TID_MAPS (id = 0-31). 57 * 58 * Return: none 59 */ 60 static void hal_tx_set_dscp_tid_map_6390(void *hal_soc, uint8_t *map, 61 uint8_t id) 62 { 63 int i; 64 uint32_t addr, cmn_reg_addr; 65 uint32_t value = 0, regval; 66 uint8_t val[DSCP_TID_TABLE_SIZE], cnt = 0; 67 68 struct hal_soc *soc = (struct hal_soc *)hal_soc; 69 70 if (id >= HAL_MAX_HW_DSCP_TID_MAPS_11AX) 71 return; 72 73 cmn_reg_addr = HWIO_TCL_R0_CONS_RING_CMN_CTRL_REG_ADDR( 74 SEQ_WCSS_UMAC_MAC_TCL_REG_OFFSET); 75 76 addr = HWIO_TCL_R0_DSCP_TID_MAP_n_ADDR( 77 SEQ_WCSS_UMAC_MAC_TCL_REG_OFFSET, 78 id * NUM_WORDS_PER_DSCP_TID_TABLE); 79 80 /* Enable read/write access */ 81 regval = HAL_REG_READ(soc, cmn_reg_addr); 82 regval |= 83 (1 << HWIO_TCL_R0_CONS_RING_CMN_CTRL_REG_DSCP_TID_MAP_PROGRAM_EN_SHFT); 84 85 HAL_REG_WRITE(soc, cmn_reg_addr, regval); 86 87 /* Write 8 (24 bits) DSCP-TID mappings in each interation */ 88 for (i = 0; i < 64; i += 8) { 89 value = (map[i] | 90 (map[i + 1] << 0x3) | 91 (map[i + 2] << 0x6) | 92 (map[i + 3] << 0x9) | 93 (map[i + 4] << 0xc) | 94 (map[i + 5] << 0xf) | 95 (map[i + 6] << 0x12) | 96 (map[i + 7] << 0x15)); 97 98 qdf_mem_copy(&val[cnt], (void *)&value, 3); 99 cnt += 3; 100 } 101 102 for (i = 0; i < DSCP_TID_TABLE_SIZE; i += 4) { 103 regval = *(uint32_t *)(val + i); 104 HAL_REG_WRITE(soc, addr, 105 (regval & HWIO_TCL_R0_DSCP_TID_MAP_n_RMSK)); 106 addr += 4; 107 } 108 109 /* Diasble read/write access */ 110 regval = HAL_REG_READ(soc, cmn_reg_addr); 111 regval &= 112 ~(HWIO_TCL_R0_CONS_RING_CMN_CTRL_REG_DSCP_TID_MAP_PROGRAM_EN_BMSK); 113 114 HAL_REG_WRITE(soc, cmn_reg_addr, regval); 115 } 116 117 /** 118 * hal_tx_update_dscp_tid_6390() - Update the dscp tid map table as updated 119 * by the user 120 * @soc: HAL SoC context 121 * @map: DSCP-TID mapping table 122 * @id : MAP ID 123 * @dscp: DSCP_TID map index 124 * 125 * Return: void 126 */ 127 static void hal_tx_update_dscp_tid_6390(void *hal_soc, uint8_t tid, 128 uint8_t id, uint8_t dscp) 129 { 130 int index; 131 uint32_t addr; 132 uint32_t value; 133 uint32_t regval; 134 struct hal_soc *soc = (struct hal_soc *)hal_soc; 135 136 addr = HWIO_TCL_R0_DSCP_TID_MAP_n_ADDR( 137 SEQ_WCSS_UMAC_MAC_TCL_REG_OFFSET, id); 138 139 index = dscp % HAL_TX_NUM_DSCP_PER_REGISTER; 140 addr += 4 * (dscp / HAL_TX_NUM_DSCP_PER_REGISTER); 141 value = tid << (HAL_TX_BITS_PER_TID * index); 142 143 regval = HAL_REG_READ(soc, addr); 144 regval &= ~(HAL_TX_TID_BITS_MASK << (HAL_TX_BITS_PER_TID * index)); 145 regval |= value; 146 147 HAL_REG_WRITE(soc, addr, (regval & HWIO_TCL_R0_DSCP_TID_MAP_n_RMSK)); 148 } 149 150 /** 151 * hal_tx_desc_set_lmac_id - Set the lmac_id value 152 * @desc: Handle to Tx Descriptor 153 * @lmac_id: mac Id to ast matching 154 * b00 – mac 0 155 * b01 – mac 1 156 * b10 – mac 2 157 * b11 – all macs (legacy HK way) 158 * 159 * Return: void 160 */ 161 static void hal_tx_desc_set_lmac_id_6390(void *desc, uint8_t lmac_id) 162 { 163 HAL_SET_FLD(desc, TCL_DATA_CMD_4, LMAC_ID) |= 164 HAL_TX_SM(TCL_DATA_CMD_4, LMAC_ID, lmac_id); 165 } 166 167