wmi.c revision 7cc23016366e183dcaf23afa4a0dca61ff7f787a
1/* 2 * Copyright (c) 2005-2011 Atheros Communications Inc. 3 * Copyright (c) 2011-2013 Qualcomm Atheros, Inc. 4 * 5 * Permission to use, copy, modify, and/or distribute this software for any 6 * purpose with or without fee is hereby granted, provided that the above 7 * copyright notice and this permission notice appear in all copies. 8 * 9 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES 10 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF 11 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR 12 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES 13 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 14 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 15 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 16 */ 17 18#include <linux/skbuff.h> 19 20#include "core.h" 21#include "htc.h" 22#include "debug.h" 23#include "wmi.h" 24#include "mac.h" 25 26int ath10k_wmi_wait_for_service_ready(struct ath10k *ar) 27{ 28 int ret; 29 ret = wait_for_completion_timeout(&ar->wmi.service_ready, 30 WMI_SERVICE_READY_TIMEOUT_HZ); 31 return ret; 32} 33 34int ath10k_wmi_wait_for_unified_ready(struct ath10k *ar) 35{ 36 int ret; 37 ret = wait_for_completion_timeout(&ar->wmi.unified_ready, 38 WMI_UNIFIED_READY_TIMEOUT_HZ); 39 return ret; 40} 41 42static struct sk_buff *ath10k_wmi_alloc_skb(u32 len) 43{ 44 struct sk_buff *skb; 45 u32 round_len = roundup(len, 4); 46 47 skb = ath10k_htc_alloc_skb(WMI_SKB_HEADROOM + round_len); 48 if (!skb) 49 return NULL; 50 51 skb_reserve(skb, WMI_SKB_HEADROOM); 52 if (!IS_ALIGNED((unsigned long)skb->data, 4)) 53 ath10k_warn("Unaligned WMI skb\n"); 54 55 skb_put(skb, round_len); 56 memset(skb->data, 0, round_len); 57 58 return skb; 59} 60 61static void ath10k_wmi_htc_tx_complete(struct ath10k *ar, struct sk_buff *skb) 62{ 63 dev_kfree_skb(skb); 64} 65 66static int ath10k_wmi_cmd_send_nowait(struct ath10k *ar, struct sk_buff *skb, 67 enum wmi_cmd_id cmd_id) 68{ 69 struct ath10k_skb_cb *skb_cb = ATH10K_SKB_CB(skb); 70 struct wmi_cmd_hdr *cmd_hdr; 71 int ret; 72 u32 cmd = 0; 73 74 if (skb_push(skb, sizeof(struct wmi_cmd_hdr)) == NULL) 75 return -ENOMEM; 76 77 cmd |= SM(cmd_id, WMI_CMD_HDR_CMD_ID); 78 79 cmd_hdr = (struct wmi_cmd_hdr *)skb->data; 80 cmd_hdr->cmd_id = __cpu_to_le32(cmd); 81 82 memset(skb_cb, 0, sizeof(*skb_cb)); 83 ret = ath10k_htc_send(&ar->htc, ar->wmi.eid, skb); 84 trace_ath10k_wmi_cmd(cmd_id, skb->data, skb->len, ret); 85 86 if (ret) 87 goto err_pull; 88 89 return 0; 90 91err_pull: 92 skb_pull(skb, sizeof(struct wmi_cmd_hdr)); 93 return ret; 94} 95 96static void ath10k_wmi_tx_beacon_nowait(struct ath10k_vif *arvif) 97{ 98 struct wmi_bcn_tx_arg arg = {0}; 99 int ret; 100 101 lockdep_assert_held(&arvif->ar->data_lock); 102 103 if (arvif->beacon == NULL) 104 return; 105 106 arg.vdev_id = arvif->vdev_id; 107 arg.tx_rate = 0; 108 arg.tx_power = 0; 109 arg.bcn = arvif->beacon->data; 110 arg.bcn_len = arvif->beacon->len; 111 112 ret = ath10k_wmi_beacon_send_nowait(arvif->ar, &arg); 113 if (ret) 114 return; 115 116 dev_kfree_skb_any(arvif->beacon); 117 arvif->beacon = NULL; 118} 119 120static void ath10k_wmi_tx_beacons_iter(void *data, u8 *mac, 121 struct ieee80211_vif *vif) 122{ 123 struct ath10k_vif *arvif = ath10k_vif_to_arvif(vif); 124 125 ath10k_wmi_tx_beacon_nowait(arvif); 126} 127 128static void ath10k_wmi_tx_beacons_nowait(struct ath10k *ar) 129{ 130 spin_lock_bh(&ar->data_lock); 131 ieee80211_iterate_active_interfaces_atomic(ar->hw, 132 IEEE80211_IFACE_ITER_NORMAL, 133 ath10k_wmi_tx_beacons_iter, 134 NULL); 135 spin_unlock_bh(&ar->data_lock); 136} 137 138static void ath10k_wmi_op_ep_tx_credits(struct ath10k *ar) 139{ 140 /* try to send pending beacons first. they take priority */ 141 ath10k_wmi_tx_beacons_nowait(ar); 142 143 wake_up(&ar->wmi.tx_credits_wq); 144} 145 146static int ath10k_wmi_cmd_send(struct ath10k *ar, struct sk_buff *skb, 147 enum wmi_cmd_id cmd_id) 148{ 149 int ret = -EINVAL; 150 151 wait_event_timeout(ar->wmi.tx_credits_wq, ({ 152 /* try to send pending beacons first. they take priority */ 153 ath10k_wmi_tx_beacons_nowait(ar); 154 155 ret = ath10k_wmi_cmd_send_nowait(ar, skb, cmd_id); 156 (ret != -EAGAIN); 157 }), 3*HZ); 158 159 if (ret) 160 dev_kfree_skb_any(skb); 161 162 return ret; 163} 164 165static int ath10k_wmi_event_scan(struct ath10k *ar, struct sk_buff *skb) 166{ 167 struct wmi_scan_event *event = (struct wmi_scan_event *)skb->data; 168 enum wmi_scan_event_type event_type; 169 enum wmi_scan_completion_reason reason; 170 u32 freq; 171 u32 req_id; 172 u32 scan_id; 173 u32 vdev_id; 174 175 event_type = __le32_to_cpu(event->event_type); 176 reason = __le32_to_cpu(event->reason); 177 freq = __le32_to_cpu(event->channel_freq); 178 req_id = __le32_to_cpu(event->scan_req_id); 179 scan_id = __le32_to_cpu(event->scan_id); 180 vdev_id = __le32_to_cpu(event->vdev_id); 181 182 ath10k_dbg(ATH10K_DBG_WMI, "WMI_SCAN_EVENTID\n"); 183 ath10k_dbg(ATH10K_DBG_WMI, 184 "scan event type %d reason %d freq %d req_id %d " 185 "scan_id %d vdev_id %d\n", 186 event_type, reason, freq, req_id, scan_id, vdev_id); 187 188 spin_lock_bh(&ar->data_lock); 189 190 switch (event_type) { 191 case WMI_SCAN_EVENT_STARTED: 192 ath10k_dbg(ATH10K_DBG_WMI, "SCAN_EVENT_STARTED\n"); 193 if (ar->scan.in_progress && ar->scan.is_roc) 194 ieee80211_ready_on_channel(ar->hw); 195 196 complete(&ar->scan.started); 197 break; 198 case WMI_SCAN_EVENT_COMPLETED: 199 ath10k_dbg(ATH10K_DBG_WMI, "SCAN_EVENT_COMPLETED\n"); 200 switch (reason) { 201 case WMI_SCAN_REASON_COMPLETED: 202 ath10k_dbg(ATH10K_DBG_WMI, "SCAN_REASON_COMPLETED\n"); 203 break; 204 case WMI_SCAN_REASON_CANCELLED: 205 ath10k_dbg(ATH10K_DBG_WMI, "SCAN_REASON_CANCELED\n"); 206 break; 207 case WMI_SCAN_REASON_PREEMPTED: 208 ath10k_dbg(ATH10K_DBG_WMI, "SCAN_REASON_PREEMPTED\n"); 209 break; 210 case WMI_SCAN_REASON_TIMEDOUT: 211 ath10k_dbg(ATH10K_DBG_WMI, "SCAN_REASON_TIMEDOUT\n"); 212 break; 213 default: 214 break; 215 } 216 217 ar->scan_channel = NULL; 218 if (!ar->scan.in_progress) { 219 ath10k_warn("no scan requested, ignoring\n"); 220 break; 221 } 222 223 if (ar->scan.is_roc) { 224 ath10k_offchan_tx_purge(ar); 225 226 if (!ar->scan.aborting) 227 ieee80211_remain_on_channel_expired(ar->hw); 228 } else { 229 ieee80211_scan_completed(ar->hw, ar->scan.aborting); 230 } 231 232 del_timer(&ar->scan.timeout); 233 complete_all(&ar->scan.completed); 234 ar->scan.in_progress = false; 235 break; 236 case WMI_SCAN_EVENT_BSS_CHANNEL: 237 ath10k_dbg(ATH10K_DBG_WMI, "SCAN_EVENT_BSS_CHANNEL\n"); 238 ar->scan_channel = NULL; 239 break; 240 case WMI_SCAN_EVENT_FOREIGN_CHANNEL: 241 ath10k_dbg(ATH10K_DBG_WMI, "SCAN_EVENT_FOREIGN_CHANNEL\n"); 242 ar->scan_channel = ieee80211_get_channel(ar->hw->wiphy, freq); 243 if (ar->scan.in_progress && ar->scan.is_roc && 244 ar->scan.roc_freq == freq) { 245 complete(&ar->scan.on_channel); 246 } 247 break; 248 case WMI_SCAN_EVENT_DEQUEUED: 249 ath10k_dbg(ATH10K_DBG_WMI, "SCAN_EVENT_DEQUEUED\n"); 250 break; 251 case WMI_SCAN_EVENT_PREEMPTED: 252 ath10k_dbg(ATH10K_DBG_WMI, "WMI_SCAN_EVENT_PREEMPTED\n"); 253 break; 254 case WMI_SCAN_EVENT_START_FAILED: 255 ath10k_dbg(ATH10K_DBG_WMI, "WMI_SCAN_EVENT_START_FAILED\n"); 256 break; 257 default: 258 break; 259 } 260 261 spin_unlock_bh(&ar->data_lock); 262 return 0; 263} 264 265static inline enum ieee80211_band phy_mode_to_band(u32 phy_mode) 266{ 267 enum ieee80211_band band; 268 269 switch (phy_mode) { 270 case MODE_11A: 271 case MODE_11NA_HT20: 272 case MODE_11NA_HT40: 273 case MODE_11AC_VHT20: 274 case MODE_11AC_VHT40: 275 case MODE_11AC_VHT80: 276 band = IEEE80211_BAND_5GHZ; 277 break; 278 case MODE_11G: 279 case MODE_11B: 280 case MODE_11GONLY: 281 case MODE_11NG_HT20: 282 case MODE_11NG_HT40: 283 case MODE_11AC_VHT20_2G: 284 case MODE_11AC_VHT40_2G: 285 case MODE_11AC_VHT80_2G: 286 default: 287 band = IEEE80211_BAND_2GHZ; 288 } 289 290 return band; 291} 292 293static inline u8 get_rate_idx(u32 rate, enum ieee80211_band band) 294{ 295 u8 rate_idx = 0; 296 297 /* rate in Kbps */ 298 switch (rate) { 299 case 1000: 300 rate_idx = 0; 301 break; 302 case 2000: 303 rate_idx = 1; 304 break; 305 case 5500: 306 rate_idx = 2; 307 break; 308 case 11000: 309 rate_idx = 3; 310 break; 311 case 6000: 312 rate_idx = 4; 313 break; 314 case 9000: 315 rate_idx = 5; 316 break; 317 case 12000: 318 rate_idx = 6; 319 break; 320 case 18000: 321 rate_idx = 7; 322 break; 323 case 24000: 324 rate_idx = 8; 325 break; 326 case 36000: 327 rate_idx = 9; 328 break; 329 case 48000: 330 rate_idx = 10; 331 break; 332 case 54000: 333 rate_idx = 11; 334 break; 335 default: 336 break; 337 } 338 339 if (band == IEEE80211_BAND_5GHZ) { 340 if (rate_idx > 3) 341 /* Omit CCK rates */ 342 rate_idx -= 4; 343 else 344 rate_idx = 0; 345 } 346 347 return rate_idx; 348} 349 350static int ath10k_wmi_event_mgmt_rx(struct ath10k *ar, struct sk_buff *skb) 351{ 352 struct wmi_mgmt_rx_event_v1 *ev_v1; 353 struct wmi_mgmt_rx_event_v2 *ev_v2; 354 struct wmi_mgmt_rx_hdr_v1 *ev_hdr; 355 struct ieee80211_rx_status *status = IEEE80211_SKB_RXCB(skb); 356 struct ieee80211_hdr *hdr; 357 u32 rx_status; 358 u32 channel; 359 u32 phy_mode; 360 u32 snr; 361 u32 rate; 362 u32 buf_len; 363 u16 fc; 364 int pull_len; 365 366 if (test_bit(ATH10K_FW_FEATURE_EXT_WMI_MGMT_RX, ar->fw_features)) { 367 ev_v2 = (struct wmi_mgmt_rx_event_v2 *)skb->data; 368 ev_hdr = &ev_v2->hdr.v1; 369 pull_len = sizeof(*ev_v2); 370 } else { 371 ev_v1 = (struct wmi_mgmt_rx_event_v1 *)skb->data; 372 ev_hdr = &ev_v1->hdr; 373 pull_len = sizeof(*ev_v1); 374 } 375 376 channel = __le32_to_cpu(ev_hdr->channel); 377 buf_len = __le32_to_cpu(ev_hdr->buf_len); 378 rx_status = __le32_to_cpu(ev_hdr->status); 379 snr = __le32_to_cpu(ev_hdr->snr); 380 phy_mode = __le32_to_cpu(ev_hdr->phy_mode); 381 rate = __le32_to_cpu(ev_hdr->rate); 382 383 memset(status, 0, sizeof(*status)); 384 385 ath10k_dbg(ATH10K_DBG_MGMT, 386 "event mgmt rx status %08x\n", rx_status); 387 388 if (rx_status & WMI_RX_STATUS_ERR_DECRYPT) { 389 dev_kfree_skb(skb); 390 return 0; 391 } 392 393 if (rx_status & WMI_RX_STATUS_ERR_KEY_CACHE_MISS) { 394 dev_kfree_skb(skb); 395 return 0; 396 } 397 398 if (rx_status & WMI_RX_STATUS_ERR_CRC) 399 status->flag |= RX_FLAG_FAILED_FCS_CRC; 400 if (rx_status & WMI_RX_STATUS_ERR_MIC) 401 status->flag |= RX_FLAG_MMIC_ERROR; 402 403 status->band = phy_mode_to_band(phy_mode); 404 status->freq = ieee80211_channel_to_frequency(channel, status->band); 405 status->signal = snr + ATH10K_DEFAULT_NOISE_FLOOR; 406 status->rate_idx = get_rate_idx(rate, status->band); 407 408 skb_pull(skb, pull_len); 409 410 hdr = (struct ieee80211_hdr *)skb->data; 411 fc = le16_to_cpu(hdr->frame_control); 412 413 if (fc & IEEE80211_FCTL_PROTECTED) { 414 status->flag |= RX_FLAG_DECRYPTED | RX_FLAG_IV_STRIPPED | 415 RX_FLAG_MMIC_STRIPPED; 416 hdr->frame_control = __cpu_to_le16(fc & 417 ~IEEE80211_FCTL_PROTECTED); 418 } 419 420 ath10k_dbg(ATH10K_DBG_MGMT, 421 "event mgmt rx skb %p len %d ftype %02x stype %02x\n", 422 skb, skb->len, 423 fc & IEEE80211_FCTL_FTYPE, fc & IEEE80211_FCTL_STYPE); 424 425 ath10k_dbg(ATH10K_DBG_MGMT, 426 "event mgmt rx freq %d band %d snr %d, rate_idx %d\n", 427 status->freq, status->band, status->signal, 428 status->rate_idx); 429 430 /* 431 * packets from HTC come aligned to 4byte boundaries 432 * because they can originally come in along with a trailer 433 */ 434 skb_trim(skb, buf_len); 435 436 ieee80211_rx(ar->hw, skb); 437 return 0; 438} 439 440static int freq_to_idx(struct ath10k *ar, int freq) 441{ 442 struct ieee80211_supported_band *sband; 443 int band, ch, idx = 0; 444 445 for (band = IEEE80211_BAND_2GHZ; band < IEEE80211_NUM_BANDS; band++) { 446 sband = ar->hw->wiphy->bands[band]; 447 if (!sband) 448 continue; 449 450 for (ch = 0; ch < sband->n_channels; ch++, idx++) 451 if (sband->channels[ch].center_freq == freq) 452 goto exit; 453 } 454 455exit: 456 return idx; 457} 458 459static void ath10k_wmi_event_chan_info(struct ath10k *ar, struct sk_buff *skb) 460{ 461 struct wmi_chan_info_event *ev; 462 struct survey_info *survey; 463 u32 err_code, freq, cmd_flags, noise_floor, rx_clear_count, cycle_count; 464 int idx; 465 466 ev = (struct wmi_chan_info_event *)skb->data; 467 468 err_code = __le32_to_cpu(ev->err_code); 469 freq = __le32_to_cpu(ev->freq); 470 cmd_flags = __le32_to_cpu(ev->cmd_flags); 471 noise_floor = __le32_to_cpu(ev->noise_floor); 472 rx_clear_count = __le32_to_cpu(ev->rx_clear_count); 473 cycle_count = __le32_to_cpu(ev->cycle_count); 474 475 ath10k_dbg(ATH10K_DBG_WMI, 476 "chan info err_code %d freq %d cmd_flags %d noise_floor %d rx_clear_count %d cycle_count %d\n", 477 err_code, freq, cmd_flags, noise_floor, rx_clear_count, 478 cycle_count); 479 480 spin_lock_bh(&ar->data_lock); 481 482 if (!ar->scan.in_progress) { 483 ath10k_warn("chan info event without a scan request?\n"); 484 goto exit; 485 } 486 487 idx = freq_to_idx(ar, freq); 488 if (idx >= ARRAY_SIZE(ar->survey)) { 489 ath10k_warn("chan info: invalid frequency %d (idx %d out of bounds)\n", 490 freq, idx); 491 goto exit; 492 } 493 494 if (cmd_flags & WMI_CHAN_INFO_FLAG_COMPLETE) { 495 /* During scanning chan info is reported twice for each 496 * visited channel. The reported cycle count is global 497 * and per-channel cycle count must be calculated */ 498 499 cycle_count -= ar->survey_last_cycle_count; 500 rx_clear_count -= ar->survey_last_rx_clear_count; 501 502 survey = &ar->survey[idx]; 503 survey->channel_time = WMI_CHAN_INFO_MSEC(cycle_count); 504 survey->channel_time_rx = WMI_CHAN_INFO_MSEC(rx_clear_count); 505 survey->noise = noise_floor; 506 survey->filled = SURVEY_INFO_CHANNEL_TIME | 507 SURVEY_INFO_CHANNEL_TIME_RX | 508 SURVEY_INFO_NOISE_DBM; 509 } 510 511 ar->survey_last_rx_clear_count = rx_clear_count; 512 ar->survey_last_cycle_count = cycle_count; 513 514exit: 515 spin_unlock_bh(&ar->data_lock); 516} 517 518static void ath10k_wmi_event_echo(struct ath10k *ar, struct sk_buff *skb) 519{ 520 ath10k_dbg(ATH10K_DBG_WMI, "WMI_ECHO_EVENTID\n"); 521} 522 523static void ath10k_wmi_event_debug_mesg(struct ath10k *ar, struct sk_buff *skb) 524{ 525 ath10k_dbg(ATH10K_DBG_WMI, "WMI_DEBUG_MESG_EVENTID\n"); 526} 527 528static void ath10k_wmi_event_update_stats(struct ath10k *ar, 529 struct sk_buff *skb) 530{ 531 struct wmi_stats_event *ev = (struct wmi_stats_event *)skb->data; 532 533 ath10k_dbg(ATH10K_DBG_WMI, "WMI_UPDATE_STATS_EVENTID\n"); 534 535 ath10k_debug_read_target_stats(ar, ev); 536} 537 538static void ath10k_wmi_event_vdev_start_resp(struct ath10k *ar, 539 struct sk_buff *skb) 540{ 541 struct wmi_vdev_start_response_event *ev; 542 543 ath10k_dbg(ATH10K_DBG_WMI, "WMI_VDEV_START_RESP_EVENTID\n"); 544 545 ev = (struct wmi_vdev_start_response_event *)skb->data; 546 547 if (WARN_ON(__le32_to_cpu(ev->status))) 548 return; 549 550 complete(&ar->vdev_setup_done); 551} 552 553static void ath10k_wmi_event_vdev_stopped(struct ath10k *ar, 554 struct sk_buff *skb) 555{ 556 ath10k_dbg(ATH10K_DBG_WMI, "WMI_VDEV_STOPPED_EVENTID\n"); 557 complete(&ar->vdev_setup_done); 558} 559 560static void ath10k_wmi_event_peer_sta_kickout(struct ath10k *ar, 561 struct sk_buff *skb) 562{ 563 ath10k_dbg(ATH10K_DBG_WMI, "WMI_PEER_STA_KICKOUT_EVENTID\n"); 564} 565 566/* 567 * FIXME 568 * 569 * We don't report to mac80211 sleep state of connected 570 * stations. Due to this mac80211 can't fill in TIM IE 571 * correctly. 572 * 573 * I know of no way of getting nullfunc frames that contain 574 * sleep transition from connected stations - these do not 575 * seem to be sent from the target to the host. There also 576 * doesn't seem to be a dedicated event for that. So the 577 * only way left to do this would be to read tim_bitmap 578 * during SWBA. 579 * 580 * We could probably try using tim_bitmap from SWBA to tell 581 * mac80211 which stations are asleep and which are not. The 582 * problem here is calling mac80211 functions so many times 583 * could take too long and make us miss the time to submit 584 * the beacon to the target. 585 * 586 * So as a workaround we try to extend the TIM IE if there 587 * is unicast buffered for stations with aid > 7 and fill it 588 * in ourselves. 589 */ 590static void ath10k_wmi_update_tim(struct ath10k *ar, 591 struct ath10k_vif *arvif, 592 struct sk_buff *bcn, 593 struct wmi_bcn_info *bcn_info) 594{ 595 struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)bcn->data; 596 struct ieee80211_tim_ie *tim; 597 u8 *ies, *ie; 598 u8 ie_len, pvm_len; 599 600 /* if next SWBA has no tim_changed the tim_bitmap is garbage. 601 * we must copy the bitmap upon change and reuse it later */ 602 if (__le32_to_cpu(bcn_info->tim_info.tim_changed)) { 603 int i; 604 605 BUILD_BUG_ON(sizeof(arvif->u.ap.tim_bitmap) != 606 sizeof(bcn_info->tim_info.tim_bitmap)); 607 608 for (i = 0; i < sizeof(arvif->u.ap.tim_bitmap); i++) { 609 __le32 t = bcn_info->tim_info.tim_bitmap[i / 4]; 610 u32 v = __le32_to_cpu(t); 611 arvif->u.ap.tim_bitmap[i] = (v >> ((i % 4) * 8)) & 0xFF; 612 } 613 614 /* FW reports either length 0 or 16 615 * so we calculate this on our own */ 616 arvif->u.ap.tim_len = 0; 617 for (i = 0; i < sizeof(arvif->u.ap.tim_bitmap); i++) 618 if (arvif->u.ap.tim_bitmap[i]) 619 arvif->u.ap.tim_len = i; 620 621 arvif->u.ap.tim_len++; 622 } 623 624 ies = bcn->data; 625 ies += ieee80211_hdrlen(hdr->frame_control); 626 ies += 12; /* fixed parameters */ 627 628 ie = (u8 *)cfg80211_find_ie(WLAN_EID_TIM, ies, 629 (u8 *)skb_tail_pointer(bcn) - ies); 630 if (!ie) { 631 if (arvif->vdev_type != WMI_VDEV_TYPE_IBSS) 632 ath10k_warn("no tim ie found;\n"); 633 return; 634 } 635 636 tim = (void *)ie + 2; 637 ie_len = ie[1]; 638 pvm_len = ie_len - 3; /* exclude dtim count, dtim period, bmap ctl */ 639 640 if (pvm_len < arvif->u.ap.tim_len) { 641 int expand_size = sizeof(arvif->u.ap.tim_bitmap) - pvm_len; 642 int move_size = skb_tail_pointer(bcn) - (ie + 2 + ie_len); 643 void *next_ie = ie + 2 + ie_len; 644 645 if (skb_put(bcn, expand_size)) { 646 memmove(next_ie + expand_size, next_ie, move_size); 647 648 ie[1] += expand_size; 649 ie_len += expand_size; 650 pvm_len += expand_size; 651 } else { 652 ath10k_warn("tim expansion failed\n"); 653 } 654 } 655 656 if (pvm_len > sizeof(arvif->u.ap.tim_bitmap)) { 657 ath10k_warn("tim pvm length is too great (%d)\n", pvm_len); 658 return; 659 } 660 661 tim->bitmap_ctrl = !!__le32_to_cpu(bcn_info->tim_info.tim_mcast); 662 memcpy(tim->virtual_map, arvif->u.ap.tim_bitmap, pvm_len); 663 664 ath10k_dbg(ATH10K_DBG_MGMT, "dtim %d/%d mcast %d pvmlen %d\n", 665 tim->dtim_count, tim->dtim_period, 666 tim->bitmap_ctrl, pvm_len); 667} 668 669static void ath10k_p2p_fill_noa_ie(u8 *data, u32 len, 670 struct wmi_p2p_noa_info *noa) 671{ 672 struct ieee80211_p2p_noa_attr *noa_attr; 673 u8 ctwindow_oppps = noa->ctwindow_oppps; 674 u8 ctwindow = ctwindow_oppps >> WMI_P2P_OPPPS_CTWINDOW_OFFSET; 675 bool oppps = !!(ctwindow_oppps & WMI_P2P_OPPPS_ENABLE_BIT); 676 __le16 *noa_attr_len; 677 u16 attr_len; 678 u8 noa_descriptors = noa->num_descriptors; 679 int i; 680 681 /* P2P IE */ 682 data[0] = WLAN_EID_VENDOR_SPECIFIC; 683 data[1] = len - 2; 684 data[2] = (WLAN_OUI_WFA >> 16) & 0xff; 685 data[3] = (WLAN_OUI_WFA >> 8) & 0xff; 686 data[4] = (WLAN_OUI_WFA >> 0) & 0xff; 687 data[5] = WLAN_OUI_TYPE_WFA_P2P; 688 689 /* NOA ATTR */ 690 data[6] = IEEE80211_P2P_ATTR_ABSENCE_NOTICE; 691 noa_attr_len = (__le16 *)&data[7]; /* 2 bytes */ 692 noa_attr = (struct ieee80211_p2p_noa_attr *)&data[9]; 693 694 noa_attr->index = noa->index; 695 noa_attr->oppps_ctwindow = ctwindow; 696 if (oppps) 697 noa_attr->oppps_ctwindow |= IEEE80211_P2P_OPPPS_ENABLE_BIT; 698 699 for (i = 0; i < noa_descriptors; i++) { 700 noa_attr->desc[i].count = 701 __le32_to_cpu(noa->descriptors[i].type_count); 702 noa_attr->desc[i].duration = noa->descriptors[i].duration; 703 noa_attr->desc[i].interval = noa->descriptors[i].interval; 704 noa_attr->desc[i].start_time = noa->descriptors[i].start_time; 705 } 706 707 attr_len = 2; /* index + oppps_ctwindow */ 708 attr_len += noa_descriptors * sizeof(struct ieee80211_p2p_noa_desc); 709 *noa_attr_len = __cpu_to_le16(attr_len); 710} 711 712static u32 ath10k_p2p_calc_noa_ie_len(struct wmi_p2p_noa_info *noa) 713{ 714 u32 len = 0; 715 u8 noa_descriptors = noa->num_descriptors; 716 u8 opp_ps_info = noa->ctwindow_oppps; 717 bool opps_enabled = !!(opp_ps_info & WMI_P2P_OPPPS_ENABLE_BIT); 718 719 720 if (!noa_descriptors && !opps_enabled) 721 return len; 722 723 len += 1 + 1 + 4; /* EID + len + OUI */ 724 len += 1 + 2; /* noa attr + attr len */ 725 len += 1 + 1; /* index + oppps_ctwindow */ 726 len += noa_descriptors * sizeof(struct ieee80211_p2p_noa_desc); 727 728 return len; 729} 730 731static void ath10k_wmi_update_noa(struct ath10k *ar, struct ath10k_vif *arvif, 732 struct sk_buff *bcn, 733 struct wmi_bcn_info *bcn_info) 734{ 735 struct wmi_p2p_noa_info *noa = &bcn_info->p2p_noa_info; 736 u8 *new_data, *old_data = arvif->u.ap.noa_data; 737 u32 new_len; 738 739 if (arvif->vdev_subtype != WMI_VDEV_SUBTYPE_P2P_GO) 740 return; 741 742 ath10k_dbg(ATH10K_DBG_MGMT, "noa changed: %d\n", noa->changed); 743 if (noa->changed & WMI_P2P_NOA_CHANGED_BIT) { 744 new_len = ath10k_p2p_calc_noa_ie_len(noa); 745 if (!new_len) 746 goto cleanup; 747 748 new_data = kmalloc(new_len, GFP_ATOMIC); 749 if (!new_data) 750 goto cleanup; 751 752 ath10k_p2p_fill_noa_ie(new_data, new_len, noa); 753 754 spin_lock_bh(&ar->data_lock); 755 arvif->u.ap.noa_data = new_data; 756 arvif->u.ap.noa_len = new_len; 757 spin_unlock_bh(&ar->data_lock); 758 kfree(old_data); 759 } 760 761 if (arvif->u.ap.noa_data) 762 if (!pskb_expand_head(bcn, 0, arvif->u.ap.noa_len, GFP_ATOMIC)) 763 memcpy(skb_put(bcn, arvif->u.ap.noa_len), 764 arvif->u.ap.noa_data, 765 arvif->u.ap.noa_len); 766 return; 767 768cleanup: 769 spin_lock_bh(&ar->data_lock); 770 arvif->u.ap.noa_data = NULL; 771 arvif->u.ap.noa_len = 0; 772 spin_unlock_bh(&ar->data_lock); 773 kfree(old_data); 774} 775 776 777static void ath10k_wmi_event_host_swba(struct ath10k *ar, struct sk_buff *skb) 778{ 779 struct wmi_host_swba_event *ev; 780 u32 map; 781 int i = -1; 782 struct wmi_bcn_info *bcn_info; 783 struct ath10k_vif *arvif; 784 struct sk_buff *bcn; 785 int vdev_id = 0; 786 787 ath10k_dbg(ATH10K_DBG_MGMT, "WMI_HOST_SWBA_EVENTID\n"); 788 789 ev = (struct wmi_host_swba_event *)skb->data; 790 map = __le32_to_cpu(ev->vdev_map); 791 792 ath10k_dbg(ATH10K_DBG_MGMT, "host swba:\n" 793 "-vdev map 0x%x\n", 794 ev->vdev_map); 795 796 for (; map; map >>= 1, vdev_id++) { 797 if (!(map & 0x1)) 798 continue; 799 800 i++; 801 802 if (i >= WMI_MAX_AP_VDEV) { 803 ath10k_warn("swba has corrupted vdev map\n"); 804 break; 805 } 806 807 bcn_info = &ev->bcn_info[i]; 808 809 ath10k_dbg(ATH10K_DBG_MGMT, 810 "-bcn_info[%d]:\n" 811 "--tim_len %d\n" 812 "--tim_mcast %d\n" 813 "--tim_changed %d\n" 814 "--tim_num_ps_pending %d\n" 815 "--tim_bitmap 0x%08x%08x%08x%08x\n", 816 i, 817 __le32_to_cpu(bcn_info->tim_info.tim_len), 818 __le32_to_cpu(bcn_info->tim_info.tim_mcast), 819 __le32_to_cpu(bcn_info->tim_info.tim_changed), 820 __le32_to_cpu(bcn_info->tim_info.tim_num_ps_pending), 821 __le32_to_cpu(bcn_info->tim_info.tim_bitmap[3]), 822 __le32_to_cpu(bcn_info->tim_info.tim_bitmap[2]), 823 __le32_to_cpu(bcn_info->tim_info.tim_bitmap[1]), 824 __le32_to_cpu(bcn_info->tim_info.tim_bitmap[0])); 825 826 arvif = ath10k_get_arvif(ar, vdev_id); 827 if (arvif == NULL) { 828 ath10k_warn("no vif for vdev_id %d found\n", vdev_id); 829 continue; 830 } 831 832 bcn = ieee80211_beacon_get(ar->hw, arvif->vif); 833 if (!bcn) { 834 ath10k_warn("could not get mac80211 beacon\n"); 835 continue; 836 } 837 838 ath10k_tx_h_seq_no(bcn); 839 ath10k_wmi_update_tim(ar, arvif, bcn, bcn_info); 840 ath10k_wmi_update_noa(ar, arvif, bcn, bcn_info); 841 842 spin_lock_bh(&ar->data_lock); 843 if (arvif->beacon) { 844 ath10k_warn("SWBA overrun on vdev %d\n", 845 arvif->vdev_id); 846 dev_kfree_skb_any(arvif->beacon); 847 } 848 849 arvif->beacon = bcn; 850 851 ath10k_wmi_tx_beacon_nowait(arvif); 852 spin_unlock_bh(&ar->data_lock); 853 } 854} 855 856static void ath10k_wmi_event_tbttoffset_update(struct ath10k *ar, 857 struct sk_buff *skb) 858{ 859 ath10k_dbg(ATH10K_DBG_WMI, "WMI_TBTTOFFSET_UPDATE_EVENTID\n"); 860} 861 862static void ath10k_wmi_event_phyerr(struct ath10k *ar, struct sk_buff *skb) 863{ 864 ath10k_dbg(ATH10K_DBG_WMI, "WMI_PHYERR_EVENTID\n"); 865} 866 867static void ath10k_wmi_event_roam(struct ath10k *ar, struct sk_buff *skb) 868{ 869 ath10k_dbg(ATH10K_DBG_WMI, "WMI_ROAM_EVENTID\n"); 870} 871 872static void ath10k_wmi_event_profile_match(struct ath10k *ar, 873 struct sk_buff *skb) 874{ 875 ath10k_dbg(ATH10K_DBG_WMI, "WMI_PROFILE_MATCH\n"); 876} 877 878static void ath10k_wmi_event_debug_print(struct ath10k *ar, 879 struct sk_buff *skb) 880{ 881 ath10k_dbg(ATH10K_DBG_WMI, "WMI_DEBUG_PRINT_EVENTID\n"); 882} 883 884static void ath10k_wmi_event_pdev_qvit(struct ath10k *ar, struct sk_buff *skb) 885{ 886 ath10k_dbg(ATH10K_DBG_WMI, "WMI_PDEV_QVIT_EVENTID\n"); 887} 888 889static void ath10k_wmi_event_wlan_profile_data(struct ath10k *ar, 890 struct sk_buff *skb) 891{ 892 ath10k_dbg(ATH10K_DBG_WMI, "WMI_WLAN_PROFILE_DATA_EVENTID\n"); 893} 894 895static void ath10k_wmi_event_rtt_measurement_report(struct ath10k *ar, 896 struct sk_buff *skb) 897{ 898 ath10k_dbg(ATH10K_DBG_WMI, "WMI_RTT_MEASUREMENT_REPORT_EVENTID\n"); 899} 900 901static void ath10k_wmi_event_tsf_measurement_report(struct ath10k *ar, 902 struct sk_buff *skb) 903{ 904 ath10k_dbg(ATH10K_DBG_WMI, "WMI_TSF_MEASUREMENT_REPORT_EVENTID\n"); 905} 906 907static void ath10k_wmi_event_rtt_error_report(struct ath10k *ar, 908 struct sk_buff *skb) 909{ 910 ath10k_dbg(ATH10K_DBG_WMI, "WMI_RTT_ERROR_REPORT_EVENTID\n"); 911} 912 913static void ath10k_wmi_event_wow_wakeup_host(struct ath10k *ar, 914 struct sk_buff *skb) 915{ 916 ath10k_dbg(ATH10K_DBG_WMI, "WMI_WOW_WAKEUP_HOST_EVENTID\n"); 917} 918 919static void ath10k_wmi_event_dcs_interference(struct ath10k *ar, 920 struct sk_buff *skb) 921{ 922 ath10k_dbg(ATH10K_DBG_WMI, "WMI_DCS_INTERFERENCE_EVENTID\n"); 923} 924 925static void ath10k_wmi_event_pdev_tpc_config(struct ath10k *ar, 926 struct sk_buff *skb) 927{ 928 ath10k_dbg(ATH10K_DBG_WMI, "WMI_PDEV_TPC_CONFIG_EVENTID\n"); 929} 930 931static void ath10k_wmi_event_pdev_ftm_intg(struct ath10k *ar, 932 struct sk_buff *skb) 933{ 934 ath10k_dbg(ATH10K_DBG_WMI, "WMI_PDEV_FTM_INTG_EVENTID\n"); 935} 936 937static void ath10k_wmi_event_gtk_offload_status(struct ath10k *ar, 938 struct sk_buff *skb) 939{ 940 ath10k_dbg(ATH10K_DBG_WMI, "WMI_GTK_OFFLOAD_STATUS_EVENTID\n"); 941} 942 943static void ath10k_wmi_event_gtk_rekey_fail(struct ath10k *ar, 944 struct sk_buff *skb) 945{ 946 ath10k_dbg(ATH10K_DBG_WMI, "WMI_GTK_REKEY_FAIL_EVENTID\n"); 947} 948 949static void ath10k_wmi_event_delba_complete(struct ath10k *ar, 950 struct sk_buff *skb) 951{ 952 ath10k_dbg(ATH10K_DBG_WMI, "WMI_TX_DELBA_COMPLETE_EVENTID\n"); 953} 954 955static void ath10k_wmi_event_addba_complete(struct ath10k *ar, 956 struct sk_buff *skb) 957{ 958 ath10k_dbg(ATH10K_DBG_WMI, "WMI_TX_ADDBA_COMPLETE_EVENTID\n"); 959} 960 961static void ath10k_wmi_event_vdev_install_key_complete(struct ath10k *ar, 962 struct sk_buff *skb) 963{ 964 ath10k_dbg(ATH10K_DBG_WMI, "WMI_VDEV_INSTALL_KEY_COMPLETE_EVENTID\n"); 965} 966 967static void ath10k_wmi_service_ready_event_rx(struct ath10k *ar, 968 struct sk_buff *skb) 969{ 970 struct wmi_service_ready_event *ev = (void *)skb->data; 971 972 if (skb->len < sizeof(*ev)) { 973 ath10k_warn("Service ready event was %d B but expected %zu B. Wrong firmware version?\n", 974 skb->len, sizeof(*ev)); 975 return; 976 } 977 978 ar->hw_min_tx_power = __le32_to_cpu(ev->hw_min_tx_power); 979 ar->hw_max_tx_power = __le32_to_cpu(ev->hw_max_tx_power); 980 ar->ht_cap_info = __le32_to_cpu(ev->ht_cap_info); 981 ar->vht_cap_info = __le32_to_cpu(ev->vht_cap_info); 982 ar->fw_version_major = 983 (__le32_to_cpu(ev->sw_version) & 0xff000000) >> 24; 984 ar->fw_version_minor = (__le32_to_cpu(ev->sw_version) & 0x00ffffff); 985 ar->fw_version_release = 986 (__le32_to_cpu(ev->sw_version_1) & 0xffff0000) >> 16; 987 ar->fw_version_build = (__le32_to_cpu(ev->sw_version_1) & 0x0000ffff); 988 ar->phy_capability = __le32_to_cpu(ev->phy_capability); 989 ar->num_rf_chains = __le32_to_cpu(ev->num_rf_chains); 990 991 if (ar->fw_version_build > 636) 992 set_bit(ATH10K_FW_FEATURE_EXT_WMI_MGMT_RX, ar->fw_features); 993 994 if (ar->num_rf_chains > WMI_MAX_SPATIAL_STREAM) { 995 ath10k_warn("hardware advertises support for more spatial streams than it should (%d > %d)\n", 996 ar->num_rf_chains, WMI_MAX_SPATIAL_STREAM); 997 ar->num_rf_chains = WMI_MAX_SPATIAL_STREAM; 998 } 999 1000 ar->ath_common.regulatory.current_rd = 1001 __le32_to_cpu(ev->hal_reg_capabilities.eeprom_rd); 1002 1003 ath10k_debug_read_service_map(ar, ev->wmi_service_bitmap, 1004 sizeof(ev->wmi_service_bitmap)); 1005 1006 if (strlen(ar->hw->wiphy->fw_version) == 0) { 1007 snprintf(ar->hw->wiphy->fw_version, 1008 sizeof(ar->hw->wiphy->fw_version), 1009 "%u.%u.%u.%u", 1010 ar->fw_version_major, 1011 ar->fw_version_minor, 1012 ar->fw_version_release, 1013 ar->fw_version_build); 1014 } 1015 1016 /* FIXME: it probably should be better to support this */ 1017 if (__le32_to_cpu(ev->num_mem_reqs) > 0) { 1018 ath10k_warn("target requested %d memory chunks; ignoring\n", 1019 __le32_to_cpu(ev->num_mem_reqs)); 1020 } 1021 1022 ath10k_dbg(ATH10K_DBG_WMI, 1023 "wmi event service ready sw_ver 0x%08x sw_ver1 0x%08x abi_ver %u phy_cap 0x%08x ht_cap 0x%08x vht_cap 0x%08x vht_supp_msc 0x%08x sys_cap_info 0x%08x mem_reqs %u num_rf_chains %u\n", 1024 __le32_to_cpu(ev->sw_version), 1025 __le32_to_cpu(ev->sw_version_1), 1026 __le32_to_cpu(ev->abi_version), 1027 __le32_to_cpu(ev->phy_capability), 1028 __le32_to_cpu(ev->ht_cap_info), 1029 __le32_to_cpu(ev->vht_cap_info), 1030 __le32_to_cpu(ev->vht_supp_mcs), 1031 __le32_to_cpu(ev->sys_cap_info), 1032 __le32_to_cpu(ev->num_mem_reqs), 1033 __le32_to_cpu(ev->num_rf_chains)); 1034 1035 complete(&ar->wmi.service_ready); 1036} 1037 1038static int ath10k_wmi_ready_event_rx(struct ath10k *ar, struct sk_buff *skb) 1039{ 1040 struct wmi_ready_event *ev = (struct wmi_ready_event *)skb->data; 1041 1042 if (WARN_ON(skb->len < sizeof(*ev))) 1043 return -EINVAL; 1044 1045 memcpy(ar->mac_addr, ev->mac_addr.addr, ETH_ALEN); 1046 1047 ath10k_dbg(ATH10K_DBG_WMI, 1048 "wmi event ready sw_version %u abi_version %u mac_addr %pM status %d\n", 1049 __le32_to_cpu(ev->sw_version), 1050 __le32_to_cpu(ev->abi_version), 1051 ev->mac_addr.addr, 1052 __le32_to_cpu(ev->status)); 1053 1054 complete(&ar->wmi.unified_ready); 1055 return 0; 1056} 1057 1058static void ath10k_wmi_event_process(struct ath10k *ar, struct sk_buff *skb) 1059{ 1060 struct wmi_cmd_hdr *cmd_hdr; 1061 enum wmi_event_id id; 1062 u16 len; 1063 1064 cmd_hdr = (struct wmi_cmd_hdr *)skb->data; 1065 id = MS(__le32_to_cpu(cmd_hdr->cmd_id), WMI_CMD_HDR_CMD_ID); 1066 1067 if (skb_pull(skb, sizeof(struct wmi_cmd_hdr)) == NULL) 1068 return; 1069 1070 len = skb->len; 1071 1072 trace_ath10k_wmi_event(id, skb->data, skb->len); 1073 1074 switch (id) { 1075 case WMI_MGMT_RX_EVENTID: 1076 ath10k_wmi_event_mgmt_rx(ar, skb); 1077 /* mgmt_rx() owns the skb now! */ 1078 return; 1079 case WMI_SCAN_EVENTID: 1080 ath10k_wmi_event_scan(ar, skb); 1081 break; 1082 case WMI_CHAN_INFO_EVENTID: 1083 ath10k_wmi_event_chan_info(ar, skb); 1084 break; 1085 case WMI_ECHO_EVENTID: 1086 ath10k_wmi_event_echo(ar, skb); 1087 break; 1088 case WMI_DEBUG_MESG_EVENTID: 1089 ath10k_wmi_event_debug_mesg(ar, skb); 1090 break; 1091 case WMI_UPDATE_STATS_EVENTID: 1092 ath10k_wmi_event_update_stats(ar, skb); 1093 break; 1094 case WMI_VDEV_START_RESP_EVENTID: 1095 ath10k_wmi_event_vdev_start_resp(ar, skb); 1096 break; 1097 case WMI_VDEV_STOPPED_EVENTID: 1098 ath10k_wmi_event_vdev_stopped(ar, skb); 1099 break; 1100 case WMI_PEER_STA_KICKOUT_EVENTID: 1101 ath10k_wmi_event_peer_sta_kickout(ar, skb); 1102 break; 1103 case WMI_HOST_SWBA_EVENTID: 1104 ath10k_wmi_event_host_swba(ar, skb); 1105 break; 1106 case WMI_TBTTOFFSET_UPDATE_EVENTID: 1107 ath10k_wmi_event_tbttoffset_update(ar, skb); 1108 break; 1109 case WMI_PHYERR_EVENTID: 1110 ath10k_wmi_event_phyerr(ar, skb); 1111 break; 1112 case WMI_ROAM_EVENTID: 1113 ath10k_wmi_event_roam(ar, skb); 1114 break; 1115 case WMI_PROFILE_MATCH: 1116 ath10k_wmi_event_profile_match(ar, skb); 1117 break; 1118 case WMI_DEBUG_PRINT_EVENTID: 1119 ath10k_wmi_event_debug_print(ar, skb); 1120 break; 1121 case WMI_PDEV_QVIT_EVENTID: 1122 ath10k_wmi_event_pdev_qvit(ar, skb); 1123 break; 1124 case WMI_WLAN_PROFILE_DATA_EVENTID: 1125 ath10k_wmi_event_wlan_profile_data(ar, skb); 1126 break; 1127 case WMI_RTT_MEASUREMENT_REPORT_EVENTID: 1128 ath10k_wmi_event_rtt_measurement_report(ar, skb); 1129 break; 1130 case WMI_TSF_MEASUREMENT_REPORT_EVENTID: 1131 ath10k_wmi_event_tsf_measurement_report(ar, skb); 1132 break; 1133 case WMI_RTT_ERROR_REPORT_EVENTID: 1134 ath10k_wmi_event_rtt_error_report(ar, skb); 1135 break; 1136 case WMI_WOW_WAKEUP_HOST_EVENTID: 1137 ath10k_wmi_event_wow_wakeup_host(ar, skb); 1138 break; 1139 case WMI_DCS_INTERFERENCE_EVENTID: 1140 ath10k_wmi_event_dcs_interference(ar, skb); 1141 break; 1142 case WMI_PDEV_TPC_CONFIG_EVENTID: 1143 ath10k_wmi_event_pdev_tpc_config(ar, skb); 1144 break; 1145 case WMI_PDEV_FTM_INTG_EVENTID: 1146 ath10k_wmi_event_pdev_ftm_intg(ar, skb); 1147 break; 1148 case WMI_GTK_OFFLOAD_STATUS_EVENTID: 1149 ath10k_wmi_event_gtk_offload_status(ar, skb); 1150 break; 1151 case WMI_GTK_REKEY_FAIL_EVENTID: 1152 ath10k_wmi_event_gtk_rekey_fail(ar, skb); 1153 break; 1154 case WMI_TX_DELBA_COMPLETE_EVENTID: 1155 ath10k_wmi_event_delba_complete(ar, skb); 1156 break; 1157 case WMI_TX_ADDBA_COMPLETE_EVENTID: 1158 ath10k_wmi_event_addba_complete(ar, skb); 1159 break; 1160 case WMI_VDEV_INSTALL_KEY_COMPLETE_EVENTID: 1161 ath10k_wmi_event_vdev_install_key_complete(ar, skb); 1162 break; 1163 case WMI_SERVICE_READY_EVENTID: 1164 ath10k_wmi_service_ready_event_rx(ar, skb); 1165 break; 1166 case WMI_READY_EVENTID: 1167 ath10k_wmi_ready_event_rx(ar, skb); 1168 break; 1169 default: 1170 ath10k_warn("Unknown eventid: %d\n", id); 1171 break; 1172 } 1173 1174 dev_kfree_skb(skb); 1175} 1176 1177static void ath10k_wmi_event_work(struct work_struct *work) 1178{ 1179 struct ath10k *ar = container_of(work, struct ath10k, 1180 wmi.wmi_event_work); 1181 struct sk_buff *skb; 1182 1183 for (;;) { 1184 skb = skb_dequeue(&ar->wmi.wmi_event_list); 1185 if (!skb) 1186 break; 1187 1188 ath10k_wmi_event_process(ar, skb); 1189 } 1190} 1191 1192static void ath10k_wmi_process_rx(struct ath10k *ar, struct sk_buff *skb) 1193{ 1194 struct wmi_cmd_hdr *cmd_hdr = (struct wmi_cmd_hdr *)skb->data; 1195 enum wmi_event_id event_id; 1196 1197 event_id = MS(__le32_to_cpu(cmd_hdr->cmd_id), WMI_CMD_HDR_CMD_ID); 1198 1199 /* some events require to be handled ASAP 1200 * thus can't be defered to a worker thread */ 1201 switch (event_id) { 1202 case WMI_MGMT_RX_EVENTID: 1203 case WMI_HOST_SWBA_EVENTID: 1204 ath10k_wmi_event_process(ar, skb); 1205 return; 1206 default: 1207 break; 1208 } 1209 1210 skb_queue_tail(&ar->wmi.wmi_event_list, skb); 1211 queue_work(ar->workqueue, &ar->wmi.wmi_event_work); 1212} 1213 1214/* WMI Initialization functions */ 1215int ath10k_wmi_attach(struct ath10k *ar) 1216{ 1217 init_completion(&ar->wmi.service_ready); 1218 init_completion(&ar->wmi.unified_ready); 1219 init_waitqueue_head(&ar->wmi.tx_credits_wq); 1220 1221 skb_queue_head_init(&ar->wmi.wmi_event_list); 1222 INIT_WORK(&ar->wmi.wmi_event_work, ath10k_wmi_event_work); 1223 1224 return 0; 1225} 1226 1227void ath10k_wmi_detach(struct ath10k *ar) 1228{ 1229 cancel_work_sync(&ar->wmi.wmi_event_work); 1230 skb_queue_purge(&ar->wmi.wmi_event_list); 1231} 1232 1233int ath10k_wmi_connect_htc_service(struct ath10k *ar) 1234{ 1235 int status; 1236 struct ath10k_htc_svc_conn_req conn_req; 1237 struct ath10k_htc_svc_conn_resp conn_resp; 1238 1239 memset(&conn_req, 0, sizeof(conn_req)); 1240 memset(&conn_resp, 0, sizeof(conn_resp)); 1241 1242 /* these fields are the same for all service endpoints */ 1243 conn_req.ep_ops.ep_tx_complete = ath10k_wmi_htc_tx_complete; 1244 conn_req.ep_ops.ep_rx_complete = ath10k_wmi_process_rx; 1245 conn_req.ep_ops.ep_tx_credits = ath10k_wmi_op_ep_tx_credits; 1246 1247 /* connect to control service */ 1248 conn_req.service_id = ATH10K_HTC_SVC_ID_WMI_CONTROL; 1249 1250 status = ath10k_htc_connect_service(&ar->htc, &conn_req, &conn_resp); 1251 if (status) { 1252 ath10k_warn("failed to connect to WMI CONTROL service status: %d\n", 1253 status); 1254 return status; 1255 } 1256 1257 ar->wmi.eid = conn_resp.eid; 1258 return 0; 1259} 1260 1261int ath10k_wmi_pdev_set_regdomain(struct ath10k *ar, u16 rd, u16 rd2g, 1262 u16 rd5g, u16 ctl2g, u16 ctl5g) 1263{ 1264 struct wmi_pdev_set_regdomain_cmd *cmd; 1265 struct sk_buff *skb; 1266 1267 skb = ath10k_wmi_alloc_skb(sizeof(*cmd)); 1268 if (!skb) 1269 return -ENOMEM; 1270 1271 cmd = (struct wmi_pdev_set_regdomain_cmd *)skb->data; 1272 cmd->reg_domain = __cpu_to_le32(rd); 1273 cmd->reg_domain_2G = __cpu_to_le32(rd2g); 1274 cmd->reg_domain_5G = __cpu_to_le32(rd5g); 1275 cmd->conformance_test_limit_2G = __cpu_to_le32(ctl2g); 1276 cmd->conformance_test_limit_5G = __cpu_to_le32(ctl5g); 1277 1278 ath10k_dbg(ATH10K_DBG_WMI, 1279 "wmi pdev regdomain rd %x rd2g %x rd5g %x ctl2g %x ctl5g %x\n", 1280 rd, rd2g, rd5g, ctl2g, ctl5g); 1281 1282 return ath10k_wmi_cmd_send(ar, skb, WMI_PDEV_SET_REGDOMAIN_CMDID); 1283} 1284 1285int ath10k_wmi_pdev_set_channel(struct ath10k *ar, 1286 const struct wmi_channel_arg *arg) 1287{ 1288 struct wmi_set_channel_cmd *cmd; 1289 struct sk_buff *skb; 1290 1291 if (arg->passive) 1292 return -EINVAL; 1293 1294 skb = ath10k_wmi_alloc_skb(sizeof(*cmd)); 1295 if (!skb) 1296 return -ENOMEM; 1297 1298 cmd = (struct wmi_set_channel_cmd *)skb->data; 1299 cmd->chan.mhz = __cpu_to_le32(arg->freq); 1300 cmd->chan.band_center_freq1 = __cpu_to_le32(arg->freq); 1301 cmd->chan.mode = arg->mode; 1302 cmd->chan.min_power = arg->min_power; 1303 cmd->chan.max_power = arg->max_power; 1304 cmd->chan.reg_power = arg->max_reg_power; 1305 cmd->chan.reg_classid = arg->reg_class_id; 1306 cmd->chan.antenna_max = arg->max_antenna_gain; 1307 1308 ath10k_dbg(ATH10K_DBG_WMI, 1309 "wmi set channel mode %d freq %d\n", 1310 arg->mode, arg->freq); 1311 1312 return ath10k_wmi_cmd_send(ar, skb, WMI_PDEV_SET_CHANNEL_CMDID); 1313} 1314 1315int ath10k_wmi_pdev_suspend_target(struct ath10k *ar) 1316{ 1317 struct wmi_pdev_suspend_cmd *cmd; 1318 struct sk_buff *skb; 1319 1320 skb = ath10k_wmi_alloc_skb(sizeof(*cmd)); 1321 if (!skb) 1322 return -ENOMEM; 1323 1324 cmd = (struct wmi_pdev_suspend_cmd *)skb->data; 1325 cmd->suspend_opt = WMI_PDEV_SUSPEND; 1326 1327 return ath10k_wmi_cmd_send(ar, skb, WMI_PDEV_SUSPEND_CMDID); 1328} 1329 1330int ath10k_wmi_pdev_resume_target(struct ath10k *ar) 1331{ 1332 struct sk_buff *skb; 1333 1334 skb = ath10k_wmi_alloc_skb(0); 1335 if (skb == NULL) 1336 return -ENOMEM; 1337 1338 return ath10k_wmi_cmd_send(ar, skb, WMI_PDEV_RESUME_CMDID); 1339} 1340 1341int ath10k_wmi_pdev_set_param(struct ath10k *ar, enum wmi_pdev_param id, 1342 u32 value) 1343{ 1344 struct wmi_pdev_set_param_cmd *cmd; 1345 struct sk_buff *skb; 1346 1347 skb = ath10k_wmi_alloc_skb(sizeof(*cmd)); 1348 if (!skb) 1349 return -ENOMEM; 1350 1351 cmd = (struct wmi_pdev_set_param_cmd *)skb->data; 1352 cmd->param_id = __cpu_to_le32(id); 1353 cmd->param_value = __cpu_to_le32(value); 1354 1355 ath10k_dbg(ATH10K_DBG_WMI, "wmi pdev set param %d value %d\n", 1356 id, value); 1357 return ath10k_wmi_cmd_send(ar, skb, WMI_PDEV_SET_PARAM_CMDID); 1358} 1359 1360int ath10k_wmi_cmd_init(struct ath10k *ar) 1361{ 1362 struct wmi_init_cmd *cmd; 1363 struct sk_buff *buf; 1364 struct wmi_resource_config config = {}; 1365 u32 val; 1366 1367 config.num_vdevs = __cpu_to_le32(TARGET_NUM_VDEVS); 1368 config.num_peers = __cpu_to_le32(TARGET_NUM_PEERS + TARGET_NUM_VDEVS); 1369 config.num_offload_peers = __cpu_to_le32(TARGET_NUM_OFFLOAD_PEERS); 1370 1371 config.num_offload_reorder_bufs = 1372 __cpu_to_le32(TARGET_NUM_OFFLOAD_REORDER_BUFS); 1373 1374 config.num_peer_keys = __cpu_to_le32(TARGET_NUM_PEER_KEYS); 1375 config.num_tids = __cpu_to_le32(TARGET_NUM_TIDS); 1376 config.ast_skid_limit = __cpu_to_le32(TARGET_AST_SKID_LIMIT); 1377 config.tx_chain_mask = __cpu_to_le32(TARGET_TX_CHAIN_MASK); 1378 config.rx_chain_mask = __cpu_to_le32(TARGET_RX_CHAIN_MASK); 1379 config.rx_timeout_pri_vo = __cpu_to_le32(TARGET_RX_TIMEOUT_LO_PRI); 1380 config.rx_timeout_pri_vi = __cpu_to_le32(TARGET_RX_TIMEOUT_LO_PRI); 1381 config.rx_timeout_pri_be = __cpu_to_le32(TARGET_RX_TIMEOUT_LO_PRI); 1382 config.rx_timeout_pri_bk = __cpu_to_le32(TARGET_RX_TIMEOUT_HI_PRI); 1383 config.rx_decap_mode = __cpu_to_le32(TARGET_RX_DECAP_MODE); 1384 1385 config.scan_max_pending_reqs = 1386 __cpu_to_le32(TARGET_SCAN_MAX_PENDING_REQS); 1387 1388 config.bmiss_offload_max_vdev = 1389 __cpu_to_le32(TARGET_BMISS_OFFLOAD_MAX_VDEV); 1390 1391 config.roam_offload_max_vdev = 1392 __cpu_to_le32(TARGET_ROAM_OFFLOAD_MAX_VDEV); 1393 1394 config.roam_offload_max_ap_profiles = 1395 __cpu_to_le32(TARGET_ROAM_OFFLOAD_MAX_AP_PROFILES); 1396 1397 config.num_mcast_groups = __cpu_to_le32(TARGET_NUM_MCAST_GROUPS); 1398 config.num_mcast_table_elems = 1399 __cpu_to_le32(TARGET_NUM_MCAST_TABLE_ELEMS); 1400 1401 config.mcast2ucast_mode = __cpu_to_le32(TARGET_MCAST2UCAST_MODE); 1402 config.tx_dbg_log_size = __cpu_to_le32(TARGET_TX_DBG_LOG_SIZE); 1403 config.num_wds_entries = __cpu_to_le32(TARGET_NUM_WDS_ENTRIES); 1404 config.dma_burst_size = __cpu_to_le32(TARGET_DMA_BURST_SIZE); 1405 config.mac_aggr_delim = __cpu_to_le32(TARGET_MAC_AGGR_DELIM); 1406 1407 val = TARGET_RX_SKIP_DEFRAG_TIMEOUT_DUP_DETECTION_CHECK; 1408 config.rx_skip_defrag_timeout_dup_detection_check = __cpu_to_le32(val); 1409 1410 config.vow_config = __cpu_to_le32(TARGET_VOW_CONFIG); 1411 1412 config.gtk_offload_max_vdev = 1413 __cpu_to_le32(TARGET_GTK_OFFLOAD_MAX_VDEV); 1414 1415 config.num_msdu_desc = __cpu_to_le32(TARGET_NUM_MSDU_DESC); 1416 config.max_frag_entries = __cpu_to_le32(TARGET_MAX_FRAG_ENTRIES); 1417 1418 buf = ath10k_wmi_alloc_skb(sizeof(*cmd)); 1419 if (!buf) 1420 return -ENOMEM; 1421 1422 cmd = (struct wmi_init_cmd *)buf->data; 1423 cmd->num_host_mem_chunks = 0; 1424 memcpy(&cmd->resource_config, &config, sizeof(config)); 1425 1426 ath10k_dbg(ATH10K_DBG_WMI, "wmi init\n"); 1427 return ath10k_wmi_cmd_send(ar, buf, WMI_INIT_CMDID); 1428} 1429 1430static int ath10k_wmi_start_scan_calc_len(const struct wmi_start_scan_arg *arg) 1431{ 1432 int len; 1433 1434 len = sizeof(struct wmi_start_scan_cmd); 1435 1436 if (arg->ie_len) { 1437 if (!arg->ie) 1438 return -EINVAL; 1439 if (arg->ie_len > WLAN_SCAN_PARAMS_MAX_IE_LEN) 1440 return -EINVAL; 1441 1442 len += sizeof(struct wmi_ie_data); 1443 len += roundup(arg->ie_len, 4); 1444 } 1445 1446 if (arg->n_channels) { 1447 if (!arg->channels) 1448 return -EINVAL; 1449 if (arg->n_channels > ARRAY_SIZE(arg->channels)) 1450 return -EINVAL; 1451 1452 len += sizeof(struct wmi_chan_list); 1453 len += sizeof(__le32) * arg->n_channels; 1454 } 1455 1456 if (arg->n_ssids) { 1457 if (!arg->ssids) 1458 return -EINVAL; 1459 if (arg->n_ssids > WLAN_SCAN_PARAMS_MAX_SSID) 1460 return -EINVAL; 1461 1462 len += sizeof(struct wmi_ssid_list); 1463 len += sizeof(struct wmi_ssid) * arg->n_ssids; 1464 } 1465 1466 if (arg->n_bssids) { 1467 if (!arg->bssids) 1468 return -EINVAL; 1469 if (arg->n_bssids > WLAN_SCAN_PARAMS_MAX_BSSID) 1470 return -EINVAL; 1471 1472 len += sizeof(struct wmi_bssid_list); 1473 len += sizeof(struct wmi_mac_addr) * arg->n_bssids; 1474 } 1475 1476 return len; 1477} 1478 1479int ath10k_wmi_start_scan(struct ath10k *ar, 1480 const struct wmi_start_scan_arg *arg) 1481{ 1482 struct wmi_start_scan_cmd *cmd; 1483 struct sk_buff *skb; 1484 struct wmi_ie_data *ie; 1485 struct wmi_chan_list *channels; 1486 struct wmi_ssid_list *ssids; 1487 struct wmi_bssid_list *bssids; 1488 u32 scan_id; 1489 u32 scan_req_id; 1490 int off; 1491 int len = 0; 1492 int i; 1493 1494 len = ath10k_wmi_start_scan_calc_len(arg); 1495 if (len < 0) 1496 return len; /* len contains error code here */ 1497 1498 skb = ath10k_wmi_alloc_skb(len); 1499 if (!skb) 1500 return -ENOMEM; 1501 1502 scan_id = WMI_HOST_SCAN_REQ_ID_PREFIX; 1503 scan_id |= arg->scan_id; 1504 1505 scan_req_id = WMI_HOST_SCAN_REQUESTOR_ID_PREFIX; 1506 scan_req_id |= arg->scan_req_id; 1507 1508 cmd = (struct wmi_start_scan_cmd *)skb->data; 1509 cmd->scan_id = __cpu_to_le32(scan_id); 1510 cmd->scan_req_id = __cpu_to_le32(scan_req_id); 1511 cmd->vdev_id = __cpu_to_le32(arg->vdev_id); 1512 cmd->scan_priority = __cpu_to_le32(arg->scan_priority); 1513 cmd->notify_scan_events = __cpu_to_le32(arg->notify_scan_events); 1514 cmd->dwell_time_active = __cpu_to_le32(arg->dwell_time_active); 1515 cmd->dwell_time_passive = __cpu_to_le32(arg->dwell_time_passive); 1516 cmd->min_rest_time = __cpu_to_le32(arg->min_rest_time); 1517 cmd->max_rest_time = __cpu_to_le32(arg->max_rest_time); 1518 cmd->repeat_probe_time = __cpu_to_le32(arg->repeat_probe_time); 1519 cmd->probe_spacing_time = __cpu_to_le32(arg->probe_spacing_time); 1520 cmd->idle_time = __cpu_to_le32(arg->idle_time); 1521 cmd->max_scan_time = __cpu_to_le32(arg->max_scan_time); 1522 cmd->probe_delay = __cpu_to_le32(arg->probe_delay); 1523 cmd->scan_ctrl_flags = __cpu_to_le32(arg->scan_ctrl_flags); 1524 1525 /* TLV list starts after fields included in the struct */ 1526 off = sizeof(*cmd); 1527 1528 if (arg->n_channels) { 1529 channels = (void *)skb->data + off; 1530 channels->tag = __cpu_to_le32(WMI_CHAN_LIST_TAG); 1531 channels->num_chan = __cpu_to_le32(arg->n_channels); 1532 1533 for (i = 0; i < arg->n_channels; i++) 1534 channels->channel_list[i] = 1535 __cpu_to_le32(arg->channels[i]); 1536 1537 off += sizeof(*channels); 1538 off += sizeof(__le32) * arg->n_channels; 1539 } 1540 1541 if (arg->n_ssids) { 1542 ssids = (void *)skb->data + off; 1543 ssids->tag = __cpu_to_le32(WMI_SSID_LIST_TAG); 1544 ssids->num_ssids = __cpu_to_le32(arg->n_ssids); 1545 1546 for (i = 0; i < arg->n_ssids; i++) { 1547 ssids->ssids[i].ssid_len = 1548 __cpu_to_le32(arg->ssids[i].len); 1549 memcpy(&ssids->ssids[i].ssid, 1550 arg->ssids[i].ssid, 1551 arg->ssids[i].len); 1552 } 1553 1554 off += sizeof(*ssids); 1555 off += sizeof(struct wmi_ssid) * arg->n_ssids; 1556 } 1557 1558 if (arg->n_bssids) { 1559 bssids = (void *)skb->data + off; 1560 bssids->tag = __cpu_to_le32(WMI_BSSID_LIST_TAG); 1561 bssids->num_bssid = __cpu_to_le32(arg->n_bssids); 1562 1563 for (i = 0; i < arg->n_bssids; i++) 1564 memcpy(&bssids->bssid_list[i], 1565 arg->bssids[i].bssid, 1566 ETH_ALEN); 1567 1568 off += sizeof(*bssids); 1569 off += sizeof(struct wmi_mac_addr) * arg->n_bssids; 1570 } 1571 1572 if (arg->ie_len) { 1573 ie = (void *)skb->data + off; 1574 ie->tag = __cpu_to_le32(WMI_IE_TAG); 1575 ie->ie_len = __cpu_to_le32(arg->ie_len); 1576 memcpy(ie->ie_data, arg->ie, arg->ie_len); 1577 1578 off += sizeof(*ie); 1579 off += roundup(arg->ie_len, 4); 1580 } 1581 1582 if (off != skb->len) { 1583 dev_kfree_skb(skb); 1584 return -EINVAL; 1585 } 1586 1587 ath10k_dbg(ATH10K_DBG_WMI, "wmi start scan\n"); 1588 return ath10k_wmi_cmd_send(ar, skb, WMI_START_SCAN_CMDID); 1589} 1590 1591void ath10k_wmi_start_scan_init(struct ath10k *ar, 1592 struct wmi_start_scan_arg *arg) 1593{ 1594 /* setup commonly used values */ 1595 arg->scan_req_id = 1; 1596 arg->scan_priority = WMI_SCAN_PRIORITY_LOW; 1597 arg->dwell_time_active = 50; 1598 arg->dwell_time_passive = 150; 1599 arg->min_rest_time = 50; 1600 arg->max_rest_time = 500; 1601 arg->repeat_probe_time = 0; 1602 arg->probe_spacing_time = 0; 1603 arg->idle_time = 0; 1604 arg->max_scan_time = 5000; 1605 arg->probe_delay = 5; 1606 arg->notify_scan_events = WMI_SCAN_EVENT_STARTED 1607 | WMI_SCAN_EVENT_COMPLETED 1608 | WMI_SCAN_EVENT_BSS_CHANNEL 1609 | WMI_SCAN_EVENT_FOREIGN_CHANNEL 1610 | WMI_SCAN_EVENT_DEQUEUED; 1611 arg->scan_ctrl_flags |= WMI_SCAN_ADD_OFDM_RATES; 1612 arg->scan_ctrl_flags |= WMI_SCAN_CHAN_STAT_EVENT; 1613 arg->n_bssids = 1; 1614 arg->bssids[0].bssid = "\xFF\xFF\xFF\xFF\xFF\xFF"; 1615} 1616 1617int ath10k_wmi_stop_scan(struct ath10k *ar, const struct wmi_stop_scan_arg *arg) 1618{ 1619 struct wmi_stop_scan_cmd *cmd; 1620 struct sk_buff *skb; 1621 u32 scan_id; 1622 u32 req_id; 1623 1624 if (arg->req_id > 0xFFF) 1625 return -EINVAL; 1626 if (arg->req_type == WMI_SCAN_STOP_ONE && arg->u.scan_id > 0xFFF) 1627 return -EINVAL; 1628 1629 skb = ath10k_wmi_alloc_skb(sizeof(*cmd)); 1630 if (!skb) 1631 return -ENOMEM; 1632 1633 scan_id = arg->u.scan_id; 1634 scan_id |= WMI_HOST_SCAN_REQ_ID_PREFIX; 1635 1636 req_id = arg->req_id; 1637 req_id |= WMI_HOST_SCAN_REQUESTOR_ID_PREFIX; 1638 1639 cmd = (struct wmi_stop_scan_cmd *)skb->data; 1640 cmd->req_type = __cpu_to_le32(arg->req_type); 1641 cmd->vdev_id = __cpu_to_le32(arg->u.vdev_id); 1642 cmd->scan_id = __cpu_to_le32(scan_id); 1643 cmd->scan_req_id = __cpu_to_le32(req_id); 1644 1645 ath10k_dbg(ATH10K_DBG_WMI, 1646 "wmi stop scan reqid %d req_type %d vdev/scan_id %d\n", 1647 arg->req_id, arg->req_type, arg->u.scan_id); 1648 return ath10k_wmi_cmd_send(ar, skb, WMI_STOP_SCAN_CMDID); 1649} 1650 1651int ath10k_wmi_vdev_create(struct ath10k *ar, u32 vdev_id, 1652 enum wmi_vdev_type type, 1653 enum wmi_vdev_subtype subtype, 1654 const u8 macaddr[ETH_ALEN]) 1655{ 1656 struct wmi_vdev_create_cmd *cmd; 1657 struct sk_buff *skb; 1658 1659 skb = ath10k_wmi_alloc_skb(sizeof(*cmd)); 1660 if (!skb) 1661 return -ENOMEM; 1662 1663 cmd = (struct wmi_vdev_create_cmd *)skb->data; 1664 cmd->vdev_id = __cpu_to_le32(vdev_id); 1665 cmd->vdev_type = __cpu_to_le32(type); 1666 cmd->vdev_subtype = __cpu_to_le32(subtype); 1667 memcpy(cmd->vdev_macaddr.addr, macaddr, ETH_ALEN); 1668 1669 ath10k_dbg(ATH10K_DBG_WMI, 1670 "WMI vdev create: id %d type %d subtype %d macaddr %pM\n", 1671 vdev_id, type, subtype, macaddr); 1672 1673 return ath10k_wmi_cmd_send(ar, skb, WMI_VDEV_CREATE_CMDID); 1674} 1675 1676int ath10k_wmi_vdev_delete(struct ath10k *ar, u32 vdev_id) 1677{ 1678 struct wmi_vdev_delete_cmd *cmd; 1679 struct sk_buff *skb; 1680 1681 skb = ath10k_wmi_alloc_skb(sizeof(*cmd)); 1682 if (!skb) 1683 return -ENOMEM; 1684 1685 cmd = (struct wmi_vdev_delete_cmd *)skb->data; 1686 cmd->vdev_id = __cpu_to_le32(vdev_id); 1687 1688 ath10k_dbg(ATH10K_DBG_WMI, 1689 "WMI vdev delete id %d\n", vdev_id); 1690 1691 return ath10k_wmi_cmd_send(ar, skb, WMI_VDEV_DELETE_CMDID); 1692} 1693 1694static int ath10k_wmi_vdev_start_restart(struct ath10k *ar, 1695 const struct wmi_vdev_start_request_arg *arg, 1696 enum wmi_cmd_id cmd_id) 1697{ 1698 struct wmi_vdev_start_request_cmd *cmd; 1699 struct sk_buff *skb; 1700 const char *cmdname; 1701 u32 flags = 0; 1702 1703 if (cmd_id != WMI_VDEV_START_REQUEST_CMDID && 1704 cmd_id != WMI_VDEV_RESTART_REQUEST_CMDID) 1705 return -EINVAL; 1706 if (WARN_ON(arg->ssid && arg->ssid_len == 0)) 1707 return -EINVAL; 1708 if (WARN_ON(arg->hidden_ssid && !arg->ssid)) 1709 return -EINVAL; 1710 if (WARN_ON(arg->ssid_len > sizeof(cmd->ssid.ssid))) 1711 return -EINVAL; 1712 1713 if (cmd_id == WMI_VDEV_START_REQUEST_CMDID) 1714 cmdname = "start"; 1715 else if (cmd_id == WMI_VDEV_RESTART_REQUEST_CMDID) 1716 cmdname = "restart"; 1717 else 1718 return -EINVAL; /* should not happen, we already check cmd_id */ 1719 1720 skb = ath10k_wmi_alloc_skb(sizeof(*cmd)); 1721 if (!skb) 1722 return -ENOMEM; 1723 1724 if (arg->hidden_ssid) 1725 flags |= WMI_VDEV_START_HIDDEN_SSID; 1726 if (arg->pmf_enabled) 1727 flags |= WMI_VDEV_START_PMF_ENABLED; 1728 1729 cmd = (struct wmi_vdev_start_request_cmd *)skb->data; 1730 cmd->vdev_id = __cpu_to_le32(arg->vdev_id); 1731 cmd->disable_hw_ack = __cpu_to_le32(arg->disable_hw_ack); 1732 cmd->beacon_interval = __cpu_to_le32(arg->bcn_intval); 1733 cmd->dtim_period = __cpu_to_le32(arg->dtim_period); 1734 cmd->flags = __cpu_to_le32(flags); 1735 cmd->bcn_tx_rate = __cpu_to_le32(arg->bcn_tx_rate); 1736 cmd->bcn_tx_power = __cpu_to_le32(arg->bcn_tx_power); 1737 1738 if (arg->ssid) { 1739 cmd->ssid.ssid_len = __cpu_to_le32(arg->ssid_len); 1740 memcpy(cmd->ssid.ssid, arg->ssid, arg->ssid_len); 1741 } 1742 1743 cmd->chan.mhz = __cpu_to_le32(arg->channel.freq); 1744 1745 cmd->chan.band_center_freq1 = 1746 __cpu_to_le32(arg->channel.band_center_freq1); 1747 1748 cmd->chan.mode = arg->channel.mode; 1749 cmd->chan.min_power = arg->channel.min_power; 1750 cmd->chan.max_power = arg->channel.max_power; 1751 cmd->chan.reg_power = arg->channel.max_reg_power; 1752 cmd->chan.reg_classid = arg->channel.reg_class_id; 1753 cmd->chan.antenna_max = arg->channel.max_antenna_gain; 1754 1755 ath10k_dbg(ATH10K_DBG_WMI, 1756 "wmi vdev %s id 0x%x freq %d, mode %d, ch_flags: 0x%0X," 1757 "max_power: %d\n", cmdname, arg->vdev_id, arg->channel.freq, 1758 arg->channel.mode, flags, arg->channel.max_power); 1759 1760 return ath10k_wmi_cmd_send(ar, skb, cmd_id); 1761} 1762 1763int ath10k_wmi_vdev_start(struct ath10k *ar, 1764 const struct wmi_vdev_start_request_arg *arg) 1765{ 1766 return ath10k_wmi_vdev_start_restart(ar, arg, 1767 WMI_VDEV_START_REQUEST_CMDID); 1768} 1769 1770int ath10k_wmi_vdev_restart(struct ath10k *ar, 1771 const struct wmi_vdev_start_request_arg *arg) 1772{ 1773 return ath10k_wmi_vdev_start_restart(ar, arg, 1774 WMI_VDEV_RESTART_REQUEST_CMDID); 1775} 1776 1777int ath10k_wmi_vdev_stop(struct ath10k *ar, u32 vdev_id) 1778{ 1779 struct wmi_vdev_stop_cmd *cmd; 1780 struct sk_buff *skb; 1781 1782 skb = ath10k_wmi_alloc_skb(sizeof(*cmd)); 1783 if (!skb) 1784 return -ENOMEM; 1785 1786 cmd = (struct wmi_vdev_stop_cmd *)skb->data; 1787 cmd->vdev_id = __cpu_to_le32(vdev_id); 1788 1789 ath10k_dbg(ATH10K_DBG_WMI, "wmi vdev stop id 0x%x\n", vdev_id); 1790 1791 return ath10k_wmi_cmd_send(ar, skb, WMI_VDEV_STOP_CMDID); 1792} 1793 1794int ath10k_wmi_vdev_up(struct ath10k *ar, u32 vdev_id, u32 aid, const u8 *bssid) 1795{ 1796 struct wmi_vdev_up_cmd *cmd; 1797 struct sk_buff *skb; 1798 1799 skb = ath10k_wmi_alloc_skb(sizeof(*cmd)); 1800 if (!skb) 1801 return -ENOMEM; 1802 1803 cmd = (struct wmi_vdev_up_cmd *)skb->data; 1804 cmd->vdev_id = __cpu_to_le32(vdev_id); 1805 cmd->vdev_assoc_id = __cpu_to_le32(aid); 1806 memcpy(&cmd->vdev_bssid.addr, bssid, 6); 1807 1808 ath10k_dbg(ATH10K_DBG_WMI, 1809 "wmi mgmt vdev up id 0x%x assoc id %d bssid %pM\n", 1810 vdev_id, aid, bssid); 1811 1812 return ath10k_wmi_cmd_send(ar, skb, WMI_VDEV_UP_CMDID); 1813} 1814 1815int ath10k_wmi_vdev_down(struct ath10k *ar, u32 vdev_id) 1816{ 1817 struct wmi_vdev_down_cmd *cmd; 1818 struct sk_buff *skb; 1819 1820 skb = ath10k_wmi_alloc_skb(sizeof(*cmd)); 1821 if (!skb) 1822 return -ENOMEM; 1823 1824 cmd = (struct wmi_vdev_down_cmd *)skb->data; 1825 cmd->vdev_id = __cpu_to_le32(vdev_id); 1826 1827 ath10k_dbg(ATH10K_DBG_WMI, 1828 "wmi mgmt vdev down id 0x%x\n", vdev_id); 1829 1830 return ath10k_wmi_cmd_send(ar, skb, WMI_VDEV_DOWN_CMDID); 1831} 1832 1833int ath10k_wmi_vdev_set_param(struct ath10k *ar, u32 vdev_id, 1834 enum wmi_vdev_param param_id, u32 param_value) 1835{ 1836 struct wmi_vdev_set_param_cmd *cmd; 1837 struct sk_buff *skb; 1838 1839 skb = ath10k_wmi_alloc_skb(sizeof(*cmd)); 1840 if (!skb) 1841 return -ENOMEM; 1842 1843 cmd = (struct wmi_vdev_set_param_cmd *)skb->data; 1844 cmd->vdev_id = __cpu_to_le32(vdev_id); 1845 cmd->param_id = __cpu_to_le32(param_id); 1846 cmd->param_value = __cpu_to_le32(param_value); 1847 1848 ath10k_dbg(ATH10K_DBG_WMI, 1849 "wmi vdev id 0x%x set param %d value %d\n", 1850 vdev_id, param_id, param_value); 1851 1852 return ath10k_wmi_cmd_send(ar, skb, WMI_VDEV_SET_PARAM_CMDID); 1853} 1854 1855int ath10k_wmi_vdev_install_key(struct ath10k *ar, 1856 const struct wmi_vdev_install_key_arg *arg) 1857{ 1858 struct wmi_vdev_install_key_cmd *cmd; 1859 struct sk_buff *skb; 1860 1861 if (arg->key_cipher == WMI_CIPHER_NONE && arg->key_data != NULL) 1862 return -EINVAL; 1863 if (arg->key_cipher != WMI_CIPHER_NONE && arg->key_data == NULL) 1864 return -EINVAL; 1865 1866 skb = ath10k_wmi_alloc_skb(sizeof(*cmd) + arg->key_len); 1867 if (!skb) 1868 return -ENOMEM; 1869 1870 cmd = (struct wmi_vdev_install_key_cmd *)skb->data; 1871 cmd->vdev_id = __cpu_to_le32(arg->vdev_id); 1872 cmd->key_idx = __cpu_to_le32(arg->key_idx); 1873 cmd->key_flags = __cpu_to_le32(arg->key_flags); 1874 cmd->key_cipher = __cpu_to_le32(arg->key_cipher); 1875 cmd->key_len = __cpu_to_le32(arg->key_len); 1876 cmd->key_txmic_len = __cpu_to_le32(arg->key_txmic_len); 1877 cmd->key_rxmic_len = __cpu_to_le32(arg->key_rxmic_len); 1878 1879 if (arg->macaddr) 1880 memcpy(cmd->peer_macaddr.addr, arg->macaddr, ETH_ALEN); 1881 if (arg->key_data) 1882 memcpy(cmd->key_data, arg->key_data, arg->key_len); 1883 1884 ath10k_dbg(ATH10K_DBG_WMI, 1885 "wmi vdev install key idx %d cipher %d len %d\n", 1886 arg->key_idx, arg->key_cipher, arg->key_len); 1887 return ath10k_wmi_cmd_send(ar, skb, WMI_VDEV_INSTALL_KEY_CMDID); 1888} 1889 1890int ath10k_wmi_peer_create(struct ath10k *ar, u32 vdev_id, 1891 const u8 peer_addr[ETH_ALEN]) 1892{ 1893 struct wmi_peer_create_cmd *cmd; 1894 struct sk_buff *skb; 1895 1896 skb = ath10k_wmi_alloc_skb(sizeof(*cmd)); 1897 if (!skb) 1898 return -ENOMEM; 1899 1900 cmd = (struct wmi_peer_create_cmd *)skb->data; 1901 cmd->vdev_id = __cpu_to_le32(vdev_id); 1902 memcpy(cmd->peer_macaddr.addr, peer_addr, ETH_ALEN); 1903 1904 ath10k_dbg(ATH10K_DBG_WMI, 1905 "wmi peer create vdev_id %d peer_addr %pM\n", 1906 vdev_id, peer_addr); 1907 return ath10k_wmi_cmd_send(ar, skb, WMI_PEER_CREATE_CMDID); 1908} 1909 1910int ath10k_wmi_peer_delete(struct ath10k *ar, u32 vdev_id, 1911 const u8 peer_addr[ETH_ALEN]) 1912{ 1913 struct wmi_peer_delete_cmd *cmd; 1914 struct sk_buff *skb; 1915 1916 skb = ath10k_wmi_alloc_skb(sizeof(*cmd)); 1917 if (!skb) 1918 return -ENOMEM; 1919 1920 cmd = (struct wmi_peer_delete_cmd *)skb->data; 1921 cmd->vdev_id = __cpu_to_le32(vdev_id); 1922 memcpy(cmd->peer_macaddr.addr, peer_addr, ETH_ALEN); 1923 1924 ath10k_dbg(ATH10K_DBG_WMI, 1925 "wmi peer delete vdev_id %d peer_addr %pM\n", 1926 vdev_id, peer_addr); 1927 return ath10k_wmi_cmd_send(ar, skb, WMI_PEER_DELETE_CMDID); 1928} 1929 1930int ath10k_wmi_peer_flush(struct ath10k *ar, u32 vdev_id, 1931 const u8 peer_addr[ETH_ALEN], u32 tid_bitmap) 1932{ 1933 struct wmi_peer_flush_tids_cmd *cmd; 1934 struct sk_buff *skb; 1935 1936 skb = ath10k_wmi_alloc_skb(sizeof(*cmd)); 1937 if (!skb) 1938 return -ENOMEM; 1939 1940 cmd = (struct wmi_peer_flush_tids_cmd *)skb->data; 1941 cmd->vdev_id = __cpu_to_le32(vdev_id); 1942 cmd->peer_tid_bitmap = __cpu_to_le32(tid_bitmap); 1943 memcpy(cmd->peer_macaddr.addr, peer_addr, ETH_ALEN); 1944 1945 ath10k_dbg(ATH10K_DBG_WMI, 1946 "wmi peer flush vdev_id %d peer_addr %pM tids %08x\n", 1947 vdev_id, peer_addr, tid_bitmap); 1948 return ath10k_wmi_cmd_send(ar, skb, WMI_PEER_FLUSH_TIDS_CMDID); 1949} 1950 1951int ath10k_wmi_peer_set_param(struct ath10k *ar, u32 vdev_id, 1952 const u8 *peer_addr, enum wmi_peer_param param_id, 1953 u32 param_value) 1954{ 1955 struct wmi_peer_set_param_cmd *cmd; 1956 struct sk_buff *skb; 1957 1958 skb = ath10k_wmi_alloc_skb(sizeof(*cmd)); 1959 if (!skb) 1960 return -ENOMEM; 1961 1962 cmd = (struct wmi_peer_set_param_cmd *)skb->data; 1963 cmd->vdev_id = __cpu_to_le32(vdev_id); 1964 cmd->param_id = __cpu_to_le32(param_id); 1965 cmd->param_value = __cpu_to_le32(param_value); 1966 memcpy(&cmd->peer_macaddr.addr, peer_addr, 6); 1967 1968 ath10k_dbg(ATH10K_DBG_WMI, 1969 "wmi vdev %d peer 0x%pM set param %d value %d\n", 1970 vdev_id, peer_addr, param_id, param_value); 1971 1972 return ath10k_wmi_cmd_send(ar, skb, WMI_PEER_SET_PARAM_CMDID); 1973} 1974 1975int ath10k_wmi_set_psmode(struct ath10k *ar, u32 vdev_id, 1976 enum wmi_sta_ps_mode psmode) 1977{ 1978 struct wmi_sta_powersave_mode_cmd *cmd; 1979 struct sk_buff *skb; 1980 1981 skb = ath10k_wmi_alloc_skb(sizeof(*cmd)); 1982 if (!skb) 1983 return -ENOMEM; 1984 1985 cmd = (struct wmi_sta_powersave_mode_cmd *)skb->data; 1986 cmd->vdev_id = __cpu_to_le32(vdev_id); 1987 cmd->sta_ps_mode = __cpu_to_le32(psmode); 1988 1989 ath10k_dbg(ATH10K_DBG_WMI, 1990 "wmi set powersave id 0x%x mode %d\n", 1991 vdev_id, psmode); 1992 1993 return ath10k_wmi_cmd_send(ar, skb, WMI_STA_POWERSAVE_MODE_CMDID); 1994} 1995 1996int ath10k_wmi_set_sta_ps_param(struct ath10k *ar, u32 vdev_id, 1997 enum wmi_sta_powersave_param param_id, 1998 u32 value) 1999{ 2000 struct wmi_sta_powersave_param_cmd *cmd; 2001 struct sk_buff *skb; 2002 2003 skb = ath10k_wmi_alloc_skb(sizeof(*cmd)); 2004 if (!skb) 2005 return -ENOMEM; 2006 2007 cmd = (struct wmi_sta_powersave_param_cmd *)skb->data; 2008 cmd->vdev_id = __cpu_to_le32(vdev_id); 2009 cmd->param_id = __cpu_to_le32(param_id); 2010 cmd->param_value = __cpu_to_le32(value); 2011 2012 ath10k_dbg(ATH10K_DBG_WMI, 2013 "wmi sta ps param vdev_id 0x%x param %d value %d\n", 2014 vdev_id, param_id, value); 2015 return ath10k_wmi_cmd_send(ar, skb, WMI_STA_POWERSAVE_PARAM_CMDID); 2016} 2017 2018int ath10k_wmi_set_ap_ps_param(struct ath10k *ar, u32 vdev_id, const u8 *mac, 2019 enum wmi_ap_ps_peer_param param_id, u32 value) 2020{ 2021 struct wmi_ap_ps_peer_cmd *cmd; 2022 struct sk_buff *skb; 2023 2024 if (!mac) 2025 return -EINVAL; 2026 2027 skb = ath10k_wmi_alloc_skb(sizeof(*cmd)); 2028 if (!skb) 2029 return -ENOMEM; 2030 2031 cmd = (struct wmi_ap_ps_peer_cmd *)skb->data; 2032 cmd->vdev_id = __cpu_to_le32(vdev_id); 2033 cmd->param_id = __cpu_to_le32(param_id); 2034 cmd->param_value = __cpu_to_le32(value); 2035 memcpy(&cmd->peer_macaddr, mac, ETH_ALEN); 2036 2037 ath10k_dbg(ATH10K_DBG_WMI, 2038 "wmi ap ps param vdev_id 0x%X param %d value %d mac_addr %pM\n", 2039 vdev_id, param_id, value, mac); 2040 2041 return ath10k_wmi_cmd_send(ar, skb, WMI_AP_PS_PEER_PARAM_CMDID); 2042} 2043 2044int ath10k_wmi_scan_chan_list(struct ath10k *ar, 2045 const struct wmi_scan_chan_list_arg *arg) 2046{ 2047 struct wmi_scan_chan_list_cmd *cmd; 2048 struct sk_buff *skb; 2049 struct wmi_channel_arg *ch; 2050 struct wmi_channel *ci; 2051 int len; 2052 int i; 2053 2054 len = sizeof(*cmd) + arg->n_channels * sizeof(struct wmi_channel); 2055 2056 skb = ath10k_wmi_alloc_skb(len); 2057 if (!skb) 2058 return -EINVAL; 2059 2060 cmd = (struct wmi_scan_chan_list_cmd *)skb->data; 2061 cmd->num_scan_chans = __cpu_to_le32(arg->n_channels); 2062 2063 for (i = 0; i < arg->n_channels; i++) { 2064 u32 flags = 0; 2065 2066 ch = &arg->channels[i]; 2067 ci = &cmd->chan_info[i]; 2068 2069 if (ch->passive) 2070 flags |= WMI_CHAN_FLAG_PASSIVE; 2071 if (ch->allow_ibss) 2072 flags |= WMI_CHAN_FLAG_ADHOC_ALLOWED; 2073 if (ch->allow_ht) 2074 flags |= WMI_CHAN_FLAG_ALLOW_HT; 2075 if (ch->allow_vht) 2076 flags |= WMI_CHAN_FLAG_ALLOW_VHT; 2077 if (ch->ht40plus) 2078 flags |= WMI_CHAN_FLAG_HT40_PLUS; 2079 2080 ci->mhz = __cpu_to_le32(ch->freq); 2081 ci->band_center_freq1 = __cpu_to_le32(ch->freq); 2082 ci->band_center_freq2 = 0; 2083 ci->min_power = ch->min_power; 2084 ci->max_power = ch->max_power; 2085 ci->reg_power = ch->max_reg_power; 2086 ci->antenna_max = ch->max_antenna_gain; 2087 ci->antenna_max = 0; 2088 2089 /* mode & flags share storage */ 2090 ci->mode = ch->mode; 2091 ci->flags |= __cpu_to_le32(flags); 2092 } 2093 2094 return ath10k_wmi_cmd_send(ar, skb, WMI_SCAN_CHAN_LIST_CMDID); 2095} 2096 2097int ath10k_wmi_peer_assoc(struct ath10k *ar, 2098 const struct wmi_peer_assoc_complete_arg *arg) 2099{ 2100 struct wmi_peer_assoc_complete_cmd *cmd; 2101 struct sk_buff *skb; 2102 2103 if (arg->peer_mpdu_density > 16) 2104 return -EINVAL; 2105 if (arg->peer_legacy_rates.num_rates > MAX_SUPPORTED_RATES) 2106 return -EINVAL; 2107 if (arg->peer_ht_rates.num_rates > MAX_SUPPORTED_RATES) 2108 return -EINVAL; 2109 2110 skb = ath10k_wmi_alloc_skb(sizeof(*cmd)); 2111 if (!skb) 2112 return -ENOMEM; 2113 2114 cmd = (struct wmi_peer_assoc_complete_cmd *)skb->data; 2115 cmd->vdev_id = __cpu_to_le32(arg->vdev_id); 2116 cmd->peer_new_assoc = __cpu_to_le32(arg->peer_reassoc ? 0 : 1); 2117 cmd->peer_associd = __cpu_to_le32(arg->peer_aid); 2118 cmd->peer_flags = __cpu_to_le32(arg->peer_flags); 2119 cmd->peer_caps = __cpu_to_le32(arg->peer_caps); 2120 cmd->peer_listen_intval = __cpu_to_le32(arg->peer_listen_intval); 2121 cmd->peer_ht_caps = __cpu_to_le32(arg->peer_ht_caps); 2122 cmd->peer_max_mpdu = __cpu_to_le32(arg->peer_max_mpdu); 2123 cmd->peer_mpdu_density = __cpu_to_le32(arg->peer_mpdu_density); 2124 cmd->peer_rate_caps = __cpu_to_le32(arg->peer_rate_caps); 2125 cmd->peer_nss = __cpu_to_le32(arg->peer_num_spatial_streams); 2126 cmd->peer_vht_caps = __cpu_to_le32(arg->peer_vht_caps); 2127 cmd->peer_phymode = __cpu_to_le32(arg->peer_phymode); 2128 2129 memcpy(cmd->peer_macaddr.addr, arg->addr, ETH_ALEN); 2130 2131 cmd->peer_legacy_rates.num_rates = 2132 __cpu_to_le32(arg->peer_legacy_rates.num_rates); 2133 memcpy(cmd->peer_legacy_rates.rates, arg->peer_legacy_rates.rates, 2134 arg->peer_legacy_rates.num_rates); 2135 2136 cmd->peer_ht_rates.num_rates = 2137 __cpu_to_le32(arg->peer_ht_rates.num_rates); 2138 memcpy(cmd->peer_ht_rates.rates, arg->peer_ht_rates.rates, 2139 arg->peer_ht_rates.num_rates); 2140 2141 cmd->peer_vht_rates.rx_max_rate = 2142 __cpu_to_le32(arg->peer_vht_rates.rx_max_rate); 2143 cmd->peer_vht_rates.rx_mcs_set = 2144 __cpu_to_le32(arg->peer_vht_rates.rx_mcs_set); 2145 cmd->peer_vht_rates.tx_max_rate = 2146 __cpu_to_le32(arg->peer_vht_rates.tx_max_rate); 2147 cmd->peer_vht_rates.tx_mcs_set = 2148 __cpu_to_le32(arg->peer_vht_rates.tx_mcs_set); 2149 2150 ath10k_dbg(ATH10K_DBG_WMI, 2151 "wmi peer assoc vdev %d addr %pM\n", 2152 arg->vdev_id, arg->addr); 2153 return ath10k_wmi_cmd_send(ar, skb, WMI_PEER_ASSOC_CMDID); 2154} 2155 2156int ath10k_wmi_beacon_send_nowait(struct ath10k *ar, 2157 const struct wmi_bcn_tx_arg *arg) 2158{ 2159 struct wmi_bcn_tx_cmd *cmd; 2160 struct sk_buff *skb; 2161 2162 skb = ath10k_wmi_alloc_skb(sizeof(*cmd) + arg->bcn_len); 2163 if (!skb) 2164 return -ENOMEM; 2165 2166 cmd = (struct wmi_bcn_tx_cmd *)skb->data; 2167 cmd->hdr.vdev_id = __cpu_to_le32(arg->vdev_id); 2168 cmd->hdr.tx_rate = __cpu_to_le32(arg->tx_rate); 2169 cmd->hdr.tx_power = __cpu_to_le32(arg->tx_power); 2170 cmd->hdr.bcn_len = __cpu_to_le32(arg->bcn_len); 2171 memcpy(cmd->bcn, arg->bcn, arg->bcn_len); 2172 2173 return ath10k_wmi_cmd_send_nowait(ar, skb, WMI_BCN_TX_CMDID); 2174} 2175 2176static void ath10k_wmi_pdev_set_wmm_param(struct wmi_wmm_params *params, 2177 const struct wmi_wmm_params_arg *arg) 2178{ 2179 params->cwmin = __cpu_to_le32(arg->cwmin); 2180 params->cwmax = __cpu_to_le32(arg->cwmax); 2181 params->aifs = __cpu_to_le32(arg->aifs); 2182 params->txop = __cpu_to_le32(arg->txop); 2183 params->acm = __cpu_to_le32(arg->acm); 2184 params->no_ack = __cpu_to_le32(arg->no_ack); 2185} 2186 2187int ath10k_wmi_pdev_set_wmm_params(struct ath10k *ar, 2188 const struct wmi_pdev_set_wmm_params_arg *arg) 2189{ 2190 struct wmi_pdev_set_wmm_params *cmd; 2191 struct sk_buff *skb; 2192 2193 skb = ath10k_wmi_alloc_skb(sizeof(*cmd)); 2194 if (!skb) 2195 return -ENOMEM; 2196 2197 cmd = (struct wmi_pdev_set_wmm_params *)skb->data; 2198 ath10k_wmi_pdev_set_wmm_param(&cmd->ac_be, &arg->ac_be); 2199 ath10k_wmi_pdev_set_wmm_param(&cmd->ac_bk, &arg->ac_bk); 2200 ath10k_wmi_pdev_set_wmm_param(&cmd->ac_vi, &arg->ac_vi); 2201 ath10k_wmi_pdev_set_wmm_param(&cmd->ac_vo, &arg->ac_vo); 2202 2203 ath10k_dbg(ATH10K_DBG_WMI, "wmi pdev set wmm params\n"); 2204 return ath10k_wmi_cmd_send(ar, skb, WMI_PDEV_SET_WMM_PARAMS_CMDID); 2205} 2206 2207int ath10k_wmi_request_stats(struct ath10k *ar, enum wmi_stats_id stats_id) 2208{ 2209 struct wmi_request_stats_cmd *cmd; 2210 struct sk_buff *skb; 2211 2212 skb = ath10k_wmi_alloc_skb(sizeof(*cmd)); 2213 if (!skb) 2214 return -ENOMEM; 2215 2216 cmd = (struct wmi_request_stats_cmd *)skb->data; 2217 cmd->stats_id = __cpu_to_le32(stats_id); 2218 2219 ath10k_dbg(ATH10K_DBG_WMI, "wmi request stats %d\n", (int)stats_id); 2220 return ath10k_wmi_cmd_send(ar, skb, WMI_REQUEST_STATS_CMDID); 2221} 2222 2223int ath10k_wmi_force_fw_hang(struct ath10k *ar, 2224 enum wmi_force_fw_hang_type type, u32 delay_ms) 2225{ 2226 struct wmi_force_fw_hang_cmd *cmd; 2227 struct sk_buff *skb; 2228 2229 skb = ath10k_wmi_alloc_skb(sizeof(*cmd)); 2230 if (!skb) 2231 return -ENOMEM; 2232 2233 cmd = (struct wmi_force_fw_hang_cmd *)skb->data; 2234 cmd->type = __cpu_to_le32(type); 2235 cmd->delay_ms = __cpu_to_le32(delay_ms); 2236 2237 ath10k_dbg(ATH10K_DBG_WMI, "wmi force fw hang %d delay %d\n", 2238 type, delay_ms); 2239 return ath10k_wmi_cmd_send(ar, skb, WMI_FORCE_FW_HANG_CMDID); 2240} 2241