1 // SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause
2 /*
3 * Copyright (C) 2012-2014, 2018-2020 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 "fw/api/commands.h"
10
iwl_parse_shared_mem_22000(struct iwl_fw_runtime * fwrt,struct iwl_rx_packet * pkt)11 static 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
iwl_parse_shared_mem(struct iwl_fw_runtime * fwrt,struct iwl_rx_packet * pkt)46 static 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
iwl_get_shared_mem_conf(struct iwl_fw_runtime * fwrt)80 void 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 = iwl_cmd_id(SHARED_MEM_CFG_CMD, SYSTEM_GROUP, 0);
93 else
94 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 else
108 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 }
114 IWL_EXPORT_SYMBOL(iwl_get_shared_mem_conf);
115