Linux Audio

Check our new training course

Loading...
v6.8
   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) 2022 Qualcomm Innovation Center, Inc. All rights reserved.
   6 */
   7
   8#include <linux/etherdevice.h>
   9#include "htt.h"
  10#include "mac.h"
  11#include "hif.h"
  12#include "txrx.h"
  13#include "debug.h"
  14
  15static u8 ath10k_htt_tx_txq_calc_size(size_t count)
  16{
  17	int exp;
  18	int factor;
  19
  20	exp = 0;
  21	factor = count >> 7;
  22
  23	while (factor >= 64 && exp < 4) {
  24		factor >>= 3;
  25		exp++;
  26	}
  27
  28	if (exp == 4)
  29		return 0xff;
  30
  31	if (count > 0)
  32		factor = max(1, factor);
  33
  34	return SM(exp, HTT_TX_Q_STATE_ENTRY_EXP) |
  35	       SM(factor, HTT_TX_Q_STATE_ENTRY_FACTOR);
  36}
  37
  38static void __ath10k_htt_tx_txq_recalc(struct ieee80211_hw *hw,
  39				       struct ieee80211_txq *txq)
  40{
  41	struct ath10k *ar = hw->priv;
  42	struct ath10k_sta *arsta;
  43	struct ath10k_vif *arvif = (void *)txq->vif->drv_priv;
 
  44	unsigned long byte_cnt;
  45	int idx;
  46	u32 bit;
  47	u16 peer_id;
  48	u8 tid;
  49	u8 count;
  50
  51	lockdep_assert_held(&ar->htt.tx_lock);
  52
  53	if (!ar->htt.tx_q_state.enabled)
  54		return;
  55
  56	if (ar->htt.tx_q_state.mode != HTT_TX_MODE_SWITCH_PUSH_PULL)
  57		return;
  58
  59	if (txq->sta) {
  60		arsta = (void *)txq->sta->drv_priv;
  61		peer_id = arsta->peer_id;
  62	} else {
  63		peer_id = arvif->peer_id;
  64	}
  65
  66	tid = txq->tid;
  67	bit = BIT(peer_id % 32);
  68	idx = peer_id / 32;
  69
  70	ieee80211_txq_get_depth(txq, NULL, &byte_cnt);
  71	count = ath10k_htt_tx_txq_calc_size(byte_cnt);
  72
  73	if (unlikely(peer_id >= ar->htt.tx_q_state.num_peers) ||
  74	    unlikely(tid >= ar->htt.tx_q_state.num_tids)) {
  75		ath10k_warn(ar, "refusing to update txq for peer_id %u tid %u due to out of bounds\n",
  76			    peer_id, tid);
  77		return;
  78	}
  79
  80	ar->htt.tx_q_state.vaddr->count[tid][peer_id] = count;
  81	ar->htt.tx_q_state.vaddr->map[tid][idx] &= ~bit;
  82	ar->htt.tx_q_state.vaddr->map[tid][idx] |= count ? bit : 0;
  83
  84	ath10k_dbg(ar, ATH10K_DBG_HTT, "htt tx txq state update peer_id %u tid %u count %u\n",
  85		   peer_id, tid, count);
  86}
  87
  88static void __ath10k_htt_tx_txq_sync(struct ath10k *ar)
  89{
  90	u32 seq;
  91	size_t size;
  92
  93	lockdep_assert_held(&ar->htt.tx_lock);
  94
  95	if (!ar->htt.tx_q_state.enabled)
  96		return;
  97
  98	if (ar->htt.tx_q_state.mode != HTT_TX_MODE_SWITCH_PUSH_PULL)
  99		return;
 100
 101	seq = le32_to_cpu(ar->htt.tx_q_state.vaddr->seq);
 102	seq++;
 103	ar->htt.tx_q_state.vaddr->seq = cpu_to_le32(seq);
 104
 105	ath10k_dbg(ar, ATH10K_DBG_HTT, "htt tx txq state update commit seq %u\n",
 106		   seq);
 107
 108	size = sizeof(*ar->htt.tx_q_state.vaddr);
 109	dma_sync_single_for_device(ar->dev,
 110				   ar->htt.tx_q_state.paddr,
 111				   size,
 112				   DMA_TO_DEVICE);
 113}
 114
 115void ath10k_htt_tx_txq_recalc(struct ieee80211_hw *hw,
 116			      struct ieee80211_txq *txq)
 117{
 118	struct ath10k *ar = hw->priv;
 119
 120	spin_lock_bh(&ar->htt.tx_lock);
 121	__ath10k_htt_tx_txq_recalc(hw, txq);
 122	spin_unlock_bh(&ar->htt.tx_lock);
 123}
 124
 125void ath10k_htt_tx_txq_sync(struct ath10k *ar)
 126{
 127	spin_lock_bh(&ar->htt.tx_lock);
 128	__ath10k_htt_tx_txq_sync(ar);
 129	spin_unlock_bh(&ar->htt.tx_lock);
 130}
 131
 132void ath10k_htt_tx_txq_update(struct ieee80211_hw *hw,
 133			      struct ieee80211_txq *txq)
 134{
 135	struct ath10k *ar = hw->priv;
 136
 137	spin_lock_bh(&ar->htt.tx_lock);
 138	__ath10k_htt_tx_txq_recalc(hw, txq);
 139	__ath10k_htt_tx_txq_sync(ar);
 140	spin_unlock_bh(&ar->htt.tx_lock);
 141}
 142
 143void ath10k_htt_tx_dec_pending(struct ath10k_htt *htt)
 144{
 145	lockdep_assert_held(&htt->tx_lock);
 146
 147	htt->num_pending_tx--;
 148	if (htt->num_pending_tx == htt->max_num_pending_tx - 1)
 149		ath10k_mac_tx_unlock(htt->ar, ATH10K_TX_PAUSE_Q_FULL);
 150
 151	if (htt->num_pending_tx == 0)
 152		wake_up(&htt->empty_tx_wq);
 153}
 154
 155int ath10k_htt_tx_inc_pending(struct ath10k_htt *htt)
 156{
 157	lockdep_assert_held(&htt->tx_lock);
 158
 159	if (htt->num_pending_tx >= htt->max_num_pending_tx)
 160		return -EBUSY;
 161
 162	htt->num_pending_tx++;
 163	if (htt->num_pending_tx == htt->max_num_pending_tx)
 164		ath10k_mac_tx_lock(htt->ar, ATH10K_TX_PAUSE_Q_FULL);
 165
 166	return 0;
 167}
 168
 169int ath10k_htt_tx_mgmt_inc_pending(struct ath10k_htt *htt, bool is_mgmt,
 170				   bool is_presp)
 171{
 172	struct ath10k *ar = htt->ar;
 173
 174	lockdep_assert_held(&htt->tx_lock);
 175
 176	if (!is_mgmt || !ar->hw_params.max_probe_resp_desc_thres)
 177		return 0;
 178
 179	if (is_presp &&
 180	    ar->hw_params.max_probe_resp_desc_thres < htt->num_pending_mgmt_tx)
 181		return -EBUSY;
 182
 183	htt->num_pending_mgmt_tx++;
 184
 185	return 0;
 186}
 187
 188void ath10k_htt_tx_mgmt_dec_pending(struct ath10k_htt *htt)
 189{
 190	lockdep_assert_held(&htt->tx_lock);
 191
 192	if (!htt->ar->hw_params.max_probe_resp_desc_thres)
 193		return;
 194
 195	htt->num_pending_mgmt_tx--;
 196}
 197
 198int ath10k_htt_tx_alloc_msdu_id(struct ath10k_htt *htt, struct sk_buff *skb)
 199{
 200	struct ath10k *ar = htt->ar;
 201	int ret;
 202
 203	spin_lock_bh(&htt->tx_lock);
 204	ret = idr_alloc(&htt->pending_tx, skb, 0,
 205			htt->max_num_pending_tx, GFP_ATOMIC);
 206	spin_unlock_bh(&htt->tx_lock);
 207
 208	ath10k_dbg(ar, ATH10K_DBG_HTT, "htt tx alloc msdu_id %d\n", ret);
 209
 210	return ret;
 211}
 212
 213void ath10k_htt_tx_free_msdu_id(struct ath10k_htt *htt, u16 msdu_id)
 214{
 215	struct ath10k *ar = htt->ar;
 216
 217	lockdep_assert_held(&htt->tx_lock);
 218
 219	ath10k_dbg(ar, ATH10K_DBG_HTT, "htt tx free msdu_id %u\n", msdu_id);
 220
 221	idr_remove(&htt->pending_tx, msdu_id);
 222}
 223
 224static void ath10k_htt_tx_free_cont_txbuf_32(struct ath10k_htt *htt)
 225{
 226	struct ath10k *ar = htt->ar;
 227	size_t size;
 228
 229	if (!htt->txbuf.vaddr_txbuff_32)
 230		return;
 231
 232	size = htt->txbuf.size;
 233	dma_free_coherent(ar->dev, size, htt->txbuf.vaddr_txbuff_32,
 234			  htt->txbuf.paddr);
 235	htt->txbuf.vaddr_txbuff_32 = NULL;
 236}
 237
 238static int ath10k_htt_tx_alloc_cont_txbuf_32(struct ath10k_htt *htt)
 239{
 240	struct ath10k *ar = htt->ar;
 241	size_t size;
 242
 243	size = htt->max_num_pending_tx *
 244			sizeof(struct ath10k_htt_txbuf_32);
 245
 246	htt->txbuf.vaddr_txbuff_32 = dma_alloc_coherent(ar->dev, size,
 247							&htt->txbuf.paddr,
 248							GFP_KERNEL);
 249	if (!htt->txbuf.vaddr_txbuff_32)
 250		return -ENOMEM;
 251
 252	htt->txbuf.size = size;
 253
 254	return 0;
 255}
 256
 257static void ath10k_htt_tx_free_cont_txbuf_64(struct ath10k_htt *htt)
 258{
 259	struct ath10k *ar = htt->ar;
 260	size_t size;
 261
 262	if (!htt->txbuf.vaddr_txbuff_64)
 263		return;
 264
 265	size = htt->txbuf.size;
 266	dma_free_coherent(ar->dev, size, htt->txbuf.vaddr_txbuff_64,
 267			  htt->txbuf.paddr);
 268	htt->txbuf.vaddr_txbuff_64 = NULL;
 269}
 270
 271static int ath10k_htt_tx_alloc_cont_txbuf_64(struct ath10k_htt *htt)
 272{
 273	struct ath10k *ar = htt->ar;
 274	size_t size;
 275
 276	size = htt->max_num_pending_tx *
 277			sizeof(struct ath10k_htt_txbuf_64);
 278
 279	htt->txbuf.vaddr_txbuff_64 = dma_alloc_coherent(ar->dev, size,
 280							&htt->txbuf.paddr,
 281							GFP_KERNEL);
 282	if (!htt->txbuf.vaddr_txbuff_64)
 283		return -ENOMEM;
 284
 285	htt->txbuf.size = size;
 286
 287	return 0;
 288}
 289
 290static void ath10k_htt_tx_free_cont_frag_desc_32(struct ath10k_htt *htt)
 291{
 292	size_t size;
 293
 294	if (!htt->frag_desc.vaddr_desc_32)
 295		return;
 296
 297	size = htt->max_num_pending_tx *
 298			sizeof(struct htt_msdu_ext_desc);
 299
 300	dma_free_coherent(htt->ar->dev,
 301			  size,
 302			  htt->frag_desc.vaddr_desc_32,
 303			  htt->frag_desc.paddr);
 304
 305	htt->frag_desc.vaddr_desc_32 = NULL;
 306}
 307
 308static int ath10k_htt_tx_alloc_cont_frag_desc_32(struct ath10k_htt *htt)
 309{
 310	struct ath10k *ar = htt->ar;
 311	size_t size;
 312
 313	if (!ar->hw_params.continuous_frag_desc)
 314		return 0;
 315
 316	size = htt->max_num_pending_tx *
 317			sizeof(struct htt_msdu_ext_desc);
 318	htt->frag_desc.vaddr_desc_32 = dma_alloc_coherent(ar->dev, size,
 319							  &htt->frag_desc.paddr,
 320							  GFP_KERNEL);
 321	if (!htt->frag_desc.vaddr_desc_32) {
 322		ath10k_err(ar, "failed to alloc fragment desc memory\n");
 323		return -ENOMEM;
 324	}
 325	htt->frag_desc.size = size;
 326
 327	return 0;
 328}
 329
 330static void ath10k_htt_tx_free_cont_frag_desc_64(struct ath10k_htt *htt)
 331{
 332	size_t size;
 333
 334	if (!htt->frag_desc.vaddr_desc_64)
 335		return;
 336
 337	size = htt->max_num_pending_tx *
 338			sizeof(struct htt_msdu_ext_desc_64);
 339
 340	dma_free_coherent(htt->ar->dev,
 341			  size,
 342			  htt->frag_desc.vaddr_desc_64,
 343			  htt->frag_desc.paddr);
 344
 345	htt->frag_desc.vaddr_desc_64 = NULL;
 346}
 347
 348static int ath10k_htt_tx_alloc_cont_frag_desc_64(struct ath10k_htt *htt)
 349{
 350	struct ath10k *ar = htt->ar;
 351	size_t size;
 352
 353	if (!ar->hw_params.continuous_frag_desc)
 354		return 0;
 355
 356	size = htt->max_num_pending_tx *
 357			sizeof(struct htt_msdu_ext_desc_64);
 358
 359	htt->frag_desc.vaddr_desc_64 = dma_alloc_coherent(ar->dev, size,
 360							  &htt->frag_desc.paddr,
 361							  GFP_KERNEL);
 362	if (!htt->frag_desc.vaddr_desc_64) {
 363		ath10k_err(ar, "failed to alloc fragment desc memory\n");
 364		return -ENOMEM;
 365	}
 366	htt->frag_desc.size = size;
 367
 368	return 0;
 369}
 370
 371static void ath10k_htt_tx_free_txq(struct ath10k_htt *htt)
 372{
 373	struct ath10k *ar = htt->ar;
 374	size_t size;
 375
 376	if (!test_bit(ATH10K_FW_FEATURE_PEER_FLOW_CONTROL,
 377		      ar->running_fw->fw_file.fw_features))
 378		return;
 379
 380	size = sizeof(*htt->tx_q_state.vaddr);
 381
 382	dma_unmap_single(ar->dev, htt->tx_q_state.paddr, size, DMA_TO_DEVICE);
 383	kfree(htt->tx_q_state.vaddr);
 384}
 385
 386static int ath10k_htt_tx_alloc_txq(struct ath10k_htt *htt)
 387{
 388	struct ath10k *ar = htt->ar;
 389	size_t size;
 390	int ret;
 391
 392	if (!test_bit(ATH10K_FW_FEATURE_PEER_FLOW_CONTROL,
 393		      ar->running_fw->fw_file.fw_features))
 394		return 0;
 395
 396	htt->tx_q_state.num_peers = HTT_TX_Q_STATE_NUM_PEERS;
 397	htt->tx_q_state.num_tids = HTT_TX_Q_STATE_NUM_TIDS;
 398	htt->tx_q_state.type = HTT_Q_DEPTH_TYPE_BYTES;
 399
 400	size = sizeof(*htt->tx_q_state.vaddr);
 401	htt->tx_q_state.vaddr = kzalloc(size, GFP_KERNEL);
 402	if (!htt->tx_q_state.vaddr)
 403		return -ENOMEM;
 404
 405	htt->tx_q_state.paddr = dma_map_single(ar->dev, htt->tx_q_state.vaddr,
 406					       size, DMA_TO_DEVICE);
 407	ret = dma_mapping_error(ar->dev, htt->tx_q_state.paddr);
 408	if (ret) {
 409		ath10k_warn(ar, "failed to dma map tx_q_state: %d\n", ret);
 410		kfree(htt->tx_q_state.vaddr);
 411		return -EIO;
 412	}
 413
 414	return 0;
 415}
 416
 417static void ath10k_htt_tx_free_txdone_fifo(struct ath10k_htt *htt)
 418{
 419	WARN_ON(!kfifo_is_empty(&htt->txdone_fifo));
 420	kfifo_free(&htt->txdone_fifo);
 421}
 422
 423static int ath10k_htt_tx_alloc_txdone_fifo(struct ath10k_htt *htt)
 424{
 425	int ret;
 426	size_t size;
 427
 428	size = roundup_pow_of_two(htt->max_num_pending_tx);
 429	ret = kfifo_alloc(&htt->txdone_fifo, size, GFP_KERNEL);
 430	return ret;
 431}
 432
 433static int ath10k_htt_tx_alloc_buf(struct ath10k_htt *htt)
 434{
 435	struct ath10k *ar = htt->ar;
 436	int ret;
 437
 438	ret = ath10k_htt_alloc_txbuff(htt);
 439	if (ret) {
 440		ath10k_err(ar, "failed to alloc cont tx buffer: %d\n", ret);
 441		return ret;
 442	}
 443
 444	ret = ath10k_htt_alloc_frag_desc(htt);
 445	if (ret) {
 446		ath10k_err(ar, "failed to alloc cont frag desc: %d\n", ret);
 447		goto free_txbuf;
 448	}
 449
 450	ret = ath10k_htt_tx_alloc_txq(htt);
 451	if (ret) {
 452		ath10k_err(ar, "failed to alloc txq: %d\n", ret);
 453		goto free_frag_desc;
 454	}
 455
 456	ret = ath10k_htt_tx_alloc_txdone_fifo(htt);
 457	if (ret) {
 458		ath10k_err(ar, "failed to alloc txdone fifo: %d\n", ret);
 459		goto free_txq;
 460	}
 461
 462	return 0;
 463
 464free_txq:
 465	ath10k_htt_tx_free_txq(htt);
 466
 467free_frag_desc:
 468	ath10k_htt_free_frag_desc(htt);
 469
 470free_txbuf:
 471	ath10k_htt_free_txbuff(htt);
 472
 473	return ret;
 474}
 475
 476int ath10k_htt_tx_start(struct ath10k_htt *htt)
 477{
 478	struct ath10k *ar = htt->ar;
 479	int ret;
 480
 481	ath10k_dbg(ar, ATH10K_DBG_BOOT, "htt tx max num pending tx %d\n",
 482		   htt->max_num_pending_tx);
 483
 484	spin_lock_init(&htt->tx_lock);
 485	idr_init(&htt->pending_tx);
 486
 487	if (htt->tx_mem_allocated)
 488		return 0;
 489
 490	if (ar->bus_param.dev_type == ATH10K_DEV_TYPE_HL)
 491		return 0;
 492
 493	ret = ath10k_htt_tx_alloc_buf(htt);
 494	if (ret)
 495		goto free_idr_pending_tx;
 496
 497	htt->tx_mem_allocated = true;
 498
 499	return 0;
 500
 501free_idr_pending_tx:
 502	idr_destroy(&htt->pending_tx);
 503
 504	return ret;
 505}
 506
 507static int ath10k_htt_tx_clean_up_pending(int msdu_id, void *skb, void *ctx)
 508{
 509	struct ath10k *ar = ctx;
 510	struct ath10k_htt *htt = &ar->htt;
 511	struct htt_tx_done tx_done = {0};
 512
 513	ath10k_dbg(ar, ATH10K_DBG_HTT, "force cleanup msdu_id %u\n", msdu_id);
 514
 515	tx_done.msdu_id = msdu_id;
 516	tx_done.status = HTT_TX_COMPL_STATE_DISCARD;
 517
 518	ath10k_txrx_tx_unref(htt, &tx_done);
 519
 520	return 0;
 521}
 522
 523void ath10k_htt_tx_destroy(struct ath10k_htt *htt)
 524{
 525	if (!htt->tx_mem_allocated)
 526		return;
 527
 528	ath10k_htt_free_txbuff(htt);
 529	ath10k_htt_tx_free_txq(htt);
 530	ath10k_htt_free_frag_desc(htt);
 531	ath10k_htt_tx_free_txdone_fifo(htt);
 532	htt->tx_mem_allocated = false;
 533}
 534
 535static void ath10k_htt_flush_tx_queue(struct ath10k_htt *htt)
 536{
 537	ath10k_htc_stop_hl(htt->ar);
 538	idr_for_each(&htt->pending_tx, ath10k_htt_tx_clean_up_pending, htt->ar);
 539}
 540
 541void ath10k_htt_tx_stop(struct ath10k_htt *htt)
 542{
 543	ath10k_htt_flush_tx_queue(htt);
 544	idr_destroy(&htt->pending_tx);
 545}
 546
 547void ath10k_htt_tx_free(struct ath10k_htt *htt)
 548{
 549	ath10k_htt_tx_stop(htt);
 550	ath10k_htt_tx_destroy(htt);
 551}
 552
 553void ath10k_htt_op_ep_tx_credits(struct ath10k *ar)
 554{
 555	queue_work(ar->workqueue, &ar->bundle_tx_work);
 556}
 557
 558void ath10k_htt_htc_tx_complete(struct ath10k *ar, struct sk_buff *skb)
 559{
 560	struct ath10k_htt *htt = &ar->htt;
 561	struct htt_tx_done tx_done = {0};
 562	struct htt_cmd_hdr *htt_hdr;
 563	struct htt_data_tx_desc *desc_hdr = NULL;
 564	u16 flags1 = 0;
 565	u8 msg_type = 0;
 566
 567	if (htt->disable_tx_comp) {
 568		htt_hdr = (struct htt_cmd_hdr *)skb->data;
 569		msg_type = htt_hdr->msg_type;
 570
 571		if (msg_type == HTT_H2T_MSG_TYPE_TX_FRM) {
 572			desc_hdr = (struct htt_data_tx_desc *)
 573				(skb->data + sizeof(*htt_hdr));
 574			flags1 = __le16_to_cpu(desc_hdr->flags1);
 575			skb_pull(skb, sizeof(struct htt_cmd_hdr));
 576			skb_pull(skb, sizeof(struct htt_data_tx_desc));
 577		}
 578	}
 579
 580	dev_kfree_skb_any(skb);
 581
 582	if ((!htt->disable_tx_comp) || (msg_type != HTT_H2T_MSG_TYPE_TX_FRM))
 583		return;
 584
 585	ath10k_dbg(ar, ATH10K_DBG_HTT,
 586		   "htt tx complete msdu id:%u ,flags1:%x\n",
 587		   __le16_to_cpu(desc_hdr->id), flags1);
 588
 589	if (flags1 & HTT_DATA_TX_DESC_FLAGS1_TX_COMPLETE)
 590		return;
 591
 592	tx_done.status = HTT_TX_COMPL_STATE_ACK;
 593	tx_done.msdu_id = __le16_to_cpu(desc_hdr->id);
 594	ath10k_txrx_tx_unref(&ar->htt, &tx_done);
 595}
 596
 597void ath10k_htt_hif_tx_complete(struct ath10k *ar, struct sk_buff *skb)
 598{
 599	dev_kfree_skb_any(skb);
 600}
 601EXPORT_SYMBOL(ath10k_htt_hif_tx_complete);
 602
 603int ath10k_htt_h2t_ver_req_msg(struct ath10k_htt *htt)
 604{
 605	struct ath10k *ar = htt->ar;
 606	struct sk_buff *skb;
 607	struct htt_cmd *cmd;
 608	int len = 0;
 609	int ret;
 610
 611	len += sizeof(cmd->hdr);
 612	len += sizeof(cmd->ver_req);
 613
 614	skb = ath10k_htc_alloc_skb(ar, len);
 615	if (!skb)
 616		return -ENOMEM;
 617
 618	skb_put(skb, len);
 619	cmd = (struct htt_cmd *)skb->data;
 620	cmd->hdr.msg_type = HTT_H2T_MSG_TYPE_VERSION_REQ;
 621
 622	ret = ath10k_htc_send(&htt->ar->htc, htt->eid, skb);
 623	if (ret) {
 624		dev_kfree_skb_any(skb);
 625		return ret;
 626	}
 627
 628	return 0;
 629}
 630
 631int ath10k_htt_h2t_stats_req(struct ath10k_htt *htt, u32 mask, u32 reset_mask,
 632			     u64 cookie)
 633{
 634	struct ath10k *ar = htt->ar;
 635	struct htt_stats_req *req;
 636	struct sk_buff *skb;
 637	struct htt_cmd *cmd;
 638	int len = 0, ret;
 639
 640	len += sizeof(cmd->hdr);
 641	len += sizeof(cmd->stats_req);
 642
 643	skb = ath10k_htc_alloc_skb(ar, len);
 644	if (!skb)
 645		return -ENOMEM;
 646
 647	skb_put(skb, len);
 648	cmd = (struct htt_cmd *)skb->data;
 649	cmd->hdr.msg_type = HTT_H2T_MSG_TYPE_STATS_REQ;
 650
 651	req = &cmd->stats_req;
 652
 653	memset(req, 0, sizeof(*req));
 654
 655	/* currently we support only max 24 bit masks so no need to worry
 656	 * about endian support
 657	 */
 658	memcpy(req->upload_types, &mask, 3);
 659	memcpy(req->reset_types, &reset_mask, 3);
 660	req->stat_type = HTT_STATS_REQ_CFG_STAT_TYPE_INVALID;
 661	req->cookie_lsb = cpu_to_le32(cookie & 0xffffffff);
 662	req->cookie_msb = cpu_to_le32((cookie & 0xffffffff00000000ULL) >> 32);
 663
 664	ret = ath10k_htc_send(&htt->ar->htc, htt->eid, skb);
 665	if (ret) {
 666		ath10k_warn(ar, "failed to send htt type stats request: %d",
 667			    ret);
 668		dev_kfree_skb_any(skb);
 669		return ret;
 670	}
 671
 672	return 0;
 673}
 674
 675static int ath10k_htt_send_frag_desc_bank_cfg_32(struct ath10k_htt *htt)
 676{
 677	struct ath10k *ar = htt->ar;
 678	struct sk_buff *skb;
 679	struct htt_cmd *cmd;
 680	struct htt_frag_desc_bank_cfg32 *cfg;
 681	int ret, size;
 682	u8 info;
 683
 684	if (!ar->hw_params.continuous_frag_desc)
 685		return 0;
 686
 687	if (!htt->frag_desc.paddr) {
 688		ath10k_warn(ar, "invalid frag desc memory\n");
 689		return -EINVAL;
 690	}
 691
 692	size = sizeof(cmd->hdr) + sizeof(cmd->frag_desc_bank_cfg32);
 693	skb = ath10k_htc_alloc_skb(ar, size);
 694	if (!skb)
 695		return -ENOMEM;
 696
 697	skb_put(skb, size);
 698	cmd = (struct htt_cmd *)skb->data;
 699	cmd->hdr.msg_type = HTT_H2T_MSG_TYPE_FRAG_DESC_BANK_CFG;
 700
 701	info = 0;
 702	info |= SM(htt->tx_q_state.type,
 703		   HTT_FRAG_DESC_BANK_CFG_INFO_Q_STATE_DEPTH_TYPE);
 704
 705	if (test_bit(ATH10K_FW_FEATURE_PEER_FLOW_CONTROL,
 706		     ar->running_fw->fw_file.fw_features))
 707		info |= HTT_FRAG_DESC_BANK_CFG_INFO_Q_STATE_VALID;
 708
 709	cfg = &cmd->frag_desc_bank_cfg32;
 710	cfg->info = info;
 711	cfg->num_banks = 1;
 712	cfg->desc_size = sizeof(struct htt_msdu_ext_desc);
 713	cfg->bank_base_addrs[0] = __cpu_to_le32(htt->frag_desc.paddr);
 714	cfg->bank_id[0].bank_min_id = 0;
 715	cfg->bank_id[0].bank_max_id = __cpu_to_le16(htt->max_num_pending_tx -
 716						    1);
 717
 718	cfg->q_state.paddr = cpu_to_le32(htt->tx_q_state.paddr);
 719	cfg->q_state.num_peers = cpu_to_le16(htt->tx_q_state.num_peers);
 720	cfg->q_state.num_tids = cpu_to_le16(htt->tx_q_state.num_tids);
 721	cfg->q_state.record_size = HTT_TX_Q_STATE_ENTRY_SIZE;
 722	cfg->q_state.record_multiplier = HTT_TX_Q_STATE_ENTRY_MULTIPLIER;
 723
 724	ath10k_dbg(ar, ATH10K_DBG_HTT, "htt frag desc bank cmd\n");
 725
 726	ret = ath10k_htc_send(&htt->ar->htc, htt->eid, skb);
 727	if (ret) {
 728		ath10k_warn(ar, "failed to send frag desc bank cfg request: %d\n",
 729			    ret);
 730		dev_kfree_skb_any(skb);
 731		return ret;
 732	}
 733
 734	return 0;
 735}
 736
 737static int ath10k_htt_send_frag_desc_bank_cfg_64(struct ath10k_htt *htt)
 738{
 739	struct ath10k *ar = htt->ar;
 740	struct sk_buff *skb;
 741	struct htt_cmd *cmd;
 742	struct htt_frag_desc_bank_cfg64 *cfg;
 743	int ret, size;
 744	u8 info;
 745
 746	if (!ar->hw_params.continuous_frag_desc)
 747		return 0;
 748
 749	if (!htt->frag_desc.paddr) {
 750		ath10k_warn(ar, "invalid frag desc memory\n");
 751		return -EINVAL;
 752	}
 753
 754	size = sizeof(cmd->hdr) + sizeof(cmd->frag_desc_bank_cfg64);
 755	skb = ath10k_htc_alloc_skb(ar, size);
 756	if (!skb)
 757		return -ENOMEM;
 758
 759	skb_put(skb, size);
 760	cmd = (struct htt_cmd *)skb->data;
 761	cmd->hdr.msg_type = HTT_H2T_MSG_TYPE_FRAG_DESC_BANK_CFG;
 762
 763	info = 0;
 764	info |= SM(htt->tx_q_state.type,
 765		   HTT_FRAG_DESC_BANK_CFG_INFO_Q_STATE_DEPTH_TYPE);
 766
 767	if (test_bit(ATH10K_FW_FEATURE_PEER_FLOW_CONTROL,
 768		     ar->running_fw->fw_file.fw_features))
 769		info |= HTT_FRAG_DESC_BANK_CFG_INFO_Q_STATE_VALID;
 770
 771	cfg = &cmd->frag_desc_bank_cfg64;
 772	cfg->info = info;
 773	cfg->num_banks = 1;
 774	cfg->desc_size = sizeof(struct htt_msdu_ext_desc_64);
 775	cfg->bank_base_addrs[0] =  __cpu_to_le64(htt->frag_desc.paddr);
 776	cfg->bank_id[0].bank_min_id = 0;
 777	cfg->bank_id[0].bank_max_id = __cpu_to_le16(htt->max_num_pending_tx -
 778						    1);
 779
 780	cfg->q_state.paddr = cpu_to_le32(htt->tx_q_state.paddr);
 781	cfg->q_state.num_peers = cpu_to_le16(htt->tx_q_state.num_peers);
 782	cfg->q_state.num_tids = cpu_to_le16(htt->tx_q_state.num_tids);
 783	cfg->q_state.record_size = HTT_TX_Q_STATE_ENTRY_SIZE;
 784	cfg->q_state.record_multiplier = HTT_TX_Q_STATE_ENTRY_MULTIPLIER;
 785
 786	ath10k_dbg(ar, ATH10K_DBG_HTT, "htt frag desc bank cmd\n");
 787
 788	ret = ath10k_htc_send(&htt->ar->htc, htt->eid, skb);
 789	if (ret) {
 790		ath10k_warn(ar, "failed to send frag desc bank cfg request: %d\n",
 791			    ret);
 792		dev_kfree_skb_any(skb);
 793		return ret;
 794	}
 795
 796	return 0;
 797}
 798
 799static void ath10k_htt_fill_rx_desc_offset_32(struct ath10k_hw_params *hw,
 800					      struct htt_rx_ring_setup_ring32 *rx_ring)
 801{
 802	ath10k_htt_rx_desc_get_offsets(hw, &rx_ring->offsets);
 803}
 804
 805static void ath10k_htt_fill_rx_desc_offset_64(struct ath10k_hw_params *hw,
 806					      struct htt_rx_ring_setup_ring64 *rx_ring)
 807{
 808	ath10k_htt_rx_desc_get_offsets(hw, &rx_ring->offsets);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 809}
 810
 811static int ath10k_htt_send_rx_ring_cfg_32(struct ath10k_htt *htt)
 812{
 813	struct ath10k *ar = htt->ar;
 814	struct ath10k_hw_params *hw = &ar->hw_params;
 815	struct sk_buff *skb;
 816	struct htt_cmd *cmd;
 817	struct htt_rx_ring_setup_ring32 *ring;
 818	const int num_rx_ring = 1;
 819	u16 flags;
 820	u32 fw_idx;
 821	int len;
 822	int ret;
 823
 824	/*
 825	 * the HW expects the buffer to be an integral number of 4-byte
 826	 * "words"
 827	 */
 828	BUILD_BUG_ON(!IS_ALIGNED(HTT_RX_BUF_SIZE, 4));
 829	BUILD_BUG_ON((HTT_RX_BUF_SIZE & HTT_MAX_CACHE_LINE_SIZE_MASK) != 0);
 830
 831	len = sizeof(cmd->hdr) + sizeof(cmd->rx_setup_32.hdr)
 832	    + (sizeof(*ring) * num_rx_ring);
 833	skb = ath10k_htc_alloc_skb(ar, len);
 834	if (!skb)
 835		return -ENOMEM;
 836
 837	skb_put(skb, len);
 838
 839	cmd = (struct htt_cmd *)skb->data;
 840	ring = &cmd->rx_setup_32.rings[0];
 841
 842	cmd->hdr.msg_type = HTT_H2T_MSG_TYPE_RX_RING_CFG;
 843	cmd->rx_setup_32.hdr.num_rings = 1;
 844
 845	/* FIXME: do we need all of this? */
 846	flags = 0;
 847	flags |= HTT_RX_RING_FLAGS_MAC80211_HDR;
 848	flags |= HTT_RX_RING_FLAGS_MSDU_PAYLOAD;
 849	flags |= HTT_RX_RING_FLAGS_PPDU_START;
 850	flags |= HTT_RX_RING_FLAGS_PPDU_END;
 851	flags |= HTT_RX_RING_FLAGS_MPDU_START;
 852	flags |= HTT_RX_RING_FLAGS_MPDU_END;
 853	flags |= HTT_RX_RING_FLAGS_MSDU_START;
 854	flags |= HTT_RX_RING_FLAGS_MSDU_END;
 855	flags |= HTT_RX_RING_FLAGS_RX_ATTENTION;
 856	flags |= HTT_RX_RING_FLAGS_FRAG_INFO;
 857	flags |= HTT_RX_RING_FLAGS_UNICAST_RX;
 858	flags |= HTT_RX_RING_FLAGS_MULTICAST_RX;
 859	flags |= HTT_RX_RING_FLAGS_CTRL_RX;
 860	flags |= HTT_RX_RING_FLAGS_MGMT_RX;
 861	flags |= HTT_RX_RING_FLAGS_NULL_RX;
 862	flags |= HTT_RX_RING_FLAGS_PHY_DATA_RX;
 863
 864	fw_idx = __le32_to_cpu(*htt->rx_ring.alloc_idx.vaddr);
 865
 866	ring->fw_idx_shadow_reg_paddr =
 867		__cpu_to_le32(htt->rx_ring.alloc_idx.paddr);
 868	ring->rx_ring_base_paddr = __cpu_to_le32(htt->rx_ring.base_paddr);
 869	ring->rx_ring_len = __cpu_to_le16(htt->rx_ring.size);
 870	ring->rx_ring_bufsize = __cpu_to_le16(HTT_RX_BUF_SIZE);
 871	ring->flags = __cpu_to_le16(flags);
 872	ring->fw_idx_init_val = __cpu_to_le16(fw_idx);
 873
 874	ath10k_htt_fill_rx_desc_offset_32(hw, ring);
 875	ret = ath10k_htc_send(&htt->ar->htc, htt->eid, skb);
 876	if (ret) {
 877		dev_kfree_skb_any(skb);
 878		return ret;
 879	}
 880
 881	return 0;
 882}
 883
 884static int ath10k_htt_send_rx_ring_cfg_64(struct ath10k_htt *htt)
 885{
 886	struct ath10k *ar = htt->ar;
 887	struct ath10k_hw_params *hw = &ar->hw_params;
 888	struct sk_buff *skb;
 889	struct htt_cmd *cmd;
 890	struct htt_rx_ring_setup_ring64 *ring;
 891	const int num_rx_ring = 1;
 892	u16 flags;
 893	u32 fw_idx;
 894	int len;
 895	int ret;
 896
 897	/* HW expects the buffer to be an integral number of 4-byte
 898	 * "words"
 899	 */
 900	BUILD_BUG_ON(!IS_ALIGNED(HTT_RX_BUF_SIZE, 4));
 901	BUILD_BUG_ON((HTT_RX_BUF_SIZE & HTT_MAX_CACHE_LINE_SIZE_MASK) != 0);
 902
 903	len = sizeof(cmd->hdr) + sizeof(cmd->rx_setup_64.hdr)
 904	    + (sizeof(*ring) * num_rx_ring);
 905	skb = ath10k_htc_alloc_skb(ar, len);
 906	if (!skb)
 907		return -ENOMEM;
 908
 909	skb_put(skb, len);
 910
 911	cmd = (struct htt_cmd *)skb->data;
 912	ring = &cmd->rx_setup_64.rings[0];
 913
 914	cmd->hdr.msg_type = HTT_H2T_MSG_TYPE_RX_RING_CFG;
 915	cmd->rx_setup_64.hdr.num_rings = 1;
 916
 917	flags = 0;
 918	flags |= HTT_RX_RING_FLAGS_MAC80211_HDR;
 919	flags |= HTT_RX_RING_FLAGS_MSDU_PAYLOAD;
 920	flags |= HTT_RX_RING_FLAGS_PPDU_START;
 921	flags |= HTT_RX_RING_FLAGS_PPDU_END;
 922	flags |= HTT_RX_RING_FLAGS_MPDU_START;
 923	flags |= HTT_RX_RING_FLAGS_MPDU_END;
 924	flags |= HTT_RX_RING_FLAGS_MSDU_START;
 925	flags |= HTT_RX_RING_FLAGS_MSDU_END;
 926	flags |= HTT_RX_RING_FLAGS_RX_ATTENTION;
 927	flags |= HTT_RX_RING_FLAGS_FRAG_INFO;
 928	flags |= HTT_RX_RING_FLAGS_UNICAST_RX;
 929	flags |= HTT_RX_RING_FLAGS_MULTICAST_RX;
 930	flags |= HTT_RX_RING_FLAGS_CTRL_RX;
 931	flags |= HTT_RX_RING_FLAGS_MGMT_RX;
 932	flags |= HTT_RX_RING_FLAGS_NULL_RX;
 933	flags |= HTT_RX_RING_FLAGS_PHY_DATA_RX;
 934
 935	fw_idx = __le32_to_cpu(*htt->rx_ring.alloc_idx.vaddr);
 936
 937	ring->fw_idx_shadow_reg_paddr = __cpu_to_le64(htt->rx_ring.alloc_idx.paddr);
 938	ring->rx_ring_base_paddr = __cpu_to_le64(htt->rx_ring.base_paddr);
 939	ring->rx_ring_len = __cpu_to_le16(htt->rx_ring.size);
 940	ring->rx_ring_bufsize = __cpu_to_le16(HTT_RX_BUF_SIZE);
 941	ring->flags = __cpu_to_le16(flags);
 942	ring->fw_idx_init_val = __cpu_to_le16(fw_idx);
 943
 944	ath10k_htt_fill_rx_desc_offset_64(hw, ring);
 945	ret = ath10k_htc_send(&htt->ar->htc, htt->eid, skb);
 946	if (ret) {
 947		dev_kfree_skb_any(skb);
 948		return ret;
 949	}
 950
 951	return 0;
 952}
 953
 954static int ath10k_htt_send_rx_ring_cfg_hl(struct ath10k_htt *htt)
 955{
 956	struct ath10k *ar = htt->ar;
 957	struct sk_buff *skb;
 958	struct htt_cmd *cmd;
 959	struct htt_rx_ring_setup_ring32 *ring;
 960	const int num_rx_ring = 1;
 961	u16 flags;
 962	int len;
 963	int ret;
 964
 965	/*
 966	 * the HW expects the buffer to be an integral number of 4-byte
 967	 * "words"
 968	 */
 969	BUILD_BUG_ON(!IS_ALIGNED(HTT_RX_BUF_SIZE, 4));
 970	BUILD_BUG_ON((HTT_RX_BUF_SIZE & HTT_MAX_CACHE_LINE_SIZE_MASK) != 0);
 971
 972	len = sizeof(cmd->hdr) + sizeof(cmd->rx_setup_32.hdr)
 973	    + (sizeof(*ring) * num_rx_ring);
 974	skb = ath10k_htc_alloc_skb(ar, len);
 975	if (!skb)
 976		return -ENOMEM;
 977
 978	skb_put(skb, len);
 979
 980	cmd = (struct htt_cmd *)skb->data;
 981	ring = &cmd->rx_setup_32.rings[0];
 982
 983	cmd->hdr.msg_type = HTT_H2T_MSG_TYPE_RX_RING_CFG;
 984	cmd->rx_setup_32.hdr.num_rings = 1;
 985
 986	flags = 0;
 987	flags |= HTT_RX_RING_FLAGS_MSDU_PAYLOAD;
 988	flags |= HTT_RX_RING_FLAGS_UNICAST_RX;
 989	flags |= HTT_RX_RING_FLAGS_MULTICAST_RX;
 990
 991	memset(ring, 0, sizeof(*ring));
 992	ring->rx_ring_len = __cpu_to_le16(HTT_RX_RING_SIZE_MIN);
 993	ring->rx_ring_bufsize = __cpu_to_le16(HTT_RX_BUF_SIZE);
 994	ring->flags = __cpu_to_le16(flags);
 995
 996	ret = ath10k_htc_send(&htt->ar->htc, htt->eid, skb);
 997	if (ret) {
 998		dev_kfree_skb_any(skb);
 999		return ret;
1000	}
1001
1002	return 0;
1003}
1004
1005static int ath10k_htt_h2t_aggr_cfg_msg_32(struct ath10k_htt *htt,
1006					  u8 max_subfrms_ampdu,
1007					  u8 max_subfrms_amsdu)
1008{
1009	struct ath10k *ar = htt->ar;
1010	struct htt_aggr_conf *aggr_conf;
1011	struct sk_buff *skb;
1012	struct htt_cmd *cmd;
1013	int len;
1014	int ret;
1015
1016	/* Firmware defaults are: amsdu = 3 and ampdu = 64 */
1017
1018	if (max_subfrms_ampdu == 0 || max_subfrms_ampdu > 64)
1019		return -EINVAL;
1020
1021	if (max_subfrms_amsdu == 0 || max_subfrms_amsdu > 31)
1022		return -EINVAL;
1023
1024	len = sizeof(cmd->hdr);
1025	len += sizeof(cmd->aggr_conf);
1026
1027	skb = ath10k_htc_alloc_skb(ar, len);
1028	if (!skb)
1029		return -ENOMEM;
1030
1031	skb_put(skb, len);
1032	cmd = (struct htt_cmd *)skb->data;
1033	cmd->hdr.msg_type = HTT_H2T_MSG_TYPE_AGGR_CFG;
1034
1035	aggr_conf = &cmd->aggr_conf;
1036	aggr_conf->max_num_ampdu_subframes = max_subfrms_ampdu;
1037	aggr_conf->max_num_amsdu_subframes = max_subfrms_amsdu;
1038
1039	ath10k_dbg(ar, ATH10K_DBG_HTT, "htt h2t aggr cfg msg amsdu %d ampdu %d",
1040		   aggr_conf->max_num_amsdu_subframes,
1041		   aggr_conf->max_num_ampdu_subframes);
1042
1043	ret = ath10k_htc_send(&htt->ar->htc, htt->eid, skb);
1044	if (ret) {
1045		dev_kfree_skb_any(skb);
1046		return ret;
1047	}
1048
1049	return 0;
1050}
1051
1052static int ath10k_htt_h2t_aggr_cfg_msg_v2(struct ath10k_htt *htt,
1053					  u8 max_subfrms_ampdu,
1054					  u8 max_subfrms_amsdu)
1055{
1056	struct ath10k *ar = htt->ar;
1057	struct htt_aggr_conf_v2 *aggr_conf;
1058	struct sk_buff *skb;
1059	struct htt_cmd *cmd;
1060	int len;
1061	int ret;
1062
1063	/* Firmware defaults are: amsdu = 3 and ampdu = 64 */
1064
1065	if (max_subfrms_ampdu == 0 || max_subfrms_ampdu > 64)
1066		return -EINVAL;
1067
1068	if (max_subfrms_amsdu == 0 || max_subfrms_amsdu > 31)
1069		return -EINVAL;
1070
1071	len = sizeof(cmd->hdr);
1072	len += sizeof(cmd->aggr_conf_v2);
1073
1074	skb = ath10k_htc_alloc_skb(ar, len);
1075	if (!skb)
1076		return -ENOMEM;
1077
1078	skb_put(skb, len);
1079	cmd = (struct htt_cmd *)skb->data;
1080	cmd->hdr.msg_type = HTT_H2T_MSG_TYPE_AGGR_CFG;
1081
1082	aggr_conf = &cmd->aggr_conf_v2;
1083	aggr_conf->max_num_ampdu_subframes = max_subfrms_ampdu;
1084	aggr_conf->max_num_amsdu_subframes = max_subfrms_amsdu;
1085
1086	ath10k_dbg(ar, ATH10K_DBG_HTT, "htt h2t aggr cfg msg amsdu %d ampdu %d",
1087		   aggr_conf->max_num_amsdu_subframes,
1088		   aggr_conf->max_num_ampdu_subframes);
1089
1090	ret = ath10k_htc_send(&htt->ar->htc, htt->eid, skb);
1091	if (ret) {
1092		dev_kfree_skb_any(skb);
1093		return ret;
1094	}
1095
1096	return 0;
1097}
1098
1099int ath10k_htt_tx_fetch_resp(struct ath10k *ar,
1100			     __le32 token,
1101			     __le16 fetch_seq_num,
1102			     struct htt_tx_fetch_record *records,
1103			     size_t num_records)
1104{
1105	struct sk_buff *skb;
1106	struct htt_cmd *cmd;
1107	const u16 resp_id = 0;
1108	int len = 0;
1109	int ret;
1110
1111	/* Response IDs are echo-ed back only for host driver convenience
1112	 * purposes. They aren't used for anything in the driver yet so use 0.
1113	 */
1114
1115	len += sizeof(cmd->hdr);
1116	len += sizeof(cmd->tx_fetch_resp);
1117	len += sizeof(cmd->tx_fetch_resp.records[0]) * num_records;
1118
1119	skb = ath10k_htc_alloc_skb(ar, len);
1120	if (!skb)
1121		return -ENOMEM;
1122
1123	skb_put(skb, len);
1124	cmd = (struct htt_cmd *)skb->data;
1125	cmd->hdr.msg_type = HTT_H2T_MSG_TYPE_TX_FETCH_RESP;
1126	cmd->tx_fetch_resp.resp_id = cpu_to_le16(resp_id);
1127	cmd->tx_fetch_resp.fetch_seq_num = fetch_seq_num;
1128	cmd->tx_fetch_resp.num_records = cpu_to_le16(num_records);
1129	cmd->tx_fetch_resp.token = token;
1130
1131	memcpy(cmd->tx_fetch_resp.records, records,
1132	       sizeof(records[0]) * num_records);
1133
1134	ret = ath10k_htc_send(&ar->htc, ar->htt.eid, skb);
1135	if (ret) {
1136		ath10k_warn(ar, "failed to submit htc command: %d\n", ret);
1137		goto err_free_skb;
1138	}
1139
1140	return 0;
1141
1142err_free_skb:
1143	dev_kfree_skb_any(skb);
1144
1145	return ret;
1146}
1147
1148static u8 ath10k_htt_tx_get_vdev_id(struct ath10k *ar, struct sk_buff *skb)
1149{
1150	struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
1151	struct ath10k_skb_cb *cb = ATH10K_SKB_CB(skb);
1152	struct ath10k_vif *arvif;
1153
1154	if (info->flags & IEEE80211_TX_CTL_TX_OFFCHAN) {
1155		return ar->scan.vdev_id;
1156	} else if (cb->vif) {
1157		arvif = (void *)cb->vif->drv_priv;
1158		return arvif->vdev_id;
1159	} else if (ar->monitor_started) {
1160		return ar->monitor_vdev_id;
1161	} else {
1162		return 0;
1163	}
1164}
1165
1166static u8 ath10k_htt_tx_get_tid(struct sk_buff *skb, bool is_eth)
1167{
1168	struct ieee80211_hdr *hdr = (void *)skb->data;
1169	struct ath10k_skb_cb *cb = ATH10K_SKB_CB(skb);
1170
1171	if (!is_eth && ieee80211_is_mgmt(hdr->frame_control))
1172		return HTT_DATA_TX_EXT_TID_MGMT;
1173	else if (cb->flags & ATH10K_SKB_F_QOS)
1174		return skb->priority & IEEE80211_QOS_CTL_TID_MASK;
1175	else
1176		return HTT_DATA_TX_EXT_TID_NON_QOS_MCAST_BCAST;
1177}
1178
1179int ath10k_htt_mgmt_tx(struct ath10k_htt *htt, struct sk_buff *msdu)
1180{
1181	struct ath10k *ar = htt->ar;
1182	struct device *dev = ar->dev;
1183	struct sk_buff *txdesc = NULL;
1184	struct htt_cmd *cmd;
1185	struct ath10k_skb_cb *skb_cb = ATH10K_SKB_CB(msdu);
1186	u8 vdev_id = ath10k_htt_tx_get_vdev_id(ar, msdu);
1187	int len = 0;
1188	int msdu_id = -1;
1189	int res;
1190	const u8 *peer_addr;
1191	struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)msdu->data;
1192
1193	len += sizeof(cmd->hdr);
1194	len += sizeof(cmd->mgmt_tx);
1195
1196	res = ath10k_htt_tx_alloc_msdu_id(htt, msdu);
1197	if (res < 0)
1198		goto err;
1199
1200	msdu_id = res;
1201
1202	if ((ieee80211_is_action(hdr->frame_control) ||
1203	     ieee80211_is_deauth(hdr->frame_control) ||
1204	     ieee80211_is_disassoc(hdr->frame_control)) &&
1205	     ieee80211_has_protected(hdr->frame_control)) {
1206		peer_addr = hdr->addr1;
1207		if (is_multicast_ether_addr(peer_addr)) {
1208			skb_put(msdu, sizeof(struct ieee80211_mmie_16));
1209		} else {
1210			if (skb_cb->ucast_cipher == WLAN_CIPHER_SUITE_GCMP ||
1211			    skb_cb->ucast_cipher == WLAN_CIPHER_SUITE_GCMP_256)
1212				skb_put(msdu, IEEE80211_GCMP_MIC_LEN);
1213			else
1214				skb_put(msdu, IEEE80211_CCMP_MIC_LEN);
1215		}
1216	}
1217
1218	txdesc = ath10k_htc_alloc_skb(ar, len);
1219	if (!txdesc) {
1220		res = -ENOMEM;
1221		goto err_free_msdu_id;
1222	}
1223
1224	skb_cb->paddr = dma_map_single(dev, msdu->data, msdu->len,
1225				       DMA_TO_DEVICE);
1226	res = dma_mapping_error(dev, skb_cb->paddr);
1227	if (res) {
1228		res = -EIO;
1229		goto err_free_txdesc;
1230	}
1231
1232	skb_put(txdesc, len);
1233	cmd = (struct htt_cmd *)txdesc->data;
1234	memset(cmd, 0, len);
1235
1236	cmd->hdr.msg_type         = HTT_H2T_MSG_TYPE_MGMT_TX;
1237	cmd->mgmt_tx.msdu_paddr = __cpu_to_le32(ATH10K_SKB_CB(msdu)->paddr);
1238	cmd->mgmt_tx.len        = __cpu_to_le32(msdu->len);
1239	cmd->mgmt_tx.desc_id    = __cpu_to_le32(msdu_id);
1240	cmd->mgmt_tx.vdev_id    = __cpu_to_le32(vdev_id);
1241	memcpy(cmd->mgmt_tx.hdr, msdu->data,
1242	       min_t(int, msdu->len, HTT_MGMT_FRM_HDR_DOWNLOAD_LEN));
1243
1244	res = ath10k_htc_send(&htt->ar->htc, htt->eid, txdesc);
1245	if (res)
1246		goto err_unmap_msdu;
1247
1248	return 0;
1249
1250err_unmap_msdu:
1251	if (ar->bus_param.dev_type != ATH10K_DEV_TYPE_HL)
1252		dma_unmap_single(dev, skb_cb->paddr, msdu->len, DMA_TO_DEVICE);
1253err_free_txdesc:
1254	dev_kfree_skb_any(txdesc);
1255err_free_msdu_id:
1256	spin_lock_bh(&htt->tx_lock);
1257	ath10k_htt_tx_free_msdu_id(htt, msdu_id);
1258	spin_unlock_bh(&htt->tx_lock);
1259err:
1260	return res;
1261}
1262
1263#define HTT_TX_HL_NEEDED_HEADROOM \
1264	(unsigned int)(sizeof(struct htt_cmd_hdr) + \
1265	sizeof(struct htt_data_tx_desc) + \
1266	sizeof(struct ath10k_htc_hdr))
1267
1268static int ath10k_htt_tx_hl(struct ath10k_htt *htt, enum ath10k_hw_txrx_mode txmode,
1269			    struct sk_buff *msdu)
1270{
1271	struct ath10k *ar = htt->ar;
1272	int res, data_len;
1273	struct htt_cmd_hdr *cmd_hdr;
 
1274	struct htt_data_tx_desc *tx_desc;
1275	struct ath10k_skb_cb *skb_cb = ATH10K_SKB_CB(msdu);
1276	struct sk_buff *tmp_skb;
1277	bool is_eth = (txmode == ATH10K_HW_TXRX_ETHERNET);
1278	u8 vdev_id = ath10k_htt_tx_get_vdev_id(ar, msdu);
1279	u8 tid = ath10k_htt_tx_get_tid(msdu, is_eth);
1280	u8 flags0 = 0;
1281	u16 flags1 = 0;
1282	u16 msdu_id = 0;
1283
1284	if (!is_eth) {
1285		struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)msdu->data;
1286
1287		if ((ieee80211_is_action(hdr->frame_control) ||
1288		     ieee80211_is_deauth(hdr->frame_control) ||
1289		     ieee80211_is_disassoc(hdr->frame_control)) &&
1290		     ieee80211_has_protected(hdr->frame_control)) {
1291			skb_put(msdu, IEEE80211_CCMP_MIC_LEN);
1292		}
1293	}
1294
1295	data_len = msdu->len;
1296
1297	switch (txmode) {
1298	case ATH10K_HW_TXRX_RAW:
1299	case ATH10K_HW_TXRX_NATIVE_WIFI:
1300		flags0 |= HTT_DATA_TX_DESC_FLAGS0_MAC_HDR_PRESENT;
1301		fallthrough;
1302	case ATH10K_HW_TXRX_ETHERNET:
1303		flags0 |= SM(txmode, HTT_DATA_TX_DESC_FLAGS0_PKT_TYPE);
1304		break;
1305	case ATH10K_HW_TXRX_MGMT:
1306		flags0 |= SM(ATH10K_HW_TXRX_MGMT,
1307			     HTT_DATA_TX_DESC_FLAGS0_PKT_TYPE);
1308		flags0 |= HTT_DATA_TX_DESC_FLAGS0_MAC_HDR_PRESENT;
1309
1310		if (htt->disable_tx_comp)
1311			flags1 |= HTT_DATA_TX_DESC_FLAGS1_TX_COMPLETE;
1312		break;
1313	}
1314
1315	if (skb_cb->flags & ATH10K_SKB_F_NO_HWCRYPT)
1316		flags0 |= HTT_DATA_TX_DESC_FLAGS0_NO_ENCRYPT;
1317
1318	flags1 |= SM((u16)vdev_id, HTT_DATA_TX_DESC_FLAGS1_VDEV_ID);
1319	flags1 |= SM((u16)tid, HTT_DATA_TX_DESC_FLAGS1_EXT_TID);
1320	if (msdu->ip_summed == CHECKSUM_PARTIAL &&
1321	    !test_bit(ATH10K_FLAG_RAW_MODE, &ar->dev_flags)) {
1322		flags1 |= HTT_DATA_TX_DESC_FLAGS1_CKSUM_L3_OFFLOAD;
1323		flags1 |= HTT_DATA_TX_DESC_FLAGS1_CKSUM_L4_OFFLOAD;
1324	}
1325
1326	/* Prepend the HTT header and TX desc struct to the data message
1327	 * and realloc the skb if it does not have enough headroom.
1328	 */
1329	if (skb_headroom(msdu) < HTT_TX_HL_NEEDED_HEADROOM) {
1330		tmp_skb = msdu;
1331
1332		ath10k_dbg(htt->ar, ATH10K_DBG_HTT,
1333			   "Not enough headroom in skb. Current headroom: %u, needed: %u. Reallocating...\n",
1334			   skb_headroom(msdu), HTT_TX_HL_NEEDED_HEADROOM);
1335		msdu = skb_realloc_headroom(msdu, HTT_TX_HL_NEEDED_HEADROOM);
1336		kfree_skb(tmp_skb);
1337		if (!msdu) {
1338			ath10k_warn(htt->ar, "htt hl tx: Unable to realloc skb!\n");
1339			res = -ENOMEM;
1340			goto out;
1341		}
1342	}
1343
1344	if (ar->bus_param.hl_msdu_ids) {
1345		flags1 |= HTT_DATA_TX_DESC_FLAGS1_POSTPONED;
1346		res = ath10k_htt_tx_alloc_msdu_id(htt, msdu);
1347		if (res < 0) {
1348			ath10k_err(ar, "msdu_id allocation failed %d\n", res);
1349			goto out;
1350		}
1351		msdu_id = res;
1352	}
1353
1354	/* As msdu is freed by mac80211 (in ieee80211_tx_status()) and by
1355	 * ath10k (in ath10k_htt_htc_tx_complete()) we have to increase
1356	 * reference by one to avoid a use-after-free case and a double
1357	 * free.
1358	 */
1359	skb_get(msdu);
1360
1361	skb_push(msdu, sizeof(*cmd_hdr));
1362	skb_push(msdu, sizeof(*tx_desc));
1363	cmd_hdr = (struct htt_cmd_hdr *)msdu->data;
1364	tx_desc = (struct htt_data_tx_desc *)(msdu->data + sizeof(*cmd_hdr));
1365
1366	cmd_hdr->msg_type = HTT_H2T_MSG_TYPE_TX_FRM;
1367	tx_desc->flags0 = flags0;
1368	tx_desc->flags1 = __cpu_to_le16(flags1);
1369	tx_desc->len = __cpu_to_le16(data_len);
1370	tx_desc->id = __cpu_to_le16(msdu_id);
1371	tx_desc->frags_paddr = 0; /* always zero */
1372	/* Initialize peer_id to INVALID_PEER because this is NOT
1373	 * Reinjection path
1374	 */
1375	tx_desc->peerid = __cpu_to_le32(HTT_INVALID_PEERID);
1376
1377	res = ath10k_htc_send_hl(&htt->ar->htc, htt->eid, msdu);
1378
1379out:
1380	return res;
1381}
1382
1383static int ath10k_htt_tx_32(struct ath10k_htt *htt,
1384			    enum ath10k_hw_txrx_mode txmode,
1385			    struct sk_buff *msdu)
1386{
1387	struct ath10k *ar = htt->ar;
1388	struct device *dev = ar->dev;
 
1389	struct ieee80211_tx_info *info = IEEE80211_SKB_CB(msdu);
1390	struct ath10k_skb_cb *skb_cb = ATH10K_SKB_CB(msdu);
1391	struct ath10k_hif_sg_item sg_items[2];
1392	struct ath10k_htt_txbuf_32 *txbuf;
1393	struct htt_data_tx_desc_frag *frags;
1394	bool is_eth = (txmode == ATH10K_HW_TXRX_ETHERNET);
1395	u8 vdev_id = ath10k_htt_tx_get_vdev_id(ar, msdu);
1396	u8 tid = ath10k_htt_tx_get_tid(msdu, is_eth);
1397	int prefetch_len;
1398	int res;
1399	u8 flags0 = 0;
1400	u16 msdu_id, flags1 = 0;
1401	u16 freq = 0;
1402	u32 frags_paddr = 0;
1403	u32 txbuf_paddr;
1404	struct htt_msdu_ext_desc *ext_desc = NULL;
1405	struct htt_msdu_ext_desc *ext_desc_t = NULL;
1406
1407	res = ath10k_htt_tx_alloc_msdu_id(htt, msdu);
1408	if (res < 0)
1409		goto err;
1410
1411	msdu_id = res;
1412
1413	prefetch_len = min(htt->prefetch_len, msdu->len);
1414	prefetch_len = roundup(prefetch_len, 4);
1415
1416	txbuf = htt->txbuf.vaddr_txbuff_32 + msdu_id;
1417	txbuf_paddr = htt->txbuf.paddr +
1418		      (sizeof(struct ath10k_htt_txbuf_32) * msdu_id);
1419
1420	if (!is_eth) {
1421		struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)msdu->data;
1422
1423		if ((ieee80211_is_action(hdr->frame_control) ||
1424		     ieee80211_is_deauth(hdr->frame_control) ||
1425		     ieee80211_is_disassoc(hdr->frame_control)) &&
1426		     ieee80211_has_protected(hdr->frame_control)) {
1427			skb_put(msdu, IEEE80211_CCMP_MIC_LEN);
1428		} else if (!(skb_cb->flags & ATH10K_SKB_F_NO_HWCRYPT) &&
1429			   txmode == ATH10K_HW_TXRX_RAW &&
1430			   ieee80211_has_protected(hdr->frame_control)) {
1431			skb_put(msdu, IEEE80211_CCMP_MIC_LEN);
1432		}
1433	}
1434
1435	skb_cb->paddr = dma_map_single(dev, msdu->data, msdu->len,
1436				       DMA_TO_DEVICE);
1437	res = dma_mapping_error(dev, skb_cb->paddr);
1438	if (res) {
1439		res = -EIO;
1440		goto err_free_msdu_id;
1441	}
1442
1443	if (unlikely(info->flags & IEEE80211_TX_CTL_TX_OFFCHAN))
1444		freq = ar->scan.roc_freq;
1445
1446	switch (txmode) {
1447	case ATH10K_HW_TXRX_RAW:
1448	case ATH10K_HW_TXRX_NATIVE_WIFI:
1449		flags0 |= HTT_DATA_TX_DESC_FLAGS0_MAC_HDR_PRESENT;
1450		fallthrough;
1451	case ATH10K_HW_TXRX_ETHERNET:
1452		if (ar->hw_params.continuous_frag_desc) {
1453			ext_desc_t = htt->frag_desc.vaddr_desc_32;
1454			memset(&ext_desc_t[msdu_id], 0,
1455			       sizeof(struct htt_msdu_ext_desc));
1456			frags = (struct htt_data_tx_desc_frag *)
1457				&ext_desc_t[msdu_id].frags;
1458			ext_desc = &ext_desc_t[msdu_id];
1459			frags[0].tword_addr.paddr_lo =
1460				__cpu_to_le32(skb_cb->paddr);
1461			frags[0].tword_addr.paddr_hi = 0;
1462			frags[0].tword_addr.len_16 = __cpu_to_le16(msdu->len);
1463
1464			frags_paddr =  htt->frag_desc.paddr +
1465				(sizeof(struct htt_msdu_ext_desc) * msdu_id);
1466		} else {
1467			frags = txbuf->frags;
1468			frags[0].dword_addr.paddr =
1469				__cpu_to_le32(skb_cb->paddr);
1470			frags[0].dword_addr.len = __cpu_to_le32(msdu->len);
1471			frags[1].dword_addr.paddr = 0;
1472			frags[1].dword_addr.len = 0;
1473
1474			frags_paddr = txbuf_paddr;
1475		}
1476		flags0 |= SM(txmode, HTT_DATA_TX_DESC_FLAGS0_PKT_TYPE);
1477		break;
1478	case ATH10K_HW_TXRX_MGMT:
1479		flags0 |= SM(ATH10K_HW_TXRX_MGMT,
1480			     HTT_DATA_TX_DESC_FLAGS0_PKT_TYPE);
1481		flags0 |= HTT_DATA_TX_DESC_FLAGS0_MAC_HDR_PRESENT;
1482
1483		frags_paddr = skb_cb->paddr;
1484		break;
1485	}
1486
1487	/* Normally all commands go through HTC which manages tx credits for
1488	 * each endpoint and notifies when tx is completed.
1489	 *
1490	 * HTT endpoint is creditless so there's no need to care about HTC
1491	 * flags. In that case it is trivial to fill the HTC header here.
1492	 *
1493	 * MSDU transmission is considered completed upon HTT event. This
1494	 * implies no relevant resources can be freed until after the event is
1495	 * received. That's why HTC tx completion handler itself is ignored by
1496	 * setting NULL to transfer_context for all sg items.
1497	 *
1498	 * There is simply no point in pushing HTT TX_FRM through HTC tx path
1499	 * as it's a waste of resources. By bypassing HTC it is possible to
1500	 * avoid extra memory allocations, compress data structures and thus
1501	 * improve performance.
1502	 */
1503
1504	txbuf->htc_hdr.eid = htt->eid;
1505	txbuf->htc_hdr.len = __cpu_to_le16(sizeof(txbuf->cmd_hdr) +
1506					   sizeof(txbuf->cmd_tx) +
1507					   prefetch_len);
1508	txbuf->htc_hdr.flags = 0;
1509
1510	if (skb_cb->flags & ATH10K_SKB_F_NO_HWCRYPT)
1511		flags0 |= HTT_DATA_TX_DESC_FLAGS0_NO_ENCRYPT;
1512
1513	flags1 |= SM((u16)vdev_id, HTT_DATA_TX_DESC_FLAGS1_VDEV_ID);
1514	flags1 |= SM((u16)tid, HTT_DATA_TX_DESC_FLAGS1_EXT_TID);
1515	if (msdu->ip_summed == CHECKSUM_PARTIAL &&
1516	    !test_bit(ATH10K_FLAG_RAW_MODE, &ar->dev_flags)) {
1517		flags1 |= HTT_DATA_TX_DESC_FLAGS1_CKSUM_L3_OFFLOAD;
1518		flags1 |= HTT_DATA_TX_DESC_FLAGS1_CKSUM_L4_OFFLOAD;
1519		if (ar->hw_params.continuous_frag_desc)
1520			ext_desc->flags |= HTT_MSDU_CHECKSUM_ENABLE;
1521	}
1522
1523	/* Prevent firmware from sending up tx inspection requests. There's
1524	 * nothing ath10k can do with frames requested for inspection so force
1525	 * it to simply rely a regular tx completion with discard status.
1526	 */
1527	flags1 |= HTT_DATA_TX_DESC_FLAGS1_POSTPONED;
1528
1529	txbuf->cmd_hdr.msg_type = HTT_H2T_MSG_TYPE_TX_FRM;
1530	txbuf->cmd_tx.flags0 = flags0;
1531	txbuf->cmd_tx.flags1 = __cpu_to_le16(flags1);
1532	txbuf->cmd_tx.len = __cpu_to_le16(msdu->len);
1533	txbuf->cmd_tx.id = __cpu_to_le16(msdu_id);
1534	txbuf->cmd_tx.frags_paddr = __cpu_to_le32(frags_paddr);
1535	if (ath10k_mac_tx_frm_has_freq(ar)) {
1536		txbuf->cmd_tx.offchan_tx.peerid =
1537				__cpu_to_le16(HTT_INVALID_PEERID);
1538		txbuf->cmd_tx.offchan_tx.freq =
1539				__cpu_to_le16(freq);
1540	} else {
1541		txbuf->cmd_tx.peerid =
1542				__cpu_to_le32(HTT_INVALID_PEERID);
1543	}
1544
1545	trace_ath10k_htt_tx(ar, msdu_id, msdu->len, vdev_id, tid);
1546	ath10k_dbg(ar, ATH10K_DBG_HTT,
1547		   "htt tx flags0 %u flags1 %u len %d id %u frags_paddr %pad, msdu_paddr %pad vdev %u tid %u freq %u\n",
1548		   flags0, flags1, msdu->len, msdu_id, &frags_paddr,
1549		   &skb_cb->paddr, vdev_id, tid, freq);
1550	ath10k_dbg_dump(ar, ATH10K_DBG_HTT_DUMP, NULL, "htt tx msdu: ",
1551			msdu->data, msdu->len);
1552	trace_ath10k_tx_hdr(ar, msdu->data, msdu->len);
1553	trace_ath10k_tx_payload(ar, msdu->data, msdu->len);
1554
1555	sg_items[0].transfer_id = 0;
1556	sg_items[0].transfer_context = NULL;
1557	sg_items[0].vaddr = &txbuf->htc_hdr;
1558	sg_items[0].paddr = txbuf_paddr +
1559			    sizeof(txbuf->frags);
1560	sg_items[0].len = sizeof(txbuf->htc_hdr) +
1561			  sizeof(txbuf->cmd_hdr) +
1562			  sizeof(txbuf->cmd_tx);
1563
1564	sg_items[1].transfer_id = 0;
1565	sg_items[1].transfer_context = NULL;
1566	sg_items[1].vaddr = msdu->data;
1567	sg_items[1].paddr = skb_cb->paddr;
1568	sg_items[1].len = prefetch_len;
1569
1570	res = ath10k_hif_tx_sg(htt->ar,
1571			       htt->ar->htc.endpoint[htt->eid].ul_pipe_id,
1572			       sg_items, ARRAY_SIZE(sg_items));
1573	if (res)
1574		goto err_unmap_msdu;
1575
1576	return 0;
1577
1578err_unmap_msdu:
1579	dma_unmap_single(dev, skb_cb->paddr, msdu->len, DMA_TO_DEVICE);
1580err_free_msdu_id:
1581	spin_lock_bh(&htt->tx_lock);
1582	ath10k_htt_tx_free_msdu_id(htt, msdu_id);
1583	spin_unlock_bh(&htt->tx_lock);
1584err:
1585	return res;
1586}
1587
1588static int ath10k_htt_tx_64(struct ath10k_htt *htt,
1589			    enum ath10k_hw_txrx_mode txmode,
1590			    struct sk_buff *msdu)
1591{
1592	struct ath10k *ar = htt->ar;
1593	struct device *dev = ar->dev;
 
1594	struct ieee80211_tx_info *info = IEEE80211_SKB_CB(msdu);
1595	struct ath10k_skb_cb *skb_cb = ATH10K_SKB_CB(msdu);
1596	struct ath10k_hif_sg_item sg_items[2];
1597	struct ath10k_htt_txbuf_64 *txbuf;
1598	struct htt_data_tx_desc_frag *frags;
1599	bool is_eth = (txmode == ATH10K_HW_TXRX_ETHERNET);
1600	u8 vdev_id = ath10k_htt_tx_get_vdev_id(ar, msdu);
1601	u8 tid = ath10k_htt_tx_get_tid(msdu, is_eth);
1602	int prefetch_len;
1603	int res;
1604	u8 flags0 = 0;
1605	u16 msdu_id, flags1 = 0;
1606	u16 freq = 0;
1607	dma_addr_t frags_paddr = 0;
1608	dma_addr_t txbuf_paddr;
1609	struct htt_msdu_ext_desc_64 *ext_desc = NULL;
1610	struct htt_msdu_ext_desc_64 *ext_desc_t = NULL;
1611
1612	res = ath10k_htt_tx_alloc_msdu_id(htt, msdu);
1613	if (res < 0)
1614		goto err;
1615
1616	msdu_id = res;
1617
1618	prefetch_len = min(htt->prefetch_len, msdu->len);
1619	prefetch_len = roundup(prefetch_len, 4);
1620
1621	txbuf = htt->txbuf.vaddr_txbuff_64 + msdu_id;
1622	txbuf_paddr = htt->txbuf.paddr +
1623		      (sizeof(struct ath10k_htt_txbuf_64) * msdu_id);
1624
1625	if (!is_eth) {
1626		struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)msdu->data;
1627
1628		if ((ieee80211_is_action(hdr->frame_control) ||
1629		     ieee80211_is_deauth(hdr->frame_control) ||
1630		     ieee80211_is_disassoc(hdr->frame_control)) &&
1631		     ieee80211_has_protected(hdr->frame_control)) {
1632			skb_put(msdu, IEEE80211_CCMP_MIC_LEN);
1633		} else if (!(skb_cb->flags & ATH10K_SKB_F_NO_HWCRYPT) &&
1634			   txmode == ATH10K_HW_TXRX_RAW &&
1635			   ieee80211_has_protected(hdr->frame_control)) {
1636			skb_put(msdu, IEEE80211_CCMP_MIC_LEN);
1637		}
1638	}
1639
1640	skb_cb->paddr = dma_map_single(dev, msdu->data, msdu->len,
1641				       DMA_TO_DEVICE);
1642	res = dma_mapping_error(dev, skb_cb->paddr);
1643	if (res) {
1644		res = -EIO;
1645		goto err_free_msdu_id;
1646	}
1647
1648	if (unlikely(info->flags & IEEE80211_TX_CTL_TX_OFFCHAN))
1649		freq = ar->scan.roc_freq;
1650
1651	switch (txmode) {
1652	case ATH10K_HW_TXRX_RAW:
1653	case ATH10K_HW_TXRX_NATIVE_WIFI:
1654		flags0 |= HTT_DATA_TX_DESC_FLAGS0_MAC_HDR_PRESENT;
1655		fallthrough;
1656	case ATH10K_HW_TXRX_ETHERNET:
1657		if (ar->hw_params.continuous_frag_desc) {
1658			ext_desc_t = htt->frag_desc.vaddr_desc_64;
1659			memset(&ext_desc_t[msdu_id], 0,
1660			       sizeof(struct htt_msdu_ext_desc_64));
1661			frags = (struct htt_data_tx_desc_frag *)
1662				&ext_desc_t[msdu_id].frags;
1663			ext_desc = &ext_desc_t[msdu_id];
1664			frags[0].tword_addr.paddr_lo =
1665				__cpu_to_le32(skb_cb->paddr);
1666			frags[0].tword_addr.paddr_hi =
1667				__cpu_to_le16(upper_32_bits(skb_cb->paddr));
1668			frags[0].tword_addr.len_16 = __cpu_to_le16(msdu->len);
1669
1670			frags_paddr =  htt->frag_desc.paddr +
1671			   (sizeof(struct htt_msdu_ext_desc_64) * msdu_id);
1672		} else {
1673			frags = txbuf->frags;
1674			frags[0].tword_addr.paddr_lo =
1675						__cpu_to_le32(skb_cb->paddr);
1676			frags[0].tword_addr.paddr_hi =
1677				__cpu_to_le16(upper_32_bits(skb_cb->paddr));
1678			frags[0].tword_addr.len_16 = __cpu_to_le16(msdu->len);
1679			frags[1].tword_addr.paddr_lo = 0;
1680			frags[1].tword_addr.paddr_hi = 0;
1681			frags[1].tword_addr.len_16 = 0;
1682		}
1683		flags0 |= SM(txmode, HTT_DATA_TX_DESC_FLAGS0_PKT_TYPE);
1684		break;
1685	case ATH10K_HW_TXRX_MGMT:
1686		flags0 |= SM(ATH10K_HW_TXRX_MGMT,
1687			     HTT_DATA_TX_DESC_FLAGS0_PKT_TYPE);
1688		flags0 |= HTT_DATA_TX_DESC_FLAGS0_MAC_HDR_PRESENT;
1689
1690		frags_paddr = skb_cb->paddr;
1691		break;
1692	}
1693
1694	/* Normally all commands go through HTC which manages tx credits for
1695	 * each endpoint and notifies when tx is completed.
1696	 *
1697	 * HTT endpoint is creditless so there's no need to care about HTC
1698	 * flags. In that case it is trivial to fill the HTC header here.
1699	 *
1700	 * MSDU transmission is considered completed upon HTT event. This
1701	 * implies no relevant resources can be freed until after the event is
1702	 * received. That's why HTC tx completion handler itself is ignored by
1703	 * setting NULL to transfer_context for all sg items.
1704	 *
1705	 * There is simply no point in pushing HTT TX_FRM through HTC tx path
1706	 * as it's a waste of resources. By bypassing HTC it is possible to
1707	 * avoid extra memory allocations, compress data structures and thus
1708	 * improve performance.
1709	 */
1710
1711	txbuf->htc_hdr.eid = htt->eid;
1712	txbuf->htc_hdr.len = __cpu_to_le16(sizeof(txbuf->cmd_hdr) +
1713					   sizeof(txbuf->cmd_tx) +
1714					   prefetch_len);
1715	txbuf->htc_hdr.flags = 0;
1716
1717	if (skb_cb->flags & ATH10K_SKB_F_NO_HWCRYPT)
1718		flags0 |= HTT_DATA_TX_DESC_FLAGS0_NO_ENCRYPT;
1719
1720	flags1 |= SM((u16)vdev_id, HTT_DATA_TX_DESC_FLAGS1_VDEV_ID);
1721	flags1 |= SM((u16)tid, HTT_DATA_TX_DESC_FLAGS1_EXT_TID);
1722	if (msdu->ip_summed == CHECKSUM_PARTIAL &&
1723	    !test_bit(ATH10K_FLAG_RAW_MODE, &ar->dev_flags)) {
1724		flags1 |= HTT_DATA_TX_DESC_FLAGS1_CKSUM_L3_OFFLOAD;
1725		flags1 |= HTT_DATA_TX_DESC_FLAGS1_CKSUM_L4_OFFLOAD;
1726		if (ar->hw_params.continuous_frag_desc) {
1727			memset(ext_desc->tso_flag, 0, sizeof(ext_desc->tso_flag));
1728			ext_desc->tso_flag[3] |=
1729				__cpu_to_le32(HTT_MSDU_CHECKSUM_ENABLE_64);
1730		}
1731	}
1732
1733	/* Prevent firmware from sending up tx inspection requests. There's
1734	 * nothing ath10k can do with frames requested for inspection so force
1735	 * it to simply rely a regular tx completion with discard status.
1736	 */
1737	flags1 |= HTT_DATA_TX_DESC_FLAGS1_POSTPONED;
1738
1739	txbuf->cmd_hdr.msg_type = HTT_H2T_MSG_TYPE_TX_FRM;
1740	txbuf->cmd_tx.flags0 = flags0;
1741	txbuf->cmd_tx.flags1 = __cpu_to_le16(flags1);
1742	txbuf->cmd_tx.len = __cpu_to_le16(msdu->len);
1743	txbuf->cmd_tx.id = __cpu_to_le16(msdu_id);
1744
1745	/* fill fragment descriptor */
1746	txbuf->cmd_tx.frags_paddr = __cpu_to_le64(frags_paddr);
1747	if (ath10k_mac_tx_frm_has_freq(ar)) {
1748		txbuf->cmd_tx.offchan_tx.peerid =
1749				__cpu_to_le16(HTT_INVALID_PEERID);
1750		txbuf->cmd_tx.offchan_tx.freq =
1751				__cpu_to_le16(freq);
1752	} else {
1753		txbuf->cmd_tx.peerid =
1754				__cpu_to_le32(HTT_INVALID_PEERID);
1755	}
1756
1757	trace_ath10k_htt_tx(ar, msdu_id, msdu->len, vdev_id, tid);
1758	ath10k_dbg(ar, ATH10K_DBG_HTT,
1759		   "htt tx flags0 %u flags1 %u len %d id %u frags_paddr %pad, msdu_paddr %pad vdev %u tid %u freq %u\n",
1760		   flags0, flags1, msdu->len, msdu_id, &frags_paddr,
1761		   &skb_cb->paddr, vdev_id, tid, freq);
1762	ath10k_dbg_dump(ar, ATH10K_DBG_HTT_DUMP, NULL, "htt tx msdu: ",
1763			msdu->data, msdu->len);
1764	trace_ath10k_tx_hdr(ar, msdu->data, msdu->len);
1765	trace_ath10k_tx_payload(ar, msdu->data, msdu->len);
1766
1767	sg_items[0].transfer_id = 0;
1768	sg_items[0].transfer_context = NULL;
1769	sg_items[0].vaddr = &txbuf->htc_hdr;
1770	sg_items[0].paddr = txbuf_paddr +
1771			    sizeof(txbuf->frags);
1772	sg_items[0].len = sizeof(txbuf->htc_hdr) +
1773			  sizeof(txbuf->cmd_hdr) +
1774			  sizeof(txbuf->cmd_tx);
1775
1776	sg_items[1].transfer_id = 0;
1777	sg_items[1].transfer_context = NULL;
1778	sg_items[1].vaddr = msdu->data;
1779	sg_items[1].paddr = skb_cb->paddr;
1780	sg_items[1].len = prefetch_len;
1781
1782	res = ath10k_hif_tx_sg(htt->ar,
1783			       htt->ar->htc.endpoint[htt->eid].ul_pipe_id,
1784			       sg_items, ARRAY_SIZE(sg_items));
1785	if (res)
1786		goto err_unmap_msdu;
1787
1788	return 0;
1789
1790err_unmap_msdu:
1791	dma_unmap_single(dev, skb_cb->paddr, msdu->len, DMA_TO_DEVICE);
1792err_free_msdu_id:
1793	spin_lock_bh(&htt->tx_lock);
1794	ath10k_htt_tx_free_msdu_id(htt, msdu_id);
1795	spin_unlock_bh(&htt->tx_lock);
1796err:
1797	return res;
1798}
1799
1800static const struct ath10k_htt_tx_ops htt_tx_ops_32 = {
1801	.htt_send_rx_ring_cfg = ath10k_htt_send_rx_ring_cfg_32,
1802	.htt_send_frag_desc_bank_cfg = ath10k_htt_send_frag_desc_bank_cfg_32,
1803	.htt_alloc_frag_desc = ath10k_htt_tx_alloc_cont_frag_desc_32,
1804	.htt_free_frag_desc = ath10k_htt_tx_free_cont_frag_desc_32,
1805	.htt_tx = ath10k_htt_tx_32,
1806	.htt_alloc_txbuff = ath10k_htt_tx_alloc_cont_txbuf_32,
1807	.htt_free_txbuff = ath10k_htt_tx_free_cont_txbuf_32,
1808	.htt_h2t_aggr_cfg_msg = ath10k_htt_h2t_aggr_cfg_msg_32,
1809};
1810
1811static const struct ath10k_htt_tx_ops htt_tx_ops_64 = {
1812	.htt_send_rx_ring_cfg = ath10k_htt_send_rx_ring_cfg_64,
1813	.htt_send_frag_desc_bank_cfg = ath10k_htt_send_frag_desc_bank_cfg_64,
1814	.htt_alloc_frag_desc = ath10k_htt_tx_alloc_cont_frag_desc_64,
1815	.htt_free_frag_desc = ath10k_htt_tx_free_cont_frag_desc_64,
1816	.htt_tx = ath10k_htt_tx_64,
1817	.htt_alloc_txbuff = ath10k_htt_tx_alloc_cont_txbuf_64,
1818	.htt_free_txbuff = ath10k_htt_tx_free_cont_txbuf_64,
1819	.htt_h2t_aggr_cfg_msg = ath10k_htt_h2t_aggr_cfg_msg_v2,
1820};
1821
1822static const struct ath10k_htt_tx_ops htt_tx_ops_hl = {
1823	.htt_send_rx_ring_cfg = ath10k_htt_send_rx_ring_cfg_hl,
1824	.htt_send_frag_desc_bank_cfg = ath10k_htt_send_frag_desc_bank_cfg_32,
1825	.htt_tx = ath10k_htt_tx_hl,
1826	.htt_h2t_aggr_cfg_msg = ath10k_htt_h2t_aggr_cfg_msg_32,
1827	.htt_flush_tx = ath10k_htt_flush_tx_queue,
1828};
1829
1830void ath10k_htt_set_tx_ops(struct ath10k_htt *htt)
1831{
1832	struct ath10k *ar = htt->ar;
1833
1834	if (ar->bus_param.dev_type == ATH10K_DEV_TYPE_HL)
1835		htt->tx_ops = &htt_tx_ops_hl;
1836	else if (ar->hw_params.target_64bit)
1837		htt->tx_ops = &htt_tx_ops_64;
1838	else
1839		htt->tx_ops = &htt_tx_ops_32;
1840}
v5.4
   1// SPDX-License-Identifier: ISC
   2/*
   3 * Copyright (c) 2005-2011 Atheros Communications Inc.
   4 * Copyright (c) 2011-2017 Qualcomm Atheros, Inc.
 
   5 */
   6
   7#include <linux/etherdevice.h>
   8#include "htt.h"
   9#include "mac.h"
  10#include "hif.h"
  11#include "txrx.h"
  12#include "debug.h"
  13
  14static u8 ath10k_htt_tx_txq_calc_size(size_t count)
  15{
  16	int exp;
  17	int factor;
  18
  19	exp = 0;
  20	factor = count >> 7;
  21
  22	while (factor >= 64 && exp < 4) {
  23		factor >>= 3;
  24		exp++;
  25	}
  26
  27	if (exp == 4)
  28		return 0xff;
  29
  30	if (count > 0)
  31		factor = max(1, factor);
  32
  33	return SM(exp, HTT_TX_Q_STATE_ENTRY_EXP) |
  34	       SM(factor, HTT_TX_Q_STATE_ENTRY_FACTOR);
  35}
  36
  37static void __ath10k_htt_tx_txq_recalc(struct ieee80211_hw *hw,
  38				       struct ieee80211_txq *txq)
  39{
  40	struct ath10k *ar = hw->priv;
  41	struct ath10k_sta *arsta;
  42	struct ath10k_vif *arvif = (void *)txq->vif->drv_priv;
  43	unsigned long frame_cnt;
  44	unsigned long byte_cnt;
  45	int idx;
  46	u32 bit;
  47	u16 peer_id;
  48	u8 tid;
  49	u8 count;
  50
  51	lockdep_assert_held(&ar->htt.tx_lock);
  52
  53	if (!ar->htt.tx_q_state.enabled)
  54		return;
  55
  56	if (ar->htt.tx_q_state.mode != HTT_TX_MODE_SWITCH_PUSH_PULL)
  57		return;
  58
  59	if (txq->sta) {
  60		arsta = (void *)txq->sta->drv_priv;
  61		peer_id = arsta->peer_id;
  62	} else {
  63		peer_id = arvif->peer_id;
  64	}
  65
  66	tid = txq->tid;
  67	bit = BIT(peer_id % 32);
  68	idx = peer_id / 32;
  69
  70	ieee80211_txq_get_depth(txq, &frame_cnt, &byte_cnt);
  71	count = ath10k_htt_tx_txq_calc_size(byte_cnt);
  72
  73	if (unlikely(peer_id >= ar->htt.tx_q_state.num_peers) ||
  74	    unlikely(tid >= ar->htt.tx_q_state.num_tids)) {
  75		ath10k_warn(ar, "refusing to update txq for peer_id %hu tid %hhu due to out of bounds\n",
  76			    peer_id, tid);
  77		return;
  78	}
  79
  80	ar->htt.tx_q_state.vaddr->count[tid][peer_id] = count;
  81	ar->htt.tx_q_state.vaddr->map[tid][idx] &= ~bit;
  82	ar->htt.tx_q_state.vaddr->map[tid][idx] |= count ? bit : 0;
  83
  84	ath10k_dbg(ar, ATH10K_DBG_HTT, "htt tx txq state update peer_id %hu tid %hhu count %hhu\n",
  85		   peer_id, tid, count);
  86}
  87
  88static void __ath10k_htt_tx_txq_sync(struct ath10k *ar)
  89{
  90	u32 seq;
  91	size_t size;
  92
  93	lockdep_assert_held(&ar->htt.tx_lock);
  94
  95	if (!ar->htt.tx_q_state.enabled)
  96		return;
  97
  98	if (ar->htt.tx_q_state.mode != HTT_TX_MODE_SWITCH_PUSH_PULL)
  99		return;
 100
 101	seq = le32_to_cpu(ar->htt.tx_q_state.vaddr->seq);
 102	seq++;
 103	ar->htt.tx_q_state.vaddr->seq = cpu_to_le32(seq);
 104
 105	ath10k_dbg(ar, ATH10K_DBG_HTT, "htt tx txq state update commit seq %u\n",
 106		   seq);
 107
 108	size = sizeof(*ar->htt.tx_q_state.vaddr);
 109	dma_sync_single_for_device(ar->dev,
 110				   ar->htt.tx_q_state.paddr,
 111				   size,
 112				   DMA_TO_DEVICE);
 113}
 114
 115void ath10k_htt_tx_txq_recalc(struct ieee80211_hw *hw,
 116			      struct ieee80211_txq *txq)
 117{
 118	struct ath10k *ar = hw->priv;
 119
 120	spin_lock_bh(&ar->htt.tx_lock);
 121	__ath10k_htt_tx_txq_recalc(hw, txq);
 122	spin_unlock_bh(&ar->htt.tx_lock);
 123}
 124
 125void ath10k_htt_tx_txq_sync(struct ath10k *ar)
 126{
 127	spin_lock_bh(&ar->htt.tx_lock);
 128	__ath10k_htt_tx_txq_sync(ar);
 129	spin_unlock_bh(&ar->htt.tx_lock);
 130}
 131
 132void ath10k_htt_tx_txq_update(struct ieee80211_hw *hw,
 133			      struct ieee80211_txq *txq)
 134{
 135	struct ath10k *ar = hw->priv;
 136
 137	spin_lock_bh(&ar->htt.tx_lock);
 138	__ath10k_htt_tx_txq_recalc(hw, txq);
 139	__ath10k_htt_tx_txq_sync(ar);
 140	spin_unlock_bh(&ar->htt.tx_lock);
 141}
 142
 143void ath10k_htt_tx_dec_pending(struct ath10k_htt *htt)
 144{
 145	lockdep_assert_held(&htt->tx_lock);
 146
 147	htt->num_pending_tx--;
 148	if (htt->num_pending_tx == htt->max_num_pending_tx - 1)
 149		ath10k_mac_tx_unlock(htt->ar, ATH10K_TX_PAUSE_Q_FULL);
 
 
 
 150}
 151
 152int ath10k_htt_tx_inc_pending(struct ath10k_htt *htt)
 153{
 154	lockdep_assert_held(&htt->tx_lock);
 155
 156	if (htt->num_pending_tx >= htt->max_num_pending_tx)
 157		return -EBUSY;
 158
 159	htt->num_pending_tx++;
 160	if (htt->num_pending_tx == htt->max_num_pending_tx)
 161		ath10k_mac_tx_lock(htt->ar, ATH10K_TX_PAUSE_Q_FULL);
 162
 163	return 0;
 164}
 165
 166int ath10k_htt_tx_mgmt_inc_pending(struct ath10k_htt *htt, bool is_mgmt,
 167				   bool is_presp)
 168{
 169	struct ath10k *ar = htt->ar;
 170
 171	lockdep_assert_held(&htt->tx_lock);
 172
 173	if (!is_mgmt || !ar->hw_params.max_probe_resp_desc_thres)
 174		return 0;
 175
 176	if (is_presp &&
 177	    ar->hw_params.max_probe_resp_desc_thres < htt->num_pending_mgmt_tx)
 178		return -EBUSY;
 179
 180	htt->num_pending_mgmt_tx++;
 181
 182	return 0;
 183}
 184
 185void ath10k_htt_tx_mgmt_dec_pending(struct ath10k_htt *htt)
 186{
 187	lockdep_assert_held(&htt->tx_lock);
 188
 189	if (!htt->ar->hw_params.max_probe_resp_desc_thres)
 190		return;
 191
 192	htt->num_pending_mgmt_tx--;
 193}
 194
 195int ath10k_htt_tx_alloc_msdu_id(struct ath10k_htt *htt, struct sk_buff *skb)
 196{
 197	struct ath10k *ar = htt->ar;
 198	int ret;
 199
 200	spin_lock_bh(&htt->tx_lock);
 201	ret = idr_alloc(&htt->pending_tx, skb, 0,
 202			htt->max_num_pending_tx, GFP_ATOMIC);
 203	spin_unlock_bh(&htt->tx_lock);
 204
 205	ath10k_dbg(ar, ATH10K_DBG_HTT, "htt tx alloc msdu_id %d\n", ret);
 206
 207	return ret;
 208}
 209
 210void ath10k_htt_tx_free_msdu_id(struct ath10k_htt *htt, u16 msdu_id)
 211{
 212	struct ath10k *ar = htt->ar;
 213
 214	lockdep_assert_held(&htt->tx_lock);
 215
 216	ath10k_dbg(ar, ATH10K_DBG_HTT, "htt tx free msdu_id %hu\n", msdu_id);
 217
 218	idr_remove(&htt->pending_tx, msdu_id);
 219}
 220
 221static void ath10k_htt_tx_free_cont_txbuf_32(struct ath10k_htt *htt)
 222{
 223	struct ath10k *ar = htt->ar;
 224	size_t size;
 225
 226	if (!htt->txbuf.vaddr_txbuff_32)
 227		return;
 228
 229	size = htt->txbuf.size;
 230	dma_free_coherent(ar->dev, size, htt->txbuf.vaddr_txbuff_32,
 231			  htt->txbuf.paddr);
 232	htt->txbuf.vaddr_txbuff_32 = NULL;
 233}
 234
 235static int ath10k_htt_tx_alloc_cont_txbuf_32(struct ath10k_htt *htt)
 236{
 237	struct ath10k *ar = htt->ar;
 238	size_t size;
 239
 240	size = htt->max_num_pending_tx *
 241			sizeof(struct ath10k_htt_txbuf_32);
 242
 243	htt->txbuf.vaddr_txbuff_32 = dma_alloc_coherent(ar->dev, size,
 244							&htt->txbuf.paddr,
 245							GFP_KERNEL);
 246	if (!htt->txbuf.vaddr_txbuff_32)
 247		return -ENOMEM;
 248
 249	htt->txbuf.size = size;
 250
 251	return 0;
 252}
 253
 254static void ath10k_htt_tx_free_cont_txbuf_64(struct ath10k_htt *htt)
 255{
 256	struct ath10k *ar = htt->ar;
 257	size_t size;
 258
 259	if (!htt->txbuf.vaddr_txbuff_64)
 260		return;
 261
 262	size = htt->txbuf.size;
 263	dma_free_coherent(ar->dev, size, htt->txbuf.vaddr_txbuff_64,
 264			  htt->txbuf.paddr);
 265	htt->txbuf.vaddr_txbuff_64 = NULL;
 266}
 267
 268static int ath10k_htt_tx_alloc_cont_txbuf_64(struct ath10k_htt *htt)
 269{
 270	struct ath10k *ar = htt->ar;
 271	size_t size;
 272
 273	size = htt->max_num_pending_tx *
 274			sizeof(struct ath10k_htt_txbuf_64);
 275
 276	htt->txbuf.vaddr_txbuff_64 = dma_alloc_coherent(ar->dev, size,
 277							&htt->txbuf.paddr,
 278							GFP_KERNEL);
 279	if (!htt->txbuf.vaddr_txbuff_64)
 280		return -ENOMEM;
 281
 282	htt->txbuf.size = size;
 283
 284	return 0;
 285}
 286
 287static void ath10k_htt_tx_free_cont_frag_desc_32(struct ath10k_htt *htt)
 288{
 289	size_t size;
 290
 291	if (!htt->frag_desc.vaddr_desc_32)
 292		return;
 293
 294	size = htt->max_num_pending_tx *
 295			sizeof(struct htt_msdu_ext_desc);
 296
 297	dma_free_coherent(htt->ar->dev,
 298			  size,
 299			  htt->frag_desc.vaddr_desc_32,
 300			  htt->frag_desc.paddr);
 301
 302	htt->frag_desc.vaddr_desc_32 = NULL;
 303}
 304
 305static int ath10k_htt_tx_alloc_cont_frag_desc_32(struct ath10k_htt *htt)
 306{
 307	struct ath10k *ar = htt->ar;
 308	size_t size;
 309
 310	if (!ar->hw_params.continuous_frag_desc)
 311		return 0;
 312
 313	size = htt->max_num_pending_tx *
 314			sizeof(struct htt_msdu_ext_desc);
 315	htt->frag_desc.vaddr_desc_32 = dma_alloc_coherent(ar->dev, size,
 316							  &htt->frag_desc.paddr,
 317							  GFP_KERNEL);
 318	if (!htt->frag_desc.vaddr_desc_32) {
 319		ath10k_err(ar, "failed to alloc fragment desc memory\n");
 320		return -ENOMEM;
 321	}
 322	htt->frag_desc.size = size;
 323
 324	return 0;
 325}
 326
 327static void ath10k_htt_tx_free_cont_frag_desc_64(struct ath10k_htt *htt)
 328{
 329	size_t size;
 330
 331	if (!htt->frag_desc.vaddr_desc_64)
 332		return;
 333
 334	size = htt->max_num_pending_tx *
 335			sizeof(struct htt_msdu_ext_desc_64);
 336
 337	dma_free_coherent(htt->ar->dev,
 338			  size,
 339			  htt->frag_desc.vaddr_desc_64,
 340			  htt->frag_desc.paddr);
 341
 342	htt->frag_desc.vaddr_desc_64 = NULL;
 343}
 344
 345static int ath10k_htt_tx_alloc_cont_frag_desc_64(struct ath10k_htt *htt)
 346{
 347	struct ath10k *ar = htt->ar;
 348	size_t size;
 349
 350	if (!ar->hw_params.continuous_frag_desc)
 351		return 0;
 352
 353	size = htt->max_num_pending_tx *
 354			sizeof(struct htt_msdu_ext_desc_64);
 355
 356	htt->frag_desc.vaddr_desc_64 = dma_alloc_coherent(ar->dev, size,
 357							  &htt->frag_desc.paddr,
 358							  GFP_KERNEL);
 359	if (!htt->frag_desc.vaddr_desc_64) {
 360		ath10k_err(ar, "failed to alloc fragment desc memory\n");
 361		return -ENOMEM;
 362	}
 363	htt->frag_desc.size = size;
 364
 365	return 0;
 366}
 367
 368static void ath10k_htt_tx_free_txq(struct ath10k_htt *htt)
 369{
 370	struct ath10k *ar = htt->ar;
 371	size_t size;
 372
 373	if (!test_bit(ATH10K_FW_FEATURE_PEER_FLOW_CONTROL,
 374		      ar->running_fw->fw_file.fw_features))
 375		return;
 376
 377	size = sizeof(*htt->tx_q_state.vaddr);
 378
 379	dma_unmap_single(ar->dev, htt->tx_q_state.paddr, size, DMA_TO_DEVICE);
 380	kfree(htt->tx_q_state.vaddr);
 381}
 382
 383static int ath10k_htt_tx_alloc_txq(struct ath10k_htt *htt)
 384{
 385	struct ath10k *ar = htt->ar;
 386	size_t size;
 387	int ret;
 388
 389	if (!test_bit(ATH10K_FW_FEATURE_PEER_FLOW_CONTROL,
 390		      ar->running_fw->fw_file.fw_features))
 391		return 0;
 392
 393	htt->tx_q_state.num_peers = HTT_TX_Q_STATE_NUM_PEERS;
 394	htt->tx_q_state.num_tids = HTT_TX_Q_STATE_NUM_TIDS;
 395	htt->tx_q_state.type = HTT_Q_DEPTH_TYPE_BYTES;
 396
 397	size = sizeof(*htt->tx_q_state.vaddr);
 398	htt->tx_q_state.vaddr = kzalloc(size, GFP_KERNEL);
 399	if (!htt->tx_q_state.vaddr)
 400		return -ENOMEM;
 401
 402	htt->tx_q_state.paddr = dma_map_single(ar->dev, htt->tx_q_state.vaddr,
 403					       size, DMA_TO_DEVICE);
 404	ret = dma_mapping_error(ar->dev, htt->tx_q_state.paddr);
 405	if (ret) {
 406		ath10k_warn(ar, "failed to dma map tx_q_state: %d\n", ret);
 407		kfree(htt->tx_q_state.vaddr);
 408		return -EIO;
 409	}
 410
 411	return 0;
 412}
 413
 414static void ath10k_htt_tx_free_txdone_fifo(struct ath10k_htt *htt)
 415{
 416	WARN_ON(!kfifo_is_empty(&htt->txdone_fifo));
 417	kfifo_free(&htt->txdone_fifo);
 418}
 419
 420static int ath10k_htt_tx_alloc_txdone_fifo(struct ath10k_htt *htt)
 421{
 422	int ret;
 423	size_t size;
 424
 425	size = roundup_pow_of_two(htt->max_num_pending_tx);
 426	ret = kfifo_alloc(&htt->txdone_fifo, size, GFP_KERNEL);
 427	return ret;
 428}
 429
 430static int ath10k_htt_tx_alloc_buf(struct ath10k_htt *htt)
 431{
 432	struct ath10k *ar = htt->ar;
 433	int ret;
 434
 435	ret = ath10k_htt_alloc_txbuff(htt);
 436	if (ret) {
 437		ath10k_err(ar, "failed to alloc cont tx buffer: %d\n", ret);
 438		return ret;
 439	}
 440
 441	ret = ath10k_htt_alloc_frag_desc(htt);
 442	if (ret) {
 443		ath10k_err(ar, "failed to alloc cont frag desc: %d\n", ret);
 444		goto free_txbuf;
 445	}
 446
 447	ret = ath10k_htt_tx_alloc_txq(htt);
 448	if (ret) {
 449		ath10k_err(ar, "failed to alloc txq: %d\n", ret);
 450		goto free_frag_desc;
 451	}
 452
 453	ret = ath10k_htt_tx_alloc_txdone_fifo(htt);
 454	if (ret) {
 455		ath10k_err(ar, "failed to alloc txdone fifo: %d\n", ret);
 456		goto free_txq;
 457	}
 458
 459	return 0;
 460
 461free_txq:
 462	ath10k_htt_tx_free_txq(htt);
 463
 464free_frag_desc:
 465	ath10k_htt_free_frag_desc(htt);
 466
 467free_txbuf:
 468	ath10k_htt_free_txbuff(htt);
 469
 470	return ret;
 471}
 472
 473int ath10k_htt_tx_start(struct ath10k_htt *htt)
 474{
 475	struct ath10k *ar = htt->ar;
 476	int ret;
 477
 478	ath10k_dbg(ar, ATH10K_DBG_BOOT, "htt tx max num pending tx %d\n",
 479		   htt->max_num_pending_tx);
 480
 481	spin_lock_init(&htt->tx_lock);
 482	idr_init(&htt->pending_tx);
 483
 484	if (htt->tx_mem_allocated)
 485		return 0;
 486
 487	if (ar->bus_param.dev_type == ATH10K_DEV_TYPE_HL)
 488		return 0;
 489
 490	ret = ath10k_htt_tx_alloc_buf(htt);
 491	if (ret)
 492		goto free_idr_pending_tx;
 493
 494	htt->tx_mem_allocated = true;
 495
 496	return 0;
 497
 498free_idr_pending_tx:
 499	idr_destroy(&htt->pending_tx);
 500
 501	return ret;
 502}
 503
 504static int ath10k_htt_tx_clean_up_pending(int msdu_id, void *skb, void *ctx)
 505{
 506	struct ath10k *ar = ctx;
 507	struct ath10k_htt *htt = &ar->htt;
 508	struct htt_tx_done tx_done = {0};
 509
 510	ath10k_dbg(ar, ATH10K_DBG_HTT, "force cleanup msdu_id %hu\n", msdu_id);
 511
 512	tx_done.msdu_id = msdu_id;
 513	tx_done.status = HTT_TX_COMPL_STATE_DISCARD;
 514
 515	ath10k_txrx_tx_unref(htt, &tx_done);
 516
 517	return 0;
 518}
 519
 520void ath10k_htt_tx_destroy(struct ath10k_htt *htt)
 521{
 522	if (!htt->tx_mem_allocated)
 523		return;
 524
 525	ath10k_htt_free_txbuff(htt);
 526	ath10k_htt_tx_free_txq(htt);
 527	ath10k_htt_free_frag_desc(htt);
 528	ath10k_htt_tx_free_txdone_fifo(htt);
 529	htt->tx_mem_allocated = false;
 530}
 531
 
 
 
 
 
 
 532void ath10k_htt_tx_stop(struct ath10k_htt *htt)
 533{
 534	idr_for_each(&htt->pending_tx, ath10k_htt_tx_clean_up_pending, htt->ar);
 535	idr_destroy(&htt->pending_tx);
 536}
 537
 538void ath10k_htt_tx_free(struct ath10k_htt *htt)
 539{
 540	ath10k_htt_tx_stop(htt);
 541	ath10k_htt_tx_destroy(htt);
 542}
 543
 
 
 
 
 
 544void ath10k_htt_htc_tx_complete(struct ath10k *ar, struct sk_buff *skb)
 545{
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 546	dev_kfree_skb_any(skb);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 547}
 548
 549void ath10k_htt_hif_tx_complete(struct ath10k *ar, struct sk_buff *skb)
 550{
 551	dev_kfree_skb_any(skb);
 552}
 553EXPORT_SYMBOL(ath10k_htt_hif_tx_complete);
 554
 555int ath10k_htt_h2t_ver_req_msg(struct ath10k_htt *htt)
 556{
 557	struct ath10k *ar = htt->ar;
 558	struct sk_buff *skb;
 559	struct htt_cmd *cmd;
 560	int len = 0;
 561	int ret;
 562
 563	len += sizeof(cmd->hdr);
 564	len += sizeof(cmd->ver_req);
 565
 566	skb = ath10k_htc_alloc_skb(ar, len);
 567	if (!skb)
 568		return -ENOMEM;
 569
 570	skb_put(skb, len);
 571	cmd = (struct htt_cmd *)skb->data;
 572	cmd->hdr.msg_type = HTT_H2T_MSG_TYPE_VERSION_REQ;
 573
 574	ret = ath10k_htc_send(&htt->ar->htc, htt->eid, skb);
 575	if (ret) {
 576		dev_kfree_skb_any(skb);
 577		return ret;
 578	}
 579
 580	return 0;
 581}
 582
 583int ath10k_htt_h2t_stats_req(struct ath10k_htt *htt, u32 mask, u32 reset_mask,
 584			     u64 cookie)
 585{
 586	struct ath10k *ar = htt->ar;
 587	struct htt_stats_req *req;
 588	struct sk_buff *skb;
 589	struct htt_cmd *cmd;
 590	int len = 0, ret;
 591
 592	len += sizeof(cmd->hdr);
 593	len += sizeof(cmd->stats_req);
 594
 595	skb = ath10k_htc_alloc_skb(ar, len);
 596	if (!skb)
 597		return -ENOMEM;
 598
 599	skb_put(skb, len);
 600	cmd = (struct htt_cmd *)skb->data;
 601	cmd->hdr.msg_type = HTT_H2T_MSG_TYPE_STATS_REQ;
 602
 603	req = &cmd->stats_req;
 604
 605	memset(req, 0, sizeof(*req));
 606
 607	/* currently we support only max 24 bit masks so no need to worry
 608	 * about endian support
 609	 */
 610	memcpy(req->upload_types, &mask, 3);
 611	memcpy(req->reset_types, &reset_mask, 3);
 612	req->stat_type = HTT_STATS_REQ_CFG_STAT_TYPE_INVALID;
 613	req->cookie_lsb = cpu_to_le32(cookie & 0xffffffff);
 614	req->cookie_msb = cpu_to_le32((cookie & 0xffffffff00000000ULL) >> 32);
 615
 616	ret = ath10k_htc_send(&htt->ar->htc, htt->eid, skb);
 617	if (ret) {
 618		ath10k_warn(ar, "failed to send htt type stats request: %d",
 619			    ret);
 620		dev_kfree_skb_any(skb);
 621		return ret;
 622	}
 623
 624	return 0;
 625}
 626
 627static int ath10k_htt_send_frag_desc_bank_cfg_32(struct ath10k_htt *htt)
 628{
 629	struct ath10k *ar = htt->ar;
 630	struct sk_buff *skb;
 631	struct htt_cmd *cmd;
 632	struct htt_frag_desc_bank_cfg32 *cfg;
 633	int ret, size;
 634	u8 info;
 635
 636	if (!ar->hw_params.continuous_frag_desc)
 637		return 0;
 638
 639	if (!htt->frag_desc.paddr) {
 640		ath10k_warn(ar, "invalid frag desc memory\n");
 641		return -EINVAL;
 642	}
 643
 644	size = sizeof(cmd->hdr) + sizeof(cmd->frag_desc_bank_cfg32);
 645	skb = ath10k_htc_alloc_skb(ar, size);
 646	if (!skb)
 647		return -ENOMEM;
 648
 649	skb_put(skb, size);
 650	cmd = (struct htt_cmd *)skb->data;
 651	cmd->hdr.msg_type = HTT_H2T_MSG_TYPE_FRAG_DESC_BANK_CFG;
 652
 653	info = 0;
 654	info |= SM(htt->tx_q_state.type,
 655		   HTT_FRAG_DESC_BANK_CFG_INFO_Q_STATE_DEPTH_TYPE);
 656
 657	if (test_bit(ATH10K_FW_FEATURE_PEER_FLOW_CONTROL,
 658		     ar->running_fw->fw_file.fw_features))
 659		info |= HTT_FRAG_DESC_BANK_CFG_INFO_Q_STATE_VALID;
 660
 661	cfg = &cmd->frag_desc_bank_cfg32;
 662	cfg->info = info;
 663	cfg->num_banks = 1;
 664	cfg->desc_size = sizeof(struct htt_msdu_ext_desc);
 665	cfg->bank_base_addrs[0] = __cpu_to_le32(htt->frag_desc.paddr);
 666	cfg->bank_id[0].bank_min_id = 0;
 667	cfg->bank_id[0].bank_max_id = __cpu_to_le16(htt->max_num_pending_tx -
 668						    1);
 669
 670	cfg->q_state.paddr = cpu_to_le32(htt->tx_q_state.paddr);
 671	cfg->q_state.num_peers = cpu_to_le16(htt->tx_q_state.num_peers);
 672	cfg->q_state.num_tids = cpu_to_le16(htt->tx_q_state.num_tids);
 673	cfg->q_state.record_size = HTT_TX_Q_STATE_ENTRY_SIZE;
 674	cfg->q_state.record_multiplier = HTT_TX_Q_STATE_ENTRY_MULTIPLIER;
 675
 676	ath10k_dbg(ar, ATH10K_DBG_HTT, "htt frag desc bank cmd\n");
 677
 678	ret = ath10k_htc_send(&htt->ar->htc, htt->eid, skb);
 679	if (ret) {
 680		ath10k_warn(ar, "failed to send frag desc bank cfg request: %d\n",
 681			    ret);
 682		dev_kfree_skb_any(skb);
 683		return ret;
 684	}
 685
 686	return 0;
 687}
 688
 689static int ath10k_htt_send_frag_desc_bank_cfg_64(struct ath10k_htt *htt)
 690{
 691	struct ath10k *ar = htt->ar;
 692	struct sk_buff *skb;
 693	struct htt_cmd *cmd;
 694	struct htt_frag_desc_bank_cfg64 *cfg;
 695	int ret, size;
 696	u8 info;
 697
 698	if (!ar->hw_params.continuous_frag_desc)
 699		return 0;
 700
 701	if (!htt->frag_desc.paddr) {
 702		ath10k_warn(ar, "invalid frag desc memory\n");
 703		return -EINVAL;
 704	}
 705
 706	size = sizeof(cmd->hdr) + sizeof(cmd->frag_desc_bank_cfg64);
 707	skb = ath10k_htc_alloc_skb(ar, size);
 708	if (!skb)
 709		return -ENOMEM;
 710
 711	skb_put(skb, size);
 712	cmd = (struct htt_cmd *)skb->data;
 713	cmd->hdr.msg_type = HTT_H2T_MSG_TYPE_FRAG_DESC_BANK_CFG;
 714
 715	info = 0;
 716	info |= SM(htt->tx_q_state.type,
 717		   HTT_FRAG_DESC_BANK_CFG_INFO_Q_STATE_DEPTH_TYPE);
 718
 719	if (test_bit(ATH10K_FW_FEATURE_PEER_FLOW_CONTROL,
 720		     ar->running_fw->fw_file.fw_features))
 721		info |= HTT_FRAG_DESC_BANK_CFG_INFO_Q_STATE_VALID;
 722
 723	cfg = &cmd->frag_desc_bank_cfg64;
 724	cfg->info = info;
 725	cfg->num_banks = 1;
 726	cfg->desc_size = sizeof(struct htt_msdu_ext_desc_64);
 727	cfg->bank_base_addrs[0] =  __cpu_to_le64(htt->frag_desc.paddr);
 728	cfg->bank_id[0].bank_min_id = 0;
 729	cfg->bank_id[0].bank_max_id = __cpu_to_le16(htt->max_num_pending_tx -
 730						    1);
 731
 732	cfg->q_state.paddr = cpu_to_le32(htt->tx_q_state.paddr);
 733	cfg->q_state.num_peers = cpu_to_le16(htt->tx_q_state.num_peers);
 734	cfg->q_state.num_tids = cpu_to_le16(htt->tx_q_state.num_tids);
 735	cfg->q_state.record_size = HTT_TX_Q_STATE_ENTRY_SIZE;
 736	cfg->q_state.record_multiplier = HTT_TX_Q_STATE_ENTRY_MULTIPLIER;
 737
 738	ath10k_dbg(ar, ATH10K_DBG_HTT, "htt frag desc bank cmd\n");
 739
 740	ret = ath10k_htc_send(&htt->ar->htc, htt->eid, skb);
 741	if (ret) {
 742		ath10k_warn(ar, "failed to send frag desc bank cfg request: %d\n",
 743			    ret);
 744		dev_kfree_skb_any(skb);
 745		return ret;
 746	}
 747
 748	return 0;
 749}
 750
 751static void ath10k_htt_fill_rx_desc_offset_32(void *rx_ring)
 
 752{
 753	struct htt_rx_ring_setup_ring32 *ring =
 754			(struct htt_rx_ring_setup_ring32 *)rx_ring;
 755
 756#define desc_offset(x) (offsetof(struct htt_rx_desc, x) / 4)
 757	ring->mac80211_hdr_offset = __cpu_to_le16(desc_offset(rx_hdr_status));
 758	ring->msdu_payload_offset = __cpu_to_le16(desc_offset(msdu_payload));
 759	ring->ppdu_start_offset = __cpu_to_le16(desc_offset(ppdu_start));
 760	ring->ppdu_end_offset = __cpu_to_le16(desc_offset(ppdu_end));
 761	ring->mpdu_start_offset = __cpu_to_le16(desc_offset(mpdu_start));
 762	ring->mpdu_end_offset = __cpu_to_le16(desc_offset(mpdu_end));
 763	ring->msdu_start_offset = __cpu_to_le16(desc_offset(msdu_start));
 764	ring->msdu_end_offset = __cpu_to_le16(desc_offset(msdu_end));
 765	ring->rx_attention_offset = __cpu_to_le16(desc_offset(attention));
 766	ring->frag_info_offset = __cpu_to_le16(desc_offset(frag_info));
 767#undef desc_offset
 768}
 769
 770static void ath10k_htt_fill_rx_desc_offset_64(void *rx_ring)
 771{
 772	struct htt_rx_ring_setup_ring64 *ring =
 773			(struct htt_rx_ring_setup_ring64 *)rx_ring;
 774
 775#define desc_offset(x) (offsetof(struct htt_rx_desc, x) / 4)
 776	ring->mac80211_hdr_offset = __cpu_to_le16(desc_offset(rx_hdr_status));
 777	ring->msdu_payload_offset = __cpu_to_le16(desc_offset(msdu_payload));
 778	ring->ppdu_start_offset = __cpu_to_le16(desc_offset(ppdu_start));
 779	ring->ppdu_end_offset = __cpu_to_le16(desc_offset(ppdu_end));
 780	ring->mpdu_start_offset = __cpu_to_le16(desc_offset(mpdu_start));
 781	ring->mpdu_end_offset = __cpu_to_le16(desc_offset(mpdu_end));
 782	ring->msdu_start_offset = __cpu_to_le16(desc_offset(msdu_start));
 783	ring->msdu_end_offset = __cpu_to_le16(desc_offset(msdu_end));
 784	ring->rx_attention_offset = __cpu_to_le16(desc_offset(attention));
 785	ring->frag_info_offset = __cpu_to_le16(desc_offset(frag_info));
 786#undef desc_offset
 787}
 788
 789static int ath10k_htt_send_rx_ring_cfg_32(struct ath10k_htt *htt)
 790{
 791	struct ath10k *ar = htt->ar;
 
 792	struct sk_buff *skb;
 793	struct htt_cmd *cmd;
 794	struct htt_rx_ring_setup_ring32 *ring;
 795	const int num_rx_ring = 1;
 796	u16 flags;
 797	u32 fw_idx;
 798	int len;
 799	int ret;
 800
 801	/*
 802	 * the HW expects the buffer to be an integral number of 4-byte
 803	 * "words"
 804	 */
 805	BUILD_BUG_ON(!IS_ALIGNED(HTT_RX_BUF_SIZE, 4));
 806	BUILD_BUG_ON((HTT_RX_BUF_SIZE & HTT_MAX_CACHE_LINE_SIZE_MASK) != 0);
 807
 808	len = sizeof(cmd->hdr) + sizeof(cmd->rx_setup_32.hdr)
 809	    + (sizeof(*ring) * num_rx_ring);
 810	skb = ath10k_htc_alloc_skb(ar, len);
 811	if (!skb)
 812		return -ENOMEM;
 813
 814	skb_put(skb, len);
 815
 816	cmd = (struct htt_cmd *)skb->data;
 817	ring = &cmd->rx_setup_32.rings[0];
 818
 819	cmd->hdr.msg_type = HTT_H2T_MSG_TYPE_RX_RING_CFG;
 820	cmd->rx_setup_32.hdr.num_rings = 1;
 821
 822	/* FIXME: do we need all of this? */
 823	flags = 0;
 824	flags |= HTT_RX_RING_FLAGS_MAC80211_HDR;
 825	flags |= HTT_RX_RING_FLAGS_MSDU_PAYLOAD;
 826	flags |= HTT_RX_RING_FLAGS_PPDU_START;
 827	flags |= HTT_RX_RING_FLAGS_PPDU_END;
 828	flags |= HTT_RX_RING_FLAGS_MPDU_START;
 829	flags |= HTT_RX_RING_FLAGS_MPDU_END;
 830	flags |= HTT_RX_RING_FLAGS_MSDU_START;
 831	flags |= HTT_RX_RING_FLAGS_MSDU_END;
 832	flags |= HTT_RX_RING_FLAGS_RX_ATTENTION;
 833	flags |= HTT_RX_RING_FLAGS_FRAG_INFO;
 834	flags |= HTT_RX_RING_FLAGS_UNICAST_RX;
 835	flags |= HTT_RX_RING_FLAGS_MULTICAST_RX;
 836	flags |= HTT_RX_RING_FLAGS_CTRL_RX;
 837	flags |= HTT_RX_RING_FLAGS_MGMT_RX;
 838	flags |= HTT_RX_RING_FLAGS_NULL_RX;
 839	flags |= HTT_RX_RING_FLAGS_PHY_DATA_RX;
 840
 841	fw_idx = __le32_to_cpu(*htt->rx_ring.alloc_idx.vaddr);
 842
 843	ring->fw_idx_shadow_reg_paddr =
 844		__cpu_to_le32(htt->rx_ring.alloc_idx.paddr);
 845	ring->rx_ring_base_paddr = __cpu_to_le32(htt->rx_ring.base_paddr);
 846	ring->rx_ring_len = __cpu_to_le16(htt->rx_ring.size);
 847	ring->rx_ring_bufsize = __cpu_to_le16(HTT_RX_BUF_SIZE);
 848	ring->flags = __cpu_to_le16(flags);
 849	ring->fw_idx_init_val = __cpu_to_le16(fw_idx);
 850
 851	ath10k_htt_fill_rx_desc_offset_32(ring);
 852	ret = ath10k_htc_send(&htt->ar->htc, htt->eid, skb);
 853	if (ret) {
 854		dev_kfree_skb_any(skb);
 855		return ret;
 856	}
 857
 858	return 0;
 859}
 860
 861static int ath10k_htt_send_rx_ring_cfg_64(struct ath10k_htt *htt)
 862{
 863	struct ath10k *ar = htt->ar;
 
 864	struct sk_buff *skb;
 865	struct htt_cmd *cmd;
 866	struct htt_rx_ring_setup_ring64 *ring;
 867	const int num_rx_ring = 1;
 868	u16 flags;
 869	u32 fw_idx;
 870	int len;
 871	int ret;
 872
 873	/* HW expects the buffer to be an integral number of 4-byte
 874	 * "words"
 875	 */
 876	BUILD_BUG_ON(!IS_ALIGNED(HTT_RX_BUF_SIZE, 4));
 877	BUILD_BUG_ON((HTT_RX_BUF_SIZE & HTT_MAX_CACHE_LINE_SIZE_MASK) != 0);
 878
 879	len = sizeof(cmd->hdr) + sizeof(cmd->rx_setup_64.hdr)
 880	    + (sizeof(*ring) * num_rx_ring);
 881	skb = ath10k_htc_alloc_skb(ar, len);
 882	if (!skb)
 883		return -ENOMEM;
 884
 885	skb_put(skb, len);
 886
 887	cmd = (struct htt_cmd *)skb->data;
 888	ring = &cmd->rx_setup_64.rings[0];
 889
 890	cmd->hdr.msg_type = HTT_H2T_MSG_TYPE_RX_RING_CFG;
 891	cmd->rx_setup_64.hdr.num_rings = 1;
 892
 893	flags = 0;
 894	flags |= HTT_RX_RING_FLAGS_MAC80211_HDR;
 895	flags |= HTT_RX_RING_FLAGS_MSDU_PAYLOAD;
 896	flags |= HTT_RX_RING_FLAGS_PPDU_START;
 897	flags |= HTT_RX_RING_FLAGS_PPDU_END;
 898	flags |= HTT_RX_RING_FLAGS_MPDU_START;
 899	flags |= HTT_RX_RING_FLAGS_MPDU_END;
 900	flags |= HTT_RX_RING_FLAGS_MSDU_START;
 901	flags |= HTT_RX_RING_FLAGS_MSDU_END;
 902	flags |= HTT_RX_RING_FLAGS_RX_ATTENTION;
 903	flags |= HTT_RX_RING_FLAGS_FRAG_INFO;
 904	flags |= HTT_RX_RING_FLAGS_UNICAST_RX;
 905	flags |= HTT_RX_RING_FLAGS_MULTICAST_RX;
 906	flags |= HTT_RX_RING_FLAGS_CTRL_RX;
 907	flags |= HTT_RX_RING_FLAGS_MGMT_RX;
 908	flags |= HTT_RX_RING_FLAGS_NULL_RX;
 909	flags |= HTT_RX_RING_FLAGS_PHY_DATA_RX;
 910
 911	fw_idx = __le32_to_cpu(*htt->rx_ring.alloc_idx.vaddr);
 912
 913	ring->fw_idx_shadow_reg_paddr = __cpu_to_le64(htt->rx_ring.alloc_idx.paddr);
 914	ring->rx_ring_base_paddr = __cpu_to_le64(htt->rx_ring.base_paddr);
 915	ring->rx_ring_len = __cpu_to_le16(htt->rx_ring.size);
 916	ring->rx_ring_bufsize = __cpu_to_le16(HTT_RX_BUF_SIZE);
 917	ring->flags = __cpu_to_le16(flags);
 918	ring->fw_idx_init_val = __cpu_to_le16(fw_idx);
 919
 920	ath10k_htt_fill_rx_desc_offset_64(ring);
 921	ret = ath10k_htc_send(&htt->ar->htc, htt->eid, skb);
 922	if (ret) {
 923		dev_kfree_skb_any(skb);
 924		return ret;
 925	}
 926
 927	return 0;
 928}
 929
 930static int ath10k_htt_send_rx_ring_cfg_hl(struct ath10k_htt *htt)
 931{
 932	struct ath10k *ar = htt->ar;
 933	struct sk_buff *skb;
 934	struct htt_cmd *cmd;
 935	struct htt_rx_ring_setup_ring32 *ring;
 936	const int num_rx_ring = 1;
 937	u16 flags;
 938	int len;
 939	int ret;
 940
 941	/*
 942	 * the HW expects the buffer to be an integral number of 4-byte
 943	 * "words"
 944	 */
 945	BUILD_BUG_ON(!IS_ALIGNED(HTT_RX_BUF_SIZE, 4));
 946	BUILD_BUG_ON((HTT_RX_BUF_SIZE & HTT_MAX_CACHE_LINE_SIZE_MASK) != 0);
 947
 948	len = sizeof(cmd->hdr) + sizeof(cmd->rx_setup_32.hdr)
 949	    + (sizeof(*ring) * num_rx_ring);
 950	skb = ath10k_htc_alloc_skb(ar, len);
 951	if (!skb)
 952		return -ENOMEM;
 953
 954	skb_put(skb, len);
 955
 956	cmd = (struct htt_cmd *)skb->data;
 957	ring = &cmd->rx_setup_32.rings[0];
 958
 959	cmd->hdr.msg_type = HTT_H2T_MSG_TYPE_RX_RING_CFG;
 960	cmd->rx_setup_32.hdr.num_rings = 1;
 961
 962	flags = 0;
 963	flags |= HTT_RX_RING_FLAGS_MSDU_PAYLOAD;
 964	flags |= HTT_RX_RING_FLAGS_UNICAST_RX;
 965	flags |= HTT_RX_RING_FLAGS_MULTICAST_RX;
 966
 967	memset(ring, 0, sizeof(*ring));
 968	ring->rx_ring_len = __cpu_to_le16(HTT_RX_RING_SIZE_MIN);
 969	ring->rx_ring_bufsize = __cpu_to_le16(HTT_RX_BUF_SIZE);
 970	ring->flags = __cpu_to_le16(flags);
 971
 972	ret = ath10k_htc_send(&htt->ar->htc, htt->eid, skb);
 973	if (ret) {
 974		dev_kfree_skb_any(skb);
 975		return ret;
 976	}
 977
 978	return 0;
 979}
 980
 981static int ath10k_htt_h2t_aggr_cfg_msg_32(struct ath10k_htt *htt,
 982					  u8 max_subfrms_ampdu,
 983					  u8 max_subfrms_amsdu)
 984{
 985	struct ath10k *ar = htt->ar;
 986	struct htt_aggr_conf *aggr_conf;
 987	struct sk_buff *skb;
 988	struct htt_cmd *cmd;
 989	int len;
 990	int ret;
 991
 992	/* Firmware defaults are: amsdu = 3 and ampdu = 64 */
 993
 994	if (max_subfrms_ampdu == 0 || max_subfrms_ampdu > 64)
 995		return -EINVAL;
 996
 997	if (max_subfrms_amsdu == 0 || max_subfrms_amsdu > 31)
 998		return -EINVAL;
 999
1000	len = sizeof(cmd->hdr);
1001	len += sizeof(cmd->aggr_conf);
1002
1003	skb = ath10k_htc_alloc_skb(ar, len);
1004	if (!skb)
1005		return -ENOMEM;
1006
1007	skb_put(skb, len);
1008	cmd = (struct htt_cmd *)skb->data;
1009	cmd->hdr.msg_type = HTT_H2T_MSG_TYPE_AGGR_CFG;
1010
1011	aggr_conf = &cmd->aggr_conf;
1012	aggr_conf->max_num_ampdu_subframes = max_subfrms_ampdu;
1013	aggr_conf->max_num_amsdu_subframes = max_subfrms_amsdu;
1014
1015	ath10k_dbg(ar, ATH10K_DBG_HTT, "htt h2t aggr cfg msg amsdu %d ampdu %d",
1016		   aggr_conf->max_num_amsdu_subframes,
1017		   aggr_conf->max_num_ampdu_subframes);
1018
1019	ret = ath10k_htc_send(&htt->ar->htc, htt->eid, skb);
1020	if (ret) {
1021		dev_kfree_skb_any(skb);
1022		return ret;
1023	}
1024
1025	return 0;
1026}
1027
1028static int ath10k_htt_h2t_aggr_cfg_msg_v2(struct ath10k_htt *htt,
1029					  u8 max_subfrms_ampdu,
1030					  u8 max_subfrms_amsdu)
1031{
1032	struct ath10k *ar = htt->ar;
1033	struct htt_aggr_conf_v2 *aggr_conf;
1034	struct sk_buff *skb;
1035	struct htt_cmd *cmd;
1036	int len;
1037	int ret;
1038
1039	/* Firmware defaults are: amsdu = 3 and ampdu = 64 */
1040
1041	if (max_subfrms_ampdu == 0 || max_subfrms_ampdu > 64)
1042		return -EINVAL;
1043
1044	if (max_subfrms_amsdu == 0 || max_subfrms_amsdu > 31)
1045		return -EINVAL;
1046
1047	len = sizeof(cmd->hdr);
1048	len += sizeof(cmd->aggr_conf_v2);
1049
1050	skb = ath10k_htc_alloc_skb(ar, len);
1051	if (!skb)
1052		return -ENOMEM;
1053
1054	skb_put(skb, len);
1055	cmd = (struct htt_cmd *)skb->data;
1056	cmd->hdr.msg_type = HTT_H2T_MSG_TYPE_AGGR_CFG;
1057
1058	aggr_conf = &cmd->aggr_conf_v2;
1059	aggr_conf->max_num_ampdu_subframes = max_subfrms_ampdu;
1060	aggr_conf->max_num_amsdu_subframes = max_subfrms_amsdu;
1061
1062	ath10k_dbg(ar, ATH10K_DBG_HTT, "htt h2t aggr cfg msg amsdu %d ampdu %d",
1063		   aggr_conf->max_num_amsdu_subframes,
1064		   aggr_conf->max_num_ampdu_subframes);
1065
1066	ret = ath10k_htc_send(&htt->ar->htc, htt->eid, skb);
1067	if (ret) {
1068		dev_kfree_skb_any(skb);
1069		return ret;
1070	}
1071
1072	return 0;
1073}
1074
1075int ath10k_htt_tx_fetch_resp(struct ath10k *ar,
1076			     __le32 token,
1077			     __le16 fetch_seq_num,
1078			     struct htt_tx_fetch_record *records,
1079			     size_t num_records)
1080{
1081	struct sk_buff *skb;
1082	struct htt_cmd *cmd;
1083	const u16 resp_id = 0;
1084	int len = 0;
1085	int ret;
1086
1087	/* Response IDs are echo-ed back only for host driver convienence
1088	 * purposes. They aren't used for anything in the driver yet so use 0.
1089	 */
1090
1091	len += sizeof(cmd->hdr);
1092	len += sizeof(cmd->tx_fetch_resp);
1093	len += sizeof(cmd->tx_fetch_resp.records[0]) * num_records;
1094
1095	skb = ath10k_htc_alloc_skb(ar, len);
1096	if (!skb)
1097		return -ENOMEM;
1098
1099	skb_put(skb, len);
1100	cmd = (struct htt_cmd *)skb->data;
1101	cmd->hdr.msg_type = HTT_H2T_MSG_TYPE_TX_FETCH_RESP;
1102	cmd->tx_fetch_resp.resp_id = cpu_to_le16(resp_id);
1103	cmd->tx_fetch_resp.fetch_seq_num = fetch_seq_num;
1104	cmd->tx_fetch_resp.num_records = cpu_to_le16(num_records);
1105	cmd->tx_fetch_resp.token = token;
1106
1107	memcpy(cmd->tx_fetch_resp.records, records,
1108	       sizeof(records[0]) * num_records);
1109
1110	ret = ath10k_htc_send(&ar->htc, ar->htt.eid, skb);
1111	if (ret) {
1112		ath10k_warn(ar, "failed to submit htc command: %d\n", ret);
1113		goto err_free_skb;
1114	}
1115
1116	return 0;
1117
1118err_free_skb:
1119	dev_kfree_skb_any(skb);
1120
1121	return ret;
1122}
1123
1124static u8 ath10k_htt_tx_get_vdev_id(struct ath10k *ar, struct sk_buff *skb)
1125{
1126	struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
1127	struct ath10k_skb_cb *cb = ATH10K_SKB_CB(skb);
1128	struct ath10k_vif *arvif;
1129
1130	if (info->flags & IEEE80211_TX_CTL_TX_OFFCHAN) {
1131		return ar->scan.vdev_id;
1132	} else if (cb->vif) {
1133		arvif = (void *)cb->vif->drv_priv;
1134		return arvif->vdev_id;
1135	} else if (ar->monitor_started) {
1136		return ar->monitor_vdev_id;
1137	} else {
1138		return 0;
1139	}
1140}
1141
1142static u8 ath10k_htt_tx_get_tid(struct sk_buff *skb, bool is_eth)
1143{
1144	struct ieee80211_hdr *hdr = (void *)skb->data;
1145	struct ath10k_skb_cb *cb = ATH10K_SKB_CB(skb);
1146
1147	if (!is_eth && ieee80211_is_mgmt(hdr->frame_control))
1148		return HTT_DATA_TX_EXT_TID_MGMT;
1149	else if (cb->flags & ATH10K_SKB_F_QOS)
1150		return skb->priority & IEEE80211_QOS_CTL_TID_MASK;
1151	else
1152		return HTT_DATA_TX_EXT_TID_NON_QOS_MCAST_BCAST;
1153}
1154
1155int ath10k_htt_mgmt_tx(struct ath10k_htt *htt, struct sk_buff *msdu)
1156{
1157	struct ath10k *ar = htt->ar;
1158	struct device *dev = ar->dev;
1159	struct sk_buff *txdesc = NULL;
1160	struct htt_cmd *cmd;
1161	struct ath10k_skb_cb *skb_cb = ATH10K_SKB_CB(msdu);
1162	u8 vdev_id = ath10k_htt_tx_get_vdev_id(ar, msdu);
1163	int len = 0;
1164	int msdu_id = -1;
1165	int res;
 
1166	struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)msdu->data;
1167
1168	len += sizeof(cmd->hdr);
1169	len += sizeof(cmd->mgmt_tx);
1170
1171	res = ath10k_htt_tx_alloc_msdu_id(htt, msdu);
1172	if (res < 0)
1173		goto err;
1174
1175	msdu_id = res;
1176
1177	if ((ieee80211_is_action(hdr->frame_control) ||
1178	     ieee80211_is_deauth(hdr->frame_control) ||
1179	     ieee80211_is_disassoc(hdr->frame_control)) &&
1180	     ieee80211_has_protected(hdr->frame_control)) {
1181		skb_put(msdu, IEEE80211_CCMP_MIC_LEN);
 
 
 
 
 
 
 
 
 
1182	}
1183
1184	txdesc = ath10k_htc_alloc_skb(ar, len);
1185	if (!txdesc) {
1186		res = -ENOMEM;
1187		goto err_free_msdu_id;
1188	}
1189
1190	skb_cb->paddr = dma_map_single(dev, msdu->data, msdu->len,
1191				       DMA_TO_DEVICE);
1192	res = dma_mapping_error(dev, skb_cb->paddr);
1193	if (res) {
1194		res = -EIO;
1195		goto err_free_txdesc;
1196	}
1197
1198	skb_put(txdesc, len);
1199	cmd = (struct htt_cmd *)txdesc->data;
1200	memset(cmd, 0, len);
1201
1202	cmd->hdr.msg_type         = HTT_H2T_MSG_TYPE_MGMT_TX;
1203	cmd->mgmt_tx.msdu_paddr = __cpu_to_le32(ATH10K_SKB_CB(msdu)->paddr);
1204	cmd->mgmt_tx.len        = __cpu_to_le32(msdu->len);
1205	cmd->mgmt_tx.desc_id    = __cpu_to_le32(msdu_id);
1206	cmd->mgmt_tx.vdev_id    = __cpu_to_le32(vdev_id);
1207	memcpy(cmd->mgmt_tx.hdr, msdu->data,
1208	       min_t(int, msdu->len, HTT_MGMT_FRM_HDR_DOWNLOAD_LEN));
1209
1210	res = ath10k_htc_send(&htt->ar->htc, htt->eid, txdesc);
1211	if (res)
1212		goto err_unmap_msdu;
1213
1214	return 0;
1215
1216err_unmap_msdu:
1217	if (ar->bus_param.dev_type != ATH10K_DEV_TYPE_HL)
1218		dma_unmap_single(dev, skb_cb->paddr, msdu->len, DMA_TO_DEVICE);
1219err_free_txdesc:
1220	dev_kfree_skb_any(txdesc);
1221err_free_msdu_id:
1222	spin_lock_bh(&htt->tx_lock);
1223	ath10k_htt_tx_free_msdu_id(htt, msdu_id);
1224	spin_unlock_bh(&htt->tx_lock);
1225err:
1226	return res;
1227}
1228
1229#define HTT_TX_HL_NEEDED_HEADROOM \
1230	(unsigned int)(sizeof(struct htt_cmd_hdr) + \
1231	sizeof(struct htt_data_tx_desc) + \
1232	sizeof(struct ath10k_htc_hdr))
1233
1234static int ath10k_htt_tx_hl(struct ath10k_htt *htt, enum ath10k_hw_txrx_mode txmode,
1235			    struct sk_buff *msdu)
1236{
1237	struct ath10k *ar = htt->ar;
1238	int res, data_len;
1239	struct htt_cmd_hdr *cmd_hdr;
1240	struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)msdu->data;
1241	struct htt_data_tx_desc *tx_desc;
1242	struct ath10k_skb_cb *skb_cb = ATH10K_SKB_CB(msdu);
1243	struct sk_buff *tmp_skb;
1244	bool is_eth = (txmode == ATH10K_HW_TXRX_ETHERNET);
1245	u8 vdev_id = ath10k_htt_tx_get_vdev_id(ar, msdu);
1246	u8 tid = ath10k_htt_tx_get_tid(msdu, is_eth);
1247	u8 flags0 = 0;
1248	u16 flags1 = 0;
1249	u16 msdu_id = 0;
1250
1251	if ((ieee80211_is_action(hdr->frame_control) ||
1252	     ieee80211_is_deauth(hdr->frame_control) ||
1253	     ieee80211_is_disassoc(hdr->frame_control)) &&
1254	     ieee80211_has_protected(hdr->frame_control)) {
1255		skb_put(msdu, IEEE80211_CCMP_MIC_LEN);
 
 
 
 
1256	}
1257
1258	data_len = msdu->len;
1259
1260	switch (txmode) {
1261	case ATH10K_HW_TXRX_RAW:
1262	case ATH10K_HW_TXRX_NATIVE_WIFI:
1263		flags0 |= HTT_DATA_TX_DESC_FLAGS0_MAC_HDR_PRESENT;
1264		/* fall through */
1265	case ATH10K_HW_TXRX_ETHERNET:
1266		flags0 |= SM(txmode, HTT_DATA_TX_DESC_FLAGS0_PKT_TYPE);
1267		break;
1268	case ATH10K_HW_TXRX_MGMT:
1269		flags0 |= SM(ATH10K_HW_TXRX_MGMT,
1270			     HTT_DATA_TX_DESC_FLAGS0_PKT_TYPE);
1271		flags0 |= HTT_DATA_TX_DESC_FLAGS0_MAC_HDR_PRESENT;
 
 
 
1272		break;
1273	}
1274
1275	if (skb_cb->flags & ATH10K_SKB_F_NO_HWCRYPT)
1276		flags0 |= HTT_DATA_TX_DESC_FLAGS0_NO_ENCRYPT;
1277
1278	flags1 |= SM((u16)vdev_id, HTT_DATA_TX_DESC_FLAGS1_VDEV_ID);
1279	flags1 |= SM((u16)tid, HTT_DATA_TX_DESC_FLAGS1_EXT_TID);
1280	if (msdu->ip_summed == CHECKSUM_PARTIAL &&
1281	    !test_bit(ATH10K_FLAG_RAW_MODE, &ar->dev_flags)) {
1282		flags1 |= HTT_DATA_TX_DESC_FLAGS1_CKSUM_L3_OFFLOAD;
1283		flags1 |= HTT_DATA_TX_DESC_FLAGS1_CKSUM_L4_OFFLOAD;
1284	}
1285
1286	/* Prepend the HTT header and TX desc struct to the data message
1287	 * and realloc the skb if it does not have enough headroom.
1288	 */
1289	if (skb_headroom(msdu) < HTT_TX_HL_NEEDED_HEADROOM) {
1290		tmp_skb = msdu;
1291
1292		ath10k_dbg(htt->ar, ATH10K_DBG_HTT,
1293			   "Not enough headroom in skb. Current headroom: %u, needed: %u. Reallocating...\n",
1294			   skb_headroom(msdu), HTT_TX_HL_NEEDED_HEADROOM);
1295		msdu = skb_realloc_headroom(msdu, HTT_TX_HL_NEEDED_HEADROOM);
1296		kfree_skb(tmp_skb);
1297		if (!msdu) {
1298			ath10k_warn(htt->ar, "htt hl tx: Unable to realloc skb!\n");
1299			res = -ENOMEM;
1300			goto out;
1301		}
1302	}
1303
1304	if (ar->bus_param.hl_msdu_ids) {
1305		flags1 |= HTT_DATA_TX_DESC_FLAGS1_POSTPONED;
1306		res = ath10k_htt_tx_alloc_msdu_id(htt, msdu);
1307		if (res < 0) {
1308			ath10k_err(ar, "msdu_id allocation failed %d\n", res);
1309			goto out;
1310		}
1311		msdu_id = res;
1312	}
1313
1314	/* As msdu is freed by mac80211 (in ieee80211_tx_status()) and by
1315	 * ath10k (in ath10k_htt_htc_tx_complete()) we have to increase
1316	 * reference by one to avoid a use-after-free case and a double
1317	 * free.
1318	 */
1319	skb_get(msdu);
1320
1321	skb_push(msdu, sizeof(*cmd_hdr));
1322	skb_push(msdu, sizeof(*tx_desc));
1323	cmd_hdr = (struct htt_cmd_hdr *)msdu->data;
1324	tx_desc = (struct htt_data_tx_desc *)(msdu->data + sizeof(*cmd_hdr));
1325
1326	cmd_hdr->msg_type = HTT_H2T_MSG_TYPE_TX_FRM;
1327	tx_desc->flags0 = flags0;
1328	tx_desc->flags1 = __cpu_to_le16(flags1);
1329	tx_desc->len = __cpu_to_le16(data_len);
1330	tx_desc->id = __cpu_to_le16(msdu_id);
1331	tx_desc->frags_paddr = 0; /* always zero */
1332	/* Initialize peer_id to INVALID_PEER because this is NOT
1333	 * Reinjection path
1334	 */
1335	tx_desc->peerid = __cpu_to_le32(HTT_INVALID_PEERID);
1336
1337	res = ath10k_htc_send(&htt->ar->htc, htt->eid, msdu);
1338
1339out:
1340	return res;
1341}
1342
1343static int ath10k_htt_tx_32(struct ath10k_htt *htt,
1344			    enum ath10k_hw_txrx_mode txmode,
1345			    struct sk_buff *msdu)
1346{
1347	struct ath10k *ar = htt->ar;
1348	struct device *dev = ar->dev;
1349	struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)msdu->data;
1350	struct ieee80211_tx_info *info = IEEE80211_SKB_CB(msdu);
1351	struct ath10k_skb_cb *skb_cb = ATH10K_SKB_CB(msdu);
1352	struct ath10k_hif_sg_item sg_items[2];
1353	struct ath10k_htt_txbuf_32 *txbuf;
1354	struct htt_data_tx_desc_frag *frags;
1355	bool is_eth = (txmode == ATH10K_HW_TXRX_ETHERNET);
1356	u8 vdev_id = ath10k_htt_tx_get_vdev_id(ar, msdu);
1357	u8 tid = ath10k_htt_tx_get_tid(msdu, is_eth);
1358	int prefetch_len;
1359	int res;
1360	u8 flags0 = 0;
1361	u16 msdu_id, flags1 = 0;
1362	u16 freq = 0;
1363	u32 frags_paddr = 0;
1364	u32 txbuf_paddr;
1365	struct htt_msdu_ext_desc *ext_desc = NULL;
1366	struct htt_msdu_ext_desc *ext_desc_t = NULL;
1367
1368	res = ath10k_htt_tx_alloc_msdu_id(htt, msdu);
1369	if (res < 0)
1370		goto err;
1371
1372	msdu_id = res;
1373
1374	prefetch_len = min(htt->prefetch_len, msdu->len);
1375	prefetch_len = roundup(prefetch_len, 4);
1376
1377	txbuf = htt->txbuf.vaddr_txbuff_32 + msdu_id;
1378	txbuf_paddr = htt->txbuf.paddr +
1379		      (sizeof(struct ath10k_htt_txbuf_32) * msdu_id);
1380
1381	if ((ieee80211_is_action(hdr->frame_control) ||
1382	     ieee80211_is_deauth(hdr->frame_control) ||
1383	     ieee80211_is_disassoc(hdr->frame_control)) &&
1384	     ieee80211_has_protected(hdr->frame_control)) {
1385		skb_put(msdu, IEEE80211_CCMP_MIC_LEN);
1386	} else if (!(skb_cb->flags & ATH10K_SKB_F_NO_HWCRYPT) &&
1387		   txmode == ATH10K_HW_TXRX_RAW &&
1388		   ieee80211_has_protected(hdr->frame_control)) {
1389		skb_put(msdu, IEEE80211_CCMP_MIC_LEN);
 
 
 
 
1390	}
1391
1392	skb_cb->paddr = dma_map_single(dev, msdu->data, msdu->len,
1393				       DMA_TO_DEVICE);
1394	res = dma_mapping_error(dev, skb_cb->paddr);
1395	if (res) {
1396		res = -EIO;
1397		goto err_free_msdu_id;
1398	}
1399
1400	if (unlikely(info->flags & IEEE80211_TX_CTL_TX_OFFCHAN))
1401		freq = ar->scan.roc_freq;
1402
1403	switch (txmode) {
1404	case ATH10K_HW_TXRX_RAW:
1405	case ATH10K_HW_TXRX_NATIVE_WIFI:
1406		flags0 |= HTT_DATA_TX_DESC_FLAGS0_MAC_HDR_PRESENT;
1407		/* fall through */
1408	case ATH10K_HW_TXRX_ETHERNET:
1409		if (ar->hw_params.continuous_frag_desc) {
1410			ext_desc_t = htt->frag_desc.vaddr_desc_32;
1411			memset(&ext_desc_t[msdu_id], 0,
1412			       sizeof(struct htt_msdu_ext_desc));
1413			frags = (struct htt_data_tx_desc_frag *)
1414				&ext_desc_t[msdu_id].frags;
1415			ext_desc = &ext_desc_t[msdu_id];
1416			frags[0].tword_addr.paddr_lo =
1417				__cpu_to_le32(skb_cb->paddr);
1418			frags[0].tword_addr.paddr_hi = 0;
1419			frags[0].tword_addr.len_16 = __cpu_to_le16(msdu->len);
1420
1421			frags_paddr =  htt->frag_desc.paddr +
1422				(sizeof(struct htt_msdu_ext_desc) * msdu_id);
1423		} else {
1424			frags = txbuf->frags;
1425			frags[0].dword_addr.paddr =
1426				__cpu_to_le32(skb_cb->paddr);
1427			frags[0].dword_addr.len = __cpu_to_le32(msdu->len);
1428			frags[1].dword_addr.paddr = 0;
1429			frags[1].dword_addr.len = 0;
1430
1431			frags_paddr = txbuf_paddr;
1432		}
1433		flags0 |= SM(txmode, HTT_DATA_TX_DESC_FLAGS0_PKT_TYPE);
1434		break;
1435	case ATH10K_HW_TXRX_MGMT:
1436		flags0 |= SM(ATH10K_HW_TXRX_MGMT,
1437			     HTT_DATA_TX_DESC_FLAGS0_PKT_TYPE);
1438		flags0 |= HTT_DATA_TX_DESC_FLAGS0_MAC_HDR_PRESENT;
1439
1440		frags_paddr = skb_cb->paddr;
1441		break;
1442	}
1443
1444	/* Normally all commands go through HTC which manages tx credits for
1445	 * each endpoint and notifies when tx is completed.
1446	 *
1447	 * HTT endpoint is creditless so there's no need to care about HTC
1448	 * flags. In that case it is trivial to fill the HTC header here.
1449	 *
1450	 * MSDU transmission is considered completed upon HTT event. This
1451	 * implies no relevant resources can be freed until after the event is
1452	 * received. That's why HTC tx completion handler itself is ignored by
1453	 * setting NULL to transfer_context for all sg items.
1454	 *
1455	 * There is simply no point in pushing HTT TX_FRM through HTC tx path
1456	 * as it's a waste of resources. By bypassing HTC it is possible to
1457	 * avoid extra memory allocations, compress data structures and thus
1458	 * improve performance.
1459	 */
1460
1461	txbuf->htc_hdr.eid = htt->eid;
1462	txbuf->htc_hdr.len = __cpu_to_le16(sizeof(txbuf->cmd_hdr) +
1463					   sizeof(txbuf->cmd_tx) +
1464					   prefetch_len);
1465	txbuf->htc_hdr.flags = 0;
1466
1467	if (skb_cb->flags & ATH10K_SKB_F_NO_HWCRYPT)
1468		flags0 |= HTT_DATA_TX_DESC_FLAGS0_NO_ENCRYPT;
1469
1470	flags1 |= SM((u16)vdev_id, HTT_DATA_TX_DESC_FLAGS1_VDEV_ID);
1471	flags1 |= SM((u16)tid, HTT_DATA_TX_DESC_FLAGS1_EXT_TID);
1472	if (msdu->ip_summed == CHECKSUM_PARTIAL &&
1473	    !test_bit(ATH10K_FLAG_RAW_MODE, &ar->dev_flags)) {
1474		flags1 |= HTT_DATA_TX_DESC_FLAGS1_CKSUM_L3_OFFLOAD;
1475		flags1 |= HTT_DATA_TX_DESC_FLAGS1_CKSUM_L4_OFFLOAD;
1476		if (ar->hw_params.continuous_frag_desc)
1477			ext_desc->flags |= HTT_MSDU_CHECKSUM_ENABLE;
1478	}
1479
1480	/* Prevent firmware from sending up tx inspection requests. There's
1481	 * nothing ath10k can do with frames requested for inspection so force
1482	 * it to simply rely a regular tx completion with discard status.
1483	 */
1484	flags1 |= HTT_DATA_TX_DESC_FLAGS1_POSTPONED;
1485
1486	txbuf->cmd_hdr.msg_type = HTT_H2T_MSG_TYPE_TX_FRM;
1487	txbuf->cmd_tx.flags0 = flags0;
1488	txbuf->cmd_tx.flags1 = __cpu_to_le16(flags1);
1489	txbuf->cmd_tx.len = __cpu_to_le16(msdu->len);
1490	txbuf->cmd_tx.id = __cpu_to_le16(msdu_id);
1491	txbuf->cmd_tx.frags_paddr = __cpu_to_le32(frags_paddr);
1492	if (ath10k_mac_tx_frm_has_freq(ar)) {
1493		txbuf->cmd_tx.offchan_tx.peerid =
1494				__cpu_to_le16(HTT_INVALID_PEERID);
1495		txbuf->cmd_tx.offchan_tx.freq =
1496				__cpu_to_le16(freq);
1497	} else {
1498		txbuf->cmd_tx.peerid =
1499				__cpu_to_le32(HTT_INVALID_PEERID);
1500	}
1501
1502	trace_ath10k_htt_tx(ar, msdu_id, msdu->len, vdev_id, tid);
1503	ath10k_dbg(ar, ATH10K_DBG_HTT,
1504		   "htt tx flags0 %hhu flags1 %hu len %d id %hu frags_paddr %pad, msdu_paddr %pad vdev %hhu tid %hhu freq %hu\n",
1505		   flags0, flags1, msdu->len, msdu_id, &frags_paddr,
1506		   &skb_cb->paddr, vdev_id, tid, freq);
1507	ath10k_dbg_dump(ar, ATH10K_DBG_HTT_DUMP, NULL, "htt tx msdu: ",
1508			msdu->data, msdu->len);
1509	trace_ath10k_tx_hdr(ar, msdu->data, msdu->len);
1510	trace_ath10k_tx_payload(ar, msdu->data, msdu->len);
1511
1512	sg_items[0].transfer_id = 0;
1513	sg_items[0].transfer_context = NULL;
1514	sg_items[0].vaddr = &txbuf->htc_hdr;
1515	sg_items[0].paddr = txbuf_paddr +
1516			    sizeof(txbuf->frags);
1517	sg_items[0].len = sizeof(txbuf->htc_hdr) +
1518			  sizeof(txbuf->cmd_hdr) +
1519			  sizeof(txbuf->cmd_tx);
1520
1521	sg_items[1].transfer_id = 0;
1522	sg_items[1].transfer_context = NULL;
1523	sg_items[1].vaddr = msdu->data;
1524	sg_items[1].paddr = skb_cb->paddr;
1525	sg_items[1].len = prefetch_len;
1526
1527	res = ath10k_hif_tx_sg(htt->ar,
1528			       htt->ar->htc.endpoint[htt->eid].ul_pipe_id,
1529			       sg_items, ARRAY_SIZE(sg_items));
1530	if (res)
1531		goto err_unmap_msdu;
1532
1533	return 0;
1534
1535err_unmap_msdu:
1536	dma_unmap_single(dev, skb_cb->paddr, msdu->len, DMA_TO_DEVICE);
1537err_free_msdu_id:
 
