Quelle  hal_tx.c   Sprache: C

// SPDX-License-Identifier: BSD-3-Clause-Clear
/*
 * Copyright (c) 2018-2019 The Linux Foundation. All rights reserved.
 * Copyright (c) 2022 Qualcomm Innovation Center, Inc. All rights reserved.
 */

#include "hal_desc.h"
#include "hal.h"
#include "hal_tx.h"
#include "hif.h"

#define DSCP_TID_MAP_TBL_ENTRY_SIZE 64

/* dscp_tid_map - Default DSCP-TID mapping
 *
 * DSCP        TID
 * 000000      0
 * 001000      1
 * 010000      2
 * 011000      3
 * 100000      4
 * 101000      5
 * 110000      6
 * 111000      7
 */
static const u8 dscp_tid_map[DSCP_TID_MAP_TBL_ENTRY_SIZE] = {
 0, 0, 0, 0, 0, 0, 0, 0,
 1, 1, 1, 1, 1, 1, 1, 1,
 2, 2, 2, 2, 2, 2, 2, 2,
 3, 3, 3, 3, 3, 3, 3, 3,
 4, 4, 4, 4, 4, 4, 4, 4,
 5, 5, 5, 5, 5, 5, 5, 5,
 6, 6, 6, 6, 6, 6, 6, 6,
 7, 7, 7, 7, 7, 7, 7, 7,
};

void ath11k_hal_tx_cmd_desc_setup(struct ath11k_base *ab, void *cmd,
      struct hal_tx_info *ti)
{
 struct hal_tcl_data_cmd *tcl_cmd = cmd;

 tcl_cmd->buf_addr_info.info0 =
  FIELD_PREP(BUFFER_ADDR_INFO0_ADDR, ti->paddr);
 tcl_cmd->buf_addr_info.info1 =
  FIELD_PREP(BUFFER_ADDR_INFO1_ADDR,
      ((uint64_t)ti->paddr >> HAL_ADDR_MSB_REG_SHIFT));
 tcl_cmd->buf_addr_info.info1 |=
  FIELD_PREP(BUFFER_ADDR_INFO1_RET_BUF_MGR, ti->rbm_id) |
  FIELD_PREP(BUFFER_ADDR_INFO1_SW_COOKIE, ti->desc_id);

 tcl_cmd->info0 =
  FIELD_PREP(HAL_TCL_DATA_CMD_INFO0_DESC_TYPE, ti->type) |
  FIELD_PREP(HAL_TCL_DATA_CMD_INFO0_ENCAP_TYPE, ti->encap_type) |
  FIELD_PREP(HAL_TCL_DATA_CMD_INFO0_ENCRYPT_TYPE,
      ti->encrypt_type) |
  FIELD_PREP(HAL_TCL_DATA_CMD_INFO0_SEARCH_TYPE,
      ti->search_type) |
  FIELD_PREP(HAL_TCL_DATA_CMD_INFO0_ADDR_EN,
      ti->addr_search_flags) |
  FIELD_PREP(HAL_TCL_DATA_CMD_INFO0_CMD_NUM,
      ti->meta_data_flags);

 tcl_cmd->info1 = ti->flags0 |
  FIELD_PREP(HAL_TCL_DATA_CMD_INFO1_DATA_LEN, ti->data_len) |
  FIELD_PREP(HAL_TCL_DATA_CMD_INFO1_PKT_OFFSET, ti->pkt_offset);

 tcl_cmd->info2 = ti->flags1 |
  FIELD_PREP(HAL_TCL_DATA_CMD_INFO2_TID, ti->tid) |
  FIELD_PREP(HAL_TCL_DATA_CMD_INFO2_LMAC_ID, ti->lmac_id);

 tcl_cmd->info3 = FIELD_PREP(HAL_TCL_DATA_CMD_INFO3_DSCP_TID_TABLE_IDX,
        ti->dscp_tid_tbl_idx) |
    FIELD_PREP(HAL_TCL_DATA_CMD_INFO3_SEARCH_INDEX,
        ti->bss_ast_idx) |
    FIELD_PREP(HAL_TCL_DATA_CMD_INFO3_CACHE_SET_NUM,
        ti->bss_ast_hash);
 tcl_cmd->info4 = 0;

 if (ti->enable_mesh)
  ab->hw_params.hw_ops->tx_mesh_enable(ab, tcl_cmd);
}

