blob: 31866e3b74fc31a50ffa649049b5ab55d4ad517c [file] [log] [blame]
Michal Kaziorca996ec2014-12-03 10:11:32 +02001/*
2 * Copyright (c) 2005-2011 Atheros Communications Inc.
Kalle Valo8b1083d2017-12-22 18:31:13 +02003 * Copyright (c) 2011-2017 Qualcomm Atheros, Inc.
Rakesh Pillai38a13902018-02-27 19:09:07 +02004 * Copyright (c) 2018, The Linux Foundation. All rights reserved.
Michal Kaziorca996ec2014-12-03 10:11:32 +02005 *
6 * Permission to use, copy, modify, and/or distribute this software for any
7 * purpose with or without fee is hereby granted, provided that the above
8 * copyright notice and this permission notice appear in all copies.
9 *
10 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
11 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
12 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
13 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
14 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
15 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
16 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
17 */
18#include "core.h"
19#include "debug.h"
Michal Kaziorb4aa5392015-03-31 10:26:24 +000020#include "mac.h"
Michal Kaziorca996ec2014-12-03 10:11:32 +020021#include "hw.h"
Michal Kazior81a9a172015-03-05 16:02:17 +020022#include "mac.h"
Michal Kaziorca996ec2014-12-03 10:11:32 +020023#include "wmi.h"
24#include "wmi-ops.h"
25#include "wmi-tlv.h"
Michal Kaziorfe3cbdf2015-02-26 13:23:18 +010026#include "p2p.h"
Alan Liua81a98c2015-10-28 21:38:32 +020027#include "testmode.h"
Michal Kaziorca996ec2014-12-03 10:11:32 +020028
29/***************/
30/* TLV helpers */
31/**************/
32
33struct wmi_tlv_policy {
34 size_t min_len;
35};
36
37static const struct wmi_tlv_policy wmi_tlv_policies[] = {
38 [WMI_TLV_TAG_ARRAY_BYTE]
Janusz Dziedzicf5431e82015-03-23 17:32:53 +020039 = { .min_len = 0 },
Michal Kaziorca996ec2014-12-03 10:11:32 +020040 [WMI_TLV_TAG_ARRAY_UINT32]
Janusz Dziedzicf5431e82015-03-23 17:32:53 +020041 = { .min_len = 0 },
Michal Kaziorca996ec2014-12-03 10:11:32 +020042 [WMI_TLV_TAG_STRUCT_SCAN_EVENT]
43 = { .min_len = sizeof(struct wmi_scan_event) },
44 [WMI_TLV_TAG_STRUCT_MGMT_RX_HDR]
45 = { .min_len = sizeof(struct wmi_tlv_mgmt_rx_ev) },
46 [WMI_TLV_TAG_STRUCT_CHAN_INFO_EVENT]
47 = { .min_len = sizeof(struct wmi_chan_info_event) },
48 [WMI_TLV_TAG_STRUCT_VDEV_START_RESPONSE_EVENT]
49 = { .min_len = sizeof(struct wmi_vdev_start_response_event) },
50 [WMI_TLV_TAG_STRUCT_PEER_STA_KICKOUT_EVENT]
51 = { .min_len = sizeof(struct wmi_peer_sta_kickout_event) },
52 [WMI_TLV_TAG_STRUCT_HOST_SWBA_EVENT]
53 = { .min_len = sizeof(struct wmi_host_swba_event) },
54 [WMI_TLV_TAG_STRUCT_TIM_INFO]
55 = { .min_len = sizeof(struct wmi_tim_info) },
56 [WMI_TLV_TAG_STRUCT_P2P_NOA_INFO]
57 = { .min_len = sizeof(struct wmi_p2p_noa_info) },
58 [WMI_TLV_TAG_STRUCT_SERVICE_READY_EVENT]
59 = { .min_len = sizeof(struct wmi_tlv_svc_rdy_ev) },
60 [WMI_TLV_TAG_STRUCT_HAL_REG_CAPABILITIES]
61 = { .min_len = sizeof(struct hal_reg_capabilities) },
62 [WMI_TLV_TAG_STRUCT_WLAN_HOST_MEM_REQ]
63 = { .min_len = sizeof(struct wlan_host_mem_req) },
64 [WMI_TLV_TAG_STRUCT_READY_EVENT]
65 = { .min_len = sizeof(struct wmi_tlv_rdy_ev) },
Michal Kazior6bf12062015-01-13 16:30:10 +020066 [WMI_TLV_TAG_STRUCT_OFFLOAD_BCN_TX_STATUS_EVENT]
67 = { .min_len = sizeof(struct wmi_tlv_bcn_tx_status_ev) },
Michal Kazior04de6c62015-01-24 12:14:47 +020068 [WMI_TLV_TAG_STRUCT_DIAG_DATA_CONTAINER_EVENT]
69 = { .min_len = sizeof(struct wmi_tlv_diag_data_ev) },
Michal Kaziorfe3cbdf2015-02-26 13:23:18 +010070 [WMI_TLV_TAG_STRUCT_P2P_NOA_EVENT]
71 = { .min_len = sizeof(struct wmi_tlv_p2p_noa_ev) },
Michal Kaziorc1a46542015-03-10 16:21:54 +020072 [WMI_TLV_TAG_STRUCT_ROAM_EVENT]
73 = { .min_len = sizeof(struct wmi_tlv_roam_ev) },
Janusz Dziedzicf5431e82015-03-23 17:32:53 +020074 [WMI_TLV_TAG_STRUCT_WOW_EVENT_INFO]
75 = { .min_len = sizeof(struct wmi_tlv_wow_event_info) },
Michal Kaziorb4aa5392015-03-31 10:26:24 +000076 [WMI_TLV_TAG_STRUCT_TX_PAUSE_EVENT]
77 = { .min_len = sizeof(struct wmi_tlv_tx_pause_ev) },
Michal Kaziorca996ec2014-12-03 10:11:32 +020078};
79
80static int
81ath10k_wmi_tlv_iter(struct ath10k *ar, const void *ptr, size_t len,
82 int (*iter)(struct ath10k *ar, u16 tag, u16 len,
83 const void *ptr, void *data),
84 void *data)
85{
86 const void *begin = ptr;
87 const struct wmi_tlv *tlv;
88 u16 tlv_tag, tlv_len;
89 int ret;
90
91 while (len > 0) {
92 if (len < sizeof(*tlv)) {
93 ath10k_dbg(ar, ATH10K_DBG_WMI,
94 "wmi tlv parse failure at byte %zd (%zu bytes left, %zu expected)\n",
95 ptr - begin, len, sizeof(*tlv));
96 return -EINVAL;
97 }
98
99 tlv = ptr;
100 tlv_tag = __le16_to_cpu(tlv->tag);
101 tlv_len = __le16_to_cpu(tlv->len);
102 ptr += sizeof(*tlv);
103 len -= sizeof(*tlv);
104
105 if (tlv_len > len) {
106 ath10k_dbg(ar, ATH10K_DBG_WMI,
107 "wmi tlv parse failure of tag %hhu at byte %zd (%zu bytes left, %hhu expected)\n",
108 tlv_tag, ptr - begin, len, tlv_len);
109 return -EINVAL;
110 }
111
112 if (tlv_tag < ARRAY_SIZE(wmi_tlv_policies) &&
113 wmi_tlv_policies[tlv_tag].min_len &&
114 wmi_tlv_policies[tlv_tag].min_len > tlv_len) {
115 ath10k_dbg(ar, ATH10K_DBG_WMI,
116 "wmi tlv parse failure of tag %hhu at byte %zd (%hhu bytes is less than min length %zu)\n",
117 tlv_tag, ptr - begin, tlv_len,
118 wmi_tlv_policies[tlv_tag].min_len);
119 return -EINVAL;
120 }
121
122 ret = iter(ar, tlv_tag, tlv_len, ptr, data);
123 if (ret)
124 return ret;
125
126 ptr += tlv_len;
127 len -= tlv_len;
128 }
129
130 return 0;
131}
132
133static int ath10k_wmi_tlv_iter_parse(struct ath10k *ar, u16 tag, u16 len,
134 const void *ptr, void *data)
135{
136 const void **tb = data;
137
138 if (tag < WMI_TLV_TAG_MAX)
139 tb[tag] = ptr;
140
141 return 0;
142}
143
144static int ath10k_wmi_tlv_parse(struct ath10k *ar, const void **tb,
145 const void *ptr, size_t len)
146{
147 return ath10k_wmi_tlv_iter(ar, ptr, len, ath10k_wmi_tlv_iter_parse,
148 (void *)tb);
149}
150
151static const void **
152ath10k_wmi_tlv_parse_alloc(struct ath10k *ar, const void *ptr,
153 size_t len, gfp_t gfp)
154{
155 const void **tb;
156 int ret;
157
158 tb = kzalloc(sizeof(*tb) * WMI_TLV_TAG_MAX, gfp);
159 if (!tb)
160 return ERR_PTR(-ENOMEM);
161
162 ret = ath10k_wmi_tlv_parse(ar, tb, ptr, len);
163 if (ret) {
164 kfree(tb);
165 return ERR_PTR(ret);
166 }
167
168 return tb;
169}
170
171static u16 ath10k_wmi_tlv_len(const void *ptr)
172{
173 return __le16_to_cpu((((const struct wmi_tlv *)ptr) - 1)->len);
174}
175
Michal Kazior6bf12062015-01-13 16:30:10 +0200176/**************/
177/* TLV events */
178/**************/
179static int ath10k_wmi_tlv_event_bcn_tx_status(struct ath10k *ar,
180 struct sk_buff *skb)
181{
182 const void **tb;
183 const struct wmi_tlv_bcn_tx_status_ev *ev;
Michal Kazior81a9a172015-03-05 16:02:17 +0200184 struct ath10k_vif *arvif;
Michal Kazior6bf12062015-01-13 16:30:10 +0200185 u32 vdev_id, tx_status;
186 int ret;
187
188 tb = ath10k_wmi_tlv_parse_alloc(ar, skb->data, skb->len, GFP_ATOMIC);
189 if (IS_ERR(tb)) {
190 ret = PTR_ERR(tb);
191 ath10k_warn(ar, "failed to parse tlv: %d\n", ret);
192 return ret;
193 }
194
195 ev = tb[WMI_TLV_TAG_STRUCT_OFFLOAD_BCN_TX_STATUS_EVENT];
196 if (!ev) {
197 kfree(tb);
198 return -EPROTO;
199 }
200
201 tx_status = __le32_to_cpu(ev->tx_status);
202 vdev_id = __le32_to_cpu(ev->vdev_id);
203
204 switch (tx_status) {
205 case WMI_TLV_BCN_TX_STATUS_OK:
206 break;
207 case WMI_TLV_BCN_TX_STATUS_XRETRY:
208 case WMI_TLV_BCN_TX_STATUS_DROP:
209 case WMI_TLV_BCN_TX_STATUS_FILTERED:
210 /* FIXME: It's probably worth telling mac80211 to stop the
211 * interface as it is crippled.
212 */
213 ath10k_warn(ar, "received bcn tmpl tx status on vdev %i: %d",
214 vdev_id, tx_status);
215 break;
216 }
217
Michal Kazior81a9a172015-03-05 16:02:17 +0200218 arvif = ath10k_get_arvif(ar, vdev_id);
Michal Kazior8513d952015-03-09 14:19:24 +0100219 if (arvif && arvif->is_up && arvif->vif->csa_active)
Michal Kazior81a9a172015-03-05 16:02:17 +0200220 ieee80211_queue_work(ar->hw, &arvif->ap_csa_work);
Michal Kazior81a9a172015-03-05 16:02:17 +0200221
Michal Kazior6bf12062015-01-13 16:30:10 +0200222 kfree(tb);
223 return 0;
224}
225
Michal Kazior04de6c62015-01-24 12:14:47 +0200226static int ath10k_wmi_tlv_event_diag_data(struct ath10k *ar,
227 struct sk_buff *skb)
228{
229 const void **tb;
230 const struct wmi_tlv_diag_data_ev *ev;
231 const struct wmi_tlv_diag_item *item;
232 const void *data;
233 int ret, num_items, len;
234
235 tb = ath10k_wmi_tlv_parse_alloc(ar, skb->data, skb->len, GFP_ATOMIC);
236 if (IS_ERR(tb)) {
237 ret = PTR_ERR(tb);
238 ath10k_warn(ar, "failed to parse tlv: %d\n", ret);
239 return ret;
240 }
241
242 ev = tb[WMI_TLV_TAG_STRUCT_DIAG_DATA_CONTAINER_EVENT];
243 data = tb[WMI_TLV_TAG_ARRAY_BYTE];
244 if (!ev || !data) {
245 kfree(tb);
246 return -EPROTO;
247 }
248
249 num_items = __le32_to_cpu(ev->num_items);
250 len = ath10k_wmi_tlv_len(data);
251
252 while (num_items--) {
253 if (len == 0)
254 break;
255 if (len < sizeof(*item)) {
256 ath10k_warn(ar, "failed to parse diag data: can't fit item header\n");
257 break;
258 }
259
260 item = data;
261
262 if (len < sizeof(*item) + __le16_to_cpu(item->len)) {
263 ath10k_warn(ar, "failed to parse diag data: item is too long\n");
264 break;
265 }
266
267 trace_ath10k_wmi_diag_container(ar,
268 item->type,
269 __le32_to_cpu(item->timestamp),
270 __le32_to_cpu(item->code),
271 __le16_to_cpu(item->len),
272 item->payload);
273
274 len -= sizeof(*item);
275 len -= roundup(__le16_to_cpu(item->len), 4);
276
277 data += sizeof(*item);
278 data += roundup(__le16_to_cpu(item->len), 4);
279 }
280
281 if (num_items != -1 || len != 0)
282 ath10k_warn(ar, "failed to parse diag data event: num_items %d len %d\n",
283 num_items, len);
284
285 kfree(tb);
286 return 0;
287}
288
Michal Kaziorc3113c32015-01-24 12:14:47 +0200289static int ath10k_wmi_tlv_event_diag(struct ath10k *ar,
290 struct sk_buff *skb)
291{
292 const void **tb;
293 const void *data;
294 int ret, len;
295
296 tb = ath10k_wmi_tlv_parse_alloc(ar, skb->data, skb->len, GFP_ATOMIC);
297 if (IS_ERR(tb)) {
298 ret = PTR_ERR(tb);
299 ath10k_warn(ar, "failed to parse tlv: %d\n", ret);
300 return ret;
301 }
302
303 data = tb[WMI_TLV_TAG_ARRAY_BYTE];
304 if (!data) {
305 kfree(tb);
306 return -EPROTO;
307 }
308 len = ath10k_wmi_tlv_len(data);
309
310 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv diag event len %d\n", len);
311 trace_ath10k_wmi_diag(ar, data, len);
312
313 kfree(tb);
314 return 0;
315}
316
Michal Kaziorfe3cbdf2015-02-26 13:23:18 +0100317static int ath10k_wmi_tlv_event_p2p_noa(struct ath10k *ar,
318 struct sk_buff *skb)
319{
320 const void **tb;
321 const struct wmi_tlv_p2p_noa_ev *ev;
322 const struct wmi_p2p_noa_info *noa;
323 int ret, vdev_id;
324
325 tb = ath10k_wmi_tlv_parse_alloc(ar, skb->data, skb->len, GFP_ATOMIC);
326 if (IS_ERR(tb)) {
327 ret = PTR_ERR(tb);
328 ath10k_warn(ar, "failed to parse tlv: %d\n", ret);
329 return ret;
330 }
331
332 ev = tb[WMI_TLV_TAG_STRUCT_P2P_NOA_EVENT];
333 noa = tb[WMI_TLV_TAG_STRUCT_P2P_NOA_INFO];
334
335 if (!ev || !noa) {
336 kfree(tb);
337 return -EPROTO;
338 }
339
340 vdev_id = __le32_to_cpu(ev->vdev_id);
341
342 ath10k_dbg(ar, ATH10K_DBG_WMI,
343 "wmi tlv p2p noa vdev_id %i descriptors %hhu\n",
344 vdev_id, noa->num_descriptors);
345
346 ath10k_p2p_noa_update_by_vdev_id(ar, vdev_id, noa);
Michal Kaziorb4aa5392015-03-31 10:26:24 +0000347 kfree(tb);
348 return 0;
349}
350
351static int ath10k_wmi_tlv_event_tx_pause(struct ath10k *ar,
352 struct sk_buff *skb)
353{
354 const void **tb;
355 const struct wmi_tlv_tx_pause_ev *ev;
356 int ret, vdev_id;
357 u32 pause_id, action, vdev_map, peer_id, tid_map;
358
359 tb = ath10k_wmi_tlv_parse_alloc(ar, skb->data, skb->len, GFP_ATOMIC);
360 if (IS_ERR(tb)) {
361 ret = PTR_ERR(tb);
362 ath10k_warn(ar, "failed to parse tlv: %d\n", ret);
363 return ret;
364 }
365
366 ev = tb[WMI_TLV_TAG_STRUCT_TX_PAUSE_EVENT];
367 if (!ev) {
368 kfree(tb);
369 return -EPROTO;
370 }
371
372 pause_id = __le32_to_cpu(ev->pause_id);
373 action = __le32_to_cpu(ev->action);
374 vdev_map = __le32_to_cpu(ev->vdev_map);
375 peer_id = __le32_to_cpu(ev->peer_id);
376 tid_map = __le32_to_cpu(ev->tid_map);
377
378 ath10k_dbg(ar, ATH10K_DBG_WMI,
379 "wmi tlv tx pause pause_id %u action %u vdev_map 0x%08x peer_id %u tid_map 0x%08x\n",
380 pause_id, action, vdev_map, peer_id, tid_map);
381
Michal Kazioracd0b272015-07-09 13:08:38 +0200382 switch (pause_id) {
383 case WMI_TLV_TX_PAUSE_ID_MCC:
384 case WMI_TLV_TX_PAUSE_ID_P2P_CLI_NOA:
385 case WMI_TLV_TX_PAUSE_ID_P2P_GO_PS:
386 case WMI_TLV_TX_PAUSE_ID_AP_PS:
387 case WMI_TLV_TX_PAUSE_ID_IBSS_PS:
388 for (vdev_id = 0; vdev_map; vdev_id++) {
389 if (!(vdev_map & BIT(vdev_id)))
390 continue;
Michal Kaziorb4aa5392015-03-31 10:26:24 +0000391
Michal Kazioracd0b272015-07-09 13:08:38 +0200392 vdev_map &= ~BIT(vdev_id);
393 ath10k_mac_handle_tx_pause_vdev(ar, vdev_id, pause_id,
394 action);
395 }
396 break;
397 case WMI_TLV_TX_PAUSE_ID_AP_PEER_PS:
398 case WMI_TLV_TX_PAUSE_ID_AP_PEER_UAPSD:
399 case WMI_TLV_TX_PAUSE_ID_STA_ADD_BA:
400 case WMI_TLV_TX_PAUSE_ID_HOST:
401 ath10k_dbg(ar, ATH10K_DBG_MAC,
402 "mac ignoring unsupported tx pause id %d\n",
403 pause_id);
404 break;
405 default:
406 ath10k_dbg(ar, ATH10K_DBG_MAC,
407 "mac ignoring unknown tx pause vdev %d\n",
408 pause_id);
409 break;
Michal Kaziorb4aa5392015-03-31 10:26:24 +0000410 }
Michal Kaziorfe3cbdf2015-02-26 13:23:18 +0100411
412 kfree(tb);
413 return 0;
414}
415
Ryan Hsue98199a2018-03-27 11:25:36 +0300416static int ath10k_wmi_tlv_event_temperature(struct ath10k *ar,
417 struct sk_buff *skb)
418{
419 const struct wmi_tlv_pdev_temperature_event *ev;
420
421 ev = (struct wmi_tlv_pdev_temperature_event *)skb->data;
422 if (WARN_ON(skb->len < sizeof(*ev)))
423 return -EPROTO;
424
425 ath10k_thermal_event_temperature(ar, __le32_to_cpu(ev->temperature));
426 return 0;
427}
428
Yingying Tang4c9f8d12018-03-28 12:13:07 +0300429static void ath10k_wmi_event_tdls_peer(struct ath10k *ar, struct sk_buff *skb)
430{
431 struct ieee80211_sta *station;
432 const struct wmi_tlv_tdls_peer_event *ev;
433 const void **tb;
434 struct ath10k_vif *arvif;
435
436 tb = ath10k_wmi_tlv_parse_alloc(ar, skb->data, skb->len, GFP_ATOMIC);
437 if (IS_ERR(tb)) {
438 ath10k_warn(ar, "tdls peer failed to parse tlv");
439 return;
440 }
441 ev = tb[WMI_TLV_TAG_STRUCT_TDLS_PEER_EVENT];
442 if (!ev) {
443 kfree(tb);
444 ath10k_warn(ar, "tdls peer NULL event");
445 return;
446 }
447
448 switch (__le32_to_cpu(ev->peer_reason)) {
449 case WMI_TDLS_TEARDOWN_REASON_TX:
450 case WMI_TDLS_TEARDOWN_REASON_RSSI:
451 case WMI_TDLS_TEARDOWN_REASON_PTR_TIMEOUT:
452 station = ieee80211_find_sta_by_ifaddr(ar->hw,
453 ev->peer_macaddr.addr,
454 NULL);
455 if (!station) {
456 ath10k_warn(ar, "did not find station from tdls peer event");
457 kfree(tb);
458 return;
459 }
460 arvif = ath10k_get_arvif(ar, __le32_to_cpu(ev->vdev_id));
461 ieee80211_tdls_oper_request(
462 arvif->vif, station->addr,
463 NL80211_TDLS_TEARDOWN,
464 WLAN_REASON_TDLS_TEARDOWN_UNREACHABLE,
465 GFP_ATOMIC
466 );
467 break;
468 }
469 kfree(tb);
470}
471
Michal Kaziorca996ec2014-12-03 10:11:32 +0200472/***********/
473/* TLV ops */
474/***********/
475
476static void ath10k_wmi_tlv_op_rx(struct ath10k *ar, struct sk_buff *skb)
477{
478 struct wmi_cmd_hdr *cmd_hdr;
479 enum wmi_tlv_event_id id;
Alan Liua81a98c2015-10-28 21:38:32 +0200480 bool consumed;
Michal Kaziorca996ec2014-12-03 10:11:32 +0200481
482 cmd_hdr = (struct wmi_cmd_hdr *)skb->data;
483 id = MS(__le32_to_cpu(cmd_hdr->cmd_id), WMI_CMD_HDR_CMD_ID);
484
485 if (skb_pull(skb, sizeof(struct wmi_cmd_hdr)) == NULL)
Michal Kazior469d4792015-06-08 13:23:27 +0200486 goto out;
Michal Kaziorca996ec2014-12-03 10:11:32 +0200487
488 trace_ath10k_wmi_event(ar, id, skb->data, skb->len);
489
Alan Liua81a98c2015-10-28 21:38:32 +0200490 consumed = ath10k_tm_event_wmi(ar, id, skb);
491
492 /* Ready event must be handled normally also in UTF mode so that we
493 * know the UTF firmware has booted, others we are just bypass WMI
494 * events to testmode.
495 */
496 if (consumed && id != WMI_TLV_READY_EVENTID) {
497 ath10k_dbg(ar, ATH10K_DBG_WMI,
498 "wmi tlv testmode consumed 0x%x\n", id);
499 goto out;
500 }
501
Michal Kaziorca996ec2014-12-03 10:11:32 +0200502 switch (id) {
503 case WMI_TLV_MGMT_RX_EVENTID:
504 ath10k_wmi_event_mgmt_rx(ar, skb);
505 /* mgmt_rx() owns the skb now! */
506 return;
507 case WMI_TLV_SCAN_EVENTID:
508 ath10k_wmi_event_scan(ar, skb);
509 break;
510 case WMI_TLV_CHAN_INFO_EVENTID:
511 ath10k_wmi_event_chan_info(ar, skb);
512 break;
513 case WMI_TLV_ECHO_EVENTID:
514 ath10k_wmi_event_echo(ar, skb);
515 break;
516 case WMI_TLV_DEBUG_MESG_EVENTID:
517 ath10k_wmi_event_debug_mesg(ar, skb);
518 break;
519 case WMI_TLV_UPDATE_STATS_EVENTID:
520 ath10k_wmi_event_update_stats(ar, skb);
521 break;
522 case WMI_TLV_VDEV_START_RESP_EVENTID:
523 ath10k_wmi_event_vdev_start_resp(ar, skb);
524 break;
525 case WMI_TLV_VDEV_STOPPED_EVENTID:
526 ath10k_wmi_event_vdev_stopped(ar, skb);
527 break;
528 case WMI_TLV_PEER_STA_KICKOUT_EVENTID:
529 ath10k_wmi_event_peer_sta_kickout(ar, skb);
530 break;
531 case WMI_TLV_HOST_SWBA_EVENTID:
532 ath10k_wmi_event_host_swba(ar, skb);
533 break;
534 case WMI_TLV_TBTTOFFSET_UPDATE_EVENTID:
535 ath10k_wmi_event_tbttoffset_update(ar, skb);
536 break;
537 case WMI_TLV_PHYERR_EVENTID:
538 ath10k_wmi_event_phyerr(ar, skb);
539 break;
540 case WMI_TLV_ROAM_EVENTID:
541 ath10k_wmi_event_roam(ar, skb);
542 break;
543 case WMI_TLV_PROFILE_MATCH:
544 ath10k_wmi_event_profile_match(ar, skb);
545 break;
546 case WMI_TLV_DEBUG_PRINT_EVENTID:
547 ath10k_wmi_event_debug_print(ar, skb);
548 break;
549 case WMI_TLV_PDEV_QVIT_EVENTID:
550 ath10k_wmi_event_pdev_qvit(ar, skb);
551 break;
552 case WMI_TLV_WLAN_PROFILE_DATA_EVENTID:
553 ath10k_wmi_event_wlan_profile_data(ar, skb);
554 break;
555 case WMI_TLV_RTT_MEASUREMENT_REPORT_EVENTID:
556 ath10k_wmi_event_rtt_measurement_report(ar, skb);
557 break;
558 case WMI_TLV_TSF_MEASUREMENT_REPORT_EVENTID:
559 ath10k_wmi_event_tsf_measurement_report(ar, skb);
560 break;
561 case WMI_TLV_RTT_ERROR_REPORT_EVENTID:
562 ath10k_wmi_event_rtt_error_report(ar, skb);
563 break;
564 case WMI_TLV_WOW_WAKEUP_HOST_EVENTID:
565 ath10k_wmi_event_wow_wakeup_host(ar, skb);
566 break;
567 case WMI_TLV_DCS_INTERFERENCE_EVENTID:
568 ath10k_wmi_event_dcs_interference(ar, skb);
569 break;
570 case WMI_TLV_PDEV_TPC_CONFIG_EVENTID:
571 ath10k_wmi_event_pdev_tpc_config(ar, skb);
572 break;
573 case WMI_TLV_PDEV_FTM_INTG_EVENTID:
574 ath10k_wmi_event_pdev_ftm_intg(ar, skb);
575 break;
576 case WMI_TLV_GTK_OFFLOAD_STATUS_EVENTID:
577 ath10k_wmi_event_gtk_offload_status(ar, skb);
578 break;
579 case WMI_TLV_GTK_REKEY_FAIL_EVENTID:
580 ath10k_wmi_event_gtk_rekey_fail(ar, skb);
581 break;
582 case WMI_TLV_TX_DELBA_COMPLETE_EVENTID:
583 ath10k_wmi_event_delba_complete(ar, skb);
584 break;
585 case WMI_TLV_TX_ADDBA_COMPLETE_EVENTID:
586 ath10k_wmi_event_addba_complete(ar, skb);
587 break;
588 case WMI_TLV_VDEV_INSTALL_KEY_COMPLETE_EVENTID:
589 ath10k_wmi_event_vdev_install_key_complete(ar, skb);
590 break;
591 case WMI_TLV_SERVICE_READY_EVENTID:
592 ath10k_wmi_event_service_ready(ar, skb);
Raja Manic8ecfc12015-07-29 11:40:38 +0300593 return;
Michal Kaziorca996ec2014-12-03 10:11:32 +0200594 case WMI_TLV_READY_EVENTID:
595 ath10k_wmi_event_ready(ar, skb);
596 break;
Carl Huangcea19a62018-04-19 19:39:38 +0300597 case WMI_TLV_SERVICE_AVAILABLE_EVENTID:
598 ath10k_wmi_event_service_available(ar, skb);
599 break;
Michal Kazior6bf12062015-01-13 16:30:10 +0200600 case WMI_TLV_OFFLOAD_BCN_TX_STATUS_EVENTID:
601 ath10k_wmi_tlv_event_bcn_tx_status(ar, skb);
602 break;
Michal Kazior04de6c62015-01-24 12:14:47 +0200603 case WMI_TLV_DIAG_DATA_CONTAINER_EVENTID:
604 ath10k_wmi_tlv_event_diag_data(ar, skb);
605 break;
Michal Kaziorc3113c32015-01-24 12:14:47 +0200606 case WMI_TLV_DIAG_EVENTID:
607 ath10k_wmi_tlv_event_diag(ar, skb);
608 break;
Michal Kaziorfe3cbdf2015-02-26 13:23:18 +0100609 case WMI_TLV_P2P_NOA_EVENTID:
610 ath10k_wmi_tlv_event_p2p_noa(ar, skb);
611 break;
Michal Kaziorb4aa5392015-03-31 10:26:24 +0000612 case WMI_TLV_TX_PAUSE_EVENTID:
613 ath10k_wmi_tlv_event_tx_pause(ar, skb);
614 break;
Ryan Hsue98199a2018-03-27 11:25:36 +0300615 case WMI_TLV_PDEV_TEMPERATURE_EVENTID:
616 ath10k_wmi_tlv_event_temperature(ar, skb);
617 break;
Yingying Tang4c9f8d12018-03-28 12:13:07 +0300618 case WMI_TLV_TDLS_PEER_EVENTID:
619 ath10k_wmi_event_tdls_peer(ar, skb);
620 break;
Michal Kaziorca996ec2014-12-03 10:11:32 +0200621 default:
622 ath10k_warn(ar, "Unknown eventid: %d\n", id);
623 break;
624 }
625
Michal Kazior469d4792015-06-08 13:23:27 +0200626out:
Michal Kaziorca996ec2014-12-03 10:11:32 +0200627 dev_kfree_skb(skb);
628}
629
630static int ath10k_wmi_tlv_op_pull_scan_ev(struct ath10k *ar,
631 struct sk_buff *skb,
632 struct wmi_scan_ev_arg *arg)
633{
634 const void **tb;
635 const struct wmi_scan_event *ev;
636 int ret;
637
638 tb = ath10k_wmi_tlv_parse_alloc(ar, skb->data, skb->len, GFP_ATOMIC);
639 if (IS_ERR(tb)) {
640 ret = PTR_ERR(tb);
641 ath10k_warn(ar, "failed to parse tlv: %d\n", ret);
642 return ret;
643 }
644
645 ev = tb[WMI_TLV_TAG_STRUCT_SCAN_EVENT];
646 if (!ev) {
647 kfree(tb);
648 return -EPROTO;
649 }
650
651 arg->event_type = ev->event_type;
652 arg->reason = ev->reason;
653 arg->channel_freq = ev->channel_freq;
654 arg->scan_req_id = ev->scan_req_id;
655 arg->scan_id = ev->scan_id;
656 arg->vdev_id = ev->vdev_id;
657
658 kfree(tb);
659 return 0;
660}
661
662static int ath10k_wmi_tlv_op_pull_mgmt_rx_ev(struct ath10k *ar,
663 struct sk_buff *skb,
664 struct wmi_mgmt_rx_ev_arg *arg)
665{
666 const void **tb;
667 const struct wmi_tlv_mgmt_rx_ev *ev;
668 const u8 *frame;
669 u32 msdu_len;
670 int ret;
671
672 tb = ath10k_wmi_tlv_parse_alloc(ar, skb->data, skb->len, GFP_ATOMIC);
673 if (IS_ERR(tb)) {
674 ret = PTR_ERR(tb);
675 ath10k_warn(ar, "failed to parse tlv: %d\n", ret);
676 return ret;
677 }
678
679 ev = tb[WMI_TLV_TAG_STRUCT_MGMT_RX_HDR];
680 frame = tb[WMI_TLV_TAG_ARRAY_BYTE];
681
682 if (!ev || !frame) {
683 kfree(tb);
684 return -EPROTO;
685 }
686
687 arg->channel = ev->channel;
688 arg->buf_len = ev->buf_len;
689 arg->status = ev->status;
690 arg->snr = ev->snr;
691 arg->phy_mode = ev->phy_mode;
692 arg->rate = ev->rate;
693
694 msdu_len = __le32_to_cpu(arg->buf_len);
695
696 if (skb->len < (frame - skb->data) + msdu_len) {
697 kfree(tb);
698 return -EPROTO;
699 }
700
701 /* shift the sk_buff to point to `frame` */
702 skb_trim(skb, 0);
703 skb_put(skb, frame - skb->data);
704 skb_pull(skb, frame - skb->data);
705 skb_put(skb, msdu_len);
706
707 kfree(tb);
708 return 0;
709}
710
711static int ath10k_wmi_tlv_op_pull_ch_info_ev(struct ath10k *ar,
712 struct sk_buff *skb,
713 struct wmi_ch_info_ev_arg *arg)
714{
715 const void **tb;
716 const struct wmi_chan_info_event *ev;
717 int ret;
718
719 tb = ath10k_wmi_tlv_parse_alloc(ar, skb->data, skb->len, GFP_ATOMIC);
720 if (IS_ERR(tb)) {
721 ret = PTR_ERR(tb);
722 ath10k_warn(ar, "failed to parse tlv: %d\n", ret);
723 return ret;
724 }
725
726 ev = tb[WMI_TLV_TAG_STRUCT_CHAN_INFO_EVENT];
727 if (!ev) {
728 kfree(tb);
729 return -EPROTO;
730 }
731
732 arg->err_code = ev->err_code;
733 arg->freq = ev->freq;
734 arg->cmd_flags = ev->cmd_flags;
735 arg->noise_floor = ev->noise_floor;
736 arg->rx_clear_count = ev->rx_clear_count;
737 arg->cycle_count = ev->cycle_count;
738
739 kfree(tb);
740 return 0;
741}
742
743static int
744ath10k_wmi_tlv_op_pull_vdev_start_ev(struct ath10k *ar, struct sk_buff *skb,
745 struct wmi_vdev_start_ev_arg *arg)
746{
747 const void **tb;
748 const struct wmi_vdev_start_response_event *ev;
749 int ret;
750
751 tb = ath10k_wmi_tlv_parse_alloc(ar, skb->data, skb->len, GFP_ATOMIC);
752 if (IS_ERR(tb)) {
753 ret = PTR_ERR(tb);
754 ath10k_warn(ar, "failed to parse tlv: %d\n", ret);
755 return ret;
756 }
757
758 ev = tb[WMI_TLV_TAG_STRUCT_VDEV_START_RESPONSE_EVENT];
759 if (!ev) {
760 kfree(tb);
761 return -EPROTO;
762 }
763
764 skb_pull(skb, sizeof(*ev));
765 arg->vdev_id = ev->vdev_id;
766 arg->req_id = ev->req_id;
767 arg->resp_type = ev->resp_type;
768 arg->status = ev->status;
769
770 kfree(tb);
771 return 0;
772}
773
774static int ath10k_wmi_tlv_op_pull_peer_kick_ev(struct ath10k *ar,
775 struct sk_buff *skb,
776 struct wmi_peer_kick_ev_arg *arg)
777{
778 const void **tb;
779 const struct wmi_peer_sta_kickout_event *ev;
780 int ret;
781
782 tb = ath10k_wmi_tlv_parse_alloc(ar, skb->data, skb->len, GFP_ATOMIC);
783 if (IS_ERR(tb)) {
784 ret = PTR_ERR(tb);
785 ath10k_warn(ar, "failed to parse tlv: %d\n", ret);
786 return ret;
787 }
788
789 ev = tb[WMI_TLV_TAG_STRUCT_PEER_STA_KICKOUT_EVENT];
790 if (!ev) {
791 kfree(tb);
792 return -EPROTO;
793 }
794
795 arg->mac_addr = ev->peer_macaddr.addr;
796
797 kfree(tb);
798 return 0;
799}
800
801struct wmi_tlv_swba_parse {
802 const struct wmi_host_swba_event *ev;
803 bool tim_done;
804 bool noa_done;
805 size_t n_tim;
806 size_t n_noa;
807 struct wmi_swba_ev_arg *arg;
808};
809
810static int ath10k_wmi_tlv_swba_tim_parse(struct ath10k *ar, u16 tag, u16 len,
811 const void *ptr, void *data)
812{
813 struct wmi_tlv_swba_parse *swba = data;
Raja Mania03fee32015-06-22 20:22:20 +0530814 struct wmi_tim_info_arg *tim_info_arg;
815 const struct wmi_tim_info *tim_info_ev = ptr;
Michal Kaziorca996ec2014-12-03 10:11:32 +0200816
817 if (tag != WMI_TLV_TAG_STRUCT_TIM_INFO)
818 return -EPROTO;
819
820 if (swba->n_tim >= ARRAY_SIZE(swba->arg->tim_info))
821 return -ENOBUFS;
822
Raja Mania03fee32015-06-22 20:22:20 +0530823 if (__le32_to_cpu(tim_info_ev->tim_len) >
824 sizeof(tim_info_ev->tim_bitmap)) {
825 ath10k_warn(ar, "refusing to parse invalid swba structure\n");
826 return -EPROTO;
827 }
828
829 tim_info_arg = &swba->arg->tim_info[swba->n_tim];
830 tim_info_arg->tim_len = tim_info_ev->tim_len;
831 tim_info_arg->tim_mcast = tim_info_ev->tim_mcast;
832 tim_info_arg->tim_bitmap = tim_info_ev->tim_bitmap;
833 tim_info_arg->tim_changed = tim_info_ev->tim_changed;
834 tim_info_arg->tim_num_ps_pending = tim_info_ev->tim_num_ps_pending;
835
836 swba->n_tim++;
837
Michal Kaziorca996ec2014-12-03 10:11:32 +0200838 return 0;
839}
840
841static int ath10k_wmi_tlv_swba_noa_parse(struct ath10k *ar, u16 tag, u16 len,
842 const void *ptr, void *data)
843{
844 struct wmi_tlv_swba_parse *swba = data;
845
846 if (tag != WMI_TLV_TAG_STRUCT_P2P_NOA_INFO)
847 return -EPROTO;
848
849 if (swba->n_noa >= ARRAY_SIZE(swba->arg->noa_info))
850 return -ENOBUFS;
851
852 swba->arg->noa_info[swba->n_noa++] = ptr;
853 return 0;
854}
855
856static int ath10k_wmi_tlv_swba_parse(struct ath10k *ar, u16 tag, u16 len,
857 const void *ptr, void *data)
858{
859 struct wmi_tlv_swba_parse *swba = data;
860 int ret;
861
862 switch (tag) {
863 case WMI_TLV_TAG_STRUCT_HOST_SWBA_EVENT:
864 swba->ev = ptr;
865 break;
866 case WMI_TLV_TAG_ARRAY_STRUCT:
867 if (!swba->tim_done) {
868 swba->tim_done = true;
869 ret = ath10k_wmi_tlv_iter(ar, ptr, len,
870 ath10k_wmi_tlv_swba_tim_parse,
871 swba);
872 if (ret)
873 return ret;
874 } else if (!swba->noa_done) {
875 swba->noa_done = true;
876 ret = ath10k_wmi_tlv_iter(ar, ptr, len,
877 ath10k_wmi_tlv_swba_noa_parse,
878 swba);
879 if (ret)
880 return ret;
881 }
882 break;
883 default:
884 break;
885 }
886 return 0;
887}
888
889static int ath10k_wmi_tlv_op_pull_swba_ev(struct ath10k *ar,
890 struct sk_buff *skb,
891 struct wmi_swba_ev_arg *arg)
892{
893 struct wmi_tlv_swba_parse swba = { .arg = arg };
894 u32 map;
895 size_t n_vdevs;
896 int ret;
897
898 ret = ath10k_wmi_tlv_iter(ar, skb->data, skb->len,
899 ath10k_wmi_tlv_swba_parse, &swba);
900 if (ret) {
901 ath10k_warn(ar, "failed to parse tlv: %d\n", ret);
902 return ret;
903 }
904
905 if (!swba.ev)
906 return -EPROTO;
907
908 arg->vdev_map = swba.ev->vdev_map;
909
910 for (map = __le32_to_cpu(arg->vdev_map), n_vdevs = 0; map; map >>= 1)
911 if (map & BIT(0))
912 n_vdevs++;
913
914 if (n_vdevs != swba.n_tim ||
915 n_vdevs != swba.n_noa)
916 return -EPROTO;
917
918 return 0;
919}
920
Raja Mani991adf72015-08-14 11:13:29 +0300921static int ath10k_wmi_tlv_op_pull_phyerr_ev_hdr(struct ath10k *ar,
922 struct sk_buff *skb,
923 struct wmi_phyerr_hdr_arg *arg)
Michal Kaziorca996ec2014-12-03 10:11:32 +0200924{
925 const void **tb;
926 const struct wmi_tlv_phyerr_ev *ev;
927 const void *phyerrs;
928 int ret;
929
930 tb = ath10k_wmi_tlv_parse_alloc(ar, skb->data, skb->len, GFP_ATOMIC);
931 if (IS_ERR(tb)) {
932 ret = PTR_ERR(tb);
933 ath10k_warn(ar, "failed to parse tlv: %d\n", ret);
934 return ret;
935 }
936
937 ev = tb[WMI_TLV_TAG_STRUCT_COMB_PHYERR_RX_HDR];
938 phyerrs = tb[WMI_TLV_TAG_ARRAY_BYTE];
939
940 if (!ev || !phyerrs) {
941 kfree(tb);
942 return -EPROTO;
943 }
944
Raja Mani991adf72015-08-14 11:13:29 +0300945 arg->num_phyerrs = __le32_to_cpu(ev->num_phyerrs);
946 arg->tsf_l32 = __le32_to_cpu(ev->tsf_l32);
947 arg->tsf_u32 = __le32_to_cpu(ev->tsf_u32);
948 arg->buf_len = __le32_to_cpu(ev->buf_len);
Michal Kaziorca996ec2014-12-03 10:11:32 +0200949 arg->phyerrs = phyerrs;
950
951 kfree(tb);
952 return 0;
953}
954
955#define WMI_TLV_ABI_VER_NS0 0x5F414351
956#define WMI_TLV_ABI_VER_NS1 0x00004C4D
957#define WMI_TLV_ABI_VER_NS2 0x00000000
958#define WMI_TLV_ABI_VER_NS3 0x00000000
959
960#define WMI_TLV_ABI_VER0_MAJOR 1
961#define WMI_TLV_ABI_VER0_MINOR 0
962#define WMI_TLV_ABI_VER0 ((((WMI_TLV_ABI_VER0_MAJOR) << 24) & 0xFF000000) | \
963 (((WMI_TLV_ABI_VER0_MINOR) << 0) & 0x00FFFFFF))
964#define WMI_TLV_ABI_VER1 53
965
966static int
967ath10k_wmi_tlv_parse_mem_reqs(struct ath10k *ar, u16 tag, u16 len,
968 const void *ptr, void *data)
969{
970 struct wmi_svc_rdy_ev_arg *arg = data;
971 int i;
972
973 if (tag != WMI_TLV_TAG_STRUCT_WLAN_HOST_MEM_REQ)
974 return -EPROTO;
975
976 for (i = 0; i < ARRAY_SIZE(arg->mem_reqs); i++) {
977 if (!arg->mem_reqs[i]) {
978 arg->mem_reqs[i] = ptr;
979 return 0;
980 }
981 }
982
983 return -ENOMEM;
984}
985
Rakesh Pillai229329f2017-12-11 19:52:52 +0530986struct wmi_tlv_svc_rdy_parse {
Michal Kaziorca996ec2014-12-03 10:11:32 +0200987 const struct hal_reg_capabilities *reg;
988 const struct wmi_tlv_svc_rdy_ev *ev;
989 const __le32 *svc_bmap;
990 const struct wlan_host_mem_req *mem_reqs;
Rakesh Pillai229329f2017-12-11 19:52:52 +0530991 bool svc_bmap_done;
992 bool dbs_hw_mode_done;
993};
994
995static int ath10k_wmi_tlv_svc_rdy_parse(struct ath10k *ar, u16 tag, u16 len,
996 const void *ptr, void *data)
997{
998 struct wmi_tlv_svc_rdy_parse *svc_rdy = data;
999
1000 switch (tag) {
1001 case WMI_TLV_TAG_STRUCT_SERVICE_READY_EVENT:
1002 svc_rdy->ev = ptr;
1003 break;
1004 case WMI_TLV_TAG_STRUCT_HAL_REG_CAPABILITIES:
1005 svc_rdy->reg = ptr;
1006 break;
1007 case WMI_TLV_TAG_ARRAY_STRUCT:
1008 svc_rdy->mem_reqs = ptr;
1009 break;
1010 case WMI_TLV_TAG_ARRAY_UINT32:
1011 if (!svc_rdy->svc_bmap_done) {
1012 svc_rdy->svc_bmap_done = true;
1013 svc_rdy->svc_bmap = ptr;
1014 } else if (!svc_rdy->dbs_hw_mode_done) {
1015 svc_rdy->dbs_hw_mode_done = true;
1016 }
1017 break;
1018 default:
1019 break;
1020 }
1021 return 0;
1022}
1023
1024static int ath10k_wmi_tlv_op_pull_svc_rdy_ev(struct ath10k *ar,
1025 struct sk_buff *skb,
1026 struct wmi_svc_rdy_ev_arg *arg)
1027{
1028 const struct hal_reg_capabilities *reg;
1029 const struct wmi_tlv_svc_rdy_ev *ev;
1030 const __le32 *svc_bmap;
1031 const struct wlan_host_mem_req *mem_reqs;
1032 struct wmi_tlv_svc_rdy_parse svc_rdy = { };
Michal Kaziorca996ec2014-12-03 10:11:32 +02001033 int ret;
1034
Rakesh Pillai229329f2017-12-11 19:52:52 +05301035 ret = ath10k_wmi_tlv_iter(ar, skb->data, skb->len,
1036 ath10k_wmi_tlv_svc_rdy_parse, &svc_rdy);
1037 if (ret) {
Michal Kaziorca996ec2014-12-03 10:11:32 +02001038 ath10k_warn(ar, "failed to parse tlv: %d\n", ret);
1039 return ret;
1040 }
1041
Rakesh Pillai229329f2017-12-11 19:52:52 +05301042 ev = svc_rdy.ev;
1043 reg = svc_rdy.reg;
1044 svc_bmap = svc_rdy.svc_bmap;
1045 mem_reqs = svc_rdy.mem_reqs;
Michal Kaziorca996ec2014-12-03 10:11:32 +02001046
Rakesh Pillai229329f2017-12-11 19:52:52 +05301047 if (!ev || !reg || !svc_bmap || !mem_reqs)
Michal Kaziorca996ec2014-12-03 10:11:32 +02001048 return -EPROTO;
Michal Kaziorca996ec2014-12-03 10:11:32 +02001049
1050 /* This is an internal ABI compatibility check for WMI TLV so check it
1051 * here instead of the generic WMI code.
1052 */
1053 ath10k_dbg(ar, ATH10K_DBG_WMI,
1054 "wmi tlv abi 0x%08x ?= 0x%08x, 0x%08x ?= 0x%08x, 0x%08x ?= 0x%08x, 0x%08x ?= 0x%08x, 0x%08x ?= 0x%08x\n",
1055 __le32_to_cpu(ev->abi.abi_ver0), WMI_TLV_ABI_VER0,
1056 __le32_to_cpu(ev->abi.abi_ver_ns0), WMI_TLV_ABI_VER_NS0,
1057 __le32_to_cpu(ev->abi.abi_ver_ns1), WMI_TLV_ABI_VER_NS1,
1058 __le32_to_cpu(ev->abi.abi_ver_ns2), WMI_TLV_ABI_VER_NS2,
1059 __le32_to_cpu(ev->abi.abi_ver_ns3), WMI_TLV_ABI_VER_NS3);
1060
1061 if (__le32_to_cpu(ev->abi.abi_ver0) != WMI_TLV_ABI_VER0 ||
1062 __le32_to_cpu(ev->abi.abi_ver_ns0) != WMI_TLV_ABI_VER_NS0 ||
1063 __le32_to_cpu(ev->abi.abi_ver_ns1) != WMI_TLV_ABI_VER_NS1 ||
1064 __le32_to_cpu(ev->abi.abi_ver_ns2) != WMI_TLV_ABI_VER_NS2 ||
1065 __le32_to_cpu(ev->abi.abi_ver_ns3) != WMI_TLV_ABI_VER_NS3) {
Michal Kaziorca996ec2014-12-03 10:11:32 +02001066 return -ENOTSUPP;
1067 }
1068
1069 arg->min_tx_power = ev->hw_min_tx_power;
1070 arg->max_tx_power = ev->hw_max_tx_power;
1071 arg->ht_cap = ev->ht_cap_info;
1072 arg->vht_cap = ev->vht_cap_info;
1073 arg->sw_ver0 = ev->abi.abi_ver0;
1074 arg->sw_ver1 = ev->abi.abi_ver1;
1075 arg->fw_build = ev->fw_build_vers;
1076 arg->phy_capab = ev->phy_capability;
1077 arg->num_rf_chains = ev->num_rf_chains;
1078 arg->eeprom_rd = reg->eeprom_rd;
1079 arg->num_mem_reqs = ev->num_mem_reqs;
1080 arg->service_map = svc_bmap;
1081 arg->service_map_len = ath10k_wmi_tlv_len(svc_bmap);
1082
1083 ret = ath10k_wmi_tlv_iter(ar, mem_reqs, ath10k_wmi_tlv_len(mem_reqs),
1084 ath10k_wmi_tlv_parse_mem_reqs, arg);
1085 if (ret) {
Michal Kaziorca996ec2014-12-03 10:11:32 +02001086 ath10k_warn(ar, "failed to parse mem_reqs tlv: %d\n", ret);
1087 return ret;
1088 }
1089
Michal Kaziorca996ec2014-12-03 10:11:32 +02001090 return 0;
1091}
1092
1093static int ath10k_wmi_tlv_op_pull_rdy_ev(struct ath10k *ar,
1094 struct sk_buff *skb,
1095 struct wmi_rdy_ev_arg *arg)
1096{
1097 const void **tb;
1098 const struct wmi_tlv_rdy_ev *ev;
1099 int ret;
1100
1101 tb = ath10k_wmi_tlv_parse_alloc(ar, skb->data, skb->len, GFP_ATOMIC);
1102 if (IS_ERR(tb)) {
1103 ret = PTR_ERR(tb);
1104 ath10k_warn(ar, "failed to parse tlv: %d\n", ret);
1105 return ret;
1106 }
1107
1108 ev = tb[WMI_TLV_TAG_STRUCT_READY_EVENT];
1109 if (!ev) {
1110 kfree(tb);
1111 return -EPROTO;
1112 }
1113
1114 arg->sw_version = ev->abi.abi_ver0;
1115 arg->abi_version = ev->abi.abi_ver1;
1116 arg->status = ev->status;
1117 arg->mac_addr = ev->mac_addr.addr;
1118
1119 kfree(tb);
1120 return 0;
1121}
1122
Carl Huangcea19a62018-04-19 19:39:38 +03001123static int ath10k_wmi_tlv_svc_avail_parse(struct ath10k *ar, u16 tag, u16 len,
1124 const void *ptr, void *data)
1125{
1126 struct wmi_svc_avail_ev_arg *arg = data;
1127
1128 switch (tag) {
1129 case WMI_TLV_TAG_STRUCT_SERVICE_AVAILABLE_EVENT:
1130 arg->service_map_ext_len = *(__le32 *)ptr;
1131 arg->service_map_ext = ptr + sizeof(__le32);
1132 return 0;
1133 default:
1134 break;
1135 }
1136 return -EPROTO;
1137}
1138
1139static int ath10k_wmi_tlv_op_pull_svc_avail(struct ath10k *ar,
1140 struct sk_buff *skb,
1141 struct wmi_svc_avail_ev_arg *arg)
1142{
1143 int ret;
1144
1145 ret = ath10k_wmi_tlv_iter(ar, skb->data, skb->len,
1146 ath10k_wmi_tlv_svc_avail_parse, arg);
1147
1148 if (ret) {
1149 ath10k_warn(ar, "failed to parse svc_avail tlv: %d\n", ret);
1150 return ret;
1151 }
1152
1153 return 0;
1154}
1155
Michal Kazior7777d8c2015-02-15 16:50:41 +02001156static void ath10k_wmi_tlv_pull_vdev_stats(const struct wmi_tlv_vdev_stats *src,
1157 struct ath10k_fw_stats_vdev *dst)
1158{
1159 int i;
1160
1161 dst->vdev_id = __le32_to_cpu(src->vdev_id);
1162 dst->beacon_snr = __le32_to_cpu(src->beacon_snr);
1163 dst->data_snr = __le32_to_cpu(src->data_snr);
1164 dst->num_rx_frames = __le32_to_cpu(src->num_rx_frames);
1165 dst->num_rts_fail = __le32_to_cpu(src->num_rts_fail);
1166 dst->num_rts_success = __le32_to_cpu(src->num_rts_success);
1167 dst->num_rx_err = __le32_to_cpu(src->num_rx_err);
1168 dst->num_rx_discard = __le32_to_cpu(src->num_rx_discard);
1169 dst->num_tx_not_acked = __le32_to_cpu(src->num_tx_not_acked);
1170
1171 for (i = 0; i < ARRAY_SIZE(src->num_tx_frames); i++)
1172 dst->num_tx_frames[i] =
1173 __le32_to_cpu(src->num_tx_frames[i]);
1174
1175 for (i = 0; i < ARRAY_SIZE(src->num_tx_frames_retries); i++)
1176 dst->num_tx_frames_retries[i] =
1177 __le32_to_cpu(src->num_tx_frames_retries[i]);
1178
1179 for (i = 0; i < ARRAY_SIZE(src->num_tx_frames_failures); i++)
1180 dst->num_tx_frames_failures[i] =
1181 __le32_to_cpu(src->num_tx_frames_failures[i]);
1182
1183 for (i = 0; i < ARRAY_SIZE(src->tx_rate_history); i++)
1184 dst->tx_rate_history[i] =
1185 __le32_to_cpu(src->tx_rate_history[i]);
1186
1187 for (i = 0; i < ARRAY_SIZE(src->beacon_rssi_history); i++)
1188 dst->beacon_rssi_history[i] =
1189 __le32_to_cpu(src->beacon_rssi_history[i]);
1190}
1191
Michal Kaziorca996ec2014-12-03 10:11:32 +02001192static int ath10k_wmi_tlv_op_pull_fw_stats(struct ath10k *ar,
1193 struct sk_buff *skb,
1194 struct ath10k_fw_stats *stats)
1195{
1196 const void **tb;
Michal Kazior7777d8c2015-02-15 16:50:41 +02001197 const struct wmi_tlv_stats_ev *ev;
Michal Kaziorca996ec2014-12-03 10:11:32 +02001198 const void *data;
Michal Kazior7777d8c2015-02-15 16:50:41 +02001199 u32 num_pdev_stats;
1200 u32 num_vdev_stats;
1201 u32 num_peer_stats;
1202 u32 num_bcnflt_stats;
1203 u32 num_chan_stats;
Michal Kaziorca996ec2014-12-03 10:11:32 +02001204 size_t data_len;
1205 int ret;
Michal Kazior7777d8c2015-02-15 16:50:41 +02001206 int i;
Michal Kaziorca996ec2014-12-03 10:11:32 +02001207
1208 tb = ath10k_wmi_tlv_parse_alloc(ar, skb->data, skb->len, GFP_ATOMIC);
1209 if (IS_ERR(tb)) {
1210 ret = PTR_ERR(tb);
1211 ath10k_warn(ar, "failed to parse tlv: %d\n", ret);
1212 return ret;
1213 }
1214
1215 ev = tb[WMI_TLV_TAG_STRUCT_STATS_EVENT];
1216 data = tb[WMI_TLV_TAG_ARRAY_BYTE];
1217
1218 if (!ev || !data) {
1219 kfree(tb);
1220 return -EPROTO;
1221 }
1222
1223 data_len = ath10k_wmi_tlv_len(data);
1224 num_pdev_stats = __le32_to_cpu(ev->num_pdev_stats);
1225 num_vdev_stats = __le32_to_cpu(ev->num_vdev_stats);
1226 num_peer_stats = __le32_to_cpu(ev->num_peer_stats);
Michal Kazior7777d8c2015-02-15 16:50:41 +02001227 num_bcnflt_stats = __le32_to_cpu(ev->num_bcnflt_stats);
1228 num_chan_stats = __le32_to_cpu(ev->num_chan_stats);
Michal Kaziorca996ec2014-12-03 10:11:32 +02001229
Michal Kazior7777d8c2015-02-15 16:50:41 +02001230 ath10k_dbg(ar, ATH10K_DBG_WMI,
1231 "wmi tlv stats update pdev %i vdev %i peer %i bcnflt %i chan %i\n",
1232 num_pdev_stats, num_vdev_stats, num_peer_stats,
1233 num_bcnflt_stats, num_chan_stats);
1234
1235 for (i = 0; i < num_pdev_stats; i++) {
1236 const struct wmi_pdev_stats *src;
1237 struct ath10k_fw_stats_pdev *dst;
1238
1239 src = data;
Christian Lamparter097e46d2016-12-29 16:12:09 +02001240 if (data_len < sizeof(*src)) {
1241 kfree(tb);
Michal Kazior7777d8c2015-02-15 16:50:41 +02001242 return -EPROTO;
Christian Lamparter097e46d2016-12-29 16:12:09 +02001243 }
Michal Kazior7777d8c2015-02-15 16:50:41 +02001244
1245 data += sizeof(*src);
1246 data_len -= sizeof(*src);
1247
1248 dst = kzalloc(sizeof(*dst), GFP_ATOMIC);
1249 if (!dst)
1250 continue;
1251
1252 ath10k_wmi_pull_pdev_stats_base(&src->base, dst);
1253 ath10k_wmi_pull_pdev_stats_tx(&src->tx, dst);
1254 ath10k_wmi_pull_pdev_stats_rx(&src->rx, dst);
1255 list_add_tail(&dst->list, &stats->pdevs);
1256 }
1257
1258 for (i = 0; i < num_vdev_stats; i++) {
1259 const struct wmi_tlv_vdev_stats *src;
1260 struct ath10k_fw_stats_vdev *dst;
1261
1262 src = data;
Christian Lamparter097e46d2016-12-29 16:12:09 +02001263 if (data_len < sizeof(*src)) {
1264 kfree(tb);
Michal Kazior7777d8c2015-02-15 16:50:41 +02001265 return -EPROTO;
Christian Lamparter097e46d2016-12-29 16:12:09 +02001266 }
Michal Kazior7777d8c2015-02-15 16:50:41 +02001267
1268 data += sizeof(*src);
1269 data_len -= sizeof(*src);
1270
1271 dst = kzalloc(sizeof(*dst), GFP_ATOMIC);
1272 if (!dst)
1273 continue;
1274
1275 ath10k_wmi_tlv_pull_vdev_stats(src, dst);
1276 list_add_tail(&dst->list, &stats->vdevs);
1277 }
1278
1279 for (i = 0; i < num_peer_stats; i++) {
1280 const struct wmi_10x_peer_stats *src;
1281 struct ath10k_fw_stats_peer *dst;
1282
1283 src = data;
Christian Lamparter097e46d2016-12-29 16:12:09 +02001284 if (data_len < sizeof(*src)) {
1285 kfree(tb);
Michal Kazior7777d8c2015-02-15 16:50:41 +02001286 return -EPROTO;
Christian Lamparter097e46d2016-12-29 16:12:09 +02001287 }
Michal Kazior7777d8c2015-02-15 16:50:41 +02001288
1289 data += sizeof(*src);
1290 data_len -= sizeof(*src);
1291
1292 dst = kzalloc(sizeof(*dst), GFP_ATOMIC);
1293 if (!dst)
1294 continue;
1295
1296 ath10k_wmi_pull_peer_stats(&src->old, dst);
1297 dst->peer_rx_rate = __le32_to_cpu(src->peer_rx_rate);
1298 list_add_tail(&dst->list, &stats->peers);
1299 }
Michal Kaziorca996ec2014-12-03 10:11:32 +02001300
1301 kfree(tb);
1302 return 0;
1303}
1304
Michal Kaziorc1a46542015-03-10 16:21:54 +02001305static int ath10k_wmi_tlv_op_pull_roam_ev(struct ath10k *ar,
1306 struct sk_buff *skb,
1307 struct wmi_roam_ev_arg *arg)
1308{
1309 const void **tb;
1310 const struct wmi_tlv_roam_ev *ev;
1311 int ret;
1312
1313 tb = ath10k_wmi_tlv_parse_alloc(ar, skb->data, skb->len, GFP_ATOMIC);
1314 if (IS_ERR(tb)) {
1315 ret = PTR_ERR(tb);
1316 ath10k_warn(ar, "failed to parse tlv: %d\n", ret);
1317 return ret;
1318 }
1319
1320 ev = tb[WMI_TLV_TAG_STRUCT_ROAM_EVENT];
1321 if (!ev) {
1322 kfree(tb);
1323 return -EPROTO;
1324 }
1325
1326 arg->vdev_id = ev->vdev_id;
1327 arg->reason = ev->reason;
1328 arg->rssi = ev->rssi;
1329
1330 kfree(tb);
1331 return 0;
1332}
1333
Janusz Dziedzicf5431e82015-03-23 17:32:53 +02001334static int
1335ath10k_wmi_tlv_op_pull_wow_ev(struct ath10k *ar, struct sk_buff *skb,
1336 struct wmi_wow_ev_arg *arg)
1337{
1338 const void **tb;
1339 const struct wmi_tlv_wow_event_info *ev;
1340 int ret;
1341
1342 tb = ath10k_wmi_tlv_parse_alloc(ar, skb->data, skb->len, GFP_ATOMIC);
1343 if (IS_ERR(tb)) {
1344 ret = PTR_ERR(tb);
1345 ath10k_warn(ar, "failed to parse tlv: %d\n", ret);
1346 return ret;
1347 }
1348
1349 ev = tb[WMI_TLV_TAG_STRUCT_WOW_EVENT_INFO];
1350 if (!ev) {
1351 kfree(tb);
1352 return -EPROTO;
1353 }
1354
1355 arg->vdev_id = __le32_to_cpu(ev->vdev_id);
1356 arg->flag = __le32_to_cpu(ev->flag);
1357 arg->wake_reason = __le32_to_cpu(ev->wake_reason);
1358 arg->data_len = __le32_to_cpu(ev->data_len);
1359
1360 kfree(tb);
1361 return 0;
1362}
1363
Michal Kazior84d49112016-08-19 13:37:42 +03001364static int ath10k_wmi_tlv_op_pull_echo_ev(struct ath10k *ar,
1365 struct sk_buff *skb,
1366 struct wmi_echo_ev_arg *arg)
1367{
1368 const void **tb;
1369 const struct wmi_echo_event *ev;
1370 int ret;
1371
1372 tb = ath10k_wmi_tlv_parse_alloc(ar, skb->data, skb->len, GFP_ATOMIC);
1373 if (IS_ERR(tb)) {
1374 ret = PTR_ERR(tb);
1375 ath10k_warn(ar, "failed to parse tlv: %d\n", ret);
1376 return ret;
1377 }
1378
1379 ev = tb[WMI_TLV_TAG_STRUCT_ECHO_EVENT];
1380 if (!ev) {
1381 kfree(tb);
1382 return -EPROTO;
1383 }
1384
1385 arg->value = ev->value;
1386
1387 kfree(tb);
1388 return 0;
1389}
1390
Michal Kaziorca996ec2014-12-03 10:11:32 +02001391static struct sk_buff *
1392ath10k_wmi_tlv_op_gen_pdev_suspend(struct ath10k *ar, u32 opt)
1393{
1394 struct wmi_tlv_pdev_suspend *cmd;
1395 struct wmi_tlv *tlv;
1396 struct sk_buff *skb;
1397
1398 skb = ath10k_wmi_alloc_skb(ar, sizeof(*tlv) + sizeof(*cmd));
1399 if (!skb)
1400 return ERR_PTR(-ENOMEM);
1401
1402 tlv = (void *)skb->data;
1403 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_PDEV_SUSPEND_CMD);
1404 tlv->len = __cpu_to_le16(sizeof(*cmd));
1405 cmd = (void *)tlv->value;
1406 cmd->opt = __cpu_to_le32(opt);
1407
1408 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv pdev suspend\n");
1409 return skb;
1410}
1411
1412static struct sk_buff *
1413ath10k_wmi_tlv_op_gen_pdev_resume(struct ath10k *ar)
1414{
1415 struct wmi_tlv_resume_cmd *cmd;
1416 struct wmi_tlv *tlv;
1417 struct sk_buff *skb;
1418
1419 skb = ath10k_wmi_alloc_skb(ar, sizeof(*tlv) + sizeof(*cmd));
1420 if (!skb)
1421 return ERR_PTR(-ENOMEM);
1422
1423 tlv = (void *)skb->data;
1424 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_PDEV_RESUME_CMD);
1425 tlv->len = __cpu_to_le16(sizeof(*cmd));
1426 cmd = (void *)tlv->value;
1427 cmd->reserved = __cpu_to_le32(0);
1428
1429 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv pdev resume\n");
1430 return skb;
1431}
1432
1433static struct sk_buff *
1434ath10k_wmi_tlv_op_gen_pdev_set_rd(struct ath10k *ar,
1435 u16 rd, u16 rd2g, u16 rd5g,
1436 u16 ctl2g, u16 ctl5g,
1437 enum wmi_dfs_region dfs_reg)
1438{
1439 struct wmi_tlv_pdev_set_rd_cmd *cmd;
1440 struct wmi_tlv *tlv;
1441 struct sk_buff *skb;
1442
1443 skb = ath10k_wmi_alloc_skb(ar, sizeof(*tlv) + sizeof(*cmd));
1444 if (!skb)
1445 return ERR_PTR(-ENOMEM);
1446
1447 tlv = (void *)skb->data;
1448 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_PDEV_SET_REGDOMAIN_CMD);
1449 tlv->len = __cpu_to_le16(sizeof(*cmd));
1450 cmd = (void *)tlv->value;
1451 cmd->regd = __cpu_to_le32(rd);
1452 cmd->regd_2ghz = __cpu_to_le32(rd2g);
1453 cmd->regd_5ghz = __cpu_to_le32(rd5g);
Erik Stromdahl4e322f72016-11-27 20:37:20 +01001454 cmd->conform_limit_2ghz = __cpu_to_le32(ctl2g);
1455 cmd->conform_limit_5ghz = __cpu_to_le32(ctl5g);
Michal Kaziorca996ec2014-12-03 10:11:32 +02001456
1457 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv pdev set rd\n");
1458 return skb;
1459}
1460
Vivek Natarajan08e75ea2015-08-04 10:45:11 +05301461static enum wmi_txbf_conf ath10k_wmi_tlv_txbf_conf_scheme(struct ath10k *ar)
1462{
1463 return WMI_TXBF_CONF_AFTER_ASSOC;
1464}
1465
Michal Kaziorca996ec2014-12-03 10:11:32 +02001466static struct sk_buff *
1467ath10k_wmi_tlv_op_gen_pdev_set_param(struct ath10k *ar, u32 param_id,
1468 u32 param_value)
1469{
1470 struct wmi_tlv_pdev_set_param_cmd *cmd;
1471 struct wmi_tlv *tlv;
1472 struct sk_buff *skb;
1473
1474 skb = ath10k_wmi_alloc_skb(ar, sizeof(*tlv) + sizeof(*cmd));
1475 if (!skb)
1476 return ERR_PTR(-ENOMEM);
1477
1478 tlv = (void *)skb->data;
1479 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_PDEV_SET_PARAM_CMD);
1480 tlv->len = __cpu_to_le16(sizeof(*cmd));
1481 cmd = (void *)tlv->value;
1482 cmd->param_id = __cpu_to_le32(param_id);
1483 cmd->param_value = __cpu_to_le32(param_value);
1484
1485 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv pdev set param\n");
1486 return skb;
1487}
1488
1489static struct sk_buff *ath10k_wmi_tlv_op_gen_init(struct ath10k *ar)
1490{
1491 struct sk_buff *skb;
1492 struct wmi_tlv *tlv;
1493 struct wmi_tlv_init_cmd *cmd;
1494 struct wmi_tlv_resource_config *cfg;
1495 struct wmi_host_mem_chunks *chunks;
1496 size_t len, chunks_len;
1497 void *ptr;
1498
1499 chunks_len = ar->wmi.num_mem_chunks * sizeof(struct host_memory_chunk);
1500 len = (sizeof(*tlv) + sizeof(*cmd)) +
1501 (sizeof(*tlv) + sizeof(*cfg)) +
1502 (sizeof(*tlv) + chunks_len);
1503
1504 skb = ath10k_wmi_alloc_skb(ar, len);
1505 if (!skb)
1506 return ERR_PTR(-ENOMEM);
1507
1508 ptr = skb->data;
1509
1510 tlv = ptr;
1511 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_INIT_CMD);
1512 tlv->len = __cpu_to_le16(sizeof(*cmd));
1513 cmd = (void *)tlv->value;
1514 ptr += sizeof(*tlv);
1515 ptr += sizeof(*cmd);
1516
1517 tlv = ptr;
1518 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_RESOURCE_CONFIG);
1519 tlv->len = __cpu_to_le16(sizeof(*cfg));
1520 cfg = (void *)tlv->value;
1521 ptr += sizeof(*tlv);
1522 ptr += sizeof(*cfg);
1523
1524 tlv = ptr;
1525 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_STRUCT);
1526 tlv->len = __cpu_to_le16(chunks_len);
1527 chunks = (void *)tlv->value;
1528
1529 ptr += sizeof(*tlv);
1530 ptr += chunks_len;
1531
1532 cmd->abi.abi_ver0 = __cpu_to_le32(WMI_TLV_ABI_VER0);
1533 cmd->abi.abi_ver1 = __cpu_to_le32(WMI_TLV_ABI_VER1);
1534 cmd->abi.abi_ver_ns0 = __cpu_to_le32(WMI_TLV_ABI_VER_NS0);
1535 cmd->abi.abi_ver_ns1 = __cpu_to_le32(WMI_TLV_ABI_VER_NS1);
1536 cmd->abi.abi_ver_ns2 = __cpu_to_le32(WMI_TLV_ABI_VER_NS2);
1537 cmd->abi.abi_ver_ns3 = __cpu_to_le32(WMI_TLV_ABI_VER_NS3);
1538 cmd->num_host_mem_chunks = __cpu_to_le32(ar->wmi.num_mem_chunks);
1539
1540 cfg->num_vdevs = __cpu_to_le32(TARGET_TLV_NUM_VDEVS);
Rakesh Pillai9f2992f2017-12-11 19:52:54 +05301541
1542 cfg->num_peers = __cpu_to_le32(ar->hw_params.num_peers);
1543 cfg->ast_skid_limit = __cpu_to_le32(ar->hw_params.ast_skid_limit);
1544 cfg->num_wds_entries = __cpu_to_le32(ar->hw_params.num_wds_entries);
Michal Kaziorc5450702015-01-24 12:14:48 +02001545
1546 if (test_bit(WMI_SERVICE_RX_FULL_REORDER, ar->wmi.svc_map)) {
Michal Kazior039a0052015-03-31 10:26:26 +00001547 cfg->num_offload_peers = __cpu_to_le32(TARGET_TLV_NUM_VDEVS);
1548 cfg->num_offload_reorder_bufs = __cpu_to_le32(TARGET_TLV_NUM_VDEVS);
Michal Kaziorc5450702015-01-24 12:14:48 +02001549 } else {
1550 cfg->num_offload_peers = __cpu_to_le32(0);
1551 cfg->num_offload_reorder_bufs = __cpu_to_le32(0);
1552 }
1553
Michal Kaziorca996ec2014-12-03 10:11:32 +02001554 cfg->num_peer_keys = __cpu_to_le32(2);
1555 cfg->num_tids = __cpu_to_le32(TARGET_TLV_NUM_TIDS);
Michal Kaziorca996ec2014-12-03 10:11:32 +02001556 cfg->tx_chain_mask = __cpu_to_le32(0x7);
1557 cfg->rx_chain_mask = __cpu_to_le32(0x7);
1558 cfg->rx_timeout_pri[0] = __cpu_to_le32(0x64);
1559 cfg->rx_timeout_pri[1] = __cpu_to_le32(0x64);
1560 cfg->rx_timeout_pri[2] = __cpu_to_le32(0x64);
1561 cfg->rx_timeout_pri[3] = __cpu_to_le32(0x28);
David Liuccec9032015-07-24 20:25:32 +03001562 cfg->rx_decap_mode = __cpu_to_le32(ar->wmi.rx_decap_mode);
Michal Kaziorca996ec2014-12-03 10:11:32 +02001563 cfg->scan_max_pending_reqs = __cpu_to_le32(4);
Michal Kazior039a0052015-03-31 10:26:26 +00001564 cfg->bmiss_offload_max_vdev = __cpu_to_le32(TARGET_TLV_NUM_VDEVS);
1565 cfg->roam_offload_max_vdev = __cpu_to_le32(TARGET_TLV_NUM_VDEVS);
Michal Kaziorca996ec2014-12-03 10:11:32 +02001566 cfg->roam_offload_max_ap_profiles = __cpu_to_le32(8);
1567 cfg->num_mcast_groups = __cpu_to_le32(0);
1568 cfg->num_mcast_table_elems = __cpu_to_le32(0);
1569 cfg->mcast2ucast_mode = __cpu_to_le32(0);
1570 cfg->tx_dbg_log_size = __cpu_to_le32(0x400);
Michal Kaziorca996ec2014-12-03 10:11:32 +02001571 cfg->dma_burst_size = __cpu_to_le32(0);
1572 cfg->mac_aggr_delim = __cpu_to_le32(0);
1573 cfg->rx_skip_defrag_timeout_dup_detection_check = __cpu_to_le32(0);
1574 cfg->vow_config = __cpu_to_le32(0);
1575 cfg->gtk_offload_max_vdev = __cpu_to_le32(2);
1576 cfg->num_msdu_desc = __cpu_to_le32(TARGET_TLV_NUM_MSDU_DESC);
1577 cfg->max_frag_entries = __cpu_to_le32(2);
Marek Puzyniak8cca3d62015-03-30 09:51:52 +03001578 cfg->num_tdls_vdevs = __cpu_to_le32(TARGET_TLV_NUM_TDLS_VDEVS);
Michal Kaziorca996ec2014-12-03 10:11:32 +02001579 cfg->num_tdls_conn_table_entries = __cpu_to_le32(0x20);
1580 cfg->beacon_tx_offload_max_vdev = __cpu_to_le32(2);
1581 cfg->num_multicast_filter_entries = __cpu_to_le32(5);
Janusz Dziedzic25c86612015-03-23 17:32:54 +02001582 cfg->num_wow_filters = __cpu_to_le32(ar->wow.max_num_patterns);
Michal Kaziorca996ec2014-12-03 10:11:32 +02001583 cfg->num_keep_alive_pattern = __cpu_to_le32(6);
1584 cfg->keep_alive_pattern_size = __cpu_to_le32(0);
1585 cfg->max_tdls_concurrent_sleep_sta = __cpu_to_le32(1);
1586 cfg->max_tdls_concurrent_buffer_sta = __cpu_to_le32(1);
1587
1588 ath10k_wmi_put_host_mem_chunks(ar, chunks);
1589
1590 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv init\n");
1591 return skb;
1592}
1593
1594static struct sk_buff *
1595ath10k_wmi_tlv_op_gen_start_scan(struct ath10k *ar,
1596 const struct wmi_start_scan_arg *arg)
1597{
1598 struct wmi_tlv_start_scan_cmd *cmd;
1599 struct wmi_tlv *tlv;
1600 struct sk_buff *skb;
1601 size_t len, chan_len, ssid_len, bssid_len, ie_len;
1602 __le32 *chans;
1603 struct wmi_ssid *ssids;
1604 struct wmi_mac_addr *addrs;
1605 void *ptr;
1606 int i, ret;
1607
1608 ret = ath10k_wmi_start_scan_verify(arg);
1609 if (ret)
1610 return ERR_PTR(ret);
1611
1612 chan_len = arg->n_channels * sizeof(__le32);
1613 ssid_len = arg->n_ssids * sizeof(struct wmi_ssid);
1614 bssid_len = arg->n_bssids * sizeof(struct wmi_mac_addr);
1615 ie_len = roundup(arg->ie_len, 4);
1616 len = (sizeof(*tlv) + sizeof(*cmd)) +
1617 (arg->n_channels ? sizeof(*tlv) + chan_len : 0) +
1618 (arg->n_ssids ? sizeof(*tlv) + ssid_len : 0) +
1619 (arg->n_bssids ? sizeof(*tlv) + bssid_len : 0) +
1620 (arg->ie_len ? sizeof(*tlv) + ie_len : 0);
1621
1622 skb = ath10k_wmi_alloc_skb(ar, len);
1623 if (!skb)
1624 return ERR_PTR(-ENOMEM);
1625
1626 ptr = (void *)skb->data;
1627 tlv = ptr;
1628 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_START_SCAN_CMD);
1629 tlv->len = __cpu_to_le16(sizeof(*cmd));
1630 cmd = (void *)tlv->value;
1631
1632 ath10k_wmi_put_start_scan_common(&cmd->common, arg);
Michal Kaziordbd3f9f2015-03-31 11:03:48 +00001633 cmd->burst_duration_ms = __cpu_to_le32(arg->burst_duration_ms);
Michal Kaziorca996ec2014-12-03 10:11:32 +02001634 cmd->num_channels = __cpu_to_le32(arg->n_channels);
1635 cmd->num_ssids = __cpu_to_le32(arg->n_ssids);
1636 cmd->num_bssids = __cpu_to_le32(arg->n_bssids);
1637 cmd->ie_len = __cpu_to_le32(arg->ie_len);
1638 cmd->num_probes = __cpu_to_le32(3);
1639
1640 /* FIXME: There are some scan flag inconsistencies across firmwares,
1641 * e.g. WMI-TLV inverts the logic behind the following flag.
1642 */
1643 cmd->common.scan_ctrl_flags ^= __cpu_to_le32(WMI_SCAN_FILTER_PROBE_REQ);
1644
1645 ptr += sizeof(*tlv);
1646 ptr += sizeof(*cmd);
1647
1648 tlv = ptr;
1649 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_UINT32);
1650 tlv->len = __cpu_to_le16(chan_len);
1651 chans = (void *)tlv->value;
1652 for (i = 0; i < arg->n_channels; i++)
1653 chans[i] = __cpu_to_le32(arg->channels[i]);
1654
1655 ptr += sizeof(*tlv);
1656 ptr += chan_len;
1657
1658 tlv = ptr;
1659 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_FIXED_STRUCT);
1660 tlv->len = __cpu_to_le16(ssid_len);
1661 ssids = (void *)tlv->value;
1662 for (i = 0; i < arg->n_ssids; i++) {
1663 ssids[i].ssid_len = __cpu_to_le32(arg->ssids[i].len);
1664 memcpy(ssids[i].ssid, arg->ssids[i].ssid, arg->ssids[i].len);
1665 }
1666
1667 ptr += sizeof(*tlv);
1668 ptr += ssid_len;
1669
1670 tlv = ptr;
1671 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_FIXED_STRUCT);
1672 tlv->len = __cpu_to_le16(bssid_len);
1673 addrs = (void *)tlv->value;
1674 for (i = 0; i < arg->n_bssids; i++)
1675 ether_addr_copy(addrs[i].addr, arg->bssids[i].bssid);
1676
1677 ptr += sizeof(*tlv);
1678 ptr += bssid_len;
1679
1680 tlv = ptr;
1681 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_BYTE);
1682 tlv->len = __cpu_to_le16(ie_len);
1683 memcpy(tlv->value, arg->ie, arg->ie_len);
1684
1685 ptr += sizeof(*tlv);
1686 ptr += ie_len;
1687
1688 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv start scan\n");
1689 return skb;
1690}
1691
1692static struct sk_buff *
1693ath10k_wmi_tlv_op_gen_stop_scan(struct ath10k *ar,
1694 const struct wmi_stop_scan_arg *arg)
1695{
1696 struct wmi_stop_scan_cmd *cmd;
1697 struct wmi_tlv *tlv;
1698 struct sk_buff *skb;
1699 u32 scan_id;
1700 u32 req_id;
1701
1702 if (arg->req_id > 0xFFF)
1703 return ERR_PTR(-EINVAL);
1704 if (arg->req_type == WMI_SCAN_STOP_ONE && arg->u.scan_id > 0xFFF)
1705 return ERR_PTR(-EINVAL);
1706
1707 skb = ath10k_wmi_alloc_skb(ar, sizeof(*tlv) + sizeof(*cmd));
1708 if (!skb)
1709 return ERR_PTR(-ENOMEM);
1710
1711 scan_id = arg->u.scan_id;
1712 scan_id |= WMI_HOST_SCAN_REQ_ID_PREFIX;
1713
1714 req_id = arg->req_id;
1715 req_id |= WMI_HOST_SCAN_REQUESTOR_ID_PREFIX;
1716
1717 tlv = (void *)skb->data;
1718 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_STOP_SCAN_CMD);
1719 tlv->len = __cpu_to_le16(sizeof(*cmd));
1720 cmd = (void *)tlv->value;
1721 cmd->req_type = __cpu_to_le32(arg->req_type);
1722 cmd->vdev_id = __cpu_to_le32(arg->u.vdev_id);
1723 cmd->scan_id = __cpu_to_le32(scan_id);
1724 cmd->scan_req_id = __cpu_to_le32(req_id);
1725
1726 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv stop scan\n");
1727 return skb;
1728}
1729
1730static struct sk_buff *
1731ath10k_wmi_tlv_op_gen_vdev_create(struct ath10k *ar,
1732 u32 vdev_id,
1733 enum wmi_vdev_type vdev_type,
1734 enum wmi_vdev_subtype vdev_subtype,
1735 const u8 mac_addr[ETH_ALEN])
1736{
1737 struct wmi_vdev_create_cmd *cmd;
1738 struct wmi_tlv *tlv;
1739 struct sk_buff *skb;
1740
1741 skb = ath10k_wmi_alloc_skb(ar, sizeof(*tlv) + sizeof(*cmd));
1742 if (!skb)
1743 return ERR_PTR(-ENOMEM);
1744
1745 tlv = (void *)skb->data;
1746 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_VDEV_CREATE_CMD);
1747 tlv->len = __cpu_to_le16(sizeof(*cmd));
1748 cmd = (void *)tlv->value;
1749 cmd->vdev_id = __cpu_to_le32(vdev_id);
1750 cmd->vdev_type = __cpu_to_le32(vdev_type);
1751 cmd->vdev_subtype = __cpu_to_le32(vdev_subtype);
1752 ether_addr_copy(cmd->vdev_macaddr.addr, mac_addr);
1753
1754 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv vdev create\n");
1755 return skb;
1756}
1757
1758static struct sk_buff *
1759ath10k_wmi_tlv_op_gen_vdev_delete(struct ath10k *ar, u32 vdev_id)
1760{
1761 struct wmi_vdev_delete_cmd *cmd;
1762 struct wmi_tlv *tlv;
1763 struct sk_buff *skb;
1764
1765 skb = ath10k_wmi_alloc_skb(ar, sizeof(*tlv) + sizeof(*cmd));
1766 if (!skb)
1767 return ERR_PTR(-ENOMEM);
1768
1769 tlv = (void *)skb->data;
1770 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_VDEV_DELETE_CMD);
1771 tlv->len = __cpu_to_le16(sizeof(*cmd));
1772 cmd = (void *)tlv->value;
1773 cmd->vdev_id = __cpu_to_le32(vdev_id);
1774
1775 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv vdev delete\n");
1776 return skb;
1777}
1778
1779static struct sk_buff *
1780ath10k_wmi_tlv_op_gen_vdev_start(struct ath10k *ar,
1781 const struct wmi_vdev_start_request_arg *arg,
1782 bool restart)
1783{
1784 struct wmi_tlv_vdev_start_cmd *cmd;
1785 struct wmi_channel *ch;
1786 struct wmi_p2p_noa_descriptor *noa;
1787 struct wmi_tlv *tlv;
1788 struct sk_buff *skb;
1789 size_t len;
1790 void *ptr;
1791 u32 flags = 0;
1792
Michal Kaziorca996ec2014-12-03 10:11:32 +02001793 if (WARN_ON(arg->hidden_ssid && !arg->ssid))
1794 return ERR_PTR(-EINVAL);
1795 if (WARN_ON(arg->ssid_len > sizeof(cmd->ssid.ssid)))
1796 return ERR_PTR(-EINVAL);
1797
1798 len = (sizeof(*tlv) + sizeof(*cmd)) +
1799 (sizeof(*tlv) + sizeof(*ch)) +
1800 (sizeof(*tlv) + 0);
1801 skb = ath10k_wmi_alloc_skb(ar, len);
1802 if (!skb)
1803 return ERR_PTR(-ENOMEM);
1804
1805 if (arg->hidden_ssid)
1806 flags |= WMI_VDEV_START_HIDDEN_SSID;
1807 if (arg->pmf_enabled)
1808 flags |= WMI_VDEV_START_PMF_ENABLED;
1809
1810 ptr = (void *)skb->data;
1811
1812 tlv = ptr;
1813 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_VDEV_START_REQUEST_CMD);
1814 tlv->len = __cpu_to_le16(sizeof(*cmd));
1815 cmd = (void *)tlv->value;
1816 cmd->vdev_id = __cpu_to_le32(arg->vdev_id);
1817 cmd->bcn_intval = __cpu_to_le32(arg->bcn_intval);
1818 cmd->dtim_period = __cpu_to_le32(arg->dtim_period);
1819 cmd->flags = __cpu_to_le32(flags);
1820 cmd->bcn_tx_rate = __cpu_to_le32(arg->bcn_tx_rate);
1821 cmd->bcn_tx_power = __cpu_to_le32(arg->bcn_tx_power);
1822 cmd->disable_hw_ack = __cpu_to_le32(arg->disable_hw_ack);
1823
1824 if (arg->ssid) {
1825 cmd->ssid.ssid_len = __cpu_to_le32(arg->ssid_len);
1826 memcpy(cmd->ssid.ssid, arg->ssid, arg->ssid_len);
1827 }
1828
1829 ptr += sizeof(*tlv);
1830 ptr += sizeof(*cmd);
1831
1832 tlv = ptr;
1833 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_CHANNEL);
1834 tlv->len = __cpu_to_le16(sizeof(*ch));
1835 ch = (void *)tlv->value;
1836 ath10k_wmi_put_wmi_channel(ch, &arg->channel);
1837
1838 ptr += sizeof(*tlv);
1839 ptr += sizeof(*ch);
1840
1841 tlv = ptr;
1842 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_STRUCT);
1843 tlv->len = 0;
1844 noa = (void *)tlv->value;
1845
1846 /* Note: This is a nested TLV containing:
1847 * [wmi_tlv][wmi_p2p_noa_descriptor][wmi_tlv]..
1848 */
1849
1850 ptr += sizeof(*tlv);
1851 ptr += 0;
1852
1853 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv vdev start\n");
1854 return skb;
1855}
1856
1857static struct sk_buff *
1858ath10k_wmi_tlv_op_gen_vdev_stop(struct ath10k *ar, u32 vdev_id)
1859{
1860 struct wmi_vdev_stop_cmd *cmd;
1861 struct wmi_tlv *tlv;
1862 struct sk_buff *skb;
1863
1864 skb = ath10k_wmi_alloc_skb(ar, sizeof(*tlv) + sizeof(*cmd));
1865 if (!skb)
1866 return ERR_PTR(-ENOMEM);
1867
1868 tlv = (void *)skb->data;
1869 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_VDEV_STOP_CMD);
1870 tlv->len = __cpu_to_le16(sizeof(*cmd));
1871 cmd = (void *)tlv->value;
1872 cmd->vdev_id = __cpu_to_le32(vdev_id);
1873
1874 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv vdev stop\n");
1875 return skb;
1876}
1877
1878static struct sk_buff *
1879ath10k_wmi_tlv_op_gen_vdev_up(struct ath10k *ar, u32 vdev_id, u32 aid,
1880 const u8 *bssid)
1881
1882{
1883 struct wmi_vdev_up_cmd *cmd;
1884 struct wmi_tlv *tlv;
1885 struct sk_buff *skb;
1886
1887 skb = ath10k_wmi_alloc_skb(ar, sizeof(*tlv) + sizeof(*cmd));
1888 if (!skb)
1889 return ERR_PTR(-ENOMEM);
1890
1891 tlv = (void *)skb->data;
1892 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_VDEV_UP_CMD);
1893 tlv->len = __cpu_to_le16(sizeof(*cmd));
1894 cmd = (void *)tlv->value;
1895 cmd->vdev_id = __cpu_to_le32(vdev_id);
1896 cmd->vdev_assoc_id = __cpu_to_le32(aid);
1897 ether_addr_copy(cmd->vdev_bssid.addr, bssid);
1898
1899 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv vdev up\n");
1900 return skb;
1901}
1902
1903static struct sk_buff *
1904ath10k_wmi_tlv_op_gen_vdev_down(struct ath10k *ar, u32 vdev_id)
1905{
1906 struct wmi_vdev_down_cmd *cmd;
1907 struct wmi_tlv *tlv;
1908 struct sk_buff *skb;
1909
1910 skb = ath10k_wmi_alloc_skb(ar, sizeof(*tlv) + sizeof(*cmd));
1911 if (!skb)
1912 return ERR_PTR(-ENOMEM);
1913
1914 tlv = (void *)skb->data;
1915 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_VDEV_DOWN_CMD);
1916 tlv->len = __cpu_to_le16(sizeof(*cmd));
1917 cmd = (void *)tlv->value;
1918 cmd->vdev_id = __cpu_to_le32(vdev_id);
1919
1920 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv vdev down\n");
1921 return skb;
1922}
1923
1924static struct sk_buff *
1925ath10k_wmi_tlv_op_gen_vdev_set_param(struct ath10k *ar, u32 vdev_id,
1926 u32 param_id, u32 param_value)
1927{
1928 struct wmi_vdev_set_param_cmd *cmd;
1929 struct wmi_tlv *tlv;
1930 struct sk_buff *skb;
1931
1932 skb = ath10k_wmi_alloc_skb(ar, sizeof(*tlv) + sizeof(*cmd));
1933 if (!skb)
1934 return ERR_PTR(-ENOMEM);
1935
1936 tlv = (void *)skb->data;
1937 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_VDEV_SET_PARAM_CMD);
1938 tlv->len = __cpu_to_le16(sizeof(*cmd));
1939 cmd = (void *)tlv->value;
1940 cmd->vdev_id = __cpu_to_le32(vdev_id);
1941 cmd->param_id = __cpu_to_le32(param_id);
1942 cmd->param_value = __cpu_to_le32(param_value);
1943
1944 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv vdev set param\n");
1945 return skb;
1946}
1947
1948static struct sk_buff *
1949ath10k_wmi_tlv_op_gen_vdev_install_key(struct ath10k *ar,
1950 const struct wmi_vdev_install_key_arg *arg)
1951{
1952 struct wmi_vdev_install_key_cmd *cmd;
1953 struct wmi_tlv *tlv;
1954 struct sk_buff *skb;
1955 size_t len;
1956 void *ptr;
1957
1958 if (arg->key_cipher == WMI_CIPHER_NONE && arg->key_data != NULL)
1959 return ERR_PTR(-EINVAL);
1960 if (arg->key_cipher != WMI_CIPHER_NONE && arg->key_data == NULL)
1961 return ERR_PTR(-EINVAL);
1962
1963 len = sizeof(*tlv) + sizeof(*cmd) +
1964 sizeof(*tlv) + roundup(arg->key_len, sizeof(__le32));
1965 skb = ath10k_wmi_alloc_skb(ar, len);
1966 if (!skb)
1967 return ERR_PTR(-ENOMEM);
1968
1969 ptr = (void *)skb->data;
1970 tlv = ptr;
1971 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_VDEV_INSTALL_KEY_CMD);
1972 tlv->len = __cpu_to_le16(sizeof(*cmd));
1973 cmd = (void *)tlv->value;
1974 cmd->vdev_id = __cpu_to_le32(arg->vdev_id);
1975 cmd->key_idx = __cpu_to_le32(arg->key_idx);
1976 cmd->key_flags = __cpu_to_le32(arg->key_flags);
1977 cmd->key_cipher = __cpu_to_le32(arg->key_cipher);
1978 cmd->key_len = __cpu_to_le32(arg->key_len);
1979 cmd->key_txmic_len = __cpu_to_le32(arg->key_txmic_len);
1980 cmd->key_rxmic_len = __cpu_to_le32(arg->key_rxmic_len);
1981
1982 if (arg->macaddr)
1983 ether_addr_copy(cmd->peer_macaddr.addr, arg->macaddr);
1984
1985 ptr += sizeof(*tlv);
1986 ptr += sizeof(*cmd);
1987
1988 tlv = ptr;
1989 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_BYTE);
1990 tlv->len = __cpu_to_le16(roundup(arg->key_len, sizeof(__le32)));
1991 if (arg->key_data)
1992 memcpy(tlv->value, arg->key_data, arg->key_len);
1993
1994 ptr += sizeof(*tlv);
1995 ptr += roundup(arg->key_len, sizeof(__le32));
1996
1997 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv vdev install key\n");
1998 return skb;
1999}
2000
Janusz Dziedzic0c7e4772015-01-24 12:14:52 +02002001static void *ath10k_wmi_tlv_put_uapsd_ac(struct ath10k *ar, void *ptr,
2002 const struct wmi_sta_uapsd_auto_trig_arg *arg)
2003{
2004 struct wmi_sta_uapsd_auto_trig_param *ac;
2005 struct wmi_tlv *tlv;
2006
2007 tlv = ptr;
2008 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_STA_UAPSD_AUTO_TRIG_PARAM);
2009 tlv->len = __cpu_to_le16(sizeof(*ac));
2010 ac = (void *)tlv->value;
2011
2012 ac->wmm_ac = __cpu_to_le32(arg->wmm_ac);
2013 ac->user_priority = __cpu_to_le32(arg->user_priority);
2014 ac->service_interval = __cpu_to_le32(arg->service_interval);
2015 ac->suspend_interval = __cpu_to_le32(arg->suspend_interval);
2016 ac->delay_interval = __cpu_to_le32(arg->delay_interval);
2017
2018 ath10k_dbg(ar, ATH10K_DBG_WMI,
2019 "wmi tlv vdev sta uapsd auto trigger ac %d prio %d svc int %d susp int %d delay int %d\n",
2020 ac->wmm_ac, ac->user_priority, ac->service_interval,
2021 ac->suspend_interval, ac->delay_interval);
2022
2023 return ptr + sizeof(*tlv) + sizeof(*ac);
2024}
2025
2026static struct sk_buff *
2027ath10k_wmi_tlv_op_gen_vdev_sta_uapsd(struct ath10k *ar, u32 vdev_id,
2028 const u8 peer_addr[ETH_ALEN],
2029 const struct wmi_sta_uapsd_auto_trig_arg *args,
2030 u32 num_ac)
2031{
2032 struct wmi_sta_uapsd_auto_trig_cmd_fixed_param *cmd;
2033 struct wmi_sta_uapsd_auto_trig_param *ac;
2034 struct wmi_tlv *tlv;
2035 struct sk_buff *skb;
2036 size_t len;
2037 size_t ac_tlv_len;
2038 void *ptr;
2039 int i;
2040
2041 ac_tlv_len = num_ac * (sizeof(*tlv) + sizeof(*ac));
2042 len = sizeof(*tlv) + sizeof(*cmd) +
2043 sizeof(*tlv) + ac_tlv_len;
2044 skb = ath10k_wmi_alloc_skb(ar, len);
2045 if (!skb)
2046 return ERR_PTR(-ENOMEM);
2047
2048 ptr = (void *)skb->data;
2049 tlv = ptr;
2050 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_STA_UAPSD_AUTO_TRIG_CMD);
2051 tlv->len = __cpu_to_le16(sizeof(*cmd));
2052 cmd = (void *)tlv->value;
2053 cmd->vdev_id = __cpu_to_le32(vdev_id);
2054 cmd->num_ac = __cpu_to_le32(num_ac);
2055 ether_addr_copy(cmd->peer_macaddr.addr, peer_addr);
2056
2057 ptr += sizeof(*tlv);
2058 ptr += sizeof(*cmd);
2059
2060 tlv = ptr;
2061 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_STRUCT);
2062 tlv->len = __cpu_to_le16(ac_tlv_len);
2063 ac = (void *)tlv->value;
2064
2065 ptr += sizeof(*tlv);
2066 for (i = 0; i < num_ac; i++)
2067 ptr = ath10k_wmi_tlv_put_uapsd_ac(ar, ptr, &args[i]);
2068
2069 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv vdev sta uapsd auto trigger\n");
2070 return skb;
2071}
2072
Michal Kazior5e752e42015-01-19 09:53:41 +01002073static void *ath10k_wmi_tlv_put_wmm(void *ptr,
2074 const struct wmi_wmm_params_arg *arg)
2075{
2076 struct wmi_wmm_params *wmm;
2077 struct wmi_tlv *tlv;
2078
2079 tlv = ptr;
2080 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_WMM_PARAMS);
2081 tlv->len = __cpu_to_le16(sizeof(*wmm));
2082 wmm = (void *)tlv->value;
2083 ath10k_wmi_set_wmm_param(wmm, arg);
2084
2085 return ptr + sizeof(*tlv) + sizeof(*wmm);
2086}
2087
Michal Kaziorca996ec2014-12-03 10:11:32 +02002088static struct sk_buff *
Michal Kazior6d492fe2015-01-28 09:57:22 +02002089ath10k_wmi_tlv_op_gen_vdev_wmm_conf(struct ath10k *ar, u32 vdev_id,
2090 const struct wmi_wmm_params_all_arg *arg)
2091{
2092 struct wmi_tlv_vdev_set_wmm_cmd *cmd;
Michal Kazior6d492fe2015-01-28 09:57:22 +02002093 struct wmi_tlv *tlv;
2094 struct sk_buff *skb;
2095 size_t len;
2096 void *ptr;
2097
Marek Puzyniakc8c60cf2015-02-10 12:38:15 +01002098 len = sizeof(*tlv) + sizeof(*cmd);
Michal Kazior6d492fe2015-01-28 09:57:22 +02002099 skb = ath10k_wmi_alloc_skb(ar, len);
2100 if (!skb)
2101 return ERR_PTR(-ENOMEM);
2102
2103 ptr = (void *)skb->data;
2104 tlv = ptr;
2105 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_VDEV_SET_WMM_PARAMS_CMD);
2106 tlv->len = __cpu_to_le16(sizeof(*cmd));
2107 cmd = (void *)tlv->value;
2108 cmd->vdev_id = __cpu_to_le32(vdev_id);
2109
Marek Puzyniakc8c60cf2015-02-10 12:38:15 +01002110 ath10k_wmi_set_wmm_param(&cmd->vdev_wmm_params[0].params, &arg->ac_be);
2111 ath10k_wmi_set_wmm_param(&cmd->vdev_wmm_params[1].params, &arg->ac_bk);
2112 ath10k_wmi_set_wmm_param(&cmd->vdev_wmm_params[2].params, &arg->ac_vi);
2113 ath10k_wmi_set_wmm_param(&cmd->vdev_wmm_params[3].params, &arg->ac_vo);
Michal Kazior6d492fe2015-01-28 09:57:22 +02002114
2115 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv vdev wmm conf\n");
2116 return skb;
2117}
2118
2119static struct sk_buff *
Janusz Dziedzic6e8b1882015-01-28 09:57:39 +02002120ath10k_wmi_tlv_op_gen_sta_keepalive(struct ath10k *ar,
2121 const struct wmi_sta_keepalive_arg *arg)
2122{
2123 struct wmi_tlv_sta_keepalive_cmd *cmd;
2124 struct wmi_sta_keepalive_arp_resp *arp;
2125 struct sk_buff *skb;
2126 struct wmi_tlv *tlv;
2127 void *ptr;
2128 size_t len;
2129
2130 len = sizeof(*tlv) + sizeof(*cmd) +
2131 sizeof(*tlv) + sizeof(*arp);
2132 skb = ath10k_wmi_alloc_skb(ar, len);
2133 if (!skb)
2134 return ERR_PTR(-ENOMEM);
2135
2136 ptr = (void *)skb->data;
2137 tlv = ptr;
2138 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_STA_KEEPALIVE_CMD);
2139 tlv->len = __cpu_to_le16(sizeof(*cmd));
2140 cmd = (void *)tlv->value;
2141 cmd->vdev_id = __cpu_to_le32(arg->vdev_id);
2142 cmd->enabled = __cpu_to_le32(arg->enabled);
2143 cmd->method = __cpu_to_le32(arg->method);
2144 cmd->interval = __cpu_to_le32(arg->interval);
2145
2146 ptr += sizeof(*tlv);
2147 ptr += sizeof(*cmd);
2148
2149 tlv = ptr;
2150 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_STA_KEEPALVE_ARP_RESPONSE);
2151 tlv->len = __cpu_to_le16(sizeof(*arp));
2152 arp = (void *)tlv->value;
2153
2154 arp->src_ip4_addr = arg->src_ip4_addr;
2155 arp->dest_ip4_addr = arg->dest_ip4_addr;
2156 ether_addr_copy(arp->dest_mac_addr.addr, arg->dest_mac_addr);
2157
Colin Ian King23de5792017-06-25 22:29:32 +01002158 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv sta keepalive vdev %d enabled %d method %d interval %d\n",
Janusz Dziedzic6e8b1882015-01-28 09:57:39 +02002159 arg->vdev_id, arg->enabled, arg->method, arg->interval);
2160 return skb;
2161}
2162
2163static struct sk_buff *
Michal Kaziorca996ec2014-12-03 10:11:32 +02002164ath10k_wmi_tlv_op_gen_peer_create(struct ath10k *ar, u32 vdev_id,
Marek Puzyniak7390ed32015-03-30 09:51:52 +03002165 const u8 peer_addr[ETH_ALEN],
2166 enum wmi_peer_type peer_type)
Michal Kaziorca996ec2014-12-03 10:11:32 +02002167{
2168 struct wmi_tlv_peer_create_cmd *cmd;
2169 struct wmi_tlv *tlv;
2170 struct sk_buff *skb;
2171
2172 skb = ath10k_wmi_alloc_skb(ar, sizeof(*tlv) + sizeof(*cmd));
2173 if (!skb)
2174 return ERR_PTR(-ENOMEM);
2175
2176 tlv = (void *)skb->data;
2177 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_PEER_CREATE_CMD);
2178 tlv->len = __cpu_to_le16(sizeof(*cmd));
2179 cmd = (void *)tlv->value;
2180 cmd->vdev_id = __cpu_to_le32(vdev_id);
Marek Puzyniak7390ed32015-03-30 09:51:52 +03002181 cmd->peer_type = __cpu_to_le32(peer_type);
Michal Kaziorca996ec2014-12-03 10:11:32 +02002182 ether_addr_copy(cmd->peer_addr.addr, peer_addr);
2183
2184 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv peer create\n");
2185 return skb;
2186}
2187
2188static struct sk_buff *
2189ath10k_wmi_tlv_op_gen_peer_delete(struct ath10k *ar, u32 vdev_id,
2190 const u8 peer_addr[ETH_ALEN])
2191{
2192 struct wmi_peer_delete_cmd *cmd;
2193 struct wmi_tlv *tlv;
2194 struct sk_buff *skb;
2195
2196 skb = ath10k_wmi_alloc_skb(ar, sizeof(*tlv) + sizeof(*cmd));
2197 if (!skb)
2198 return ERR_PTR(-ENOMEM);
2199
2200 tlv = (void *)skb->data;
2201 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_PEER_DELETE_CMD);
2202 tlv->len = __cpu_to_le16(sizeof(*cmd));
2203 cmd = (void *)tlv->value;
2204 cmd->vdev_id = __cpu_to_le32(vdev_id);
2205 ether_addr_copy(cmd->peer_macaddr.addr, peer_addr);
2206
2207 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv peer delete\n");
2208 return skb;
2209}
2210
2211static struct sk_buff *
2212ath10k_wmi_tlv_op_gen_peer_flush(struct ath10k *ar, u32 vdev_id,
2213 const u8 peer_addr[ETH_ALEN], u32 tid_bitmap)
2214{
2215 struct wmi_peer_flush_tids_cmd *cmd;
2216 struct wmi_tlv *tlv;
2217 struct sk_buff *skb;
2218
2219 skb = ath10k_wmi_alloc_skb(ar, sizeof(*tlv) + sizeof(*cmd));
2220 if (!skb)
2221 return ERR_PTR(-ENOMEM);
2222
2223 tlv = (void *)skb->data;
2224 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_PEER_FLUSH_TIDS_CMD);
2225 tlv->len = __cpu_to_le16(sizeof(*cmd));
2226 cmd = (void *)tlv->value;
2227 cmd->vdev_id = __cpu_to_le32(vdev_id);
2228 cmd->peer_tid_bitmap = __cpu_to_le32(tid_bitmap);
2229 ether_addr_copy(cmd->peer_macaddr.addr, peer_addr);
2230
2231 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv peer flush\n");
2232 return skb;
2233}
2234
2235static struct sk_buff *
2236ath10k_wmi_tlv_op_gen_peer_set_param(struct ath10k *ar, u32 vdev_id,
2237 const u8 *peer_addr,
2238 enum wmi_peer_param param_id,
2239 u32 param_value)
2240{
2241 struct wmi_peer_set_param_cmd *cmd;
2242 struct wmi_tlv *tlv;
2243 struct sk_buff *skb;
2244
2245 skb = ath10k_wmi_alloc_skb(ar, sizeof(*tlv) + sizeof(*cmd));
2246 if (!skb)
2247 return ERR_PTR(-ENOMEM);
2248
2249 tlv = (void *)skb->data;
2250 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_PEER_SET_PARAM_CMD);
2251 tlv->len = __cpu_to_le16(sizeof(*cmd));
2252 cmd = (void *)tlv->value;
2253 cmd->vdev_id = __cpu_to_le32(vdev_id);
2254 cmd->param_id = __cpu_to_le32(param_id);
2255 cmd->param_value = __cpu_to_le32(param_value);
2256 ether_addr_copy(cmd->peer_macaddr.addr, peer_addr);
2257
2258 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv peer set param\n");
2259 return skb;
2260}
2261
2262static struct sk_buff *
2263ath10k_wmi_tlv_op_gen_peer_assoc(struct ath10k *ar,
2264 const struct wmi_peer_assoc_complete_arg *arg)
2265{
2266 struct wmi_tlv_peer_assoc_cmd *cmd;
2267 struct wmi_vht_rate_set *vht_rate;
2268 struct wmi_tlv *tlv;
2269 struct sk_buff *skb;
2270 size_t len, legacy_rate_len, ht_rate_len;
2271 void *ptr;
2272
2273 if (arg->peer_mpdu_density > 16)
2274 return ERR_PTR(-EINVAL);
2275 if (arg->peer_legacy_rates.num_rates > MAX_SUPPORTED_RATES)
2276 return ERR_PTR(-EINVAL);
2277 if (arg->peer_ht_rates.num_rates > MAX_SUPPORTED_RATES)
2278 return ERR_PTR(-EINVAL);
2279
2280 legacy_rate_len = roundup(arg->peer_legacy_rates.num_rates,
2281 sizeof(__le32));
2282 ht_rate_len = roundup(arg->peer_ht_rates.num_rates, sizeof(__le32));
2283 len = (sizeof(*tlv) + sizeof(*cmd)) +
2284 (sizeof(*tlv) + legacy_rate_len) +
2285 (sizeof(*tlv) + ht_rate_len) +
2286 (sizeof(*tlv) + sizeof(*vht_rate));
2287 skb = ath10k_wmi_alloc_skb(ar, len);
2288 if (!skb)
2289 return ERR_PTR(-ENOMEM);
2290
2291 ptr = (void *)skb->data;
2292 tlv = ptr;
2293 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_PEER_ASSOC_COMPLETE_CMD);
2294 tlv->len = __cpu_to_le16(sizeof(*cmd));
2295 cmd = (void *)tlv->value;
2296
2297 cmd->vdev_id = __cpu_to_le32(arg->vdev_id);
2298 cmd->new_assoc = __cpu_to_le32(arg->peer_reassoc ? 0 : 1);
2299 cmd->assoc_id = __cpu_to_le32(arg->peer_aid);
2300 cmd->flags = __cpu_to_le32(arg->peer_flags);
2301 cmd->caps = __cpu_to_le32(arg->peer_caps);
2302 cmd->listen_intval = __cpu_to_le32(arg->peer_listen_intval);
2303 cmd->ht_caps = __cpu_to_le32(arg->peer_ht_caps);
2304 cmd->max_mpdu = __cpu_to_le32(arg->peer_max_mpdu);
2305 cmd->mpdu_density = __cpu_to_le32(arg->peer_mpdu_density);
2306 cmd->rate_caps = __cpu_to_le32(arg->peer_rate_caps);
2307 cmd->nss = __cpu_to_le32(arg->peer_num_spatial_streams);
2308 cmd->vht_caps = __cpu_to_le32(arg->peer_vht_caps);
2309 cmd->phy_mode = __cpu_to_le32(arg->peer_phymode);
2310 cmd->num_legacy_rates = __cpu_to_le32(arg->peer_legacy_rates.num_rates);
2311 cmd->num_ht_rates = __cpu_to_le32(arg->peer_ht_rates.num_rates);
2312 ether_addr_copy(cmd->mac_addr.addr, arg->addr);
2313
2314 ptr += sizeof(*tlv);
2315 ptr += sizeof(*cmd);
2316
2317 tlv = ptr;
2318 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_BYTE);
2319 tlv->len = __cpu_to_le16(legacy_rate_len);
2320 memcpy(tlv->value, arg->peer_legacy_rates.rates,
2321 arg->peer_legacy_rates.num_rates);
2322
2323 ptr += sizeof(*tlv);
2324 ptr += legacy_rate_len;
2325
2326 tlv = ptr;
2327 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_BYTE);
2328 tlv->len = __cpu_to_le16(ht_rate_len);
2329 memcpy(tlv->value, arg->peer_ht_rates.rates,
2330 arg->peer_ht_rates.num_rates);
2331
2332 ptr += sizeof(*tlv);
2333 ptr += ht_rate_len;
2334
2335 tlv = ptr;
2336 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_VHT_RATE_SET);
2337 tlv->len = __cpu_to_le16(sizeof(*vht_rate));
2338 vht_rate = (void *)tlv->value;
2339
2340 vht_rate->rx_max_rate = __cpu_to_le32(arg->peer_vht_rates.rx_max_rate);
2341 vht_rate->rx_mcs_set = __cpu_to_le32(arg->peer_vht_rates.rx_mcs_set);
2342 vht_rate->tx_max_rate = __cpu_to_le32(arg->peer_vht_rates.tx_max_rate);
2343 vht_rate->tx_mcs_set = __cpu_to_le32(arg->peer_vht_rates.tx_mcs_set);
2344
2345 ptr += sizeof(*tlv);
2346 ptr += sizeof(*vht_rate);
2347
2348 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv peer assoc\n");
2349 return skb;
2350}
2351
2352static struct sk_buff *
2353ath10k_wmi_tlv_op_gen_set_psmode(struct ath10k *ar, u32 vdev_id,
2354 enum wmi_sta_ps_mode psmode)
2355{
2356 struct wmi_sta_powersave_mode_cmd *cmd;
2357 struct wmi_tlv *tlv;
2358 struct sk_buff *skb;
2359
2360 skb = ath10k_wmi_alloc_skb(ar, sizeof(*tlv) + sizeof(*cmd));
2361 if (!skb)
2362 return ERR_PTR(-ENOMEM);
2363
2364 tlv = (void *)skb->data;
2365 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_STA_POWERSAVE_MODE_CMD);
2366 tlv->len = __cpu_to_le16(sizeof(*cmd));
2367 cmd = (void *)tlv->value;
2368 cmd->vdev_id = __cpu_to_le32(vdev_id);
2369 cmd->sta_ps_mode = __cpu_to_le32(psmode);
2370
2371 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv set psmode\n");
2372 return skb;
2373}
2374
2375static struct sk_buff *
2376ath10k_wmi_tlv_op_gen_set_sta_ps(struct ath10k *ar, u32 vdev_id,
2377 enum wmi_sta_powersave_param param_id,
2378 u32 param_value)
2379{
2380 struct wmi_sta_powersave_param_cmd *cmd;
2381 struct wmi_tlv *tlv;
2382 struct sk_buff *skb;
2383
2384 skb = ath10k_wmi_alloc_skb(ar, sizeof(*tlv) + sizeof(*cmd));
2385 if (!skb)
2386 return ERR_PTR(-ENOMEM);
2387
2388 tlv = (void *)skb->data;
2389 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_STA_POWERSAVE_PARAM_CMD);
2390 tlv->len = __cpu_to_le16(sizeof(*cmd));
2391 cmd = (void *)tlv->value;
2392 cmd->vdev_id = __cpu_to_le32(vdev_id);
2393 cmd->param_id = __cpu_to_le32(param_id);
2394 cmd->param_value = __cpu_to_le32(param_value);
2395
2396 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv set sta ps\n");
2397 return skb;
2398}
2399
2400static struct sk_buff *
2401ath10k_wmi_tlv_op_gen_set_ap_ps(struct ath10k *ar, u32 vdev_id, const u8 *mac,
2402 enum wmi_ap_ps_peer_param param_id, u32 value)
2403{
2404 struct wmi_ap_ps_peer_cmd *cmd;
2405 struct wmi_tlv *tlv;
2406 struct sk_buff *skb;
2407
2408 if (!mac)
2409 return ERR_PTR(-EINVAL);
2410
Michal Kazior4543ab02015-02-25 11:39:36 +01002411 skb = ath10k_wmi_alloc_skb(ar, sizeof(*tlv) + sizeof(*cmd));
Michal Kaziorca996ec2014-12-03 10:11:32 +02002412 if (!skb)
2413 return ERR_PTR(-ENOMEM);
2414
2415 tlv = (void *)skb->data;
2416 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_AP_PS_PEER_CMD);
2417 tlv->len = __cpu_to_le16(sizeof(*cmd));
2418 cmd = (void *)tlv->value;
2419 cmd->vdev_id = __cpu_to_le32(vdev_id);
2420 cmd->param_id = __cpu_to_le32(param_id);
2421 cmd->param_value = __cpu_to_le32(value);
2422 ether_addr_copy(cmd->peer_macaddr.addr, mac);
2423
2424 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv ap ps param\n");
2425 return skb;
2426}
2427
2428static struct sk_buff *
2429ath10k_wmi_tlv_op_gen_scan_chan_list(struct ath10k *ar,
2430 const struct wmi_scan_chan_list_arg *arg)
2431{
2432 struct wmi_tlv_scan_chan_list_cmd *cmd;
2433 struct wmi_channel *ci;
2434 struct wmi_channel_arg *ch;
2435 struct wmi_tlv *tlv;
2436 struct sk_buff *skb;
2437 size_t chans_len, len;
2438 int i;
2439 void *ptr, *chans;
2440
2441 chans_len = arg->n_channels * (sizeof(*tlv) + sizeof(*ci));
2442 len = (sizeof(*tlv) + sizeof(*cmd)) +
2443 (sizeof(*tlv) + chans_len);
2444
2445 skb = ath10k_wmi_alloc_skb(ar, len);
2446 if (!skb)
2447 return ERR_PTR(-ENOMEM);
2448
2449 ptr = (void *)skb->data;
2450 tlv = ptr;
2451 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_SCAN_CHAN_LIST_CMD);
2452 tlv->len = __cpu_to_le16(sizeof(*cmd));
2453 cmd = (void *)tlv->value;
2454 cmd->num_scan_chans = __cpu_to_le32(arg->n_channels);
2455
2456 ptr += sizeof(*tlv);
2457 ptr += sizeof(*cmd);
2458
2459 tlv = ptr;
2460 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_STRUCT);
2461 tlv->len = __cpu_to_le16(chans_len);
2462 chans = (void *)tlv->value;
2463
2464 for (i = 0; i < arg->n_channels; i++) {
2465 ch = &arg->channels[i];
2466
2467 tlv = chans;
2468 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_CHANNEL);
2469 tlv->len = __cpu_to_le16(sizeof(*ci));
2470 ci = (void *)tlv->value;
2471
2472 ath10k_wmi_put_wmi_channel(ci, ch);
2473
2474 chans += sizeof(*tlv);
2475 chans += sizeof(*ci);
2476 }
2477
2478 ptr += sizeof(*tlv);
2479 ptr += chans_len;
2480
2481 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv scan chan list\n");
2482 return skb;
2483}
2484
2485static struct sk_buff *
Michal Kazior9ad50182015-01-29 14:29:47 +02002486ath10k_wmi_tlv_op_gen_beacon_dma(struct ath10k *ar, u32 vdev_id,
2487 const void *bcn, size_t bcn_len,
2488 u32 bcn_paddr, bool dtim_zero,
2489 bool deliver_cab)
2490
Michal Kaziorca996ec2014-12-03 10:11:32 +02002491{
Michal Kaziorca996ec2014-12-03 10:11:32 +02002492 struct wmi_bcn_tx_ref_cmd *cmd;
2493 struct wmi_tlv *tlv;
2494 struct sk_buff *skb;
Michal Kaziorca996ec2014-12-03 10:11:32 +02002495 struct ieee80211_hdr *hdr;
2496 u16 fc;
2497
2498 skb = ath10k_wmi_alloc_skb(ar, sizeof(*tlv) + sizeof(*cmd));
2499 if (!skb)
2500 return ERR_PTR(-ENOMEM);
2501
Michal Kazior9ad50182015-01-29 14:29:47 +02002502 hdr = (struct ieee80211_hdr *)bcn;
Michal Kaziorca996ec2014-12-03 10:11:32 +02002503 fc = le16_to_cpu(hdr->frame_control);
2504
2505 tlv = (void *)skb->data;
2506 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_BCN_SEND_FROM_HOST_CMD);
2507 tlv->len = __cpu_to_le16(sizeof(*cmd));
2508 cmd = (void *)tlv->value;
Michal Kazior9ad50182015-01-29 14:29:47 +02002509 cmd->vdev_id = __cpu_to_le32(vdev_id);
2510 cmd->data_len = __cpu_to_le32(bcn_len);
2511 cmd->data_ptr = __cpu_to_le32(bcn_paddr);
Michal Kaziorca996ec2014-12-03 10:11:32 +02002512 cmd->msdu_id = 0;
2513 cmd->frame_control = __cpu_to_le32(fc);
2514 cmd->flags = 0;
2515
Michal Kazior9ad50182015-01-29 14:29:47 +02002516 if (dtim_zero)
Michal Kaziorca996ec2014-12-03 10:11:32 +02002517 cmd->flags |= __cpu_to_le32(WMI_BCN_TX_REF_FLAG_DTIM_ZERO);
2518
Michal Kazior9ad50182015-01-29 14:29:47 +02002519 if (deliver_cab)
Michal Kaziorca996ec2014-12-03 10:11:32 +02002520 cmd->flags |= __cpu_to_le32(WMI_BCN_TX_REF_FLAG_DELIVER_CAB);
2521
2522 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv beacon dma\n");
2523 return skb;
2524}
2525
Michal Kaziorca996ec2014-12-03 10:11:32 +02002526static struct sk_buff *
2527ath10k_wmi_tlv_op_gen_pdev_set_wmm(struct ath10k *ar,
Michal Kazior5e752e42015-01-19 09:53:41 +01002528 const struct wmi_wmm_params_all_arg *arg)
Michal Kaziorca996ec2014-12-03 10:11:32 +02002529{
2530 struct wmi_tlv_pdev_set_wmm_cmd *cmd;
2531 struct wmi_wmm_params *wmm;
2532 struct wmi_tlv *tlv;
2533 struct sk_buff *skb;
2534 size_t len;
2535 void *ptr;
2536
2537 len = (sizeof(*tlv) + sizeof(*cmd)) +
2538 (4 * (sizeof(*tlv) + sizeof(*wmm)));
2539 skb = ath10k_wmi_alloc_skb(ar, len);
2540 if (!skb)
2541 return ERR_PTR(-ENOMEM);
2542
2543 ptr = (void *)skb->data;
2544
2545 tlv = ptr;
2546 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_PDEV_SET_WMM_PARAMS_CMD);
2547 tlv->len = __cpu_to_le16(sizeof(*cmd));
2548 cmd = (void *)tlv->value;
2549
2550 /* nothing to set here */
2551
2552 ptr += sizeof(*tlv);
2553 ptr += sizeof(*cmd);
2554
2555 ptr = ath10k_wmi_tlv_put_wmm(ptr, &arg->ac_be);
2556 ptr = ath10k_wmi_tlv_put_wmm(ptr, &arg->ac_bk);
2557 ptr = ath10k_wmi_tlv_put_wmm(ptr, &arg->ac_vi);
2558 ptr = ath10k_wmi_tlv_put_wmm(ptr, &arg->ac_vo);
2559
2560 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv pdev set wmm\n");
2561 return skb;
2562}
2563
2564static struct sk_buff *
Michal Kaziorde23d3e2015-02-15 16:50:41 +02002565ath10k_wmi_tlv_op_gen_request_stats(struct ath10k *ar, u32 stats_mask)
Michal Kaziorca996ec2014-12-03 10:11:32 +02002566{
2567 struct wmi_request_stats_cmd *cmd;
2568 struct wmi_tlv *tlv;
2569 struct sk_buff *skb;
2570
2571 skb = ath10k_wmi_alloc_skb(ar, sizeof(*tlv) + sizeof(*cmd));
2572 if (!skb)
2573 return ERR_PTR(-ENOMEM);
2574
2575 tlv = (void *)skb->data;
2576 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_REQUEST_STATS_CMD);
2577 tlv->len = __cpu_to_le16(sizeof(*cmd));
2578 cmd = (void *)tlv->value;
Michal Kaziorde23d3e2015-02-15 16:50:41 +02002579 cmd->stats_id = __cpu_to_le32(stats_mask);
Michal Kaziorca996ec2014-12-03 10:11:32 +02002580
2581 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv request stats\n");
2582 return skb;
2583}
2584
2585static struct sk_buff *
Rakesh Pillai38a13902018-02-27 19:09:07 +02002586ath10k_wmi_tlv_op_gen_mgmt_tx_send(struct ath10k *ar, struct sk_buff *msdu,
2587 dma_addr_t paddr)
Rakesh Pillai1807da42017-12-11 19:52:53 +05302588{
2589 struct ath10k_skb_cb *cb = ATH10K_SKB_CB(msdu);
2590 struct wmi_tlv_mgmt_tx_cmd *cmd;
Rakesh Pillai1807da42017-12-11 19:52:53 +05302591 struct ieee80211_hdr *hdr;
Rakesh Pillai38a13902018-02-27 19:09:07 +02002592 struct ath10k_vif *arvif;
2593 u32 buf_len = msdu->len;
2594 struct wmi_tlv *tlv;
Rakesh Pillai1807da42017-12-11 19:52:53 +05302595 struct sk_buff *skb;
Rakesh Pillai38a13902018-02-27 19:09:07 +02002596 u32 vdev_id;
Rakesh Pillai1807da42017-12-11 19:52:53 +05302597 void *ptr;
2598 int len;
Rakesh Pillai1807da42017-12-11 19:52:53 +05302599
2600 if (!cb->vif)
2601 return ERR_PTR(-EINVAL);
2602
2603 hdr = (struct ieee80211_hdr *)msdu->data;
Rakesh Pillai1807da42017-12-11 19:52:53 +05302604 arvif = (void *)cb->vif->drv_priv;
2605 vdev_id = arvif->vdev_id;
2606
2607 if (WARN_ON_ONCE(!ieee80211_is_mgmt(hdr->frame_control)))
2608 return ERR_PTR(-EINVAL);
2609
2610 len = sizeof(*cmd) + 2 * sizeof(*tlv);
2611
2612 if ((ieee80211_is_action(hdr->frame_control) ||
2613 ieee80211_is_deauth(hdr->frame_control) ||
2614 ieee80211_is_disassoc(hdr->frame_control)) &&
2615 ieee80211_has_protected(hdr->frame_control)) {
2616 len += IEEE80211_CCMP_MIC_LEN;
2617 buf_len += IEEE80211_CCMP_MIC_LEN;
2618 }
2619
2620 buf_len = min_t(u32, buf_len, WMI_TLV_MGMT_TX_FRAME_MAX_LEN);
2621 buf_len = round_up(buf_len, 4);
2622
2623 len += buf_len;
2624 len = round_up(len, 4);
2625 skb = ath10k_wmi_alloc_skb(ar, len);
2626 if (!skb)
2627 return ERR_PTR(-ENOMEM);
2628
2629 ptr = (void *)skb->data;
2630 tlv = ptr;
2631 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_MGMT_TX_CMD);
2632 tlv->len = __cpu_to_le16(sizeof(*cmd));
2633 cmd = (void *)tlv->value;
2634 cmd->vdev_id = __cpu_to_le32(vdev_id);
2635 cmd->desc_id = 0;
2636 cmd->chanfreq = 0;
2637 cmd->buf_len = __cpu_to_le32(buf_len);
2638 cmd->frame_len = __cpu_to_le32(msdu->len);
Rakesh Pillai38a13902018-02-27 19:09:07 +02002639 cmd->paddr = __cpu_to_le64(paddr);
Rakesh Pillai1807da42017-12-11 19:52:53 +05302640
2641 ptr += sizeof(*tlv);
2642 ptr += sizeof(*cmd);
2643
2644 tlv = ptr;
2645 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_BYTE);
2646 tlv->len = __cpu_to_le16(buf_len);
2647
2648 ptr += sizeof(*tlv);
2649 memcpy(ptr, msdu->data, buf_len);
2650
2651 return skb;
2652}
2653
2654static struct sk_buff *
Michal Kaziorca996ec2014-12-03 10:11:32 +02002655ath10k_wmi_tlv_op_gen_force_fw_hang(struct ath10k *ar,
2656 enum wmi_force_fw_hang_type type,
2657 u32 delay_ms)
2658{
2659 struct wmi_force_fw_hang_cmd *cmd;
2660 struct wmi_tlv *tlv;
2661 struct sk_buff *skb;
2662
2663 skb = ath10k_wmi_alloc_skb(ar, sizeof(*tlv) + sizeof(*cmd));
2664 if (!skb)
2665 return ERR_PTR(-ENOMEM);
2666
2667 tlv = (void *)skb->data;
2668 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_FORCE_FW_HANG_CMD);
2669 tlv->len = __cpu_to_le16(sizeof(*cmd));
2670 cmd = (void *)tlv->value;
2671 cmd->type = __cpu_to_le32(type);
2672 cmd->delay_ms = __cpu_to_le32(delay_ms);
2673
2674 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv force fw hang\n");
2675 return skb;
2676}
2677
2678static struct sk_buff *
Maharaja Kennadyrajanafcbc822016-08-23 15:35:36 +05302679ath10k_wmi_tlv_op_gen_dbglog_cfg(struct ath10k *ar, u64 module_enable,
SenthilKumar Jegadeesan467210a2015-01-29 14:36:52 +05302680 u32 log_level) {
Michal Kaziorca996ec2014-12-03 10:11:32 +02002681 struct wmi_tlv_dbglog_cmd *cmd;
2682 struct wmi_tlv *tlv;
2683 struct sk_buff *skb;
2684 size_t len, bmap_len;
2685 u32 value;
2686 void *ptr;
2687
2688 if (module_enable) {
2689 value = WMI_TLV_DBGLOG_LOG_LEVEL_VALUE(
2690 module_enable,
2691 WMI_TLV_DBGLOG_LOG_LEVEL_VERBOSE);
2692 } else {
2693 value = WMI_TLV_DBGLOG_LOG_LEVEL_VALUE(
2694 WMI_TLV_DBGLOG_ALL_MODULES,
2695 WMI_TLV_DBGLOG_LOG_LEVEL_WARN);
2696 }
2697
2698 bmap_len = 0;
2699 len = sizeof(*tlv) + sizeof(*cmd) + sizeof(*tlv) + bmap_len;
2700 skb = ath10k_wmi_alloc_skb(ar, len);
2701 if (!skb)
2702 return ERR_PTR(-ENOMEM);
2703
2704 ptr = (void *)skb->data;
2705
2706 tlv = ptr;
2707 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_DEBUG_LOG_CONFIG_CMD);
2708 tlv->len = __cpu_to_le16(sizeof(*cmd));
2709 cmd = (void *)tlv->value;
2710 cmd->param = __cpu_to_le32(WMI_TLV_DBGLOG_PARAM_LOG_LEVEL);
2711 cmd->value = __cpu_to_le32(value);
2712
2713 ptr += sizeof(*tlv);
2714 ptr += sizeof(*cmd);
2715
2716 tlv = ptr;
2717 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_UINT32);
2718 tlv->len = __cpu_to_le16(bmap_len);
2719
2720 /* nothing to do here */
2721
2722 ptr += sizeof(*tlv);
2723 ptr += sizeof(bmap_len);
2724
2725 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv dbglog value 0x%08x\n", value);
2726 return skb;
2727}
2728
2729static struct sk_buff *
2730ath10k_wmi_tlv_op_gen_pktlog_enable(struct ath10k *ar, u32 filter)
2731{
2732 struct wmi_tlv_pktlog_enable *cmd;
2733 struct wmi_tlv *tlv;
2734 struct sk_buff *skb;
2735 void *ptr;
2736 size_t len;
2737
2738 len = sizeof(*tlv) + sizeof(*cmd);
2739 skb = ath10k_wmi_alloc_skb(ar, len);
2740 if (!skb)
2741 return ERR_PTR(-ENOMEM);
2742
2743 ptr = (void *)skb->data;
2744 tlv = ptr;
2745 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_PDEV_PKTLOG_ENABLE_CMD);
2746 tlv->len = __cpu_to_le16(sizeof(*cmd));
2747 cmd = (void *)tlv->value;
2748 cmd->filter = __cpu_to_le32(filter);
2749
2750 ptr += sizeof(*tlv);
2751 ptr += sizeof(*cmd);
2752
2753 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv pktlog enable filter 0x%08x\n",
2754 filter);
2755 return skb;
2756}
2757
2758static struct sk_buff *
Ryan Hsue98199a2018-03-27 11:25:36 +03002759ath10k_wmi_tlv_op_gen_pdev_get_temperature(struct ath10k *ar)
2760{
2761 struct wmi_tlv_pdev_get_temp_cmd *cmd;
2762 struct wmi_tlv *tlv;
2763 struct sk_buff *skb;
2764
2765 skb = ath10k_wmi_alloc_skb(ar, sizeof(*tlv) + sizeof(*cmd));
2766 if (!skb)
2767 return ERR_PTR(-ENOMEM);
2768
2769 tlv = (void *)skb->data;
2770 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_PDEV_GET_TEMPERATURE_CMD);
2771 tlv->len = __cpu_to_le16(sizeof(*cmd));
2772 cmd = (void *)tlv->value;
2773 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi pdev get temperature tlv\n");
2774 return skb;
2775}
2776
2777static struct sk_buff *
Michal Kaziorca996ec2014-12-03 10:11:32 +02002778ath10k_wmi_tlv_op_gen_pktlog_disable(struct ath10k *ar)
2779{
2780 struct wmi_tlv_pktlog_disable *cmd;
2781 struct wmi_tlv *tlv;
2782 struct sk_buff *skb;
2783 void *ptr;
2784 size_t len;
2785
2786 len = sizeof(*tlv) + sizeof(*cmd);
2787 skb = ath10k_wmi_alloc_skb(ar, len);
2788 if (!skb)
2789 return ERR_PTR(-ENOMEM);
2790
2791 ptr = (void *)skb->data;
2792 tlv = ptr;
2793 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_PDEV_PKTLOG_DISABLE_CMD);
2794 tlv->len = __cpu_to_le16(sizeof(*cmd));
2795 cmd = (void *)tlv->value;
2796
2797 ptr += sizeof(*tlv);
2798 ptr += sizeof(*cmd);
2799
2800 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv pktlog disable\n");
2801 return skb;
2802}
2803
Michal Kaziorbe9ce9d2015-01-13 16:30:11 +02002804static struct sk_buff *
2805ath10k_wmi_tlv_op_gen_bcn_tmpl(struct ath10k *ar, u32 vdev_id,
2806 u32 tim_ie_offset, struct sk_buff *bcn,
2807 u32 prb_caps, u32 prb_erp, void *prb_ies,
2808 size_t prb_ies_len)
2809{
2810 struct wmi_tlv_bcn_tmpl_cmd *cmd;
2811 struct wmi_tlv_bcn_prb_info *info;
2812 struct wmi_tlv *tlv;
2813 struct sk_buff *skb;
2814 void *ptr;
2815 size_t len;
2816
2817 if (WARN_ON(prb_ies_len > 0 && !prb_ies))
2818 return ERR_PTR(-EINVAL);
2819
2820 len = sizeof(*tlv) + sizeof(*cmd) +
2821 sizeof(*tlv) + sizeof(*info) + prb_ies_len +
2822 sizeof(*tlv) + roundup(bcn->len, 4);
2823 skb = ath10k_wmi_alloc_skb(ar, len);
2824 if (!skb)
2825 return ERR_PTR(-ENOMEM);
2826
2827 ptr = (void *)skb->data;
2828 tlv = ptr;
2829 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_BCN_TMPL_CMD);
2830 tlv->len = __cpu_to_le16(sizeof(*cmd));
2831 cmd = (void *)tlv->value;
2832 cmd->vdev_id = __cpu_to_le32(vdev_id);
2833 cmd->tim_ie_offset = __cpu_to_le32(tim_ie_offset);
2834 cmd->buf_len = __cpu_to_le32(bcn->len);
2835
2836 ptr += sizeof(*tlv);
2837 ptr += sizeof(*cmd);
2838
2839 /* FIXME: prb_ies_len should be probably aligned to 4byte boundary but
2840 * then it is then impossible to pass original ie len.
2841 * This chunk is not used yet so if setting probe resp template yields
2842 * problems with beaconing or crashes firmware look here.
2843 */
2844 tlv = ptr;
2845 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_BCN_PRB_INFO);
2846 tlv->len = __cpu_to_le16(sizeof(*info) + prb_ies_len);
2847 info = (void *)tlv->value;
2848 info->caps = __cpu_to_le32(prb_caps);
2849 info->erp = __cpu_to_le32(prb_erp);
2850 memcpy(info->ies, prb_ies, prb_ies_len);
2851
2852 ptr += sizeof(*tlv);
2853 ptr += sizeof(*info);
2854 ptr += prb_ies_len;
2855
2856 tlv = ptr;
2857 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_BYTE);
2858 tlv->len = __cpu_to_le16(roundup(bcn->len, 4));
2859 memcpy(tlv->value, bcn->data, bcn->len);
2860
2861 /* FIXME: Adjust TSF? */
2862
2863 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv bcn tmpl vdev_id %i\n",
2864 vdev_id);
2865 return skb;
2866}
2867
Michal Kazior4c4955f2015-01-13 16:30:11 +02002868static struct sk_buff *
2869ath10k_wmi_tlv_op_gen_prb_tmpl(struct ath10k *ar, u32 vdev_id,
2870 struct sk_buff *prb)
2871{
2872 struct wmi_tlv_prb_tmpl_cmd *cmd;
2873 struct wmi_tlv_bcn_prb_info *info;
2874 struct wmi_tlv *tlv;
2875 struct sk_buff *skb;
2876 void *ptr;
2877 size_t len;
2878
2879 len = sizeof(*tlv) + sizeof(*cmd) +
2880 sizeof(*tlv) + sizeof(*info) +
2881 sizeof(*tlv) + roundup(prb->len, 4);
2882 skb = ath10k_wmi_alloc_skb(ar, len);
2883 if (!skb)
2884 return ERR_PTR(-ENOMEM);
2885
2886 ptr = (void *)skb->data;
2887 tlv = ptr;
2888 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_PRB_TMPL_CMD);
2889 tlv->len = __cpu_to_le16(sizeof(*cmd));
2890 cmd = (void *)tlv->value;
2891 cmd->vdev_id = __cpu_to_le32(vdev_id);
2892 cmd->buf_len = __cpu_to_le32(prb->len);
2893
2894 ptr += sizeof(*tlv);
2895 ptr += sizeof(*cmd);
2896
2897 tlv = ptr;
2898 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_BCN_PRB_INFO);
2899 tlv->len = __cpu_to_le16(sizeof(*info));
2900 info = (void *)tlv->value;
2901 info->caps = 0;
2902 info->erp = 0;
2903
2904 ptr += sizeof(*tlv);
2905 ptr += sizeof(*info);
2906
2907 tlv = ptr;
2908 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_BYTE);
2909 tlv->len = __cpu_to_le16(roundup(prb->len, 4));
2910 memcpy(tlv->value, prb->data, prb->len);
2911
2912 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv prb tmpl vdev_id %i\n",
2913 vdev_id);
2914 return skb;
2915}
2916
Michal Kazior369242b4e2015-01-13 16:30:11 +02002917static struct sk_buff *
2918ath10k_wmi_tlv_op_gen_p2p_go_bcn_ie(struct ath10k *ar, u32 vdev_id,
2919 const u8 *p2p_ie)
2920{
2921 struct wmi_tlv_p2p_go_bcn_ie *cmd;
2922 struct wmi_tlv *tlv;
2923 struct sk_buff *skb;
2924 void *ptr;
2925 size_t len;
2926
2927 len = sizeof(*tlv) + sizeof(*cmd) +
2928 sizeof(*tlv) + roundup(p2p_ie[1] + 2, 4);
2929 skb = ath10k_wmi_alloc_skb(ar, len);
2930 if (!skb)
2931 return ERR_PTR(-ENOMEM);
2932
2933 ptr = (void *)skb->data;
2934 tlv = ptr;
2935 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_P2P_GO_SET_BEACON_IE);
2936 tlv->len = __cpu_to_le16(sizeof(*cmd));
2937 cmd = (void *)tlv->value;
2938 cmd->vdev_id = __cpu_to_le32(vdev_id);
2939 cmd->ie_len = __cpu_to_le32(p2p_ie[1] + 2);
2940
2941 ptr += sizeof(*tlv);
2942 ptr += sizeof(*cmd);
2943
2944 tlv = ptr;
2945 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_BYTE);
2946 tlv->len = __cpu_to_le16(roundup(p2p_ie[1] + 2, 4));
2947 memcpy(tlv->value, p2p_ie, p2p_ie[1] + 2);
2948
2949 ptr += sizeof(*tlv);
2950 ptr += roundup(p2p_ie[1] + 2, 4);
2951
2952 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv p2p go bcn ie for vdev %i\n",
2953 vdev_id);
2954 return skb;
2955}
2956
Janusz Dziedzicf5431e82015-03-23 17:32:53 +02002957static struct sk_buff *
Marek Puzyniakad45c882015-03-30 09:51:53 +03002958ath10k_wmi_tlv_op_gen_update_fw_tdls_state(struct ath10k *ar, u32 vdev_id,
2959 enum wmi_tdls_state state)
2960{
2961 struct wmi_tdls_set_state_cmd *cmd;
2962 struct wmi_tlv *tlv;
2963 struct sk_buff *skb;
2964 void *ptr;
2965 size_t len;
2966 /* Set to options from wmi_tlv_tdls_options,
2967 * for now none of them are enabled.
2968 */
2969 u32 options = 0;
2970
Yingying Tang802ca332018-03-28 12:12:52 +03002971 if (test_bit(WMI_SERVICE_TDLS_UAPSD_BUFFER_STA, ar->wmi.svc_map))
2972 options |= WMI_TLV_TDLS_BUFFER_STA_EN;
2973
Yingying Tang4c9f8d12018-03-28 12:13:07 +03002974 /* WMI_TDLS_ENABLE_ACTIVE_EXTERNAL_CONTROL means firm will handle TDLS
2975 * link inactivity detecting logic.
2976 */
2977 if (state == WMI_TDLS_ENABLE_ACTIVE)
2978 state = WMI_TDLS_ENABLE_ACTIVE_EXTERNAL_CONTROL;
2979
Marek Puzyniakad45c882015-03-30 09:51:53 +03002980 len = sizeof(*tlv) + sizeof(*cmd);
2981 skb = ath10k_wmi_alloc_skb(ar, len);
2982 if (!skb)
2983 return ERR_PTR(-ENOMEM);
2984
2985 ptr = (void *)skb->data;
2986 tlv = ptr;
2987 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_TDLS_SET_STATE_CMD);
2988 tlv->len = __cpu_to_le16(sizeof(*cmd));
2989
2990 cmd = (void *)tlv->value;
2991 cmd->vdev_id = __cpu_to_le32(vdev_id);
2992 cmd->state = __cpu_to_le32(state);
2993 cmd->notification_interval_ms = __cpu_to_le32(5000);
2994 cmd->tx_discovery_threshold = __cpu_to_le32(100);
2995 cmd->tx_teardown_threshold = __cpu_to_le32(5);
2996 cmd->rssi_teardown_threshold = __cpu_to_le32(-75);
2997 cmd->rssi_delta = __cpu_to_le32(-20);
2998 cmd->tdls_options = __cpu_to_le32(options);
2999 cmd->tdls_peer_traffic_ind_window = __cpu_to_le32(2);
3000 cmd->tdls_peer_traffic_response_timeout_ms = __cpu_to_le32(5000);
3001 cmd->tdls_puapsd_mask = __cpu_to_le32(0xf);
3002 cmd->tdls_puapsd_inactivity_time_ms = __cpu_to_le32(0);
3003 cmd->tdls_puapsd_rx_frame_threshold = __cpu_to_le32(10);
3004
3005 ptr += sizeof(*tlv);
3006 ptr += sizeof(*cmd);
3007
3008 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv update fw tdls state %d for vdev %i\n",
3009 state, vdev_id);
3010 return skb;
3011}
3012
3013static u32 ath10k_wmi_tlv_prepare_peer_qos(u8 uapsd_queues, u8 sp)
3014{
3015 u32 peer_qos = 0;
3016
3017 if (uapsd_queues & IEEE80211_WMM_IE_STA_QOSINFO_AC_VO)
3018 peer_qos |= WMI_TLV_TDLS_PEER_QOS_AC_VO;
3019 if (uapsd_queues & IEEE80211_WMM_IE_STA_QOSINFO_AC_VI)
3020 peer_qos |= WMI_TLV_TDLS_PEER_QOS_AC_VI;
3021 if (uapsd_queues & IEEE80211_WMM_IE_STA_QOSINFO_AC_BK)
3022 peer_qos |= WMI_TLV_TDLS_PEER_QOS_AC_BK;
3023 if (uapsd_queues & IEEE80211_WMM_IE_STA_QOSINFO_AC_BE)
3024 peer_qos |= WMI_TLV_TDLS_PEER_QOS_AC_BE;
3025
3026 peer_qos |= SM(sp, WMI_TLV_TDLS_PEER_SP);
3027
3028 return peer_qos;
3029}
3030
3031static struct sk_buff *
3032ath10k_wmi_tlv_op_gen_tdls_peer_update(struct ath10k *ar,
3033 const struct wmi_tdls_peer_update_cmd_arg *arg,
3034 const struct wmi_tdls_peer_capab_arg *cap,
3035 const struct wmi_channel_arg *chan_arg)
3036{
3037 struct wmi_tdls_peer_update_cmd *cmd;
3038 struct wmi_tdls_peer_capab *peer_cap;
3039 struct wmi_channel *chan;
3040 struct wmi_tlv *tlv;
3041 struct sk_buff *skb;
3042 u32 peer_qos;
3043 void *ptr;
3044 int len;
3045 int i;
3046
3047 len = sizeof(*tlv) + sizeof(*cmd) +
3048 sizeof(*tlv) + sizeof(*peer_cap) +
3049 sizeof(*tlv) + cap->peer_chan_len * sizeof(*chan);
3050
3051 skb = ath10k_wmi_alloc_skb(ar, len);
3052 if (!skb)
3053 return ERR_PTR(-ENOMEM);
3054
3055 ptr = (void *)skb->data;
3056 tlv = ptr;
3057 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_TDLS_PEER_UPDATE_CMD);
3058 tlv->len = __cpu_to_le16(sizeof(*cmd));
3059
3060 cmd = (void *)tlv->value;
3061 cmd->vdev_id = __cpu_to_le32(arg->vdev_id);
3062 ether_addr_copy(cmd->peer_macaddr.addr, arg->addr);
3063 cmd->peer_state = __cpu_to_le32(arg->peer_state);
3064
3065 ptr += sizeof(*tlv);
3066 ptr += sizeof(*cmd);
3067
3068 tlv = ptr;
3069 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_TDLS_PEER_CAPABILITIES);
3070 tlv->len = __cpu_to_le16(sizeof(*peer_cap));
3071 peer_cap = (void *)tlv->value;
3072 peer_qos = ath10k_wmi_tlv_prepare_peer_qos(cap->peer_uapsd_queues,
3073 cap->peer_max_sp);
3074 peer_cap->peer_qos = __cpu_to_le32(peer_qos);
3075 peer_cap->buff_sta_support = __cpu_to_le32(cap->buff_sta_support);
3076 peer_cap->off_chan_support = __cpu_to_le32(cap->off_chan_support);
3077 peer_cap->peer_curr_operclass = __cpu_to_le32(cap->peer_curr_operclass);
3078 peer_cap->self_curr_operclass = __cpu_to_le32(cap->self_curr_operclass);
3079 peer_cap->peer_chan_len = __cpu_to_le32(cap->peer_chan_len);
3080 peer_cap->peer_operclass_len = __cpu_to_le32(cap->peer_operclass_len);
3081
3082 for (i = 0; i < WMI_TDLS_MAX_SUPP_OPER_CLASSES; i++)
3083 peer_cap->peer_operclass[i] = cap->peer_operclass[i];
3084
3085 peer_cap->is_peer_responder = __cpu_to_le32(cap->is_peer_responder);
3086 peer_cap->pref_offchan_num = __cpu_to_le32(cap->pref_offchan_num);
3087 peer_cap->pref_offchan_bw = __cpu_to_le32(cap->pref_offchan_bw);
3088
3089 ptr += sizeof(*tlv);
3090 ptr += sizeof(*peer_cap);
3091
3092 tlv = ptr;
3093 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_STRUCT);
3094 tlv->len = __cpu_to_le16(cap->peer_chan_len * sizeof(*chan));
3095
3096 ptr += sizeof(*tlv);
3097
3098 for (i = 0; i < cap->peer_chan_len; i++) {
3099 tlv = ptr;
3100 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_CHANNEL);
3101 tlv->len = __cpu_to_le16(sizeof(*chan));
3102 chan = (void *)tlv->value;
3103 ath10k_wmi_put_wmi_channel(chan, &chan_arg[i]);
3104
3105 ptr += sizeof(*tlv);
3106 ptr += sizeof(*chan);
3107 }
3108
3109 ath10k_dbg(ar, ATH10K_DBG_WMI,
3110 "wmi tlv tdls peer update vdev %i state %d n_chans %u\n",
3111 arg->vdev_id, arg->peer_state, cap->peer_chan_len);
3112 return skb;
3113}
3114
3115static struct sk_buff *
Janusz Dziedzicf5431e82015-03-23 17:32:53 +02003116ath10k_wmi_tlv_op_gen_wow_enable(struct ath10k *ar)
3117{
3118 struct wmi_tlv_wow_enable_cmd *cmd;
3119 struct wmi_tlv *tlv;
3120 struct sk_buff *skb;
3121 size_t len;
3122
3123 len = sizeof(*tlv) + sizeof(*cmd);
3124 skb = ath10k_wmi_alloc_skb(ar, len);
3125 if (!skb)
3126 return ERR_PTR(-ENOMEM);
3127
3128 tlv = (struct wmi_tlv *)skb->data;
3129 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_WOW_ENABLE_CMD);
3130 tlv->len = __cpu_to_le16(sizeof(*cmd));
3131 cmd = (void *)tlv->value;
3132
3133 cmd->enable = __cpu_to_le32(1);
3134
3135 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv wow enable\n");
3136 return skb;
3137}
3138
3139static struct sk_buff *
3140ath10k_wmi_tlv_op_gen_wow_add_wakeup_event(struct ath10k *ar,
3141 u32 vdev_id,
3142 enum wmi_wow_wakeup_event event,
3143 u32 enable)
3144{
3145 struct wmi_tlv_wow_add_del_event_cmd *cmd;
3146 struct wmi_tlv *tlv;
3147 struct sk_buff *skb;
3148 size_t len;
3149
3150 len = sizeof(*tlv) + sizeof(*cmd);
3151 skb = ath10k_wmi_alloc_skb(ar, len);
3152 if (!skb)
3153 return ERR_PTR(-ENOMEM);
3154
3155 tlv = (struct wmi_tlv *)skb->data;
3156 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_WOW_ADD_DEL_EVT_CMD);
3157 tlv->len = __cpu_to_le16(sizeof(*cmd));
3158 cmd = (void *)tlv->value;
3159
3160 cmd->vdev_id = __cpu_to_le32(vdev_id);
3161 cmd->is_add = __cpu_to_le32(enable);
3162 cmd->event_bitmap = __cpu_to_le32(1 << event);
3163
3164 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv wow add wakeup event %s enable %d vdev_id %d\n",
3165 wow_wakeup_event(event), enable, vdev_id);
3166 return skb;
3167}
3168
3169static struct sk_buff *
3170ath10k_wmi_tlv_gen_wow_host_wakeup_ind(struct ath10k *ar)
3171{
3172 struct wmi_tlv_wow_host_wakeup_ind *cmd;
3173 struct wmi_tlv *tlv;
3174 struct sk_buff *skb;
3175 size_t len;
3176
3177 len = sizeof(*tlv) + sizeof(*cmd);
3178 skb = ath10k_wmi_alloc_skb(ar, len);
3179 if (!skb)
3180 return ERR_PTR(-ENOMEM);
3181
3182 tlv = (struct wmi_tlv *)skb->data;
3183 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_WOW_HOSTWAKEUP_FROM_SLEEP_CMD);
3184 tlv->len = __cpu_to_le16(sizeof(*cmd));
3185 cmd = (void *)tlv->value;
3186
3187 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv wow host wakeup ind\n");
3188 return skb;
3189}
3190
Janusz Dziedzicd4976102015-03-23 17:32:54 +02003191static struct sk_buff *
3192ath10k_wmi_tlv_op_gen_wow_add_pattern(struct ath10k *ar, u32 vdev_id,
3193 u32 pattern_id, const u8 *pattern,
3194 const u8 *bitmask, int pattern_len,
3195 int pattern_offset)
3196{
3197 struct wmi_tlv_wow_add_pattern_cmd *cmd;
3198 struct wmi_tlv_wow_bitmap_pattern *bitmap;
3199 struct wmi_tlv *tlv;
3200 struct sk_buff *skb;
3201 void *ptr;
3202 size_t len;
3203
3204 len = sizeof(*tlv) + sizeof(*cmd) +
3205 sizeof(*tlv) + /* array struct */
3206 sizeof(*tlv) + sizeof(*bitmap) + /* bitmap */
3207 sizeof(*tlv) + /* empty ipv4 sync */
3208 sizeof(*tlv) + /* empty ipv6 sync */
3209 sizeof(*tlv) + /* empty magic */
3210 sizeof(*tlv) + /* empty info timeout */
3211 sizeof(*tlv) + sizeof(u32); /* ratelimit interval */
3212
3213 skb = ath10k_wmi_alloc_skb(ar, len);
3214 if (!skb)
3215 return ERR_PTR(-ENOMEM);
3216
3217 /* cmd */
3218 ptr = (void *)skb->data;
3219 tlv = ptr;
3220 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_WOW_ADD_PATTERN_CMD);
3221 tlv->len = __cpu_to_le16(sizeof(*cmd));
3222 cmd = (void *)tlv->value;
3223
3224 cmd->vdev_id = __cpu_to_le32(vdev_id);
3225 cmd->pattern_id = __cpu_to_le32(pattern_id);
3226 cmd->pattern_type = __cpu_to_le32(WOW_BITMAP_PATTERN);
3227
3228 ptr += sizeof(*tlv);
3229 ptr += sizeof(*cmd);
3230
3231 /* bitmap */
3232 tlv = ptr;
3233 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_STRUCT);
3234 tlv->len = __cpu_to_le16(sizeof(*tlv) + sizeof(*bitmap));
3235
3236 ptr += sizeof(*tlv);
3237
3238 tlv = ptr;
3239 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_WOW_BITMAP_PATTERN_T);
3240 tlv->len = __cpu_to_le16(sizeof(*bitmap));
3241 bitmap = (void *)tlv->value;
3242
3243 memcpy(bitmap->patternbuf, pattern, pattern_len);
3244 memcpy(bitmap->bitmaskbuf, bitmask, pattern_len);
3245 bitmap->pattern_offset = __cpu_to_le32(pattern_offset);
3246 bitmap->pattern_len = __cpu_to_le32(pattern_len);
3247 bitmap->bitmask_len = __cpu_to_le32(pattern_len);
3248 bitmap->pattern_id = __cpu_to_le32(pattern_id);
3249
3250 ptr += sizeof(*tlv);
3251 ptr += sizeof(*bitmap);
3252
3253 /* ipv4 sync */
3254 tlv = ptr;
3255 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_STRUCT);
3256 tlv->len = __cpu_to_le16(0);
3257
3258 ptr += sizeof(*tlv);
3259
3260 /* ipv6 sync */
3261 tlv = ptr;
3262 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_STRUCT);
3263 tlv->len = __cpu_to_le16(0);
3264
3265 ptr += sizeof(*tlv);
3266
3267 /* magic */
3268 tlv = ptr;
3269 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_STRUCT);
3270 tlv->len = __cpu_to_le16(0);
3271
3272 ptr += sizeof(*tlv);
3273
3274 /* pattern info timeout */
3275 tlv = ptr;
3276 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_UINT32);
3277 tlv->len = __cpu_to_le16(0);
3278
3279 ptr += sizeof(*tlv);
3280
3281 /* ratelimit interval */
3282 tlv = ptr;
3283 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_UINT32);
3284 tlv->len = __cpu_to_le16(sizeof(u32));
3285
3286 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv wow add pattern vdev_id %d pattern_id %d, pattern_offset %d\n",
3287 vdev_id, pattern_id, pattern_offset);
3288 return skb;
3289}
3290
3291static struct sk_buff *
3292ath10k_wmi_tlv_op_gen_wow_del_pattern(struct ath10k *ar, u32 vdev_id,
3293 u32 pattern_id)
3294{
3295 struct wmi_tlv_wow_del_pattern_cmd *cmd;
3296 struct wmi_tlv *tlv;
3297 struct sk_buff *skb;
3298 size_t len;
3299
3300 len = sizeof(*tlv) + sizeof(*cmd);
3301 skb = ath10k_wmi_alloc_skb(ar, len);
3302 if (!skb)
3303 return ERR_PTR(-ENOMEM);
3304
3305 tlv = (struct wmi_tlv *)skb->data;
3306 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_WOW_DEL_PATTERN_CMD);
3307 tlv->len = __cpu_to_le16(sizeof(*cmd));
3308 cmd = (void *)tlv->value;
3309
3310 cmd->vdev_id = __cpu_to_le32(vdev_id);
3311 cmd->pattern_id = __cpu_to_le32(pattern_id);
3312 cmd->pattern_type = __cpu_to_le32(WOW_BITMAP_PATTERN);
3313
3314 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv wow del pattern vdev_id %d pattern_id %d\n",
3315 vdev_id, pattern_id);
3316 return skb;
3317}
3318
Michal Kazior5b272e32015-03-31 10:26:22 +00003319static struct sk_buff *
3320ath10k_wmi_tlv_op_gen_adaptive_qcs(struct ath10k *ar, bool enable)
3321{
3322 struct wmi_tlv_adaptive_qcs *cmd;
3323 struct wmi_tlv *tlv;
3324 struct sk_buff *skb;
3325 void *ptr;
3326 size_t len;
3327
3328 len = sizeof(*tlv) + sizeof(*cmd);
3329 skb = ath10k_wmi_alloc_skb(ar, len);
3330 if (!skb)
3331 return ERR_PTR(-ENOMEM);
3332
3333 ptr = (void *)skb->data;
3334 tlv = ptr;
3335 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_RESMGR_ADAPTIVE_OCS_CMD);
3336 tlv->len = __cpu_to_le16(sizeof(*cmd));
3337 cmd = (void *)tlv->value;
3338 cmd->enable = __cpu_to_le32(enable ? 1 : 0);
3339
3340 ptr += sizeof(*tlv);
3341 ptr += sizeof(*cmd);
3342
3343 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv adaptive qcs %d\n", enable);
3344 return skb;
3345}
3346
Michal Kaziore25854f2016-08-19 13:37:41 +03003347static struct sk_buff *
3348ath10k_wmi_tlv_op_gen_echo(struct ath10k *ar, u32 value)
3349{
3350 struct wmi_echo_cmd *cmd;
3351 struct wmi_tlv *tlv;
3352 struct sk_buff *skb;
3353 void *ptr;
3354 size_t len;
3355
3356 len = sizeof(*tlv) + sizeof(*cmd);
3357 skb = ath10k_wmi_alloc_skb(ar, len);
3358 if (!skb)
3359 return ERR_PTR(-ENOMEM);
3360
3361 ptr = (void *)skb->data;
3362 tlv = ptr;
3363 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_ECHO_CMD);
3364 tlv->len = __cpu_to_le16(sizeof(*cmd));
3365 cmd = (void *)tlv->value;
3366 cmd->value = cpu_to_le32(value);
3367
3368 ptr += sizeof(*tlv);
3369 ptr += sizeof(*cmd);
3370
3371 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv echo value 0x%08x\n", value);
3372 return skb;
3373}
3374
Michal Kazior5a401f32016-11-14 14:26:40 +01003375static struct sk_buff *
3376ath10k_wmi_tlv_op_gen_vdev_spectral_conf(struct ath10k *ar,
3377 const struct wmi_vdev_spectral_conf_arg *arg)
3378{
3379 struct wmi_vdev_spectral_conf_cmd *cmd;
3380 struct sk_buff *skb;
3381 struct wmi_tlv *tlv;
3382 void *ptr;
3383 size_t len;
3384
3385 len = sizeof(*tlv) + sizeof(*cmd);
3386 skb = ath10k_wmi_alloc_skb(ar, len);
3387 if (!skb)
3388 return ERR_PTR(-ENOMEM);
3389
3390 ptr = (void *)skb->data;
3391 tlv = ptr;
3392 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_VDEV_SPECTRAL_CONFIGURE_CMD);
3393 tlv->len = __cpu_to_le16(sizeof(*cmd));
3394 cmd = (void *)tlv->value;
3395 cmd->vdev_id = __cpu_to_le32(arg->vdev_id);
3396 cmd->scan_count = __cpu_to_le32(arg->scan_count);
3397 cmd->scan_period = __cpu_to_le32(arg->scan_period);
3398 cmd->scan_priority = __cpu_to_le32(arg->scan_priority);
3399 cmd->scan_fft_size = __cpu_to_le32(arg->scan_fft_size);
3400 cmd->scan_gc_ena = __cpu_to_le32(arg->scan_gc_ena);
3401 cmd->scan_restart_ena = __cpu_to_le32(arg->scan_restart_ena);
3402 cmd->scan_noise_floor_ref = __cpu_to_le32(arg->scan_noise_floor_ref);
3403 cmd->scan_init_delay = __cpu_to_le32(arg->scan_init_delay);
3404 cmd->scan_nb_tone_thr = __cpu_to_le32(arg->scan_nb_tone_thr);
3405 cmd->scan_str_bin_thr = __cpu_to_le32(arg->scan_str_bin_thr);
3406 cmd->scan_wb_rpt_mode = __cpu_to_le32(arg->scan_wb_rpt_mode);
3407 cmd->scan_rssi_rpt_mode = __cpu_to_le32(arg->scan_rssi_rpt_mode);
3408 cmd->scan_rssi_thr = __cpu_to_le32(arg->scan_rssi_thr);
3409 cmd->scan_pwr_format = __cpu_to_le32(arg->scan_pwr_format);
3410 cmd->scan_rpt_mode = __cpu_to_le32(arg->scan_rpt_mode);
3411 cmd->scan_bin_scale = __cpu_to_le32(arg->scan_bin_scale);
3412 cmd->scan_dbm_adj = __cpu_to_le32(arg->scan_dbm_adj);
3413 cmd->scan_chn_mask = __cpu_to_le32(arg->scan_chn_mask);
3414
3415 return skb;
3416}
3417
3418static struct sk_buff *
3419ath10k_wmi_tlv_op_gen_vdev_spectral_enable(struct ath10k *ar, u32 vdev_id,
3420 u32 trigger, u32 enable)
3421{
3422 struct wmi_vdev_spectral_enable_cmd *cmd;
3423 struct sk_buff *skb;
3424 struct wmi_tlv *tlv;
3425 void *ptr;
3426 size_t len;
3427
3428 len = sizeof(*tlv) + sizeof(*cmd);
3429 skb = ath10k_wmi_alloc_skb(ar, len);
3430 if (!skb)
3431 return ERR_PTR(-ENOMEM);
3432
3433 ptr = (void *)skb->data;
3434 tlv = ptr;
3435 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_VDEV_SPECTRAL_ENABLE_CMD);
3436 tlv->len = __cpu_to_le16(sizeof(*cmd));
3437 cmd = (void *)tlv->value;
3438 cmd->vdev_id = __cpu_to_le32(vdev_id);
3439 cmd->trigger_cmd = __cpu_to_le32(trigger);
3440 cmd->enable_cmd = __cpu_to_le32(enable);
3441
3442 return skb;
3443}
3444
Michal Kaziorca996ec2014-12-03 10:11:32 +02003445/****************/
3446/* TLV mappings */
3447/****************/
3448
3449static struct wmi_cmd_map wmi_tlv_cmd_map = {
3450 .init_cmdid = WMI_TLV_INIT_CMDID,
3451 .start_scan_cmdid = WMI_TLV_START_SCAN_CMDID,
3452 .stop_scan_cmdid = WMI_TLV_STOP_SCAN_CMDID,
3453 .scan_chan_list_cmdid = WMI_TLV_SCAN_CHAN_LIST_CMDID,
3454 .scan_sch_prio_tbl_cmdid = WMI_TLV_SCAN_SCH_PRIO_TBL_CMDID,
3455 .pdev_set_regdomain_cmdid = WMI_TLV_PDEV_SET_REGDOMAIN_CMDID,
3456 .pdev_set_channel_cmdid = WMI_TLV_PDEV_SET_CHANNEL_CMDID,
3457 .pdev_set_param_cmdid = WMI_TLV_PDEV_SET_PARAM_CMDID,
3458 .pdev_pktlog_enable_cmdid = WMI_TLV_PDEV_PKTLOG_ENABLE_CMDID,
3459 .pdev_pktlog_disable_cmdid = WMI_TLV_PDEV_PKTLOG_DISABLE_CMDID,
3460 .pdev_set_wmm_params_cmdid = WMI_TLV_PDEV_SET_WMM_PARAMS_CMDID,
3461 .pdev_set_ht_cap_ie_cmdid = WMI_TLV_PDEV_SET_HT_CAP_IE_CMDID,
3462 .pdev_set_vht_cap_ie_cmdid = WMI_TLV_PDEV_SET_VHT_CAP_IE_CMDID,
3463 .pdev_set_dscp_tid_map_cmdid = WMI_TLV_PDEV_SET_DSCP_TID_MAP_CMDID,
3464 .pdev_set_quiet_mode_cmdid = WMI_TLV_PDEV_SET_QUIET_MODE_CMDID,
3465 .pdev_green_ap_ps_enable_cmdid = WMI_TLV_PDEV_GREEN_AP_PS_ENABLE_CMDID,
3466 .pdev_get_tpc_config_cmdid = WMI_TLV_PDEV_GET_TPC_CONFIG_CMDID,
3467 .pdev_set_base_macaddr_cmdid = WMI_TLV_PDEV_SET_BASE_MACADDR_CMDID,
3468 .vdev_create_cmdid = WMI_TLV_VDEV_CREATE_CMDID,
3469 .vdev_delete_cmdid = WMI_TLV_VDEV_DELETE_CMDID,
3470 .vdev_start_request_cmdid = WMI_TLV_VDEV_START_REQUEST_CMDID,
3471 .vdev_restart_request_cmdid = WMI_TLV_VDEV_RESTART_REQUEST_CMDID,
3472 .vdev_up_cmdid = WMI_TLV_VDEV_UP_CMDID,
3473 .vdev_stop_cmdid = WMI_TLV_VDEV_STOP_CMDID,
3474 .vdev_down_cmdid = WMI_TLV_VDEV_DOWN_CMDID,
3475 .vdev_set_param_cmdid = WMI_TLV_VDEV_SET_PARAM_CMDID,
3476 .vdev_install_key_cmdid = WMI_TLV_VDEV_INSTALL_KEY_CMDID,
3477 .peer_create_cmdid = WMI_TLV_PEER_CREATE_CMDID,
3478 .peer_delete_cmdid = WMI_TLV_PEER_DELETE_CMDID,
3479 .peer_flush_tids_cmdid = WMI_TLV_PEER_FLUSH_TIDS_CMDID,
3480 .peer_set_param_cmdid = WMI_TLV_PEER_SET_PARAM_CMDID,
3481 .peer_assoc_cmdid = WMI_TLV_PEER_ASSOC_CMDID,
3482 .peer_add_wds_entry_cmdid = WMI_TLV_PEER_ADD_WDS_ENTRY_CMDID,
3483 .peer_remove_wds_entry_cmdid = WMI_TLV_PEER_REMOVE_WDS_ENTRY_CMDID,
3484 .peer_mcast_group_cmdid = WMI_TLV_PEER_MCAST_GROUP_CMDID,
3485 .bcn_tx_cmdid = WMI_TLV_BCN_TX_CMDID,
3486 .pdev_send_bcn_cmdid = WMI_TLV_PDEV_SEND_BCN_CMDID,
3487 .bcn_tmpl_cmdid = WMI_TLV_BCN_TMPL_CMDID,
3488 .bcn_filter_rx_cmdid = WMI_TLV_BCN_FILTER_RX_CMDID,
3489 .prb_req_filter_rx_cmdid = WMI_TLV_PRB_REQ_FILTER_RX_CMDID,
3490 .mgmt_tx_cmdid = WMI_TLV_MGMT_TX_CMDID,
Rakesh Pillai1807da42017-12-11 19:52:53 +05303491 .mgmt_tx_send_cmdid = WMI_TLV_MGMT_TX_SEND_CMD,
Michal Kaziorca996ec2014-12-03 10:11:32 +02003492 .prb_tmpl_cmdid = WMI_TLV_PRB_TMPL_CMDID,
3493 .addba_clear_resp_cmdid = WMI_TLV_ADDBA_CLEAR_RESP_CMDID,
3494 .addba_send_cmdid = WMI_TLV_ADDBA_SEND_CMDID,
3495 .addba_status_cmdid = WMI_TLV_ADDBA_STATUS_CMDID,
3496 .delba_send_cmdid = WMI_TLV_DELBA_SEND_CMDID,
3497 .addba_set_resp_cmdid = WMI_TLV_ADDBA_SET_RESP_CMDID,
3498 .send_singleamsdu_cmdid = WMI_TLV_SEND_SINGLEAMSDU_CMDID,
3499 .sta_powersave_mode_cmdid = WMI_TLV_STA_POWERSAVE_MODE_CMDID,
3500 .sta_powersave_param_cmdid = WMI_TLV_STA_POWERSAVE_PARAM_CMDID,
3501 .sta_mimo_ps_mode_cmdid = WMI_TLV_STA_MIMO_PS_MODE_CMDID,
3502 .pdev_dfs_enable_cmdid = WMI_TLV_PDEV_DFS_ENABLE_CMDID,
3503 .pdev_dfs_disable_cmdid = WMI_TLV_PDEV_DFS_DISABLE_CMDID,
3504 .roam_scan_mode = WMI_TLV_ROAM_SCAN_MODE,
3505 .roam_scan_rssi_threshold = WMI_TLV_ROAM_SCAN_RSSI_THRESHOLD,
3506 .roam_scan_period = WMI_TLV_ROAM_SCAN_PERIOD,
3507 .roam_scan_rssi_change_threshold =
3508 WMI_TLV_ROAM_SCAN_RSSI_CHANGE_THRESHOLD,
3509 .roam_ap_profile = WMI_TLV_ROAM_AP_PROFILE,
3510 .ofl_scan_add_ap_profile = WMI_TLV_ROAM_AP_PROFILE,
3511 .ofl_scan_remove_ap_profile = WMI_TLV_OFL_SCAN_REMOVE_AP_PROFILE,
3512 .ofl_scan_period = WMI_TLV_OFL_SCAN_PERIOD,
3513 .p2p_dev_set_device_info = WMI_TLV_P2P_DEV_SET_DEVICE_INFO,
3514 .p2p_dev_set_discoverability = WMI_TLV_P2P_DEV_SET_DISCOVERABILITY,
3515 .p2p_go_set_beacon_ie = WMI_TLV_P2P_GO_SET_BEACON_IE,
3516 .p2p_go_set_probe_resp_ie = WMI_TLV_P2P_GO_SET_PROBE_RESP_IE,
3517 .p2p_set_vendor_ie_data_cmdid = WMI_TLV_P2P_SET_VENDOR_IE_DATA_CMDID,
3518 .ap_ps_peer_param_cmdid = WMI_TLV_AP_PS_PEER_PARAM_CMDID,
3519 .ap_ps_peer_uapsd_coex_cmdid = WMI_TLV_AP_PS_PEER_UAPSD_COEX_CMDID,
3520 .peer_rate_retry_sched_cmdid = WMI_TLV_PEER_RATE_RETRY_SCHED_CMDID,
3521 .wlan_profile_trigger_cmdid = WMI_TLV_WLAN_PROFILE_TRIGGER_CMDID,
3522 .wlan_profile_set_hist_intvl_cmdid =
3523 WMI_TLV_WLAN_PROFILE_SET_HIST_INTVL_CMDID,
3524 .wlan_profile_get_profile_data_cmdid =
3525 WMI_TLV_WLAN_PROFILE_GET_PROFILE_DATA_CMDID,
3526 .wlan_profile_enable_profile_id_cmdid =
3527 WMI_TLV_WLAN_PROFILE_ENABLE_PROFILE_ID_CMDID,
3528 .wlan_profile_list_profile_id_cmdid =
3529 WMI_TLV_WLAN_PROFILE_LIST_PROFILE_ID_CMDID,
3530 .pdev_suspend_cmdid = WMI_TLV_PDEV_SUSPEND_CMDID,
3531 .pdev_resume_cmdid = WMI_TLV_PDEV_RESUME_CMDID,
3532 .add_bcn_filter_cmdid = WMI_TLV_ADD_BCN_FILTER_CMDID,
3533 .rmv_bcn_filter_cmdid = WMI_TLV_RMV_BCN_FILTER_CMDID,
3534 .wow_add_wake_pattern_cmdid = WMI_TLV_WOW_ADD_WAKE_PATTERN_CMDID,
3535 .wow_del_wake_pattern_cmdid = WMI_TLV_WOW_DEL_WAKE_PATTERN_CMDID,
3536 .wow_enable_disable_wake_event_cmdid =
3537 WMI_TLV_WOW_ENABLE_DISABLE_WAKE_EVENT_CMDID,
3538 .wow_enable_cmdid = WMI_TLV_WOW_ENABLE_CMDID,
3539 .wow_hostwakeup_from_sleep_cmdid =
3540 WMI_TLV_WOW_HOSTWAKEUP_FROM_SLEEP_CMDID,
3541 .rtt_measreq_cmdid = WMI_TLV_RTT_MEASREQ_CMDID,
3542 .rtt_tsf_cmdid = WMI_TLV_RTT_TSF_CMDID,
3543 .vdev_spectral_scan_configure_cmdid = WMI_TLV_SPECTRAL_SCAN_CONF_CMDID,
3544 .vdev_spectral_scan_enable_cmdid = WMI_TLV_SPECTRAL_SCAN_ENABLE_CMDID,
3545 .request_stats_cmdid = WMI_TLV_REQUEST_STATS_CMDID,
3546 .set_arp_ns_offload_cmdid = WMI_TLV_SET_ARP_NS_OFFLOAD_CMDID,
3547 .network_list_offload_config_cmdid =
3548 WMI_TLV_NETWORK_LIST_OFFLOAD_CONFIG_CMDID,
3549 .gtk_offload_cmdid = WMI_TLV_GTK_OFFLOAD_CMDID,
3550 .csa_offload_enable_cmdid = WMI_TLV_CSA_OFFLOAD_ENABLE_CMDID,
3551 .csa_offload_chanswitch_cmdid = WMI_TLV_CSA_OFFLOAD_CHANSWITCH_CMDID,
3552 .chatter_set_mode_cmdid = WMI_TLV_CHATTER_SET_MODE_CMDID,
3553 .peer_tid_addba_cmdid = WMI_TLV_PEER_TID_ADDBA_CMDID,
3554 .peer_tid_delba_cmdid = WMI_TLV_PEER_TID_DELBA_CMDID,
3555 .sta_dtim_ps_method_cmdid = WMI_TLV_STA_DTIM_PS_METHOD_CMDID,
3556 .sta_uapsd_auto_trig_cmdid = WMI_TLV_STA_UAPSD_AUTO_TRIG_CMDID,
3557 .sta_keepalive_cmd = WMI_TLV_STA_KEEPALIVE_CMDID,
3558 .echo_cmdid = WMI_TLV_ECHO_CMDID,
3559 .pdev_utf_cmdid = WMI_TLV_PDEV_UTF_CMDID,
3560 .dbglog_cfg_cmdid = WMI_TLV_DBGLOG_CFG_CMDID,
3561 .pdev_qvit_cmdid = WMI_TLV_PDEV_QVIT_CMDID,
3562 .pdev_ftm_intg_cmdid = WMI_TLV_PDEV_FTM_INTG_CMDID,
3563 .vdev_set_keepalive_cmdid = WMI_TLV_VDEV_SET_KEEPALIVE_CMDID,
3564 .vdev_get_keepalive_cmdid = WMI_TLV_VDEV_GET_KEEPALIVE_CMDID,
3565 .force_fw_hang_cmdid = WMI_TLV_FORCE_FW_HANG_CMDID,
3566 .gpio_config_cmdid = WMI_TLV_GPIO_CONFIG_CMDID,
3567 .gpio_output_cmdid = WMI_TLV_GPIO_OUTPUT_CMDID,
Ryan Hsue98199a2018-03-27 11:25:36 +03003568 .pdev_get_temperature_cmdid = WMI_TLV_PDEV_GET_TEMPERATURE_CMDID,
Michal Kazior6d492fe2015-01-28 09:57:22 +02003569 .vdev_set_wmm_params_cmdid = WMI_TLV_VDEV_SET_WMM_PARAMS_CMDID,
Marek Puzyniakad45c882015-03-30 09:51:53 +03003570 .tdls_set_state_cmdid = WMI_TLV_TDLS_SET_STATE_CMDID,
3571 .tdls_peer_update_cmdid = WMI_TLV_TDLS_PEER_UPDATE_CMDID,
Michal Kazior5b272e32015-03-31 10:26:22 +00003572 .adaptive_qcs_cmdid = WMI_TLV_RESMGR_ADAPTIVE_OCS_CMDID,
Raja Mani772b4ae2015-06-22 20:10:12 +05303573 .scan_update_request_cmdid = WMI_CMD_UNSUPPORTED,
3574 .vdev_standby_response_cmdid = WMI_CMD_UNSUPPORTED,
3575 .vdev_resume_response_cmdid = WMI_CMD_UNSUPPORTED,
3576 .wlan_peer_caching_add_peer_cmdid = WMI_CMD_UNSUPPORTED,
3577 .wlan_peer_caching_evict_peer_cmdid = WMI_CMD_UNSUPPORTED,
3578 .wlan_peer_caching_restore_peer_cmdid = WMI_CMD_UNSUPPORTED,
3579 .wlan_peer_caching_print_all_peers_info_cmdid = WMI_CMD_UNSUPPORTED,
3580 .peer_update_wds_entry_cmdid = WMI_CMD_UNSUPPORTED,
3581 .peer_add_proxy_sta_entry_cmdid = WMI_CMD_UNSUPPORTED,
3582 .rtt_keepalive_cmdid = WMI_CMD_UNSUPPORTED,
3583 .oem_req_cmdid = WMI_CMD_UNSUPPORTED,
3584 .nan_cmdid = WMI_CMD_UNSUPPORTED,
3585 .vdev_ratemask_cmdid = WMI_CMD_UNSUPPORTED,
3586 .qboost_cfg_cmdid = WMI_CMD_UNSUPPORTED,
3587 .pdev_smart_ant_enable_cmdid = WMI_CMD_UNSUPPORTED,
3588 .pdev_smart_ant_set_rx_antenna_cmdid = WMI_CMD_UNSUPPORTED,
3589 .peer_smart_ant_set_tx_antenna_cmdid = WMI_CMD_UNSUPPORTED,
3590 .peer_smart_ant_set_train_info_cmdid = WMI_CMD_UNSUPPORTED,
3591 .peer_smart_ant_set_node_config_ops_cmdid = WMI_CMD_UNSUPPORTED,
3592 .pdev_set_antenna_switch_table_cmdid = WMI_CMD_UNSUPPORTED,
3593 .pdev_set_ctl_table_cmdid = WMI_CMD_UNSUPPORTED,
3594 .pdev_set_mimogain_table_cmdid = WMI_CMD_UNSUPPORTED,
3595 .pdev_ratepwr_table_cmdid = WMI_CMD_UNSUPPORTED,
3596 .pdev_ratepwr_chainmsk_table_cmdid = WMI_CMD_UNSUPPORTED,
3597 .pdev_fips_cmdid = WMI_CMD_UNSUPPORTED,
3598 .tt_set_conf_cmdid = WMI_CMD_UNSUPPORTED,
3599 .fwtest_cmdid = WMI_CMD_UNSUPPORTED,
3600 .vdev_atf_request_cmdid = WMI_CMD_UNSUPPORTED,
3601 .peer_atf_request_cmdid = WMI_CMD_UNSUPPORTED,
3602 .pdev_get_ani_cck_config_cmdid = WMI_CMD_UNSUPPORTED,
3603 .pdev_get_ani_ofdm_config_cmdid = WMI_CMD_UNSUPPORTED,
3604 .pdev_reserve_ast_entry_cmdid = WMI_CMD_UNSUPPORTED,
Michal Kaziorca996ec2014-12-03 10:11:32 +02003605};
3606
3607static struct wmi_pdev_param_map wmi_tlv_pdev_param_map = {
3608 .tx_chain_mask = WMI_TLV_PDEV_PARAM_TX_CHAIN_MASK,
3609 .rx_chain_mask = WMI_TLV_PDEV_PARAM_RX_CHAIN_MASK,
3610 .txpower_limit2g = WMI_TLV_PDEV_PARAM_TXPOWER_LIMIT2G,
3611 .txpower_limit5g = WMI_TLV_PDEV_PARAM_TXPOWER_LIMIT5G,
3612 .txpower_scale = WMI_TLV_PDEV_PARAM_TXPOWER_SCALE,
3613 .beacon_gen_mode = WMI_TLV_PDEV_PARAM_BEACON_GEN_MODE,
3614 .beacon_tx_mode = WMI_TLV_PDEV_PARAM_BEACON_TX_MODE,
3615 .resmgr_offchan_mode = WMI_TLV_PDEV_PARAM_RESMGR_OFFCHAN_MODE,
3616 .protection_mode = WMI_TLV_PDEV_PARAM_PROTECTION_MODE,
3617 .dynamic_bw = WMI_TLV_PDEV_PARAM_DYNAMIC_BW,
3618 .non_agg_sw_retry_th = WMI_TLV_PDEV_PARAM_NON_AGG_SW_RETRY_TH,
3619 .agg_sw_retry_th = WMI_TLV_PDEV_PARAM_AGG_SW_RETRY_TH,
3620 .sta_kickout_th = WMI_TLV_PDEV_PARAM_STA_KICKOUT_TH,
3621 .ac_aggrsize_scaling = WMI_TLV_PDEV_PARAM_AC_AGGRSIZE_SCALING,
3622 .ltr_enable = WMI_TLV_PDEV_PARAM_LTR_ENABLE,
3623 .ltr_ac_latency_be = WMI_TLV_PDEV_PARAM_LTR_AC_LATENCY_BE,
3624 .ltr_ac_latency_bk = WMI_TLV_PDEV_PARAM_LTR_AC_LATENCY_BK,
3625 .ltr_ac_latency_vi = WMI_TLV_PDEV_PARAM_LTR_AC_LATENCY_VI,
3626 .ltr_ac_latency_vo = WMI_TLV_PDEV_PARAM_LTR_AC_LATENCY_VO,
3627 .ltr_ac_latency_timeout = WMI_TLV_PDEV_PARAM_LTR_AC_LATENCY_TIMEOUT,
3628 .ltr_sleep_override = WMI_TLV_PDEV_PARAM_LTR_SLEEP_OVERRIDE,
3629 .ltr_rx_override = WMI_TLV_PDEV_PARAM_LTR_RX_OVERRIDE,
3630 .ltr_tx_activity_timeout = WMI_TLV_PDEV_PARAM_LTR_TX_ACTIVITY_TIMEOUT,
3631 .l1ss_enable = WMI_TLV_PDEV_PARAM_L1SS_ENABLE,
3632 .dsleep_enable = WMI_TLV_PDEV_PARAM_DSLEEP_ENABLE,
3633 .pcielp_txbuf_flush = WMI_TLV_PDEV_PARAM_PCIELP_TXBUF_FLUSH,
3634 .pcielp_txbuf_watermark = WMI_TLV_PDEV_PARAM_PCIELP_TXBUF_TMO_EN,
3635 .pcielp_txbuf_tmo_en = WMI_TLV_PDEV_PARAM_PCIELP_TXBUF_TMO_EN,
3636 .pcielp_txbuf_tmo_value = WMI_TLV_PDEV_PARAM_PCIELP_TXBUF_TMO_VALUE,
3637 .pdev_stats_update_period = WMI_TLV_PDEV_PARAM_PDEV_STATS_UPDATE_PERIOD,
3638 .vdev_stats_update_period = WMI_TLV_PDEV_PARAM_VDEV_STATS_UPDATE_PERIOD,
3639 .peer_stats_update_period = WMI_TLV_PDEV_PARAM_PEER_STATS_UPDATE_PERIOD,
3640 .bcnflt_stats_update_period =
3641 WMI_TLV_PDEV_PARAM_BCNFLT_STATS_UPDATE_PERIOD,
3642 .pmf_qos = WMI_TLV_PDEV_PARAM_PMF_QOS,
3643 .arp_ac_override = WMI_TLV_PDEV_PARAM_ARP_AC_OVERRIDE,
3644 .dcs = WMI_TLV_PDEV_PARAM_DCS,
3645 .ani_enable = WMI_TLV_PDEV_PARAM_ANI_ENABLE,
3646 .ani_poll_period = WMI_TLV_PDEV_PARAM_ANI_POLL_PERIOD,
3647 .ani_listen_period = WMI_TLV_PDEV_PARAM_ANI_LISTEN_PERIOD,
3648 .ani_ofdm_level = WMI_TLV_PDEV_PARAM_ANI_OFDM_LEVEL,
3649 .ani_cck_level = WMI_TLV_PDEV_PARAM_ANI_CCK_LEVEL,
3650 .dyntxchain = WMI_TLV_PDEV_PARAM_DYNTXCHAIN,
3651 .proxy_sta = WMI_TLV_PDEV_PARAM_PROXY_STA,
3652 .idle_ps_config = WMI_TLV_PDEV_PARAM_IDLE_PS_CONFIG,
3653 .power_gating_sleep = WMI_TLV_PDEV_PARAM_POWER_GATING_SLEEP,
3654 .fast_channel_reset = WMI_TLV_PDEV_PARAM_UNSUPPORTED,
3655 .burst_dur = WMI_TLV_PDEV_PARAM_BURST_DUR,
3656 .burst_enable = WMI_TLV_PDEV_PARAM_BURST_ENABLE,
Peter Oha7bd3e92014-12-02 13:07:14 +02003657 .cal_period = WMI_PDEV_PARAM_UNSUPPORTED,
Raja Manid86561f2015-06-22 20:10:14 +05303658 .aggr_burst = WMI_PDEV_PARAM_UNSUPPORTED,
3659 .rx_decap_mode = WMI_PDEV_PARAM_UNSUPPORTED,
3660 .smart_antenna_default_antenna = WMI_PDEV_PARAM_UNSUPPORTED,
3661 .igmpmld_override = WMI_PDEV_PARAM_UNSUPPORTED,
3662 .igmpmld_tid = WMI_PDEV_PARAM_UNSUPPORTED,
3663 .antenna_gain = WMI_PDEV_PARAM_UNSUPPORTED,
3664 .rx_filter = WMI_PDEV_PARAM_UNSUPPORTED,
3665 .set_mcast_to_ucast_tid = WMI_PDEV_PARAM_UNSUPPORTED,
3666 .proxy_sta_mode = WMI_PDEV_PARAM_UNSUPPORTED,
3667 .set_mcast2ucast_mode = WMI_PDEV_PARAM_UNSUPPORTED,
3668 .set_mcast2ucast_buffer = WMI_PDEV_PARAM_UNSUPPORTED,
3669 .remove_mcast2ucast_buffer = WMI_PDEV_PARAM_UNSUPPORTED,
3670 .peer_sta_ps_statechg_enable = WMI_PDEV_PARAM_UNSUPPORTED,
3671 .igmpmld_ac_override = WMI_PDEV_PARAM_UNSUPPORTED,
3672 .block_interbss = WMI_PDEV_PARAM_UNSUPPORTED,
3673 .set_disable_reset_cmdid = WMI_PDEV_PARAM_UNSUPPORTED,
3674 .set_msdu_ttl_cmdid = WMI_PDEV_PARAM_UNSUPPORTED,
3675 .set_ppdu_duration_cmdid = WMI_PDEV_PARAM_UNSUPPORTED,
3676 .txbf_sound_period_cmdid = WMI_PDEV_PARAM_UNSUPPORTED,
3677 .set_promisc_mode_cmdid = WMI_PDEV_PARAM_UNSUPPORTED,
3678 .set_burst_mode_cmdid = WMI_PDEV_PARAM_UNSUPPORTED,
3679 .en_stats = WMI_PDEV_PARAM_UNSUPPORTED,
3680 .mu_group_policy = WMI_PDEV_PARAM_UNSUPPORTED,
3681 .noise_detection = WMI_PDEV_PARAM_UNSUPPORTED,
3682 .noise_threshold = WMI_PDEV_PARAM_UNSUPPORTED,
3683 .dpd_enable = WMI_PDEV_PARAM_UNSUPPORTED,
3684 .set_mcast_bcast_echo = WMI_PDEV_PARAM_UNSUPPORTED,
3685 .atf_strict_sch = WMI_PDEV_PARAM_UNSUPPORTED,
3686 .atf_sched_duration = WMI_PDEV_PARAM_UNSUPPORTED,
3687 .ant_plzn = WMI_PDEV_PARAM_UNSUPPORTED,
3688 .mgmt_retry_limit = WMI_PDEV_PARAM_UNSUPPORTED,
3689 .sensitivity_level = WMI_PDEV_PARAM_UNSUPPORTED,
3690 .signed_txpower_2g = WMI_PDEV_PARAM_UNSUPPORTED,
3691 .signed_txpower_5g = WMI_PDEV_PARAM_UNSUPPORTED,
3692 .enable_per_tid_amsdu = WMI_PDEV_PARAM_UNSUPPORTED,
3693 .enable_per_tid_ampdu = WMI_PDEV_PARAM_UNSUPPORTED,
3694 .cca_threshold = WMI_PDEV_PARAM_UNSUPPORTED,
3695 .rts_fixed_rate = WMI_PDEV_PARAM_UNSUPPORTED,
3696 .pdev_reset = WMI_PDEV_PARAM_UNSUPPORTED,
3697 .wapi_mbssid_offset = WMI_PDEV_PARAM_UNSUPPORTED,
3698 .arp_srcaddr = WMI_PDEV_PARAM_UNSUPPORTED,
3699 .arp_dstaddr = WMI_PDEV_PARAM_UNSUPPORTED,
Michal Kaziorca996ec2014-12-03 10:11:32 +02003700};
3701
3702static struct wmi_vdev_param_map wmi_tlv_vdev_param_map = {
3703 .rts_threshold = WMI_TLV_VDEV_PARAM_RTS_THRESHOLD,
3704 .fragmentation_threshold = WMI_TLV_VDEV_PARAM_FRAGMENTATION_THRESHOLD,
3705 .beacon_interval = WMI_TLV_VDEV_PARAM_BEACON_INTERVAL,
3706 .listen_interval = WMI_TLV_VDEV_PARAM_LISTEN_INTERVAL,
3707 .multicast_rate = WMI_TLV_VDEV_PARAM_MULTICAST_RATE,
3708 .mgmt_tx_rate = WMI_TLV_VDEV_PARAM_MGMT_TX_RATE,
3709 .slot_time = WMI_TLV_VDEV_PARAM_SLOT_TIME,
3710 .preamble = WMI_TLV_VDEV_PARAM_PREAMBLE,
3711 .swba_time = WMI_TLV_VDEV_PARAM_SWBA_TIME,
3712 .wmi_vdev_stats_update_period = WMI_TLV_VDEV_STATS_UPDATE_PERIOD,
3713 .wmi_vdev_pwrsave_ageout_time = WMI_TLV_VDEV_PWRSAVE_AGEOUT_TIME,
3714 .wmi_vdev_host_swba_interval = WMI_TLV_VDEV_HOST_SWBA_INTERVAL,
3715 .dtim_period = WMI_TLV_VDEV_PARAM_DTIM_PERIOD,
3716 .wmi_vdev_oc_scheduler_air_time_limit =
3717 WMI_TLV_VDEV_OC_SCHEDULER_AIR_TIME_LIMIT,
3718 .wds = WMI_TLV_VDEV_PARAM_WDS,
3719 .atim_window = WMI_TLV_VDEV_PARAM_ATIM_WINDOW,
3720 .bmiss_count_max = WMI_TLV_VDEV_PARAM_BMISS_COUNT_MAX,
3721 .bmiss_first_bcnt = WMI_TLV_VDEV_PARAM_BMISS_FIRST_BCNT,
3722 .bmiss_final_bcnt = WMI_TLV_VDEV_PARAM_BMISS_FINAL_BCNT,
3723 .feature_wmm = WMI_TLV_VDEV_PARAM_FEATURE_WMM,
3724 .chwidth = WMI_TLV_VDEV_PARAM_CHWIDTH,
3725 .chextoffset = WMI_TLV_VDEV_PARAM_CHEXTOFFSET,
3726 .disable_htprotection = WMI_TLV_VDEV_PARAM_DISABLE_HTPROTECTION,
3727 .sta_quickkickout = WMI_TLV_VDEV_PARAM_STA_QUICKKICKOUT,
3728 .mgmt_rate = WMI_TLV_VDEV_PARAM_MGMT_RATE,
3729 .protection_mode = WMI_TLV_VDEV_PARAM_PROTECTION_MODE,
3730 .fixed_rate = WMI_TLV_VDEV_PARAM_FIXED_RATE,
3731 .sgi = WMI_TLV_VDEV_PARAM_SGI,
3732 .ldpc = WMI_TLV_VDEV_PARAM_LDPC,
3733 .tx_stbc = WMI_TLV_VDEV_PARAM_TX_STBC,
3734 .rx_stbc = WMI_TLV_VDEV_PARAM_RX_STBC,
3735 .intra_bss_fwd = WMI_TLV_VDEV_PARAM_INTRA_BSS_FWD,
3736 .def_keyid = WMI_TLV_VDEV_PARAM_DEF_KEYID,
3737 .nss = WMI_TLV_VDEV_PARAM_NSS,
3738 .bcast_data_rate = WMI_TLV_VDEV_PARAM_BCAST_DATA_RATE,
3739 .mcast_data_rate = WMI_TLV_VDEV_PARAM_MCAST_DATA_RATE,
3740 .mcast_indicate = WMI_TLV_VDEV_PARAM_MCAST_INDICATE,
3741 .dhcp_indicate = WMI_TLV_VDEV_PARAM_DHCP_INDICATE,
3742 .unknown_dest_indicate = WMI_TLV_VDEV_PARAM_UNKNOWN_DEST_INDICATE,
3743 .ap_keepalive_min_idle_inactive_time_secs =
3744 WMI_TLV_VDEV_PARAM_AP_KEEPALIVE_MIN_IDLE_INACTIVE_TIME_SECS,
3745 .ap_keepalive_max_idle_inactive_time_secs =
3746 WMI_TLV_VDEV_PARAM_AP_KEEPALIVE_MAX_IDLE_INACTIVE_TIME_SECS,
3747 .ap_keepalive_max_unresponsive_time_secs =
3748 WMI_TLV_VDEV_PARAM_AP_KEEPALIVE_MAX_UNRESPONSIVE_TIME_SECS,
3749 .ap_enable_nawds = WMI_TLV_VDEV_PARAM_AP_ENABLE_NAWDS,
3750 .mcast2ucast_set = WMI_TLV_VDEV_PARAM_UNSUPPORTED,
3751 .enable_rtscts = WMI_TLV_VDEV_PARAM_ENABLE_RTSCTS,
3752 .txbf = WMI_TLV_VDEV_PARAM_TXBF,
3753 .packet_powersave = WMI_TLV_VDEV_PARAM_PACKET_POWERSAVE,
3754 .drop_unencry = WMI_TLV_VDEV_PARAM_DROP_UNENCRY,
3755 .tx_encap_type = WMI_TLV_VDEV_PARAM_TX_ENCAP_TYPE,
3756 .ap_detect_out_of_sync_sleeping_sta_time_secs =
3757 WMI_TLV_VDEV_PARAM_UNSUPPORTED,
Raja Mani93841a12015-06-22 20:10:13 +05303758 .rc_num_retries = WMI_VDEV_PARAM_UNSUPPORTED,
3759 .cabq_maxdur = WMI_VDEV_PARAM_UNSUPPORTED,
3760 .mfptest_set = WMI_VDEV_PARAM_UNSUPPORTED,
3761 .rts_fixed_rate = WMI_VDEV_PARAM_UNSUPPORTED,
3762 .vht_sgimask = WMI_VDEV_PARAM_UNSUPPORTED,
3763 .vht80_ratemask = WMI_VDEV_PARAM_UNSUPPORTED,
3764 .early_rx_adjust_enable = WMI_VDEV_PARAM_UNSUPPORTED,
3765 .early_rx_tgt_bmiss_num = WMI_VDEV_PARAM_UNSUPPORTED,
3766 .early_rx_bmiss_sample_cycle = WMI_VDEV_PARAM_UNSUPPORTED,
3767 .early_rx_slop_step = WMI_VDEV_PARAM_UNSUPPORTED,
3768 .early_rx_init_slop = WMI_VDEV_PARAM_UNSUPPORTED,
3769 .early_rx_adjust_pause = WMI_VDEV_PARAM_UNSUPPORTED,
3770 .proxy_sta = WMI_VDEV_PARAM_UNSUPPORTED,
3771 .meru_vc = WMI_VDEV_PARAM_UNSUPPORTED,
3772 .rx_decap_type = WMI_VDEV_PARAM_UNSUPPORTED,
3773 .bw_nss_ratemask = WMI_VDEV_PARAM_UNSUPPORTED,
Michal Kaziorca996ec2014-12-03 10:11:32 +02003774};
3775
3776static const struct wmi_ops wmi_tlv_ops = {
3777 .rx = ath10k_wmi_tlv_op_rx,
3778 .map_svc = wmi_tlv_svc_map,
Carl Huangcea19a62018-04-19 19:39:38 +03003779 .map_svc_ext = wmi_tlv_svc_map_ext,
Michal Kaziorca996ec2014-12-03 10:11:32 +02003780
3781 .pull_scan = ath10k_wmi_tlv_op_pull_scan_ev,
3782 .pull_mgmt_rx = ath10k_wmi_tlv_op_pull_mgmt_rx_ev,
3783 .pull_ch_info = ath10k_wmi_tlv_op_pull_ch_info_ev,
3784 .pull_vdev_start = ath10k_wmi_tlv_op_pull_vdev_start_ev,
3785 .pull_peer_kick = ath10k_wmi_tlv_op_pull_peer_kick_ev,
3786 .pull_swba = ath10k_wmi_tlv_op_pull_swba_ev,
Raja Mani991adf72015-08-14 11:13:29 +03003787 .pull_phyerr_hdr = ath10k_wmi_tlv_op_pull_phyerr_ev_hdr,
3788 .pull_phyerr = ath10k_wmi_op_pull_phyerr_ev,
Michal Kaziorca996ec2014-12-03 10:11:32 +02003789 .pull_svc_rdy = ath10k_wmi_tlv_op_pull_svc_rdy_ev,
3790 .pull_rdy = ath10k_wmi_tlv_op_pull_rdy_ev,
Carl Huangcea19a62018-04-19 19:39:38 +03003791 .pull_svc_avail = ath10k_wmi_tlv_op_pull_svc_avail,
Michal Kaziorca996ec2014-12-03 10:11:32 +02003792 .pull_fw_stats = ath10k_wmi_tlv_op_pull_fw_stats,
Michal Kaziorc1a46542015-03-10 16:21:54 +02003793 .pull_roam_ev = ath10k_wmi_tlv_op_pull_roam_ev,
Janusz Dziedzicf5431e82015-03-23 17:32:53 +02003794 .pull_wow_event = ath10k_wmi_tlv_op_pull_wow_ev,
Michal Kazior84d49112016-08-19 13:37:42 +03003795 .pull_echo_ev = ath10k_wmi_tlv_op_pull_echo_ev,
Vivek Natarajan08e75ea2015-08-04 10:45:11 +05303796 .get_txbf_conf_scheme = ath10k_wmi_tlv_txbf_conf_scheme,
Michal Kaziorca996ec2014-12-03 10:11:32 +02003797
3798 .gen_pdev_suspend = ath10k_wmi_tlv_op_gen_pdev_suspend,
3799 .gen_pdev_resume = ath10k_wmi_tlv_op_gen_pdev_resume,
3800 .gen_pdev_set_rd = ath10k_wmi_tlv_op_gen_pdev_set_rd,
3801 .gen_pdev_set_param = ath10k_wmi_tlv_op_gen_pdev_set_param,
3802 .gen_init = ath10k_wmi_tlv_op_gen_init,
3803 .gen_start_scan = ath10k_wmi_tlv_op_gen_start_scan,
3804 .gen_stop_scan = ath10k_wmi_tlv_op_gen_stop_scan,
3805 .gen_vdev_create = ath10k_wmi_tlv_op_gen_vdev_create,
3806 .gen_vdev_delete = ath10k_wmi_tlv_op_gen_vdev_delete,
3807 .gen_vdev_start = ath10k_wmi_tlv_op_gen_vdev_start,
3808 .gen_vdev_stop = ath10k_wmi_tlv_op_gen_vdev_stop,
3809 .gen_vdev_up = ath10k_wmi_tlv_op_gen_vdev_up,
3810 .gen_vdev_down = ath10k_wmi_tlv_op_gen_vdev_down,
3811 .gen_vdev_set_param = ath10k_wmi_tlv_op_gen_vdev_set_param,
3812 .gen_vdev_install_key = ath10k_wmi_tlv_op_gen_vdev_install_key,
Michal Kazior6d492fe2015-01-28 09:57:22 +02003813 .gen_vdev_wmm_conf = ath10k_wmi_tlv_op_gen_vdev_wmm_conf,
Michal Kaziorca996ec2014-12-03 10:11:32 +02003814 .gen_peer_create = ath10k_wmi_tlv_op_gen_peer_create,
3815 .gen_peer_delete = ath10k_wmi_tlv_op_gen_peer_delete,
3816 .gen_peer_flush = ath10k_wmi_tlv_op_gen_peer_flush,
3817 .gen_peer_set_param = ath10k_wmi_tlv_op_gen_peer_set_param,
3818 .gen_peer_assoc = ath10k_wmi_tlv_op_gen_peer_assoc,
3819 .gen_set_psmode = ath10k_wmi_tlv_op_gen_set_psmode,
3820 .gen_set_sta_ps = ath10k_wmi_tlv_op_gen_set_sta_ps,
3821 .gen_set_ap_ps = ath10k_wmi_tlv_op_gen_set_ap_ps,
3822 .gen_scan_chan_list = ath10k_wmi_tlv_op_gen_scan_chan_list,
3823 .gen_beacon_dma = ath10k_wmi_tlv_op_gen_beacon_dma,
3824 .gen_pdev_set_wmm = ath10k_wmi_tlv_op_gen_pdev_set_wmm,
3825 .gen_request_stats = ath10k_wmi_tlv_op_gen_request_stats,
3826 .gen_force_fw_hang = ath10k_wmi_tlv_op_gen_force_fw_hang,
3827 /* .gen_mgmt_tx = not implemented; HTT is used */
Rakesh Pillai38a13902018-02-27 19:09:07 +02003828 .gen_mgmt_tx_send = ath10k_wmi_tlv_op_gen_mgmt_tx_send,
Michal Kaziorca996ec2014-12-03 10:11:32 +02003829 .gen_dbglog_cfg = ath10k_wmi_tlv_op_gen_dbglog_cfg,
3830 .gen_pktlog_enable = ath10k_wmi_tlv_op_gen_pktlog_enable,
3831 .gen_pktlog_disable = ath10k_wmi_tlv_op_gen_pktlog_disable,
Rajkumar Manoharanffdd7382014-12-17 12:21:40 +02003832 /* .gen_pdev_set_quiet_mode not implemented */
Ryan Hsue98199a2018-03-27 11:25:36 +03003833 .gen_pdev_get_temperature = ath10k_wmi_tlv_op_gen_pdev_get_temperature,
Rajkumar Manoharandc8ab272015-01-12 14:07:25 +02003834 /* .gen_addba_clear_resp not implemented */
Rajkumar Manoharan65c08932015-01-12 14:07:26 +02003835 /* .gen_addba_send not implemented */
Rajkumar Manoharan11597412015-01-12 14:07:26 +02003836 /* .gen_addba_set_resp not implemented */
Rajkumar Manoharan50abef82015-01-12 14:07:26 +02003837 /* .gen_delba_send not implemented */
Michal Kaziorbe9ce9d2015-01-13 16:30:11 +02003838 .gen_bcn_tmpl = ath10k_wmi_tlv_op_gen_bcn_tmpl,
Michal Kazior4c4955f2015-01-13 16:30:11 +02003839 .gen_prb_tmpl = ath10k_wmi_tlv_op_gen_prb_tmpl,
Michal Kazior369242b4e2015-01-13 16:30:11 +02003840 .gen_p2p_go_bcn_ie = ath10k_wmi_tlv_op_gen_p2p_go_bcn_ie,
Janusz Dziedzic0c7e4772015-01-24 12:14:52 +02003841 .gen_vdev_sta_uapsd = ath10k_wmi_tlv_op_gen_vdev_sta_uapsd,
Janusz Dziedzic6e8b1882015-01-28 09:57:39 +02003842 .gen_sta_keepalive = ath10k_wmi_tlv_op_gen_sta_keepalive,
Janusz Dziedzicf5431e82015-03-23 17:32:53 +02003843 .gen_wow_enable = ath10k_wmi_tlv_op_gen_wow_enable,
3844 .gen_wow_add_wakeup_event = ath10k_wmi_tlv_op_gen_wow_add_wakeup_event,
3845 .gen_wow_host_wakeup_ind = ath10k_wmi_tlv_gen_wow_host_wakeup_ind,
Janusz Dziedzicd4976102015-03-23 17:32:54 +02003846 .gen_wow_add_pattern = ath10k_wmi_tlv_op_gen_wow_add_pattern,
3847 .gen_wow_del_pattern = ath10k_wmi_tlv_op_gen_wow_del_pattern,
Marek Puzyniakad45c882015-03-30 09:51:53 +03003848 .gen_update_fw_tdls_state = ath10k_wmi_tlv_op_gen_update_fw_tdls_state,
3849 .gen_tdls_peer_update = ath10k_wmi_tlv_op_gen_tdls_peer_update,
Michal Kazior5b272e32015-03-31 10:26:22 +00003850 .gen_adaptive_qcs = ath10k_wmi_tlv_op_gen_adaptive_qcs,
Manikanta Pubbisettybc6f9ae2015-10-16 15:54:52 +03003851 .fw_stats_fill = ath10k_wmi_main_op_fw_stats_fill,
Peter Oh6e4de1a2016-01-28 13:54:10 -08003852 .get_vdev_subtype = ath10k_wmi_op_get_vdev_subtype,
Michal Kaziore25854f2016-08-19 13:37:41 +03003853 .gen_echo = ath10k_wmi_tlv_op_gen_echo,
Michal Kazior5a401f32016-11-14 14:26:40 +01003854 .gen_vdev_spectral_conf = ath10k_wmi_tlv_op_gen_vdev_spectral_conf,
3855 .gen_vdev_spectral_enable = ath10k_wmi_tlv_op_gen_vdev_spectral_enable,
Michal Kaziorca996ec2014-12-03 10:11:32 +02003856};
3857
Tamizh chelvam3fab30f2015-10-29 14:27:37 +02003858static const struct wmi_peer_flags_map wmi_tlv_peer_flags_map = {
3859 .auth = WMI_TLV_PEER_AUTH,
3860 .qos = WMI_TLV_PEER_QOS,
3861 .need_ptk_4_way = WMI_TLV_PEER_NEED_PTK_4_WAY,
3862 .need_gtk_2_way = WMI_TLV_PEER_NEED_GTK_2_WAY,
3863 .apsd = WMI_TLV_PEER_APSD,
3864 .ht = WMI_TLV_PEER_HT,
3865 .bw40 = WMI_TLV_PEER_40MHZ,
3866 .stbc = WMI_TLV_PEER_STBC,
3867 .ldbc = WMI_TLV_PEER_LDPC,
3868 .dyn_mimops = WMI_TLV_PEER_DYN_MIMOPS,
3869 .static_mimops = WMI_TLV_PEER_STATIC_MIMOPS,
3870 .spatial_mux = WMI_TLV_PEER_SPATIAL_MUX,
3871 .vht = WMI_TLV_PEER_VHT,
3872 .bw80 = WMI_TLV_PEER_80MHZ,
3873 .pmf = WMI_TLV_PEER_PMF,
Sebastian Gottschallbc1efd72017-01-12 13:02:12 +02003874 .bw160 = WMI_TLV_PEER_160MHZ,
Tamizh chelvam3fab30f2015-10-29 14:27:37 +02003875};
3876
Michal Kaziorca996ec2014-12-03 10:11:32 +02003877/************/
3878/* TLV init */
3879/************/
3880
3881void ath10k_wmi_tlv_attach(struct ath10k *ar)
3882{
3883 ar->wmi.cmd = &wmi_tlv_cmd_map;
3884 ar->wmi.vdev_param = &wmi_tlv_vdev_param_map;
3885 ar->wmi.pdev_param = &wmi_tlv_pdev_param_map;
3886 ar->wmi.ops = &wmi_tlv_ops;
Tamizh chelvam3fab30f2015-10-29 14:27:37 +02003887 ar->wmi.peer_flags = &wmi_tlv_peer_flags_map;
Michal Kaziorca996ec2014-12-03 10:11:32 +02003888}