ath10k: add hif rx methods for wcn3990 (d9151052) · Commits · e / devices / android_kernel_fairphone_FP4

drivers/net/wireless/ath/ath10k/snoc.c

+153 −18

Original line number	Original line	Diff line number	Diff line
	@@ -26,6 +26,7 @@
	#include <linux/platform_device.h>		#include <linux/platform_device.h>
	#define WCN3990_CE_ATTR_FLAGS 0		#define WCN3990_CE_ATTR_FLAGS 0
	#define ATH10K_SNOC_RX_POST_RETRY_MS 50		#define ATH10K_SNOC_RX_POST_RETRY_MS 50
			#define CE_POLL_PIPE 4

	static char *const ce_name[] = {		static char *const ce_name[] = {
	"WLAN_CE_0",		"WLAN_CE_0",
	@@ -44,6 +45,9 @@ static char *const ce_name[] = {

	static void ath10k_snoc_htc_tx_cb(struct ath10k_ce_pipe *ce_state);		static void ath10k_snoc_htc_tx_cb(struct ath10k_ce_pipe *ce_state);
	static void ath10k_snoc_htt_tx_cb(struct ath10k_ce_pipe *ce_state);		static void ath10k_snoc_htt_tx_cb(struct ath10k_ce_pipe *ce_state);
			static void ath10k_snoc_htc_rx_cb(struct ath10k_ce_pipe *ce_state);
			static void ath10k_snoc_htt_rx_cb(struct ath10k_ce_pipe *ce_state);
			static void ath10k_snoc_htt_htc_rx_cb(struct ath10k_ce_pipe *ce_state);

	static const struct ath10k_snoc_drv_priv drv_priv = {		static const struct ath10k_snoc_drv_priv drv_priv = {
	.hw_rev = ATH10K_HW_WCN3990,		.hw_rev = ATH10K_HW_WCN3990,
	@@ -53,7 +57,7 @@ static const struct ath10k_snoc_drv_priv drv_priv = {
	static struct ce_attr host_ce_config_wlan[] = {		static struct ce_attr host_ce_config_wlan[] = {
	/* CE0: host->target HTC control streams */		/* CE0: host->target HTC control streams */
	{		{
	.flags = WCN3990_CE_ATTR_FLAGS,		.flags = CE_ATTR_FLAGS,
	.src_nentries = 16,		.src_nentries = 16,
	.src_sz_max = 2048,		.src_sz_max = 2048,
	.dest_nentries = 0,		.dest_nentries = 0,
	@@ -62,25 +66,25 @@ static struct ce_attr host_ce_config_wlan[] = {

	/* CE1: target->host HTT + HTC control */		/* CE1: target->host HTT + HTC control */
	{		{
	.flags = WCN3990_CE_ATTR_FLAGS,		.flags = CE_ATTR_FLAGS,
	.src_nentries = 0,		.src_nentries = 0,
	.src_sz_max = 2048,		.src_sz_max = 2048,
	.dest_nentries = 512,		.dest_nentries = 512,
	.recv_cb = NULL,		.recv_cb = ath10k_snoc_htt_htc_rx_cb,
	},		},

	/* CE2: target->host WMI */		/* CE2: target->host WMI */
	{		{
	.flags = WCN3990_CE_ATTR_FLAGS,		.flags = CE_ATTR_FLAGS,
	.src_nentries = 0,		.src_nentries = 0,
	.src_sz_max = 2048,		.src_sz_max = 2048,
	.dest_nentries = 64,		.dest_nentries = 64,
	.recv_cb = NULL,		.recv_cb = ath10k_snoc_htc_rx_cb,
	},		},

	/* CE3: host->target WMI */		/* CE3: host->target WMI */
	{		{
	.flags = WCN3990_CE_ATTR_FLAGS,		.flags = CE_ATTR_FLAGS,
	.src_nentries = 32,		.src_nentries = 32,
	.src_sz_max = 2048,		.src_sz_max = 2048,
	.dest_nentries = 0,		.dest_nentries = 0,
	@@ -89,7 +93,7 @@ static struct ce_attr host_ce_config_wlan[] = {

	/* CE4: host->target HTT */		/* CE4: host->target HTT */
	{		{
	.flags = WCN3990_CE_ATTR_FLAGS \| CE_ATTR_DIS_INTR,		.flags = CE_ATTR_FLAGS \| CE_ATTR_DIS_INTR,
	.src_nentries = 256,		.src_nentries = 256,
	.src_sz_max = 256,		.src_sz_max = 256,
	.dest_nentries = 0,		.dest_nentries = 0,
	@@ -98,16 +102,16 @@ static struct ce_attr host_ce_config_wlan[] = {

	/* CE5: target->host HTT (ipa_uc->target ) */		/* CE5: target->host HTT (ipa_uc->target ) */
	{		{
	.flags = WCN3990_CE_ATTR_FLAGS,		.flags = CE_ATTR_FLAGS,
	.src_nentries = 0,		.src_nentries = 0,
	.src_sz_max = 512,		.src_sz_max = 512,
	.dest_nentries = 512,		.dest_nentries = 512,
	.recv_cb = NULL,		.recv_cb = ath10k_snoc_htt_rx_cb,
	},		},

	/* CE6: target autonomous hif_memcpy */		/* CE6: target autonomous hif_memcpy */
	{		{
	.flags = WCN3990_CE_ATTR_FLAGS,		.flags = CE_ATTR_FLAGS,
	.src_nentries = 0,		.src_nentries = 0,
	.src_sz_max = 0,		.src_sz_max = 0,
	.dest_nentries = 0,		.dest_nentries = 0,
	@@ -115,7 +119,7 @@ static struct ce_attr host_ce_config_wlan[] = {

	/* CE7: ce_diag, the Diagnostic Window */		/* CE7: ce_diag, the Diagnostic Window */
	{		{
	.flags = WCN3990_CE_ATTR_FLAGS,		.flags = CE_ATTR_FLAGS,
	.src_nentries = 2,		.src_nentries = 2,
	.src_sz_max = 2048,		.src_sz_max = 2048,
	.dest_nentries = 2,		.dest_nentries = 2,
	@@ -123,7 +127,7 @@ static struct ce_attr host_ce_config_wlan[] = {

	/* CE8: Target to uMC */		/* CE8: Target to uMC */
	{		{
	.flags = WCN3990_CE_ATTR_FLAGS,		.flags = CE_ATTR_FLAGS,
	.src_nentries = 0,		.src_nentries = 0,
	.src_sz_max = 2048,		.src_sz_max = 2048,
	.dest_nentries = 128,		.dest_nentries = 128,
	@@ -131,29 +135,29 @@ static struct ce_attr host_ce_config_wlan[] = {

	/* CE9 target->host HTT */		/* CE9 target->host HTT */
	{		{
	.flags = WCN3990_CE_ATTR_FLAGS,		.flags = CE_ATTR_FLAGS,
	.src_nentries = 0,		.src_nentries = 0,
	.src_sz_max = 2048,		.src_sz_max = 2048,
	.dest_nentries = 512,		.dest_nentries = 512,
	.recv_cb = NULL,		.recv_cb = ath10k_snoc_htt_htc_rx_cb,
	},		},

	/* CE10: target->host HTT */		/* CE10: target->host HTT */
	{		{
	.flags = WCN3990_CE_ATTR_FLAGS,		.flags = CE_ATTR_FLAGS,
	.src_nentries = 0,		.src_nentries = 0,
	.src_sz_max = 2048,		.src_sz_max = 2048,
	.dest_nentries = 512,		.dest_nentries = 512,
	.recv_cb = NULL,		.recv_cb = ath10k_snoc_htt_htc_rx_cb,
	},		},

	/* CE11: target -> host PKTLOG */		/* CE11: target -> host PKTLOG */
	{		{
	.flags = WCN3990_CE_ATTR_FLAGS,		.flags = CE_ATTR_FLAGS,
	.src_nentries = 0,		.src_nentries = 0,
	.src_sz_max = 2048,		.src_sz_max = 2048,
	.dest_nentries = 512,		.dest_nentries = 512,
	.recv_cb = NULL,		.recv_cb = ath10k_snoc_htt_htc_rx_cb,
	},		},
	};		};

	@@ -362,6 +366,82 @@ static void ath10k_snoc_rx_post(struct ath10k *ar)
	ath10k_snoc_rx_post_pipe(&ar_snoc->pipe_info[i]);		ath10k_snoc_rx_post_pipe(&ar_snoc->pipe_info[i]);
	}		}

			static void ath10k_snoc_process_rx_cb(struct ath10k_ce_pipe *ce_state,
			void (callback)(struct ath10k ar,
			struct sk_buff *skb))
			{
			struct ath10k *ar = ce_state->ar;
			struct ath10k_snoc *ar_snoc = ath10k_snoc_priv(ar);
			struct ath10k_snoc_pipe *pipe_info = &ar_snoc->pipe_info[ce_state->id];
			struct sk_buff *skb;
			struct sk_buff_head list;
			void *transfer_context;
			unsigned int nbytes, max_nbytes;

			__skb_queue_head_init(&list);
			while (ath10k_ce_completed_recv_next(ce_state, &transfer_context,
			&nbytes) == 0) {
			skb = transfer_context;
			max_nbytes = skb->len + skb_tailroom(skb);
			dma_unmap_single(ar->dev, ATH10K_SKB_RXCB(skb)->paddr,
			max_nbytes, DMA_FROM_DEVICE);

			if (unlikely(max_nbytes < nbytes)) {
			ath10k_warn(ar, "rxed more than expected (nbytes %d, max %d)",
			nbytes, max_nbytes);
			dev_kfree_skb_any(skb);
			continue;
			}

			skb_put(skb, nbytes);
			__skb_queue_tail(&list, skb);
			}

			while ((skb = __skb_dequeue(&list))) {
			ath10k_dbg(ar, ATH10K_DBG_SNOC, "snoc rx ce pipe %d len %d\n",
			ce_state->id, skb->len);

			callback(ar, skb);
			}

			ath10k_snoc_rx_post_pipe(pipe_info);
			}

			static void ath10k_snoc_htc_rx_cb(struct ath10k_ce_pipe *ce_state)
			{
			ath10k_snoc_process_rx_cb(ce_state, ath10k_htc_rx_completion_handler);
			}

			static void ath10k_snoc_htt_htc_rx_cb(struct ath10k_ce_pipe *ce_state)
			{
			/* CE4 polling needs to be done whenever CE pipe which transports
			* HTT Rx (target->host) is processed.
			*/
			ath10k_ce_per_engine_service(ce_state->ar, CE_POLL_PIPE);

			ath10k_snoc_process_rx_cb(ce_state, ath10k_htc_rx_completion_handler);
			}

			static void ath10k_snoc_htt_rx_deliver(struct ath10k ar, struct sk_buff skb)
			{
			skb_pull(skb, sizeof(struct ath10k_htc_hdr));
			ath10k_htt_t2h_msg_handler(ar, skb);
			}

			static void ath10k_snoc_htt_rx_cb(struct ath10k_ce_pipe *ce_state)
			{
			ath10k_ce_per_engine_service(ce_state->ar, CE_POLL_PIPE);
			ath10k_snoc_process_rx_cb(ce_state, ath10k_snoc_htt_rx_deliver);
			}

			static void ath10k_snoc_rx_replenish_retry(struct timer_list *t)
			{
			struct ath10k_pci *ar_snoc = from_timer(ar_snoc, t, rx_post_retry);
			struct ath10k *ar = ar_snoc->ar;

			ath10k_snoc_rx_post(ar);
			}

	static void ath10k_snoc_htc_tx_cb(struct ath10k_ce_pipe *ce_state)		static void ath10k_snoc_htc_tx_cb(struct ath10k_ce_pipe *ce_state)
	{		{
	struct ath10k *ar = ce_state->ar;		struct ath10k *ar = ce_state->ar;
	@@ -620,6 +700,8 @@ static void ath10k_snoc_hif_stop(struct ath10k *ar)
	{		{
	ath10k_snoc_irq_disable(ar);		ath10k_snoc_irq_disable(ar);
	ath10k_snoc_buffer_cleanup(ar);		ath10k_snoc_buffer_cleanup(ar);
			napi_synchronize(&ar->napi);
			napi_disable(&ar->napi);
	ath10k_dbg(ar, ATH10K_DBG_BOOT, "boot hif stop\n");		ath10k_dbg(ar, ATH10K_DBG_BOOT, "boot hif stop\n");
	}		}

	@@ -684,6 +766,7 @@ static int ath10k_snoc_hif_power_up(struct ath10k *ar)
	goto err_wlan_enable;		goto err_wlan_enable;
	}		}

			napi_enable(&ar->napi);
	return 0;		return 0;

	err_wlan_enable:		err_wlan_enable:
	@@ -711,11 +794,60 @@ static const struct ath10k_bus_ops ath10k_snoc_bus_ops = {
	.write32 = ath10k_snoc_write32,		.write32 = ath10k_snoc_write32,
	};		};

			int ath10k_snoc_get_ce_id_from_irq(struct ath10k *ar, int irq)
			{
			struct ath10k_snoc *ar_snoc = ath10k_snoc_priv(ar);
			int i;

			for (i = 0; i < CE_COUNT_MAX; i++) {
			if (ar_snoc->ce_irqs[i].irq_line == irq)
			return i;
			}
			ath10k_err(ar, "No matching CE id for irq %d\n", irq);

			return -EINVAL;
			}

	static irqreturn_t ath10k_snoc_per_engine_handler(int irq, void *arg)		static irqreturn_t ath10k_snoc_per_engine_handler(int irq, void *arg)
	{		{
			struct ath10k *ar = arg;
			struct ath10k_snoc *ar_snoc = ath10k_snoc_priv(ar);
			int ce_id = ath10k_snoc_get_ce_id_from_irq(ar, irq);

			if (ce_id < 0 \|\| ce_id >= ARRAY_SIZE(ar_snoc->pipe_info)) {
			ath10k_warn(ar, "unexpected/invalid irq %d ce_id %d\n", irq,
			ce_id);
	return IRQ_HANDLED;		return IRQ_HANDLED;
	}		}

			ath10k_snoc_irq_disable(ar);
			napi_schedule(&ar->napi);

			return IRQ_HANDLED;
			}

			static int ath10k_snoc_napi_poll(struct napi_struct *ctx, int budget)
			{
			struct ath10k *ar = container_of(ctx, struct ath10k, napi);
			int done = 0;

			ath10k_ce_per_engine_service_any(ar);
			done = ath10k_htt_txrx_compl_task(ar, budget);

			if (done < budget) {
			napi_complete(ctx);
			ath10k_snoc_irq_enable(ar);
			}

			return done;
			}

			void ath10k_snoc_init_napi(struct ath10k *ar)
			{
			netif_napi_add(&ar->napi_dev, &ar->napi, ath10k_snoc_napi_poll,
			ATH10K_NAPI_BUDGET);
			}

	static int ath10k_snoc_request_irq(struct ath10k *ar)		static int ath10k_snoc_request_irq(struct ath10k *ar)
	{		{
	struct ath10k_snoc *ar_snoc = ath10k_snoc_priv(ar);		struct ath10k_snoc *ar_snoc = ath10k_snoc_priv(ar);
	@@ -796,6 +928,7 @@ static int ath10k_snoc_setup_resource(struct ath10k *ar)
	struct ath10k_snoc_pipe *pipe;		struct ath10k_snoc_pipe *pipe;
	int i, ret;		int i, ret;

			timer_setup(&ar_snoc->rx_post_retry, ath10k_snoc_rx_replenish_retry, 0);
	spin_lock_init(&ce->ce_lock);		spin_lock_init(&ce->ce_lock);
	for (i = 0; i < CE_COUNT; i++) {		for (i = 0; i < CE_COUNT; i++) {
	pipe = &ar_snoc->pipe_info[i];		pipe = &ar_snoc->pipe_info[i];
	@@ -812,6 +945,7 @@ static int ath10k_snoc_setup_resource(struct ath10k *ar)

	pipe->buf_sz = host_ce_config_wlan[i].src_sz_max;		pipe->buf_sz = host_ce_config_wlan[i].src_sz_max;
	}		}
			ath10k_snoc_init_napi(ar);

	return 0;		return 0;
	}		}
	@@ -820,6 +954,7 @@ static void ath10k_snoc_release_resource(struct ath10k *ar)
	{		{
	int i;		int i;

			netif_napi_del(&ar->napi);
	for (i = 0; i < CE_COUNT; i++)		for (i = 0; i < CE_COUNT; i++)
	ath10k_ce_free_pipe(ar, i);		ath10k_ce_free_pipe(ar, i);
	}		}