1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62#include "iwl-drv.h"
63#include "runtime.h"
64#include "fw/api/commands.h"
65
66static void iwl_parse_shared_mem_22000(struct iwl_fw_runtime *fwrt,
67 struct iwl_rx_packet *pkt)
68{
69 struct iwl_shared_mem_cfg *mem_cfg = (void *)pkt->data;
70 int i, lmac;
71 int lmac_num = le32_to_cpu(mem_cfg->lmac_num);
72 u8 api_ver = iwl_fw_lookup_notif_ver(fwrt->fw, SYSTEM_GROUP,
73 SHARED_MEM_CFG_CMD, 0);
74
75 if (WARN_ON(lmac_num > ARRAY_SIZE(mem_cfg->lmac_smem)))
76 return;
77
78 fwrt->smem_cfg.num_lmacs = lmac_num;
79 fwrt->smem_cfg.num_txfifo_entries =
80 ARRAY_SIZE(mem_cfg->lmac_smem[0].txfifo_size);
81 fwrt->smem_cfg.rxfifo2_size = le32_to_cpu(mem_cfg->rxfifo2_size);
82
83 if (api_ver >= 4 &&
84 !WARN_ON_ONCE(iwl_rx_packet_payload_len(pkt) < sizeof(*mem_cfg))) {
85 fwrt->smem_cfg.rxfifo2_control_size =
86 le32_to_cpu(mem_cfg->rxfifo2_control_size);
87 }
88
89 for (lmac = 0; lmac < lmac_num; lmac++) {
90 struct iwl_shared_mem_lmac_cfg *lmac_cfg =
91 &mem_cfg->lmac_smem[lmac];
92
93 for (i = 0; i < ARRAY_SIZE(lmac_cfg->txfifo_size); i++)
94 fwrt->smem_cfg.lmac[lmac].txfifo_size[i] =
95 le32_to_cpu(lmac_cfg->txfifo_size[i]);
96 fwrt->smem_cfg.lmac[lmac].rxfifo1_size =
97 le32_to_cpu(lmac_cfg->rxfifo1_size);
98 }
99}
100
101static void iwl_parse_shared_mem(struct iwl_fw_runtime *fwrt,
102 struct iwl_rx_packet *pkt)
103{
104 struct iwl_shared_mem_cfg_v2 *mem_cfg = (void *)pkt->data;
105 int i;
106
107 fwrt->smem_cfg.num_lmacs = 1;
108
109 fwrt->smem_cfg.num_txfifo_entries = ARRAY_SIZE(mem_cfg->txfifo_size);
110 for (i = 0; i < ARRAY_SIZE(mem_cfg->txfifo_size); i++)
111 fwrt->smem_cfg.lmac[0].txfifo_size[i] =
112 le32_to_cpu(mem_cfg->txfifo_size[i]);
113
114 fwrt->smem_cfg.lmac[0].rxfifo1_size =
115 le32_to_cpu(mem_cfg->rxfifo_size[0]);
116 fwrt->smem_cfg.rxfifo2_size = le32_to_cpu(mem_cfg->rxfifo_size[1]);
117
118
119 if (fw_has_capa(&fwrt->fw->ucode_capa,
120 IWL_UCODE_TLV_CAPA_EXTEND_SHARED_MEM_CFG)) {
121 BUILD_BUG_ON(sizeof(fwrt->smem_cfg.internal_txfifo_size) !=
122 sizeof(mem_cfg->internal_txfifo_size));
123
124 fwrt->smem_cfg.internal_txfifo_addr =
125 le32_to_cpu(mem_cfg->internal_txfifo_addr);
126
127 for (i = 0;
128 i < ARRAY_SIZE(fwrt->smem_cfg.internal_txfifo_size);
129 i++)
130 fwrt->smem_cfg.internal_txfifo_size[i] =
131 le32_to_cpu(mem_cfg->internal_txfifo_size[i]);
132 }
133}
134
135void iwl_get_shared_mem_conf(struct iwl_fw_runtime *fwrt)
136{
137 struct iwl_host_cmd cmd = {
138 .flags = CMD_WANT_SKB,
139 .data = { NULL, },
140 .len = { 0, },
141 };
142 struct iwl_rx_packet *pkt;
143 int ret;
144
145 if (fw_has_capa(&fwrt->fw->ucode_capa,
146 IWL_UCODE_TLV_CAPA_EXTEND_SHARED_MEM_CFG))
147 cmd.id = iwl_cmd_id(SHARED_MEM_CFG_CMD, SYSTEM_GROUP, 0);
148 else
149 cmd.id = SHARED_MEM_CFG;
150
151 ret = iwl_trans_send_cmd(fwrt->trans, &cmd);
152
153 if (ret) {
154 WARN(ret != -ERFKILL,
155 "Could not send the SMEM command: %d\n", ret);
156 return;
157 }
158
159 pkt = cmd.resp_pkt;
160 if (fwrt->trans->trans_cfg->device_family >= IWL_DEVICE_FAMILY_22000)
161 iwl_parse_shared_mem_22000(fwrt, pkt);
162 else
163 iwl_parse_shared_mem(fwrt, pkt);
164
165 IWL_DEBUG_INFO(fwrt, "SHARED MEM CFG: got memory offsets/sizes\n");
166
167 iwl_free_resp(&cmd);
168}
169IWL_EXPORT_SYMBOL(iwl_get_shared_mem_conf);
170