1538	ath10k_htt_tx_free_msdu_id(htt, msdu_id);
 
1539err:
1540	return res;
1541}
1542
1543static int ath10k_htt_tx_64(struct ath10k_htt *htt,
1544			    enum ath10k_hw_txrx_mode txmode,
1545			    struct sk_buff *msdu)
1546{
1547	struct ath10k *ar = htt->ar;
1548	struct device *dev = ar->dev;
1549	struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)msdu->data;
1550	struct ieee80211_tx_info *info = IEEE80211_SKB_CB(msdu);
1551	struct ath10k_skb_cb *skb_cb = ATH10K_SKB_CB(msdu);
1552	struct ath10k_hif_sg_item sg_items[2];
1553	struct ath10k_htt_txbuf_64 *txbuf;
1554	struct htt_data_tx_desc_frag *frags;
1555	bool is_eth = (txmode == ATH10K_HW_TXRX_ETHERNET);
1556	u8 vdev_id = ath10k_htt_tx_get_vdev_id(ar, msdu);
1557	u8 tid = ath10k_htt_tx_get_tid(msdu, is_eth);
1558	int prefetch_len;
1559	int res;
1560	u8 flags0 = 0;
1561	u16 msdu_id, flags1 = 0;
1562	u16 freq = 0;
1563	dma_addr_t frags_paddr = 0;
1564	dma_addr_t txbuf_paddr;
1565	struct htt_msdu_ext_desc_64 *ext_desc = NULL;
1566	struct htt_msdu_ext_desc_64 *ext_desc_t = NULL;
1567
1568	res = ath10k_htt_tx_alloc_msdu_id(htt, msdu);
1569	if (res < 0)
1570		goto err;
1571
1572	msdu_id = res;
1573
1574	prefetch_len = min(htt->prefetch_len, msdu->len);
1575	prefetch_len = roundup(prefetch_len, 4);
1576
1577	txbuf = htt->txbuf.vaddr_txbuff_64 + msdu_id;
1578	txbuf_paddr = htt->txbuf.paddr +
1579		      (sizeof(struct ath10k_htt_txbuf_64) * msdu_id);
1580
1581	if ((ieee80211_is_action(hdr->frame_control) ||
1582	     ieee80211_is_deauth(hdr->frame_control) ||
1583	     ieee80211_is_disassoc(hdr->frame_control)) &&
1584	     ieee80211_has_protected(hdr->frame_control)) {
1585		skb_put(msdu, IEEE80211_CCMP_MIC_LEN);
1586	} else if (!(skb_cb->flags & ATH10K_SKB_F_NO_HWCRYPT) &&
1587		   txmode == ATH10K_HW_TXRX_RAW &&
1588		   ieee80211_has_protected(hdr->frame_control)) {
1589		skb_put(msdu, IEEE80211_CCMP_MIC_LEN);
 
 
 
 
1590	}
1591
1592	skb_cb->paddr = dma_map_single(dev, msdu->data, msdu->len,
1593				       DMA_TO_DEVICE);
1594	res = dma_mapping_error(dev, skb_cb->paddr);
1595	if (res) {
1596		res = -EIO;
1597		goto err_free_msdu_id;
1598	}
1599
1600	if (unlikely(info->flags & IEEE80211_TX_CTL_TX_OFFCHAN))
1601		freq = ar->scan.roc_freq;
1602
1603	switch (txmode) {
1604	case ATH10K_HW_TXRX_RAW:
1605	case ATH10K_HW_TXRX_NATIVE_WIFI:
1606		flags0 |= HTT_DATA_TX_DESC_FLAGS0_MAC_HDR_PRESENT;
1607		/* fall through */
1608	case ATH10K_HW_TXRX_ETHERNET:
1609		if (ar->hw_params.continuous_frag_desc) {
1610			ext_desc_t = htt->frag_desc.vaddr_desc_64;
1611			memset(&ext_desc_t[msdu_id], 0,
1612			       sizeof(struct htt_msdu_ext_desc_64));
1613			frags = (struct htt_data_tx_desc_frag *)
1614				&ext_desc_t[msdu_id].frags;
1615			ext_desc = &ext_desc_t[msdu_id];
1616			frags[0].tword_addr.paddr_lo =
1617				__cpu_to_le32(skb_cb->paddr);
1618			frags[0].tword_addr.paddr_hi =
1619				__cpu_to_le16(upper_32_bits(skb_cb->paddr));
1620			frags[0].tword_addr.len_16 = __cpu_to_le16(msdu->len);
1621
1622			frags_paddr =  htt->frag_desc.paddr +
1623			   (sizeof(struct htt_msdu_ext_desc_64) * msdu_id);
1624		} else {
1625			frags = txbuf->frags;
1626			frags[0].tword_addr.paddr_lo =
1627						__cpu_to_le32(skb_cb->paddr);
1628			frags[0].tword_addr.paddr_hi =
1629				__cpu_to_le16(upper_32_bits(skb_cb->paddr));
1630			frags[0].tword_addr.len_16 = __cpu_to_le16(msdu->len);
1631			frags[1].tword_addr.paddr_lo = 0;
1632			frags[1].tword_addr.paddr_hi = 0;
1633			frags[1].tword_addr.len_16 = 0;
1634		}
1635		flags0 |= SM(txmode, HTT_DATA_TX_DESC_FLAGS0_PKT_TYPE);
1636		break;
1637	case ATH10K_HW_TXRX_MGMT:
1638		flags0 |= SM(ATH10K_HW_TXRX_MGMT,
1639			     HTT_DATA_TX_DESC_FLAGS0_PKT_TYPE);
1640		flags0 |= HTT_DATA_TX_DESC_FLAGS0_MAC_HDR_PRESENT;
1641
1642		frags_paddr = skb_cb->paddr;
1643		break;
1644	}
1645
1646	/* Normally all commands go through HTC which manages tx credits for
1647	 * each endpoint and notifies when tx is completed.
1648	 *
1649	 * HTT endpoint is creditless so there's no need to care about HTC
1650	 * flags. In that case it is trivial to fill the HTC header here.
1651	 *
1652	 * MSDU transmission is considered completed upon HTT event. This
1653	 * implies no relevant resources can be freed until after the event is
1654	 * received. That's why HTC tx completion handler itself is ignored by
1655	 * setting NULL to transfer_context for all sg items.
1656	 *
1657	 * There is simply no point in pushing HTT TX_FRM through HTC tx path
1658	 * as it's a waste of resources. By bypassing HTC it is possible to
1659	 * avoid extra memory allocations, compress data structures and thus
1660	 * improve performance.
1661	 */
1662
1663	txbuf->htc_hdr.eid = htt->eid;
1664	txbuf->htc_hdr.len = __cpu_to_le16(sizeof(txbuf->cmd_hdr) +
1665					   sizeof(txbuf->cmd_tx) +
1666					   prefetch_len);
1667	txbuf->htc_hdr.flags = 0;
1668
1669	if (skb_cb->flags & ATH10K_SKB_F_NO_HWCRYPT)
1670		flags0 |= HTT_DATA_TX_DESC_FLAGS0_NO_ENCRYPT;
1671
1672	flags1 |= SM((u16)vdev_id, HTT_DATA_TX_DESC_FLAGS1_VDEV_ID);
1673	flags1 |= SM((u16)tid, HTT_DATA_TX_DESC_FLAGS1_EXT_TID);
1674	if (msdu->ip_summed == CHECKSUM_PARTIAL &&
1675	    !test_bit(ATH10K_FLAG_RAW_MODE, &ar->dev_flags)) {
1676		flags1 |= HTT_DATA_TX_DESC_FLAGS1_CKSUM_L3_OFFLOAD;
1677		flags1 |= HTT_DATA_TX_DESC_FLAGS1_CKSUM_L4_OFFLOAD;
1678		if (ar->hw_params.continuous_frag_desc) {
1679			memset(ext_desc->tso_flag, 0, sizeof(ext_desc->tso_flag));
1680			ext_desc->tso_flag[3] |=
1681				__cpu_to_le32(HTT_MSDU_CHECKSUM_ENABLE_64);
1682		}
1683	}
1684
1685	/* Prevent firmware from sending up tx inspection requests. There's
1686	 * nothing ath10k can do with frames requested for inspection so force
1687	 * it to simply rely a regular tx completion with discard status.
1688	 */
1689	flags1 |= HTT_DATA_TX_DESC_FLAGS1_POSTPONED;
1690
1691	txbuf->cmd_hdr.msg_type = HTT_H2T_MSG_TYPE_TX_FRM;
1692	txbuf->cmd_tx.flags0 = flags0;
1693	txbuf->cmd_tx.flags1 = __cpu_to_le16(flags1);
1694	txbuf->cmd_tx.len = __cpu_to_le16(msdu->len);
1695	txbuf->cmd_tx.id = __cpu_to_le16(msdu_id);
1696
1697	/* fill fragment descriptor */
1698	txbuf->cmd_tx.frags_paddr = __cpu_to_le64(frags_paddr);
1699	if (ath10k_mac_tx_frm_has_freq(ar)) {
1700		txbuf->cmd_tx.offchan_tx.peerid =
1701				__cpu_to_le16(HTT_INVALID_PEERID);
1702		txbuf->cmd_tx.offchan_tx.freq =
1703				__cpu_to_le16(freq);
1704	} else {
1705		txbuf->cmd_tx.peerid =
1706				__cpu_to_le32(HTT_INVALID_PEERID);
1707	}
1708
1709	trace_ath10k_htt_tx(ar, msdu_id, msdu->len, vdev_id, tid);
1710	ath10k_dbg(ar, ATH10K_DBG_HTT,
1711		   "htt tx flags0 %hhu flags1 %hu len %d id %hu frags_paddr %pad, msdu_paddr %pad vdev %hhu tid %hhu freq %hu\n",
1712		   flags0, flags1, msdu->len, msdu_id, &frags_paddr,
1713		   &skb_cb->paddr, vdev_id, tid, freq);
1714	ath10k_dbg_dump(ar, ATH10K_DBG_HTT_DUMP, NULL, "htt tx msdu: ",
1715			msdu->data, msdu->len);
1716	trace_ath10k_tx_hdr(ar, msdu->data, msdu->len);
1717	trace_ath10k_tx_payload(ar, msdu->data, msdu->len);
1718
1719	sg_items[0].transfer_id = 0;
1720	sg_items[0].transfer_context = NULL;
1721	sg_items[0].vaddr = &txbuf->htc_hdr;
1722	sg_items[0].paddr = txbuf_paddr +
1723			    sizeof(txbuf->frags);
1724	sg_items[0].len = sizeof(txbuf->htc_hdr) +
1725			  sizeof(txbuf->cmd_hdr) +
1726			  sizeof(txbuf->cmd_tx);
1727
1728	sg_items[1].transfer_id = 0;
1729	sg_items[1].transfer_context = NULL;
1730	sg_items[1].vaddr = msdu->data;
1731	sg_items[1].paddr = skb_cb->paddr;
1732	sg_items[1].len = prefetch_len;
1733
1734	res = ath10k_hif_tx_sg(htt->ar,
1735			       htt->ar->htc.endpoint[htt->eid].ul_pipe_id,
1736			       sg_items, ARRAY_SIZE(sg_items));
1737	if (res)
1738		goto err_unmap_msdu;
1739
1740	return 0;
1741
1742err_unmap_msdu:
1743	dma_unmap_single(dev, skb_cb->paddr, msdu->len, DMA_TO_DEVICE);
1744err_free_msdu_id:
 
