1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18#include "bmi.h"
19#include "hif.h"
20#include "debug.h"
21#include "htc.h"
22
23void ath10k_bmi_start(struct ath10k *ar)
24{
25 ath10k_dbg(ar, ATH10K_DBG_BMI, "bmi start\n");
26
27 ar->bmi.done_sent = false;
28}
29
30int ath10k_bmi_done(struct ath10k *ar)
31{
32 struct bmi_cmd cmd;
33 u32 cmdlen = sizeof(cmd.id) + sizeof(cmd.done);
34 int ret;
35
36 ath10k_dbg(ar, ATH10K_DBG_BMI, "bmi done\n");
37
38 if (ar->bmi.done_sent) {
39 ath10k_dbg(ar, ATH10K_DBG_BMI, "bmi skipped\n");
40 return 0;
41 }
42
43 ar->bmi.done_sent = true;
44 cmd.id = __cpu_to_le32(BMI_DONE);
45
46 ret = ath10k_hif_exchange_bmi_msg(ar, &cmd, cmdlen, NULL, NULL);
47 if (ret) {
48 ath10k_warn(ar, "unable to write to the device: %d\n", ret);
49 return ret;
50 }
51
52 return 0;
53}
54
55int ath10k_bmi_get_target_info(struct ath10k *ar,
56 struct bmi_target_info *target_info)
57{
58 struct bmi_cmd cmd;
59 union bmi_resp resp;
60 u32 cmdlen = sizeof(cmd.id) + sizeof(cmd.get_target_info);
61 u32 resplen = sizeof(resp.get_target_info);
62 int ret;
63
64 ath10k_dbg(ar, ATH10K_DBG_BMI, "bmi get target info\n");
65
66 if (ar->bmi.done_sent) {
67 ath10k_warn(ar, "BMI Get Target Info Command disallowed\n");
68 return -EBUSY;
69 }
70
71 cmd.id = __cpu_to_le32(BMI_GET_TARGET_INFO);
72
73 ret = ath10k_hif_exchange_bmi_msg(ar, &cmd, cmdlen, &resp, &resplen);
74 if (ret) {
75 ath10k_warn(ar, "unable to get target info from device\n");
76 return ret;
77 }
78
79 if (resplen < sizeof(resp.get_target_info)) {
80 ath10k_warn(ar, "invalid get_target_info response length (%d)\n",
81 resplen);
82 return -EIO;
83 }
84
85 target_info->version = __le32_to_cpu(resp.get_target_info.version);
86 target_info->type = __le32_to_cpu(resp.get_target_info.type);
87
88 return 0;
89}
90
91int ath10k_bmi_read_memory(struct ath10k *ar,
92 u32 address, void *buffer, u32 length)
93{
94 struct bmi_cmd cmd;
95 union bmi_resp resp;
96 u32 cmdlen = sizeof(cmd.id) + sizeof(cmd.read_mem);
97 u32 rxlen;
98 int ret;
99
100 ath10k_dbg(ar, ATH10K_DBG_BMI, "bmi read address 0x%x length %d\n",
101 address, length);
102
103 if (ar->bmi.done_sent) {
104 ath10k_warn(ar, "command disallowed\n");
105 return -EBUSY;
106 }
107
108 while (length) {
109 rxlen = min_t(u32, length, BMI_MAX_DATA_SIZE);
110
111 cmd.id = __cpu_to_le32(BMI_READ_MEMORY);
112 cmd.read_mem.addr = __cpu_to_le32(address);
113 cmd.read_mem.len = __cpu_to_le32(rxlen);
114
115 ret = ath10k_hif_exchange_bmi_msg(ar, &cmd, cmdlen,
116 &resp, &rxlen);
117 if (ret) {
118 ath10k_warn(ar, "unable to read from the device (%d)\n",
119 ret);
120 return ret;
121 }
122
123 memcpy(buffer, resp.read_mem.payload, rxlen);
124 address += rxlen;
125 buffer += rxlen;
126 length -= rxlen;
127 }
128
129 return 0;
130}
131
132int ath10k_bmi_write_memory(struct ath10k *ar,
133 u32 address, const void *buffer, u32 length)
134{
135 struct bmi_cmd cmd;
136 u32 hdrlen = sizeof(cmd.id) + sizeof(cmd.write_mem);
137 u32 txlen;
138 int ret;
139
140 ath10k_dbg(ar, ATH10K_DBG_BMI, "bmi write address 0x%x length %d\n",
141 address, length);
142
143 if (ar->bmi.done_sent) {
144 ath10k_warn(ar, "command disallowed\n");
145 return -EBUSY;
146 }
147
148 while (length) {
149 txlen = min(length, BMI_MAX_DATA_SIZE - hdrlen);
150
151
152 memcpy(cmd.write_mem.payload, buffer, txlen);
153 txlen = roundup(txlen, 4);
154
155 cmd.id = __cpu_to_le32(BMI_WRITE_MEMORY);
156 cmd.write_mem.addr = __cpu_to_le32(address);
157 cmd.write_mem.len = __cpu_to_le32(txlen);
158
159 ret = ath10k_hif_exchange_bmi_msg(ar, &cmd, hdrlen + txlen,
160 NULL, NULL);
161 if (ret) {
162 ath10k_warn(ar, "unable to write to the device (%d)\n",
163 ret);
164 return ret;
165 }
166
167
168 txlen = min(txlen, length);
169
170 address += txlen;
171 buffer += txlen;
172 length -= txlen;
173 }
174
175 return 0;
176}
177
178int ath10k_bmi_execute(struct ath10k *ar, u32 address, u32 param, u32 *result)
179{
180 struct bmi_cmd cmd;
181 union bmi_resp resp;
182 u32 cmdlen = sizeof(cmd.id) + sizeof(cmd.execute);
183 u32 resplen = sizeof(resp.execute);
184 int ret;
185
186 ath10k_dbg(ar, ATH10K_DBG_BMI, "bmi execute address 0x%x param 0x%x\n",
187 address, param);
188
189 if (ar->bmi.done_sent) {
190 ath10k_warn(ar, "command disallowed\n");
191 return -EBUSY;
192 }
193
194 cmd.id = __cpu_to_le32(BMI_EXECUTE);
195 cmd.execute.addr = __cpu_to_le32(address);
196 cmd.execute.param = __cpu_to_le32(param);
197
198 ret = ath10k_hif_exchange_bmi_msg(ar, &cmd, cmdlen, &resp, &resplen);
199 if (ret) {
200 ath10k_warn(ar, "unable to read from the device\n");
201 return ret;
202 }
203
204 if (resplen < sizeof(resp.execute)) {
205 ath10k_warn(ar, "invalid execute response length (%d)\n",
206 resplen);
207 return -EIO;
208 }
209
210 *result = __le32_to_cpu(resp.execute.result);
211
212 ath10k_dbg(ar, ATH10K_DBG_BMI, "bmi execute result 0x%x\n", *result);
213
214 return 0;
215}
216
217int ath10k_bmi_lz_data(struct ath10k *ar, const void *buffer, u32 length)
218{
219 struct bmi_cmd cmd;
220 u32 hdrlen = sizeof(cmd.id) + sizeof(cmd.lz_data);
221 u32 txlen;
222 int ret;
223
224 ath10k_dbg(ar, ATH10K_DBG_BMI, "bmi lz data buffer 0x%pK length %d\n",
225 buffer, length);
226
227 if (ar->bmi.done_sent) {
228 ath10k_warn(ar, "command disallowed\n");
229 return -EBUSY;
230 }
231
232 while (length) {
233 txlen = min(length, BMI_MAX_DATA_SIZE - hdrlen);
234
235 WARN_ON_ONCE(txlen & 3);
236
237 cmd.id = __cpu_to_le32(BMI_LZ_DATA);
238 cmd.lz_data.len = __cpu_to_le32(txlen);
239 memcpy(cmd.lz_data.payload, buffer, txlen);
240
241 ret = ath10k_hif_exchange_bmi_msg(ar, &cmd, hdrlen + txlen,
242 NULL, NULL);
243 if (ret) {
244 ath10k_warn(ar, "unable to write to the device\n");
245 return ret;
246 }
247
248 buffer += txlen;
249 length -= txlen;
250 }
251
252 return 0;
253}
254
255int ath10k_bmi_lz_stream_start(struct ath10k *ar, u32 address)
256{
257 struct bmi_cmd cmd;
258 u32 cmdlen = sizeof(cmd.id) + sizeof(cmd.lz_start);
259 int ret;
260
261 ath10k_dbg(ar, ATH10K_DBG_BMI, "bmi lz stream start address 0x%x\n",
262 address);
263
264 if (ar->bmi.done_sent) {
265 ath10k_warn(ar, "command disallowed\n");
266 return -EBUSY;
267 }
268
269 cmd.id = __cpu_to_le32(BMI_LZ_STREAM_START);
270 cmd.lz_start.addr = __cpu_to_le32(address);
271
272 ret = ath10k_hif_exchange_bmi_msg(ar, &cmd, cmdlen, NULL, NULL);
273 if (ret) {
274 ath10k_warn(ar, "unable to Start LZ Stream to the device\n");
275 return ret;
276 }
277
278 return 0;
279}
280
281int ath10k_bmi_fast_download(struct ath10k *ar,
282 u32 address, const void *buffer, u32 length)
283{
284 u8 trailer[4] = {};
285 u32 head_len = rounddown(length, 4);
286 u32 trailer_len = length - head_len;
287 int ret;
288
289 ath10k_dbg(ar, ATH10K_DBG_BMI,
290 "bmi fast download address 0x%x buffer 0x%pK length %d\n",
291 address, buffer, length);
292
293 ret = ath10k_bmi_lz_stream_start(ar, address);
294 if (ret)
295 return ret;
296
297
298 if (trailer_len > 0)
299 memcpy(trailer, buffer + head_len, trailer_len);
300
301 ret = ath10k_bmi_lz_data(ar, buffer, head_len);
302 if (ret)
303 return ret;
304
305 if (trailer_len > 0)
306 ret = ath10k_bmi_lz_data(ar, trailer, 4);
307
308 if (ret != 0)
309 return ret;
310
311
312
313
314
315 ret = ath10k_bmi_lz_stream_start(ar, 0x00);
316
317 return ret;
318}
319