void ath11k_hal_tx_set_dscp_tid_map(struct ath11k_base *ab, int id)
{
 u32 ctrl_reg_val;
 u32 addr;
 u8 hw_map_val[HAL_DSCP_TID_TBL_SIZE];
 int i;
 u32 value;
 int cnt = 0;

 ctrl_reg_val = ath11k_hif_read32(ab, HAL_SEQ_WCSS_UMAC_TCL_REG +
      HAL_TCL1_RING_CMN_CTRL_REG);
 /* Enable read/write access */
 ctrl_reg_val |= HAL_TCL1_RING_CMN_CTRL_DSCP_TID_MAP_PROG_EN;
 ath11k_hif_write32(ab, HAL_SEQ_WCSS_UMAC_TCL_REG +
      HAL_TCL1_RING_CMN_CTRL_REG, ctrl_reg_val);

 addr = HAL_SEQ_WCSS_UMAC_TCL_REG + HAL_TCL1_RING_DSCP_TID_MAP +
        (4 * id * (HAL_DSCP_TID_TBL_SIZE / 4));

 /* Configure each DSCP-TID mapping in three bits there by configure
 * three bytes in an iteration.
 */
 for (i = 0; i < DSCP_TID_MAP_TBL_ENTRY_SIZE; i += 8) {
  value = FIELD_PREP(HAL_TCL1_RING_FIELD_DSCP_TID_MAP0,
       dscp_tid_map[i]) |
   FIELD_PREP(HAL_TCL1_RING_FIELD_DSCP_TID_MAP1,
       dscp_tid_map[i + 1]) |
   FIELD_PREP(HAL_TCL1_RING_FIELD_DSCP_TID_MAP2,
       dscp_tid_map[i + 2]) |
   FIELD_PREP(HAL_TCL1_RING_FIELD_DSCP_TID_MAP3,
       dscp_tid_map[i + 3]) |
   FIELD_PREP(HAL_TCL1_RING_FIELD_DSCP_TID_MAP4,
       dscp_tid_map[i + 4]) |
   FIELD_PREP(HAL_TCL1_RING_FIELD_DSCP_TID_MAP5,
       dscp_tid_map[i + 5]) |
   FIELD_PREP(HAL_TCL1_RING_FIELD_DSCP_TID_MAP6,
       dscp_tid_map[i + 6]) |
   FIELD_PREP(HAL_TCL1_RING_FIELD_DSCP_TID_MAP7,
       dscp_tid_map[i + 7]);
  memcpy(&hw_map_val[cnt], (u8 *)&value, 3);
  cnt += 3;
 }

 for (i = 0; i < HAL_DSCP_TID_TBL_SIZE; i += 4) {
  ath11k_hif_write32(ab, addr, *(u32 *)&hw_map_val[i]);
  addr += 4;
 }

 /* Disable read/write access */
 ctrl_reg_val = ath11k_hif_read32(ab, HAL_SEQ_WCSS_UMAC_TCL_REG +
      HAL_TCL1_RING_CMN_CTRL_REG);
 ctrl_reg_val &= ~HAL_TCL1_RING_CMN_CTRL_DSCP_TID_MAP_PROG_EN;
 ath11k_hif_write32(ab, HAL_SEQ_WCSS_UMAC_TCL_REG +
      HAL_TCL1_RING_CMN_CTRL_REG,
      ctrl_reg_val);
}

void ath11k_hal_tx_init_data_ring(struct ath11k_base *ab, struct hal_srng *srng)
{
 struct hal_srng_params params;
 struct hal_tlv_hdr *tlv;
 int i, entry_size;
 u8 *desc;

 memset(¶ms, 0, sizeof(params));

 entry_size = ath11k_hal_srng_get_entrysize(ab, HAL_TCL_DATA);
 ath11k_hal_srng_get_params(ab, srng, ¶ms);
 desc = (u8 *)params.ring_base_vaddr;

 for (i = 0; i < params.num_entries; i++) {
  tlv = (struct hal_tlv_hdr *)desc;
  tlv->tl = FIELD_PREP(HAL_TLV_HDR_TAG, HAL_TCL_DATA_CMD) |
     FIELD_PREP(HAL_TLV_HDR_LEN,
         sizeof(struct hal_tcl_data_cmd));
  desc += entry_size;
 }
}