162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0
262306a36Sopenharmony_ci/* Copyright (C) 2012-2019 ARM Limited (or its affiliates). */
362306a36Sopenharmony_ci
462306a36Sopenharmony_ci#include <linux/kernel.h>
562306a36Sopenharmony_ci#include <linux/nospec.h>
662306a36Sopenharmony_ci#include "cc_driver.h"
762306a36Sopenharmony_ci#include "cc_buffer_mgr.h"
862306a36Sopenharmony_ci#include "cc_request_mgr.h"
962306a36Sopenharmony_ci#include "cc_pm.h"
1062306a36Sopenharmony_ci
1162306a36Sopenharmony_ci#define CC_MAX_POLL_ITER	10
1262306a36Sopenharmony_ci/* The highest descriptor count in used */
1362306a36Sopenharmony_ci#define CC_MAX_DESC_SEQ_LEN	23
1462306a36Sopenharmony_ci
1562306a36Sopenharmony_cistruct cc_req_mgr_handle {
1662306a36Sopenharmony_ci	/* Request manager resources */
1762306a36Sopenharmony_ci	unsigned int hw_queue_size; /* HW capability */
1862306a36Sopenharmony_ci	unsigned int min_free_hw_slots;
1962306a36Sopenharmony_ci	unsigned int max_used_sw_slots;
2062306a36Sopenharmony_ci	struct cc_crypto_req req_queue[MAX_REQUEST_QUEUE_SIZE];
2162306a36Sopenharmony_ci	u32 req_queue_head;
2262306a36Sopenharmony_ci	u32 req_queue_tail;
2362306a36Sopenharmony_ci	u32 axi_completed;
2462306a36Sopenharmony_ci	u32 q_free_slots;
2562306a36Sopenharmony_ci	/* This lock protects access to HW register
2662306a36Sopenharmony_ci	 * that must be single request at a time
2762306a36Sopenharmony_ci	 */
2862306a36Sopenharmony_ci	spinlock_t hw_lock;
2962306a36Sopenharmony_ci	struct cc_hw_desc compl_desc;
3062306a36Sopenharmony_ci	u8 *dummy_comp_buff;
3162306a36Sopenharmony_ci	dma_addr_t dummy_comp_buff_dma;
3262306a36Sopenharmony_ci
3362306a36Sopenharmony_ci	/* backlog queue */
3462306a36Sopenharmony_ci	struct list_head backlog;
3562306a36Sopenharmony_ci	unsigned int bl_len;
3662306a36Sopenharmony_ci	spinlock_t bl_lock; /* protect backlog queue */
3762306a36Sopenharmony_ci
3862306a36Sopenharmony_ci#ifdef COMP_IN_WQ
3962306a36Sopenharmony_ci	struct workqueue_struct *workq;
4062306a36Sopenharmony_ci	struct delayed_work compwork;
4162306a36Sopenharmony_ci#else
4262306a36Sopenharmony_ci	struct tasklet_struct comptask;
4362306a36Sopenharmony_ci#endif
4462306a36Sopenharmony_ci};
4562306a36Sopenharmony_ci
4662306a36Sopenharmony_cistruct cc_bl_item {
4762306a36Sopenharmony_ci	struct cc_crypto_req creq;
4862306a36Sopenharmony_ci	struct cc_hw_desc desc[CC_MAX_DESC_SEQ_LEN];
4962306a36Sopenharmony_ci	unsigned int len;
5062306a36Sopenharmony_ci	struct list_head list;
5162306a36Sopenharmony_ci	bool notif;
5262306a36Sopenharmony_ci};
5362306a36Sopenharmony_ci
5462306a36Sopenharmony_cistatic const u32 cc_cpp_int_masks[CC_CPP_NUM_ALGS][CC_CPP_NUM_SLOTS] = {
5562306a36Sopenharmony_ci	{ BIT(CC_HOST_IRR_REE_OP_ABORTED_AES_0_INT_BIT_SHIFT),
5662306a36Sopenharmony_ci	  BIT(CC_HOST_IRR_REE_OP_ABORTED_AES_1_INT_BIT_SHIFT),
5762306a36Sopenharmony_ci	  BIT(CC_HOST_IRR_REE_OP_ABORTED_AES_2_INT_BIT_SHIFT),
5862306a36Sopenharmony_ci	  BIT(CC_HOST_IRR_REE_OP_ABORTED_AES_3_INT_BIT_SHIFT),
5962306a36Sopenharmony_ci	  BIT(CC_HOST_IRR_REE_OP_ABORTED_AES_4_INT_BIT_SHIFT),
6062306a36Sopenharmony_ci	  BIT(CC_HOST_IRR_REE_OP_ABORTED_AES_5_INT_BIT_SHIFT),
6162306a36Sopenharmony_ci	  BIT(CC_HOST_IRR_REE_OP_ABORTED_AES_6_INT_BIT_SHIFT),
6262306a36Sopenharmony_ci	  BIT(CC_HOST_IRR_REE_OP_ABORTED_AES_7_INT_BIT_SHIFT) },
6362306a36Sopenharmony_ci	{ BIT(CC_HOST_IRR_REE_OP_ABORTED_SM_0_INT_BIT_SHIFT),
6462306a36Sopenharmony_ci	  BIT(CC_HOST_IRR_REE_OP_ABORTED_SM_1_INT_BIT_SHIFT),
6562306a36Sopenharmony_ci	  BIT(CC_HOST_IRR_REE_OP_ABORTED_SM_2_INT_BIT_SHIFT),
6662306a36Sopenharmony_ci	  BIT(CC_HOST_IRR_REE_OP_ABORTED_SM_3_INT_BIT_SHIFT),
6762306a36Sopenharmony_ci	  BIT(CC_HOST_IRR_REE_OP_ABORTED_SM_4_INT_BIT_SHIFT),
6862306a36Sopenharmony_ci	  BIT(CC_HOST_IRR_REE_OP_ABORTED_SM_5_INT_BIT_SHIFT),
6962306a36Sopenharmony_ci	  BIT(CC_HOST_IRR_REE_OP_ABORTED_SM_6_INT_BIT_SHIFT),
7062306a36Sopenharmony_ci	  BIT(CC_HOST_IRR_REE_OP_ABORTED_SM_7_INT_BIT_SHIFT) }
7162306a36Sopenharmony_ci};
7262306a36Sopenharmony_ci
7362306a36Sopenharmony_cistatic void comp_handler(unsigned long devarg);
7462306a36Sopenharmony_ci#ifdef COMP_IN_WQ
7562306a36Sopenharmony_cistatic void comp_work_handler(struct work_struct *work);
7662306a36Sopenharmony_ci#endif
7762306a36Sopenharmony_ci
7862306a36Sopenharmony_cistatic inline u32 cc_cpp_int_mask(enum cc_cpp_alg alg, int slot)
7962306a36Sopenharmony_ci{
8062306a36Sopenharmony_ci	alg = array_index_nospec(alg, CC_CPP_NUM_ALGS);
8162306a36Sopenharmony_ci	slot = array_index_nospec(slot, CC_CPP_NUM_SLOTS);
8262306a36Sopenharmony_ci
8362306a36Sopenharmony_ci	return cc_cpp_int_masks[alg][slot];
8462306a36Sopenharmony_ci}
8562306a36Sopenharmony_ci
8662306a36Sopenharmony_civoid cc_req_mgr_fini(struct cc_drvdata *drvdata)
8762306a36Sopenharmony_ci{
8862306a36Sopenharmony_ci	struct cc_req_mgr_handle *req_mgr_h = drvdata->request_mgr_handle;
8962306a36Sopenharmony_ci	struct device *dev = drvdata_to_dev(drvdata);
9062306a36Sopenharmony_ci
9162306a36Sopenharmony_ci	if (!req_mgr_h)
9262306a36Sopenharmony_ci		return; /* Not allocated */
9362306a36Sopenharmony_ci
9462306a36Sopenharmony_ci	if (req_mgr_h->dummy_comp_buff_dma) {
9562306a36Sopenharmony_ci		dma_free_coherent(dev, sizeof(u32), req_mgr_h->dummy_comp_buff,
9662306a36Sopenharmony_ci				  req_mgr_h->dummy_comp_buff_dma);
9762306a36Sopenharmony_ci	}
9862306a36Sopenharmony_ci
9962306a36Sopenharmony_ci	dev_dbg(dev, "max_used_hw_slots=%d\n", (req_mgr_h->hw_queue_size -
10062306a36Sopenharmony_ci						req_mgr_h->min_free_hw_slots));
10162306a36Sopenharmony_ci	dev_dbg(dev, "max_used_sw_slots=%d\n", req_mgr_h->max_used_sw_slots);
10262306a36Sopenharmony_ci
10362306a36Sopenharmony_ci#ifdef COMP_IN_WQ
10462306a36Sopenharmony_ci	destroy_workqueue(req_mgr_h->workq);
10562306a36Sopenharmony_ci#else
10662306a36Sopenharmony_ci	/* Kill tasklet */
10762306a36Sopenharmony_ci	tasklet_kill(&req_mgr_h->comptask);
10862306a36Sopenharmony_ci#endif
10962306a36Sopenharmony_ci	kfree_sensitive(req_mgr_h);
11062306a36Sopenharmony_ci	drvdata->request_mgr_handle = NULL;
11162306a36Sopenharmony_ci}
11262306a36Sopenharmony_ci
11362306a36Sopenharmony_ciint cc_req_mgr_init(struct cc_drvdata *drvdata)
11462306a36Sopenharmony_ci{
11562306a36Sopenharmony_ci	struct cc_req_mgr_handle *req_mgr_h;
11662306a36Sopenharmony_ci	struct device *dev = drvdata_to_dev(drvdata);
11762306a36Sopenharmony_ci	int rc = 0;
11862306a36Sopenharmony_ci
11962306a36Sopenharmony_ci	req_mgr_h = kzalloc(sizeof(*req_mgr_h), GFP_KERNEL);
12062306a36Sopenharmony_ci	if (!req_mgr_h) {
12162306a36Sopenharmony_ci		rc = -ENOMEM;
12262306a36Sopenharmony_ci		goto req_mgr_init_err;
12362306a36Sopenharmony_ci	}
12462306a36Sopenharmony_ci
12562306a36Sopenharmony_ci	drvdata->request_mgr_handle = req_mgr_h;
12662306a36Sopenharmony_ci
12762306a36Sopenharmony_ci	spin_lock_init(&req_mgr_h->hw_lock);
12862306a36Sopenharmony_ci	spin_lock_init(&req_mgr_h->bl_lock);
12962306a36Sopenharmony_ci	INIT_LIST_HEAD(&req_mgr_h->backlog);
13062306a36Sopenharmony_ci
13162306a36Sopenharmony_ci#ifdef COMP_IN_WQ
13262306a36Sopenharmony_ci	dev_dbg(dev, "Initializing completion workqueue\n");
13362306a36Sopenharmony_ci	req_mgr_h->workq = create_singlethread_workqueue("ccree");
13462306a36Sopenharmony_ci	if (!req_mgr_h->workq) {
13562306a36Sopenharmony_ci		dev_err(dev, "Failed creating work queue\n");
13662306a36Sopenharmony_ci		rc = -ENOMEM;
13762306a36Sopenharmony_ci		goto req_mgr_init_err;
13862306a36Sopenharmony_ci	}
13962306a36Sopenharmony_ci	INIT_DELAYED_WORK(&req_mgr_h->compwork, comp_work_handler);
14062306a36Sopenharmony_ci#else
14162306a36Sopenharmony_ci	dev_dbg(dev, "Initializing completion tasklet\n");
14262306a36Sopenharmony_ci	tasklet_init(&req_mgr_h->comptask, comp_handler,
14362306a36Sopenharmony_ci		     (unsigned long)drvdata);
14462306a36Sopenharmony_ci#endif
14562306a36Sopenharmony_ci	req_mgr_h->hw_queue_size = cc_ioread(drvdata,
14662306a36Sopenharmony_ci					     CC_REG(DSCRPTR_QUEUE_SRAM_SIZE));
14762306a36Sopenharmony_ci	dev_dbg(dev, "hw_queue_size=0x%08X\n", req_mgr_h->hw_queue_size);
14862306a36Sopenharmony_ci	if (req_mgr_h->hw_queue_size < MIN_HW_QUEUE_SIZE) {
14962306a36Sopenharmony_ci		dev_err(dev, "Invalid HW queue size = %u (Min. required is %u)\n",
15062306a36Sopenharmony_ci			req_mgr_h->hw_queue_size, MIN_HW_QUEUE_SIZE);
15162306a36Sopenharmony_ci		rc = -ENOMEM;
15262306a36Sopenharmony_ci		goto req_mgr_init_err;
15362306a36Sopenharmony_ci	}
15462306a36Sopenharmony_ci	req_mgr_h->min_free_hw_slots = req_mgr_h->hw_queue_size;
15562306a36Sopenharmony_ci	req_mgr_h->max_used_sw_slots = 0;
15662306a36Sopenharmony_ci
15762306a36Sopenharmony_ci	/* Allocate DMA word for "dummy" completion descriptor use */
15862306a36Sopenharmony_ci	req_mgr_h->dummy_comp_buff =
15962306a36Sopenharmony_ci		dma_alloc_coherent(dev, sizeof(u32),
16062306a36Sopenharmony_ci				   &req_mgr_h->dummy_comp_buff_dma,
16162306a36Sopenharmony_ci				   GFP_KERNEL);
16262306a36Sopenharmony_ci	if (!req_mgr_h->dummy_comp_buff) {
16362306a36Sopenharmony_ci		dev_err(dev, "Not enough memory to allocate DMA (%zu) dropped buffer\n",
16462306a36Sopenharmony_ci			sizeof(u32));
16562306a36Sopenharmony_ci		rc = -ENOMEM;
16662306a36Sopenharmony_ci		goto req_mgr_init_err;
16762306a36Sopenharmony_ci	}
16862306a36Sopenharmony_ci
16962306a36Sopenharmony_ci	/* Init. "dummy" completion descriptor */
17062306a36Sopenharmony_ci	hw_desc_init(&req_mgr_h->compl_desc);
17162306a36Sopenharmony_ci	set_din_const(&req_mgr_h->compl_desc, 0, sizeof(u32));
17262306a36Sopenharmony_ci	set_dout_dlli(&req_mgr_h->compl_desc, req_mgr_h->dummy_comp_buff_dma,
17362306a36Sopenharmony_ci		      sizeof(u32), NS_BIT, 1);
17462306a36Sopenharmony_ci	set_flow_mode(&req_mgr_h->compl_desc, BYPASS);
17562306a36Sopenharmony_ci	set_queue_last_ind(drvdata, &req_mgr_h->compl_desc);
17662306a36Sopenharmony_ci
17762306a36Sopenharmony_ci	return 0;
17862306a36Sopenharmony_ci
17962306a36Sopenharmony_cireq_mgr_init_err:
18062306a36Sopenharmony_ci	cc_req_mgr_fini(drvdata);
18162306a36Sopenharmony_ci	return rc;
18262306a36Sopenharmony_ci}
18362306a36Sopenharmony_ci
18462306a36Sopenharmony_cistatic void enqueue_seq(struct cc_drvdata *drvdata, struct cc_hw_desc seq[],
18562306a36Sopenharmony_ci			unsigned int seq_len)
18662306a36Sopenharmony_ci{
18762306a36Sopenharmony_ci	int i, w;
18862306a36Sopenharmony_ci	void __iomem *reg = drvdata->cc_base + CC_REG(DSCRPTR_QUEUE_WORD0);
18962306a36Sopenharmony_ci	struct device *dev = drvdata_to_dev(drvdata);
19062306a36Sopenharmony_ci
19162306a36Sopenharmony_ci	/*
19262306a36Sopenharmony_ci	 * We do indeed write all 6 command words to the same
19362306a36Sopenharmony_ci	 * register. The HW supports this.
19462306a36Sopenharmony_ci	 */
19562306a36Sopenharmony_ci
19662306a36Sopenharmony_ci	for (i = 0; i < seq_len; i++) {
19762306a36Sopenharmony_ci		for (w = 0; w <= 5; w++)
19862306a36Sopenharmony_ci			writel_relaxed(seq[i].word[w], reg);
19962306a36Sopenharmony_ci
20062306a36Sopenharmony_ci		if (cc_dump_desc)
20162306a36Sopenharmony_ci			dev_dbg(dev, "desc[%02d]: 0x%08X 0x%08X 0x%08X 0x%08X 0x%08X 0x%08X\n",
20262306a36Sopenharmony_ci				i, seq[i].word[0], seq[i].word[1],
20362306a36Sopenharmony_ci				seq[i].word[2], seq[i].word[3],
20462306a36Sopenharmony_ci				seq[i].word[4], seq[i].word[5]);
20562306a36Sopenharmony_ci	}
20662306a36Sopenharmony_ci}
20762306a36Sopenharmony_ci
20862306a36Sopenharmony_ci/**
20962306a36Sopenharmony_ci * request_mgr_complete() - Completion will take place if and only if user
21062306a36Sopenharmony_ci * requested completion by cc_send_sync_request().
21162306a36Sopenharmony_ci *
21262306a36Sopenharmony_ci * @dev: Device pointer
21362306a36Sopenharmony_ci * @dx_compl_h: The completion event to signal
21462306a36Sopenharmony_ci * @dummy: unused error code
21562306a36Sopenharmony_ci */
21662306a36Sopenharmony_cistatic void request_mgr_complete(struct device *dev, void *dx_compl_h,
21762306a36Sopenharmony_ci				 int dummy)
21862306a36Sopenharmony_ci{
21962306a36Sopenharmony_ci	struct completion *this_compl = dx_compl_h;
22062306a36Sopenharmony_ci
22162306a36Sopenharmony_ci	complete(this_compl);
22262306a36Sopenharmony_ci}
22362306a36Sopenharmony_ci
22462306a36Sopenharmony_cistatic int cc_queues_status(struct cc_drvdata *drvdata,
22562306a36Sopenharmony_ci			    struct cc_req_mgr_handle *req_mgr_h,
22662306a36Sopenharmony_ci			    unsigned int total_seq_len)
22762306a36Sopenharmony_ci{
22862306a36Sopenharmony_ci	unsigned long poll_queue;
22962306a36Sopenharmony_ci	struct device *dev = drvdata_to_dev(drvdata);
23062306a36Sopenharmony_ci
23162306a36Sopenharmony_ci	/* SW queue is checked only once as it will not
23262306a36Sopenharmony_ci	 * be changed during the poll because the spinlock_bh
23362306a36Sopenharmony_ci	 * is held by the thread
23462306a36Sopenharmony_ci	 */
23562306a36Sopenharmony_ci	if (((req_mgr_h->req_queue_head + 1) & (MAX_REQUEST_QUEUE_SIZE - 1)) ==
23662306a36Sopenharmony_ci	    req_mgr_h->req_queue_tail) {
23762306a36Sopenharmony_ci		dev_err(dev, "SW FIFO is full. req_queue_head=%d sw_fifo_len=%d\n",
23862306a36Sopenharmony_ci			req_mgr_h->req_queue_head, MAX_REQUEST_QUEUE_SIZE);
23962306a36Sopenharmony_ci		return -ENOSPC;
24062306a36Sopenharmony_ci	}
24162306a36Sopenharmony_ci
24262306a36Sopenharmony_ci	if (req_mgr_h->q_free_slots >= total_seq_len)
24362306a36Sopenharmony_ci		return 0;
24462306a36Sopenharmony_ci
24562306a36Sopenharmony_ci	/* Wait for space in HW queue. Poll constant num of iterations. */
24662306a36Sopenharmony_ci	for (poll_queue = 0; poll_queue < CC_MAX_POLL_ITER ; poll_queue++) {
24762306a36Sopenharmony_ci		req_mgr_h->q_free_slots =
24862306a36Sopenharmony_ci			cc_ioread(drvdata, CC_REG(DSCRPTR_QUEUE_CONTENT));
24962306a36Sopenharmony_ci		if (req_mgr_h->q_free_slots < req_mgr_h->min_free_hw_slots)
25062306a36Sopenharmony_ci			req_mgr_h->min_free_hw_slots = req_mgr_h->q_free_slots;
25162306a36Sopenharmony_ci
25262306a36Sopenharmony_ci		if (req_mgr_h->q_free_slots >= total_seq_len) {
25362306a36Sopenharmony_ci			/* If there is enough place return */
25462306a36Sopenharmony_ci			return 0;
25562306a36Sopenharmony_ci		}
25662306a36Sopenharmony_ci
25762306a36Sopenharmony_ci		dev_dbg(dev, "HW FIFO is full. q_free_slots=%d total_seq_len=%d\n",
25862306a36Sopenharmony_ci			req_mgr_h->q_free_slots, total_seq_len);
25962306a36Sopenharmony_ci	}
26062306a36Sopenharmony_ci	/* No room in the HW queue try again later */
26162306a36Sopenharmony_ci	dev_dbg(dev, "HW FIFO full, timeout. req_queue_head=%d sw_fifo_len=%d q_free_slots=%d total_seq_len=%d\n",
26262306a36Sopenharmony_ci		req_mgr_h->req_queue_head, MAX_REQUEST_QUEUE_SIZE,
26362306a36Sopenharmony_ci		req_mgr_h->q_free_slots, total_seq_len);
26462306a36Sopenharmony_ci	return -ENOSPC;
26562306a36Sopenharmony_ci}
26662306a36Sopenharmony_ci
26762306a36Sopenharmony_ci/**
26862306a36Sopenharmony_ci * cc_do_send_request() - Enqueue caller request to crypto hardware.
26962306a36Sopenharmony_ci * Need to be called with HW lock held and PM running
27062306a36Sopenharmony_ci *
27162306a36Sopenharmony_ci * @drvdata: Associated device driver context
27262306a36Sopenharmony_ci * @cc_req: The request to enqueue
27362306a36Sopenharmony_ci * @desc: The crypto sequence
27462306a36Sopenharmony_ci * @len: The crypto sequence length
27562306a36Sopenharmony_ci * @add_comp: If "true": add an artificial dout DMA to mark completion
27662306a36Sopenharmony_ci *
27762306a36Sopenharmony_ci */
27862306a36Sopenharmony_cistatic void cc_do_send_request(struct cc_drvdata *drvdata,
27962306a36Sopenharmony_ci			       struct cc_crypto_req *cc_req,
28062306a36Sopenharmony_ci			       struct cc_hw_desc *desc, unsigned int len,
28162306a36Sopenharmony_ci			       bool add_comp)
28262306a36Sopenharmony_ci{
28362306a36Sopenharmony_ci	struct cc_req_mgr_handle *req_mgr_h = drvdata->request_mgr_handle;
28462306a36Sopenharmony_ci	unsigned int used_sw_slots;
28562306a36Sopenharmony_ci	unsigned int total_seq_len = len; /*initial sequence length*/
28662306a36Sopenharmony_ci	struct device *dev = drvdata_to_dev(drvdata);
28762306a36Sopenharmony_ci
28862306a36Sopenharmony_ci	used_sw_slots = ((req_mgr_h->req_queue_head -
28962306a36Sopenharmony_ci			  req_mgr_h->req_queue_tail) &
29062306a36Sopenharmony_ci			 (MAX_REQUEST_QUEUE_SIZE - 1));
29162306a36Sopenharmony_ci	if (used_sw_slots > req_mgr_h->max_used_sw_slots)
29262306a36Sopenharmony_ci		req_mgr_h->max_used_sw_slots = used_sw_slots;
29362306a36Sopenharmony_ci
29462306a36Sopenharmony_ci	/* Enqueue request - must be locked with HW lock*/
29562306a36Sopenharmony_ci	req_mgr_h->req_queue[req_mgr_h->req_queue_head] = *cc_req;
29662306a36Sopenharmony_ci	req_mgr_h->req_queue_head = (req_mgr_h->req_queue_head + 1) &
29762306a36Sopenharmony_ci				    (MAX_REQUEST_QUEUE_SIZE - 1);
29862306a36Sopenharmony_ci
29962306a36Sopenharmony_ci	dev_dbg(dev, "Enqueue request head=%u\n", req_mgr_h->req_queue_head);
30062306a36Sopenharmony_ci
30162306a36Sopenharmony_ci	/*
30262306a36Sopenharmony_ci	 * We are about to push command to the HW via the command registers
30362306a36Sopenharmony_ci	 * that may reference host memory. We need to issue a memory barrier
30462306a36Sopenharmony_ci	 * to make sure there are no outstanding memory writes
30562306a36Sopenharmony_ci	 */
30662306a36Sopenharmony_ci	wmb();
30762306a36Sopenharmony_ci
30862306a36Sopenharmony_ci	/* STAT_PHASE_4: Push sequence */
30962306a36Sopenharmony_ci
31062306a36Sopenharmony_ci	enqueue_seq(drvdata, desc, len);
31162306a36Sopenharmony_ci
31262306a36Sopenharmony_ci	if (add_comp) {
31362306a36Sopenharmony_ci		enqueue_seq(drvdata, &req_mgr_h->compl_desc, 1);
31462306a36Sopenharmony_ci		total_seq_len++;
31562306a36Sopenharmony_ci	}
31662306a36Sopenharmony_ci
31762306a36Sopenharmony_ci	if (req_mgr_h->q_free_slots < total_seq_len) {
31862306a36Sopenharmony_ci		/* This situation should never occur. Maybe indicating problem
31962306a36Sopenharmony_ci		 * with resuming power. Set the free slot count to 0 and hope
32062306a36Sopenharmony_ci		 * for the best.
32162306a36Sopenharmony_ci		 */
32262306a36Sopenharmony_ci		dev_err(dev, "HW free slot count mismatch.");
32362306a36Sopenharmony_ci		req_mgr_h->q_free_slots = 0;
32462306a36Sopenharmony_ci	} else {
32562306a36Sopenharmony_ci		/* Update the free slots in HW queue */
32662306a36Sopenharmony_ci		req_mgr_h->q_free_slots -= total_seq_len;
32762306a36Sopenharmony_ci	}
32862306a36Sopenharmony_ci}
32962306a36Sopenharmony_ci
33062306a36Sopenharmony_cistatic void cc_enqueue_backlog(struct cc_drvdata *drvdata,
33162306a36Sopenharmony_ci			       struct cc_bl_item *bli)
33262306a36Sopenharmony_ci{
33362306a36Sopenharmony_ci	struct cc_req_mgr_handle *mgr = drvdata->request_mgr_handle;
33462306a36Sopenharmony_ci	struct device *dev = drvdata_to_dev(drvdata);
33562306a36Sopenharmony_ci
33662306a36Sopenharmony_ci	spin_lock_bh(&mgr->bl_lock);
33762306a36Sopenharmony_ci	list_add_tail(&bli->list, &mgr->backlog);
33862306a36Sopenharmony_ci	++mgr->bl_len;
33962306a36Sopenharmony_ci	dev_dbg(dev, "+++bl len: %d\n", mgr->bl_len);
34062306a36Sopenharmony_ci	spin_unlock_bh(&mgr->bl_lock);
34162306a36Sopenharmony_ci	tasklet_schedule(&mgr->comptask);
34262306a36Sopenharmony_ci}
34362306a36Sopenharmony_ci
34462306a36Sopenharmony_cistatic void cc_proc_backlog(struct cc_drvdata *drvdata)
34562306a36Sopenharmony_ci{
34662306a36Sopenharmony_ci	struct cc_req_mgr_handle *mgr = drvdata->request_mgr_handle;
34762306a36Sopenharmony_ci	struct cc_bl_item *bli;
34862306a36Sopenharmony_ci	struct cc_crypto_req *creq;
34962306a36Sopenharmony_ci	void *req;
35062306a36Sopenharmony_ci	struct device *dev = drvdata_to_dev(drvdata);
35162306a36Sopenharmony_ci	int rc;
35262306a36Sopenharmony_ci
35362306a36Sopenharmony_ci	spin_lock(&mgr->bl_lock);
35462306a36Sopenharmony_ci
35562306a36Sopenharmony_ci	while (mgr->bl_len) {
35662306a36Sopenharmony_ci		bli = list_first_entry(&mgr->backlog, struct cc_bl_item, list);
35762306a36Sopenharmony_ci		dev_dbg(dev, "---bl len: %d\n", mgr->bl_len);
35862306a36Sopenharmony_ci
35962306a36Sopenharmony_ci		spin_unlock(&mgr->bl_lock);
36062306a36Sopenharmony_ci
36162306a36Sopenharmony_ci
36262306a36Sopenharmony_ci		creq = &bli->creq;
36362306a36Sopenharmony_ci		req = creq->user_arg;
36462306a36Sopenharmony_ci
36562306a36Sopenharmony_ci		/*
36662306a36Sopenharmony_ci		 * Notify the request we're moving out of the backlog
36762306a36Sopenharmony_ci		 * but only if we haven't done so already.
36862306a36Sopenharmony_ci		 */
36962306a36Sopenharmony_ci		if (!bli->notif) {
37062306a36Sopenharmony_ci			creq->user_cb(dev, req, -EINPROGRESS);
37162306a36Sopenharmony_ci			bli->notif = true;
37262306a36Sopenharmony_ci		}
37362306a36Sopenharmony_ci
37462306a36Sopenharmony_ci		spin_lock(&mgr->hw_lock);
37562306a36Sopenharmony_ci
37662306a36Sopenharmony_ci		rc = cc_queues_status(drvdata, mgr, bli->len);
37762306a36Sopenharmony_ci		if (rc) {
37862306a36Sopenharmony_ci			/*
37962306a36Sopenharmony_ci			 * There is still no room in the FIFO for
38062306a36Sopenharmony_ci			 * this request. Bail out. We'll return here
38162306a36Sopenharmony_ci			 * on the next completion irq.
38262306a36Sopenharmony_ci			 */
38362306a36Sopenharmony_ci			spin_unlock(&mgr->hw_lock);
38462306a36Sopenharmony_ci			return;
38562306a36Sopenharmony_ci		}
38662306a36Sopenharmony_ci
38762306a36Sopenharmony_ci		cc_do_send_request(drvdata, &bli->creq, bli->desc, bli->len,
38862306a36Sopenharmony_ci				   false);
38962306a36Sopenharmony_ci		spin_unlock(&mgr->hw_lock);
39062306a36Sopenharmony_ci
39162306a36Sopenharmony_ci		/* Remove ourselves from the backlog list */
39262306a36Sopenharmony_ci		spin_lock(&mgr->bl_lock);
39362306a36Sopenharmony_ci		list_del(&bli->list);
39462306a36Sopenharmony_ci		--mgr->bl_len;
39562306a36Sopenharmony_ci		kfree(bli);
39662306a36Sopenharmony_ci	}
39762306a36Sopenharmony_ci
39862306a36Sopenharmony_ci	spin_unlock(&mgr->bl_lock);
39962306a36Sopenharmony_ci}
40062306a36Sopenharmony_ci
40162306a36Sopenharmony_ciint cc_send_request(struct cc_drvdata *drvdata, struct cc_crypto_req *cc_req,
40262306a36Sopenharmony_ci		    struct cc_hw_desc *desc, unsigned int len,
40362306a36Sopenharmony_ci		    struct crypto_async_request *req)
40462306a36Sopenharmony_ci{
40562306a36Sopenharmony_ci	int rc;
40662306a36Sopenharmony_ci	struct cc_req_mgr_handle *mgr = drvdata->request_mgr_handle;
40762306a36Sopenharmony_ci	struct device *dev = drvdata_to_dev(drvdata);
40862306a36Sopenharmony_ci	bool backlog_ok = req->flags & CRYPTO_TFM_REQ_MAY_BACKLOG;
40962306a36Sopenharmony_ci	gfp_t flags = cc_gfp_flags(req);
41062306a36Sopenharmony_ci	struct cc_bl_item *bli;
41162306a36Sopenharmony_ci
41262306a36Sopenharmony_ci	rc = cc_pm_get(dev);
41362306a36Sopenharmony_ci	if (rc) {
41462306a36Sopenharmony_ci		dev_err(dev, "cc_pm_get returned %x\n", rc);
41562306a36Sopenharmony_ci		return rc;
41662306a36Sopenharmony_ci	}
41762306a36Sopenharmony_ci
41862306a36Sopenharmony_ci	spin_lock_bh(&mgr->hw_lock);
41962306a36Sopenharmony_ci	rc = cc_queues_status(drvdata, mgr, len);
42062306a36Sopenharmony_ci
42162306a36Sopenharmony_ci#ifdef CC_DEBUG_FORCE_BACKLOG
42262306a36Sopenharmony_ci	if (backlog_ok)
42362306a36Sopenharmony_ci		rc = -ENOSPC;
42462306a36Sopenharmony_ci#endif /* CC_DEBUG_FORCE_BACKLOG */
42562306a36Sopenharmony_ci
42662306a36Sopenharmony_ci	if (rc == -ENOSPC && backlog_ok) {
42762306a36Sopenharmony_ci		spin_unlock_bh(&mgr->hw_lock);
42862306a36Sopenharmony_ci
42962306a36Sopenharmony_ci		bli = kmalloc(sizeof(*bli), flags);
43062306a36Sopenharmony_ci		if (!bli) {
43162306a36Sopenharmony_ci			cc_pm_put_suspend(dev);
43262306a36Sopenharmony_ci			return -ENOMEM;
43362306a36Sopenharmony_ci		}
43462306a36Sopenharmony_ci
43562306a36Sopenharmony_ci		memcpy(&bli->creq, cc_req, sizeof(*cc_req));
43662306a36Sopenharmony_ci		memcpy(&bli->desc, desc, len * sizeof(*desc));
43762306a36Sopenharmony_ci		bli->len = len;
43862306a36Sopenharmony_ci		bli->notif = false;
43962306a36Sopenharmony_ci		cc_enqueue_backlog(drvdata, bli);
44062306a36Sopenharmony_ci		return -EBUSY;
44162306a36Sopenharmony_ci	}
44262306a36Sopenharmony_ci
44362306a36Sopenharmony_ci	if (!rc) {
44462306a36Sopenharmony_ci		cc_do_send_request(drvdata, cc_req, desc, len, false);
44562306a36Sopenharmony_ci		rc = -EINPROGRESS;
44662306a36Sopenharmony_ci	}
44762306a36Sopenharmony_ci
44862306a36Sopenharmony_ci	spin_unlock_bh(&mgr->hw_lock);
44962306a36Sopenharmony_ci	return rc;
45062306a36Sopenharmony_ci}
45162306a36Sopenharmony_ci
45262306a36Sopenharmony_ciint cc_send_sync_request(struct cc_drvdata *drvdata,
45362306a36Sopenharmony_ci			 struct cc_crypto_req *cc_req, struct cc_hw_desc *desc,
45462306a36Sopenharmony_ci			 unsigned int len)
45562306a36Sopenharmony_ci{
45662306a36Sopenharmony_ci	int rc;
45762306a36Sopenharmony_ci	struct device *dev = drvdata_to_dev(drvdata);
45862306a36Sopenharmony_ci	struct cc_req_mgr_handle *mgr = drvdata->request_mgr_handle;
45962306a36Sopenharmony_ci
46062306a36Sopenharmony_ci	init_completion(&cc_req->seq_compl);
46162306a36Sopenharmony_ci	cc_req->user_cb = request_mgr_complete;
46262306a36Sopenharmony_ci	cc_req->user_arg = &cc_req->seq_compl;
46362306a36Sopenharmony_ci
46462306a36Sopenharmony_ci	rc = cc_pm_get(dev);
46562306a36Sopenharmony_ci	if (rc) {
46662306a36Sopenharmony_ci		dev_err(dev, "cc_pm_get returned %x\n", rc);
46762306a36Sopenharmony_ci		return rc;
46862306a36Sopenharmony_ci	}
46962306a36Sopenharmony_ci
47062306a36Sopenharmony_ci	while (true) {
47162306a36Sopenharmony_ci		spin_lock_bh(&mgr->hw_lock);
47262306a36Sopenharmony_ci		rc = cc_queues_status(drvdata, mgr, len + 1);
47362306a36Sopenharmony_ci
47462306a36Sopenharmony_ci		if (!rc)
47562306a36Sopenharmony_ci			break;
47662306a36Sopenharmony_ci
47762306a36Sopenharmony_ci		spin_unlock_bh(&mgr->hw_lock);
47862306a36Sopenharmony_ci		wait_for_completion_interruptible(&drvdata->hw_queue_avail);
47962306a36Sopenharmony_ci		reinit_completion(&drvdata->hw_queue_avail);
48062306a36Sopenharmony_ci	}
48162306a36Sopenharmony_ci
48262306a36Sopenharmony_ci	cc_do_send_request(drvdata, cc_req, desc, len, true);
48362306a36Sopenharmony_ci	spin_unlock_bh(&mgr->hw_lock);
48462306a36Sopenharmony_ci	wait_for_completion(&cc_req->seq_compl);
48562306a36Sopenharmony_ci	return 0;
48662306a36Sopenharmony_ci}
48762306a36Sopenharmony_ci
48862306a36Sopenharmony_ci/**
48962306a36Sopenharmony_ci * send_request_init() - Enqueue caller request to crypto hardware during init
49062306a36Sopenharmony_ci * process.
49162306a36Sopenharmony_ci * Assume this function is not called in the middle of a flow,
49262306a36Sopenharmony_ci * since we set QUEUE_LAST_IND flag in the last descriptor.
49362306a36Sopenharmony_ci *
49462306a36Sopenharmony_ci * @drvdata: Associated device driver context
49562306a36Sopenharmony_ci * @desc: The crypto sequence
49662306a36Sopenharmony_ci * @len: The crypto sequence length
49762306a36Sopenharmony_ci *
49862306a36Sopenharmony_ci * Return:
49962306a36Sopenharmony_ci * Returns "0" upon success
50062306a36Sopenharmony_ci */
50162306a36Sopenharmony_ciint send_request_init(struct cc_drvdata *drvdata, struct cc_hw_desc *desc,
50262306a36Sopenharmony_ci		      unsigned int len)
50362306a36Sopenharmony_ci{
50462306a36Sopenharmony_ci	struct cc_req_mgr_handle *req_mgr_h = drvdata->request_mgr_handle;
50562306a36Sopenharmony_ci	unsigned int total_seq_len = len; /*initial sequence length*/
50662306a36Sopenharmony_ci	int rc = 0;
50762306a36Sopenharmony_ci
50862306a36Sopenharmony_ci	/* Wait for space in HW and SW FIFO. Poll for as much as FIFO_TIMEOUT.
50962306a36Sopenharmony_ci	 */
51062306a36Sopenharmony_ci	rc = cc_queues_status(drvdata, req_mgr_h, total_seq_len);
51162306a36Sopenharmony_ci	if (rc)
51262306a36Sopenharmony_ci		return rc;
51362306a36Sopenharmony_ci
51462306a36Sopenharmony_ci	set_queue_last_ind(drvdata, &desc[(len - 1)]);
51562306a36Sopenharmony_ci
51662306a36Sopenharmony_ci	/*
51762306a36Sopenharmony_ci	 * We are about to push command to the HW via the command registers
51862306a36Sopenharmony_ci	 * that may reference host memory. We need to issue a memory barrier
51962306a36Sopenharmony_ci	 * to make sure there are no outstanding memory writes
52062306a36Sopenharmony_ci	 */
52162306a36Sopenharmony_ci	wmb();
52262306a36Sopenharmony_ci	enqueue_seq(drvdata, desc, len);
52362306a36Sopenharmony_ci
52462306a36Sopenharmony_ci	/* Update the free slots in HW queue */
52562306a36Sopenharmony_ci	req_mgr_h->q_free_slots =
52662306a36Sopenharmony_ci		cc_ioread(drvdata, CC_REG(DSCRPTR_QUEUE_CONTENT));
52762306a36Sopenharmony_ci
52862306a36Sopenharmony_ci	return 0;
52962306a36Sopenharmony_ci}
53062306a36Sopenharmony_ci
53162306a36Sopenharmony_civoid complete_request(struct cc_drvdata *drvdata)
53262306a36Sopenharmony_ci{
53362306a36Sopenharmony_ci	struct cc_req_mgr_handle *request_mgr_handle =
53462306a36Sopenharmony_ci						drvdata->request_mgr_handle;
53562306a36Sopenharmony_ci
53662306a36Sopenharmony_ci	complete(&drvdata->hw_queue_avail);
53762306a36Sopenharmony_ci#ifdef COMP_IN_WQ
53862306a36Sopenharmony_ci	queue_delayed_work(request_mgr_handle->workq,
53962306a36Sopenharmony_ci			   &request_mgr_handle->compwork, 0);
54062306a36Sopenharmony_ci#else
54162306a36Sopenharmony_ci	tasklet_schedule(&request_mgr_handle->comptask);
54262306a36Sopenharmony_ci#endif
54362306a36Sopenharmony_ci}
54462306a36Sopenharmony_ci
54562306a36Sopenharmony_ci#ifdef COMP_IN_WQ
54662306a36Sopenharmony_cistatic void comp_work_handler(struct work_struct *work)
54762306a36Sopenharmony_ci{
54862306a36Sopenharmony_ci	struct cc_drvdata *drvdata =
54962306a36Sopenharmony_ci		container_of(work, struct cc_drvdata, compwork.work);
55062306a36Sopenharmony_ci
55162306a36Sopenharmony_ci	comp_handler((unsigned long)drvdata);
55262306a36Sopenharmony_ci}
55362306a36Sopenharmony_ci#endif
55462306a36Sopenharmony_ci
55562306a36Sopenharmony_cistatic void proc_completions(struct cc_drvdata *drvdata)
55662306a36Sopenharmony_ci{
55762306a36Sopenharmony_ci	struct cc_crypto_req *cc_req;
55862306a36Sopenharmony_ci	struct device *dev = drvdata_to_dev(drvdata);
55962306a36Sopenharmony_ci	struct cc_req_mgr_handle *request_mgr_handle =
56062306a36Sopenharmony_ci						drvdata->request_mgr_handle;
56162306a36Sopenharmony_ci	unsigned int *tail = &request_mgr_handle->req_queue_tail;
56262306a36Sopenharmony_ci	unsigned int *head = &request_mgr_handle->req_queue_head;
56362306a36Sopenharmony_ci	int rc;
56462306a36Sopenharmony_ci	u32 mask;
56562306a36Sopenharmony_ci
56662306a36Sopenharmony_ci	while (request_mgr_handle->axi_completed) {
56762306a36Sopenharmony_ci		request_mgr_handle->axi_completed--;
56862306a36Sopenharmony_ci
56962306a36Sopenharmony_ci		/* Dequeue request */
57062306a36Sopenharmony_ci		if (*head == *tail) {
57162306a36Sopenharmony_ci			/* We are supposed to handle a completion but our
57262306a36Sopenharmony_ci			 * queue is empty. This is not normal. Return and
57362306a36Sopenharmony_ci			 * hope for the best.
57462306a36Sopenharmony_ci			 */
57562306a36Sopenharmony_ci			dev_err(dev, "Request queue is empty head == tail %u\n",
57662306a36Sopenharmony_ci				*head);
57762306a36Sopenharmony_ci			break;
57862306a36Sopenharmony_ci		}
57962306a36Sopenharmony_ci
58062306a36Sopenharmony_ci		cc_req = &request_mgr_handle->req_queue[*tail];
58162306a36Sopenharmony_ci
58262306a36Sopenharmony_ci		if (cc_req->cpp.is_cpp) {
58362306a36Sopenharmony_ci
58462306a36Sopenharmony_ci			dev_dbg(dev, "CPP request completion slot: %d alg:%d\n",
58562306a36Sopenharmony_ci				cc_req->cpp.slot, cc_req->cpp.alg);
58662306a36Sopenharmony_ci			mask = cc_cpp_int_mask(cc_req->cpp.alg,
58762306a36Sopenharmony_ci					       cc_req->cpp.slot);
58862306a36Sopenharmony_ci			rc = (drvdata->irq & mask ? -EPERM : 0);
58962306a36Sopenharmony_ci			dev_dbg(dev, "Got mask: %x irq: %x rc: %d\n", mask,
59062306a36Sopenharmony_ci				drvdata->irq, rc);
59162306a36Sopenharmony_ci		} else {
59262306a36Sopenharmony_ci			dev_dbg(dev, "None CPP request completion\n");
59362306a36Sopenharmony_ci			rc = 0;
59462306a36Sopenharmony_ci		}
59562306a36Sopenharmony_ci
59662306a36Sopenharmony_ci		if (cc_req->user_cb)
59762306a36Sopenharmony_ci			cc_req->user_cb(dev, cc_req->user_arg, rc);
59862306a36Sopenharmony_ci		*tail = (*tail + 1) & (MAX_REQUEST_QUEUE_SIZE - 1);
59962306a36Sopenharmony_ci		dev_dbg(dev, "Dequeue request tail=%u\n", *tail);
60062306a36Sopenharmony_ci		dev_dbg(dev, "Request completed. axi_completed=%d\n",
60162306a36Sopenharmony_ci			request_mgr_handle->axi_completed);
60262306a36Sopenharmony_ci		cc_pm_put_suspend(dev);
60362306a36Sopenharmony_ci	}
60462306a36Sopenharmony_ci}
60562306a36Sopenharmony_ci
60662306a36Sopenharmony_cistatic inline u32 cc_axi_comp_count(struct cc_drvdata *drvdata)
60762306a36Sopenharmony_ci{
60862306a36Sopenharmony_ci	return FIELD_GET(AXIM_MON_COMP_VALUE,
60962306a36Sopenharmony_ci			 cc_ioread(drvdata, drvdata->axim_mon_offset));
61062306a36Sopenharmony_ci}
61162306a36Sopenharmony_ci
61262306a36Sopenharmony_ci/* Deferred service handler, run as interrupt-fired tasklet */
61362306a36Sopenharmony_cistatic void comp_handler(unsigned long devarg)
61462306a36Sopenharmony_ci{
61562306a36Sopenharmony_ci	struct cc_drvdata *drvdata = (struct cc_drvdata *)devarg;
61662306a36Sopenharmony_ci	struct cc_req_mgr_handle *request_mgr_handle =
61762306a36Sopenharmony_ci						drvdata->request_mgr_handle;
61862306a36Sopenharmony_ci	struct device *dev = drvdata_to_dev(drvdata);
61962306a36Sopenharmony_ci	u32 irq;
62062306a36Sopenharmony_ci
62162306a36Sopenharmony_ci	dev_dbg(dev, "Completion handler called!\n");
62262306a36Sopenharmony_ci	irq = (drvdata->irq & drvdata->comp_mask);
62362306a36Sopenharmony_ci
62462306a36Sopenharmony_ci	/* To avoid the interrupt from firing as we unmask it,
62562306a36Sopenharmony_ci	 * we clear it now
62662306a36Sopenharmony_ci	 */
62762306a36Sopenharmony_ci	cc_iowrite(drvdata, CC_REG(HOST_ICR), irq);
62862306a36Sopenharmony_ci
62962306a36Sopenharmony_ci	/* Avoid race with above clear: Test completion counter once more */
63062306a36Sopenharmony_ci
63162306a36Sopenharmony_ci	request_mgr_handle->axi_completed += cc_axi_comp_count(drvdata);
63262306a36Sopenharmony_ci
63362306a36Sopenharmony_ci	dev_dbg(dev, "AXI completion after updated: %d\n",
63462306a36Sopenharmony_ci		request_mgr_handle->axi_completed);
63562306a36Sopenharmony_ci
63662306a36Sopenharmony_ci	while (request_mgr_handle->axi_completed) {
63762306a36Sopenharmony_ci		do {
63862306a36Sopenharmony_ci			drvdata->irq |= cc_ioread(drvdata, CC_REG(HOST_IRR));
63962306a36Sopenharmony_ci			irq = (drvdata->irq & drvdata->comp_mask);
64062306a36Sopenharmony_ci			proc_completions(drvdata);
64162306a36Sopenharmony_ci
64262306a36Sopenharmony_ci			/* At this point (after proc_completions()),
64362306a36Sopenharmony_ci			 * request_mgr_handle->axi_completed is 0.
64462306a36Sopenharmony_ci			 */
64562306a36Sopenharmony_ci			request_mgr_handle->axi_completed +=
64662306a36Sopenharmony_ci						cc_axi_comp_count(drvdata);
64762306a36Sopenharmony_ci		} while (request_mgr_handle->axi_completed > 0);
64862306a36Sopenharmony_ci
64962306a36Sopenharmony_ci		cc_iowrite(drvdata, CC_REG(HOST_ICR), irq);
65062306a36Sopenharmony_ci
65162306a36Sopenharmony_ci		request_mgr_handle->axi_completed += cc_axi_comp_count(drvdata);
65262306a36Sopenharmony_ci	}
65362306a36Sopenharmony_ci
65462306a36Sopenharmony_ci	/* after verifying that there is nothing to do,
65562306a36Sopenharmony_ci	 * unmask AXI completion interrupt
65662306a36Sopenharmony_ci	 */
65762306a36Sopenharmony_ci	cc_iowrite(drvdata, CC_REG(HOST_IMR),
65862306a36Sopenharmony_ci		   cc_ioread(drvdata, CC_REG(HOST_IMR)) & ~drvdata->comp_mask);
65962306a36Sopenharmony_ci
66062306a36Sopenharmony_ci	cc_proc_backlog(drvdata);
66162306a36Sopenharmony_ci	dev_dbg(dev, "Comp. handler done.\n");
66262306a36Sopenharmony_ci}
663