1 // SPDX-License-Identifier: ISC 2 /* 3 * Copyright (c) 2005-2011 Atheros Communications Inc. 4 * Copyright (c) 2011-2017 Qualcomm Atheros, Inc. 5 * Copyright (c) 2018-2019, The Linux Foundation. All rights reserved. 6 */ 7 #include "core.h" 8 #include "debug.h" 9 #include "mac.h" 10 #include "hw.h" 11 #include "wmi.h" 12 #include "wmi-ops.h" 13 #include "wmi-tlv.h" 14 #include "p2p.h" 15 #include "testmode.h" 16 #include <linux/bitfield.h> 17 18 /***************/ 19 /* TLV helpers */ 20 /**************/ 21 22 struct wmi_tlv_policy { 23 size_t min_len; 24 }; 25 26 static const struct wmi_tlv_policy wmi_tlv_policies[] = { 27 [WMI_TLV_TAG_ARRAY_BYTE] 28 = { .min_len = 0 }, 29 [WMI_TLV_TAG_ARRAY_UINT32] 30 = { .min_len = 0 }, 31 [WMI_TLV_TAG_STRUCT_SCAN_EVENT] 32 = { .min_len = sizeof(struct wmi_scan_event) }, 33 [WMI_TLV_TAG_STRUCT_MGMT_RX_HDR] 34 = { .min_len = sizeof(struct wmi_tlv_mgmt_rx_ev) }, 35 [WMI_TLV_TAG_STRUCT_CHAN_INFO_EVENT] 36 = { .min_len = sizeof(struct wmi_chan_info_event) }, 37 [WMI_TLV_TAG_STRUCT_VDEV_START_RESPONSE_EVENT] 38 = { .min_len = sizeof(struct wmi_vdev_start_response_event) }, 39 [WMI_TLV_TAG_STRUCT_PEER_STA_KICKOUT_EVENT] 40 = { .min_len = sizeof(struct wmi_peer_sta_kickout_event) }, 41 [WMI_TLV_TAG_STRUCT_HOST_SWBA_EVENT] 42 = { .min_len = sizeof(struct wmi_host_swba_event) }, 43 [WMI_TLV_TAG_STRUCT_TIM_INFO] 44 = { .min_len = sizeof(struct wmi_tim_info) }, 45 [WMI_TLV_TAG_STRUCT_P2P_NOA_INFO] 46 = { .min_len = sizeof(struct wmi_p2p_noa_info) }, 47 [WMI_TLV_TAG_STRUCT_SERVICE_READY_EVENT] 48 = { .min_len = sizeof(struct wmi_tlv_svc_rdy_ev) }, 49 [WMI_TLV_TAG_STRUCT_HAL_REG_CAPABILITIES] 50 = { .min_len = sizeof(struct hal_reg_capabilities) }, 51 [WMI_TLV_TAG_STRUCT_WLAN_HOST_MEM_REQ] 52 = { .min_len = sizeof(struct wlan_host_mem_req) }, 53 [WMI_TLV_TAG_STRUCT_READY_EVENT] 54 = { .min_len = sizeof(struct wmi_tlv_rdy_ev) }, 55 [WMI_TLV_TAG_STRUCT_OFFLOAD_BCN_TX_STATUS_EVENT] 56 = { .min_len = sizeof(struct wmi_tlv_bcn_tx_status_ev) }, 57 [WMI_TLV_TAG_STRUCT_DIAG_DATA_CONTAINER_EVENT] 58 = { .min_len = sizeof(struct wmi_tlv_diag_data_ev) }, 59 [WMI_TLV_TAG_STRUCT_P2P_NOA_EVENT] 60 = { .min_len = sizeof(struct wmi_tlv_p2p_noa_ev) }, 61 [WMI_TLV_TAG_STRUCT_ROAM_EVENT] 62 = { .min_len = sizeof(struct wmi_tlv_roam_ev) }, 63 [WMI_TLV_TAG_STRUCT_WOW_EVENT_INFO] 64 = { .min_len = sizeof(struct wmi_tlv_wow_event_info) }, 65 [WMI_TLV_TAG_STRUCT_TX_PAUSE_EVENT] 66 = { .min_len = sizeof(struct wmi_tlv_tx_pause_ev) }, 67 }; 68 69 static int 70 ath10k_wmi_tlv_iter(struct ath10k *ar, const void *ptr, size_t len, 71 int (*iter)(struct ath10k *ar, u16 tag, u16 len, 72 const void *ptr, void *data), 73 void *data) 74 { 75 const void *begin = ptr; 76 const struct wmi_tlv *tlv; 77 u16 tlv_tag, tlv_len; 78 int ret; 79 80 while (len > 0) { 81 if (len < sizeof(*tlv)) { 82 ath10k_dbg(ar, ATH10K_DBG_WMI, 83 "wmi tlv parse failure at byte %zd (%zu bytes left, %zu expected)\n", 84 ptr - begin, len, sizeof(*tlv)); 85 return -EINVAL; 86 } 87 88 tlv = ptr; 89 tlv_tag = __le16_to_cpu(tlv->tag); 90 tlv_len = __le16_to_cpu(tlv->len); 91 ptr += sizeof(*tlv); 92 len -= sizeof(*tlv); 93 94 if (tlv_len > len) { 95 ath10k_dbg(ar, ATH10K_DBG_WMI, 96 "wmi tlv parse failure of tag %hhu at byte %zd (%zu bytes left, %hhu expected)\n", 97 tlv_tag, ptr - begin, len, tlv_len); 98 return -EINVAL; 99 } 100 101 if (tlv_tag < ARRAY_SIZE(wmi_tlv_policies) && 102 wmi_tlv_policies[tlv_tag].min_len && 103 wmi_tlv_policies[tlv_tag].min_len > tlv_len) { 104 ath10k_dbg(ar, ATH10K_DBG_WMI, 105 "wmi tlv parse failure of tag %hhu at byte %zd (%hhu bytes is less than min length %zu)\n", 106 tlv_tag, ptr - begin, tlv_len, 107 wmi_tlv_policies[tlv_tag].min_len); 108 return -EINVAL; 109 } 110 111 ret = iter(ar, tlv_tag, tlv_len, ptr, data); 112 if (ret) 113 return ret; 114 115 ptr += tlv_len; 116 len -= tlv_len; 117 } 118 119 return 0; 120 } 121 122 static int ath10k_wmi_tlv_iter_parse(struct ath10k *ar, u16 tag, u16 len, 123 const void *ptr, void *data) 124 { 125 const void **tb = data; 126 127 if (tag < WMI_TLV_TAG_MAX) 128 tb[tag] = ptr; 129 130 return 0; 131 } 132 133 static int ath10k_wmi_tlv_parse(struct ath10k *ar, const void **tb, 134 const void *ptr, size_t len) 135 { 136 return ath10k_wmi_tlv_iter(ar, ptr, len, ath10k_wmi_tlv_iter_parse, 137 (void *)tb); 138 } 139 140 static const void ** 141 ath10k_wmi_tlv_parse_alloc(struct ath10k *ar, const void *ptr, 142 size_t len, gfp_t gfp) 143 { 144 const void **tb; 145 int ret; 146 147 tb = kcalloc(WMI_TLV_TAG_MAX, sizeof(*tb), gfp); 148 if (!tb) 149 return ERR_PTR(-ENOMEM); 150 151 ret = ath10k_wmi_tlv_parse(ar, tb, ptr, len); 152 if (ret) { 153 kfree(tb); 154 return ERR_PTR(ret); 155 } 156 157 return tb; 158 } 159 160 static u16 ath10k_wmi_tlv_len(const void *ptr) 161 { 162 return __le16_to_cpu((((const struct wmi_tlv *)ptr) - 1)->len); 163 } 164 165 /**************/ 166 /* TLV events */ 167 /**************/ 168 static int ath10k_wmi_tlv_event_bcn_tx_status(struct ath10k *ar, 169 struct sk_buff *skb) 170 { 171 const void **tb; 172 const struct wmi_tlv_bcn_tx_status_ev *ev; 173 struct ath10k_vif *arvif; 174 u32 vdev_id, tx_status; 175 int ret; 176 177 tb = ath10k_wmi_tlv_parse_alloc(ar, skb->data, skb->len, GFP_ATOMIC); 178 if (IS_ERR(tb)) { 179 ret = PTR_ERR(tb); 180 ath10k_warn(ar, "failed to parse tlv: %d\n", ret); 181 return ret; 182 } 183 184 ev = tb[WMI_TLV_TAG_STRUCT_OFFLOAD_BCN_TX_STATUS_EVENT]; 185 if (!ev) { 186 kfree(tb); 187 return -EPROTO; 188 } 189 190 tx_status = __le32_to_cpu(ev->tx_status); 191 vdev_id = __le32_to_cpu(ev->vdev_id); 192 193 switch (tx_status) { 194 case WMI_TLV_BCN_TX_STATUS_OK: 195 break; 196 case WMI_TLV_BCN_TX_STATUS_XRETRY: 197 case WMI_TLV_BCN_TX_STATUS_DROP: 198 case WMI_TLV_BCN_TX_STATUS_FILTERED: 199 /* FIXME: It's probably worth telling mac80211 to stop the 200 * interface as it is crippled. 201 */ 202 ath10k_warn(ar, "received bcn tmpl tx status on vdev %i: %d", 203 vdev_id, tx_status); 204 break; 205 } 206 207 arvif = ath10k_get_arvif(ar, vdev_id); 208 if (arvif && arvif->is_up && arvif->vif->csa_active) 209 ieee80211_queue_work(ar->hw, &arvif->ap_csa_work); 210 211 kfree(tb); 212 return 0; 213 } 214 215 static void ath10k_wmi_tlv_event_vdev_delete_resp(struct ath10k *ar, 216 struct sk_buff *skb) 217 { 218 ath10k_dbg(ar, ATH10K_DBG_WMI, "WMI_VDEV_DELETE_RESP_EVENTID\n"); 219 complete(&ar->vdev_delete_done); 220 } 221 222 static int ath10k_wmi_tlv_event_diag_data(struct ath10k *ar, 223 struct sk_buff *skb) 224 { 225 const void **tb; 226 const struct wmi_tlv_diag_data_ev *ev; 227 const struct wmi_tlv_diag_item *item; 228 const void *data; 229 int ret, num_items, len; 230 231 tb = ath10k_wmi_tlv_parse_alloc(ar, skb->data, skb->len, GFP_ATOMIC); 232 if (IS_ERR(tb)) { 233 ret = PTR_ERR(tb); 234 ath10k_warn(ar, "failed to parse tlv: %d\n", ret); 235 return ret; 236 } 237 238 ev = tb[WMI_TLV_TAG_STRUCT_DIAG_DATA_CONTAINER_EVENT]; 239 data = tb[WMI_TLV_TAG_ARRAY_BYTE]; 240 if (!ev || !data) { 241 kfree(tb); 242 return -EPROTO; 243 } 244 245 num_items = __le32_to_cpu(ev->num_items); 246 len = ath10k_wmi_tlv_len(data); 247 248 while (num_items--) { 249 if (len == 0) 250 break; 251 if (len < sizeof(*item)) { 252 ath10k_warn(ar, "failed to parse diag data: can't fit item header\n"); 253 break; 254 } 255 256 item = data; 257 258 if (len < sizeof(*item) + __le16_to_cpu(item->len)) { 259 ath10k_warn(ar, "failed to parse diag data: item is too long\n"); 260 break; 261 } 262 263 trace_ath10k_wmi_diag_container(ar, 264 item->type, 265 __le32_to_cpu(item->timestamp), 266 __le32_to_cpu(item->code), 267 __le16_to_cpu(item->len), 268 item->payload); 269 270 len -= sizeof(*item); 271 len -= roundup(__le16_to_cpu(item->len), 4); 272 273 data += sizeof(*item); 274 data += roundup(__le16_to_cpu(item->len), 4); 275 } 276 277 if (num_items != -1 || len != 0) 278 ath10k_warn(ar, "failed to parse diag data event: num_items %d len %d\n", 279 num_items, len); 280 281 kfree(tb); 282 return 0; 283 } 284 285 static int ath10k_wmi_tlv_event_diag(struct ath10k *ar, 286 struct sk_buff *skb) 287 { 288 const void **tb; 289 const void *data; 290 int ret, len; 291 292 tb = ath10k_wmi_tlv_parse_alloc(ar, skb->data, skb->len, GFP_ATOMIC); 293 if (IS_ERR(tb)) { 294 ret = PTR_ERR(tb); 295 ath10k_warn(ar, "failed to parse tlv: %d\n", ret); 296 return ret; 297 } 298 299 data = tb[WMI_TLV_TAG_ARRAY_BYTE]; 300 if (!data) { 301 kfree(tb); 302 return -EPROTO; 303 } 304 len = ath10k_wmi_tlv_len(data); 305 306 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv diag event len %d\n", len); 307 trace_ath10k_wmi_diag(ar, data, len); 308 309 kfree(tb); 310 return 0; 311 } 312 313 static int ath10k_wmi_tlv_event_p2p_noa(struct ath10k *ar, 314 struct sk_buff *skb) 315 { 316 const void **tb; 317 const struct wmi_tlv_p2p_noa_ev *ev; 318 const struct wmi_p2p_noa_info *noa; 319 int ret, vdev_id; 320 321 tb = ath10k_wmi_tlv_parse_alloc(ar, skb->data, skb->len, GFP_ATOMIC); 322 if (IS_ERR(tb)) { 323 ret = PTR_ERR(tb); 324 ath10k_warn(ar, "failed to parse tlv: %d\n", ret); 325 return ret; 326 } 327 328 ev = tb[WMI_TLV_TAG_STRUCT_P2P_NOA_EVENT]; 329 noa = tb[WMI_TLV_TAG_STRUCT_P2P_NOA_INFO]; 330 331 if (!ev || !noa) { 332 kfree(tb); 333 return -EPROTO; 334 } 335 336 vdev_id = __le32_to_cpu(ev->vdev_id); 337 338 ath10k_dbg(ar, ATH10K_DBG_WMI, 339 "wmi tlv p2p noa vdev_id %i descriptors %hhu\n", 340 vdev_id, noa->num_descriptors); 341 342 ath10k_p2p_noa_update_by_vdev_id(ar, vdev_id, noa); 343 kfree(tb); 344 return 0; 345 } 346 347 static int ath10k_wmi_tlv_event_tx_pause(struct ath10k *ar, 348 struct sk_buff *skb) 349 { 350 const void **tb; 351 const struct wmi_tlv_tx_pause_ev *ev; 352 int ret, vdev_id; 353 u32 pause_id, action, vdev_map, peer_id, tid_map; 354 355 tb = ath10k_wmi_tlv_parse_alloc(ar, skb->data, skb->len, GFP_ATOMIC); 356 if (IS_ERR(tb)) { 357 ret = PTR_ERR(tb); 358 ath10k_warn(ar, "failed to parse tlv: %d\n", ret); 359 return ret; 360 } 361 362 ev = tb[WMI_TLV_TAG_STRUCT_TX_PAUSE_EVENT]; 363 if (!ev) { 364 kfree(tb); 365 return -EPROTO; 366 } 367 368 pause_id = __le32_to_cpu(ev->pause_id); 369 action = __le32_to_cpu(ev->action); 370 vdev_map = __le32_to_cpu(ev->vdev_map); 371 peer_id = __le32_to_cpu(ev->peer_id); 372 tid_map = __le32_to_cpu(ev->tid_map); 373 374 ath10k_dbg(ar, ATH10K_DBG_WMI, 375 "wmi tlv tx pause pause_id %u action %u vdev_map 0x%08x peer_id %u tid_map 0x%08x\n", 376 pause_id, action, vdev_map, peer_id, tid_map); 377 378 switch (pause_id) { 379 case WMI_TLV_TX_PAUSE_ID_MCC: 380 case WMI_TLV_TX_PAUSE_ID_P2P_CLI_NOA: 381 case WMI_TLV_TX_PAUSE_ID_P2P_GO_PS: 382 case WMI_TLV_TX_PAUSE_ID_AP_PS: 383 case WMI_TLV_TX_PAUSE_ID_IBSS_PS: 384 for (vdev_id = 0; vdev_map; vdev_id++) { 385 if (!(vdev_map & BIT(vdev_id))) 386 continue; 387 388 vdev_map &= ~BIT(vdev_id); 389 ath10k_mac_handle_tx_pause_vdev(ar, vdev_id, pause_id, 390 action); 391 } 392 break; 393 case WMI_TLV_TX_PAUSE_ID_AP_PEER_PS: 394 case WMI_TLV_TX_PAUSE_ID_AP_PEER_UAPSD: 395 case WMI_TLV_TX_PAUSE_ID_STA_ADD_BA: 396 case WMI_TLV_TX_PAUSE_ID_HOST: 397 ath10k_dbg(ar, ATH10K_DBG_MAC, 398 "mac ignoring unsupported tx pause id %d\n", 399 pause_id); 400 break; 401 default: 402 ath10k_dbg(ar, ATH10K_DBG_MAC, 403 "mac ignoring unknown tx pause vdev %d\n", 404 pause_id); 405 break; 406 } 407 408 kfree(tb); 409 return 0; 410 } 411 412 static void ath10k_wmi_tlv_event_rfkill_state_change(struct ath10k *ar, 413 struct sk_buff *skb) 414 { 415 const struct wmi_tlv_rfkill_state_change_ev *ev; 416 const void **tb; 417 bool radio; 418 int ret; 419 420 tb = ath10k_wmi_tlv_parse_alloc(ar, skb->data, skb->len, GFP_ATOMIC); 421 if (IS_ERR(tb)) { 422 ret = PTR_ERR(tb); 423 ath10k_warn(ar, 424 "failed to parse rfkill state change event: %d\n", 425 ret); 426 return; 427 } 428 429 ev = tb[WMI_TLV_TAG_STRUCT_RFKILL_EVENT]; 430 if (!ev) { 431 kfree(tb); 432 return; 433 } 434 435 ath10k_dbg(ar, ATH10K_DBG_MAC, 436 "wmi tlv rfkill state change gpio %d type %d radio_state %d\n", 437 __le32_to_cpu(ev->gpio_pin_num), 438 __le32_to_cpu(ev->int_type), 439 __le32_to_cpu(ev->radio_state)); 440 441 radio = (__le32_to_cpu(ev->radio_state) == WMI_TLV_RFKILL_RADIO_STATE_ON); 442 443 spin_lock_bh(&ar->data_lock); 444 445 if (!radio) 446 ar->hw_rfkill_on = true; 447 448 spin_unlock_bh(&ar->data_lock); 449 450 /* notify cfg80211 radio state change */ 451 ath10k_mac_rfkill_enable_radio(ar, radio); 452 wiphy_rfkill_set_hw_state(ar->hw->wiphy, !radio); 453 } 454 455 static int ath10k_wmi_tlv_event_temperature(struct ath10k *ar, 456 struct sk_buff *skb) 457 { 458 const struct wmi_tlv_pdev_temperature_event *ev; 459 460 ev = (struct wmi_tlv_pdev_temperature_event *)skb->data; 461 if (WARN_ON(skb->len < sizeof(*ev))) 462 return -EPROTO; 463 464 ath10k_thermal_event_temperature(ar, __le32_to_cpu(ev->temperature)); 465 return 0; 466 } 467 468 static void ath10k_wmi_event_tdls_peer(struct ath10k *ar, struct sk_buff *skb) 469 { 470 struct ieee80211_sta *station; 471 const struct wmi_tlv_tdls_peer_event *ev; 472 const void **tb; 473 struct ath10k_vif *arvif; 474 475 tb = ath10k_wmi_tlv_parse_alloc(ar, skb->data, skb->len, GFP_ATOMIC); 476 if (IS_ERR(tb)) { 477 ath10k_warn(ar, "tdls peer failed to parse tlv"); 478 return; 479 } 480 ev = tb[WMI_TLV_TAG_STRUCT_TDLS_PEER_EVENT]; 481 if (!ev) { 482 kfree(tb); 483 ath10k_warn(ar, "tdls peer NULL event"); 484 return; 485 } 486 487 switch (__le32_to_cpu(ev->peer_reason)) { 488 case WMI_TDLS_TEARDOWN_REASON_TX: 489 case WMI_TDLS_TEARDOWN_REASON_RSSI: 490 case WMI_TDLS_TEARDOWN_REASON_PTR_TIMEOUT: 491 station = ieee80211_find_sta_by_ifaddr(ar->hw, 492 ev->peer_macaddr.addr, 493 NULL); 494 if (!station) { 495 ath10k_warn(ar, "did not find station from tdls peer event"); 496 kfree(tb); 497 return; 498 } 499 arvif = ath10k_get_arvif(ar, __le32_to_cpu(ev->vdev_id)); 500 ieee80211_tdls_oper_request( 501 arvif->vif, station->addr, 502 NL80211_TDLS_TEARDOWN, 503 WLAN_REASON_TDLS_TEARDOWN_UNREACHABLE, 504 GFP_ATOMIC 505 ); 506 break; 507 } 508 kfree(tb); 509 } 510 511 static int ath10k_wmi_tlv_event_peer_delete_resp(struct ath10k *ar, 512 struct sk_buff *skb) 513 { 514 struct wmi_peer_delete_resp_ev_arg *arg; 515 struct wmi_tlv *tlv_hdr; 516 517 tlv_hdr = (struct wmi_tlv *)skb->data; 518 arg = (struct wmi_peer_delete_resp_ev_arg *)tlv_hdr->value; 519 520 ath10k_dbg(ar, ATH10K_DBG_WMI, "vdev id %d", arg->vdev_id); 521 ath10k_dbg(ar, ATH10K_DBG_WMI, "peer mac addr %pM", &arg->peer_addr); 522 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv peer delete response\n"); 523 524 complete(&ar->peer_delete_done); 525 526 return 0; 527 } 528 529 /***********/ 530 /* TLV ops */ 531 /***********/ 532 533 static void ath10k_wmi_tlv_op_rx(struct ath10k *ar, struct sk_buff *skb) 534 { 535 struct wmi_cmd_hdr *cmd_hdr; 536 enum wmi_tlv_event_id id; 537 bool consumed; 538 539 cmd_hdr = (struct wmi_cmd_hdr *)skb->data; 540 id = MS(__le32_to_cpu(cmd_hdr->cmd_id), WMI_CMD_HDR_CMD_ID); 541 542 if (skb_pull(skb, sizeof(struct wmi_cmd_hdr)) == NULL) 543 goto out; 544 545 trace_ath10k_wmi_event(ar, id, skb->data, skb->len); 546 547 consumed = ath10k_tm_event_wmi(ar, id, skb); 548 549 /* Ready event must be handled normally also in UTF mode so that we 550 * know the UTF firmware has booted, others we are just bypass WMI 551 * events to testmode. 552 */ 553 if (consumed && id != WMI_TLV_READY_EVENTID) { 554 ath10k_dbg(ar, ATH10K_DBG_WMI, 555 "wmi tlv testmode consumed 0x%x\n", id); 556 goto out; 557 } 558 559 switch (id) { 560 case WMI_TLV_MGMT_RX_EVENTID: 561 ath10k_wmi_event_mgmt_rx(ar, skb); 562 /* mgmt_rx() owns the skb now! */ 563 return; 564 case WMI_TLV_SCAN_EVENTID: 565 ath10k_wmi_event_scan(ar, skb); 566 break; 567 case WMI_TLV_CHAN_INFO_EVENTID: 568 ath10k_wmi_event_chan_info(ar, skb); 569 break; 570 case WMI_TLV_ECHO_EVENTID: 571 ath10k_wmi_event_echo(ar, skb); 572 break; 573 case WMI_TLV_DEBUG_MESG_EVENTID: 574 ath10k_wmi_event_debug_mesg(ar, skb); 575 break; 576 case WMI_TLV_UPDATE_STATS_EVENTID: 577 ath10k_wmi_event_update_stats(ar, skb); 578 break; 579 case WMI_TLV_VDEV_START_RESP_EVENTID: 580 ath10k_wmi_event_vdev_start_resp(ar, skb); 581 break; 582 case WMI_TLV_VDEV_STOPPED_EVENTID: 583 ath10k_wmi_event_vdev_stopped(ar, skb); 584 break; 585 case WMI_TLV_VDEV_DELETE_RESP_EVENTID: 586 ath10k_wmi_tlv_event_vdev_delete_resp(ar, skb); 587 break; 588 case WMI_TLV_PEER_STA_KICKOUT_EVENTID: 589 ath10k_wmi_event_peer_sta_kickout(ar, skb); 590 break; 591 case WMI_TLV_HOST_SWBA_EVENTID: 592 ath10k_wmi_event_host_swba(ar, skb); 593 break; 594 case WMI_TLV_TBTTOFFSET_UPDATE_EVENTID: 595 ath10k_wmi_event_tbttoffset_update(ar, skb); 596 break; 597 case WMI_TLV_PHYERR_EVENTID: 598 ath10k_wmi_event_phyerr(ar, skb); 599 break; 600 case WMI_TLV_ROAM_EVENTID: 601 ath10k_wmi_event_roam(ar, skb); 602 break; 603 case WMI_TLV_PROFILE_MATCH: 604 ath10k_wmi_event_profile_match(ar, skb); 605 break; 606 case WMI_TLV_DEBUG_PRINT_EVENTID: 607 ath10k_wmi_event_debug_print(ar, skb); 608 break; 609 case WMI_TLV_PDEV_QVIT_EVENTID: 610 ath10k_wmi_event_pdev_qvit(ar, skb); 611 break; 612 case WMI_TLV_WLAN_PROFILE_DATA_EVENTID: 613 ath10k_wmi_event_wlan_profile_data(ar, skb); 614 break; 615 case WMI_TLV_RTT_MEASUREMENT_REPORT_EVENTID: 616 ath10k_wmi_event_rtt_measurement_report(ar, skb); 617 break; 618 case WMI_TLV_TSF_MEASUREMENT_REPORT_EVENTID: 619 ath10k_wmi_event_tsf_measurement_report(ar, skb); 620 break; 621 case WMI_TLV_RTT_ERROR_REPORT_EVENTID: 622 ath10k_wmi_event_rtt_error_report(ar, skb); 623 break; 624 case WMI_TLV_WOW_WAKEUP_HOST_EVENTID: 625 ath10k_wmi_event_wow_wakeup_host(ar, skb); 626 break; 627 case WMI_TLV_DCS_INTERFERENCE_EVENTID: 628 ath10k_wmi_event_dcs_interference(ar, skb); 629 break; 630 case WMI_TLV_PDEV_TPC_CONFIG_EVENTID: 631 ath10k_wmi_event_pdev_tpc_config(ar, skb); 632 break; 633 case WMI_TLV_PDEV_FTM_INTG_EVENTID: 634 ath10k_wmi_event_pdev_ftm_intg(ar, skb); 635 break; 636 case WMI_TLV_GTK_OFFLOAD_STATUS_EVENTID: 637 ath10k_wmi_event_gtk_offload_status(ar, skb); 638 break; 639 case WMI_TLV_GTK_REKEY_FAIL_EVENTID: 640 ath10k_wmi_event_gtk_rekey_fail(ar, skb); 641 break; 642 case WMI_TLV_TX_DELBA_COMPLETE_EVENTID: 643 ath10k_wmi_event_delba_complete(ar, skb); 644 break; 645 case WMI_TLV_TX_ADDBA_COMPLETE_EVENTID: 646 ath10k_wmi_event_addba_complete(ar, skb); 647 break; 648 case WMI_TLV_VDEV_INSTALL_KEY_COMPLETE_EVENTID: 649 ath10k_wmi_event_vdev_install_key_complete(ar, skb); 650 break; 651 case WMI_TLV_SERVICE_READY_EVENTID: 652 ath10k_wmi_event_service_ready(ar, skb); 653 return; 654 case WMI_TLV_READY_EVENTID: 655 ath10k_wmi_event_ready(ar, skb); 656 break; 657 case WMI_TLV_SERVICE_AVAILABLE_EVENTID: 658 ath10k_wmi_event_service_available(ar, skb); 659 break; 660 case WMI_TLV_OFFLOAD_BCN_TX_STATUS_EVENTID: 661 ath10k_wmi_tlv_event_bcn_tx_status(ar, skb); 662 break; 663 case WMI_TLV_DIAG_DATA_CONTAINER_EVENTID: 664 ath10k_wmi_tlv_event_diag_data(ar, skb); 665 break; 666 case WMI_TLV_DIAG_EVENTID: 667 ath10k_wmi_tlv_event_diag(ar, skb); 668 break; 669 case WMI_TLV_P2P_NOA_EVENTID: 670 ath10k_wmi_tlv_event_p2p_noa(ar, skb); 671 break; 672 case WMI_TLV_TX_PAUSE_EVENTID: 673 ath10k_wmi_tlv_event_tx_pause(ar, skb); 674 break; 675 case WMI_TLV_RFKILL_STATE_CHANGE_EVENTID: 676 ath10k_wmi_tlv_event_rfkill_state_change(ar, skb); 677 break; 678 case WMI_TLV_PDEV_TEMPERATURE_EVENTID: 679 ath10k_wmi_tlv_event_temperature(ar, skb); 680 break; 681 case WMI_TLV_TDLS_PEER_EVENTID: 682 ath10k_wmi_event_tdls_peer(ar, skb); 683 break; 684 case WMI_TLV_PEER_DELETE_RESP_EVENTID: 685 ath10k_wmi_tlv_event_peer_delete_resp(ar, skb); 686 break; 687 case WMI_TLV_MGMT_TX_COMPLETION_EVENTID: 688 ath10k_wmi_event_mgmt_tx_compl(ar, skb); 689 break; 690 case WMI_TLV_MGMT_TX_BUNDLE_COMPLETION_EVENTID: 691 ath10k_wmi_event_mgmt_tx_bundle_compl(ar, skb); 692 break; 693 default: 694 ath10k_dbg(ar, ATH10K_DBG_WMI, "Unknown eventid: %d\n", id); 695 break; 696 } 697 698 out: 699 dev_kfree_skb(skb); 700 } 701 702 static int ath10k_wmi_tlv_op_pull_scan_ev(struct ath10k *ar, 703 struct sk_buff *skb, 704 struct wmi_scan_ev_arg *arg) 705 { 706 const void **tb; 707 const struct wmi_scan_event *ev; 708 int ret; 709 710 tb = ath10k_wmi_tlv_parse_alloc(ar, skb->data, skb->len, GFP_ATOMIC); 711 if (IS_ERR(tb)) { 712 ret = PTR_ERR(tb); 713 ath10k_warn(ar, "failed to parse tlv: %d\n", ret); 714 return ret; 715 } 716 717 ev = tb[WMI_TLV_TAG_STRUCT_SCAN_EVENT]; 718 if (!ev) { 719 kfree(tb); 720 return -EPROTO; 721 } 722 723 arg->event_type = ev->event_type; 724 arg->reason = ev->reason; 725 arg->channel_freq = ev->channel_freq; 726 arg->scan_req_id = ev->scan_req_id; 727 arg->scan_id = ev->scan_id; 728 arg->vdev_id = ev->vdev_id; 729 730 kfree(tb); 731 return 0; 732 } 733 734 static int 735 ath10k_wmi_tlv_op_pull_mgmt_tx_compl_ev(struct ath10k *ar, struct sk_buff *skb, 736 struct wmi_tlv_mgmt_tx_compl_ev_arg *arg) 737 { 738 const void **tb; 739 const struct wmi_tlv_mgmt_tx_compl_ev *ev; 740 int ret; 741 742 tb = ath10k_wmi_tlv_parse_alloc(ar, skb->data, skb->len, GFP_ATOMIC); 743 if (IS_ERR(tb)) { 744 ret = PTR_ERR(tb); 745 ath10k_warn(ar, "failed to parse tlv: %d\n", ret); 746 return ret; 747 } 748 749 ev = tb[WMI_TLV_TAG_STRUCT_MGMT_TX_COMPL_EVENT]; 750 751 arg->desc_id = ev->desc_id; 752 arg->status = ev->status; 753 arg->pdev_id = ev->pdev_id; 754 arg->ppdu_id = ev->ppdu_id; 755 756 if (test_bit(WMI_SERVICE_TX_DATA_ACK_RSSI, ar->wmi.svc_map)) 757 arg->ack_rssi = ev->ack_rssi; 758 759 kfree(tb); 760 return 0; 761 } 762 763 struct wmi_tlv_tx_bundle_compl_parse { 764 const __le32 *num_reports; 765 const __le32 *desc_ids; 766 const __le32 *status; 767 const __le32 *ppdu_ids; 768 const __le32 *ack_rssi; 769 bool desc_ids_done; 770 bool status_done; 771 bool ppdu_ids_done; 772 bool ack_rssi_done; 773 }; 774 775 static int 776 ath10k_wmi_tlv_mgmt_tx_bundle_compl_parse(struct ath10k *ar, u16 tag, u16 len, 777 const void *ptr, void *data) 778 { 779 struct wmi_tlv_tx_bundle_compl_parse *bundle_tx_compl = data; 780 781 switch (tag) { 782 case WMI_TLV_TAG_STRUCT_MGMT_TX_COMPL_BUNDLE_EVENT: 783 bundle_tx_compl->num_reports = ptr; 784 break; 785 case WMI_TLV_TAG_ARRAY_UINT32: 786 if (!bundle_tx_compl->desc_ids_done) { 787 bundle_tx_compl->desc_ids_done = true; 788 bundle_tx_compl->desc_ids = ptr; 789 } else if (!bundle_tx_compl->status_done) { 790 bundle_tx_compl->status_done = true; 791 bundle_tx_compl->status = ptr; 792 } else if (!bundle_tx_compl->ppdu_ids_done) { 793 bundle_tx_compl->ppdu_ids_done = true; 794 bundle_tx_compl->ppdu_ids = ptr; 795 } else if (!bundle_tx_compl->ack_rssi_done) { 796 bundle_tx_compl->ack_rssi_done = true; 797 bundle_tx_compl->ack_rssi = ptr; 798 } 799 break; 800 default: 801 break; 802 } 803 return 0; 804 } 805 806 static int ath10k_wmi_tlv_op_pull_mgmt_tx_bundle_compl_ev( 807 struct ath10k *ar, struct sk_buff *skb, 808 struct wmi_tlv_mgmt_tx_bundle_compl_ev_arg *arg) 809 { 810 struct wmi_tlv_tx_bundle_compl_parse bundle_tx_compl = { }; 811 int ret; 812 813 ret = ath10k_wmi_tlv_iter(ar, skb->data, skb->len, 814 ath10k_wmi_tlv_mgmt_tx_bundle_compl_parse, 815 &bundle_tx_compl); 816 if (ret) { 817 ath10k_warn(ar, "failed to parse tlv: %d\n", ret); 818 return ret; 819 } 820 821 if (!bundle_tx_compl.num_reports || !bundle_tx_compl.desc_ids || 822 !bundle_tx_compl.status) 823 return -EPROTO; 824 825 arg->num_reports = *bundle_tx_compl.num_reports; 826 arg->desc_ids = bundle_tx_compl.desc_ids; 827 arg->status = bundle_tx_compl.status; 828 arg->ppdu_ids = bundle_tx_compl.ppdu_ids; 829 830 if (test_bit(WMI_SERVICE_TX_DATA_ACK_RSSI, ar->wmi.svc_map)) 831 arg->ack_rssi = bundle_tx_compl.ack_rssi; 832 833 return 0; 834 } 835 836 static int ath10k_wmi_tlv_op_pull_mgmt_rx_ev(struct ath10k *ar, 837 struct sk_buff *skb, 838 struct wmi_mgmt_rx_ev_arg *arg) 839 { 840 const void **tb; 841 const struct wmi_tlv_mgmt_rx_ev *ev; 842 const u8 *frame; 843 u32 msdu_len; 844 int ret, i; 845 846 tb = ath10k_wmi_tlv_parse_alloc(ar, skb->data, skb->len, GFP_ATOMIC); 847 if (IS_ERR(tb)) { 848 ret = PTR_ERR(tb); 849 ath10k_warn(ar, "failed to parse tlv: %d\n", ret); 850 return ret; 851 } 852 853 ev = tb[WMI_TLV_TAG_STRUCT_MGMT_RX_HDR]; 854 frame = tb[WMI_TLV_TAG_ARRAY_BYTE]; 855 856 if (!ev || !frame) { 857 kfree(tb); 858 return -EPROTO; 859 } 860 861 arg->channel = ev->channel; 862 arg->buf_len = ev->buf_len; 863 arg->status = ev->status; 864 arg->snr = ev->snr; 865 arg->phy_mode = ev->phy_mode; 866 arg->rate = ev->rate; 867 868 for (i = 0; i < ARRAY_SIZE(ev->rssi); i++) 869 arg->rssi[i] = ev->rssi[i]; 870 871 msdu_len = __le32_to_cpu(arg->buf_len); 872 873 if (skb->len < (frame - skb->data) + msdu_len) { 874 kfree(tb); 875 return -EPROTO; 876 } 877 878 /* shift the sk_buff to point to `frame` */ 879 skb_trim(skb, 0); 880 skb_put(skb, frame - skb->data); 881 skb_pull(skb, frame - skb->data); 882 skb_put(skb, msdu_len); 883 884 kfree(tb); 885 return 0; 886 } 887 888 static int ath10k_wmi_tlv_op_pull_ch_info_ev(struct ath10k *ar, 889 struct sk_buff *skb, 890 struct wmi_ch_info_ev_arg *arg) 891 { 892 const void **tb; 893 const struct wmi_tlv_chan_info_event *ev; 894 int ret; 895 896 tb = ath10k_wmi_tlv_parse_alloc(ar, skb->data, skb->len, GFP_ATOMIC); 897 if (IS_ERR(tb)) { 898 ret = PTR_ERR(tb); 899 ath10k_warn(ar, "failed to parse tlv: %d\n", ret); 900 return ret; 901 } 902 903 ev = tb[WMI_TLV_TAG_STRUCT_CHAN_INFO_EVENT]; 904 if (!ev) { 905 kfree(tb); 906 return -EPROTO; 907 } 908 909 arg->err_code = ev->err_code; 910 arg->freq = ev->freq; 911 arg->cmd_flags = ev->cmd_flags; 912 arg->noise_floor = ev->noise_floor; 913 arg->rx_clear_count = ev->rx_clear_count; 914 arg->cycle_count = ev->cycle_count; 915 if (test_bit(ATH10K_FW_FEATURE_SINGLE_CHAN_INFO_PER_CHANNEL, 916 ar->running_fw->fw_file.fw_features)) 917 arg->mac_clk_mhz = ev->mac_clk_mhz; 918 919 kfree(tb); 920 return 0; 921 } 922 923 static int 924 ath10k_wmi_tlv_op_pull_vdev_start_ev(struct ath10k *ar, struct sk_buff *skb, 925 struct wmi_vdev_start_ev_arg *arg) 926 { 927 const void **tb; 928 const struct wmi_vdev_start_response_event *ev; 929 int ret; 930 931 tb = ath10k_wmi_tlv_parse_alloc(ar, skb->data, skb->len, GFP_ATOMIC); 932 if (IS_ERR(tb)) { 933 ret = PTR_ERR(tb); 934 ath10k_warn(ar, "failed to parse tlv: %d\n", ret); 935 return ret; 936 } 937 938 ev = tb[WMI_TLV_TAG_STRUCT_VDEV_START_RESPONSE_EVENT]; 939 if (!ev) { 940 kfree(tb); 941 return -EPROTO; 942 } 943 944 skb_pull(skb, sizeof(*ev)); 945 arg->vdev_id = ev->vdev_id; 946 arg->req_id = ev->req_id; 947 arg->resp_type = ev->resp_type; 948 arg->status = ev->status; 949 950 kfree(tb); 951 return 0; 952 } 953 954 static int ath10k_wmi_tlv_op_pull_peer_kick_ev(struct ath10k *ar, 955 struct sk_buff *skb, 956 struct wmi_peer_kick_ev_arg *arg) 957 { 958 const void **tb; 959 const struct wmi_peer_sta_kickout_event *ev; 960 int ret; 961 962 tb = ath10k_wmi_tlv_parse_alloc(ar, skb->data, skb->len, GFP_ATOMIC); 963 if (IS_ERR(tb)) { 964 ret = PTR_ERR(tb); 965 ath10k_warn(ar, "failed to parse tlv: %d\n", ret); 966 return ret; 967 } 968 969 ev = tb[WMI_TLV_TAG_STRUCT_PEER_STA_KICKOUT_EVENT]; 970 if (!ev) { 971 kfree(tb); 972 return -EPROTO; 973 } 974 975 arg->mac_addr = ev->peer_macaddr.addr; 976 977 kfree(tb); 978 return 0; 979 } 980 981 struct wmi_tlv_swba_parse { 982 const struct wmi_host_swba_event *ev; 983 bool tim_done; 984 bool noa_done; 985 size_t n_tim; 986 size_t n_noa; 987 struct wmi_swba_ev_arg *arg; 988 }; 989 990 static int ath10k_wmi_tlv_swba_tim_parse(struct ath10k *ar, u16 tag, u16 len, 991 const void *ptr, void *data) 992 { 993 struct wmi_tlv_swba_parse *swba = data; 994 struct wmi_tim_info_arg *tim_info_arg; 995 const struct wmi_tim_info *tim_info_ev = ptr; 996 997 if (tag != WMI_TLV_TAG_STRUCT_TIM_INFO) 998 return -EPROTO; 999 1000 if (swba->n_tim >= ARRAY_SIZE(swba->arg->tim_info)) 1001 return -ENOBUFS; 1002 1003 if (__le32_to_cpu(tim_info_ev->tim_len) > 1004 sizeof(tim_info_ev->tim_bitmap)) { 1005 ath10k_warn(ar, "refusing to parse invalid swba structure\n"); 1006 return -EPROTO; 1007 } 1008 1009 tim_info_arg = &swba->arg->tim_info[swba->n_tim]; 1010 tim_info_arg->tim_len = tim_info_ev->tim_len; 1011 tim_info_arg->tim_mcast = tim_info_ev->tim_mcast; 1012 tim_info_arg->tim_bitmap = tim_info_ev->tim_bitmap; 1013 tim_info_arg->tim_changed = tim_info_ev->tim_changed; 1014 tim_info_arg->tim_num_ps_pending = tim_info_ev->tim_num_ps_pending; 1015 1016 swba->n_tim++; 1017 1018 return 0; 1019 } 1020 1021 static int ath10k_wmi_tlv_swba_noa_parse(struct ath10k *ar, u16 tag, u16 len, 1022 const void *ptr, void *data) 1023 { 1024 struct wmi_tlv_swba_parse *swba = data; 1025 1026 if (tag != WMI_TLV_TAG_STRUCT_P2P_NOA_INFO) 1027 return -EPROTO; 1028 1029 if (swba->n_noa >= ARRAY_SIZE(swba->arg->noa_info)) 1030 return -ENOBUFS; 1031 1032 swba->arg->noa_info[swba->n_noa++] = ptr; 1033 return 0; 1034 } 1035 1036 static int ath10k_wmi_tlv_swba_parse(struct ath10k *ar, u16 tag, u16 len, 1037 const void *ptr, void *data) 1038 { 1039 struct wmi_tlv_swba_parse *swba = data; 1040 int ret; 1041 1042 switch (tag) { 1043 case WMI_TLV_TAG_STRUCT_HOST_SWBA_EVENT: 1044 swba->ev = ptr; 1045 break; 1046 case WMI_TLV_TAG_ARRAY_STRUCT: 1047 if (!swba->tim_done) { 1048 swba->tim_done = true; 1049 ret = ath10k_wmi_tlv_iter(ar, ptr, len, 1050 ath10k_wmi_tlv_swba_tim_parse, 1051 swba); 1052 if (ret) 1053 return ret; 1054 } else if (!swba->noa_done) { 1055 swba->noa_done = true; 1056 ret = ath10k_wmi_tlv_iter(ar, ptr, len, 1057 ath10k_wmi_tlv_swba_noa_parse, 1058 swba); 1059 if (ret) 1060 return ret; 1061 } 1062 break; 1063 default: 1064 break; 1065 } 1066 return 0; 1067 } 1068 1069 static int ath10k_wmi_tlv_op_pull_swba_ev(struct ath10k *ar, 1070 struct sk_buff *skb, 1071 struct wmi_swba_ev_arg *arg) 1072 { 1073 struct wmi_tlv_swba_parse swba = { .arg = arg }; 1074 u32 map; 1075 size_t n_vdevs; 1076 int ret; 1077 1078 ret = ath10k_wmi_tlv_iter(ar, skb->data, skb->len, 1079 ath10k_wmi_tlv_swba_parse, &swba); 1080 if (ret) { 1081 ath10k_warn(ar, "failed to parse tlv: %d\n", ret); 1082 return ret; 1083 } 1084 1085 if (!swba.ev) 1086 return -EPROTO; 1087 1088 arg->vdev_map = swba.ev->vdev_map; 1089 1090 for (map = __le32_to_cpu(arg->vdev_map), n_vdevs = 0; map; map >>= 1) 1091 if (map & BIT(0)) 1092 n_vdevs++; 1093 1094 if (n_vdevs != swba.n_tim || 1095 n_vdevs != swba.n_noa) 1096 return -EPROTO; 1097 1098 return 0; 1099 } 1100 1101 static int ath10k_wmi_tlv_op_pull_phyerr_ev_hdr(struct ath10k *ar, 1102 struct sk_buff *skb, 1103 struct wmi_phyerr_hdr_arg *arg) 1104 { 1105 const void **tb; 1106 const struct wmi_tlv_phyerr_ev *ev; 1107 const void *phyerrs; 1108 int ret; 1109 1110 tb = ath10k_wmi_tlv_parse_alloc(ar, skb->data, skb->len, GFP_ATOMIC); 1111 if (IS_ERR(tb)) { 1112 ret = PTR_ERR(tb); 1113 ath10k_warn(ar, "failed to parse tlv: %d\n", ret); 1114 return ret; 1115 } 1116 1117 ev = tb[WMI_TLV_TAG_STRUCT_COMB_PHYERR_RX_HDR]; 1118 phyerrs = tb[WMI_TLV_TAG_ARRAY_BYTE]; 1119 1120 if (!ev || !phyerrs) { 1121 kfree(tb); 1122 return -EPROTO; 1123 } 1124 1125 arg->num_phyerrs = __le32_to_cpu(ev->num_phyerrs); 1126 arg->tsf_l32 = __le32_to_cpu(ev->tsf_l32); 1127 arg->tsf_u32 = __le32_to_cpu(ev->tsf_u32); 1128 arg->buf_len = __le32_to_cpu(ev->buf_len); 1129 arg->phyerrs = phyerrs; 1130 1131 kfree(tb); 1132 return 0; 1133 } 1134 1135 #define WMI_TLV_ABI_VER_NS0 0x5F414351 1136 #define WMI_TLV_ABI_VER_NS1 0x00004C4D 1137 #define WMI_TLV_ABI_VER_NS2 0x00000000 1138 #define WMI_TLV_ABI_VER_NS3 0x00000000 1139 1140 #define WMI_TLV_ABI_VER0_MAJOR 1 1141 #define WMI_TLV_ABI_VER0_MINOR 0 1142 #define WMI_TLV_ABI_VER0 ((((WMI_TLV_ABI_VER0_MAJOR) << 24) & 0xFF000000) | \ 1143 (((WMI_TLV_ABI_VER0_MINOR) << 0) & 0x00FFFFFF)) 1144 #define WMI_TLV_ABI_VER1 53 1145 1146 static int 1147 ath10k_wmi_tlv_parse_mem_reqs(struct ath10k *ar, u16 tag, u16 len, 1148 const void *ptr, void *data) 1149 { 1150 struct wmi_svc_rdy_ev_arg *arg = data; 1151 int i; 1152 1153 if (tag != WMI_TLV_TAG_STRUCT_WLAN_HOST_MEM_REQ) 1154 return -EPROTO; 1155 1156 for (i = 0; i < ARRAY_SIZE(arg->mem_reqs); i++) { 1157 if (!arg->mem_reqs[i]) { 1158 arg->mem_reqs[i] = ptr; 1159 return 0; 1160 } 1161 } 1162 1163 return -ENOMEM; 1164 } 1165 1166 struct wmi_tlv_svc_rdy_parse { 1167 const struct hal_reg_capabilities *reg; 1168 const struct wmi_tlv_svc_rdy_ev *ev; 1169 const __le32 *svc_bmap; 1170 const struct wlan_host_mem_req *mem_reqs; 1171 bool svc_bmap_done; 1172 bool dbs_hw_mode_done; 1173 }; 1174 1175 static int ath10k_wmi_tlv_svc_rdy_parse(struct ath10k *ar, u16 tag, u16 len, 1176 const void *ptr, void *data) 1177 { 1178 struct wmi_tlv_svc_rdy_parse *svc_rdy = data; 1179 1180 switch (tag) { 1181 case WMI_TLV_TAG_STRUCT_SERVICE_READY_EVENT: 1182 svc_rdy->ev = ptr; 1183 break; 1184 case WMI_TLV_TAG_STRUCT_HAL_REG_CAPABILITIES: 1185 svc_rdy->reg = ptr; 1186 break; 1187 case WMI_TLV_TAG_ARRAY_STRUCT: 1188 svc_rdy->mem_reqs = ptr; 1189 break; 1190 case WMI_TLV_TAG_ARRAY_UINT32: 1191 if (!svc_rdy->svc_bmap_done) { 1192 svc_rdy->svc_bmap_done = true; 1193 svc_rdy->svc_bmap = ptr; 1194 } else if (!svc_rdy->dbs_hw_mode_done) { 1195 svc_rdy->dbs_hw_mode_done = true; 1196 } 1197 break; 1198 default: 1199 break; 1200 } 1201 return 0; 1202 } 1203 1204 static int ath10k_wmi_tlv_op_pull_svc_rdy_ev(struct ath10k *ar, 1205 struct sk_buff *skb, 1206 struct wmi_svc_rdy_ev_arg *arg) 1207 { 1208 const struct hal_reg_capabilities *reg; 1209 const struct wmi_tlv_svc_rdy_ev *ev; 1210 const __le32 *svc_bmap; 1211 const struct wlan_host_mem_req *mem_reqs; 1212 struct wmi_tlv_svc_rdy_parse svc_rdy = { }; 1213 int ret; 1214 1215 ret = ath10k_wmi_tlv_iter(ar, skb->data, skb->len, 1216 ath10k_wmi_tlv_svc_rdy_parse, &svc_rdy); 1217 if (ret) { 1218 ath10k_warn(ar, "failed to parse tlv: %d\n", ret); 1219 return ret; 1220 } 1221 1222 ev = svc_rdy.ev; 1223 reg = svc_rdy.reg; 1224 svc_bmap = svc_rdy.svc_bmap; 1225 mem_reqs = svc_rdy.mem_reqs; 1226 1227 if (!ev || !reg || !svc_bmap || !mem_reqs) 1228 return -EPROTO; 1229 1230 /* This is an internal ABI compatibility check for WMI TLV so check it 1231 * here instead of the generic WMI code. 1232 */ 1233 ath10k_dbg(ar, ATH10K_DBG_WMI, 1234 "wmi tlv abi 0x%08x ?= 0x%08x, 0x%08x ?= 0x%08x, 0x%08x ?= 0x%08x, 0x%08x ?= 0x%08x, 0x%08x ?= 0x%08x\n", 1235 __le32_to_cpu(ev->abi.abi_ver0), WMI_TLV_ABI_VER0, 1236 __le32_to_cpu(ev->abi.abi_ver_ns0), WMI_TLV_ABI_VER_NS0, 1237 __le32_to_cpu(ev->abi.abi_ver_ns1), WMI_TLV_ABI_VER_NS1, 1238 __le32_to_cpu(ev->abi.abi_ver_ns2), WMI_TLV_ABI_VER_NS2, 1239 __le32_to_cpu(ev->abi.abi_ver_ns3), WMI_TLV_ABI_VER_NS3); 1240 1241 if (__le32_to_cpu(ev->abi.abi_ver0) != WMI_TLV_ABI_VER0 || 1242 __le32_to_cpu(ev->abi.abi_ver_ns0) != WMI_TLV_ABI_VER_NS0 || 1243 __le32_to_cpu(ev->abi.abi_ver_ns1) != WMI_TLV_ABI_VER_NS1 || 1244 __le32_to_cpu(ev->abi.abi_ver_ns2) != WMI_TLV_ABI_VER_NS2 || 1245 __le32_to_cpu(ev->abi.abi_ver_ns3) != WMI_TLV_ABI_VER_NS3) { 1246 return -ENOTSUPP; 1247 } 1248 1249 arg->min_tx_power = ev->hw_min_tx_power; 1250 arg->max_tx_power = ev->hw_max_tx_power; 1251 arg->ht_cap = ev->ht_cap_info; 1252 arg->vht_cap = ev->vht_cap_info; 1253 arg->vht_supp_mcs = ev->vht_supp_mcs; 1254 arg->sw_ver0 = ev->abi.abi_ver0; 1255 arg->sw_ver1 = ev->abi.abi_ver1; 1256 arg->fw_build = ev->fw_build_vers; 1257 arg->phy_capab = ev->phy_capability; 1258 arg->num_rf_chains = ev->num_rf_chains; 1259 arg->eeprom_rd = reg->eeprom_rd; 1260 arg->low_2ghz_chan = reg->low_2ghz_chan; 1261 arg->high_2ghz_chan = reg->high_2ghz_chan; 1262 arg->low_5ghz_chan = reg->low_5ghz_chan; 1263 arg->high_5ghz_chan = reg->high_5ghz_chan; 1264 arg->num_mem_reqs = ev->num_mem_reqs; 1265 arg->service_map = svc_bmap; 1266 arg->service_map_len = ath10k_wmi_tlv_len(svc_bmap); 1267 arg->sys_cap_info = ev->sys_cap_info; 1268 1269 ret = ath10k_wmi_tlv_iter(ar, mem_reqs, ath10k_wmi_tlv_len(mem_reqs), 1270 ath10k_wmi_tlv_parse_mem_reqs, arg); 1271 if (ret) { 1272 ath10k_warn(ar, "failed to parse mem_reqs tlv: %d\n", ret); 1273 return ret; 1274 } 1275 1276 return 0; 1277 } 1278 1279 static int ath10k_wmi_tlv_op_pull_rdy_ev(struct ath10k *ar, 1280 struct sk_buff *skb, 1281 struct wmi_rdy_ev_arg *arg) 1282 { 1283 const void **tb; 1284 const struct wmi_tlv_rdy_ev *ev; 1285 int ret; 1286 1287 tb = ath10k_wmi_tlv_parse_alloc(ar, skb->data, skb->len, GFP_ATOMIC); 1288 if (IS_ERR(tb)) { 1289 ret = PTR_ERR(tb); 1290 ath10k_warn(ar, "failed to parse tlv: %d\n", ret); 1291 return ret; 1292 } 1293 1294 ev = tb[WMI_TLV_TAG_STRUCT_READY_EVENT]; 1295 if (!ev) { 1296 kfree(tb); 1297 return -EPROTO; 1298 } 1299 1300 arg->sw_version = ev->abi.abi_ver0; 1301 arg->abi_version = ev->abi.abi_ver1; 1302 arg->status = ev->status; 1303 arg->mac_addr = ev->mac_addr.addr; 1304 1305 kfree(tb); 1306 return 0; 1307 } 1308 1309 static int ath10k_wmi_tlv_svc_avail_parse(struct ath10k *ar, u16 tag, u16 len, 1310 const void *ptr, void *data) 1311 { 1312 struct wmi_svc_avail_ev_arg *arg = data; 1313 1314 switch (tag) { 1315 case WMI_TLV_TAG_STRUCT_SERVICE_AVAILABLE_EVENT: 1316 arg->service_map_ext_len = *(__le32 *)ptr; 1317 arg->service_map_ext = ptr + sizeof(__le32); 1318 return 0; 1319 default: 1320 break; 1321 } 1322 return -EPROTO; 1323 } 1324 1325 static int ath10k_wmi_tlv_op_pull_svc_avail(struct ath10k *ar, 1326 struct sk_buff *skb, 1327 struct wmi_svc_avail_ev_arg *arg) 1328 { 1329 int ret; 1330 1331 ret = ath10k_wmi_tlv_iter(ar, skb->data, skb->len, 1332 ath10k_wmi_tlv_svc_avail_parse, arg); 1333 1334 if (ret) { 1335 ath10k_warn(ar, "failed to parse svc_avail tlv: %d\n", ret); 1336 return ret; 1337 } 1338 1339 return 0; 1340 } 1341 1342 static void ath10k_wmi_tlv_pull_vdev_stats(const struct wmi_tlv_vdev_stats *src, 1343 struct ath10k_fw_stats_vdev *dst) 1344 { 1345 int i; 1346 1347 dst->vdev_id = __le32_to_cpu(src->vdev_id); 1348 dst->beacon_snr = __le32_to_cpu(src->beacon_snr); 1349 dst->data_snr = __le32_to_cpu(src->data_snr); 1350 dst->num_rx_frames = __le32_to_cpu(src->num_rx_frames); 1351 dst->num_rts_fail = __le32_to_cpu(src->num_rts_fail); 1352 dst->num_rts_success = __le32_to_cpu(src->num_rts_success); 1353 dst->num_rx_err = __le32_to_cpu(src->num_rx_err); 1354 dst->num_rx_discard = __le32_to_cpu(src->num_rx_discard); 1355 dst->num_tx_not_acked = __le32_to_cpu(src->num_tx_not_acked); 1356 1357 for (i = 0; i < ARRAY_SIZE(src->num_tx_frames); i++) 1358 dst->num_tx_frames[i] = 1359 __le32_to_cpu(src->num_tx_frames[i]); 1360 1361 for (i = 0; i < ARRAY_SIZE(src->num_tx_frames_retries); i++) 1362 dst->num_tx_frames_retries[i] = 1363 __le32_to_cpu(src->num_tx_frames_retries[i]); 1364 1365 for (i = 0; i < ARRAY_SIZE(src->num_tx_frames_failures); i++) 1366 dst->num_tx_frames_failures[i] = 1367 __le32_to_cpu(src->num_tx_frames_failures[i]); 1368 1369 for (i = 0; i < ARRAY_SIZE(src->tx_rate_history); i++) 1370 dst->tx_rate_history[i] = 1371 __le32_to_cpu(src->tx_rate_history[i]); 1372 1373 for (i = 0; i < ARRAY_SIZE(src->beacon_rssi_history); i++) 1374 dst->beacon_rssi_history[i] = 1375 __le32_to_cpu(src->beacon_rssi_history[i]); 1376 } 1377 1378 static int ath10k_wmi_tlv_op_pull_fw_stats(struct ath10k *ar, 1379 struct sk_buff *skb, 1380 struct ath10k_fw_stats *stats) 1381 { 1382 const void **tb; 1383 const struct wmi_tlv_stats_ev *ev; 1384 u32 num_peer_stats_extd; 1385 const void *data; 1386 u32 num_pdev_stats; 1387 u32 num_vdev_stats; 1388 u32 num_peer_stats; 1389 u32 num_bcnflt_stats; 1390 u32 num_chan_stats; 1391 size_t data_len; 1392 u32 stats_id; 1393 int ret; 1394 int i; 1395 1396 tb = ath10k_wmi_tlv_parse_alloc(ar, skb->data, skb->len, GFP_ATOMIC); 1397 if (IS_ERR(tb)) { 1398 ret = PTR_ERR(tb); 1399 ath10k_warn(ar, "failed to parse tlv: %d\n", ret); 1400 return ret; 1401 } 1402 1403 ev = tb[WMI_TLV_TAG_STRUCT_STATS_EVENT]; 1404 data = tb[WMI_TLV_TAG_ARRAY_BYTE]; 1405 1406 if (!ev || !data) { 1407 kfree(tb); 1408 return -EPROTO; 1409 } 1410 1411 data_len = ath10k_wmi_tlv_len(data); 1412 num_pdev_stats = __le32_to_cpu(ev->num_pdev_stats); 1413 num_vdev_stats = __le32_to_cpu(ev->num_vdev_stats); 1414 num_peer_stats = __le32_to_cpu(ev->num_peer_stats); 1415 num_bcnflt_stats = __le32_to_cpu(ev->num_bcnflt_stats); 1416 num_chan_stats = __le32_to_cpu(ev->num_chan_stats); 1417 stats_id = __le32_to_cpu(ev->stats_id); 1418 num_peer_stats_extd = __le32_to_cpu(ev->num_peer_stats_extd); 1419 1420 ath10k_dbg(ar, ATH10K_DBG_WMI, 1421 "wmi tlv stats update pdev %i vdev %i peer %i bcnflt %i chan %i peer_extd %i\n", 1422 num_pdev_stats, num_vdev_stats, num_peer_stats, 1423 num_bcnflt_stats, num_chan_stats, num_peer_stats_extd); 1424 1425 for (i = 0; i < num_pdev_stats; i++) { 1426 const struct wmi_pdev_stats *src; 1427 struct ath10k_fw_stats_pdev *dst; 1428 1429 src = data; 1430 if (data_len < sizeof(*src)) { 1431 kfree(tb); 1432 return -EPROTO; 1433 } 1434 1435 data += sizeof(*src); 1436 data_len -= sizeof(*src); 1437 1438 dst = kzalloc(sizeof(*dst), GFP_ATOMIC); 1439 if (!dst) 1440 continue; 1441 1442 ath10k_wmi_pull_pdev_stats_base(&src->base, dst); 1443 ath10k_wmi_pull_pdev_stats_tx(&src->tx, dst); 1444 ath10k_wmi_pull_pdev_stats_rx(&src->rx, dst); 1445 list_add_tail(&dst->list, &stats->pdevs); 1446 } 1447 1448 for (i = 0; i < num_vdev_stats; i++) { 1449 const struct wmi_tlv_vdev_stats *src; 1450 struct ath10k_fw_stats_vdev *dst; 1451 1452 src = data; 1453 if (data_len < sizeof(*src)) { 1454 kfree(tb); 1455 return -EPROTO; 1456 } 1457 1458 data += sizeof(*src); 1459 data_len -= sizeof(*src); 1460 1461 dst = kzalloc(sizeof(*dst), GFP_ATOMIC); 1462 if (!dst) 1463 continue; 1464 1465 ath10k_wmi_tlv_pull_vdev_stats(src, dst); 1466 list_add_tail(&dst->list, &stats->vdevs); 1467 } 1468 1469 for (i = 0; i < num_peer_stats; i++) { 1470 const struct wmi_10x_peer_stats *src; 1471 struct ath10k_fw_stats_peer *dst; 1472 1473 src = data; 1474 if (data_len < sizeof(*src)) { 1475 kfree(tb); 1476 return -EPROTO; 1477 } 1478 1479 data += sizeof(*src); 1480 data_len -= sizeof(*src); 1481 1482 dst = kzalloc(sizeof(*dst), GFP_ATOMIC); 1483 if (!dst) 1484 continue; 1485 1486 ath10k_wmi_pull_peer_stats(&src->old, dst); 1487 dst->peer_rx_rate = __le32_to_cpu(src->peer_rx_rate); 1488 1489 if (stats_id & WMI_TLV_STAT_PEER_EXTD) { 1490 const struct wmi_tlv_peer_stats_extd *extd; 1491 unsigned long rx_duration_high; 1492 1493 extd = data + sizeof(*src) * (num_peer_stats - i - 1) 1494 + sizeof(*extd) * i; 1495 1496 dst->rx_duration = __le32_to_cpu(extd->rx_duration); 1497 rx_duration_high = __le32_to_cpu 1498 (extd->rx_duration_high); 1499 1500 if (test_bit(WMI_TLV_PEER_RX_DURATION_HIGH_VALID_BIT, 1501 &rx_duration_high)) { 1502 rx_duration_high = 1503 FIELD_GET(WMI_TLV_PEER_RX_DURATION_HIGH_MASK, 1504 rx_duration_high); 1505 dst->rx_duration |= (u64)rx_duration_high << 1506 WMI_TLV_PEER_RX_DURATION_SHIFT; 1507 } 1508 } 1509 1510 list_add_tail(&dst->list, &stats->peers); 1511 } 1512 1513 kfree(tb); 1514 return 0; 1515 } 1516 1517 static int ath10k_wmi_tlv_op_pull_roam_ev(struct ath10k *ar, 1518 struct sk_buff *skb, 1519 struct wmi_roam_ev_arg *arg) 1520 { 1521 const void **tb; 1522 const struct wmi_tlv_roam_ev *ev; 1523 int ret; 1524 1525 tb = ath10k_wmi_tlv_parse_alloc(ar, skb->data, skb->len, GFP_ATOMIC); 1526 if (IS_ERR(tb)) { 1527 ret = PTR_ERR(tb); 1528 ath10k_warn(ar, "failed to parse tlv: %d\n", ret); 1529 return ret; 1530 } 1531 1532 ev = tb[WMI_TLV_TAG_STRUCT_ROAM_EVENT]; 1533 if (!ev) { 1534 kfree(tb); 1535 return -EPROTO; 1536 } 1537 1538 arg->vdev_id = ev->vdev_id; 1539 arg->reason = ev->reason; 1540 arg->rssi = ev->rssi; 1541 1542 kfree(tb); 1543 return 0; 1544 } 1545 1546 static int 1547 ath10k_wmi_tlv_op_pull_wow_ev(struct ath10k *ar, struct sk_buff *skb, 1548 struct wmi_wow_ev_arg *arg) 1549 { 1550 const void **tb; 1551 const struct wmi_tlv_wow_event_info *ev; 1552 int ret; 1553 1554 tb = ath10k_wmi_tlv_parse_alloc(ar, skb->data, skb->len, GFP_ATOMIC); 1555 if (IS_ERR(tb)) { 1556 ret = PTR_ERR(tb); 1557 ath10k_warn(ar, "failed to parse tlv: %d\n", ret); 1558 return ret; 1559 } 1560 1561 ev = tb[WMI_TLV_TAG_STRUCT_WOW_EVENT_INFO]; 1562 if (!ev) { 1563 kfree(tb); 1564 return -EPROTO; 1565 } 1566 1567 arg->vdev_id = __le32_to_cpu(ev->vdev_id); 1568 arg->flag = __le32_to_cpu(ev->flag); 1569 arg->wake_reason = __le32_to_cpu(ev->wake_reason); 1570 arg->data_len = __le32_to_cpu(ev->data_len); 1571 1572 kfree(tb); 1573 return 0; 1574 } 1575 1576 static int ath10k_wmi_tlv_op_pull_echo_ev(struct ath10k *ar, 1577 struct sk_buff *skb, 1578 struct wmi_echo_ev_arg *arg) 1579 { 1580 const void **tb; 1581 const struct wmi_echo_event *ev; 1582 int ret; 1583 1584 tb = ath10k_wmi_tlv_parse_alloc(ar, skb->data, skb->len, GFP_ATOMIC); 1585 if (IS_ERR(tb)) { 1586 ret = PTR_ERR(tb); 1587 ath10k_warn(ar, "failed to parse tlv: %d\n", ret); 1588 return ret; 1589 } 1590 1591 ev = tb[WMI_TLV_TAG_STRUCT_ECHO_EVENT]; 1592 if (!ev) { 1593 kfree(tb); 1594 return -EPROTO; 1595 } 1596 1597 arg->value = ev->value; 1598 1599 kfree(tb); 1600 return 0; 1601 } 1602 1603 static struct sk_buff * 1604 ath10k_wmi_tlv_op_gen_pdev_suspend(struct ath10k *ar, u32 opt) 1605 { 1606 struct wmi_tlv_pdev_suspend *cmd; 1607 struct wmi_tlv *tlv; 1608 struct sk_buff *skb; 1609 1610 skb = ath10k_wmi_alloc_skb(ar, sizeof(*tlv) + sizeof(*cmd)); 1611 if (!skb) 1612 return ERR_PTR(-ENOMEM); 1613 1614 tlv = (void *)skb->data; 1615 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_PDEV_SUSPEND_CMD); 1616 tlv->len = __cpu_to_le16(sizeof(*cmd)); 1617 cmd = (void *)tlv->value; 1618 cmd->opt = __cpu_to_le32(opt); 1619 1620 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv pdev suspend\n"); 1621 return skb; 1622 } 1623 1624 static struct sk_buff * 1625 ath10k_wmi_tlv_op_gen_pdev_resume(struct ath10k *ar) 1626 { 1627 struct wmi_tlv_resume_cmd *cmd; 1628 struct wmi_tlv *tlv; 1629 struct sk_buff *skb; 1630 1631 skb = ath10k_wmi_alloc_skb(ar, sizeof(*tlv) + sizeof(*cmd)); 1632 if (!skb) 1633 return ERR_PTR(-ENOMEM); 1634 1635 tlv = (void *)skb->data; 1636 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_PDEV_RESUME_CMD); 1637 tlv->len = __cpu_to_le16(sizeof(*cmd)); 1638 cmd = (void *)tlv->value; 1639 cmd->reserved = __cpu_to_le32(0); 1640 1641 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv pdev resume\n"); 1642 return skb; 1643 } 1644 1645 static struct sk_buff * 1646 ath10k_wmi_tlv_op_gen_pdev_set_rd(struct ath10k *ar, 1647 u16 rd, u16 rd2g, u16 rd5g, 1648 u16 ctl2g, u16 ctl5g, 1649 enum wmi_dfs_region dfs_reg) 1650 { 1651 struct wmi_tlv_pdev_set_rd_cmd *cmd; 1652 struct wmi_tlv *tlv; 1653 struct sk_buff *skb; 1654 1655 skb = ath10k_wmi_alloc_skb(ar, sizeof(*tlv) + sizeof(*cmd)); 1656 if (!skb) 1657 return ERR_PTR(-ENOMEM); 1658 1659 tlv = (void *)skb->data; 1660 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_PDEV_SET_REGDOMAIN_CMD); 1661 tlv->len = __cpu_to_le16(sizeof(*cmd)); 1662 cmd = (void *)tlv->value; 1663 cmd->regd = __cpu_to_le32(rd); 1664 cmd->regd_2ghz = __cpu_to_le32(rd2g); 1665 cmd->regd_5ghz = __cpu_to_le32(rd5g); 1666 cmd->conform_limit_2ghz = __cpu_to_le32(ctl2g); 1667 cmd->conform_limit_5ghz = __cpu_to_le32(ctl5g); 1668 1669 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv pdev set rd\n"); 1670 return skb; 1671 } 1672 1673 static enum wmi_txbf_conf ath10k_wmi_tlv_txbf_conf_scheme(struct ath10k *ar) 1674 { 1675 return WMI_TXBF_CONF_AFTER_ASSOC; 1676 } 1677 1678 static struct sk_buff * 1679 ath10k_wmi_tlv_op_gen_pdev_set_param(struct ath10k *ar, u32 param_id, 1680 u32 param_value) 1681 { 1682 struct wmi_tlv_pdev_set_param_cmd *cmd; 1683 struct wmi_tlv *tlv; 1684 struct sk_buff *skb; 1685 1686 skb = ath10k_wmi_alloc_skb(ar, sizeof(*tlv) + sizeof(*cmd)); 1687 if (!skb) 1688 return ERR_PTR(-ENOMEM); 1689 1690 tlv = (void *)skb->data; 1691 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_PDEV_SET_PARAM_CMD); 1692 tlv->len = __cpu_to_le16(sizeof(*cmd)); 1693 cmd = (void *)tlv->value; 1694 cmd->param_id = __cpu_to_le32(param_id); 1695 cmd->param_value = __cpu_to_le32(param_value); 1696 1697 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv pdev set param %d value 0x%x\n", 1698 param_id, param_value); 1699 return skb; 1700 } 1701 1702 static void 1703 ath10k_wmi_tlv_put_host_mem_chunks(struct ath10k *ar, void *host_mem_chunks) 1704 { 1705 struct host_memory_chunk_tlv *chunk; 1706 struct wmi_tlv *tlv; 1707 dma_addr_t paddr; 1708 int i; 1709 __le16 tlv_len, tlv_tag; 1710 1711 tlv_tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_WLAN_HOST_MEMORY_CHUNK); 1712 tlv_len = __cpu_to_le16(sizeof(*chunk)); 1713 for (i = 0; i < ar->wmi.num_mem_chunks; i++) { 1714 tlv = host_mem_chunks; 1715 tlv->tag = tlv_tag; 1716 tlv->len = tlv_len; 1717 chunk = (void *)tlv->value; 1718 1719 chunk->ptr = __cpu_to_le32(ar->wmi.mem_chunks[i].paddr); 1720 chunk->size = __cpu_to_le32(ar->wmi.mem_chunks[i].len); 1721 chunk->req_id = __cpu_to_le32(ar->wmi.mem_chunks[i].req_id); 1722 1723 if (test_bit(WMI_SERVICE_SUPPORT_EXTEND_ADDRESS, 1724 ar->wmi.svc_map)) { 1725 paddr = ar->wmi.mem_chunks[i].paddr; 1726 chunk->ptr_high = __cpu_to_le32(upper_32_bits(paddr)); 1727 } 1728 1729 ath10k_dbg(ar, ATH10K_DBG_WMI, 1730 "wmi-tlv chunk %d len %d, addr 0x%llx, id 0x%x\n", 1731 i, 1732 ar->wmi.mem_chunks[i].len, 1733 (unsigned long long)ar->wmi.mem_chunks[i].paddr, 1734 ar->wmi.mem_chunks[i].req_id); 1735 1736 host_mem_chunks += sizeof(*tlv); 1737 host_mem_chunks += sizeof(*chunk); 1738 } 1739 } 1740 1741 static struct sk_buff *ath10k_wmi_tlv_op_gen_init(struct ath10k *ar) 1742 { 1743 struct sk_buff *skb; 1744 struct wmi_tlv *tlv; 1745 struct wmi_tlv_init_cmd *cmd; 1746 struct wmi_tlv_resource_config *cfg; 1747 void *chunks; 1748 size_t len, chunks_len; 1749 void *ptr; 1750 1751 chunks_len = ar->wmi.num_mem_chunks * 1752 (sizeof(struct host_memory_chunk_tlv) + sizeof(*tlv)); 1753 len = (sizeof(*tlv) + sizeof(*cmd)) + 1754 (sizeof(*tlv) + sizeof(*cfg)) + 1755 (sizeof(*tlv) + chunks_len); 1756 1757 skb = ath10k_wmi_alloc_skb(ar, len); 1758 if (!skb) 1759 return ERR_PTR(-ENOMEM); 1760 1761 ptr = skb->data; 1762 1763 tlv = ptr; 1764 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_INIT_CMD); 1765 tlv->len = __cpu_to_le16(sizeof(*cmd)); 1766 cmd = (void *)tlv->value; 1767 ptr += sizeof(*tlv); 1768 ptr += sizeof(*cmd); 1769 1770 tlv = ptr; 1771 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_RESOURCE_CONFIG); 1772 tlv->len = __cpu_to_le16(sizeof(*cfg)); 1773 cfg = (void *)tlv->value; 1774 ptr += sizeof(*tlv); 1775 ptr += sizeof(*cfg); 1776 1777 tlv = ptr; 1778 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_STRUCT); 1779 tlv->len = __cpu_to_le16(chunks_len); 1780 chunks = (void *)tlv->value; 1781 1782 ptr += sizeof(*tlv); 1783 ptr += chunks_len; 1784 1785 cmd->abi.abi_ver0 = __cpu_to_le32(WMI_TLV_ABI_VER0); 1786 cmd->abi.abi_ver1 = __cpu_to_le32(WMI_TLV_ABI_VER1); 1787 cmd->abi.abi_ver_ns0 = __cpu_to_le32(WMI_TLV_ABI_VER_NS0); 1788 cmd->abi.abi_ver_ns1 = __cpu_to_le32(WMI_TLV_ABI_VER_NS1); 1789 cmd->abi.abi_ver_ns2 = __cpu_to_le32(WMI_TLV_ABI_VER_NS2); 1790 cmd->abi.abi_ver_ns3 = __cpu_to_le32(WMI_TLV_ABI_VER_NS3); 1791 cmd->num_host_mem_chunks = __cpu_to_le32(ar->wmi.num_mem_chunks); 1792 1793 cfg->num_vdevs = __cpu_to_le32(TARGET_TLV_NUM_VDEVS); 1794 1795 if (ar->hw_params.num_peers) 1796 cfg->num_peers = __cpu_to_le32(ar->hw_params.num_peers); 1797 else 1798 cfg->num_peers = __cpu_to_le32(TARGET_TLV_NUM_PEERS); 1799 cfg->ast_skid_limit = __cpu_to_le32(ar->hw_params.ast_skid_limit); 1800 cfg->num_wds_entries = __cpu_to_le32(ar->hw_params.num_wds_entries); 1801 1802 if (test_bit(WMI_SERVICE_RX_FULL_REORDER, ar->wmi.svc_map)) { 1803 cfg->num_offload_peers = __cpu_to_le32(TARGET_TLV_NUM_VDEVS); 1804 cfg->num_offload_reorder_bufs = __cpu_to_le32(TARGET_TLV_NUM_VDEVS); 1805 } else { 1806 cfg->num_offload_peers = __cpu_to_le32(0); 1807 cfg->num_offload_reorder_bufs = __cpu_to_le32(0); 1808 } 1809 1810 cfg->num_peer_keys = __cpu_to_le32(2); 1811 if (ar->hw_params.num_peers) 1812 cfg->num_tids = __cpu_to_le32(ar->hw_params.num_peers * 2); 1813 else 1814 cfg->num_tids = __cpu_to_le32(TARGET_TLV_NUM_TIDS); 1815 cfg->tx_chain_mask = __cpu_to_le32(0x7); 1816 cfg->rx_chain_mask = __cpu_to_le32(0x7); 1817 cfg->rx_timeout_pri[0] = __cpu_to_le32(0x64); 1818 cfg->rx_timeout_pri[1] = __cpu_to_le32(0x64); 1819 cfg->rx_timeout_pri[2] = __cpu_to_le32(0x64); 1820 cfg->rx_timeout_pri[3] = __cpu_to_le32(0x28); 1821 cfg->rx_decap_mode = __cpu_to_le32(ar->wmi.rx_decap_mode); 1822 cfg->scan_max_pending_reqs = __cpu_to_le32(4); 1823 cfg->bmiss_offload_max_vdev = __cpu_to_le32(TARGET_TLV_NUM_VDEVS); 1824 cfg->roam_offload_max_vdev = __cpu_to_le32(TARGET_TLV_NUM_VDEVS); 1825 cfg->roam_offload_max_ap_profiles = __cpu_to_le32(8); 1826 cfg->num_mcast_groups = __cpu_to_le32(0); 1827 cfg->num_mcast_table_elems = __cpu_to_le32(0); 1828 cfg->mcast2ucast_mode = __cpu_to_le32(0); 1829 cfg->tx_dbg_log_size = __cpu_to_le32(0x400); 1830 cfg->dma_burst_size = __cpu_to_le32(0); 1831 cfg->mac_aggr_delim = __cpu_to_le32(0); 1832 cfg->rx_skip_defrag_timeout_dup_detection_check = __cpu_to_le32(0); 1833 cfg->vow_config = __cpu_to_le32(0); 1834 cfg->gtk_offload_max_vdev = __cpu_to_le32(2); 1835 cfg->num_msdu_desc = __cpu_to_le32(ar->htt.max_num_pending_tx); 1836 cfg->max_frag_entries = __cpu_to_le32(2); 1837 cfg->num_tdls_vdevs = __cpu_to_le32(TARGET_TLV_NUM_TDLS_VDEVS); 1838 cfg->num_tdls_conn_table_entries = __cpu_to_le32(0x20); 1839 cfg->beacon_tx_offload_max_vdev = __cpu_to_le32(2); 1840 cfg->num_multicast_filter_entries = __cpu_to_le32(5); 1841 cfg->num_wow_filters = __cpu_to_le32(ar->wow.max_num_patterns); 1842 cfg->num_keep_alive_pattern = __cpu_to_le32(6); 1843 cfg->keep_alive_pattern_size = __cpu_to_le32(0); 1844 cfg->max_tdls_concurrent_sleep_sta = __cpu_to_le32(1); 1845 cfg->max_tdls_concurrent_buffer_sta = __cpu_to_le32(1); 1846 cfg->wmi_send_separate = __cpu_to_le32(0); 1847 cfg->num_ocb_vdevs = __cpu_to_le32(0); 1848 cfg->num_ocb_channels = __cpu_to_le32(0); 1849 cfg->num_ocb_schedules = __cpu_to_le32(0); 1850 cfg->host_capab = __cpu_to_le32(WMI_TLV_FLAG_MGMT_BUNDLE_TX_COMPL); 1851 1852 if (test_bit(WMI_SERVICE_TX_DATA_ACK_RSSI, ar->wmi.svc_map)) 1853 cfg->host_capab |= __cpu_to_le32(WMI_RSRC_CFG_FLAG_TX_ACK_RSSI); 1854 1855 ath10k_wmi_tlv_put_host_mem_chunks(ar, chunks); 1856 1857 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv init\n"); 1858 return skb; 1859 } 1860 1861 static struct sk_buff * 1862 ath10k_wmi_tlv_op_gen_start_scan(struct ath10k *ar, 1863 const struct wmi_start_scan_arg *arg) 1864 { 1865 struct wmi_tlv_start_scan_cmd *cmd; 1866 struct wmi_tlv *tlv; 1867 struct sk_buff *skb; 1868 size_t len, chan_len, ssid_len, bssid_len, ie_len; 1869 __le32 *chans; 1870 struct wmi_ssid *ssids; 1871 struct wmi_mac_addr *addrs; 1872 void *ptr; 1873 int i, ret; 1874 1875 ret = ath10k_wmi_start_scan_verify(arg); 1876 if (ret) 1877 return ERR_PTR(ret); 1878 1879 chan_len = arg->n_channels * sizeof(__le32); 1880 ssid_len = arg->n_ssids * sizeof(struct wmi_ssid); 1881 bssid_len = arg->n_bssids * sizeof(struct wmi_mac_addr); 1882 ie_len = roundup(arg->ie_len, 4); 1883 len = (sizeof(*tlv) + sizeof(*cmd)) + 1884 sizeof(*tlv) + chan_len + 1885 sizeof(*tlv) + ssid_len + 1886 sizeof(*tlv) + bssid_len + 1887 sizeof(*tlv) + ie_len; 1888 1889 skb = ath10k_wmi_alloc_skb(ar, len); 1890 if (!skb) 1891 return ERR_PTR(-ENOMEM); 1892 1893 ptr = (void *)skb->data; 1894 tlv = ptr; 1895 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_START_SCAN_CMD); 1896 tlv->len = __cpu_to_le16(sizeof(*cmd)); 1897 cmd = (void *)tlv->value; 1898 1899 ath10k_wmi_put_start_scan_common(&cmd->common, arg); 1900 cmd->burst_duration_ms = __cpu_to_le32(arg->burst_duration_ms); 1901 cmd->num_channels = __cpu_to_le32(arg->n_channels); 1902 cmd->num_ssids = __cpu_to_le32(arg->n_ssids); 1903 cmd->num_bssids = __cpu_to_le32(arg->n_bssids); 1904 cmd->ie_len = __cpu_to_le32(arg->ie_len); 1905 cmd->num_probes = __cpu_to_le32(3); 1906 ether_addr_copy(cmd->mac_addr.addr, arg->mac_addr.addr); 1907 ether_addr_copy(cmd->mac_mask.addr, arg->mac_mask.addr); 1908 1909 /* FIXME: There are some scan flag inconsistencies across firmwares, 1910 * e.g. WMI-TLV inverts the logic behind the following flag. 1911 */ 1912 cmd->common.scan_ctrl_flags ^= __cpu_to_le32(WMI_SCAN_FILTER_PROBE_REQ); 1913 1914 ptr += sizeof(*tlv); 1915 ptr += sizeof(*cmd); 1916 1917 tlv = ptr; 1918 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_UINT32); 1919 tlv->len = __cpu_to_le16(chan_len); 1920 chans = (void *)tlv->value; 1921 for (i = 0; i < arg->n_channels; i++) 1922 chans[i] = __cpu_to_le32(arg->channels[i]); 1923 1924 ptr += sizeof(*tlv); 1925 ptr += chan_len; 1926 1927 tlv = ptr; 1928 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_FIXED_STRUCT); 1929 tlv->len = __cpu_to_le16(ssid_len); 1930 ssids = (void *)tlv->value; 1931 for (i = 0; i < arg->n_ssids; i++) { 1932 ssids[i].ssid_len = __cpu_to_le32(arg->ssids[i].len); 1933 memcpy(ssids[i].ssid, arg->ssids[i].ssid, arg->ssids[i].len); 1934 } 1935 1936 ptr += sizeof(*tlv); 1937 ptr += ssid_len; 1938 1939 tlv = ptr; 1940 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_FIXED_STRUCT); 1941 tlv->len = __cpu_to_le16(bssid_len); 1942 addrs = (void *)tlv->value; 1943 for (i = 0; i < arg->n_bssids; i++) 1944 ether_addr_copy(addrs[i].addr, arg->bssids[i].bssid); 1945 1946 ptr += sizeof(*tlv); 1947 ptr += bssid_len; 1948 1949 tlv = ptr; 1950 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_BYTE); 1951 tlv->len = __cpu_to_le16(ie_len); 1952 memcpy(tlv->value, arg->ie, arg->ie_len); 1953 1954 ptr += sizeof(*tlv); 1955 ptr += ie_len; 1956 1957 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv start scan\n"); 1958 return skb; 1959 } 1960 1961 static struct sk_buff * 1962 ath10k_wmi_tlv_op_gen_stop_scan(struct ath10k *ar, 1963 const struct wmi_stop_scan_arg *arg) 1964 { 1965 struct wmi_stop_scan_cmd *cmd; 1966 struct wmi_tlv *tlv; 1967 struct sk_buff *skb; 1968 u32 scan_id; 1969 u32 req_id; 1970 1971 if (arg->req_id > 0xFFF) 1972 return ERR_PTR(-EINVAL); 1973 if (arg->req_type == WMI_SCAN_STOP_ONE && arg->u.scan_id > 0xFFF) 1974 return ERR_PTR(-EINVAL); 1975 1976 skb = ath10k_wmi_alloc_skb(ar, sizeof(*tlv) + sizeof(*cmd)); 1977 if (!skb) 1978 return ERR_PTR(-ENOMEM); 1979 1980 scan_id = arg->u.scan_id; 1981 scan_id |= WMI_HOST_SCAN_REQ_ID_PREFIX; 1982 1983 req_id = arg->req_id; 1984 req_id |= WMI_HOST_SCAN_REQUESTOR_ID_PREFIX; 1985 1986 tlv = (void *)skb->data; 1987 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_STOP_SCAN_CMD); 1988 tlv->len = __cpu_to_le16(sizeof(*cmd)); 1989 cmd = (void *)tlv->value; 1990 cmd->req_type = __cpu_to_le32(arg->req_type); 1991 cmd->vdev_id = __cpu_to_le32(arg->u.vdev_id); 1992 cmd->scan_id = __cpu_to_le32(scan_id); 1993 cmd->scan_req_id = __cpu_to_le32(req_id); 1994 1995 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv stop scan\n"); 1996 return skb; 1997 } 1998 1999 static int ath10k_wmi_tlv_op_get_vdev_subtype(struct ath10k *ar, 2000 enum wmi_vdev_subtype subtype) 2001 { 2002 switch (subtype) { 2003 case WMI_VDEV_SUBTYPE_NONE: 2004 return WMI_TLV_VDEV_SUBTYPE_NONE; 2005 case WMI_VDEV_SUBTYPE_P2P_DEVICE: 2006 return WMI_TLV_VDEV_SUBTYPE_P2P_DEV; 2007 case WMI_VDEV_SUBTYPE_P2P_CLIENT: 2008 return WMI_TLV_VDEV_SUBTYPE_P2P_CLI; 2009 case WMI_VDEV_SUBTYPE_P2P_GO: 2010 return WMI_TLV_VDEV_SUBTYPE_P2P_GO; 2011 case WMI_VDEV_SUBTYPE_PROXY_STA: 2012 return WMI_TLV_VDEV_SUBTYPE_PROXY_STA; 2013 case WMI_VDEV_SUBTYPE_MESH_11S: 2014 return WMI_TLV_VDEV_SUBTYPE_MESH_11S; 2015 case WMI_VDEV_SUBTYPE_MESH_NON_11S: 2016 return -ENOTSUPP; 2017 } 2018 return -ENOTSUPP; 2019 } 2020 2021 static struct sk_buff * 2022 ath10k_wmi_tlv_op_gen_vdev_create(struct ath10k *ar, 2023 u32 vdev_id, 2024 enum wmi_vdev_type vdev_type, 2025 enum wmi_vdev_subtype vdev_subtype, 2026 const u8 mac_addr[ETH_ALEN]) 2027 { 2028 struct wmi_vdev_create_cmd *cmd; 2029 struct wmi_tlv *tlv; 2030 struct sk_buff *skb; 2031 2032 skb = ath10k_wmi_alloc_skb(ar, sizeof(*tlv) + sizeof(*cmd)); 2033 if (!skb) 2034 return ERR_PTR(-ENOMEM); 2035 2036 tlv = (void *)skb->data; 2037 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_VDEV_CREATE_CMD); 2038 tlv->len = __cpu_to_le16(sizeof(*cmd)); 2039 cmd = (void *)tlv->value; 2040 cmd->vdev_id = __cpu_to_le32(vdev_id); 2041 cmd->vdev_type = __cpu_to_le32(vdev_type); 2042 cmd->vdev_subtype = __cpu_to_le32(vdev_subtype); 2043 ether_addr_copy(cmd->vdev_macaddr.addr, mac_addr); 2044 2045 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv vdev create\n"); 2046 return skb; 2047 } 2048 2049 static struct sk_buff * 2050 ath10k_wmi_tlv_op_gen_vdev_delete(struct ath10k *ar, u32 vdev_id) 2051 { 2052 struct wmi_vdev_delete_cmd *cmd; 2053 struct wmi_tlv *tlv; 2054 struct sk_buff *skb; 2055 2056 skb = ath10k_wmi_alloc_skb(ar, sizeof(*tlv) + sizeof(*cmd)); 2057 if (!skb) 2058 return ERR_PTR(-ENOMEM); 2059 2060 tlv = (void *)skb->data; 2061 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_VDEV_DELETE_CMD); 2062 tlv->len = __cpu_to_le16(sizeof(*cmd)); 2063 cmd = (void *)tlv->value; 2064 cmd->vdev_id = __cpu_to_le32(vdev_id); 2065 2066 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv vdev delete\n"); 2067 return skb; 2068 } 2069 2070 static struct sk_buff * 2071 ath10k_wmi_tlv_op_gen_vdev_start(struct ath10k *ar, 2072 const struct wmi_vdev_start_request_arg *arg, 2073 bool restart) 2074 { 2075 struct wmi_tlv_vdev_start_cmd *cmd; 2076 struct wmi_channel *ch; 2077 struct wmi_tlv *tlv; 2078 struct sk_buff *skb; 2079 size_t len; 2080 void *ptr; 2081 u32 flags = 0; 2082 2083 if (WARN_ON(arg->hidden_ssid && !arg->ssid)) 2084 return ERR_PTR(-EINVAL); 2085 if (WARN_ON(arg->ssid_len > sizeof(cmd->ssid.ssid))) 2086 return ERR_PTR(-EINVAL); 2087 2088 len = (sizeof(*tlv) + sizeof(*cmd)) + 2089 (sizeof(*tlv) + sizeof(*ch)) + 2090 (sizeof(*tlv) + 0); 2091 skb = ath10k_wmi_alloc_skb(ar, len); 2092 if (!skb) 2093 return ERR_PTR(-ENOMEM); 2094 2095 if (arg->hidden_ssid) 2096 flags |= WMI_VDEV_START_HIDDEN_SSID; 2097 if (arg->pmf_enabled) 2098 flags |= WMI_VDEV_START_PMF_ENABLED; 2099 2100 ptr = (void *)skb->data; 2101 2102 tlv = ptr; 2103 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_VDEV_START_REQUEST_CMD); 2104 tlv->len = __cpu_to_le16(sizeof(*cmd)); 2105 cmd = (void *)tlv->value; 2106 cmd->vdev_id = __cpu_to_le32(arg->vdev_id); 2107 cmd->bcn_intval = __cpu_to_le32(arg->bcn_intval); 2108 cmd->dtim_period = __cpu_to_le32(arg->dtim_period); 2109 cmd->flags = __cpu_to_le32(flags); 2110 cmd->bcn_tx_rate = __cpu_to_le32(arg->bcn_tx_rate); 2111 cmd->bcn_tx_power = __cpu_to_le32(arg->bcn_tx_power); 2112 cmd->disable_hw_ack = __cpu_to_le32(arg->disable_hw_ack); 2113 2114 if (arg->ssid) { 2115 cmd->ssid.ssid_len = __cpu_to_le32(arg->ssid_len); 2116 memcpy(cmd->ssid.ssid, arg->ssid, arg->ssid_len); 2117 } 2118 2119 ptr += sizeof(*tlv); 2120 ptr += sizeof(*cmd); 2121 2122 tlv = ptr; 2123 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_CHANNEL); 2124 tlv->len = __cpu_to_le16(sizeof(*ch)); 2125 ch = (void *)tlv->value; 2126 ath10k_wmi_put_wmi_channel(ch, &arg->channel); 2127 2128 ptr += sizeof(*tlv); 2129 ptr += sizeof(*ch); 2130 2131 tlv = ptr; 2132 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_STRUCT); 2133 tlv->len = 0; 2134 2135 /* Note: This is a nested TLV containing: 2136 * [wmi_tlv][wmi_p2p_noa_descriptor][wmi_tlv].. 2137 */ 2138 2139 ptr += sizeof(*tlv); 2140 ptr += 0; 2141 2142 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv vdev start\n"); 2143 return skb; 2144 } 2145 2146 static struct sk_buff * 2147 ath10k_wmi_tlv_op_gen_vdev_stop(struct ath10k *ar, u32 vdev_id) 2148 { 2149 struct wmi_vdev_stop_cmd *cmd; 2150 struct wmi_tlv *tlv; 2151 struct sk_buff *skb; 2152 2153 skb = ath10k_wmi_alloc_skb(ar, sizeof(*tlv) + sizeof(*cmd)); 2154 if (!skb) 2155 return ERR_PTR(-ENOMEM); 2156 2157 tlv = (void *)skb->data; 2158 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_VDEV_STOP_CMD); 2159 tlv->len = __cpu_to_le16(sizeof(*cmd)); 2160 cmd = (void *)tlv->value; 2161 cmd->vdev_id = __cpu_to_le32(vdev_id); 2162 2163 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv vdev stop\n"); 2164 return skb; 2165 } 2166 2167 static struct sk_buff * 2168 ath10k_wmi_tlv_op_gen_vdev_up(struct ath10k *ar, u32 vdev_id, u32 aid, 2169 const u8 *bssid) 2170 2171 { 2172 struct wmi_vdev_up_cmd *cmd; 2173 struct wmi_tlv *tlv; 2174 struct sk_buff *skb; 2175 2176 skb = ath10k_wmi_alloc_skb(ar, sizeof(*tlv) + sizeof(*cmd)); 2177 if (!skb) 2178 return ERR_PTR(-ENOMEM); 2179 2180 tlv = (void *)skb->data; 2181 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_VDEV_UP_CMD); 2182 tlv->len = __cpu_to_le16(sizeof(*cmd)); 2183 cmd = (void *)tlv->value; 2184 cmd->vdev_id = __cpu_to_le32(vdev_id); 2185 cmd->vdev_assoc_id = __cpu_to_le32(aid); 2186 ether_addr_copy(cmd->vdev_bssid.addr, bssid); 2187 2188 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv vdev up\n"); 2189 return skb; 2190 } 2191 2192 static struct sk_buff * 2193 ath10k_wmi_tlv_op_gen_vdev_down(struct ath10k *ar, u32 vdev_id) 2194 { 2195 struct wmi_vdev_down_cmd *cmd; 2196 struct wmi_tlv *tlv; 2197 struct sk_buff *skb; 2198 2199 skb = ath10k_wmi_alloc_skb(ar, sizeof(*tlv) + sizeof(*cmd)); 2200 if (!skb) 2201 return ERR_PTR(-ENOMEM); 2202 2203 tlv = (void *)skb->data; 2204 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_VDEV_DOWN_CMD); 2205 tlv->len = __cpu_to_le16(sizeof(*cmd)); 2206 cmd = (void *)tlv->value; 2207 cmd->vdev_id = __cpu_to_le32(vdev_id); 2208 2209 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv vdev down\n"); 2210 return skb; 2211 } 2212 2213 static struct sk_buff * 2214 ath10k_wmi_tlv_op_gen_vdev_set_param(struct ath10k *ar, u32 vdev_id, 2215 u32 param_id, u32 param_value) 2216 { 2217 struct wmi_vdev_set_param_cmd *cmd; 2218 struct wmi_tlv *tlv; 2219 struct sk_buff *skb; 2220 2221 skb = ath10k_wmi_alloc_skb(ar, sizeof(*tlv) + sizeof(*cmd)); 2222 if (!skb) 2223 return ERR_PTR(-ENOMEM); 2224 2225 tlv = (void *)skb->data; 2226 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_VDEV_SET_PARAM_CMD); 2227 tlv->len = __cpu_to_le16(sizeof(*cmd)); 2228 cmd = (void *)tlv->value; 2229 cmd->vdev_id = __cpu_to_le32(vdev_id); 2230 cmd->param_id = __cpu_to_le32(param_id); 2231 cmd->param_value = __cpu_to_le32(param_value); 2232 2233 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv vdev %d set param %d value 0x%x\n", 2234 vdev_id, param_id, param_value); 2235 return skb; 2236 } 2237 2238 static struct sk_buff * 2239 ath10k_wmi_tlv_op_gen_vdev_install_key(struct ath10k *ar, 2240 const struct wmi_vdev_install_key_arg *arg) 2241 { 2242 struct wmi_vdev_install_key_cmd *cmd; 2243 struct wmi_tlv *tlv; 2244 struct sk_buff *skb; 2245 size_t len; 2246 void *ptr; 2247 2248 if (arg->key_cipher == ar->wmi_key_cipher[WMI_CIPHER_NONE] && 2249 arg->key_data) 2250 return ERR_PTR(-EINVAL); 2251 if (arg->key_cipher != ar->wmi_key_cipher[WMI_CIPHER_NONE] && 2252 !arg->key_data) 2253 return ERR_PTR(-EINVAL); 2254 2255 len = sizeof(*tlv) + sizeof(*cmd) + 2256 sizeof(*tlv) + roundup(arg->key_len, sizeof(__le32)); 2257 skb = ath10k_wmi_alloc_skb(ar, len); 2258 if (!skb) 2259 return ERR_PTR(-ENOMEM); 2260 2261 ptr = (void *)skb->data; 2262 tlv = ptr; 2263 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_VDEV_INSTALL_KEY_CMD); 2264 tlv->len = __cpu_to_le16(sizeof(*cmd)); 2265 cmd = (void *)tlv->value; 2266 cmd->vdev_id = __cpu_to_le32(arg->vdev_id); 2267 cmd->key_idx = __cpu_to_le32(arg->key_idx); 2268 cmd->key_flags = __cpu_to_le32(arg->key_flags); 2269 cmd->key_cipher = __cpu_to_le32(arg->key_cipher); 2270 cmd->key_len = __cpu_to_le32(arg->key_len); 2271 cmd->key_txmic_len = __cpu_to_le32(arg->key_txmic_len); 2272 cmd->key_rxmic_len = __cpu_to_le32(arg->key_rxmic_len); 2273 2274 if (arg->macaddr) 2275 ether_addr_copy(cmd->peer_macaddr.addr, arg->macaddr); 2276 2277 ptr += sizeof(*tlv); 2278 ptr += sizeof(*cmd); 2279 2280 tlv = ptr; 2281 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_BYTE); 2282 tlv->len = __cpu_to_le16(roundup(arg->key_len, sizeof(__le32))); 2283 if (arg->key_data) 2284 memcpy(tlv->value, arg->key_data, arg->key_len); 2285 2286 ptr += sizeof(*tlv); 2287 ptr += roundup(arg->key_len, sizeof(__le32)); 2288 2289 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv vdev install key\n"); 2290 return skb; 2291 } 2292 2293 static void *ath10k_wmi_tlv_put_uapsd_ac(struct ath10k *ar, void *ptr, 2294 const struct wmi_sta_uapsd_auto_trig_arg *arg) 2295 { 2296 struct wmi_sta_uapsd_auto_trig_param *ac; 2297 struct wmi_tlv *tlv; 2298 2299 tlv = ptr; 2300 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_STA_UAPSD_AUTO_TRIG_PARAM); 2301 tlv->len = __cpu_to_le16(sizeof(*ac)); 2302 ac = (void *)tlv->value; 2303 2304 ac->wmm_ac = __cpu_to_le32(arg->wmm_ac); 2305 ac->user_priority = __cpu_to_le32(arg->user_priority); 2306 ac->service_interval = __cpu_to_le32(arg->service_interval); 2307 ac->suspend_interval = __cpu_to_le32(arg->suspend_interval); 2308 ac->delay_interval = __cpu_to_le32(arg->delay_interval); 2309 2310 ath10k_dbg(ar, ATH10K_DBG_WMI, 2311 "wmi tlv vdev sta uapsd auto trigger ac %d prio %d svc int %d susp int %d delay int %d\n", 2312 ac->wmm_ac, ac->user_priority, ac->service_interval, 2313 ac->suspend_interval, ac->delay_interval); 2314 2315 return ptr + sizeof(*tlv) + sizeof(*ac); 2316 } 2317 2318 static struct sk_buff * 2319 ath10k_wmi_tlv_op_gen_vdev_sta_uapsd(struct ath10k *ar, u32 vdev_id, 2320 const u8 peer_addr[ETH_ALEN], 2321 const struct wmi_sta_uapsd_auto_trig_arg *args, 2322 u32 num_ac) 2323 { 2324 struct wmi_sta_uapsd_auto_trig_cmd_fixed_param *cmd; 2325 struct wmi_sta_uapsd_auto_trig_param *ac; 2326 struct wmi_tlv *tlv; 2327 struct sk_buff *skb; 2328 size_t len; 2329 size_t ac_tlv_len; 2330 void *ptr; 2331 int i; 2332 2333 ac_tlv_len = num_ac * (sizeof(*tlv) + sizeof(*ac)); 2334 len = sizeof(*tlv) + sizeof(*cmd) + 2335 sizeof(*tlv) + ac_tlv_len; 2336 skb = ath10k_wmi_alloc_skb(ar, len); 2337 if (!skb) 2338 return ERR_PTR(-ENOMEM); 2339 2340 ptr = (void *)skb->data; 2341 tlv = ptr; 2342 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_STA_UAPSD_AUTO_TRIG_CMD); 2343 tlv->len = __cpu_to_le16(sizeof(*cmd)); 2344 cmd = (void *)tlv->value; 2345 cmd->vdev_id = __cpu_to_le32(vdev_id); 2346 cmd->num_ac = __cpu_to_le32(num_ac); 2347 ether_addr_copy(cmd->peer_macaddr.addr, peer_addr); 2348 2349 ptr += sizeof(*tlv); 2350 ptr += sizeof(*cmd); 2351 2352 tlv = ptr; 2353 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_STRUCT); 2354 tlv->len = __cpu_to_le16(ac_tlv_len); 2355 ac = (void *)tlv->value; 2356 2357 ptr += sizeof(*tlv); 2358 for (i = 0; i < num_ac; i++) 2359 ptr = ath10k_wmi_tlv_put_uapsd_ac(ar, ptr, &args[i]); 2360 2361 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv vdev sta uapsd auto trigger\n"); 2362 return skb; 2363 } 2364 2365 static void *ath10k_wmi_tlv_put_wmm(void *ptr, 2366 const struct wmi_wmm_params_arg *arg) 2367 { 2368 struct wmi_wmm_params *wmm; 2369 struct wmi_tlv *tlv; 2370 2371 tlv = ptr; 2372 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_WMM_PARAMS); 2373 tlv->len = __cpu_to_le16(sizeof(*wmm)); 2374 wmm = (void *)tlv->value; 2375 ath10k_wmi_set_wmm_param(wmm, arg); 2376 2377 return ptr + sizeof(*tlv) + sizeof(*wmm); 2378 } 2379 2380 static struct sk_buff * 2381 ath10k_wmi_tlv_op_gen_vdev_wmm_conf(struct ath10k *ar, u32 vdev_id, 2382 const struct wmi_wmm_params_all_arg *arg) 2383 { 2384 struct wmi_tlv_vdev_set_wmm_cmd *cmd; 2385 struct wmi_tlv *tlv; 2386 struct sk_buff *skb; 2387 size_t len; 2388 void *ptr; 2389 2390 len = sizeof(*tlv) + sizeof(*cmd); 2391 skb = ath10k_wmi_alloc_skb(ar, len); 2392 if (!skb) 2393 return ERR_PTR(-ENOMEM); 2394 2395 ptr = (void *)skb->data; 2396 tlv = ptr; 2397 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_VDEV_SET_WMM_PARAMS_CMD); 2398 tlv->len = __cpu_to_le16(sizeof(*cmd)); 2399 cmd = (void *)tlv->value; 2400 cmd->vdev_id = __cpu_to_le32(vdev_id); 2401 2402 ath10k_wmi_set_wmm_param(&cmd->vdev_wmm_params[0].params, &arg->ac_be); 2403 ath10k_wmi_set_wmm_param(&cmd->vdev_wmm_params[1].params, &arg->ac_bk); 2404 ath10k_wmi_set_wmm_param(&cmd->vdev_wmm_params[2].params, &arg->ac_vi); 2405 ath10k_wmi_set_wmm_param(&cmd->vdev_wmm_params[3].params, &arg->ac_vo); 2406 2407 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv vdev wmm conf\n"); 2408 return skb; 2409 } 2410 2411 static struct sk_buff * 2412 ath10k_wmi_tlv_op_gen_sta_keepalive(struct ath10k *ar, 2413 const struct wmi_sta_keepalive_arg *arg) 2414 { 2415 struct wmi_tlv_sta_keepalive_cmd *cmd; 2416 struct wmi_sta_keepalive_arp_resp *arp; 2417 struct sk_buff *skb; 2418 struct wmi_tlv *tlv; 2419 void *ptr; 2420 size_t len; 2421 2422 len = sizeof(*tlv) + sizeof(*cmd) + 2423 sizeof(*tlv) + sizeof(*arp); 2424 skb = ath10k_wmi_alloc_skb(ar, len); 2425 if (!skb) 2426 return ERR_PTR(-ENOMEM); 2427 2428 ptr = (void *)skb->data; 2429 tlv = ptr; 2430 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_STA_KEEPALIVE_CMD); 2431 tlv->len = __cpu_to_le16(sizeof(*cmd)); 2432 cmd = (void *)tlv->value; 2433 cmd->vdev_id = __cpu_to_le32(arg->vdev_id); 2434 cmd->enabled = __cpu_to_le32(arg->enabled); 2435 cmd->method = __cpu_to_le32(arg->method); 2436 cmd->interval = __cpu_to_le32(arg->interval); 2437 2438 ptr += sizeof(*tlv); 2439 ptr += sizeof(*cmd); 2440 2441 tlv = ptr; 2442 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_STA_KEEPALVE_ARP_RESPONSE); 2443 tlv->len = __cpu_to_le16(sizeof(*arp)); 2444 arp = (void *)tlv->value; 2445 2446 arp->src_ip4_addr = arg->src_ip4_addr; 2447 arp->dest_ip4_addr = arg->dest_ip4_addr; 2448 ether_addr_copy(arp->dest_mac_addr.addr, arg->dest_mac_addr); 2449 2450 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv sta keepalive vdev %d enabled %d method %d interval %d\n", 2451 arg->vdev_id, arg->enabled, arg->method, arg->interval); 2452 return skb; 2453 } 2454 2455 static struct sk_buff * 2456 ath10k_wmi_tlv_op_gen_peer_create(struct ath10k *ar, u32 vdev_id, 2457 const u8 peer_addr[ETH_ALEN], 2458 enum wmi_peer_type peer_type) 2459 { 2460 struct wmi_tlv_peer_create_cmd *cmd; 2461 struct wmi_tlv *tlv; 2462 struct sk_buff *skb; 2463 2464 skb = ath10k_wmi_alloc_skb(ar, sizeof(*tlv) + sizeof(*cmd)); 2465 if (!skb) 2466 return ERR_PTR(-ENOMEM); 2467 2468 tlv = (void *)skb->data; 2469 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_PEER_CREATE_CMD); 2470 tlv->len = __cpu_to_le16(sizeof(*cmd)); 2471 cmd = (void *)tlv->value; 2472 cmd->vdev_id = __cpu_to_le32(vdev_id); 2473 cmd->peer_type = __cpu_to_le32(peer_type); 2474 ether_addr_copy(cmd->peer_addr.addr, peer_addr); 2475 2476 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv peer create\n"); 2477 return skb; 2478 } 2479 2480 static struct sk_buff * 2481 ath10k_wmi_tlv_op_gen_peer_delete(struct ath10k *ar, u32 vdev_id, 2482 const u8 peer_addr[ETH_ALEN]) 2483 { 2484 struct wmi_peer_delete_cmd *cmd; 2485 struct wmi_tlv *tlv; 2486 struct sk_buff *skb; 2487 2488 skb = ath10k_wmi_alloc_skb(ar, sizeof(*tlv) + sizeof(*cmd)); 2489 if (!skb) 2490 return ERR_PTR(-ENOMEM); 2491 2492 tlv = (void *)skb->data; 2493 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_PEER_DELETE_CMD); 2494 tlv->len = __cpu_to_le16(sizeof(*cmd)); 2495 cmd = (void *)tlv->value; 2496 cmd->vdev_id = __cpu_to_le32(vdev_id); 2497 ether_addr_copy(cmd->peer_macaddr.addr, peer_addr); 2498 2499 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv peer delete\n"); 2500 return skb; 2501 } 2502 2503 static struct sk_buff * 2504 ath10k_wmi_tlv_op_gen_peer_flush(struct ath10k *ar, u32 vdev_id, 2505 const u8 peer_addr[ETH_ALEN], u32 tid_bitmap) 2506 { 2507 struct wmi_peer_flush_tids_cmd *cmd; 2508 struct wmi_tlv *tlv; 2509 struct sk_buff *skb; 2510 2511 skb = ath10k_wmi_alloc_skb(ar, sizeof(*tlv) + sizeof(*cmd)); 2512 if (!skb) 2513 return ERR_PTR(-ENOMEM); 2514 2515 tlv = (void *)skb->data; 2516 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_PEER_FLUSH_TIDS_CMD); 2517 tlv->len = __cpu_to_le16(sizeof(*cmd)); 2518 cmd = (void *)tlv->value; 2519 cmd->vdev_id = __cpu_to_le32(vdev_id); 2520 cmd->peer_tid_bitmap = __cpu_to_le32(tid_bitmap); 2521 ether_addr_copy(cmd->peer_macaddr.addr, peer_addr); 2522 2523 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv peer flush\n"); 2524 return skb; 2525 } 2526 2527 static struct sk_buff * 2528 ath10k_wmi_tlv_op_gen_peer_set_param(struct ath10k *ar, u32 vdev_id, 2529 const u8 *peer_addr, 2530 enum wmi_peer_param param_id, 2531 u32 param_value) 2532 { 2533 struct wmi_peer_set_param_cmd *cmd; 2534 struct wmi_tlv *tlv; 2535 struct sk_buff *skb; 2536 2537 skb = ath10k_wmi_alloc_skb(ar, sizeof(*tlv) + sizeof(*cmd)); 2538 if (!skb) 2539 return ERR_PTR(-ENOMEM); 2540 2541 tlv = (void *)skb->data; 2542 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_PEER_SET_PARAM_CMD); 2543 tlv->len = __cpu_to_le16(sizeof(*cmd)); 2544 cmd = (void *)tlv->value; 2545 cmd->vdev_id = __cpu_to_le32(vdev_id); 2546 cmd->param_id = __cpu_to_le32(param_id); 2547 cmd->param_value = __cpu_to_le32(param_value); 2548 ether_addr_copy(cmd->peer_macaddr.addr, peer_addr); 2549 2550 ath10k_dbg(ar, ATH10K_DBG_WMI, 2551 "wmi tlv vdev %d peer %pM set param %d value 0x%x\n", 2552 vdev_id, peer_addr, param_id, param_value); 2553 return skb; 2554 } 2555 2556 static struct sk_buff * 2557 ath10k_wmi_tlv_op_gen_peer_assoc(struct ath10k *ar, 2558 const struct wmi_peer_assoc_complete_arg *arg) 2559 { 2560 struct wmi_tlv_peer_assoc_cmd *cmd; 2561 struct wmi_vht_rate_set *vht_rate; 2562 struct wmi_tlv *tlv; 2563 struct sk_buff *skb; 2564 size_t len, legacy_rate_len, ht_rate_len; 2565 void *ptr; 2566 2567 if (arg->peer_mpdu_density > 16) 2568 return ERR_PTR(-EINVAL); 2569 if (arg->peer_legacy_rates.num_rates > MAX_SUPPORTED_RATES) 2570 return ERR_PTR(-EINVAL); 2571 if (arg->peer_ht_rates.num_rates > MAX_SUPPORTED_RATES) 2572 return ERR_PTR(-EINVAL); 2573 2574 legacy_rate_len = roundup(arg->peer_legacy_rates.num_rates, 2575 sizeof(__le32)); 2576 ht_rate_len = roundup(arg->peer_ht_rates.num_rates, sizeof(__le32)); 2577 len = (sizeof(*tlv) + sizeof(*cmd)) + 2578 (sizeof(*tlv) + legacy_rate_len) + 2579 (sizeof(*tlv) + ht_rate_len) + 2580 (sizeof(*tlv) + sizeof(*vht_rate)); 2581 skb = ath10k_wmi_alloc_skb(ar, len); 2582 if (!skb) 2583 return ERR_PTR(-ENOMEM); 2584 2585 ptr = (void *)skb->data; 2586 tlv = ptr; 2587 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_PEER_ASSOC_COMPLETE_CMD); 2588 tlv->len = __cpu_to_le16(sizeof(*cmd)); 2589 cmd = (void *)tlv->value; 2590 2591 cmd->vdev_id = __cpu_to_le32(arg->vdev_id); 2592 cmd->new_assoc = __cpu_to_le32(arg->peer_reassoc ? 0 : 1); 2593 cmd->assoc_id = __cpu_to_le32(arg->peer_aid); 2594 cmd->flags = __cpu_to_le32(arg->peer_flags); 2595 cmd->caps = __cpu_to_le32(arg->peer_caps); 2596 cmd->listen_intval = __cpu_to_le32(arg->peer_listen_intval); 2597 cmd->ht_caps = __cpu_to_le32(arg->peer_ht_caps); 2598 cmd->max_mpdu = __cpu_to_le32(arg->peer_max_mpdu); 2599 cmd->mpdu_density = __cpu_to_le32(arg->peer_mpdu_density); 2600 cmd->rate_caps = __cpu_to_le32(arg->peer_rate_caps); 2601 cmd->nss = __cpu_to_le32(arg->peer_num_spatial_streams); 2602 cmd->vht_caps = __cpu_to_le32(arg->peer_vht_caps); 2603 cmd->phy_mode = __cpu_to_le32(arg->peer_phymode); 2604 cmd->num_legacy_rates = __cpu_to_le32(arg->peer_legacy_rates.num_rates); 2605 cmd->num_ht_rates = __cpu_to_le32(arg->peer_ht_rates.num_rates); 2606 ether_addr_copy(cmd->mac_addr.addr, arg->addr); 2607 2608 ptr += sizeof(*tlv); 2609 ptr += sizeof(*cmd); 2610 2611 tlv = ptr; 2612 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_BYTE); 2613 tlv->len = __cpu_to_le16(legacy_rate_len); 2614 memcpy(tlv->value, arg->peer_legacy_rates.rates, 2615 arg->peer_legacy_rates.num_rates); 2616 2617 ptr += sizeof(*tlv); 2618 ptr += legacy_rate_len; 2619 2620 tlv = ptr; 2621 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_BYTE); 2622 tlv->len = __cpu_to_le16(ht_rate_len); 2623 memcpy(tlv->value, arg->peer_ht_rates.rates, 2624 arg->peer_ht_rates.num_rates); 2625 2626 ptr += sizeof(*tlv); 2627 ptr += ht_rate_len; 2628 2629 tlv = ptr; 2630 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_VHT_RATE_SET); 2631 tlv->len = __cpu_to_le16(sizeof(*vht_rate)); 2632 vht_rate = (void *)tlv->value; 2633 2634 vht_rate->rx_max_rate = __cpu_to_le32(arg->peer_vht_rates.rx_max_rate); 2635 vht_rate->rx_mcs_set = __cpu_to_le32(arg->peer_vht_rates.rx_mcs_set); 2636 vht_rate->tx_max_rate = __cpu_to_le32(arg->peer_vht_rates.tx_max_rate); 2637 vht_rate->tx_mcs_set = __cpu_to_le32(arg->peer_vht_rates.tx_mcs_set); 2638 2639 ptr += sizeof(*tlv); 2640 ptr += sizeof(*vht_rate); 2641 2642 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv peer assoc\n"); 2643 return skb; 2644 } 2645 2646 static struct sk_buff * 2647 ath10k_wmi_tlv_op_gen_set_psmode(struct ath10k *ar, u32 vdev_id, 2648 enum wmi_sta_ps_mode psmode) 2649 { 2650 struct wmi_sta_powersave_mode_cmd *cmd; 2651 struct wmi_tlv *tlv; 2652 struct sk_buff *skb; 2653 2654 skb = ath10k_wmi_alloc_skb(ar, sizeof(*tlv) + sizeof(*cmd)); 2655 if (!skb) 2656 return ERR_PTR(-ENOMEM); 2657 2658 tlv = (void *)skb->data; 2659 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_STA_POWERSAVE_MODE_CMD); 2660 tlv->len = __cpu_to_le16(sizeof(*cmd)); 2661 cmd = (void *)tlv->value; 2662 cmd->vdev_id = __cpu_to_le32(vdev_id); 2663 cmd->sta_ps_mode = __cpu_to_le32(psmode); 2664 2665 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv set psmode\n"); 2666 return skb; 2667 } 2668 2669 static struct sk_buff * 2670 ath10k_wmi_tlv_op_gen_set_sta_ps(struct ath10k *ar, u32 vdev_id, 2671 enum wmi_sta_powersave_param param_id, 2672 u32 param_value) 2673 { 2674 struct wmi_sta_powersave_param_cmd *cmd; 2675 struct wmi_tlv *tlv; 2676 struct sk_buff *skb; 2677 2678 skb = ath10k_wmi_alloc_skb(ar, sizeof(*tlv) + sizeof(*cmd)); 2679 if (!skb) 2680 return ERR_PTR(-ENOMEM); 2681 2682 tlv = (void *)skb->data; 2683 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_STA_POWERSAVE_PARAM_CMD); 2684 tlv->len = __cpu_to_le16(sizeof(*cmd)); 2685 cmd = (void *)tlv->value; 2686 cmd->vdev_id = __cpu_to_le32(vdev_id); 2687 cmd->param_id = __cpu_to_le32(param_id); 2688 cmd->param_value = __cpu_to_le32(param_value); 2689 2690 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv set sta ps\n"); 2691 return skb; 2692 } 2693 2694 static struct sk_buff * 2695 ath10k_wmi_tlv_op_gen_set_ap_ps(struct ath10k *ar, u32 vdev_id, const u8 *mac, 2696 enum wmi_ap_ps_peer_param param_id, u32 value) 2697 { 2698 struct wmi_ap_ps_peer_cmd *cmd; 2699 struct wmi_tlv *tlv; 2700 struct sk_buff *skb; 2701 2702 if (!mac) 2703 return ERR_PTR(-EINVAL); 2704 2705 skb = ath10k_wmi_alloc_skb(ar, sizeof(*tlv) + sizeof(*cmd)); 2706 if (!skb) 2707 return ERR_PTR(-ENOMEM); 2708 2709 tlv = (void *)skb->data; 2710 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_AP_PS_PEER_CMD); 2711 tlv->len = __cpu_to_le16(sizeof(*cmd)); 2712 cmd = (void *)tlv->value; 2713 cmd->vdev_id = __cpu_to_le32(vdev_id); 2714 cmd->param_id = __cpu_to_le32(param_id); 2715 cmd->param_value = __cpu_to_le32(value); 2716 ether_addr_copy(cmd->peer_macaddr.addr, mac); 2717 2718 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv ap ps param\n"); 2719 return skb; 2720 } 2721 2722 static struct sk_buff * 2723 ath10k_wmi_tlv_op_gen_scan_chan_list(struct ath10k *ar, 2724 const struct wmi_scan_chan_list_arg *arg) 2725 { 2726 struct wmi_tlv_scan_chan_list_cmd *cmd; 2727 struct wmi_channel *ci; 2728 struct wmi_channel_arg *ch; 2729 struct wmi_tlv *tlv; 2730 struct sk_buff *skb; 2731 size_t chans_len, len; 2732 int i; 2733 void *ptr, *chans; 2734 2735 chans_len = arg->n_channels * (sizeof(*tlv) + sizeof(*ci)); 2736 len = (sizeof(*tlv) + sizeof(*cmd)) + 2737 (sizeof(*tlv) + chans_len); 2738 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_SCAN_CHAN_LIST_CMD); 2746 tlv->len = __cpu_to_le16(sizeof(*cmd)); 2747 cmd = (void *)tlv->value; 2748 cmd->num_scan_chans = __cpu_to_le32(arg->n_channels); 2749 2750 ptr += sizeof(*tlv); 2751 ptr += sizeof(*cmd); 2752 2753 tlv = ptr; 2754 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_STRUCT); 2755 tlv->len = __cpu_to_le16(chans_len); 2756 chans = (void *)tlv->value; 2757 2758 for (i = 0; i < arg->n_channels; i++) { 2759 ch = &arg->channels[i]; 2760 2761 tlv = chans; 2762 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_CHANNEL); 2763 tlv->len = __cpu_to_le16(sizeof(*ci)); 2764 ci = (void *)tlv->value; 2765 2766 ath10k_wmi_put_wmi_channel(ci, ch); 2767 2768 chans += sizeof(*tlv); 2769 chans += sizeof(*ci); 2770 } 2771 2772 ptr += sizeof(*tlv); 2773 ptr += chans_len; 2774 2775 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv scan chan list\n"); 2776 return skb; 2777 } 2778 2779 static struct sk_buff * 2780 ath10k_wmi_tlv_op_gen_scan_prob_req_oui(struct ath10k *ar, u32 prob_req_oui) 2781 { 2782 struct wmi_scan_prob_req_oui_cmd *cmd; 2783 struct wmi_tlv *tlv; 2784 struct sk_buff *skb; 2785 2786 skb = ath10k_wmi_alloc_skb(ar, sizeof(*tlv) + sizeof(*cmd)); 2787 if (!skb) 2788 return ERR_PTR(-ENOMEM); 2789 2790 tlv = (void *)skb->data; 2791 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_SCAN_PROB_REQ_OUI_CMD); 2792 tlv->len = __cpu_to_le16(sizeof(*cmd)); 2793 cmd = (void *)tlv->value; 2794 cmd->prob_req_oui = __cpu_to_le32(prob_req_oui); 2795 2796 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv scan prob req oui\n"); 2797 return skb; 2798 } 2799 2800 static struct sk_buff * 2801 ath10k_wmi_tlv_op_gen_beacon_dma(struct ath10k *ar, u32 vdev_id, 2802 const void *bcn, size_t bcn_len, 2803 u32 bcn_paddr, bool dtim_zero, 2804 bool deliver_cab) 2805 2806 { 2807 struct wmi_bcn_tx_ref_cmd *cmd; 2808 struct wmi_tlv *tlv; 2809 struct sk_buff *skb; 2810 struct ieee80211_hdr *hdr; 2811 u16 fc; 2812 2813 skb = ath10k_wmi_alloc_skb(ar, sizeof(*tlv) + sizeof(*cmd)); 2814 if (!skb) 2815 return ERR_PTR(-ENOMEM); 2816 2817 hdr = (struct ieee80211_hdr *)bcn; 2818 fc = le16_to_cpu(hdr->frame_control); 2819 2820 tlv = (void *)skb->data; 2821 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_BCN_SEND_FROM_HOST_CMD); 2822 tlv->len = __cpu_to_le16(sizeof(*cmd)); 2823 cmd = (void *)tlv->value; 2824 cmd->vdev_id = __cpu_to_le32(vdev_id); 2825 cmd->data_len = __cpu_to_le32(bcn_len); 2826 cmd->data_ptr = __cpu_to_le32(bcn_paddr); 2827 cmd->msdu_id = 0; 2828 cmd->frame_control = __cpu_to_le32(fc); 2829 cmd->flags = 0; 2830 2831 if (dtim_zero) 2832 cmd->flags |= __cpu_to_le32(WMI_BCN_TX_REF_FLAG_DTIM_ZERO); 2833 2834 if (deliver_cab) 2835 cmd->flags |= __cpu_to_le32(WMI_BCN_TX_REF_FLAG_DELIVER_CAB); 2836 2837 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv beacon dma\n"); 2838 return skb; 2839 } 2840 2841 static struct sk_buff * 2842 ath10k_wmi_tlv_op_gen_pdev_set_wmm(struct ath10k *ar, 2843 const struct wmi_wmm_params_all_arg *arg) 2844 { 2845 struct wmi_tlv_pdev_set_wmm_cmd *cmd; 2846 struct wmi_wmm_params *wmm; 2847 struct wmi_tlv *tlv; 2848 struct sk_buff *skb; 2849 size_t len; 2850 void *ptr; 2851 2852 len = (sizeof(*tlv) + sizeof(*cmd)) + 2853 (4 * (sizeof(*tlv) + sizeof(*wmm))); 2854 skb = ath10k_wmi_alloc_skb(ar, len); 2855 if (!skb) 2856 return ERR_PTR(-ENOMEM); 2857 2858 ptr = (void *)skb->data; 2859 2860 tlv = ptr; 2861 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_PDEV_SET_WMM_PARAMS_CMD); 2862 tlv->len = __cpu_to_le16(sizeof(*cmd)); 2863 cmd = (void *)tlv->value; 2864 2865 /* nothing to set here */ 2866 2867 ptr += sizeof(*tlv); 2868 ptr += sizeof(*cmd); 2869 2870 ptr = ath10k_wmi_tlv_put_wmm(ptr, &arg->ac_be); 2871 ptr = ath10k_wmi_tlv_put_wmm(ptr, &arg->ac_bk); 2872 ptr = ath10k_wmi_tlv_put_wmm(ptr, &arg->ac_vi); 2873 ptr = ath10k_wmi_tlv_put_wmm(ptr, &arg->ac_vo); 2874 2875 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv pdev set wmm\n"); 2876 return skb; 2877 } 2878 2879 static struct sk_buff * 2880 ath10k_wmi_tlv_op_gen_request_stats(struct ath10k *ar, u32 stats_mask) 2881 { 2882 struct wmi_request_stats_cmd *cmd; 2883 struct wmi_tlv *tlv; 2884 struct sk_buff *skb; 2885 2886 skb = ath10k_wmi_alloc_skb(ar, sizeof(*tlv) + sizeof(*cmd)); 2887 if (!skb) 2888 return ERR_PTR(-ENOMEM); 2889 2890 tlv = (void *)skb->data; 2891 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_REQUEST_STATS_CMD); 2892 tlv->len = __cpu_to_le16(sizeof(*cmd)); 2893 cmd = (void *)tlv->value; 2894 cmd->stats_id = __cpu_to_le32(stats_mask); 2895 2896 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv request stats\n"); 2897 return skb; 2898 } 2899 2900 static int 2901 ath10k_wmi_mgmt_tx_alloc_msdu_id(struct ath10k *ar, struct sk_buff *skb, 2902 dma_addr_t paddr) 2903 { 2904 struct ath10k_wmi *wmi = &ar->wmi; 2905 struct ath10k_mgmt_tx_pkt_addr *pkt_addr; 2906 int ret; 2907 2908 pkt_addr = kmalloc(sizeof(*pkt_addr), GFP_ATOMIC); 2909 if (!pkt_addr) 2910 return -ENOMEM; 2911 2912 pkt_addr->vaddr = skb; 2913 pkt_addr->paddr = paddr; 2914 2915 spin_lock_bh(&ar->data_lock); 2916 ret = idr_alloc(&wmi->mgmt_pending_tx, pkt_addr, 0, 2917 wmi->mgmt_max_num_pending_tx, GFP_ATOMIC); 2918 spin_unlock_bh(&ar->data_lock); 2919 2920 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi mgmt tx alloc msdu_id ret %d\n", ret); 2921 return ret; 2922 } 2923 2924 static struct sk_buff * 2925 ath10k_wmi_tlv_op_gen_mgmt_tx_send(struct ath10k *ar, struct sk_buff *msdu, 2926 dma_addr_t paddr) 2927 { 2928 struct ath10k_skb_cb *cb = ATH10K_SKB_CB(msdu); 2929 struct wmi_tlv_mgmt_tx_cmd *cmd; 2930 struct ieee80211_hdr *hdr; 2931 struct ath10k_vif *arvif; 2932 u32 buf_len = msdu->len; 2933 struct wmi_tlv *tlv; 2934 struct sk_buff *skb; 2935 int len, desc_id; 2936 u32 vdev_id; 2937 void *ptr; 2938 2939 if (!cb->vif) 2940 return ERR_PTR(-EINVAL); 2941 2942 hdr = (struct ieee80211_hdr *)msdu->data; 2943 arvif = (void *)cb->vif->drv_priv; 2944 vdev_id = arvif->vdev_id; 2945 2946 if (WARN_ON_ONCE(!ieee80211_is_mgmt(hdr->frame_control) && 2947 (!(ieee80211_is_nullfunc(hdr->frame_control) || 2948 ieee80211_is_qos_nullfunc(hdr->frame_control))))) 2949 return ERR_PTR(-EINVAL); 2950 2951 len = sizeof(*cmd) + 2 * sizeof(*tlv); 2952 2953 if ((ieee80211_is_action(hdr->frame_control) || 2954 ieee80211_is_deauth(hdr->frame_control) || 2955 ieee80211_is_disassoc(hdr->frame_control)) && 2956 ieee80211_has_protected(hdr->frame_control)) { 2957 skb_put(msdu, IEEE80211_CCMP_MIC_LEN); 2958 buf_len += IEEE80211_CCMP_MIC_LEN; 2959 } 2960 2961 buf_len = min_t(u32, buf_len, WMI_TLV_MGMT_TX_FRAME_MAX_LEN); 2962 buf_len = round_up(buf_len, 4); 2963 2964 len += buf_len; 2965 len = round_up(len, 4); 2966 skb = ath10k_wmi_alloc_skb(ar, len); 2967 if (!skb) 2968 return ERR_PTR(-ENOMEM); 2969 2970 desc_id = ath10k_wmi_mgmt_tx_alloc_msdu_id(ar, msdu, paddr); 2971 if (desc_id < 0) 2972 goto err_free_skb; 2973 2974 ptr = (void *)skb->data; 2975 tlv = ptr; 2976 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_MGMT_TX_CMD); 2977 tlv->len = __cpu_to_le16(sizeof(*cmd)); 2978 cmd = (void *)tlv->value; 2979 cmd->vdev_id = __cpu_to_le32(vdev_id); 2980 cmd->desc_id = __cpu_to_le32(desc_id); 2981 cmd->chanfreq = 0; 2982 cmd->buf_len = __cpu_to_le32(buf_len); 2983 cmd->frame_len = __cpu_to_le32(msdu->len); 2984 cmd->paddr = __cpu_to_le64(paddr); 2985 2986 ptr += sizeof(*tlv); 2987 ptr += sizeof(*cmd); 2988 2989 tlv = ptr; 2990 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_BYTE); 2991 tlv->len = __cpu_to_le16(buf_len); 2992 2993 ptr += sizeof(*tlv); 2994 memcpy(ptr, msdu->data, buf_len); 2995 2996 return skb; 2997 2998 err_free_skb: 2999 dev_kfree_skb(skb); 3000 return ERR_PTR(desc_id); 3001 } 3002 3003 static struct sk_buff * 3004 ath10k_wmi_tlv_op_gen_force_fw_hang(struct ath10k *ar, 3005 enum wmi_force_fw_hang_type type, 3006 u32 delay_ms) 3007 { 3008 struct wmi_force_fw_hang_cmd *cmd; 3009 struct wmi_tlv *tlv; 3010 struct sk_buff *skb; 3011 3012 skb = ath10k_wmi_alloc_skb(ar, sizeof(*tlv) + sizeof(*cmd)); 3013 if (!skb) 3014 return ERR_PTR(-ENOMEM); 3015 3016 tlv = (void *)skb->data; 3017 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_FORCE_FW_HANG_CMD); 3018 tlv->len = __cpu_to_le16(sizeof(*cmd)); 3019 cmd = (void *)tlv->value; 3020 cmd->type = __cpu_to_le32(type); 3021 cmd->delay_ms = __cpu_to_le32(delay_ms); 3022 3023 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv force fw hang\n"); 3024 return skb; 3025 } 3026 3027 static struct sk_buff * 3028 ath10k_wmi_tlv_op_gen_dbglog_cfg(struct ath10k *ar, u64 module_enable, 3029 u32 log_level) 3030 { 3031 struct wmi_tlv_dbglog_cmd *cmd; 3032 struct wmi_tlv *tlv; 3033 struct sk_buff *skb; 3034 size_t len, bmap_len; 3035 u32 value; 3036 void *ptr; 3037 3038 if (module_enable) { 3039 value = WMI_TLV_DBGLOG_LOG_LEVEL_VALUE( 3040 module_enable, 3041 WMI_TLV_DBGLOG_LOG_LEVEL_VERBOSE); 3042 } else { 3043 value = WMI_TLV_DBGLOG_LOG_LEVEL_VALUE( 3044 WMI_TLV_DBGLOG_ALL_MODULES, 3045 WMI_TLV_DBGLOG_LOG_LEVEL_WARN); 3046 } 3047 3048 bmap_len = 0; 3049 len = sizeof(*tlv) + sizeof(*cmd) + sizeof(*tlv) + bmap_len; 3050 skb = ath10k_wmi_alloc_skb(ar, len); 3051 if (!skb) 3052 return ERR_PTR(-ENOMEM); 3053 3054 ptr = (void *)skb->data; 3055 3056 tlv = ptr; 3057 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_DEBUG_LOG_CONFIG_CMD); 3058 tlv->len = __cpu_to_le16(sizeof(*cmd)); 3059 cmd = (void *)tlv->value; 3060 cmd->param = __cpu_to_le32(WMI_TLV_DBGLOG_PARAM_LOG_LEVEL); 3061 cmd->value = __cpu_to_le32(value); 3062 3063 ptr += sizeof(*tlv); 3064 ptr += sizeof(*cmd); 3065 3066 tlv = ptr; 3067 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_UINT32); 3068 tlv->len = __cpu_to_le16(bmap_len); 3069 3070 /* nothing to do here */ 3071 3072 ptr += sizeof(*tlv); 3073 ptr += sizeof(bmap_len); 3074 3075 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv dbglog value 0x%08x\n", value); 3076 return skb; 3077 } 3078 3079 static struct sk_buff * 3080 ath10k_wmi_tlv_op_gen_pktlog_enable(struct ath10k *ar, u32 filter) 3081 { 3082 struct wmi_tlv_pktlog_enable *cmd; 3083 struct wmi_tlv *tlv; 3084 struct sk_buff *skb; 3085 void *ptr; 3086 size_t len; 3087 3088 len = sizeof(*tlv) + sizeof(*cmd); 3089 skb = ath10k_wmi_alloc_skb(ar, len); 3090 if (!skb) 3091 return ERR_PTR(-ENOMEM); 3092 3093 ptr = (void *)skb->data; 3094 tlv = ptr; 3095 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_PDEV_PKTLOG_ENABLE_CMD); 3096 tlv->len = __cpu_to_le16(sizeof(*cmd)); 3097 cmd = (void *)tlv->value; 3098 cmd->filter = __cpu_to_le32(filter); 3099 3100 ptr += sizeof(*tlv); 3101 ptr += sizeof(*cmd); 3102 3103 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv pktlog enable filter 0x%08x\n", 3104 filter); 3105 return skb; 3106 } 3107 3108 static struct sk_buff * 3109 ath10k_wmi_tlv_op_gen_pdev_get_temperature(struct ath10k *ar) 3110 { 3111 struct wmi_tlv_pdev_get_temp_cmd *cmd; 3112 struct wmi_tlv *tlv; 3113 struct sk_buff *skb; 3114 3115 skb = ath10k_wmi_alloc_skb(ar, sizeof(*tlv) + sizeof(*cmd)); 3116 if (!skb) 3117 return ERR_PTR(-ENOMEM); 3118 3119 tlv = (void *)skb->data; 3120 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_PDEV_GET_TEMPERATURE_CMD); 3121 tlv->len = __cpu_to_le16(sizeof(*cmd)); 3122 cmd = (void *)tlv->value; 3123 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi pdev get temperature tlv\n"); 3124 return skb; 3125 } 3126 3127 static struct sk_buff * 3128 ath10k_wmi_tlv_op_gen_pktlog_disable(struct ath10k *ar) 3129 { 3130 struct wmi_tlv_pktlog_disable *cmd; 3131 struct wmi_tlv *tlv; 3132 struct sk_buff *skb; 3133 void *ptr; 3134 size_t len; 3135 3136 len = sizeof(*tlv) + sizeof(*cmd); 3137 skb = ath10k_wmi_alloc_skb(ar, len); 3138 if (!skb) 3139 return ERR_PTR(-ENOMEM); 3140 3141 ptr = (void *)skb->data; 3142 tlv = ptr; 3143 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_PDEV_PKTLOG_DISABLE_CMD); 3144 tlv->len = __cpu_to_le16(sizeof(*cmd)); 3145 cmd = (void *)tlv->value; 3146 3147 ptr += sizeof(*tlv); 3148 ptr += sizeof(*cmd); 3149 3150 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv pktlog disable\n"); 3151 return skb; 3152 } 3153 3154 static struct sk_buff * 3155 ath10k_wmi_tlv_op_gen_bcn_tmpl(struct ath10k *ar, u32 vdev_id, 3156 u32 tim_ie_offset, struct sk_buff *bcn, 3157 u32 prb_caps, u32 prb_erp, void *prb_ies, 3158 size_t prb_ies_len) 3159 { 3160 struct wmi_tlv_bcn_tmpl_cmd *cmd; 3161 struct wmi_tlv_bcn_prb_info *info; 3162 struct wmi_tlv *tlv; 3163 struct sk_buff *skb; 3164 void *ptr; 3165 size_t len; 3166 3167 if (WARN_ON(prb_ies_len > 0 && !prb_ies)) 3168 return ERR_PTR(-EINVAL); 3169 3170 len = sizeof(*tlv) + sizeof(*cmd) + 3171 sizeof(*tlv) + sizeof(*info) + prb_ies_len + 3172 sizeof(*tlv) + roundup(bcn->len, 4); 3173 skb = ath10k_wmi_alloc_skb(ar, len); 3174 if (!skb) 3175 return ERR_PTR(-ENOMEM); 3176 3177 ptr = (void *)skb->data; 3178 tlv = ptr; 3179 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_BCN_TMPL_CMD); 3180 tlv->len = __cpu_to_le16(sizeof(*cmd)); 3181 cmd = (void *)tlv->value; 3182 cmd->vdev_id = __cpu_to_le32(vdev_id); 3183 cmd->tim_ie_offset = __cpu_to_le32(tim_ie_offset); 3184 cmd->buf_len = __cpu_to_le32(bcn->len); 3185 3186 ptr += sizeof(*tlv); 3187 ptr += sizeof(*cmd); 3188 3189 /* FIXME: prb_ies_len should be probably aligned to 4byte boundary but 3190 * then it is then impossible to pass original ie len. 3191 * This chunk is not used yet so if setting probe resp template yields 3192 * problems with beaconing or crashes firmware look here. 3193 */ 3194 tlv = ptr; 3195 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_BCN_PRB_INFO); 3196 tlv->len = __cpu_to_le16(sizeof(*info) + prb_ies_len); 3197 info = (void *)tlv->value; 3198 info->caps = __cpu_to_le32(prb_caps); 3199 info->erp = __cpu_to_le32(prb_erp); 3200 memcpy(info->ies, prb_ies, prb_ies_len); 3201 3202 ptr += sizeof(*tlv); 3203 ptr += sizeof(*info); 3204 ptr += prb_ies_len; 3205 3206 tlv = ptr; 3207 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_BYTE); 3208 tlv->len = __cpu_to_le16(roundup(bcn->len, 4)); 3209 memcpy(tlv->value, bcn->data, bcn->len); 3210 3211 /* FIXME: Adjust TSF? */ 3212 3213 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv bcn tmpl vdev_id %i\n", 3214 vdev_id); 3215 return skb; 3216 } 3217 3218 static struct sk_buff * 3219 ath10k_wmi_tlv_op_gen_prb_tmpl(struct ath10k *ar, u32 vdev_id, 3220 struct sk_buff *prb) 3221 { 3222 struct wmi_tlv_prb_tmpl_cmd *cmd; 3223 struct wmi_tlv_bcn_prb_info *info; 3224 struct wmi_tlv *tlv; 3225 struct sk_buff *skb; 3226 void *ptr; 3227 size_t len; 3228 3229 len = sizeof(*tlv) + sizeof(*cmd) + 3230 sizeof(*tlv) + sizeof(*info) + 3231 sizeof(*tlv) + roundup(prb->len, 4); 3232 skb = ath10k_wmi_alloc_skb(ar, len); 3233 if (!skb) 3234 return ERR_PTR(-ENOMEM); 3235 3236 ptr = (void *)skb->data; 3237 tlv = ptr; 3238 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_PRB_TMPL_CMD); 3239 tlv->len = __cpu_to_le16(sizeof(*cmd)); 3240 cmd = (void *)tlv->value; 3241 cmd->vdev_id = __cpu_to_le32(vdev_id); 3242 cmd->buf_len = __cpu_to_le32(prb->len); 3243 3244 ptr += sizeof(*tlv); 3245 ptr += sizeof(*cmd); 3246 3247 tlv = ptr; 3248 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_BCN_PRB_INFO); 3249 tlv->len = __cpu_to_le16(sizeof(*info)); 3250 info = (void *)tlv->value; 3251 info->caps = 0; 3252 info->erp = 0; 3253 3254 ptr += sizeof(*tlv); 3255 ptr += sizeof(*info); 3256 3257 tlv = ptr; 3258 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_BYTE); 3259 tlv->len = __cpu_to_le16(roundup(prb->len, 4)); 3260 memcpy(tlv->value, prb->data, prb->len); 3261 3262 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv prb tmpl vdev_id %i\n", 3263 vdev_id); 3264 return skb; 3265 } 3266 3267 static struct sk_buff * 3268 ath10k_wmi_tlv_op_gen_p2p_go_bcn_ie(struct ath10k *ar, u32 vdev_id, 3269 const u8 *p2p_ie) 3270 { 3271 struct wmi_tlv_p2p_go_bcn_ie *cmd; 3272 struct wmi_tlv *tlv; 3273 struct sk_buff *skb; 3274 void *ptr; 3275 size_t len; 3276 3277 len = sizeof(*tlv) + sizeof(*cmd) + 3278 sizeof(*tlv) + roundup(p2p_ie[1] + 2, 4); 3279 skb = ath10k_wmi_alloc_skb(ar, len); 3280 if (!skb) 3281 return ERR_PTR(-ENOMEM); 3282 3283 ptr = (void *)skb->data; 3284 tlv = ptr; 3285 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_P2P_GO_SET_BEACON_IE); 3286 tlv->len = __cpu_to_le16(sizeof(*cmd)); 3287 cmd = (void *)tlv->value; 3288 cmd->vdev_id = __cpu_to_le32(vdev_id); 3289 cmd->ie_len = __cpu_to_le32(p2p_ie[1] + 2); 3290 3291 ptr += sizeof(*tlv); 3292 ptr += sizeof(*cmd); 3293 3294 tlv = ptr; 3295 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_BYTE); 3296 tlv->len = __cpu_to_le16(roundup(p2p_ie[1] + 2, 4)); 3297 memcpy(tlv->value, p2p_ie, p2p_ie[1] + 2); 3298 3299 ptr += sizeof(*tlv); 3300 ptr += roundup(p2p_ie[1] + 2, 4); 3301 3302 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv p2p go bcn ie for vdev %i\n", 3303 vdev_id); 3304 return skb; 3305 } 3306 3307 static struct sk_buff * 3308 ath10k_wmi_tlv_op_gen_update_fw_tdls_state(struct ath10k *ar, u32 vdev_id, 3309 enum wmi_tdls_state state) 3310 { 3311 struct wmi_tdls_set_state_cmd *cmd; 3312 struct wmi_tlv *tlv; 3313 struct sk_buff *skb; 3314 void *ptr; 3315 size_t len; 3316 /* Set to options from wmi_tlv_tdls_options, 3317 * for now none of them are enabled. 3318 */ 3319 u32 options = 0; 3320 3321 if (test_bit(WMI_SERVICE_TDLS_UAPSD_BUFFER_STA, ar->wmi.svc_map)) 3322 options |= WMI_TLV_TDLS_BUFFER_STA_EN; 3323 3324 /* WMI_TDLS_ENABLE_ACTIVE_EXTERNAL_CONTROL means firm will handle TDLS 3325 * link inactivity detecting logic. 3326 */ 3327 if (state == WMI_TDLS_ENABLE_ACTIVE) 3328 state = WMI_TDLS_ENABLE_ACTIVE_EXTERNAL_CONTROL; 3329 3330 len = sizeof(*tlv) + sizeof(*cmd); 3331 skb = ath10k_wmi_alloc_skb(ar, len); 3332 if (!skb) 3333 return ERR_PTR(-ENOMEM); 3334 3335 ptr = (void *)skb->data; 3336 tlv = ptr; 3337 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_TDLS_SET_STATE_CMD); 3338 tlv->len = __cpu_to_le16(sizeof(*cmd)); 3339 3340 cmd = (void *)tlv->value; 3341 cmd->vdev_id = __cpu_to_le32(vdev_id); 3342 cmd->state = __cpu_to_le32(state); 3343 cmd->notification_interval_ms = __cpu_to_le32(5000); 3344 cmd->tx_discovery_threshold = __cpu_to_le32(100); 3345 cmd->tx_teardown_threshold = __cpu_to_le32(5); 3346 cmd->rssi_teardown_threshold = __cpu_to_le32(-75); 3347 cmd->rssi_delta = __cpu_to_le32(-20); 3348 cmd->tdls_options = __cpu_to_le32(options); 3349 cmd->tdls_peer_traffic_ind_window = __cpu_to_le32(2); 3350 cmd->tdls_peer_traffic_response_timeout_ms = __cpu_to_le32(5000); 3351 cmd->tdls_puapsd_mask = __cpu_to_le32(0xf); 3352 cmd->tdls_puapsd_inactivity_time_ms = __cpu_to_le32(0); 3353 cmd->tdls_puapsd_rx_frame_threshold = __cpu_to_le32(10); 3354 3355 ptr += sizeof(*tlv); 3356 ptr += sizeof(*cmd); 3357 3358 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv update fw tdls state %d for vdev %i\n", 3359 state, vdev_id); 3360 return skb; 3361 } 3362 3363 static u32 ath10k_wmi_tlv_prepare_peer_qos(u8 uapsd_queues, u8 sp) 3364 { 3365 u32 peer_qos = 0; 3366 3367 if (uapsd_queues & IEEE80211_WMM_IE_STA_QOSINFO_AC_VO) 3368 peer_qos |= WMI_TLV_TDLS_PEER_QOS_AC_VO; 3369 if (uapsd_queues & IEEE80211_WMM_IE_STA_QOSINFO_AC_VI) 3370 peer_qos |= WMI_TLV_TDLS_PEER_QOS_AC_VI; 3371 if (uapsd_queues & IEEE80211_WMM_IE_STA_QOSINFO_AC_BK) 3372 peer_qos |= WMI_TLV_TDLS_PEER_QOS_AC_BK; 3373 if (uapsd_queues & IEEE80211_WMM_IE_STA_QOSINFO_AC_BE) 3374 peer_qos |= WMI_TLV_TDLS_PEER_QOS_AC_BE; 3375 3376 peer_qos |= SM(sp, WMI_TLV_TDLS_PEER_SP); 3377 3378 return peer_qos; 3379 } 3380 3381 static struct sk_buff * 3382 ath10k_wmi_tlv_op_gen_tdls_peer_update(struct ath10k *ar, 3383 const struct wmi_tdls_peer_update_cmd_arg *arg, 3384 const struct wmi_tdls_peer_capab_arg *cap, 3385 const struct wmi_channel_arg *chan_arg) 3386 { 3387 struct wmi_tdls_peer_update_cmd *cmd; 3388 struct wmi_tdls_peer_capab *peer_cap; 3389 struct wmi_channel *chan; 3390 struct wmi_tlv *tlv; 3391 struct sk_buff *skb; 3392 u32 peer_qos; 3393 void *ptr; 3394 int len; 3395 int i; 3396 3397 len = sizeof(*tlv) + sizeof(*cmd) + 3398 sizeof(*tlv) + sizeof(*peer_cap) + 3399 sizeof(*tlv) + cap->peer_chan_len * sizeof(*chan); 3400 3401 skb = ath10k_wmi_alloc_skb(ar, len); 3402 if (!skb) 3403 return ERR_PTR(-ENOMEM); 3404 3405 ptr = (void *)skb->data; 3406 tlv = ptr; 3407 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_TDLS_PEER_UPDATE_CMD); 3408 tlv->len = __cpu_to_le16(sizeof(*cmd)); 3409 3410 cmd = (void *)tlv->value; 3411 cmd->vdev_id = __cpu_to_le32(arg->vdev_id); 3412 ether_addr_copy(cmd->peer_macaddr.addr, arg->addr); 3413 cmd->peer_state = __cpu_to_le32(arg->peer_state); 3414 3415 ptr += sizeof(*tlv); 3416 ptr += sizeof(*cmd); 3417 3418 tlv = ptr; 3419 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_TDLS_PEER_CAPABILITIES); 3420 tlv->len = __cpu_to_le16(sizeof(*peer_cap)); 3421 peer_cap = (void *)tlv->value; 3422 peer_qos = ath10k_wmi_tlv_prepare_peer_qos(cap->peer_uapsd_queues, 3423 cap->peer_max_sp); 3424 peer_cap->peer_qos = __cpu_to_le32(peer_qos); 3425 peer_cap->buff_sta_support = __cpu_to_le32(cap->buff_sta_support); 3426 peer_cap->off_chan_support = __cpu_to_le32(cap->off_chan_support); 3427 peer_cap->peer_curr_operclass = __cpu_to_le32(cap->peer_curr_operclass); 3428 peer_cap->self_curr_operclass = __cpu_to_le32(cap->self_curr_operclass); 3429 peer_cap->peer_chan_len = __cpu_to_le32(cap->peer_chan_len); 3430 peer_cap->peer_operclass_len = __cpu_to_le32(cap->peer_operclass_len); 3431 3432 for (i = 0; i < WMI_TDLS_MAX_SUPP_OPER_CLASSES; i++) 3433 peer_cap->peer_operclass[i] = cap->peer_operclass[i]; 3434 3435 peer_cap->is_peer_responder = __cpu_to_le32(cap->is_peer_responder); 3436 peer_cap->pref_offchan_num = __cpu_to_le32(cap->pref_offchan_num); 3437 peer_cap->pref_offchan_bw = __cpu_to_le32(cap->pref_offchan_bw); 3438 3439 ptr += sizeof(*tlv); 3440 ptr += sizeof(*peer_cap); 3441 3442 tlv = ptr; 3443 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_STRUCT); 3444 tlv->len = __cpu_to_le16(cap->peer_chan_len * sizeof(*chan)); 3445 3446 ptr += sizeof(*tlv); 3447 3448 for (i = 0; i < cap->peer_chan_len; i++) { 3449 tlv = ptr; 3450 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_CHANNEL); 3451 tlv->len = __cpu_to_le16(sizeof(*chan)); 3452 chan = (void *)tlv->value; 3453 ath10k_wmi_put_wmi_channel(chan, &chan_arg[i]); 3454 3455 ptr += sizeof(*tlv); 3456 ptr += sizeof(*chan); 3457 } 3458 3459 ath10k_dbg(ar, ATH10K_DBG_WMI, 3460 "wmi tlv tdls peer update vdev %i state %d n_chans %u\n", 3461 arg->vdev_id, arg->peer_state, cap->peer_chan_len); 3462 return skb; 3463 } 3464 3465 static struct sk_buff * 3466 ath10k_wmi_tlv_op_gen_pdev_set_quiet_mode(struct ath10k *ar, u32 period, 3467 u32 duration, u32 next_offset, 3468 u32 enabled) 3469 { 3470 struct wmi_tlv_set_quiet_cmd *cmd; 3471 struct wmi_tlv *tlv; 3472 struct sk_buff *skb; 3473 3474 skb = ath10k_wmi_alloc_skb(ar, sizeof(*tlv) + sizeof(*cmd)); 3475 if (!skb) 3476 return ERR_PTR(-ENOMEM); 3477 3478 tlv = (void *)skb->data; 3479 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_PDEV_SET_QUIET_CMD); 3480 tlv->len = __cpu_to_le16(sizeof(*cmd)); 3481 cmd = (void *)tlv->value; 3482 3483 /* vdev_id is not in use, set to 0 */ 3484 cmd->vdev_id = __cpu_to_le32(0); 3485 cmd->period = __cpu_to_le32(period); 3486 cmd->duration = __cpu_to_le32(duration); 3487 cmd->next_start = __cpu_to_le32(next_offset); 3488 cmd->enabled = __cpu_to_le32(enabled); 3489 3490 ath10k_dbg(ar, ATH10K_DBG_WMI, 3491 "wmi tlv quiet param: period %u duration %u enabled %d\n", 3492 period, duration, enabled); 3493 return skb; 3494 } 3495 3496 static struct sk_buff * 3497 ath10k_wmi_tlv_op_gen_wow_enable(struct ath10k *ar) 3498 { 3499 struct wmi_tlv_wow_enable_cmd *cmd; 3500 struct wmi_tlv *tlv; 3501 struct sk_buff *skb; 3502 size_t len; 3503 3504 len = sizeof(*tlv) + sizeof(*cmd); 3505 skb = ath10k_wmi_alloc_skb(ar, len); 3506 if (!skb) 3507 return ERR_PTR(-ENOMEM); 3508 3509 tlv = (struct wmi_tlv *)skb->data; 3510 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_WOW_ENABLE_CMD); 3511 tlv->len = __cpu_to_le16(sizeof(*cmd)); 3512 cmd = (void *)tlv->value; 3513 3514 cmd->enable = __cpu_to_le32(1); 3515 if (!ar->bus_param.link_can_suspend) 3516 cmd->pause_iface_config = __cpu_to_le32(WOW_IFACE_PAUSE_DISABLED); 3517 3518 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv wow enable\n"); 3519 return skb; 3520 } 3521 3522 static struct sk_buff * 3523 ath10k_wmi_tlv_op_gen_wow_add_wakeup_event(struct ath10k *ar, 3524 u32 vdev_id, 3525 enum wmi_wow_wakeup_event event, 3526 u32 enable) 3527 { 3528 struct wmi_tlv_wow_add_del_event_cmd *cmd; 3529 struct wmi_tlv *tlv; 3530 struct sk_buff *skb; 3531 size_t len; 3532 3533 len = sizeof(*tlv) + sizeof(*cmd); 3534 skb = ath10k_wmi_alloc_skb(ar, len); 3535 if (!skb) 3536 return ERR_PTR(-ENOMEM); 3537 3538 tlv = (struct wmi_tlv *)skb->data; 3539 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_WOW_ADD_DEL_EVT_CMD); 3540 tlv->len = __cpu_to_le16(sizeof(*cmd)); 3541 cmd = (void *)tlv->value; 3542 3543 cmd->vdev_id = __cpu_to_le32(vdev_id); 3544 cmd->is_add = __cpu_to_le32(enable); 3545 cmd->event_bitmap = __cpu_to_le32(1 << event); 3546 3547 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv wow add wakeup event %s enable %d vdev_id %d\n", 3548 wow_wakeup_event(event), enable, vdev_id); 3549 return skb; 3550 } 3551 3552 static struct sk_buff * 3553 ath10k_wmi_tlv_gen_wow_host_wakeup_ind(struct ath10k *ar) 3554 { 3555 struct wmi_tlv_wow_host_wakeup_ind *cmd; 3556 struct wmi_tlv *tlv; 3557 struct sk_buff *skb; 3558 size_t len; 3559 3560 len = sizeof(*tlv) + sizeof(*cmd); 3561 skb = ath10k_wmi_alloc_skb(ar, len); 3562 if (!skb) 3563 return ERR_PTR(-ENOMEM); 3564 3565 tlv = (struct wmi_tlv *)skb->data; 3566 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_WOW_HOSTWAKEUP_FROM_SLEEP_CMD); 3567 tlv->len = __cpu_to_le16(sizeof(*cmd)); 3568 cmd = (void *)tlv->value; 3569 3570 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv wow host wakeup ind\n"); 3571 return skb; 3572 } 3573 3574 static struct sk_buff * 3575 ath10k_wmi_tlv_op_gen_wow_add_pattern(struct ath10k *ar, u32 vdev_id, 3576 u32 pattern_id, const u8 *pattern, 3577 const u8 *bitmask, int pattern_len, 3578 int pattern_offset) 3579 { 3580 struct wmi_tlv_wow_add_pattern_cmd *cmd; 3581 struct wmi_tlv_wow_bitmap_pattern *bitmap; 3582 struct wmi_tlv *tlv; 3583 struct sk_buff *skb; 3584 void *ptr; 3585 size_t len; 3586 3587 len = sizeof(*tlv) + sizeof(*cmd) + 3588 sizeof(*tlv) + /* array struct */ 3589 sizeof(*tlv) + sizeof(*bitmap) + /* bitmap */ 3590 sizeof(*tlv) + /* empty ipv4 sync */ 3591 sizeof(*tlv) + /* empty ipv6 sync */ 3592 sizeof(*tlv) + /* empty magic */ 3593 sizeof(*tlv) + /* empty info timeout */ 3594 sizeof(*tlv) + sizeof(u32); /* ratelimit interval */ 3595 3596 skb = ath10k_wmi_alloc_skb(ar, len); 3597 if (!skb) 3598 return ERR_PTR(-ENOMEM); 3599 3600 /* cmd */ 3601 ptr = (void *)skb->data; 3602 tlv = ptr; 3603 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_WOW_ADD_PATTERN_CMD); 3604 tlv->len = __cpu_to_le16(sizeof(*cmd)); 3605 cmd = (void *)tlv->value; 3606 3607 cmd->vdev_id = __cpu_to_le32(vdev_id); 3608 cmd->pattern_id = __cpu_to_le32(pattern_id); 3609 cmd->pattern_type = __cpu_to_le32(WOW_BITMAP_PATTERN); 3610 3611 ptr += sizeof(*tlv); 3612 ptr += sizeof(*cmd); 3613 3614 /* bitmap */ 3615 tlv = ptr; 3616 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_STRUCT); 3617 tlv->len = __cpu_to_le16(sizeof(*tlv) + sizeof(*bitmap)); 3618 3619 ptr += sizeof(*tlv); 3620 3621 tlv = ptr; 3622 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_WOW_BITMAP_PATTERN_T); 3623 tlv->len = __cpu_to_le16(sizeof(*bitmap)); 3624 bitmap = (void *)tlv->value; 3625 3626 memcpy(bitmap->patternbuf, pattern, pattern_len); 3627 memcpy(bitmap->bitmaskbuf, bitmask, pattern_len); 3628 bitmap->pattern_offset = __cpu_to_le32(pattern_offset); 3629 bitmap->pattern_len = __cpu_to_le32(pattern_len); 3630 bitmap->bitmask_len = __cpu_to_le32(pattern_len); 3631 bitmap->pattern_id = __cpu_to_le32(pattern_id); 3632 3633 ptr += sizeof(*tlv); 3634 ptr += sizeof(*bitmap); 3635 3636 /* ipv4 sync */ 3637 tlv = ptr; 3638 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_STRUCT); 3639 tlv->len = __cpu_to_le16(0); 3640 3641 ptr += sizeof(*tlv); 3642 3643 /* ipv6 sync */ 3644 tlv = ptr; 3645 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_STRUCT); 3646 tlv->len = __cpu_to_le16(0); 3647 3648 ptr += sizeof(*tlv); 3649 3650 /* magic */ 3651 tlv = ptr; 3652 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_STRUCT); 3653 tlv->len = __cpu_to_le16(0); 3654 3655 ptr += sizeof(*tlv); 3656 3657 /* pattern info timeout */ 3658 tlv = ptr; 3659 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_UINT32); 3660 tlv->len = __cpu_to_le16(0); 3661 3662 ptr += sizeof(*tlv); 3663 3664 /* ratelimit interval */ 3665 tlv = ptr; 3666 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_UINT32); 3667 tlv->len = __cpu_to_le16(sizeof(u32)); 3668 3669 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv wow add pattern vdev_id %d pattern_id %d, pattern_offset %d\n", 3670 vdev_id, pattern_id, pattern_offset); 3671 return skb; 3672 } 3673 3674 static struct sk_buff * 3675 ath10k_wmi_tlv_op_gen_wow_del_pattern(struct ath10k *ar, u32 vdev_id, 3676 u32 pattern_id) 3677 { 3678 struct wmi_tlv_wow_del_pattern_cmd *cmd; 3679 struct wmi_tlv *tlv; 3680 struct sk_buff *skb; 3681 size_t len; 3682 3683 len = sizeof(*tlv) + sizeof(*cmd); 3684 skb = ath10k_wmi_alloc_skb(ar, len); 3685 if (!skb) 3686 return ERR_PTR(-ENOMEM); 3687 3688 tlv = (struct wmi_tlv *)skb->data; 3689 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_WOW_DEL_PATTERN_CMD); 3690 tlv->len = __cpu_to_le16(sizeof(*cmd)); 3691 cmd = (void *)tlv->value; 3692 3693 cmd->vdev_id = __cpu_to_le32(vdev_id); 3694 cmd->pattern_id = __cpu_to_le32(pattern_id); 3695 cmd->pattern_type = __cpu_to_le32(WOW_BITMAP_PATTERN); 3696 3697 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv wow del pattern vdev_id %d pattern_id %d\n", 3698 vdev_id, pattern_id); 3699 return skb; 3700 } 3701 3702 /* Request FW to start PNO operation */ 3703 static struct sk_buff * 3704 ath10k_wmi_tlv_op_gen_config_pno_start(struct ath10k *ar, 3705 u32 vdev_id, 3706 struct wmi_pno_scan_req *pno) 3707 { 3708 struct nlo_configured_parameters *nlo_list; 3709 struct wmi_tlv_wow_nlo_config_cmd *cmd; 3710 struct wmi_tlv *tlv; 3711 struct sk_buff *skb; 3712 __le32 *channel_list; 3713 u16 tlv_len; 3714 size_t len; 3715 void *ptr; 3716 u32 i; 3717 3718 len = sizeof(*tlv) + sizeof(*cmd) + 3719 sizeof(*tlv) + 3720 /* TLV place holder for array of structures 3721 * nlo_configured_parameters(nlo_list) 3722 */ 3723 sizeof(*tlv); 3724 /* TLV place holder for array of uint32 channel_list */ 3725 3726 len += sizeof(u32) * min_t(u8, pno->a_networks[0].channel_count, 3727 WMI_NLO_MAX_CHAN); 3728 len += sizeof(struct nlo_configured_parameters) * 3729 min_t(u8, pno->uc_networks_count, WMI_NLO_MAX_SSIDS); 3730 3731 skb = ath10k_wmi_alloc_skb(ar, len); 3732 if (!skb) 3733 return ERR_PTR(-ENOMEM); 3734 3735 ptr = (void *)skb->data; 3736 tlv = ptr; 3737 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_NLO_CONFIG_CMD); 3738 tlv->len = __cpu_to_le16(sizeof(*cmd)); 3739 cmd = (void *)tlv->value; 3740 3741 /* wmi_tlv_wow_nlo_config_cmd parameters*/ 3742 cmd->vdev_id = __cpu_to_le32(pno->vdev_id); 3743 cmd->flags = __cpu_to_le32(WMI_NLO_CONFIG_START | WMI_NLO_CONFIG_SSID_HIDE_EN); 3744 3745 /* current FW does not support min-max range for dwell time */ 3746 cmd->active_dwell_time = __cpu_to_le32(pno->active_max_time); 3747 cmd->passive_dwell_time = __cpu_to_le32(pno->passive_max_time); 3748 3749 if (pno->do_passive_scan) 3750 cmd->flags |= __cpu_to_le32(WMI_NLO_CONFIG_SCAN_PASSIVE); 3751 3752 /* copy scan interval */ 3753 cmd->fast_scan_period = __cpu_to_le32(pno->fast_scan_period); 3754 cmd->slow_scan_period = __cpu_to_le32(pno->slow_scan_period); 3755 cmd->fast_scan_max_cycles = __cpu_to_le32(pno->fast_scan_max_cycles); 3756 cmd->delay_start_time = __cpu_to_le32(pno->delay_start_time); 3757 3758 if (pno->enable_pno_scan_randomization) { 3759 cmd->flags |= __cpu_to_le32(WMI_NLO_CONFIG_SPOOFED_MAC_IN_PROBE_REQ | 3760 WMI_NLO_CONFIG_RANDOM_SEQ_NO_IN_PROBE_REQ); 3761 ether_addr_copy(cmd->mac_addr.addr, pno->mac_addr); 3762 ether_addr_copy(cmd->mac_mask.addr, pno->mac_addr_mask); 3763 } 3764 3765 ptr += sizeof(*tlv); 3766 ptr += sizeof(*cmd); 3767 3768 /* nlo_configured_parameters(nlo_list) */ 3769 cmd->no_of_ssids = __cpu_to_le32(min_t(u8, pno->uc_networks_count, 3770 WMI_NLO_MAX_SSIDS)); 3771 tlv_len = __le32_to_cpu(cmd->no_of_ssids) * 3772 sizeof(struct nlo_configured_parameters); 3773 3774 tlv = ptr; 3775 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_STRUCT); 3776 tlv->len = __cpu_to_le16(tlv_len); 3777 3778 ptr += sizeof(*tlv); 3779 nlo_list = ptr; 3780 for (i = 0; i < __le32_to_cpu(cmd->no_of_ssids); i++) { 3781 tlv = (struct wmi_tlv *)(&nlo_list[i].tlv_header); 3782 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_BYTE); 3783 tlv->len = __cpu_to_le16(sizeof(struct nlo_configured_parameters) - 3784 sizeof(*tlv)); 3785 3786 /* copy ssid and it's length */ 3787 nlo_list[i].ssid.valid = __cpu_to_le32(true); 3788 nlo_list[i].ssid.ssid.ssid_len = pno->a_networks[i].ssid.ssid_len; 3789 memcpy(nlo_list[i].ssid.ssid.ssid, 3790 pno->a_networks[i].ssid.ssid, 3791 __le32_to_cpu(nlo_list[i].ssid.ssid.ssid_len)); 3792 3793 /* copy rssi threshold */ 3794 if (pno->a_networks[i].rssi_threshold && 3795 pno->a_networks[i].rssi_threshold > -300) { 3796 nlo_list[i].rssi_cond.valid = __cpu_to_le32(true); 3797 nlo_list[i].rssi_cond.rssi = 3798 __cpu_to_le32(pno->a_networks[i].rssi_threshold); 3799 } 3800 3801 nlo_list[i].bcast_nw_type.valid = __cpu_to_le32(true); 3802 nlo_list[i].bcast_nw_type.bcast_nw_type = 3803 __cpu_to_le32(pno->a_networks[i].bcast_nw_type); 3804 } 3805 3806 ptr += __le32_to_cpu(cmd->no_of_ssids) * sizeof(struct nlo_configured_parameters); 3807 3808 /* copy channel info */ 3809 cmd->num_of_channels = __cpu_to_le32(min_t(u8, 3810 pno->a_networks[0].channel_count, 3811 WMI_NLO_MAX_CHAN)); 3812 3813 tlv = ptr; 3814 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_UINT32); 3815 tlv->len = __cpu_to_le16(__le32_to_cpu(cmd->num_of_channels) * 3816 sizeof(u_int32_t)); 3817 ptr += sizeof(*tlv); 3818 3819 channel_list = (__le32 *)ptr; 3820 for (i = 0; i < __le32_to_cpu(cmd->num_of_channels); i++) 3821 channel_list[i] = __cpu_to_le32(pno->a_networks[0].channels[i]); 3822 3823 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv start pno config vdev_id %d\n", 3824 vdev_id); 3825 3826 return skb; 3827 } 3828 3829 /* Request FW to stop ongoing PNO operation */ 3830 static struct sk_buff *ath10k_wmi_tlv_op_gen_config_pno_stop(struct ath10k *ar, 3831 u32 vdev_id) 3832 { 3833 struct wmi_tlv_wow_nlo_config_cmd *cmd; 3834 struct wmi_tlv *tlv; 3835 struct sk_buff *skb; 3836 void *ptr; 3837 size_t len; 3838 3839 len = sizeof(*tlv) + sizeof(*cmd) + 3840 sizeof(*tlv) + 3841 /* TLV place holder for array of structures 3842 * nlo_configured_parameters(nlo_list) 3843 */ 3844 sizeof(*tlv); 3845 /* TLV place holder for array of uint32 channel_list */ 3846 skb = ath10k_wmi_alloc_skb(ar, len); 3847 if (!skb) 3848 return ERR_PTR(-ENOMEM); 3849 3850 ptr = (void *)skb->data; 3851 tlv = ptr; 3852 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_NLO_CONFIG_CMD); 3853 tlv->len = __cpu_to_le16(sizeof(*cmd)); 3854 cmd = (void *)tlv->value; 3855 3856 cmd->vdev_id = __cpu_to_le32(vdev_id); 3857 cmd->flags = __cpu_to_le32(WMI_NLO_CONFIG_STOP); 3858 3859 ptr += sizeof(*tlv); 3860 ptr += sizeof(*cmd); 3861 3862 /* nlo_configured_parameters(nlo_list) */ 3863 tlv = ptr; 3864 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_STRUCT); 3865 tlv->len = __cpu_to_le16(0); 3866 3867 ptr += sizeof(*tlv); 3868 3869 /* channel list */ 3870 tlv = ptr; 3871 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_ARRAY_UINT32); 3872 tlv->len = __cpu_to_le16(0); 3873 3874 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv stop pno config vdev_id %d\n", vdev_id); 3875 return skb; 3876 } 3877 3878 static struct sk_buff * 3879 ath10k_wmi_tlv_op_gen_config_pno(struct ath10k *ar, u32 vdev_id, 3880 struct wmi_pno_scan_req *pno_scan) 3881 { 3882 if (pno_scan->enable) 3883 return ath10k_wmi_tlv_op_gen_config_pno_start(ar, vdev_id, pno_scan); 3884 else 3885 return ath10k_wmi_tlv_op_gen_config_pno_stop(ar, vdev_id); 3886 } 3887 3888 static struct sk_buff * 3889 ath10k_wmi_tlv_op_gen_adaptive_qcs(struct ath10k *ar, bool enable) 3890 { 3891 struct wmi_tlv_adaptive_qcs *cmd; 3892 struct wmi_tlv *tlv; 3893 struct sk_buff *skb; 3894 void *ptr; 3895 size_t len; 3896 3897 len = sizeof(*tlv) + sizeof(*cmd); 3898 skb = ath10k_wmi_alloc_skb(ar, len); 3899 if (!skb) 3900 return ERR_PTR(-ENOMEM); 3901 3902 ptr = (void *)skb->data; 3903 tlv = ptr; 3904 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_RESMGR_ADAPTIVE_OCS_CMD); 3905 tlv->len = __cpu_to_le16(sizeof(*cmd)); 3906 cmd = (void *)tlv->value; 3907 cmd->enable = __cpu_to_le32(enable ? 1 : 0); 3908 3909 ptr += sizeof(*tlv); 3910 ptr += sizeof(*cmd); 3911 3912 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv adaptive qcs %d\n", enable); 3913 return skb; 3914 } 3915 3916 static struct sk_buff * 3917 ath10k_wmi_tlv_op_gen_echo(struct ath10k *ar, u32 value) 3918 { 3919 struct wmi_echo_cmd *cmd; 3920 struct wmi_tlv *tlv; 3921 struct sk_buff *skb; 3922 void *ptr; 3923 size_t len; 3924 3925 len = sizeof(*tlv) + sizeof(*cmd); 3926 skb = ath10k_wmi_alloc_skb(ar, len); 3927 if (!skb) 3928 return ERR_PTR(-ENOMEM); 3929 3930 ptr = (void *)skb->data; 3931 tlv = ptr; 3932 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_ECHO_CMD); 3933 tlv->len = __cpu_to_le16(sizeof(*cmd)); 3934 cmd = (void *)tlv->value; 3935 cmd->value = cpu_to_le32(value); 3936 3937 ptr += sizeof(*tlv); 3938 ptr += sizeof(*cmd); 3939 3940 ath10k_dbg(ar, ATH10K_DBG_WMI, "wmi tlv echo value 0x%08x\n", value); 3941 return skb; 3942 } 3943 3944 static struct sk_buff * 3945 ath10k_wmi_tlv_op_gen_vdev_spectral_conf(struct ath10k *ar, 3946 const struct wmi_vdev_spectral_conf_arg *arg) 3947 { 3948 struct wmi_vdev_spectral_conf_cmd *cmd; 3949 struct sk_buff *skb; 3950 struct wmi_tlv *tlv; 3951 void *ptr; 3952 size_t len; 3953 3954 len = sizeof(*tlv) + sizeof(*cmd); 3955 skb = ath10k_wmi_alloc_skb(ar, len); 3956 if (!skb) 3957 return ERR_PTR(-ENOMEM); 3958 3959 ptr = (void *)skb->data; 3960 tlv = ptr; 3961 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_VDEV_SPECTRAL_CONFIGURE_CMD); 3962 tlv->len = __cpu_to_le16(sizeof(*cmd)); 3963 cmd = (void *)tlv->value; 3964 cmd->vdev_id = __cpu_to_le32(arg->vdev_id); 3965 cmd->scan_count = __cpu_to_le32(arg->scan_count); 3966 cmd->scan_period = __cpu_to_le32(arg->scan_period); 3967 cmd->scan_priority = __cpu_to_le32(arg->scan_priority); 3968 cmd->scan_fft_size = __cpu_to_le32(arg->scan_fft_size); 3969 cmd->scan_gc_ena = __cpu_to_le32(arg->scan_gc_ena); 3970 cmd->scan_restart_ena = __cpu_to_le32(arg->scan_restart_ena); 3971 cmd->scan_noise_floor_ref = __cpu_to_le32(arg->scan_noise_floor_ref); 3972 cmd->scan_init_delay = __cpu_to_le32(arg->scan_init_delay); 3973 cmd->scan_nb_tone_thr = __cpu_to_le32(arg->scan_nb_tone_thr); 3974 cmd->scan_str_bin_thr = __cpu_to_le32(arg->scan_str_bin_thr); 3975 cmd->scan_wb_rpt_mode = __cpu_to_le32(arg->scan_wb_rpt_mode); 3976 cmd->scan_rssi_rpt_mode = __cpu_to_le32(arg->scan_rssi_rpt_mode); 3977 cmd->scan_rssi_thr = __cpu_to_le32(arg->scan_rssi_thr); 3978 cmd->scan_pwr_format = __cpu_to_le32(arg->scan_pwr_format); 3979 cmd->scan_rpt_mode = __cpu_to_le32(arg->scan_rpt_mode); 3980 cmd->scan_bin_scale = __cpu_to_le32(arg->scan_bin_scale); 3981 cmd->scan_dbm_adj = __cpu_to_le32(arg->scan_dbm_adj); 3982 cmd->scan_chn_mask = __cpu_to_le32(arg->scan_chn_mask); 3983 3984 return skb; 3985 } 3986 3987 static struct sk_buff * 3988 ath10k_wmi_tlv_op_gen_vdev_spectral_enable(struct ath10k *ar, u32 vdev_id, 3989 u32 trigger, u32 enable) 3990 { 3991 struct wmi_vdev_spectral_enable_cmd *cmd; 3992 struct sk_buff *skb; 3993 struct wmi_tlv *tlv; 3994 void *ptr; 3995 size_t len; 3996 3997 len = sizeof(*tlv) + sizeof(*cmd); 3998 skb = ath10k_wmi_alloc_skb(ar, len); 3999 if (!skb) 4000 return ERR_PTR(-ENOMEM); 4001 4002 ptr = (void *)skb->data; 4003 tlv = ptr; 4004 tlv->tag = __cpu_to_le16(WMI_TLV_TAG_STRUCT_VDEV_SPECTRAL_ENABLE_CMD); 4005 tlv->len = __cpu_to_le16(sizeof(*cmd)); 4006 cmd = (void *)tlv->value; 4007 cmd->vdev_id = __cpu_to_le32(vdev_id); 4008 cmd->trigger_cmd = __cpu_to_le32(trigger); 4009 cmd->enable_cmd = __cpu_to_le32(enable); 4010 4011 return skb; 4012 } 4013 4014 /****************/ 4015 /* TLV mappings */ 4016 /****************/ 4017 4018 static struct wmi_cmd_map wmi_tlv_cmd_map = { 4019 .init_cmdid = WMI_TLV_INIT_CMDID, 4020 .start_scan_cmdid = WMI_TLV_START_SCAN_CMDID, 4021 .stop_scan_cmdid = WMI_TLV_STOP_SCAN_CMDID, 4022 .scan_chan_list_cmdid = WMI_TLV_SCAN_CHAN_LIST_CMDID, 4023 .scan_sch_prio_tbl_cmdid = WMI_TLV_SCAN_SCH_PRIO_TBL_CMDID, 4024 .scan_prob_req_oui_cmdid = WMI_TLV_SCAN_PROB_REQ_OUI_CMDID, 4025 .pdev_set_regdomain_cmdid = WMI_TLV_PDEV_SET_REGDOMAIN_CMDID, 4026 .pdev_set_channel_cmdid = WMI_TLV_PDEV_SET_CHANNEL_CMDID, 4027 .pdev_set_param_cmdid = WMI_TLV_PDEV_SET_PARAM_CMDID, 4028 .pdev_pktlog_enable_cmdid = WMI_TLV_PDEV_PKTLOG_ENABLE_CMDID, 4029 .pdev_pktlog_disable_cmdid = WMI_TLV_PDEV_PKTLOG_DISABLE_CMDID, 4030 .pdev_set_wmm_params_cmdid = WMI_TLV_PDEV_SET_WMM_PARAMS_CMDID, 4031 .pdev_set_ht_cap_ie_cmdid = WMI_TLV_PDEV_SET_HT_CAP_IE_CMDID, 4032 .pdev_set_vht_cap_ie_cmdid = WMI_TLV_PDEV_SET_VHT_CAP_IE_CMDID, 4033 .pdev_set_dscp_tid_map_cmdid = WMI_TLV_PDEV_SET_DSCP_TID_MAP_CMDID, 4034 .pdev_set_quiet_mode_cmdid = WMI_TLV_PDEV_SET_QUIET_MODE_CMDID, 4035 .pdev_green_ap_ps_enable_cmdid = WMI_TLV_PDEV_GREEN_AP_PS_ENABLE_CMDID, 4036 .pdev_get_tpc_config_cmdid = WMI_TLV_PDEV_GET_TPC_CONFIG_CMDID, 4037 .pdev_set_base_macaddr_cmdid = WMI_TLV_PDEV_SET_BASE_MACADDR_CMDID, 4038 .vdev_create_cmdid = WMI_TLV_VDEV_CREATE_CMDID, 4039 .vdev_delete_cmdid = WMI_TLV_VDEV_DELETE_CMDID, 4040 .vdev_start_request_cmdid = WMI_TLV_VDEV_START_REQUEST_CMDID, 4041 .vdev_restart_request_cmdid = WMI_TLV_VDEV_RESTART_REQUEST_CMDID, 4042 .vdev_up_cmdid = WMI_TLV_VDEV_UP_CMDID, 4043 .vdev_stop_cmdid = WMI_TLV_VDEV_STOP_CMDID, 4044 .vdev_down_cmdid = WMI_TLV_VDEV_DOWN_CMDID, 4045 .vdev_set_param_cmdid = WMI_TLV_VDEV_SET_PARAM_CMDID, 4046 .vdev_install_key_cmdid = WMI_TLV_VDEV_INSTALL_KEY_CMDID, 4047 .peer_create_cmdid = WMI_TLV_PEER_CREATE_CMDID, 4048 .peer_delete_cmdid = WMI_TLV_PEER_DELETE_CMDID, 4049 .peer_flush_tids_cmdid = WMI_TLV_PEER_FLUSH_TIDS_CMDID, 4050 .peer_set_param_cmdid = WMI_TLV_PEER_SET_PARAM_CMDID, 4051 .peer_assoc_cmdid = WMI_TLV_PEER_ASSOC_CMDID, 4052 .peer_add_wds_entry_cmdid = WMI_TLV_PEER_ADD_WDS_ENTRY_CMDID, 4053 .peer_remove_wds_entry_cmdid = WMI_TLV_PEER_REMOVE_WDS_ENTRY_CMDID, 4054 .peer_mcast_group_cmdid = WMI_TLV_PEER_MCAST_GROUP_CMDID, 4055 .bcn_tx_cmdid = WMI_TLV_BCN_TX_CMDID, 4056 .pdev_send_bcn_cmdid = WMI_TLV_PDEV_SEND_BCN_CMDID, 4057 .bcn_tmpl_cmdid = WMI_TLV_BCN_TMPL_CMDID, 4058 .bcn_filter_rx_cmdid = WMI_TLV_BCN_FILTER_RX_CMDID, 4059 .prb_req_filter_rx_cmdid = WMI_TLV_PRB_REQ_FILTER_RX_CMDID, 4060 .mgmt_tx_cmdid = WMI_TLV_MGMT_TX_CMDID, 4061 .mgmt_tx_send_cmdid = WMI_TLV_MGMT_TX_SEND_CMD, 4062 .prb_tmpl_cmdid = WMI_TLV_PRB_TMPL_CMDID, 4063 .addba_clear_resp_cmdid = WMI_TLV_ADDBA_CLEAR_RESP_CMDID, 4064 .addba_send_cmdid = WMI_TLV_ADDBA_SEND_CMDID, 4065 .addba_status_cmdid = WMI_TLV_ADDBA_STATUS_CMDID, 4066 .delba_send_cmdid = WMI_TLV_DELBA_SEND_CMDID, 4067 .addba_set_resp_cmdid = WMI_TLV_ADDBA_SET_RESP_CMDID, 4068 .send_singleamsdu_cmdid = WMI_TLV_SEND_SINGLEAMSDU_CMDID, 4069 .sta_powersave_mode_cmdid = WMI_TLV_STA_POWERSAVE_MODE_CMDID, 4070 .sta_powersave_param_cmdid = WMI_TLV_STA_POWERSAVE_PARAM_CMDID, 4071 .sta_mimo_ps_mode_cmdid = WMI_TLV_STA_MIMO_PS_MODE_CMDID, 4072 .pdev_dfs_enable_cmdid = WMI_TLV_PDEV_DFS_ENABLE_CMDID, 4073 .pdev_dfs_disable_cmdid = WMI_TLV_PDEV_DFS_DISABLE_CMDID, 4074 .roam_scan_mode = WMI_TLV_ROAM_SCAN_MODE, 4075 .roam_scan_rssi_threshold = WMI_TLV_ROAM_SCAN_RSSI_THRESHOLD, 4076 .roam_scan_period = WMI_TLV_ROAM_SCAN_PERIOD, 4077 .roam_scan_rssi_change_threshold = 4078 WMI_TLV_ROAM_SCAN_RSSI_CHANGE_THRESHOLD, 4079 .roam_ap_profile = WMI_TLV_ROAM_AP_PROFILE, 4080 .ofl_scan_add_ap_profile = WMI_TLV_ROAM_AP_PROFILE, 4081 .ofl_scan_remove_ap_profile = WMI_TLV_OFL_SCAN_REMOVE_AP_PROFILE, 4082 .ofl_scan_period = WMI_TLV_OFL_SCAN_PERIOD, 4083 .p2p_dev_set_device_info = WMI_TLV_P2P_DEV_SET_DEVICE_INFO, 4084 .p2p_dev_set_discoverability = WMI_TLV_P2P_DEV_SET_DISCOVERABILITY, 4085 .p2p_go_set_beacon_ie = WMI_TLV_P2P_GO_SET_BEACON_IE, 4086 .p2p_go_set_probe_resp_ie = WMI_TLV_P2P_GO_SET_PROBE_RESP_IE, 4087 .p2p_set_vendor_ie_data_cmdid = WMI_TLV_P2P_SET_VENDOR_IE_DATA_CMDID, 4088 .ap_ps_peer_param_cmdid = WMI_TLV_AP_PS_PEER_PARAM_CMDID, 4089 .ap_ps_peer_uapsd_coex_cmdid = WMI_TLV_AP_PS_PEER_UAPSD_COEX_CMDID, 4090 .peer_rate_retry_sched_cmdid = WMI_TLV_PEER_RATE_RETRY_SCHED_CMDID, 4091 .wlan_profile_trigger_cmdid = WMI_TLV_WLAN_PROFILE_TRIGGER_CMDID, 4092 .wlan_profile_set_hist_intvl_cmdid = 4093 WMI_TLV_WLAN_PROFILE_SET_HIST_INTVL_CMDID, 4094 .wlan_profile_get_profile_data_cmdid = 4095 WMI_TLV_WLAN_PROFILE_GET_PROFILE_DATA_CMDID, 4096 .wlan_profile_enable_profile_id_cmdid = 4097 WMI_TLV_WLAN_PROFILE_ENABLE_PROFILE_ID_CMDID, 4098 .wlan_profile_list_profile_id_cmdid = 4099 WMI_TLV_WLAN_PROFILE_LIST_PROFILE_ID_CMDID, 4100 .pdev_suspend_cmdid = WMI_TLV_PDEV_SUSPEND_CMDID, 4101 .pdev_resume_cmdid = WMI_TLV_PDEV_RESUME_CMDID, 4102 .add_bcn_filter_cmdid = WMI_TLV_ADD_BCN_FILTER_CMDID, 4103 .rmv_bcn_filter_cmdid = WMI_TLV_RMV_BCN_FILTER_CMDID, 4104 .wow_add_wake_pattern_cmdid = WMI_TLV_WOW_ADD_WAKE_PATTERN_CMDID, 4105 .wow_del_wake_pattern_cmdid = WMI_TLV_WOW_DEL_WAKE_PATTERN_CMDID, 4106 .wow_enable_disable_wake_event_cmdid = 4107 WMI_TLV_WOW_ENABLE_DISABLE_WAKE_EVENT_CMDID, 4108 .wow_enable_cmdid = WMI_TLV_WOW_ENABLE_CMDID, 4109 .wow_hostwakeup_from_sleep_cmdid = 4110 WMI_TLV_WOW_HOSTWAKEUP_FROM_SLEEP_CMDID, 4111 .rtt_measreq_cmdid = WMI_TLV_RTT_MEASREQ_CMDID, 4112 .rtt_tsf_cmdid = WMI_TLV_RTT_TSF_CMDID, 4113 .vdev_spectral_scan_configure_cmdid = WMI_TLV_SPECTRAL_SCAN_CONF_CMDID, 4114 .vdev_spectral_scan_enable_cmdid = WMI_TLV_SPECTRAL_SCAN_ENABLE_CMDID, 4115 .request_stats_cmdid = WMI_TLV_REQUEST_STATS_CMDID, 4116 .set_arp_ns_offload_cmdid = WMI_TLV_SET_ARP_NS_OFFLOAD_CMDID, 4117 .network_list_offload_config_cmdid = 4118 WMI_TLV_NETWORK_LIST_OFFLOAD_CONFIG_CMDID, 4119 .gtk_offload_cmdid = WMI_TLV_GTK_OFFLOAD_CMDID, 4120 .csa_offload_enable_cmdid = WMI_TLV_CSA_OFFLOAD_ENABLE_CMDID, 4121 .csa_offload_chanswitch_cmdid = WMI_TLV_CSA_OFFLOAD_CHANSWITCH_CMDID, 4122 .chatter_set_mode_cmdid = WMI_TLV_CHATTER_SET_MODE_CMDID, 4123 .peer_tid_addba_cmdid = WMI_TLV_PEER_TID_ADDBA_CMDID, 4124 .peer_tid_delba_cmdid = WMI_TLV_PEER_TID_DELBA_CMDID, 4125 .sta_dtim_ps_method_cmdid = WMI_TLV_STA_DTIM_PS_METHOD_CMDID, 4126 .sta_uapsd_auto_trig_cmdid = WMI_TLV_STA_UAPSD_AUTO_TRIG_CMDID, 4127 .sta_keepalive_cmd = WMI_TLV_STA_KEEPALIVE_CMDID, 4128 .echo_cmdid = WMI_TLV_ECHO_CMDID, 4129 .pdev_utf_cmdid = WMI_TLV_PDEV_UTF_CMDID, 4130 .dbglog_cfg_cmdid = WMI_TLV_DBGLOG_CFG_CMDID, 4131 .pdev_qvit_cmdid = WMI_TLV_PDEV_QVIT_CMDID, 4132 .pdev_ftm_intg_cmdid = WMI_TLV_PDEV_FTM_INTG_CMDID, 4133 .vdev_set_keepalive_cmdid = WMI_TLV_VDEV_SET_KEEPALIVE_CMDID, 4134 .vdev_get_keepalive_cmdid = WMI_TLV_VDEV_GET_KEEPALIVE_CMDID, 4135 .force_fw_hang_cmdid = WMI_TLV_FORCE_FW_HANG_CMDID, 4136 .gpio_config_cmdid = WMI_TLV_GPIO_CONFIG_CMDID, 4137 .gpio_output_cmdid = WMI_TLV_GPIO_OUTPUT_CMDID, 4138 .pdev_get_temperature_cmdid = WMI_TLV_PDEV_GET_TEMPERATURE_CMDID, 4139 .vdev_set_wmm_params_cmdid = WMI_TLV_VDEV_SET_WMM_PARAMS_CMDID, 4140 .tdls_set_state_cmdid = WMI_TLV_TDLS_SET_STATE_CMDID, 4141 .tdls_peer_update_cmdid = WMI_TLV_TDLS_PEER_UPDATE_CMDID, 4142 .adaptive_qcs_cmdid = WMI_TLV_RESMGR_ADAPTIVE_OCS_CMDID, 4143 .scan_update_request_cmdid = WMI_CMD_UNSUPPORTED, 4144 .vdev_standby_response_cmdid = WMI_CMD_UNSUPPORTED, 4145 .vdev_resume_response_cmdid = WMI_CMD_UNSUPPORTED, 4146 .wlan_peer_caching_add_peer_cmdid = WMI_CMD_UNSUPPORTED, 4147 .wlan_peer_caching_evict_peer_cmdid = WMI_CMD_UNSUPPORTED, 4148 .wlan_peer_caching_restore_peer_cmdid = WMI_CMD_UNSUPPORTED, 4149 .wlan_peer_caching_print_all_peers_info_cmdid = WMI_CMD_UNSUPPORTED, 4150 .peer_update_wds_entry_cmdid = WMI_CMD_UNSUPPORTED, 4151 .peer_add_proxy_sta_entry_cmdid = WMI_CMD_UNSUPPORTED, 4152 .rtt_keepalive_cmdid = WMI_CMD_UNSUPPORTED, 4153 .oem_req_cmdid = WMI_CMD_UNSUPPORTED, 4154 .nan_cmdid = WMI_CMD_UNSUPPORTED, 4155 .vdev_ratemask_cmdid = WMI_CMD_UNSUPPORTED, 4156 .qboost_cfg_cmdid = WMI_CMD_UNSUPPORTED, 4157 .pdev_smart_ant_enable_cmdid = WMI_CMD_UNSUPPORTED, 4158 .pdev_smart_ant_set_rx_antenna_cmdid = WMI_CMD_UNSUPPORTED, 4159 .peer_smart_ant_set_tx_antenna_cmdid = WMI_CMD_UNSUPPORTED, 4160 .peer_smart_ant_set_train_info_cmdid = WMI_CMD_UNSUPPORTED, 4161 .peer_smart_ant_set_node_config_ops_cmdid = WMI_CMD_UNSUPPORTED, 4162 .pdev_set_antenna_switch_table_cmdid = WMI_CMD_UNSUPPORTED, 4163 .pdev_set_ctl_table_cmdid = WMI_CMD_UNSUPPORTED, 4164 .pdev_set_mimogain_table_cmdid = WMI_CMD_UNSUPPORTED, 4165 .pdev_ratepwr_table_cmdid = WMI_CMD_UNSUPPORTED, 4166 .pdev_ratepwr_chainmsk_table_cmdid = WMI_CMD_UNSUPPORTED, 4167 .pdev_fips_cmdid = WMI_CMD_UNSUPPORTED, 4168 .tt_set_conf_cmdid = WMI_CMD_UNSUPPORTED, 4169 .fwtest_cmdid = WMI_CMD_UNSUPPORTED, 4170 .vdev_atf_request_cmdid = WMI_CMD_UNSUPPORTED, 4171 .peer_atf_request_cmdid = WMI_CMD_UNSUPPORTED, 4172 .pdev_get_ani_cck_config_cmdid = WMI_CMD_UNSUPPORTED, 4173 .pdev_get_ani_ofdm_config_cmdid = WMI_CMD_UNSUPPORTED, 4174 .pdev_reserve_ast_entry_cmdid = WMI_CMD_UNSUPPORTED, 4175 }; 4176 4177 static struct wmi_pdev_param_map wmi_tlv_pdev_param_map = { 4178 .tx_chain_mask = WMI_TLV_PDEV_PARAM_TX_CHAIN_MASK, 4179 .rx_chain_mask = WMI_TLV_PDEV_PARAM_RX_CHAIN_MASK, 4180 .txpower_limit2g = WMI_TLV_PDEV_PARAM_TXPOWER_LIMIT2G, 4181 .txpower_limit5g = WMI_TLV_PDEV_PARAM_TXPOWER_LIMIT5G, 4182 .txpower_scale = WMI_TLV_PDEV_PARAM_TXPOWER_SCALE, 4183 .beacon_gen_mode = WMI_TLV_PDEV_PARAM_BEACON_GEN_MODE, 4184 .beacon_tx_mode = WMI_TLV_PDEV_PARAM_BEACON_TX_MODE, 4185 .resmgr_offchan_mode = WMI_TLV_PDEV_PARAM_RESMGR_OFFCHAN_MODE, 4186 .protection_mode = WMI_TLV_PDEV_PARAM_PROTECTION_MODE, 4187 .dynamic_bw = WMI_TLV_PDEV_PARAM_DYNAMIC_BW, 4188 .non_agg_sw_retry_th = WMI_TLV_PDEV_PARAM_NON_AGG_SW_RETRY_TH, 4189 .agg_sw_retry_th = WMI_TLV_PDEV_PARAM_AGG_SW_RETRY_TH, 4190 .sta_kickout_th = WMI_TLV_PDEV_PARAM_STA_KICKOUT_TH, 4191 .ac_aggrsize_scaling = WMI_TLV_PDEV_PARAM_AC_AGGRSIZE_SCALING, 4192 .ltr_enable = WMI_TLV_PDEV_PARAM_LTR_ENABLE, 4193 .ltr_ac_latency_be = WMI_TLV_PDEV_PARAM_LTR_AC_LATENCY_BE, 4194 .ltr_ac_latency_bk = WMI_TLV_PDEV_PARAM_LTR_AC_LATENCY_BK, 4195 .ltr_ac_latency_vi = WMI_TLV_PDEV_PARAM_LTR_AC_LATENCY_VI, 4196 .ltr_ac_latency_vo = WMI_TLV_PDEV_PARAM_LTR_AC_LATENCY_VO, 4197 .ltr_ac_latency_timeout = WMI_TLV_PDEV_PARAM_LTR_AC_LATENCY_TIMEOUT, 4198 .ltr_sleep_override = WMI_TLV_PDEV_PARAM_LTR_SLEEP_OVERRIDE, 4199 .ltr_rx_override = WMI_TLV_PDEV_PARAM_LTR_RX_OVERRIDE, 4200 .ltr_tx_activity_timeout = WMI_TLV_PDEV_PARAM_LTR_TX_ACTIVITY_TIMEOUT, 4201 .l1ss_enable = WMI_TLV_PDEV_PARAM_L1SS_ENABLE, 4202 .dsleep_enable = WMI_TLV_PDEV_PARAM_DSLEEP_ENABLE, 4203 .pcielp_txbuf_flush = WMI_TLV_PDEV_PARAM_PCIELP_TXBUF_FLUSH, 4204 .pcielp_txbuf_watermark = WMI_TLV_PDEV_PARAM_PCIELP_TXBUF_TMO_EN, 4205 .pcielp_txbuf_tmo_en = WMI_TLV_PDEV_PARAM_PCIELP_TXBUF_TMO_EN, 4206 .pcielp_txbuf_tmo_value = WMI_TLV_PDEV_PARAM_PCIELP_TXBUF_TMO_VALUE, 4207 .pdev_stats_update_period = WMI_TLV_PDEV_PARAM_PDEV_STATS_UPDATE_PERIOD, 4208 .vdev_stats_update_period = WMI_TLV_PDEV_PARAM_VDEV_STATS_UPDATE_PERIOD, 4209 .peer_stats_update_period = WMI_TLV_PDEV_PARAM_PEER_STATS_UPDATE_PERIOD, 4210 .bcnflt_stats_update_period = 4211 WMI_TLV_PDEV_PARAM_BCNFLT_STATS_UPDATE_PERIOD, 4212 .pmf_qos = WMI_TLV_PDEV_PARAM_PMF_QOS, 4213 .arp_ac_override = WMI_TLV_PDEV_PARAM_ARP_AC_OVERRIDE, 4214 .dcs = WMI_TLV_PDEV_PARAM_DCS, 4215 .ani_enable = WMI_TLV_PDEV_PARAM_ANI_ENABLE, 4216 .ani_poll_period = WMI_TLV_PDEV_PARAM_ANI_POLL_PERIOD, 4217 .ani_listen_period = WMI_TLV_PDEV_PARAM_ANI_LISTEN_PERIOD, 4218 .ani_ofdm_level = WMI_TLV_PDEV_PARAM_ANI_OFDM_LEVEL, 4219 .ani_cck_level = WMI_TLV_PDEV_PARAM_ANI_CCK_LEVEL, 4220 .dyntxchain = WMI_TLV_PDEV_PARAM_DYNTXCHAIN, 4221 .proxy_sta = WMI_TLV_PDEV_PARAM_PROXY_STA, 4222 .idle_ps_config = WMI_TLV_PDEV_PARAM_IDLE_PS_CONFIG, 4223 .power_gating_sleep = WMI_TLV_PDEV_PARAM_POWER_GATING_SLEEP, 4224 .fast_channel_reset = WMI_TLV_PDEV_PARAM_UNSUPPORTED, 4225 .burst_dur = WMI_TLV_PDEV_PARAM_BURST_DUR, 4226 .burst_enable = WMI_TLV_PDEV_PARAM_BURST_ENABLE, 4227 .cal_period = WMI_PDEV_PARAM_UNSUPPORTED, 4228 .aggr_burst = WMI_PDEV_PARAM_UNSUPPORTED, 4229 .rx_decap_mode = WMI_PDEV_PARAM_UNSUPPORTED, 4230 .smart_antenna_default_antenna = WMI_PDEV_PARAM_UNSUPPORTED, 4231 .igmpmld_override = WMI_PDEV_PARAM_UNSUPPORTED, 4232 .igmpmld_tid = WMI_PDEV_PARAM_UNSUPPORTED, 4233 .antenna_gain = WMI_PDEV_PARAM_UNSUPPORTED, 4234 .rx_filter = WMI_PDEV_PARAM_UNSUPPORTED, 4235 .set_mcast_to_ucast_tid = WMI_PDEV_PARAM_UNSUPPORTED, 4236 .proxy_sta_mode = WMI_PDEV_PARAM_UNSUPPORTED, 4237 .set_mcast2ucast_mode = WMI_PDEV_PARAM_UNSUPPORTED, 4238 .set_mcast2ucast_buffer = WMI_PDEV_PARAM_UNSUPPORTED, 4239 .remove_mcast2ucast_buffer = WMI_PDEV_PARAM_UNSUPPORTED, 4240 .peer_sta_ps_statechg_enable = WMI_PDEV_PARAM_UNSUPPORTED, 4241 .igmpmld_ac_override = WMI_PDEV_PARAM_UNSUPPORTED, 4242 .block_interbss = WMI_PDEV_PARAM_UNSUPPORTED, 4243 .set_disable_reset_cmdid = WMI_PDEV_PARAM_UNSUPPORTED, 4244 .set_msdu_ttl_cmdid = WMI_PDEV_PARAM_UNSUPPORTED, 4245 .set_ppdu_duration_cmdid = WMI_PDEV_PARAM_UNSUPPORTED, 4246 .txbf_sound_period_cmdid = WMI_PDEV_PARAM_UNSUPPORTED, 4247 .set_promisc_mode_cmdid = WMI_PDEV_PARAM_UNSUPPORTED, 4248 .set_burst_mode_cmdid = WMI_PDEV_PARAM_UNSUPPORTED, 4249 .en_stats = WMI_PDEV_PARAM_UNSUPPORTED, 4250 .mu_group_policy = WMI_PDEV_PARAM_UNSUPPORTED, 4251 .noise_detection = WMI_PDEV_PARAM_UNSUPPORTED, 4252 .noise_threshold = WMI_PDEV_PARAM_UNSUPPORTED, 4253 .dpd_enable = WMI_PDEV_PARAM_UNSUPPORTED, 4254 .set_mcast_bcast_echo = WMI_PDEV_PARAM_UNSUPPORTED, 4255 .atf_strict_sch = WMI_PDEV_PARAM_UNSUPPORTED, 4256 .atf_sched_duration = WMI_PDEV_PARAM_UNSUPPORTED, 4257 .ant_plzn = WMI_PDEV_PARAM_UNSUPPORTED, 4258 .mgmt_retry_limit = WMI_PDEV_PARAM_UNSUPPORTED, 4259 .sensitivity_level = WMI_PDEV_PARAM_UNSUPPORTED, 4260 .signed_txpower_2g = WMI_PDEV_PARAM_UNSUPPORTED, 4261 .signed_txpower_5g = WMI_PDEV_PARAM_UNSUPPORTED, 4262 .enable_per_tid_amsdu = WMI_PDEV_PARAM_UNSUPPORTED, 4263 .enable_per_tid_ampdu = WMI_PDEV_PARAM_UNSUPPORTED, 4264 .cca_threshold = WMI_PDEV_PARAM_UNSUPPORTED, 4265 .rts_fixed_rate = WMI_PDEV_PARAM_UNSUPPORTED, 4266 .pdev_reset = WMI_PDEV_PARAM_UNSUPPORTED, 4267 .wapi_mbssid_offset = WMI_PDEV_PARAM_UNSUPPORTED, 4268 .arp_srcaddr = WMI_PDEV_PARAM_UNSUPPORTED, 4269 .arp_dstaddr = WMI_PDEV_PARAM_UNSUPPORTED, 4270 .rfkill_config = WMI_TLV_PDEV_PARAM_HW_RFKILL_CONFIG, 4271 .rfkill_enable = WMI_TLV_PDEV_PARAM_RFKILL_ENABLE, 4272 }; 4273 4274 static struct wmi_peer_param_map wmi_tlv_peer_param_map = { 4275 .smps_state = WMI_TLV_PEER_SMPS_STATE, 4276 .ampdu = WMI_TLV_PEER_AMPDU, 4277 .authorize = WMI_TLV_PEER_AUTHORIZE, 4278 .chan_width = WMI_TLV_PEER_CHAN_WIDTH, 4279 .nss = WMI_TLV_PEER_NSS, 4280 .use_4addr = WMI_TLV_PEER_USE_4ADDR, 4281 .membership = WMI_TLV_PEER_MEMBERSHIP, 4282 .user_pos = WMI_TLV_PEER_USERPOS, 4283 .crit_proto_hint_enabled = WMI_TLV_PEER_CRIT_PROTO_HINT_ENABLED, 4284 .tx_fail_cnt_thr = WMI_TLV_PEER_TX_FAIL_CNT_THR, 4285 .set_hw_retry_cts2s = WMI_TLV_PEER_SET_HW_RETRY_CTS2S, 4286 .ibss_atim_win_len = WMI_TLV_PEER_IBSS_ATIM_WINDOW_LENGTH, 4287 .phymode = WMI_TLV_PEER_PHYMODE, 4288 .use_fixed_power = WMI_TLV_PEER_USE_FIXED_PWR, 4289 .dummy_var = WMI_TLV_PEER_DUMMY_VAR, 4290 }; 4291 4292 static struct wmi_vdev_param_map wmi_tlv_vdev_param_map = { 4293 .rts_threshold = WMI_TLV_VDEV_PARAM_RTS_THRESHOLD, 4294 .fragmentation_threshold = WMI_TLV_VDEV_PARAM_FRAGMENTATION_THRESHOLD, 4295 .beacon_interval = WMI_TLV_VDEV_PARAM_BEACON_INTERVAL, 4296 .listen_interval = WMI_TLV_VDEV_PARAM_LISTEN_INTERVAL, 4297 .multicast_rate = WMI_TLV_VDEV_PARAM_MULTICAST_RATE, 4298 .mgmt_tx_rate = WMI_TLV_VDEV_PARAM_MGMT_TX_RATE, 4299 .slot_time = WMI_TLV_VDEV_PARAM_SLOT_TIME, 4300 .preamble = WMI_TLV_VDEV_PARAM_PREAMBLE, 4301 .swba_time = WMI_TLV_VDEV_PARAM_SWBA_TIME, 4302 .wmi_vdev_stats_update_period = WMI_TLV_VDEV_STATS_UPDATE_PERIOD, 4303 .wmi_vdev_pwrsave_ageout_time = WMI_TLV_VDEV_PWRSAVE_AGEOUT_TIME, 4304 .wmi_vdev_host_swba_interval = WMI_TLV_VDEV_HOST_SWBA_INTERVAL, 4305 .dtim_period = WMI_TLV_VDEV_PARAM_DTIM_PERIOD, 4306 .wmi_vdev_oc_scheduler_air_time_limit = 4307 WMI_TLV_VDEV_OC_SCHEDULER_AIR_TIME_LIMIT, 4308 .wds = WMI_TLV_VDEV_PARAM_WDS, 4309 .atim_window = WMI_TLV_VDEV_PARAM_ATIM_WINDOW, 4310 .bmiss_count_max = WMI_TLV_VDEV_PARAM_BMISS_COUNT_MAX, 4311 .bmiss_first_bcnt = WMI_TLV_VDEV_PARAM_BMISS_FIRST_BCNT, 4312 .bmiss_final_bcnt = WMI_TLV_VDEV_PARAM_BMISS_FINAL_BCNT, 4313 .feature_wmm = WMI_TLV_VDEV_PARAM_FEATURE_WMM, 4314 .chwidth = WMI_TLV_VDEV_PARAM_CHWIDTH, 4315 .chextoffset = WMI_TLV_VDEV_PARAM_CHEXTOFFSET, 4316 .disable_htprotection = WMI_TLV_VDEV_PARAM_DISABLE_HTPROTECTION, 4317 .sta_quickkickout = WMI_TLV_VDEV_PARAM_STA_QUICKKICKOUT, 4318 .mgmt_rate = WMI_TLV_VDEV_PARAM_MGMT_RATE, 4319 .protection_mode = WMI_TLV_VDEV_PARAM_PROTECTION_MODE, 4320 .fixed_rate = WMI_TLV_VDEV_PARAM_FIXED_RATE, 4321 .sgi = WMI_TLV_VDEV_PARAM_SGI, 4322 .ldpc = WMI_TLV_VDEV_PARAM_LDPC, 4323 .tx_stbc = WMI_TLV_VDEV_PARAM_TX_STBC, 4324 .rx_stbc = WMI_TLV_VDEV_PARAM_RX_STBC, 4325 .intra_bss_fwd = WMI_TLV_VDEV_PARAM_INTRA_BSS_FWD, 4326 .def_keyid = WMI_TLV_VDEV_PARAM_DEF_KEYID, 4327 .nss = WMI_TLV_VDEV_PARAM_NSS, 4328 .bcast_data_rate = WMI_TLV_VDEV_PARAM_BCAST_DATA_RATE, 4329 .mcast_data_rate = WMI_TLV_VDEV_PARAM_MCAST_DATA_RATE, 4330 .mcast_indicate = WMI_TLV_VDEV_PARAM_MCAST_INDICATE, 4331 .dhcp_indicate = WMI_TLV_VDEV_PARAM_DHCP_INDICATE, 4332 .unknown_dest_indicate = WMI_TLV_VDEV_PARAM_UNKNOWN_DEST_INDICATE, 4333 .ap_keepalive_min_idle_inactive_time_secs = 4334 WMI_TLV_VDEV_PARAM_AP_KEEPALIVE_MIN_IDLE_INACTIVE_TIME_SECS, 4335 .ap_keepalive_max_idle_inactive_time_secs = 4336 WMI_TLV_VDEV_PARAM_AP_KEEPALIVE_MAX_IDLE_INACTIVE_TIME_SECS, 4337 .ap_keepalive_max_unresponsive_time_secs = 4338 WMI_TLV_VDEV_PARAM_AP_KEEPALIVE_MAX_UNRESPONSIVE_TIME_SECS, 4339 .ap_enable_nawds = WMI_TLV_VDEV_PARAM_AP_ENABLE_NAWDS, 4340 .mcast2ucast_set = WMI_TLV_VDEV_PARAM_UNSUPPORTED, 4341 .enable_rtscts = WMI_TLV_VDEV_PARAM_ENABLE_RTSCTS, 4342 .txbf = WMI_TLV_VDEV_PARAM_TXBF, 4343 .packet_powersave = WMI_TLV_VDEV_PARAM_PACKET_POWERSAVE, 4344 .drop_unencry = WMI_TLV_VDEV_PARAM_DROP_UNENCRY, 4345 .tx_encap_type = WMI_TLV_VDEV_PARAM_TX_ENCAP_TYPE, 4346 .ap_detect_out_of_sync_sleeping_sta_time_secs = 4347 WMI_TLV_VDEV_PARAM_UNSUPPORTED, 4348 .rc_num_retries = WMI_VDEV_PARAM_UNSUPPORTED, 4349 .cabq_maxdur = WMI_VDEV_PARAM_UNSUPPORTED, 4350 .mfptest_set = WMI_VDEV_PARAM_UNSUPPORTED, 4351 .rts_fixed_rate = WMI_VDEV_PARAM_UNSUPPORTED, 4352 .vht_sgimask = WMI_VDEV_PARAM_UNSUPPORTED, 4353 .vht80_ratemask = WMI_VDEV_PARAM_UNSUPPORTED, 4354 .early_rx_adjust_enable = WMI_VDEV_PARAM_UNSUPPORTED, 4355 .early_rx_tgt_bmiss_num = WMI_VDEV_PARAM_UNSUPPORTED, 4356 .early_rx_bmiss_sample_cycle = WMI_VDEV_PARAM_UNSUPPORTED, 4357 .early_rx_slop_step = WMI_VDEV_PARAM_UNSUPPORTED, 4358 .early_rx_init_slop = WMI_VDEV_PARAM_UNSUPPORTED, 4359 .early_rx_adjust_pause = WMI_VDEV_PARAM_UNSUPPORTED, 4360 .proxy_sta = WMI_VDEV_PARAM_UNSUPPORTED, 4361 .meru_vc = WMI_VDEV_PARAM_UNSUPPORTED, 4362 .rx_decap_type = WMI_VDEV_PARAM_UNSUPPORTED, 4363 .bw_nss_ratemask = WMI_VDEV_PARAM_UNSUPPORTED, 4364 }; 4365 4366 static const struct wmi_ops wmi_tlv_ops = { 4367 .rx = ath10k_wmi_tlv_op_rx, 4368 .map_svc = wmi_tlv_svc_map, 4369 .map_svc_ext = wmi_tlv_svc_map_ext, 4370 4371 .pull_scan = ath10k_wmi_tlv_op_pull_scan_ev, 4372 .pull_mgmt_rx = ath10k_wmi_tlv_op_pull_mgmt_rx_ev, 4373 .pull_mgmt_tx_compl = ath10k_wmi_tlv_op_pull_mgmt_tx_compl_ev, 4374 .pull_mgmt_tx_bundle_compl = ath10k_wmi_tlv_op_pull_mgmt_tx_bundle_compl_ev, 4375 .pull_ch_info = ath10k_wmi_tlv_op_pull_ch_info_ev, 4376 .pull_vdev_start = ath10k_wmi_tlv_op_pull_vdev_start_ev, 4377 .pull_peer_kick = ath10k_wmi_tlv_op_pull_peer_kick_ev, 4378 .pull_swba = ath10k_wmi_tlv_op_pull_swba_ev, 4379 .pull_phyerr_hdr = ath10k_wmi_tlv_op_pull_phyerr_ev_hdr, 4380 .pull_phyerr = ath10k_wmi_op_pull_phyerr_ev, 4381 .pull_svc_rdy = ath10k_wmi_tlv_op_pull_svc_rdy_ev, 4382 .pull_rdy = ath10k_wmi_tlv_op_pull_rdy_ev, 4383 .pull_svc_avail = ath10k_wmi_tlv_op_pull_svc_avail, 4384 .pull_fw_stats = ath10k_wmi_tlv_op_pull_fw_stats, 4385 .pull_roam_ev = ath10k_wmi_tlv_op_pull_roam_ev, 4386 .pull_wow_event = ath10k_wmi_tlv_op_pull_wow_ev, 4387 .pull_echo_ev = ath10k_wmi_tlv_op_pull_echo_ev, 4388 .get_txbf_conf_scheme = ath10k_wmi_tlv_txbf_conf_scheme, 4389 4390 .gen_pdev_suspend = ath10k_wmi_tlv_op_gen_pdev_suspend, 4391 .gen_pdev_resume = ath10k_wmi_tlv_op_gen_pdev_resume, 4392 .gen_pdev_set_rd = ath10k_wmi_tlv_op_gen_pdev_set_rd, 4393 .gen_pdev_set_param = ath10k_wmi_tlv_op_gen_pdev_set_param, 4394 .gen_init = ath10k_wmi_tlv_op_gen_init, 4395 .gen_start_scan = ath10k_wmi_tlv_op_gen_start_scan, 4396 .gen_stop_scan = ath10k_wmi_tlv_op_gen_stop_scan, 4397 .gen_vdev_create = ath10k_wmi_tlv_op_gen_vdev_create, 4398 .gen_vdev_delete = ath10k_wmi_tlv_op_gen_vdev_delete, 4399 .gen_vdev_start = ath10k_wmi_tlv_op_gen_vdev_start, 4400 .gen_vdev_stop = ath10k_wmi_tlv_op_gen_vdev_stop, 4401 .gen_vdev_up = ath10k_wmi_tlv_op_gen_vdev_up, 4402 .gen_vdev_down = ath10k_wmi_tlv_op_gen_vdev_down, 4403 .gen_vdev_set_param = ath10k_wmi_tlv_op_gen_vdev_set_param, 4404 .gen_vdev_install_key = ath10k_wmi_tlv_op_gen_vdev_install_key, 4405 .gen_vdev_wmm_conf = ath10k_wmi_tlv_op_gen_vdev_wmm_conf, 4406 .gen_peer_create = ath10k_wmi_tlv_op_gen_peer_create, 4407 .gen_peer_delete = ath10k_wmi_tlv_op_gen_peer_delete, 4408 .gen_peer_flush = ath10k_wmi_tlv_op_gen_peer_flush, 4409 .gen_peer_set_param = ath10k_wmi_tlv_op_gen_peer_set_param, 4410 .gen_peer_assoc = ath10k_wmi_tlv_op_gen_peer_assoc, 4411 .gen_set_psmode = ath10k_wmi_tlv_op_gen_set_psmode, 4412 .gen_set_sta_ps = ath10k_wmi_tlv_op_gen_set_sta_ps, 4413 .gen_set_ap_ps = ath10k_wmi_tlv_op_gen_set_ap_ps, 4414 .gen_scan_chan_list = ath10k_wmi_tlv_op_gen_scan_chan_list, 4415 .gen_scan_prob_req_oui = ath10k_wmi_tlv_op_gen_scan_prob_req_oui, 4416 .gen_beacon_dma = ath10k_wmi_tlv_op_gen_beacon_dma, 4417 .gen_pdev_set_wmm = ath10k_wmi_tlv_op_gen_pdev_set_wmm, 4418 .gen_request_stats = ath10k_wmi_tlv_op_gen_request_stats, 4419 .gen_force_fw_hang = ath10k_wmi_tlv_op_gen_force_fw_hang, 4420 /* .gen_mgmt_tx = not implemented; HTT is used */ 4421 .gen_mgmt_tx_send = ath10k_wmi_tlv_op_gen_mgmt_tx_send, 4422 .gen_dbglog_cfg = ath10k_wmi_tlv_op_gen_dbglog_cfg, 4423 .gen_pktlog_enable = ath10k_wmi_tlv_op_gen_pktlog_enable, 4424 .gen_pktlog_disable = ath10k_wmi_tlv_op_gen_pktlog_disable, 4425 .gen_pdev_set_quiet_mode = ath10k_wmi_tlv_op_gen_pdev_set_quiet_mode, 4426 .gen_pdev_get_temperature = ath10k_wmi_tlv_op_gen_pdev_get_temperature, 4427 /* .gen_addba_clear_resp not implemented */ 4428 /* .gen_addba_send not implemented */ 4429 /* .gen_addba_set_resp not implemented */ 4430 /* .gen_delba_send not implemented */ 4431 .gen_bcn_tmpl = ath10k_wmi_tlv_op_gen_bcn_tmpl, 4432 .gen_prb_tmpl = ath10k_wmi_tlv_op_gen_prb_tmpl, 4433 .gen_p2p_go_bcn_ie = ath10k_wmi_tlv_op_gen_p2p_go_bcn_ie, 4434 .gen_vdev_sta_uapsd = ath10k_wmi_tlv_op_gen_vdev_sta_uapsd, 4435 .gen_sta_keepalive = ath10k_wmi_tlv_op_gen_sta_keepalive, 4436 .gen_wow_enable = ath10k_wmi_tlv_op_gen_wow_enable, 4437 .gen_wow_add_wakeup_event = ath10k_wmi_tlv_op_gen_wow_add_wakeup_event, 4438 .gen_wow_host_wakeup_ind = ath10k_wmi_tlv_gen_wow_host_wakeup_ind, 4439 .gen_wow_add_pattern = ath10k_wmi_tlv_op_gen_wow_add_pattern, 4440 .gen_wow_del_pattern = ath10k_wmi_tlv_op_gen_wow_del_pattern, 4441 .gen_wow_config_pno = ath10k_wmi_tlv_op_gen_config_pno, 4442 .gen_update_fw_tdls_state = ath10k_wmi_tlv_op_gen_update_fw_tdls_state, 4443 .gen_tdls_peer_update = ath10k_wmi_tlv_op_gen_tdls_peer_update, 4444 .gen_adaptive_qcs = ath10k_wmi_tlv_op_gen_adaptive_qcs, 4445 .fw_stats_fill = ath10k_wmi_main_op_fw_stats_fill, 4446 .get_vdev_subtype = ath10k_wmi_tlv_op_get_vdev_subtype, 4447 .gen_echo = ath10k_wmi_tlv_op_gen_echo, 4448 .gen_vdev_spectral_conf = ath10k_wmi_tlv_op_gen_vdev_spectral_conf, 4449 .gen_vdev_spectral_enable = ath10k_wmi_tlv_op_gen_vdev_spectral_enable, 4450 }; 4451 4452 static const struct wmi_peer_flags_map wmi_tlv_peer_flags_map = { 4453 .auth = WMI_TLV_PEER_AUTH, 4454 .qos = WMI_TLV_PEER_QOS, 4455 .need_ptk_4_way = WMI_TLV_PEER_NEED_PTK_4_WAY, 4456 .need_gtk_2_way = WMI_TLV_PEER_NEED_GTK_2_WAY, 4457 .apsd = WMI_TLV_PEER_APSD, 4458 .ht = WMI_TLV_PEER_HT, 4459 .bw40 = WMI_TLV_PEER_40MHZ, 4460 .stbc = WMI_TLV_PEER_STBC, 4461 .ldbc = WMI_TLV_PEER_LDPC, 4462 .dyn_mimops = WMI_TLV_PEER_DYN_MIMOPS, 4463 .static_mimops = WMI_TLV_PEER_STATIC_MIMOPS, 4464 .spatial_mux = WMI_TLV_PEER_SPATIAL_MUX, 4465 .vht = WMI_TLV_PEER_VHT, 4466 .bw80 = WMI_TLV_PEER_80MHZ, 4467 .pmf = WMI_TLV_PEER_PMF, 4468 .bw160 = WMI_TLV_PEER_160MHZ, 4469 }; 4470 4471 /************/ 4472 /* TLV init */ 4473 /************/ 4474 4475 void ath10k_wmi_tlv_attach(struct ath10k *ar) 4476 { 4477 ar->wmi.cmd = &wmi_tlv_cmd_map; 4478 ar->wmi.vdev_param = &wmi_tlv_vdev_param_map; 4479 ar->wmi.pdev_param = &wmi_tlv_pdev_param_map; 4480 ar->wmi.peer_param = &wmi_tlv_peer_param_map; 4481 ar->wmi.ops = &wmi_tlv_ops; 4482 ar->wmi.peer_flags = &wmi_tlv_peer_flags_map; 4483 } 4484