iwlwifi/fw/smem.c

0001 // SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause
0002 /*
0003  * Copyright (C) 2012-2014, 2018-2021 Intel Corporation
0004  * Copyright (C) 2013-2015 Intel Mobile Communications GmbH
0005  * Copyright (C) 2016-2017 Intel Deutschland GmbH
0006  */
0007 #include "iwl-drv.h"
0008 #include "runtime.h"
0009 #include "fw/api/commands.h"
0010
0011 static void iwl_parse_shared_mem_22000(struct iwl_fw_runtime *fwrt,
0012                        struct iwl_rx_packet *pkt)
0013 {
0014     struct iwl_shared_mem_cfg *mem_cfg = (void *)pkt->data;
0015     int i, lmac;
0016     int lmac_num = le32_to_cpu(mem_cfg->lmac_num);
0017     u8 api_ver = iwl_fw_lookup_notif_ver(fwrt->fw, SYSTEM_GROUP,
0018                          SHARED_MEM_CFG_CMD, 0);
0019
0020     if (WARN_ON(lmac_num > ARRAY_SIZE(mem_cfg->lmac_smem)))
0021         return;
0022
0023     fwrt->smem_cfg.num_lmacs = lmac_num;
0024     fwrt->smem_cfg.num_txfifo_entries =
0025         ARRAY_SIZE(mem_cfg->lmac_smem[0].txfifo_size);
0026     fwrt->smem_cfg.rxfifo2_size = le32_to_cpu(mem_cfg->rxfifo2_size);
0027
0028     if (api_ver >= 4 &&
0029         !WARN_ON_ONCE(iwl_rx_packet_payload_len(pkt) < sizeof(*mem_cfg))) {
0030         fwrt->smem_cfg.rxfifo2_control_size =
0031             le32_to_cpu(mem_cfg->rxfifo2_control_size);
0032     }
0033
0034     for (lmac = 0; lmac < lmac_num; lmac++) {
0035         struct iwl_shared_mem_lmac_cfg *lmac_cfg =
0036             &mem_cfg->lmac_smem[lmac];
0037
0038         for (i = 0; i < ARRAY_SIZE(lmac_cfg->txfifo_size); i++)
0039             fwrt->smem_cfg.lmac[lmac].txfifo_size[i] =
0040                 le32_to_cpu(lmac_cfg->txfifo_size[i]);
0041         fwrt->smem_cfg.lmac[lmac].rxfifo1_size =
0042             le32_to_cpu(lmac_cfg->rxfifo1_size);
0043     }
0044 }
0045
0046 static void iwl_parse_shared_mem(struct iwl_fw_runtime *fwrt,
0047                  struct iwl_rx_packet *pkt)
0048 {
0049     struct iwl_shared_mem_cfg_v2 *mem_cfg = (void *)pkt->data;
0050     int i;
0051
0052     fwrt->smem_cfg.num_lmacs = 1;
0053
0054     fwrt->smem_cfg.num_txfifo_entries = ARRAY_SIZE(mem_cfg->txfifo_size);
0055     for (i = 0; i < ARRAY_SIZE(mem_cfg->txfifo_size); i++)
0056         fwrt->smem_cfg.lmac[0].txfifo_size[i] =
0057             le32_to_cpu(mem_cfg->txfifo_size[i]);
0058
0059     fwrt->smem_cfg.lmac[0].rxfifo1_size =
0060         le32_to_cpu(mem_cfg->rxfifo_size[0]);
0061     fwrt->smem_cfg.rxfifo2_size = le32_to_cpu(mem_cfg->rxfifo_size[1]);
0062
0063     /* new API has more data, from rxfifo_addr field and on */
0064     if (fw_has_capa(&fwrt->fw->ucode_capa,
0065             IWL_UCODE_TLV_CAPA_EXTEND_SHARED_MEM_CFG)) {
0066         BUILD_BUG_ON(sizeof(fwrt->smem_cfg.internal_txfifo_size) !=
0067                  sizeof(mem_cfg->internal_txfifo_size));
0068
0069         fwrt->smem_cfg.internal_txfifo_addr =
0070             le32_to_cpu(mem_cfg->internal_txfifo_addr);
0071
0072         for (i = 0;
0073              i < ARRAY_SIZE(fwrt->smem_cfg.internal_txfifo_size);
0074              i++)
0075             fwrt->smem_cfg.internal_txfifo_size[i] =
0076                 le32_to_cpu(mem_cfg->internal_txfifo_size[i]);
0077     }
0078 }
0079
0080 void iwl_get_shared_mem_conf(struct iwl_fw_runtime *fwrt)
0081 {
0082     struct iwl_host_cmd cmd = {
0083         .flags = CMD_WANT_SKB,
0084         .data = { NULL, },
0085         .len = { 0, },
0086     };
0087     struct iwl_rx_packet *pkt;
0088     int ret;
0089
0090     if (fw_has_capa(&fwrt->fw->ucode_capa,
0091             IWL_UCODE_TLV_CAPA_EXTEND_SHARED_MEM_CFG))
0092         cmd.id = WIDE_ID(SYSTEM_GROUP, SHARED_MEM_CFG_CMD);
0093     else
0094         cmd.id = SHARED_MEM_CFG;
0095
0096     ret = iwl_trans_send_cmd(fwrt->trans, &cmd);
0097
0098     if (ret) {
0099         WARN(ret != -ERFKILL,
0100              "Could not send the SMEM command: %d\n", ret);
0101         return;
0102     }
0103
0104     pkt = cmd.resp_pkt;
0105     if (fwrt->trans->trans_cfg->device_family >= IWL_DEVICE_FAMILY_22000)
0106         iwl_parse_shared_mem_22000(fwrt, pkt);
0107     else
0108         iwl_parse_shared_mem(fwrt, pkt);
0109
0110     IWL_DEBUG_INFO(fwrt, "SHARED MEM CFG: got memory offsets/sizes\n");
0111
0112     iwl_free_resp(&cmd);
0113 }
0114 IWL_EXPORT_SYMBOL(iwl_get_shared_mem_conf);