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