1*5113495bSYour Name /*
2*5113495bSYour Name * Copyright (c) 2016-2020 The Linux Foundation. All rights reserved.
3*5113495bSYour Name * Copyright (c) 2022-2023 Qualcomm Innovation Center, Inc. All rights reserved.
4*5113495bSYour Name *
5*5113495bSYour Name * Permission to use, copy, modify, and/or distribute this software for
6*5113495bSYour Name * any purpose with or without fee is hereby granted, provided that the
7*5113495bSYour Name * above copyright notice and this permission notice appear in all
8*5113495bSYour Name * copies.
9*5113495bSYour Name *
10*5113495bSYour Name * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL
11*5113495bSYour Name * WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED
12*5113495bSYour Name * WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE
13*5113495bSYour Name * AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL
14*5113495bSYour Name * DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR
15*5113495bSYour Name * PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER
16*5113495bSYour Name * TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
17*5113495bSYour Name * PERFORMANCE OF THIS SOFTWARE.
18*5113495bSYour Name */
19*5113495bSYour Name #include "hal_hw_headers.h"
20*5113495bSYour Name #include "hal_internal.h"
21*5113495bSYour Name #include "cdp_txrx_mon_struct.h"
22*5113495bSYour Name #include "qdf_trace.h"
23*5113495bSYour Name #include "hal_rx.h"
24*5113495bSYour Name #include "hal_tx.h"
25*5113495bSYour Name #include "dp_types.h"
26*5113495bSYour Name #include "hal_api_mon.h"
27*5113495bSYour Name
28*5113495bSYour Name /**
29*5113495bSYour Name * hal_tx_desc_set_dscp_tid_table_id_8074v2() - Sets DSCP to TID conversion
30*5113495bSYour Name * table ID
31*5113495bSYour Name * @desc: Handle to Tx Descriptor
32*5113495bSYour Name * @id: DSCP to tid conversion table to be used for this frame
33*5113495bSYour Name *
34*5113495bSYour Name * Return: void
35*5113495bSYour Name */
36*5113495bSYour Name
hal_tx_desc_set_dscp_tid_table_id_8074v2(void * desc,uint8_t id)37*5113495bSYour Name static void hal_tx_desc_set_dscp_tid_table_id_8074v2(void *desc, uint8_t id)
38*5113495bSYour Name {
39*5113495bSYour Name HAL_SET_FLD(desc, TCL_DATA_CMD_5,
40*5113495bSYour Name DSCP_TID_TABLE_NUM) |=
41*5113495bSYour Name HAL_TX_SM(TCL_DATA_CMD_5,
42*5113495bSYour Name DSCP_TID_TABLE_NUM, id);
43*5113495bSYour Name }
44*5113495bSYour Name
45*5113495bSYour Name
46*5113495bSYour Name #define DSCP_TID_TABLE_SIZE 24
47*5113495bSYour Name #define NUM_WORDS_PER_DSCP_TID_TABLE (DSCP_TID_TABLE_SIZE / 4)
48*5113495bSYour Name #define HAL_TX_NUM_DSCP_REGISTER_SIZE 32
49*5113495bSYour Name /**
50*5113495bSYour Name * hal_tx_set_dscp_tid_map_8074v2() - Configure default DSCP to TID map table
51*5113495bSYour Name * @soc: HAL SoC context
52*5113495bSYour Name * @map: DSCP-TID mapping table
53*5113495bSYour Name * @id: mapping table ID - 0,1
54*5113495bSYour Name *
55*5113495bSYour Name * DSCP are mapped to 8 TID values using TID values programmed
56*5113495bSYour Name * in two set of mapping registers DSCP_TID1_MAP_<0 to 6> (id = 0)
57*5113495bSYour Name * and DSCP_TID2_MAP_<0 to 6> (id = 1)
58*5113495bSYour Name * Each mapping register has TID mapping for 10 DSCP values
59*5113495bSYour Name *
60*5113495bSYour Name * Return: none
61*5113495bSYour Name */
hal_tx_set_dscp_tid_map_8074v2(struct hal_soc * soc,uint8_t * map,uint8_t id)62*5113495bSYour Name static void hal_tx_set_dscp_tid_map_8074v2(struct hal_soc *soc,
63*5113495bSYour Name uint8_t *map,
64*5113495bSYour Name uint8_t id)
65*5113495bSYour Name {
66*5113495bSYour Name int i;
67*5113495bSYour Name uint32_t addr, cmn_reg_addr;
68*5113495bSYour Name uint32_t value = 0, regval;
69*5113495bSYour Name uint8_t val[DSCP_TID_TABLE_SIZE], cnt = 0;
70*5113495bSYour Name
71*5113495bSYour Name if (id >= HAL_MAX_HW_DSCP_TID_V2_MAPS)
72*5113495bSYour Name return;
73*5113495bSYour Name
74*5113495bSYour Name cmn_reg_addr = HWIO_TCL_R0_CONS_RING_CMN_CTRL_REG_ADDR(
75*5113495bSYour Name SEQ_WCSS_UMAC_MAC_TCL_REG_OFFSET);
76*5113495bSYour Name
77*5113495bSYour Name addr = HWIO_TCL_R0_DSCP_TID_MAP_n_ADDR(
78*5113495bSYour Name SEQ_WCSS_UMAC_MAC_TCL_REG_OFFSET,
79*5113495bSYour Name id * NUM_WORDS_PER_DSCP_TID_TABLE);
80*5113495bSYour Name
81*5113495bSYour Name /* Enable read/write access */
82*5113495bSYour Name regval = HAL_REG_READ(soc, cmn_reg_addr);
83*5113495bSYour Name regval |=
84*5113495bSYour Name (1 << HWIO_TCL_R0_CONS_RING_CMN_CTRL_REG_DSCP_TID_MAP_PROGRAM_EN_SHFT);
85*5113495bSYour Name
86*5113495bSYour Name HAL_REG_WRITE(soc, cmn_reg_addr, regval);
87*5113495bSYour Name
88*5113495bSYour Name /* Write 8 (24 bits) DSCP-TID mappings in each iteration */
89*5113495bSYour Name for (i = 0; i < 64; i += 8) {
90*5113495bSYour Name value = (map[i] |
91*5113495bSYour Name (map[i + 1] << 0x3) |
92*5113495bSYour Name (map[i + 2] << 0x6) |
93*5113495bSYour Name (map[i + 3] << 0x9) |
94*5113495bSYour Name (map[i + 4] << 0xc) |
95*5113495bSYour Name (map[i + 5] << 0xf) |
96*5113495bSYour Name (map[i + 6] << 0x12) |
97*5113495bSYour Name (map[i + 7] << 0x15));
98*5113495bSYour Name
99*5113495bSYour Name qdf_mem_copy(&val[cnt], &value, 3);
100*5113495bSYour Name cnt += 3;
101*5113495bSYour Name }
102*5113495bSYour Name
103*5113495bSYour Name for (i = 0; i < DSCP_TID_TABLE_SIZE; i += 4) {
104*5113495bSYour Name regval = *(uint32_t *)(val + i);
105*5113495bSYour Name HAL_REG_WRITE(soc, addr,
106*5113495bSYour Name (regval & HWIO_TCL_R0_DSCP_TID_MAP_n_RMSK));
107*5113495bSYour Name addr += 4;
108*5113495bSYour Name }
109*5113495bSYour Name
110*5113495bSYour Name /* Disable read/write access */
111*5113495bSYour Name regval = HAL_REG_READ(soc, cmn_reg_addr);
112*5113495bSYour Name regval &=
113*5113495bSYour Name ~(HWIO_TCL_R0_CONS_RING_CMN_CTRL_REG_DSCP_TID_MAP_PROGRAM_EN_BMSK);
114*5113495bSYour Name
115*5113495bSYour Name HAL_REG_WRITE(soc, cmn_reg_addr, regval);
116*5113495bSYour Name }
117*5113495bSYour Name
118*5113495bSYour Name /**
119*5113495bSYour Name * hal_tx_update_dscp_tid_8074v2() - Update the dscp tid map table as
120*5113495bSYour Name * updated by user
121*5113495bSYour Name * @soc: HAL SoC context
122*5113495bSYour Name * @tid: TID
123*5113495bSYour Name * @id : MAP ID
124*5113495bSYour Name * @dscp: DSCP
125*5113495bSYour Name *
126*5113495bSYour Name * Return: void
127*5113495bSYour Name */
hal_tx_update_dscp_tid_8074v2(struct hal_soc * soc,uint8_t tid,uint8_t id,uint8_t dscp)128*5113495bSYour Name static void hal_tx_update_dscp_tid_8074v2(struct hal_soc *soc, uint8_t tid,
129*5113495bSYour Name uint8_t id, uint8_t dscp)
130*5113495bSYour Name {
131*5113495bSYour Name uint32_t addr, addr1, cmn_reg_addr, regmask = 0xFFFFFFFF;
132*5113495bSYour Name uint32_t start_value = 0, end_value = 0;
133*5113495bSYour Name uint32_t regval;
134*5113495bSYour Name uint8_t end_bits = 0;
135*5113495bSYour Name uint8_t start_bits = 0;
136*5113495bSYour Name uint32_t start_index, end_index;
137*5113495bSYour Name cmn_reg_addr = HWIO_TCL_R0_CONS_RING_CMN_CTRL_REG_ADDR(
138*5113495bSYour Name SEQ_WCSS_UMAC_MAC_TCL_REG_OFFSET);
139*5113495bSYour Name
140*5113495bSYour Name addr = HWIO_TCL_R0_DSCP_TID_MAP_n_ADDR(
141*5113495bSYour Name SEQ_WCSS_UMAC_MAC_TCL_REG_OFFSET,
142*5113495bSYour Name id * NUM_WORDS_PER_DSCP_TID_TABLE);
143*5113495bSYour Name
144*5113495bSYour Name start_index = dscp * HAL_TX_BITS_PER_TID;
145*5113495bSYour Name end_index = (start_index + (HAL_TX_BITS_PER_TID - 1))
146*5113495bSYour Name % HAL_TX_NUM_DSCP_REGISTER_SIZE;
147*5113495bSYour Name start_index = start_index % HAL_TX_NUM_DSCP_REGISTER_SIZE;
148*5113495bSYour Name addr += (4 * ((dscp * HAL_TX_BITS_PER_TID) /
149*5113495bSYour Name HAL_TX_NUM_DSCP_REGISTER_SIZE));
150*5113495bSYour Name
151*5113495bSYour Name if (end_index < start_index) {
152*5113495bSYour Name end_bits = end_index + 1;
153*5113495bSYour Name start_bits = HAL_TX_BITS_PER_TID - end_bits;
154*5113495bSYour Name start_value = tid << start_index;
155*5113495bSYour Name end_value = tid >> start_bits;
156*5113495bSYour Name addr1 = addr + 4;
157*5113495bSYour Name } else {
158*5113495bSYour Name start_bits = HAL_TX_BITS_PER_TID - end_bits;
159*5113495bSYour Name start_value = tid << start_index;
160*5113495bSYour Name addr1 = 0;
161*5113495bSYour Name }
162*5113495bSYour Name
163*5113495bSYour Name /* Enable read/write access */
164*5113495bSYour Name regval = HAL_REG_READ(soc, cmn_reg_addr);
165*5113495bSYour Name regval |=
166*5113495bSYour Name (1 << HWIO_TCL_R0_CONS_RING_CMN_CTRL_REG_DSCP_TID_MAP_PROGRAM_EN_SHFT);
167*5113495bSYour Name
168*5113495bSYour Name HAL_REG_WRITE(soc, cmn_reg_addr, regval);
169*5113495bSYour Name
170*5113495bSYour Name regval = HAL_REG_READ(soc, addr);
171*5113495bSYour Name
172*5113495bSYour Name if (end_index < start_index)
173*5113495bSYour Name regval &= (regmask >> start_bits);
174*5113495bSYour Name else
175*5113495bSYour Name regval &= ~(7 << start_index);
176*5113495bSYour Name
177*5113495bSYour Name regval |= start_value;
178*5113495bSYour Name
179*5113495bSYour Name HAL_REG_WRITE(soc, addr, (regval & HWIO_TCL_R0_DSCP_TID_MAP_n_RMSK));
180*5113495bSYour Name
181*5113495bSYour Name if (addr1) {
182*5113495bSYour Name regval = HAL_REG_READ(soc, addr1);
183*5113495bSYour Name regval &= (~0) << end_bits;
184*5113495bSYour Name regval |= end_value;
185*5113495bSYour Name
186*5113495bSYour Name HAL_REG_WRITE(soc, addr1, (regval &
187*5113495bSYour Name HWIO_TCL_R0_DSCP_TID_MAP_n_RMSK));
188*5113495bSYour Name }
189*5113495bSYour Name
190*5113495bSYour Name /* Disable read/write access */
191*5113495bSYour Name regval = HAL_REG_READ(soc, cmn_reg_addr);
192*5113495bSYour Name regval &=
193*5113495bSYour Name ~(HWIO_TCL_R0_CONS_RING_CMN_CTRL_REG_DSCP_TID_MAP_PROGRAM_EN_BMSK);
194*5113495bSYour Name HAL_REG_WRITE(soc, cmn_reg_addr, regval);
195*5113495bSYour Name }
196*5113495bSYour Name
197*5113495bSYour Name /**
198*5113495bSYour Name * hal_tx_desc_set_lmac_id_8074v2() - Set the lmac_id value
199*5113495bSYour Name * @desc: Handle to Tx Descriptor
200*5113495bSYour Name * @lmac_id: mac Id to ast matching
201*5113495bSYour Name * b00 – mac 0
202*5113495bSYour Name * b01 – mac 1
203*5113495bSYour Name * b10 – mac 2
204*5113495bSYour Name * b11 – all macs (legacy HK way)
205*5113495bSYour Name *
206*5113495bSYour Name * Return: void
207*5113495bSYour Name */
hal_tx_desc_set_lmac_id_8074v2(void * desc,uint8_t lmac_id)208*5113495bSYour Name static void hal_tx_desc_set_lmac_id_8074v2(void *desc, uint8_t lmac_id)
209*5113495bSYour Name {
210*5113495bSYour Name HAL_SET_FLD(desc, TCL_DATA_CMD_4, LMAC_ID) |=
211*5113495bSYour Name HAL_TX_SM(TCL_DATA_CMD_4, LMAC_ID, lmac_id);
212*5113495bSYour Name }
213*5113495bSYour Name
214*5113495bSYour Name /**
215*5113495bSYour Name * hal_tx_init_cmd_credit_ring_8074v2() - Initialize command/credit SRNG
216*5113495bSYour Name * @hal_soc_hdl: Handle to HAL SoC structure
217*5113495bSYour Name * @hal_ring_hdl: Handle to HAL SRNG structure
218*5113495bSYour Name *
219*5113495bSYour Name * Return: none
220*5113495bSYour Name */
hal_tx_init_cmd_credit_ring_8074v2(hal_soc_handle_t hal_soc_hdl,hal_ring_handle_t hal_ring_hdl)221*5113495bSYour Name static inline void hal_tx_init_cmd_credit_ring_8074v2(hal_soc_handle_t hal_soc_hdl,
222*5113495bSYour Name hal_ring_handle_t hal_ring_hdl)
223*5113495bSYour Name {
224*5113495bSYour Name uint8_t *desc_addr;
225*5113495bSYour Name struct hal_srng_params srng_params;
226*5113495bSYour Name uint32_t desc_size;
227*5113495bSYour Name uint32_t num_desc;
228*5113495bSYour Name
229*5113495bSYour Name hal_get_srng_params(hal_soc_hdl, hal_ring_hdl, &srng_params);
230*5113495bSYour Name
231*5113495bSYour Name desc_addr = (uint8_t *)srng_params.ring_base_vaddr;
232*5113495bSYour Name desc_size = sizeof(struct tcl_data_cmd);
233*5113495bSYour Name num_desc = srng_params.num_entries;
234*5113495bSYour Name
235*5113495bSYour Name while (num_desc) {
236*5113495bSYour Name /* using CMD/CREDIT Ring to send DATA CMD tag */
237*5113495bSYour Name HAL_TX_DESC_SET_TLV_HDR(desc_addr, WIFITCL_DATA_CMD_E,
238*5113495bSYour Name desc_size);
239*5113495bSYour Name desc_addr += (desc_size + sizeof(struct tlv_32_hdr));
240*5113495bSYour Name num_desc--;
241*5113495bSYour Name }
242*5113495bSYour Name }
243