115 lines · c
1// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause2/*3 * Copyright (C) 2012-2014, 2018-2021 Intel Corporation4 * Copyright (C) 2013-2015 Intel Mobile Communications GmbH5 * Copyright (C) 2016-2017 Intel Deutschland GmbH6 */7#include "iwl-drv.h"8#include "runtime.h"9#include "fw/api/commands.h"10 11static void iwl_parse_shared_mem_22000(struct iwl_fw_runtime *fwrt,12 struct iwl_rx_packet *pkt)13{14 struct iwl_shared_mem_cfg *mem_cfg = (void *)pkt->data;15 int i, lmac;16 int lmac_num = le32_to_cpu(mem_cfg->lmac_num);17 u8 api_ver = iwl_fw_lookup_notif_ver(fwrt->fw, SYSTEM_GROUP,18 SHARED_MEM_CFG_CMD, 0);19 20 if (WARN_ON(lmac_num > ARRAY_SIZE(mem_cfg->lmac_smem)))21 return;22 23 fwrt->smem_cfg.num_lmacs = lmac_num;24 fwrt->smem_cfg.num_txfifo_entries =25 ARRAY_SIZE(mem_cfg->lmac_smem[0].txfifo_size);26 fwrt->smem_cfg.rxfifo2_size = le32_to_cpu(mem_cfg->rxfifo2_size);27 28 if (api_ver >= 4 &&29 !WARN_ON_ONCE(iwl_rx_packet_payload_len(pkt) < sizeof(*mem_cfg))) {30 fwrt->smem_cfg.rxfifo2_control_size =31 le32_to_cpu(mem_cfg->rxfifo2_control_size);32 }33 34 for (lmac = 0; lmac < lmac_num; lmac++) {35 struct iwl_shared_mem_lmac_cfg *lmac_cfg =36 &mem_cfg->lmac_smem[lmac];37 38 for (i = 0; i < ARRAY_SIZE(lmac_cfg->txfifo_size); i++)39 fwrt->smem_cfg.lmac[lmac].txfifo_size[i] =40 le32_to_cpu(lmac_cfg->txfifo_size[i]);41 fwrt->smem_cfg.lmac[lmac].rxfifo1_size =42 le32_to_cpu(lmac_cfg->rxfifo1_size);43 }44}45 46static void iwl_parse_shared_mem(struct iwl_fw_runtime *fwrt,47 struct iwl_rx_packet *pkt)48{49 struct iwl_shared_mem_cfg_v2 *mem_cfg = (void *)pkt->data;50 int i;51 52 fwrt->smem_cfg.num_lmacs = 1;53 54 fwrt->smem_cfg.num_txfifo_entries = ARRAY_SIZE(mem_cfg->txfifo_size);55 for (i = 0; i < ARRAY_SIZE(mem_cfg->txfifo_size); i++)56 fwrt->smem_cfg.lmac[0].txfifo_size[i] =57 le32_to_cpu(mem_cfg->txfifo_size[i]);58 59 fwrt->smem_cfg.lmac[0].rxfifo1_size =60 le32_to_cpu(mem_cfg->rxfifo_size[0]);61 fwrt->smem_cfg.rxfifo2_size = le32_to_cpu(mem_cfg->rxfifo_size[1]);62 63 /* new API has more data, from rxfifo_addr field and on */64 if (fw_has_capa(&fwrt->fw->ucode_capa,65 IWL_UCODE_TLV_CAPA_EXTEND_SHARED_MEM_CFG)) {66 BUILD_BUG_ON(sizeof(fwrt->smem_cfg.internal_txfifo_size) !=67 sizeof(mem_cfg->internal_txfifo_size));68 69 fwrt->smem_cfg.internal_txfifo_addr =70 le32_to_cpu(mem_cfg->internal_txfifo_addr);71 72 for (i = 0;73 i < ARRAY_SIZE(fwrt->smem_cfg.internal_txfifo_size);74 i++)75 fwrt->smem_cfg.internal_txfifo_size[i] =76 le32_to_cpu(mem_cfg->internal_txfifo_size[i]);77 }78}79 80void iwl_get_shared_mem_conf(struct iwl_fw_runtime *fwrt)81{82 struct iwl_host_cmd cmd = {83 .flags = CMD_WANT_SKB,84 .data = { NULL, },85 .len = { 0, },86 };87 struct iwl_rx_packet *pkt;88 int ret;89 90 if (fw_has_capa(&fwrt->fw->ucode_capa,91 IWL_UCODE_TLV_CAPA_EXTEND_SHARED_MEM_CFG))92 cmd.id = WIDE_ID(SYSTEM_GROUP, SHARED_MEM_CFG_CMD);93 else94 cmd.id = SHARED_MEM_CFG;95 96 ret = iwl_trans_send_cmd(fwrt->trans, &cmd);97 98 if (ret) {99 WARN(ret != -ERFKILL,100 "Could not send the SMEM command: %d\n", ret);101 return;102 }103 104 pkt = cmd.resp_pkt;105 if (fwrt->trans->trans_cfg->device_family >= IWL_DEVICE_FAMILY_22000)106 iwl_parse_shared_mem_22000(fwrt, pkt);107 else108 iwl_parse_shared_mem(fwrt, pkt);109 110 IWL_DEBUG_INFO(fwrt, "SHARED MEM CFG: got memory offsets/sizes\n");111 112 iwl_free_resp(&cmd);113}114IWL_EXPORT_SYMBOL(iwl_get_shared_mem_conf);115