Debian Codegraph @

drivers/net/wireless/intel/iwlwifi/fw/smem.c

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