1745	ath10k_htt_tx_free_msdu_id(htt, msdu_id);
 
1746err:
1747	return res;
1748}
1749
1750static const struct ath10k_htt_tx_ops htt_tx_ops_32 = {
1751	.htt_send_rx_ring_cfg = ath10k_htt_send_rx_ring_cfg_32,
1752	.htt_send_frag_desc_bank_cfg = ath10k_htt_send_frag_desc_bank_cfg_32,
1753	.htt_alloc_frag_desc = ath10k_htt_tx_alloc_cont_frag_desc_32,
1754	.htt_free_frag_desc = ath10k_htt_tx_free_cont_frag_desc_32,
1755	.htt_tx = ath10k_htt_tx_32,
1756	.htt_alloc_txbuff = ath10k_htt_tx_alloc_cont_txbuf_32,
1757	.htt_free_txbuff = ath10k_htt_tx_free_cont_txbuf_32,
1758	.htt_h2t_aggr_cfg_msg = ath10k_htt_h2t_aggr_cfg_msg_32,
1759};
1760
1761static const struct ath10k_htt_tx_ops htt_tx_ops_64 = {
1762	.htt_send_rx_ring_cfg = ath10k_htt_send_rx_ring_cfg_64,
1763	.htt_send_frag_desc_bank_cfg = ath10k_htt_send_frag_desc_bank_cfg_64,
1764	.htt_alloc_frag_desc = ath10k_htt_tx_alloc_cont_frag_desc_64,
1765	.htt_free_frag_desc = ath10k_htt_tx_free_cont_frag_desc_64,
1766	.htt_tx = ath10k_htt_tx_64,
1767	.htt_alloc_txbuff = ath10k_htt_tx_alloc_cont_txbuf_64,
1768	.htt_free_txbuff = ath10k_htt_tx_free_cont_txbuf_64,
1769	.htt_h2t_aggr_cfg_msg = ath10k_htt_h2t_aggr_cfg_msg_v2,
1770};
1771
1772static const struct ath10k_htt_tx_ops htt_tx_ops_hl = {
1773	.htt_send_rx_ring_cfg = ath10k_htt_send_rx_ring_cfg_hl,
1774	.htt_send_frag_desc_bank_cfg = ath10k_htt_send_frag_desc_bank_cfg_32,
1775	.htt_tx = ath10k_htt_tx_hl,
1776	.htt_h2t_aggr_cfg_msg = ath10k_htt_h2t_aggr_cfg_msg_32,
 
1777};
1778
1779void ath10k_htt_set_tx_ops(struct ath10k_htt *htt)
1780{
1781	struct ath10k *ar = htt->ar;
1782
1783	if (ar->bus_param.dev_type == ATH10K_DEV_TYPE_HL)
1784		htt->tx_ops = &htt_tx_ops_hl;
1785	else if (ar->hw_params.target_64bit)
1786		htt->tx_ops = &htt_tx_ops_64;
1787	else
1788		htt->tx_ops = &htt_tx_ops_32;
1789}