| /* Qualcomm Crypto Engine driver. |
| * |
| * Copyright (c) 2011 - 2012, Code Aurora Forum. All rights reserved. |
| * |
| * This program is free software; you can redistribute it and/or modify |
| * it under the terms of the GNU General Public License version 2 and |
| * only version 2 as published by the Free Software Foundation. |
| * |
| * This program is distributed in the hope that it will be useful, |
| * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| * GNU General Public License for more details. |
| */ |
| #include <linux/types.h> |
| #include <linux/kernel.h> |
| #include <linux/module.h> |
| #include <linux/mod_devicetable.h> |
| #include <linux/device.h> |
| #include <linux/clk.h> |
| #include <linux/err.h> |
| #include <linux/dma-mapping.h> |
| #include <linux/io.h> |
| #include <linux/platform_device.h> |
| #include <linux/spinlock.h> |
| #include <linux/delay.h> |
| #include <linux/crypto.h> |
| #include <linux/qcedev.h> |
| #include <linux/bitops.h> |
| #include <crypto/hash.h> |
| #include <crypto/sha.h> |
| #include <mach/dma.h> |
| #include <mach/clk.h> |
| #include <mach/socinfo.h> |
| |
| #include "qce.h" |
| #include "qce40.h" |
| #include "qcryptohw_40.h" |
| |
| /* ADM definitions */ |
| #define LI_SG_CMD (1 << 31) /* last index in the scatter gather cmd */ |
| #define SRC_INDEX_SG_CMD(index) ((index & 0x3fff) << 16) |
| #define DST_INDEX_SG_CMD(index) (index & 0x3fff) |
| #define ADM_DESC_LAST (1 << 31) |
| #define QCE_FIFO_SIZE 0x8000 |
| |
| /* |
| * CE HW device structure. |
| * Each engine has an instance of the structure. |
| * Each engine can only handle one crypto operation at one time. It is up to |
| * the sw above to ensure single threading of operation on an engine. |
| */ |
| struct qce_device { |
| struct device *pdev; /* Handle to platform_device structure */ |
| |
| unsigned char *coh_vmem; /* Allocated coherent virtual memory */ |
| dma_addr_t coh_pmem; /* Allocated coherent physical memory */ |
| int memsize; /* Memory allocated */ |
| |
| void __iomem *iobase; /* Virtual io base of CE HW */ |
| unsigned int phy_iobase; /* Physical io base of CE HW */ |
| |
| struct clk *ce_core_src_clk; /* Handle to CE src clk*/ |
| struct clk *ce_core_clk; /* Handle to CE clk */ |
| struct clk *ce_clk; /* Handle to CE clk */ |
| |
| qce_comp_func_ptr_t qce_cb; /* qce callback function pointer */ |
| |
| int assoc_nents; |
| int ivsize; |
| int authsize; |
| int src_nents; |
| int dst_nents; |
| |
| void *areq; |
| enum qce_cipher_mode_enum mode; |
| struct ce_dm_data ce_dm; |
| }; |
| |
| /* Standard initialization vector for SHA-1, source: FIPS 180-2 */ |
| static uint8_t _std_init_vector_sha1_uint8[] = { |
| 0x67, 0x45, 0x23, 0x01, 0xEF, 0xCD, 0xAB, 0x89, |
| 0x98, 0xBA, 0xDC, 0xFE, 0x10, 0x32, 0x54, 0x76, |
| 0xC3, 0xD2, 0xE1, 0xF0 |
| }; |
| |
| /* Standard initialization vector for SHA-256, source: FIPS 180-2 */ |
| static uint8_t _std_init_vector_sha256_uint8[] = { |
| 0x6A, 0x09, 0xE6, 0x67, 0xBB, 0x67, 0xAE, 0x85, |
| 0x3C, 0x6E, 0xF3, 0x72, 0xA5, 0x4F, 0xF5, 0x3A, |
| 0x51, 0x0E, 0x52, 0x7F, 0x9B, 0x05, 0x68, 0x8C, |
| 0x1F, 0x83, 0xD9, 0xAB, 0x5B, 0xE0, 0xCD, 0x19 |
| }; |
| |
| static void _byte_stream_swap_to_net_words(uint32_t *iv, unsigned char *b, |
| unsigned int len) |
| { |
| unsigned i, j; |
| unsigned char swap_iv[AES_IV_LENGTH]; |
| |
| memset(swap_iv, 0, AES_IV_LENGTH); |
| for (i = (AES_IV_LENGTH-len), j = len-1; i < AES_IV_LENGTH; i++, j--) |
| swap_iv[i] = b[j]; |
| memcpy(iv, swap_iv, AES_IV_LENGTH); |
| } |
| |
| static int count_sg(struct scatterlist *sg, int nbytes) |
| { |
| int i; |
| |
| for (i = 0; nbytes > 0; i++, sg = sg_next(sg)) |
| nbytes -= sg->length; |
| return i; |
| } |
| |
| static int dma_map_pmem_sg(struct buf_info *pmem, unsigned entries, |
| struct scatterlist *sg) |
| { |
| int i; |
| for (i = 0; i < entries; i++) { |
| |
| sg->dma_address = (dma_addr_t)pmem->offset; |
| sg++; |
| pmem++; |
| } |
| return 0; |
| } |
| |
| static int _probe_ce_engine(struct qce_device *pce_dev) |
| { |
| unsigned int val; |
| unsigned int rev; |
| unsigned int ret; |
| |
| val = (uint32_t)(*((uint32_t *)pce_dev->ce_dm.buffer.version)); |
| if (((val & 0xfffffff) != 0x0000043) && |
| ((val & 0xfffffff) != 0x0000042) && |
| ((val & 0xfffffff) != 0x0000040)) { |
| dev_err(pce_dev->pdev, |
| "Unknown Qualcomm crypto device at 0x%x 0x%x\n", |
| pce_dev->phy_iobase, val); |
| return -EIO; |
| }; |
| rev = (val & CRYPTO_CORE_REV_MASK); |
| if (rev >= 0x42) { |
| dev_info(pce_dev->pdev, |
| "Qualcomm Crypto 4.2 device found at 0x%x\n", |
| pce_dev->phy_iobase); |
| pce_dev->ce_dm.ce_block_size = 64; |
| |
| /* Configure the crypto register to support 64byte CRCI if it |
| * is not XPU protected and the HW version of device is greater |
| * than 0x42. |
| * Crypto config register returns a 0 when it is XPU protected. |
| */ |
| |
| ret = readl_relaxed(pce_dev->iobase + CRYPTO_CONFIG_REG); |
| if (ret) { |
| val = BIT(CRYPTO_MASK_DOUT_INTR) | |
| BIT(CRYPTO_MASK_DIN_INTR) | |
| BIT(CRYPTO_MASK_OP_DONE_INTR) | |
| BIT(CRYPTO_MASK_ERR_INTR) | |
| (CRYPTO_REQ_SIZE_ENUM_64_BYTES << |
| CRYPTO_REQ_SIZE) | |
| (CRYPTO_FIFO_ENUM_64_BYTES << |
| CRYPTO_FIFO_THRESHOLD); |
| |
| writel_relaxed(val, pce_dev->iobase + |
| CRYPTO_CONFIG_REG); |
| } /* end of if (ret) */ |
| } else { |
| if (rev == 0x40) { |
| dev_info(pce_dev->pdev, |
| "Qualcomm Crypto 4.0 device found at 0x%x\n", |
| pce_dev->phy_iobase); |
| pce_dev->ce_dm.ce_block_size = 16; |
| } |
| } |
| |
| dev_info(pce_dev->pdev, |
| "IO base 0x%x\n, ce_in channel %d , " |
| "ce_out channel %d\n, " |
| "crci_in %d, crci_out %d\n", |
| (unsigned int) pce_dev->iobase, |
| pce_dev->ce_dm.chan_ce_in, pce_dev->ce_dm.chan_ce_out, |
| pce_dev->ce_dm.crci_in, pce_dev->ce_dm.crci_out); |
| |
| return 0; |
| }; |
| |
| |
| static void _check_probe_done_call_back(struct msm_dmov_cmd *cmd_ptr, |
| unsigned int result, struct msm_dmov_errdata *err) |
| { |
| struct qce_device *pce_dev; |
| pce_dev = (struct qce_device *) cmd_ptr->user; |
| |
| if (result != ADM_STATUS_OK) { |
| dev_err(pce_dev->pdev, "Qualcomm ADM status error %x\n", |
| result); |
| pce_dev->ce_dm.chan_ce_in_status = -1; |
| } else { |
| _probe_ce_engine(pce_dev); |
| pce_dev->ce_dm.chan_ce_in_status = 0; |
| } |
| pce_dev->ce_dm.chan_ce_in_state = QCE_CHAN_STATE_IDLE; |
| }; |
| |
| static int _init_ce_engine(struct qce_device *pce_dev) |
| { |
| int status; |
| /* Reset ce */ |
| clk_reset(pce_dev->ce_core_clk, CLK_RESET_ASSERT); |
| clk_reset(pce_dev->ce_core_clk, CLK_RESET_DEASSERT); |
| |
| /* |
| * Ensure previous instruction (any writes to CLK registers) |
| * to toggle the CLK reset lines was completed before configuring |
| * ce engine. The ce engine configuration settings should not be lost |
| * becasue of clk reset. |
| */ |
| mb(); |
| |
| /* |
| * Clear ACCESS_VIOL bit in CRYPTO_STATUS REGISTER |
| */ |
| status = readl_relaxed(pce_dev->iobase + CRYPTO_STATUS_REG); |
| *((uint32_t *)(pce_dev->ce_dm.buffer.status)) = status & (~0x40000); |
| /* |
| * Ensure ce configuration is completed. |
| */ |
| mb(); |
| |
| pce_dev->ce_dm.chan_ce_in_cmd->complete_func = |
| _check_probe_done_call_back; |
| pce_dev->ce_dm.chan_ce_in_cmd->cmdptr = |
| pce_dev->ce_dm.cmdptrlist.probe_ce_hw; |
| pce_dev->ce_dm.chan_ce_in_state = QCE_CHAN_STATE_IN_PROG; |
| pce_dev->ce_dm.chan_ce_out_state = QCE_CHAN_STATE_COMP; |
| msm_dmov_enqueue_cmd(pce_dev->ce_dm.chan_ce_in, |
| pce_dev->ce_dm.chan_ce_in_cmd); |
| |
| return 0; |
| }; |
| |
| static int _ce_setup_hash_cmdrptrlist(struct qce_device *pce_dev, |
| struct qce_sha_req *sreq) |
| { |
| struct ce_cmdptrlists_ops *cmdptrlist = &pce_dev->ce_dm.cmdptrlist; |
| |
| switch (sreq->alg) { |
| case QCE_HASH_SHA1: |
| pce_dev->ce_dm.chan_ce_in_cmd->cmdptr = cmdptrlist->auth_sha1; |
| break; |
| |
| case QCE_HASH_SHA256: |
| pce_dev->ce_dm.chan_ce_in_cmd->cmdptr = cmdptrlist->auth_sha256; |
| break; |
| case QCE_HASH_SHA1_HMAC: |
| pce_dev->ce_dm.chan_ce_in_cmd->cmdptr = |
| cmdptrlist->auth_sha1_hmac; |
| break; |
| |
| case QCE_HASH_SHA256_HMAC: |
| pce_dev->ce_dm.chan_ce_in_cmd->cmdptr = |
| cmdptrlist->auth_sha256_hmac; |
| break; |
| case QCE_HASH_AES_CMAC: |
| if (sreq->authklen == AES128_KEY_SIZE) |
| pce_dev->ce_dm.chan_ce_in_cmd->cmdptr = |
| cmdptrlist->auth_aes_128_cmac; |
| else |
| pce_dev->ce_dm.chan_ce_in_cmd->cmdptr = |
| cmdptrlist->auth_aes_256_cmac; |
| break; |
| |
| default: |
| break; |
| } |
| |
| return 0; |
| } |
| |
| static int _ce_setup_hash(struct qce_device *pce_dev, struct qce_sha_req *sreq) |
| { |
| uint32_t diglen; |
| int i; |
| uint32_t auth_cfg = 0; |
| bool sha1 = false; |
| |
| if (sreq->alg == QCE_HASH_AES_CMAC) { |
| |
| memcpy(pce_dev->ce_dm.buffer.auth_key, sreq->authkey, |
| sreq->authklen); |
| auth_cfg |= (1 << CRYPTO_LAST); |
| auth_cfg |= (CRYPTO_AUTH_MODE_CMAC << CRYPTO_AUTH_MODE); |
| auth_cfg |= (CRYPTO_AUTH_SIZE_ENUM_16_BYTES << |
| CRYPTO_AUTH_SIZE); |
| auth_cfg |= CRYPTO_AUTH_ALG_AES << CRYPTO_AUTH_ALG; |
| |
| switch (sreq->authklen) { |
| case AES128_KEY_SIZE: |
| auth_cfg |= (CRYPTO_AUTH_KEY_SZ_AES128 << |
| CRYPTO_AUTH_KEY_SIZE); |
| break; |
| case AES256_KEY_SIZE: |
| auth_cfg |= (CRYPTO_AUTH_KEY_SZ_AES256 << |
| CRYPTO_AUTH_KEY_SIZE); |
| break; |
| default: |
| break; |
| } |
| |
| goto go_proc; |
| } |
| |
| /* if not the last, the size has to be on the block boundary */ |
| if (sreq->last_blk == 0 && (sreq->size % SHA256_BLOCK_SIZE)) |
| return -EIO; |
| |
| switch (sreq->alg) { |
| case QCE_HASH_SHA1: |
| case QCE_HASH_SHA1_HMAC: |
| diglen = SHA1_DIGEST_SIZE; |
| sha1 = true; |
| break; |
| case QCE_HASH_SHA256: |
| case QCE_HASH_SHA256_HMAC: |
| diglen = SHA256_DIGEST_SIZE; |
| break; |
| default: |
| return -EINVAL; |
| } |
| |
| if ((sreq->alg == QCE_HASH_SHA1_HMAC) || |
| (sreq->alg == QCE_HASH_SHA256_HMAC)) { |
| |
| memcpy(pce_dev->ce_dm.buffer.auth_key, sreq->authkey, |
| sreq->authklen); |
| auth_cfg |= (CRYPTO_AUTH_MODE_HMAC << CRYPTO_AUTH_MODE); |
| } else { |
| auth_cfg |= (CRYPTO_AUTH_MODE_HASH << CRYPTO_AUTH_MODE); |
| } |
| |
| /* write 20/32 bytes, 5/8 words into auth_iv for SHA1/SHA256 */ |
| if (sreq->first_blk) { |
| if (sha1) |
| memcpy(pce_dev->ce_dm.buffer.auth_iv, |
| _std_init_vector_sha1_uint8, diglen); |
| else |
| memcpy(pce_dev->ce_dm.buffer.auth_iv, |
| _std_init_vector_sha256_uint8, diglen); |
| } else { |
| memcpy(pce_dev->ce_dm.buffer.auth_iv, sreq->digest, |
| diglen); |
| } |
| |
| /* write auth_bytecnt 0/1/2/3, start with 0 */ |
| for (i = 0; i < 4; i++) |
| *(((uint32_t *)(pce_dev->ce_dm.buffer.auth_byte_count) + i)) = |
| sreq->auth_data[i]; |
| |
| /* write seg_cfg */ |
| if (sha1) |
| auth_cfg |= (CRYPTO_AUTH_SIZE_SHA1 << CRYPTO_AUTH_SIZE); |
| else |
| auth_cfg |= (CRYPTO_AUTH_SIZE_SHA256 << CRYPTO_AUTH_SIZE); |
| |
| if (sreq->last_blk) |
| auth_cfg |= 1 << CRYPTO_LAST; |
| |
| auth_cfg |= CRYPTO_AUTH_ALG_SHA << CRYPTO_AUTH_ALG; |
| |
| go_proc: |
| auth_cfg |= (CRYPTO_AUTH_POS_BEFORE << CRYPTO_AUTH_POS); |
| |
| /* write auth seg cfg */ |
| *((uint32_t *)(pce_dev->ce_dm.buffer.auth_seg_cfg_size_start)) = |
| auth_cfg; |
| /* write auth seg size */ |
| *((uint32_t *)(pce_dev->ce_dm.buffer.auth_seg_cfg_size_start) + 1) = |
| sreq->size; |
| |
| /* write auth seg size start*/ |
| *((uint32_t *)(pce_dev->ce_dm.buffer.auth_seg_cfg_size_start)+2) = 0; |
| |
| /* write seg size */ |
| *((uint32_t *)(pce_dev->ce_dm.buffer.seg_size)) = sreq->size; |
| |
| _ce_setup_hash_cmdrptrlist(pce_dev, sreq); |
| |
| return 0; |
| } |
| |
| static int _ce_setup_cipher_cmdrptrlist(struct qce_device *pce_dev, |
| struct qce_req *creq) |
| { |
| struct ce_cmdptrlists_ops *cmdptrlist = |
| &pce_dev->ce_dm.cmdptrlist; |
| |
| if (creq->alg != CIPHER_ALG_AES) { |
| switch (creq->alg) { |
| case CIPHER_ALG_DES: |
| if (creq->mode == QCE_MODE_ECB) { |
| pce_dev->ce_dm.chan_ce_in_cmd->cmdptr = |
| cmdptrlist->cipher_des_ecb; |
| } else { |
| pce_dev->ce_dm.chan_ce_in_cmd->cmdptr = |
| cmdptrlist->cipher_des_cbc; |
| } |
| break; |
| |
| case CIPHER_ALG_3DES: |
| if (creq->mode == QCE_MODE_ECB) { |
| pce_dev->ce_dm.chan_ce_in_cmd->cmdptr = |
| cmdptrlist->cipher_3des_ecb; |
| } else { |
| pce_dev->ce_dm.chan_ce_in_cmd->cmdptr = |
| cmdptrlist->cipher_3des_cbc; |
| } |
| break; |
| default: |
| break; |
| } |
| } else { |
| switch (creq->mode) { |
| case QCE_MODE_ECB: |
| if (creq->encklen == AES128_KEY_SIZE) { |
| pce_dev->ce_dm.chan_ce_in_cmd->cmdptr = |
| cmdptrlist->cipher_aes_128_ecb; |
| } else { |
| pce_dev->ce_dm.chan_ce_in_cmd->cmdptr = |
| cmdptrlist->cipher_aes_256_ecb; |
| } |
| break; |
| |
| case QCE_MODE_CBC: |
| if (creq->encklen == AES128_KEY_SIZE) { |
| pce_dev->ce_dm.chan_ce_in_cmd->cmdptr = |
| cmdptrlist->cipher_aes_128_cbc_ctr; |
| } else { |
| pce_dev->ce_dm.chan_ce_in_cmd->cmdptr = |
| cmdptrlist->cipher_aes_256_cbc_ctr; |
| } |
| break; |
| |
| case QCE_MODE_CTR: |
| if (creq->encklen == AES128_KEY_SIZE) { |
| pce_dev->ce_dm.chan_ce_in_cmd->cmdptr = |
| cmdptrlist->cipher_aes_128_cbc_ctr; |
| } else { |
| pce_dev->ce_dm.chan_ce_in_cmd->cmdptr = |
| cmdptrlist->cipher_aes_256_cbc_ctr; |
| } |
| break; |
| |
| case QCE_MODE_XTS: |
| if (creq->encklen == AES128_KEY_SIZE) { |
| pce_dev->ce_dm.chan_ce_in_cmd->cmdptr = |
| cmdptrlist->cipher_aes_128_xts; |
| } else { |
| pce_dev->ce_dm.chan_ce_in_cmd->cmdptr = |
| cmdptrlist->cipher_aes_256_xts; |
| } |
| break; |
| case QCE_MODE_CCM: |
| if (creq->encklen == AES128_KEY_SIZE) { |
| pce_dev->ce_dm.chan_ce_in_cmd->cmdptr = |
| cmdptrlist->aead_aes_128_ccm; |
| } else { |
| pce_dev->ce_dm.chan_ce_in_cmd->cmdptr = |
| cmdptrlist->aead_aes_256_ccm; |
| } |
| break; |
| default: |
| break; |
| } |
| } |
| |
| switch (creq->mode) { |
| case QCE_MODE_CCM: |
| pce_dev->ce_dm.chan_ce_out_cmd->cmdptr = |
| cmdptrlist->aead_ce_out; |
| break; |
| case QCE_MODE_ECB: |
| pce_dev->ce_dm.chan_ce_out_cmd->cmdptr = |
| cmdptrlist->cipher_ce_out; |
| break; |
| default: |
| pce_dev->ce_dm.chan_ce_out_cmd->cmdptr = |
| cmdptrlist->cipher_ce_out_get_iv; |
| break; |
| } |
| |
| return 0; |
| } |
| |
| static int _ce_setup_cipher(struct qce_device *pce_dev, struct qce_req *creq, |
| uint32_t totallen_in, uint32_t coffset) |
| { |
| uint32_t enck_size_in_word = creq->encklen / sizeof(uint32_t); |
| uint32_t encr_cfg = 0; |
| uint32_t ivsize = creq->ivsize; |
| struct ce_reg_buffer_addr *buffer = &pce_dev->ce_dm.buffer; |
| |
| if (creq->mode == QCE_MODE_XTS) |
| memcpy(buffer->encr_key, creq->enckey, |
| creq->encklen/2); |
| else |
| memcpy(buffer->encr_key, creq->enckey, creq->encklen); |
| |
| if ((creq->op == QCE_REQ_AEAD) && (creq->mode == QCE_MODE_CCM)) { |
| uint32_t noncelen32 = MAX_NONCE/sizeof(uint32_t); |
| uint32_t auth_cfg = 0; |
| |
| /* write nonce */ |
| memcpy(buffer->auth_nonce_info, creq->nonce, MAX_NONCE); |
| memcpy(buffer->auth_key, creq->enckey, creq->encklen); |
| |
| auth_cfg |= (noncelen32 << CRYPTO_AUTH_NONCE_NUM_WORDS); |
| auth_cfg &= ~(1 << CRYPTO_USE_HW_KEY_AUTH); |
| auth_cfg |= (1 << CRYPTO_LAST); |
| if (creq->dir == QCE_ENCRYPT) |
| auth_cfg |= (CRYPTO_AUTH_POS_BEFORE << CRYPTO_AUTH_POS); |
| else |
| auth_cfg |= (CRYPTO_AUTH_POS_AFTER << CRYPTO_AUTH_POS); |
| auth_cfg |= (((creq->authsize >> 1) - 2) << CRYPTO_AUTH_SIZE); |
| auth_cfg |= (CRYPTO_AUTH_MODE_CCM << CRYPTO_AUTH_MODE); |
| if (creq->authklen == AES128_KEY_SIZE) |
| auth_cfg |= (CRYPTO_AUTH_KEY_SZ_AES128 << |
| CRYPTO_AUTH_KEY_SIZE); |
| else { |
| if (creq->authklen == AES256_KEY_SIZE) |
| auth_cfg |= (CRYPTO_AUTH_KEY_SZ_AES256 << |
| CRYPTO_AUTH_KEY_SIZE); |
| } |
| auth_cfg |= (CRYPTO_AUTH_ALG_AES << CRYPTO_AUTH_ALG); |
| *((uint32_t *)(buffer->auth_seg_cfg_size_start)) = auth_cfg; |
| |
| if (creq->dir == QCE_ENCRYPT) |
| *((uint32_t *)(buffer->auth_seg_cfg_size_start) + 1) = |
| totallen_in; |
| else |
| *((uint32_t *)(buffer->auth_seg_cfg_size_start) + 1) = |
| (totallen_in - creq->authsize); |
| *((uint32_t *)(buffer->auth_seg_cfg_size_start) + 2) = 0; |
| } |
| |
| *((uint32_t *)(buffer->auth_seg_cfg_size_start) + 2) = 0; |
| |
| switch (creq->mode) { |
| case QCE_MODE_ECB: |
| encr_cfg |= (CRYPTO_ENCR_MODE_ECB << CRYPTO_ENCR_MODE); |
| break; |
| |
| case QCE_MODE_CBC: |
| encr_cfg |= (CRYPTO_ENCR_MODE_CBC << CRYPTO_ENCR_MODE); |
| break; |
| |
| case QCE_MODE_XTS: |
| encr_cfg |= (CRYPTO_ENCR_MODE_XTS << CRYPTO_ENCR_MODE); |
| break; |
| |
| case QCE_MODE_CCM: |
| encr_cfg |= (CRYPTO_ENCR_MODE_CCM << CRYPTO_ENCR_MODE); |
| break; |
| |
| case QCE_MODE_CTR: |
| default: |
| encr_cfg |= (CRYPTO_ENCR_MODE_CTR << CRYPTO_ENCR_MODE); |
| break; |
| } |
| pce_dev->mode = creq->mode; |
| |
| switch (creq->alg) { |
| case CIPHER_ALG_DES: |
| if (creq->mode != QCE_MODE_ECB) |
| memcpy(buffer->encr_cntr_iv, creq->iv, ivsize); |
| |
| encr_cfg |= ((CRYPTO_ENCR_KEY_SZ_DES << CRYPTO_ENCR_KEY_SZ) | |
| (CRYPTO_ENCR_ALG_DES << CRYPTO_ENCR_ALG)); |
| break; |
| |
| case CIPHER_ALG_3DES: |
| if (creq->mode != QCE_MODE_ECB) |
| memcpy(buffer->encr_cntr_iv, creq->iv, ivsize); |
| |
| encr_cfg |= ((CRYPTO_ENCR_KEY_SZ_3DES << CRYPTO_ENCR_KEY_SZ) | |
| (CRYPTO_ENCR_ALG_DES << CRYPTO_ENCR_ALG)); |
| break; |
| |
| case CIPHER_ALG_AES: |
| default: |
| if (creq->mode == QCE_MODE_XTS) { |
| memcpy(buffer->encr_xts_key, (creq->enckey + |
| creq->encklen/2), creq->encklen/2); |
| *((uint32_t *)(buffer->encr_xts_du_size)) = |
| creq->cryptlen; |
| |
| } |
| if (creq->mode != QCE_MODE_ECB) { |
| if (creq->mode == QCE_MODE_XTS) |
| _byte_stream_swap_to_net_words( |
| (uint32_t *)(buffer->encr_cntr_iv), |
| creq->iv, ivsize); |
| else |
| memcpy(buffer->encr_cntr_iv, creq->iv, |
| ivsize); |
| } |
| /* set number of counter bits */ |
| *((uint32_t *)(buffer->encr_mask)) = (uint32_t)0xffffffff; |
| |
| if (creq->op == QCE_REQ_ABLK_CIPHER_NO_KEY) { |
| encr_cfg |= (CRYPTO_ENCR_KEY_SZ_AES128 << |
| CRYPTO_ENCR_KEY_SZ); |
| encr_cfg |= CRYPTO_ENCR_ALG_AES << CRYPTO_ENCR_ALG; |
| } else { |
| uint32_t key_size; |
| |
| if (creq->mode == QCE_MODE_XTS) { |
| key_size = creq->encklen/2; |
| enck_size_in_word = key_size/sizeof(uint32_t); |
| } else { |
| key_size = creq->encklen; |
| } |
| |
| switch (key_size) { |
| case AES128_KEY_SIZE: |
| encr_cfg |= (CRYPTO_ENCR_KEY_SZ_AES128 << |
| CRYPTO_ENCR_KEY_SZ); |
| break; |
| case AES256_KEY_SIZE: |
| default: |
| encr_cfg |= (CRYPTO_ENCR_KEY_SZ_AES256 << |
| CRYPTO_ENCR_KEY_SZ); |
| break; |
| } /* end of switch (creq->encklen) */ |
| |
| encr_cfg |= CRYPTO_ENCR_ALG_AES << CRYPTO_ENCR_ALG; |
| } /* else of if (creq->op == QCE_REQ_ABLK_CIPHER_NO_KEY) */ |
| break; |
| } /* end of switch (creq->mode) */ |
| |
| /* write encr seg cfg */ |
| encr_cfg |= ((creq->dir == QCE_ENCRYPT) ? 1 : 0) << CRYPTO_ENCODE; |
| |
| /* write encr seg cfg */ |
| *((uint32_t *)(buffer->encr_seg_cfg_size_start)) = encr_cfg; |
| /* write encr seg size */ |
| if ((creq->mode == QCE_MODE_CCM) && (creq->dir == QCE_DECRYPT)) |
| *((uint32_t *)(buffer->encr_seg_cfg_size_start) + 1) = |
| (creq->cryptlen + creq->authsize); |
| else |
| *((uint32_t *)(buffer->encr_seg_cfg_size_start) + 1) = |
| creq->cryptlen; |
| |
| |
| *((uint32_t *)(buffer->encr_seg_cfg_size_start) + 2) = |
| (coffset & 0xffff); |
| |
| *((uint32_t *)(buffer->seg_size)) = totallen_in; |
| |
| _ce_setup_cipher_cmdrptrlist(pce_dev, creq); |
| return 0; |
| }; |
| |
| static int _aead_complete(struct qce_device *pce_dev) |
| { |
| struct aead_request *areq; |
| |
| areq = (struct aead_request *) pce_dev->areq; |
| |
| if (areq->src != areq->dst) { |
| dma_unmap_sg(pce_dev->pdev, areq->dst, pce_dev->dst_nents, |
| DMA_FROM_DEVICE); |
| } |
| dma_unmap_sg(pce_dev->pdev, areq->src, pce_dev->src_nents, |
| (areq->src == areq->dst) ? DMA_BIDIRECTIONAL : |
| DMA_TO_DEVICE); |
| |
| dma_unmap_sg(pce_dev->pdev, areq->assoc, pce_dev->assoc_nents, |
| DMA_TO_DEVICE); |
| |
| /* check MAC */ |
| if (pce_dev->mode == QCE_MODE_CCM) { |
| uint32_t result; |
| |
| result = |
| (uint32_t)(*((uint32_t *)pce_dev->ce_dm.buffer.status)); |
| result &= (1 << CRYPTO_MAC_FAILED); |
| result |= (pce_dev->ce_dm.chan_ce_in_status | |
| pce_dev->ce_dm.chan_ce_out_status); |
| pce_dev->qce_cb(areq, pce_dev->ce_dm.buffer.auth_result, NULL, |
| result); |
| } |
| return 0; |
| }; |
| |
| static void _sha_complete(struct qce_device *pce_dev) |
| { |
| struct ahash_request *areq; |
| |
| areq = (struct ahash_request *) pce_dev->areq; |
| dma_unmap_sg(pce_dev->pdev, areq->src, pce_dev->src_nents, |
| DMA_TO_DEVICE); |
| |
| pce_dev->qce_cb(areq, pce_dev->ce_dm.buffer.auth_result, |
| pce_dev->ce_dm.buffer.auth_byte_count, |
| pce_dev->ce_dm.chan_ce_in_status); |
| |
| }; |
| |
| static int _ablk_cipher_complete(struct qce_device *pce_dev) |
| { |
| struct ablkcipher_request *areq; |
| |
| areq = (struct ablkcipher_request *) pce_dev->areq; |
| |
| if (areq->src != areq->dst) { |
| dma_unmap_sg(pce_dev->pdev, areq->dst, |
| pce_dev->dst_nents, DMA_FROM_DEVICE); |
| } |
| dma_unmap_sg(pce_dev->pdev, areq->src, pce_dev->src_nents, |
| (areq->src == areq->dst) ? DMA_BIDIRECTIONAL : |
| DMA_TO_DEVICE); |
| |
| if (pce_dev->mode == QCE_MODE_ECB) { |
| pce_dev->qce_cb(areq, NULL, NULL, |
| pce_dev->ce_dm.chan_ce_in_status | |
| pce_dev->ce_dm.chan_ce_out_status); |
| } else { |
| |
| pce_dev->qce_cb(areq, NULL, pce_dev->ce_dm.buffer.encr_cntr_iv, |
| pce_dev->ce_dm.chan_ce_in_status | |
| pce_dev->ce_dm.chan_ce_out_status); |
| } |
| |
| return 0; |
| }; |
| |
| static int _ablk_cipher_use_pmem_complete(struct qce_device *pce_dev) |
| { |
| struct ablkcipher_request *areq; |
| |
| areq = (struct ablkcipher_request *) pce_dev->areq; |
| |
| if (pce_dev->mode == QCE_MODE_ECB) { |
| pce_dev->qce_cb(areq, NULL, NULL, |
| pce_dev->ce_dm.chan_ce_in_status | |
| pce_dev->ce_dm.chan_ce_out_status); |
| } else { |
| pce_dev->qce_cb(areq, NULL, pce_dev->ce_dm.buffer.encr_cntr_iv, |
| pce_dev->ce_dm.chan_ce_in_status | |
| pce_dev->ce_dm.chan_ce_out_status); |
| } |
| |
| return 0; |
| }; |
| |
| static int qce_split_and_insert_dm_desc(struct dmov_desc *pdesc, |
| unsigned int plen, unsigned int paddr, int *index) |
| { |
| while (plen > QCE_FIFO_SIZE) { |
| pdesc->len = QCE_FIFO_SIZE; |
| if (paddr > 0) { |
| pdesc->addr = paddr; |
| paddr += QCE_FIFO_SIZE; |
| } |
| plen -= pdesc->len; |
| if (plen > 0) { |
| *index = (*index) + 1; |
| if ((*index) >= QCE_MAX_NUM_DESC) |
| return -ENOMEM; |
| pdesc++; |
| } |
| } |
| if ((plen > 0) && (plen <= QCE_FIFO_SIZE)) { |
| pdesc->len = plen; |
| if (paddr > 0) |
| pdesc->addr = paddr; |
| } |
| |
| return 0; |
| } |
| |
| static int _chain_sg_buffer_in(struct qce_device *pce_dev, |
| struct scatterlist *sg, unsigned int nbytes) |
| { |
| unsigned int len; |
| unsigned int dlen; |
| struct dmov_desc *pdesc; |
| |
| pdesc = pce_dev->ce_dm.ce_in_src_desc + |
| pce_dev->ce_dm.ce_in_src_desc_index; |
| /* |
| * Two consective chunks may be handled by the old |
| * buffer descriptor. |
| */ |
| while (nbytes > 0) { |
| len = min(nbytes, sg_dma_len(sg)); |
| dlen = pdesc->len & ADM_DESC_LENGTH_MASK; |
| nbytes -= len; |
| if (dlen == 0) { |
| pdesc->addr = sg_dma_address(sg); |
| pdesc->len = len; |
| if (pdesc->len > QCE_FIFO_SIZE) |
| qce_split_and_insert_dm_desc(pdesc, pdesc->len, |
| sg_dma_address(sg), |
| &pce_dev->ce_dm.ce_in_src_desc_index); |
| } else if (sg_dma_address(sg) == (pdesc->addr + dlen)) { |
| pdesc->len = dlen + len; |
| if (pdesc->len > QCE_FIFO_SIZE) |
| qce_split_and_insert_dm_desc(pdesc, pdesc->len, |
| pdesc->addr, |
| &pce_dev->ce_dm.ce_in_src_desc_index); |
| } else { |
| pce_dev->ce_dm.ce_in_src_desc_index++; |
| if (pce_dev->ce_dm.ce_in_src_desc_index >= |
| QCE_MAX_NUM_DESC) |
| return -ENOMEM; |
| pdesc++; |
| pdesc->len = len; |
| pdesc->addr = sg_dma_address(sg); |
| if (pdesc->len > QCE_FIFO_SIZE) |
| qce_split_and_insert_dm_desc(pdesc, pdesc->len, |
| sg_dma_address(sg), |
| &pce_dev->ce_dm.ce_in_src_desc_index); |
| } |
| if (nbytes > 0) |
| sg = sg_next(sg); |
| } |
| return 0; |
| } |
| |
| static int _chain_pm_buffer_in(struct qce_device *pce_dev, |
| unsigned int pmem, unsigned int nbytes) |
| { |
| unsigned int dlen; |
| struct dmov_desc *pdesc; |
| |
| pdesc = pce_dev->ce_dm.ce_in_src_desc + |
| pce_dev->ce_dm.ce_in_src_desc_index; |
| dlen = pdesc->len & ADM_DESC_LENGTH_MASK; |
| if (dlen == 0) { |
| pdesc->addr = pmem; |
| pdesc->len = nbytes; |
| } else if (pmem == (pdesc->addr + dlen)) { |
| pdesc->len = dlen + nbytes; |
| } else { |
| pce_dev->ce_dm.ce_in_src_desc_index++; |
| if (pce_dev->ce_dm.ce_in_src_desc_index >= |
| QCE_MAX_NUM_DESC) |
| return -ENOMEM; |
| pdesc++; |
| pdesc->len = nbytes; |
| pdesc->addr = pmem; |
| } |
| return 0; |
| } |
| |
| static void _chain_buffer_in_init(struct qce_device *pce_dev) |
| { |
| struct dmov_desc *pdesc; |
| |
| pce_dev->ce_dm.ce_in_src_desc_index = 0; |
| pce_dev->ce_dm.ce_in_dst_desc_index = 0; |
| pdesc = pce_dev->ce_dm.ce_in_src_desc; |
| pdesc->len = 0; |
| } |
| |
| static void _ce_in_final(struct qce_device *pce_dev, unsigned total) |
| { |
| struct dmov_desc *pdesc; |
| dmov_sg *pcmd; |
| |
| pdesc = pce_dev->ce_dm.ce_in_src_desc + |
| pce_dev->ce_dm.ce_in_src_desc_index; |
| pdesc->len |= ADM_DESC_LAST; |
| |
| pdesc = pce_dev->ce_dm.ce_in_dst_desc; |
| if (total > QCE_FIFO_SIZE) { |
| qce_split_and_insert_dm_desc(pdesc, total, 0, |
| &pce_dev->ce_dm.ce_in_dst_desc_index); |
| pdesc = pce_dev->ce_dm.ce_in_dst_desc + |
| pce_dev->ce_dm.ce_in_dst_desc_index; |
| pdesc->len |= ADM_DESC_LAST; |
| } else |
| pdesc->len = ADM_DESC_LAST | total; |
| |
| pcmd = (dmov_sg *) pce_dev->ce_dm.cmdlist.ce_data_in; |
| pcmd->cmd |= CMD_LC; |
| |
| } |
| |
| #ifdef QCE_DEBUG |
| static void _ce_in_dump(struct qce_device *pce_dev) |
| { |
| int i; |
| struct dmov_desc *pdesc; |
| |
| dev_info(pce_dev->pdev, "_ce_in_dump: src\n"); |
| for (i = 0; i <= pce_dev->ce_dm.ce_in_src_desc_index; i++) { |
| pdesc = pce_dev->ce_dm.ce_in_src_desc + i; |
| dev_info(pce_dev->pdev, "%x , %x\n", pdesc->addr, |
| pdesc->len); |
| } |
| dev_info(pce_dev->pdev, "_ce_in_dump: dst\n"); |
| for (i = 0; i <= pce_dev->ce_dm.ce_in_dst_desc_index; i++) { |
| pdesc = pce_dev->ce_dm.ce_in_dst_desc + i; |
| dev_info(pce_dev->pdev, "%x , %x\n", pdesc->addr, |
| pdesc->len); |
| } |
| }; |
| |
| static void _ce_out_dump(struct qce_device *pce_dev) |
| { |
| int i; |
| struct dmov_desc *pdesc; |
| |
| dev_info(pce_dev->pdev, "_ce_out_dump: src\n"); |
| for (i = 0; i <= pce_dev->ce_dm.ce_out_src_desc_index; i++) { |
| pdesc = pce_dev->ce_dm.ce_out_src_desc + i; |
| dev_info(pce_dev->pdev, "%x , %x\n", pdesc->addr, |
| pdesc->len); |
| } |
| |
| dev_info(pce_dev->pdev, "_ce_out_dump: dst\n"); |
| for (i = 0; i <= pce_dev->ce_dm.ce_out_dst_desc_index; i++) { |
| pdesc = pce_dev->ce_dm.ce_out_dst_desc + i; |
| dev_info(pce_dev->pdev, "%x , %x\n", pdesc->addr, |
| pdesc->len); |
| } |
| }; |
| |
| #else |
| |
| static void _ce_in_dump(struct qce_device *pce_dev) |
| { |
| }; |
| |
| static void _ce_out_dump(struct qce_device *pce_dev) |
| { |
| }; |
| |
| #endif |
| |
| static int _chain_sg_buffer_out(struct qce_device *pce_dev, |
| struct scatterlist *sg, unsigned int nbytes) |
| { |
| unsigned int len; |
| unsigned int dlen; |
| struct dmov_desc *pdesc; |
| |
| pdesc = pce_dev->ce_dm.ce_out_dst_desc + |
| pce_dev->ce_dm.ce_out_dst_desc_index; |
| /* |
| * Two consective chunks may be handled by the old |
| * buffer descriptor. |
| */ |
| while (nbytes > 0) { |
| len = min(nbytes, sg_dma_len(sg)); |
| dlen = pdesc->len & ADM_DESC_LENGTH_MASK; |
| nbytes -= len; |
| if (dlen == 0) { |
| pdesc->addr = sg_dma_address(sg); |
| pdesc->len = len; |
| if (pdesc->len > QCE_FIFO_SIZE) |
| qce_split_and_insert_dm_desc(pdesc, pdesc->len, |
| sg_dma_address(sg), |
| &pce_dev->ce_dm.ce_out_dst_desc_index); |
| } else if (sg_dma_address(sg) == (pdesc->addr + dlen)) { |
| pdesc->len = dlen + len; |
| if (pdesc->len > QCE_FIFO_SIZE) |
| qce_split_and_insert_dm_desc(pdesc, pdesc->len, |
| pdesc->addr, |
| &pce_dev->ce_dm.ce_out_dst_desc_index); |
| |
| } else { |
| pce_dev->ce_dm.ce_out_dst_desc_index++; |
| if (pce_dev->ce_dm.ce_out_dst_desc_index >= |
| QCE_MAX_NUM_DESC) |
| return -EIO; |
| pdesc++; |
| pdesc->len = len; |
| pdesc->addr = sg_dma_address(sg); |
| if (pdesc->len > QCE_FIFO_SIZE) |
| qce_split_and_insert_dm_desc(pdesc, pdesc->len, |
| sg_dma_address(sg), |
| &pce_dev->ce_dm.ce_out_dst_desc_index); |
| |
| } |
| if (nbytes > 0) |
| sg = sg_next(sg); |
| } |
| return 0; |
| } |
| |
| static int _chain_pm_buffer_out(struct qce_device *pce_dev, |
| unsigned int pmem, unsigned int nbytes) |
| { |
| unsigned int dlen; |
| struct dmov_desc *pdesc; |
| |
| pdesc = pce_dev->ce_dm.ce_out_dst_desc + |
| pce_dev->ce_dm.ce_out_dst_desc_index; |
| dlen = pdesc->len & ADM_DESC_LENGTH_MASK; |
| |
| if (dlen == 0) { |
| pdesc->addr = pmem; |
| pdesc->len = nbytes; |
| } else if (pmem == (pdesc->addr + dlen)) { |
| pdesc->len = dlen + nbytes; |
| } else { |
| pce_dev->ce_dm.ce_out_dst_desc_index++; |
| if (pce_dev->ce_dm.ce_out_dst_desc_index >= QCE_MAX_NUM_DESC) |
| return -EIO; |
| pdesc++; |
| pdesc->len = nbytes; |
| pdesc->addr = pmem; |
| } |
| return 0; |
| }; |
| |
| static void _chain_buffer_out_init(struct qce_device *pce_dev) |
| { |
| struct dmov_desc *pdesc; |
| |
| pce_dev->ce_dm.ce_out_dst_desc_index = 0; |
| pce_dev->ce_dm.ce_out_src_desc_index = 0; |
| pdesc = pce_dev->ce_dm.ce_out_dst_desc; |
| pdesc->len = 0; |
| }; |
| |
| static void _ce_out_final(struct qce_device *pce_dev, unsigned total) |
| { |
| struct dmov_desc *pdesc; |
| dmov_sg *pcmd; |
| |
| pdesc = pce_dev->ce_dm.ce_out_dst_desc + |
| pce_dev->ce_dm.ce_out_dst_desc_index; |
| pdesc->len |= ADM_DESC_LAST; |
| |
| pdesc = pce_dev->ce_dm.ce_out_src_desc + |
| pce_dev->ce_dm.ce_out_src_desc_index; |
| if (total > QCE_FIFO_SIZE) { |
| qce_split_and_insert_dm_desc(pdesc, total, 0, |
| &pce_dev->ce_dm.ce_out_src_desc_index); |
| pdesc = pce_dev->ce_dm.ce_out_src_desc + |
| pce_dev->ce_dm.ce_out_src_desc_index; |
| pdesc->len |= ADM_DESC_LAST; |
| } else |
| pdesc->len = ADM_DESC_LAST | total; |
| |
| pcmd = (dmov_sg *) pce_dev->ce_dm.cmdlist.ce_data_out; |
| pcmd->cmd |= CMD_LC; |
| }; |
| |
| static void _aead_ce_in_call_back(struct msm_dmov_cmd *cmd_ptr, |
| unsigned int result, struct msm_dmov_errdata *err) |
| { |
| struct qce_device *pce_dev; |
| |
| pce_dev = (struct qce_device *) cmd_ptr->user; |
| if (result != ADM_STATUS_OK) { |
| dev_err(pce_dev->pdev, "Qualcomm ADM status error %x\n", |
| result); |
| pce_dev->ce_dm.chan_ce_in_status = -1; |
| } else { |
| pce_dev->ce_dm.chan_ce_in_status = 0; |
| } |
| |
| pce_dev->ce_dm.chan_ce_in_state = QCE_CHAN_STATE_COMP; |
| if (pce_dev->ce_dm.chan_ce_out_state == QCE_CHAN_STATE_COMP) { |
| pce_dev->ce_dm.chan_ce_in_state = QCE_CHAN_STATE_IDLE; |
| pce_dev->ce_dm.chan_ce_out_state = QCE_CHAN_STATE_IDLE; |
| |
| /* done */ |
| _aead_complete(pce_dev); |
| } |
| }; |
| |
| static void _aead_ce_out_call_back(struct msm_dmov_cmd *cmd_ptr, |
| unsigned int result, struct msm_dmov_errdata *err) |
| { |
| struct qce_device *pce_dev; |
| |
| pce_dev = (struct qce_device *) cmd_ptr->user; |
| if (result != ADM_STATUS_OK) { |
| dev_err(pce_dev->pdev, "Qualcomm ADM status error %x\n", |
| result); |
| pce_dev->ce_dm.chan_ce_out_status = -1; |
| } else { |
| pce_dev->ce_dm.chan_ce_out_status = 0; |
| }; |
| |
| pce_dev->ce_dm.chan_ce_out_state = QCE_CHAN_STATE_COMP; |
| if (pce_dev->ce_dm.chan_ce_in_state == QCE_CHAN_STATE_COMP) { |
| pce_dev->ce_dm.chan_ce_in_state = QCE_CHAN_STATE_IDLE; |
| pce_dev->ce_dm.chan_ce_out_state = QCE_CHAN_STATE_IDLE; |
| |
| /* done */ |
| _aead_complete(pce_dev); |
| } |
| |
| }; |
| |
| static void _sha_ce_in_call_back(struct msm_dmov_cmd *cmd_ptr, |
| unsigned int result, struct msm_dmov_errdata *err) |
| { |
| struct qce_device *pce_dev; |
| |
| pce_dev = (struct qce_device *) cmd_ptr->user; |
| if (result != ADM_STATUS_OK) { |
| dev_err(pce_dev->pdev, "Qualcomm ADM status error %x\n", |
| result); |
| pce_dev->ce_dm.chan_ce_in_status = -1; |
| } else { |
| pce_dev->ce_dm.chan_ce_in_status = 0; |
| } |
| pce_dev->ce_dm.chan_ce_in_state = QCE_CHAN_STATE_IDLE; |
| _sha_complete(pce_dev); |
| }; |
| |
| static void _ablk_cipher_ce_in_call_back(struct msm_dmov_cmd *cmd_ptr, |
| unsigned int result, struct msm_dmov_errdata *err) |
| { |
| struct qce_device *pce_dev; |
| |
| pce_dev = (struct qce_device *) cmd_ptr->user; |
| if (result != ADM_STATUS_OK) { |
| dev_err(pce_dev->pdev, "Qualcomm ADM status error %x\n", |
| result); |
| pce_dev->ce_dm.chan_ce_in_status = -1; |
| } else { |
| pce_dev->ce_dm.chan_ce_in_status = 0; |
| } |
| |
| pce_dev->ce_dm.chan_ce_in_state = QCE_CHAN_STATE_COMP; |
| if (pce_dev->ce_dm.chan_ce_out_state == QCE_CHAN_STATE_COMP) { |
| pce_dev->ce_dm.chan_ce_in_state = QCE_CHAN_STATE_IDLE; |
| pce_dev->ce_dm.chan_ce_out_state = QCE_CHAN_STATE_IDLE; |
| |
| /* done */ |
| _ablk_cipher_complete(pce_dev); |
| } |
| }; |
| |
| static void _ablk_cipher_ce_out_call_back(struct msm_dmov_cmd *cmd_ptr, |
| unsigned int result, struct msm_dmov_errdata *err) |
| { |
| struct qce_device *pce_dev; |
| |
| pce_dev = (struct qce_device *) cmd_ptr->user; |
| |
| if (result != ADM_STATUS_OK) { |
| dev_err(pce_dev->pdev, "Qualcomm ADM status error %x\n", |
| result); |
| pce_dev->ce_dm.chan_ce_out_status = -1; |
| } else { |
| pce_dev->ce_dm.chan_ce_out_status = 0; |
| }; |
| |
| pce_dev->ce_dm.chan_ce_out_state = QCE_CHAN_STATE_COMP; |
| if (pce_dev->ce_dm.chan_ce_in_state == QCE_CHAN_STATE_COMP) { |
| pce_dev->ce_dm.chan_ce_in_state = QCE_CHAN_STATE_IDLE; |
| pce_dev->ce_dm.chan_ce_out_state = QCE_CHAN_STATE_IDLE; |
| |
| /* done */ |
| _ablk_cipher_complete(pce_dev); |
| } |
| }; |
| |
| |
| static void _ablk_cipher_ce_in_call_back_pmem(struct msm_dmov_cmd *cmd_ptr, |
| unsigned int result, struct msm_dmov_errdata *err) |
| { |
| struct qce_device *pce_dev; |
| pce_dev = (struct qce_device *) cmd_ptr->user; |
| if (result != ADM_STATUS_OK) { |
| dev_err(pce_dev->pdev, "Qualcomm ADM status error %x\n", |
| result); |
| pce_dev->ce_dm.chan_ce_in_status = -1; |
| } else { |
| pce_dev->ce_dm.chan_ce_in_status = 0; |
| } |
| |
| pce_dev->ce_dm.chan_ce_in_state = QCE_CHAN_STATE_COMP; |
| if (pce_dev->ce_dm.chan_ce_out_state == QCE_CHAN_STATE_COMP) { |
| pce_dev->ce_dm.chan_ce_in_state = QCE_CHAN_STATE_IDLE; |
| pce_dev->ce_dm.chan_ce_out_state = QCE_CHAN_STATE_IDLE; |
| |
| /* done */ |
| _ablk_cipher_use_pmem_complete(pce_dev); |
| } |
| }; |
| |
| static void _ablk_cipher_ce_out_call_back_pmem(struct msm_dmov_cmd *cmd_ptr, |
| unsigned int result, struct msm_dmov_errdata *err) |
| { |
| struct qce_device *pce_dev; |
| |
| pce_dev = (struct qce_device *) cmd_ptr->user; |
| if (result != ADM_STATUS_OK) { |
| dev_err(pce_dev->pdev, "Qualcomm ADM status error %x\n", |
| result); |
| pce_dev->ce_dm.chan_ce_out_status = -1; |
| } else { |
| pce_dev->ce_dm.chan_ce_out_status = 0; |
| }; |
| |
| pce_dev->ce_dm.chan_ce_out_state = QCE_CHAN_STATE_COMP; |
| if (pce_dev->ce_dm.chan_ce_in_state == QCE_CHAN_STATE_COMP) { |
| pce_dev->ce_dm.chan_ce_in_state = QCE_CHAN_STATE_IDLE; |
| pce_dev->ce_dm.chan_ce_out_state = QCE_CHAN_STATE_IDLE; |
| |
| /* done */ |
| _ablk_cipher_use_pmem_complete(pce_dev); |
| } |
| }; |
| |
| static int qce_setup_cmd_buffers(struct qce_device *pce_dev, |
| unsigned char **pvaddr) |
| { |
| struct ce_reg_buffers *addr = (struct ce_reg_buffers *)(*pvaddr); |
| struct ce_reg_buffer_addr *buffer = &pce_dev->ce_dm.buffer; |
| |
| /* |
| * Designate chunks of the allocated memory to various |
| * buffer pointers |
| */ |
| buffer->reset_buf_64 = addr->reset_buf_64; |
| buffer->version = addr->version; |
| buffer->encr_seg_cfg_size_start = addr->encr_seg_cfg_size_start; |
| buffer->encr_key = addr->encr_key; |
| buffer->encr_xts_key = addr->encr_xts_key; |
| buffer->encr_xts_du_size = addr->encr_xts_du_size; |
| buffer->encr_cntr_iv = addr->encr_cntr_iv; |
| buffer->encr_mask = addr->encr_mask; |
| buffer->auth_seg_cfg_size_start = addr->auth_seg_cfg_size_start; |
| buffer->auth_key = addr->auth_key; |
| buffer->auth_iv = addr->auth_iv; |
| buffer->auth_result = addr->auth_result; |
| buffer->auth_nonce_info = addr->auth_nonce_info; |
| buffer->auth_byte_count = addr->auth_byte_count; |
| buffer->seg_size = addr->seg_size; |
| buffer->go_proc = addr->go_proc; |
| buffer->status = addr->status; |
| buffer->pad = addr->pad; |
| |
| memset(buffer->reset_buf_64, 0, 64); |
| *((uint32_t *)buffer->encr_mask) = (uint32_t)(0xffffffff); |
| *((uint32_t *)buffer->go_proc) = (uint32_t)(1 << CRYPTO_GO); |
| |
| *pvaddr += sizeof(struct ce_reg_buffers); |
| |
| return 0; |
| |
| } |
| |
| static int _setup_cipher_cmdlists(struct qce_device *pce_dev, |
| unsigned char **pvaddr) |
| { |
| dmov_s *pscmd = (dmov_s *)(*pvaddr); |
| |
| /* |
| * Designate chunks of the allocated memory to various |
| * command list pointers related to cipher operation |
| */ |
| pce_dev->ce_dm.cmdlist.set_cipher_cfg = pscmd; |
| pscmd->cmd = CMD_LC | CMD_MODE_SINGLE; |
| pscmd->dst = (unsigned) (CRYPTO_ENCR_SEG_CFG_REG + |
| pce_dev->phy_iobase); |
| pscmd->len = CRYPTO_REG_SIZE * 3; |
| pscmd->src = |
| GET_PHYS_ADDR(pce_dev->ce_dm.buffer.encr_seg_cfg_size_start); |
| pscmd++; |
| |
| pce_dev->ce_dm.cmdlist.set_cipher_aes_128_key = pscmd; |
| pscmd->cmd = CMD_LC | CMD_SRC_SWAP_BYTES | |
| CMD_SRC_SWAP_SHORTS | CMD_MODE_SINGLE; |
| pscmd->dst = (unsigned) (CRYPTO_ENCR_KEY0_REG + pce_dev->phy_iobase); |
| pscmd->len = CRYPTO_REG_SIZE * 4; |
| pscmd->src = GET_PHYS_ADDR(pce_dev->ce_dm.buffer.encr_key); |
| pscmd++; |
| |
| pce_dev->ce_dm.cmdlist.set_cipher_aes_256_key = pscmd; |
| pscmd->cmd = CMD_LC | CMD_SRC_SWAP_BYTES | |
| CMD_SRC_SWAP_SHORTS | CMD_MODE_SINGLE; |
| pscmd->dst = (unsigned) (CRYPTO_ENCR_KEY0_REG + pce_dev->phy_iobase); |
| pscmd->len = CRYPTO_REG_SIZE * 8; |
| pscmd->src = GET_PHYS_ADDR(pce_dev->ce_dm.buffer.encr_key); |
| pscmd++; |
| |
| pce_dev->ce_dm.cmdlist.set_cipher_des_key = pscmd; |
| pscmd->cmd = CMD_LC | CMD_SRC_SWAP_BYTES | |
| CMD_SRC_SWAP_SHORTS | CMD_MODE_SINGLE; |
| pscmd->dst = (unsigned) (CRYPTO_ENCR_KEY0_REG + pce_dev->phy_iobase); |
| pscmd->len = CRYPTO_REG_SIZE * 2; |
| pscmd->src = GET_PHYS_ADDR(pce_dev->ce_dm.buffer.encr_key); |
| pscmd++; |
| |
| pce_dev->ce_dm.cmdlist.set_cipher_3des_key = pscmd; |
| pscmd->cmd = CMD_LC | CMD_SRC_SWAP_BYTES | |
| CMD_SRC_SWAP_SHORTS | CMD_MODE_SINGLE; |
| pscmd->dst = (unsigned) (CRYPTO_ENCR_KEY0_REG + pce_dev->phy_iobase); |
| pscmd->len = CRYPTO_REG_SIZE * 6; |
| pscmd->src = GET_PHYS_ADDR(pce_dev->ce_dm.buffer.encr_key); |
| pscmd++; |
| |
| pce_dev->ce_dm.cmdlist.set_cipher_aes_128_xts_key = pscmd; |
| pscmd->cmd = CMD_LC | CMD_SRC_SWAP_BYTES | |
| CMD_SRC_SWAP_SHORTS | CMD_MODE_SINGLE; |
| pscmd->dst = (unsigned) (CRYPTO_ENCR_XTS_KEY0_REG + |
| pce_dev->phy_iobase); |
| pscmd->len = CRYPTO_REG_SIZE * 4; |
| pscmd->src = GET_PHYS_ADDR(pce_dev->ce_dm.buffer.encr_xts_key); |
| pscmd++; |
| |
| pce_dev->ce_dm.cmdlist.set_cipher_aes_256_xts_key = pscmd; |
| pscmd->cmd = CMD_LC | CMD_SRC_SWAP_BYTES | |
| CMD_SRC_SWAP_SHORTS | CMD_MODE_SINGLE; |
| pscmd->dst = (unsigned) (CRYPTO_ENCR_XTS_KEY0_REG + |
| pce_dev->phy_iobase); |
| pscmd->len = CRYPTO_REG_SIZE * 8; |
| pscmd->src = GET_PHYS_ADDR(pce_dev->ce_dm.buffer.encr_xts_key); |
| pscmd++; |
| |
| pce_dev->ce_dm.cmdlist.set_cipher_xts_du_size = pscmd; |
| pscmd->cmd = CMD_LC | CMD_MODE_SINGLE; |
| pscmd->dst = (unsigned) (CRYPTO_ENCR_XTS_DU_SIZE_REG + |
| pce_dev->phy_iobase); |
| pscmd->len = CRYPTO_REG_SIZE * 4; |
| pscmd->src = GET_PHYS_ADDR(pce_dev->ce_dm.buffer.encr_xts_du_size); |
| pscmd++; |
| |
| pce_dev->ce_dm.cmdlist.set_cipher_aes_iv = pscmd; |
| pscmd->cmd = CMD_LC | CMD_SRC_SWAP_BYTES | |
| CMD_SRC_SWAP_SHORTS | CMD_MODE_SINGLE; |
| pscmd->dst = (unsigned) (CRYPTO_CNTR0_IV0_REG + pce_dev->phy_iobase); |
| pscmd->len = CRYPTO_REG_SIZE * 4; |
| pscmd->src = GET_PHYS_ADDR(pce_dev->ce_dm.buffer.encr_cntr_iv); |
| pscmd++; |
| |
| pce_dev->ce_dm.cmdlist.set_cipher_des_iv = pscmd; |
| pscmd->cmd = CMD_LC | CMD_SRC_SWAP_BYTES | |
| CMD_SRC_SWAP_SHORTS | CMD_MODE_SINGLE; |
| pscmd->dst = (unsigned) (CRYPTO_CNTR0_IV0_REG + pce_dev->phy_iobase); |
| pscmd->len = CRYPTO_REG_SIZE * 2; |
| pscmd->src = GET_PHYS_ADDR(pce_dev->ce_dm.buffer.encr_cntr_iv); |
| pscmd++; |
| |
| pce_dev->ce_dm.cmdlist.get_cipher_iv = pscmd; |
| pscmd->cmd = CMD_LC | CMD_SRC_SWAP_BYTES | |
| CMD_SRC_SWAP_SHORTS | CMD_MODE_SINGLE; |
| pscmd->src = (unsigned) (CRYPTO_CNTR0_IV0_REG + pce_dev->phy_iobase); |
| pscmd->len = CRYPTO_REG_SIZE * 4; |
| pscmd->dst = GET_PHYS_ADDR(pce_dev->ce_dm.buffer.encr_cntr_iv); |
| pscmd++; |
| |
| pce_dev->ce_dm.cmdlist.set_cipher_mask = pscmd; |
| pscmd->cmd = CMD_LC | CMD_MODE_SINGLE; |
| pscmd->dst = (unsigned) (CRYPTO_CNTR_MASK_REG + pce_dev->phy_iobase); |
| pscmd->len = CRYPTO_REG_SIZE; |
| pscmd->src = GET_PHYS_ADDR(pce_dev->ce_dm.buffer.encr_mask); |
| pscmd++; |
| |
| /* RESET CIPHER AND AUTH REGISTERS COMMAND LISTS*/ |
| |
| pce_dev->ce_dm.cmdlist.reset_cipher_key = pscmd; |
| pscmd->cmd = CMD_LC | CMD_MODE_SINGLE; |
| pscmd->dst = (unsigned) (CRYPTO_ENCR_KEY0_REG + pce_dev->phy_iobase); |
| pscmd->len = CRYPTO_REG_SIZE * 8; |
| pscmd->src = GET_PHYS_ADDR(pce_dev->ce_dm.buffer.reset_buf_64); |
| pscmd++; |
| |
| pce_dev->ce_dm.cmdlist.reset_cipher_xts_key = pscmd; |
| pscmd->cmd = CMD_LC | CMD_MODE_SINGLE; |
| pscmd->dst = (unsigned) (CRYPTO_ENCR_XTS_KEY0_REG + |
| pce_dev->phy_iobase); |
| pscmd->len = CRYPTO_REG_SIZE * 8; |
| pscmd->src = GET_PHYS_ADDR(pce_dev->ce_dm.buffer.reset_buf_64); |
| pscmd++; |
| |
| pce_dev->ce_dm.cmdlist.reset_cipher_iv = pscmd; |
| pscmd->cmd = CMD_LC | CMD_MODE_SINGLE; |
| pscmd->dst = (unsigned) (CRYPTO_CNTR0_IV0_REG + pce_dev->phy_iobase); |
| pscmd->len = CRYPTO_REG_SIZE * 4; |
| pscmd->src = GET_PHYS_ADDR(pce_dev->ce_dm.buffer.reset_buf_64); |
| pscmd++; |
| |
| pce_dev->ce_dm.cmdlist.reset_cipher_cfg = pscmd; |
| pscmd->cmd = CMD_LC | CMD_MODE_SINGLE; |
| pscmd->dst = (unsigned) (CRYPTO_ENCR_SEG_CFG_REG + pce_dev->phy_iobase); |
| pscmd->len = CRYPTO_REG_SIZE; |
| pscmd->src = GET_PHYS_ADDR(pce_dev->ce_dm.buffer.reset_buf_64); |
| pscmd++; |
| |
| *pvaddr = (unsigned char *) pscmd; |
| |
| return 0; |
| } |
| |
| static int _setup_auth_cmdlists(struct qce_device *pce_dev, |
| unsigned char **pvaddr) |
| { |
| dmov_s *pscmd = (dmov_s *)(*pvaddr); |
| |
| /* |
| * Designate chunks of the allocated memory to various |
| * command list pointers related to authentication operation |
| */ |
| pce_dev->ce_dm.cmdlist.set_auth_cfg = pscmd; |
| pscmd->cmd = CMD_LC | CMD_MODE_SINGLE; |
| pscmd->dst = (unsigned) (CRYPTO_AUTH_SEG_CFG_REG + pce_dev->phy_iobase); |
| pscmd->len = CRYPTO_REG_SIZE * 3; |
| pscmd->src = |
| GET_PHYS_ADDR(pce_dev->ce_dm.buffer.auth_seg_cfg_size_start); |
| pscmd++; |
| |
| pce_dev->ce_dm.cmdlist.set_auth_key_128 = pscmd; |
| pscmd->cmd = CMD_LC | CMD_SRC_SWAP_BYTES | |
| CMD_SRC_SWAP_SHORTS | CMD_MODE_SINGLE; |
| pscmd->dst = (unsigned) (CRYPTO_AUTH_KEY0_REG + pce_dev->phy_iobase); |
| pscmd->len = CRYPTO_REG_SIZE * 4; |
| pscmd->src = GET_PHYS_ADDR(pce_dev->ce_dm.buffer.auth_key); |
| pscmd++; |
| |
| pce_dev->ce_dm.cmdlist.set_auth_key_256 = pscmd; |
| pscmd->cmd = CMD_LC | CMD_SRC_SWAP_BYTES | |
| CMD_SRC_SWAP_SHORTS | CMD_MODE_SINGLE; |
| pscmd->dst = (unsigned) (CRYPTO_AUTH_KEY0_REG + pce_dev->phy_iobase); |
| pscmd->len = CRYPTO_REG_SIZE * 8; |
| pscmd->src = GET_PHYS_ADDR(pce_dev->ce_dm.buffer.auth_key); |
| pscmd++; |
| |
| pce_dev->ce_dm.cmdlist.set_auth_key_512 = pscmd; |
| pscmd->cmd = CMD_LC | CMD_SRC_SWAP_BYTES | |
| CMD_SRC_SWAP_SHORTS | CMD_MODE_SINGLE; |
| pscmd->dst = (unsigned) (CRYPTO_AUTH_KEY0_REG + pce_dev->phy_iobase); |
| pscmd->len = CRYPTO_REG_SIZE * 16; |
| pscmd->src = GET_PHYS_ADDR(pce_dev->ce_dm.buffer.auth_key); |
| pscmd++; |
| |
| pce_dev->ce_dm.cmdlist.set_auth_iv_16 = pscmd; |
| pscmd->cmd = CMD_LC | CMD_SRC_SWAP_BYTES | |
| CMD_SRC_SWAP_SHORTS | CMD_MODE_SINGLE; |
| pscmd->dst = (unsigned) (CRYPTO_AUTH_IV0_REG + pce_dev->phy_iobase); |
| pscmd->len = CRYPTO_REG_SIZE * 4; |
| pscmd->src = GET_PHYS_ADDR(pce_dev->ce_dm.buffer.auth_iv); |
| pscmd++; |
| |
| pce_dev->ce_dm.cmdlist.get_auth_result_16 = pscmd; |
| pscmd->cmd = CMD_LC | CMD_SRC_SWAP_BYTES | |
| CMD_SRC_SWAP_SHORTS | CMD_MODE_SINGLE; |
| pscmd->src = (unsigned) (CRYPTO_AUTH_IV0_REG + pce_dev->phy_iobase); |
| pscmd->len = CRYPTO_REG_SIZE * 4; |
| pscmd->dst = GET_PHYS_ADDR(pce_dev->ce_dm.buffer.auth_result); |
| pscmd++; |
| |
| pce_dev->ce_dm.cmdlist.set_auth_iv_20 = pscmd; |
| pscmd->cmd = CMD_LC | CMD_SRC_SWAP_BYTES | |
| CMD_SRC_SWAP_SHORTS | CMD_MODE_SINGLE; |
| pscmd->dst = (unsigned) (CRYPTO_AUTH_IV0_REG + pce_dev->phy_iobase); |
| pscmd->len = CRYPTO_REG_SIZE * 5; |
| pscmd->src = GET_PHYS_ADDR(pce_dev->ce_dm.buffer.auth_iv); |
| pscmd++; |
| |
| pce_dev->ce_dm.cmdlist.get_auth_result_20 = pscmd; |
| pscmd->cmd = CMD_LC | CMD_SRC_SWAP_BYTES | |
| CMD_SRC_SWAP_SHORTS | CMD_MODE_SINGLE; |
| pscmd->src = (unsigned) (CRYPTO_AUTH_IV0_REG + pce_dev->phy_iobase); |
| pscmd->len = CRYPTO_REG_SIZE * 5; |
| pscmd->dst = GET_PHYS_ADDR(pce_dev->ce_dm.buffer.auth_result); |
| pscmd++; |
| |
| pce_dev->ce_dm.cmdlist.set_auth_iv_32 = pscmd; |
| pscmd->cmd = CMD_LC | CMD_SRC_SWAP_BYTES | |
| CMD_SRC_SWAP_SHORTS | CMD_MODE_SINGLE; |
| pscmd->dst = (unsigned) (CRYPTO_AUTH_IV0_REG + pce_dev->phy_iobase); |
| pscmd->len = CRYPTO_REG_SIZE * 8; |
| pscmd->src = GET_PHYS_ADDR(pce_dev->ce_dm.buffer.auth_iv); |
| pscmd++; |
| |
| |
| pce_dev->ce_dm.cmdlist.get_auth_result_32 = pscmd; |
| pscmd->cmd = CMD_LC | CMD_SRC_SWAP_BYTES | |
| CMD_SRC_SWAP_SHORTS | CMD_MODE_SINGLE; |
| pscmd->src = (unsigned) (CRYPTO_AUTH_IV0_REG + pce_dev->phy_iobase); |
| pscmd->len = CRYPTO_REG_SIZE * 8; |
| pscmd->dst = GET_PHYS_ADDR(pce_dev->ce_dm.buffer.auth_result); |
| pscmd++; |
| |
| pce_dev->ce_dm.cmdlist.set_auth_byte_count = pscmd; |
| pscmd->cmd = CMD_LC | CMD_MODE_SINGLE; |
| pscmd->dst = (unsigned) (CRYPTO_AUTH_BYTECNT0_REG + |
| pce_dev->phy_iobase); |
| pscmd->len = CRYPTO_REG_SIZE * 4; |
| pscmd->src = GET_PHYS_ADDR(pce_dev->ce_dm.buffer.auth_byte_count); |
| pscmd++; |
| |
| pce_dev->ce_dm.cmdlist.get_auth_byte_count = pscmd; |
| pscmd->cmd = CMD_LC | CMD_MODE_SINGLE; |
| pscmd->src = (unsigned) (CRYPTO_AUTH_BYTECNT0_REG + |
| pce_dev->phy_iobase); |
| pscmd->len = CRYPTO_REG_SIZE * 4; |
| pscmd->dst = GET_PHYS_ADDR(pce_dev->ce_dm.buffer.auth_byte_count); |
| pscmd++; |
| |
| pce_dev->ce_dm.cmdlist.set_auth_nonce_info = pscmd; |
| pscmd->cmd = CMD_LC | CMD_SRC_SWAP_BYTES | |
| CMD_SRC_SWAP_SHORTS | CMD_MODE_SINGLE; |
| pscmd->dst = (unsigned) (CRYPTO_AUTH_INFO_NONCE0_REG + |
| pce_dev->phy_iobase); |
| pscmd->len = CRYPTO_REG_SIZE * 4; |
| pscmd->src = GET_PHYS_ADDR(pce_dev->ce_dm.buffer.auth_nonce_info); |
| pscmd++; |
| |
| /* RESET CIPHER AND AUTH REGISTERS COMMAND LISTS*/ |
| |
| pce_dev->ce_dm.cmdlist.reset_auth_key = pscmd; |
| pscmd->cmd = CMD_LC | CMD_MODE_SINGLE; |
| pscmd->dst = (unsigned) (CRYPTO_AUTH_KEY0_REG + pce_dev->phy_iobase); |
| pscmd->len = CRYPTO_REG_SIZE * 16; |
| pscmd->src = GET_PHYS_ADDR(pce_dev->ce_dm.buffer.reset_buf_64); |
| pscmd++; |
| |
| pce_dev->ce_dm.cmdlist.reset_auth_iv = pscmd; |
| pscmd->cmd = CMD_LC | CMD_MODE_SINGLE; |
| pscmd->dst = (unsigned) (CRYPTO_AUTH_IV0_REG + pce_dev->phy_iobase); |
| pscmd->len = CRYPTO_REG_SIZE * 16; |
| pscmd->src = GET_PHYS_ADDR(pce_dev->ce_dm.buffer.reset_buf_64); |
| pscmd++; |
| |
| pce_dev->ce_dm.cmdlist.reset_auth_cfg = pscmd; |
| pscmd->cmd = CMD_LC | CMD_MODE_SINGLE; |
| pscmd->dst = (unsigned) (CRYPTO_AUTH_SEG_CFG_REG + pce_dev->phy_iobase); |
| pscmd->len = CRYPTO_REG_SIZE; |
| pscmd->src = GET_PHYS_ADDR(pce_dev->ce_dm.buffer.reset_buf_64); |
| pscmd++; |
| |
| |
| pce_dev->ce_dm.cmdlist.reset_auth_byte_count = pscmd; |
| pscmd->cmd = CMD_LC | CMD_MODE_SINGLE; |
| pscmd->dst = (unsigned) (CRYPTO_AUTH_BYTECNT0_REG + |
| pce_dev->phy_iobase); |
| pscmd->len = CRYPTO_REG_SIZE * 4; |
| pscmd->src = GET_PHYS_ADDR(pce_dev->ce_dm.buffer.reset_buf_64); |
| pscmd++; |
| |
| /* WAIT UNTIL MAC OP IS DONE*/ |
| |
| pce_dev->ce_dm.cmdlist.get_status_wait = pscmd; |
| pscmd->cmd = CMD_LC | CMD_MODE_SINGLE; |
| pscmd->src = (unsigned) (CRYPTO_STATUS_REG + pce_dev->phy_iobase); |
| pscmd->len = CRYPTO_REG_SIZE; |
| pscmd->dst = GET_PHYS_ADDR(pce_dev->ce_dm.buffer.status); |
| pscmd++; |
| |
| *pvaddr = (unsigned char *) pscmd; |
| |
| return 0; |
| } |
| |
| static int qce_setup_cmdlists(struct qce_device *pce_dev, |
| unsigned char **pvaddr) |
| { |
| dmov_sg *pcmd; |
| dmov_s *pscmd; |
| unsigned char *vaddr = *pvaddr; |
| struct dmov_desc *pdesc; |
| int i = 0; |
| |
| /* |
| * Designate chunks of the allocated memory to various |
| * command list pointers related to operation define |
| * in ce_cmdlists structure. |
| */ |
| vaddr = (unsigned char *) ALIGN(((unsigned int)vaddr), 16); |
| *pvaddr = (unsigned char *) vaddr; |
| |
| _setup_cipher_cmdlists(pce_dev, pvaddr); |
| _setup_auth_cmdlists(pce_dev, pvaddr); |
| |
| pscmd = (dmov_s *)(*pvaddr); |
| |
| /* GET HW VERSION COMMAND LIST */ |
| pce_dev->ce_dm.cmdlist.get_hw_version = pscmd; |
| pscmd->cmd = CMD_LC | CMD_MODE_SINGLE | CMD_OCB; |
| pscmd->src = (unsigned) (CRYPTO_VERSION_REG + pce_dev->phy_iobase); |
| pscmd->len = CRYPTO_REG_SIZE; |
| pscmd->dst = GET_PHYS_ADDR(pce_dev->ce_dm.buffer.version); |
| pscmd++; |
| |
| |
| /* SET SEG SIZE REGISTER and OCB COMMAND LIST */ |
| pce_dev->ce_dm.cmdlist.set_seg_size_ocb = pscmd; |
| pscmd->cmd = CMD_LC | CMD_MODE_SINGLE | CMD_OCB; |
| pscmd->dst = (unsigned) (CRYPTO_SEG_SIZE_REG + pce_dev->phy_iobase); |
| pscmd->len = CRYPTO_REG_SIZE; |
| pscmd->src = GET_PHYS_ADDR(pce_dev->ce_dm.buffer.seg_size); |
| pscmd++; |
| |
| |
| /* OCU COMMAND LIST */ |
| pce_dev->ce_dm.cmdlist.get_status_ocu = pscmd; |
| pscmd->cmd = CMD_LC | CMD_MODE_SINGLE | CMD_OCU; |
| pscmd->src = (unsigned) (CRYPTO_STATUS_REG + pce_dev->phy_iobase); |
| pscmd->len = CRYPTO_REG_SIZE; |
| pscmd->dst = GET_PHYS_ADDR(pce_dev->ce_dm.buffer.status); |
| pscmd++; |
| |
| /* CLEAR STATUS COMMAND LIST */ |
| pce_dev->ce_dm.cmdlist.clear_status = pscmd; |
| pscmd->cmd = CMD_LC | CMD_MODE_SINGLE | CMD_OCU; |
| pscmd->dst = (unsigned) (CRYPTO_STATUS_REG + pce_dev->phy_iobase); |
| pscmd->len = CRYPTO_REG_SIZE; |
| pscmd->src = GET_PHYS_ADDR(pce_dev->ce_dm.buffer.status); |
| pscmd++; |
| |
| /* SET GO_PROC REGISTERS COMMAND LIST */ |
| pce_dev->ce_dm.cmdlist.set_go_proc = pscmd; |
| pscmd->cmd = CMD_LC | CMD_MODE_SINGLE; |
| pscmd->dst = (unsigned) (CRYPTO_GOPROC_REG + pce_dev->phy_iobase); |
| pscmd->len = CRYPTO_REG_SIZE; |
| pscmd->src = GET_PHYS_ADDR(pce_dev->ce_dm.buffer.go_proc); |
| pscmd++; |
| |
| pcmd = (dmov_sg *)pscmd; |
| pce_dev->ce_dm.cmdlist.ce_data_in = pcmd; |
| /* swap byte and half word , dst crci , scatter gather */ |
| pcmd->cmd = CMD_DST_SWAP_BYTES | CMD_DST_SWAP_SHORTS | |
| CMD_DST_CRCI(pce_dev->ce_dm.crci_in) | CMD_MODE_SG; |
| |
| pdesc = pce_dev->ce_dm.ce_in_src_desc; |
| pdesc->addr = 0; /* to be filled in each operation */ |
| pdesc->len = 0; /* to be filled in each operation */ |
| |
| pdesc = pce_dev->ce_dm.ce_in_dst_desc; |
| for (i = 0; i < QCE_MAX_NUM_DESC; i++) { |
| pdesc->addr = (CRYPTO_DATA_SHADOW0 + pce_dev->phy_iobase); |
| pdesc->len = 0; /* to be filled in each operation */ |
| pdesc++; |
| } |
| pcmd->src_dscr = GET_PHYS_ADDR(pce_dev->ce_dm.ce_in_src_desc); |
| pcmd->dst_dscr = GET_PHYS_ADDR(pce_dev->ce_dm.ce_in_dst_desc); |
| pcmd->_reserved = LI_SG_CMD | SRC_INDEX_SG_CMD(0) | |
| DST_INDEX_SG_CMD(0); |
| |
| |
| pcmd++; |
| pce_dev->ce_dm.cmdlist.ce_data_out = pcmd; |
| /* swap byte, half word, source crci, scatter gather */ |
| pcmd->cmd = CMD_SRC_SWAP_BYTES | CMD_SRC_SWAP_SHORTS | |
| CMD_SRC_CRCI(pce_dev->ce_dm.crci_out) | CMD_MODE_SG; |
| |
| pdesc = pce_dev->ce_dm.ce_out_src_desc; |
| for (i = 0; i < QCE_MAX_NUM_DESC; i++) { |
| pdesc->addr = (CRYPTO_DATA_SHADOW0 + pce_dev->phy_iobase); |
| pdesc->len = 0; /* to be filled in each operation */ |
| pdesc++; |
| } |
| |
| pdesc = pce_dev->ce_dm.ce_out_dst_desc; |
| pdesc->addr = 0; /* to be filled in each operation */ |
| pdesc->len = 0; /* to be filled in each operation */ |
| |
| pcmd->src_dscr = GET_PHYS_ADDR(pce_dev->ce_dm.ce_out_src_desc); |
| pcmd->dst_dscr = GET_PHYS_ADDR(pce_dev->ce_dm.ce_out_dst_desc); |
| pcmd->_reserved = LI_SG_CMD | SRC_INDEX_SG_CMD(0) | |
| DST_INDEX_SG_CMD(0); |
| pcmd++; |
| |
| *pvaddr = (unsigned char *) pcmd; |
| |
| return 0; |
| } |
| |
| static int _setup_cipher_cmdptrlists(struct qce_device *pce_dev, |
| unsigned char **pvaddr) |
| { |
| uint32_t * cmd_ptr_vaddr = (uint32_t *)(*pvaddr); |
| struct ce_cmdlists *cmdlist = &pce_dev->ce_dm.cmdlist; |
| struct ce_cmdptrlists_ops *cmdptrlist = &pce_dev->ce_dm.cmdptrlist; |
| |
| /* |
| * Designate chunks of the allocated memory to various |
| * command list pointers related to cipher operations defined |
| * in ce_cmdptrlists_ops structure. |
| */ |
| cmd_ptr_vaddr = (uint32_t *) ALIGN(((unsigned int) cmd_ptr_vaddr), 16); |
| cmdptrlist->cipher_aes_128_cbc_ctr = QCE_SET_CMD_PTR(cmd_ptr_vaddr); |
| |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_seg_size_ocb); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_cipher_cfg); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_cipher_aes_128_key); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_cipher_aes_iv); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->reset_auth_cfg); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_cipher_mask); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_go_proc); |
| *cmd_ptr_vaddr++ = QCE_SET_LAST_CMD_PTR(cmdlist->ce_data_in); |
| |
| cmd_ptr_vaddr = (uint32_t *) ALIGN(((unsigned int) cmd_ptr_vaddr), 16); |
| cmdptrlist->cipher_aes_256_cbc_ctr = QCE_SET_CMD_PTR(cmd_ptr_vaddr); |
| |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_seg_size_ocb); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_cipher_cfg); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_cipher_aes_256_key); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_cipher_aes_iv); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->reset_auth_cfg); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_cipher_mask); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_go_proc); |
| *cmd_ptr_vaddr++ = QCE_SET_LAST_CMD_PTR(cmdlist->ce_data_in); |
| |
| cmd_ptr_vaddr = (uint32_t *) ALIGN(((unsigned int) cmd_ptr_vaddr), 16); |
| cmdptrlist->cipher_aes_128_ecb = QCE_SET_CMD_PTR(cmd_ptr_vaddr); |
| |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_seg_size_ocb); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_cipher_cfg); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_cipher_aes_128_key); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->reset_auth_cfg); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_cipher_mask); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_go_proc); |
| *cmd_ptr_vaddr++ = QCE_SET_LAST_CMD_PTR(cmdlist->ce_data_in); |
| |
| cmd_ptr_vaddr = (uint32_t *)ALIGN(((unsigned int) cmd_ptr_vaddr), 16); |
| cmdptrlist->cipher_aes_256_ecb = QCE_SET_CMD_PTR(cmd_ptr_vaddr); |
| |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_seg_size_ocb); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_cipher_cfg); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_cipher_aes_256_key); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->reset_auth_cfg); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_cipher_mask); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_go_proc); |
| *cmd_ptr_vaddr++ = QCE_SET_LAST_CMD_PTR(cmdlist->ce_data_in); |
| |
| cmd_ptr_vaddr = (uint32_t *)ALIGN(((unsigned int) cmd_ptr_vaddr), 16); |
| cmdptrlist->cipher_aes_128_xts = QCE_SET_CMD_PTR(cmd_ptr_vaddr); |
| |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_seg_size_ocb); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_cipher_cfg); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_cipher_aes_128_key); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_cipher_aes_128_xts_key); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_cipher_aes_iv); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->reset_auth_cfg); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_cipher_xts_du_size); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_cipher_mask); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_go_proc); |
| *cmd_ptr_vaddr++ = QCE_SET_LAST_CMD_PTR(cmdlist->ce_data_in); |
| |
| cmd_ptr_vaddr = (uint32_t *) ALIGN(((unsigned int) cmd_ptr_vaddr), 16); |
| cmdptrlist->cipher_aes_256_xts = QCE_SET_CMD_PTR(cmd_ptr_vaddr); |
| |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_seg_size_ocb); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_cipher_cfg); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_cipher_aes_256_key); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_cipher_aes_256_xts_key); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_cipher_aes_iv); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->reset_auth_cfg); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_cipher_xts_du_size); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_cipher_mask); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_go_proc); |
| *cmd_ptr_vaddr++ = QCE_SET_LAST_CMD_PTR(cmdlist->ce_data_in); |
| |
| cmd_ptr_vaddr = (uint32_t *)ALIGN(((unsigned int) cmd_ptr_vaddr), 16); |
| cmdptrlist->cipher_des_cbc = QCE_SET_CMD_PTR(cmd_ptr_vaddr); |
| |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_seg_size_ocb); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_cipher_cfg); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_cipher_des_key); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_cipher_des_iv); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->reset_auth_cfg); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_go_proc); |
| *cmd_ptr_vaddr++ = QCE_SET_LAST_CMD_PTR(cmdlist->ce_data_in); |
| |
| cmd_ptr_vaddr = (uint32_t *)ALIGN(((unsigned int) cmd_ptr_vaddr), 16); |
| cmdptrlist->cipher_des_ecb = QCE_SET_CMD_PTR(cmd_ptr_vaddr); |
| |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_seg_size_ocb); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_cipher_cfg); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_cipher_des_key); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->reset_auth_cfg); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_go_proc); |
| *cmd_ptr_vaddr++ = QCE_SET_LAST_CMD_PTR(cmdlist->ce_data_in); |
| |
| cmd_ptr_vaddr = (uint32_t *) ALIGN(((unsigned int) cmd_ptr_vaddr), 16); |
| cmdptrlist->cipher_3des_cbc = QCE_SET_CMD_PTR(cmd_ptr_vaddr); |
| |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_seg_size_ocb); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_cipher_cfg); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_cipher_3des_key); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_cipher_des_iv); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->reset_auth_cfg); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_go_proc); |
| *cmd_ptr_vaddr++ = QCE_SET_LAST_CMD_PTR(cmdlist->ce_data_in); |
| |
| cmd_ptr_vaddr = (uint32_t *) ALIGN(((unsigned int) cmd_ptr_vaddr), 16); |
| cmdptrlist->cipher_3des_ecb = QCE_SET_CMD_PTR(cmd_ptr_vaddr); |
| |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_seg_size_ocb); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_cipher_cfg); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_cipher_3des_key); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->reset_auth_cfg); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_go_proc); |
| *cmd_ptr_vaddr++ = QCE_SET_LAST_CMD_PTR(cmdlist->ce_data_in); |
| |
| cmd_ptr_vaddr = (uint32_t *) ALIGN(((unsigned int) cmd_ptr_vaddr), 16); |
| cmdptrlist->cipher_ce_out = QCE_SET_CMD_PTR(cmd_ptr_vaddr); |
| |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->ce_data_out); |
| *cmd_ptr_vaddr++ = QCE_SET_LAST_CMD_PTR(cmdlist->get_status_ocu); |
| |
| cmd_ptr_vaddr = (uint32_t *) ALIGN(((unsigned int) cmd_ptr_vaddr), 16); |
| cmdptrlist->cipher_ce_out_get_iv = QCE_SET_CMD_PTR(cmd_ptr_vaddr); |
| |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->ce_data_out); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->get_cipher_iv); |
| *cmd_ptr_vaddr++ = QCE_SET_LAST_CMD_PTR(cmdlist->get_status_ocu); |
| |
| *pvaddr = (unsigned char *) cmd_ptr_vaddr; |
| |
| return 0; |
| } |
| |
| static int _setup_auth_cmdptrlists(struct qce_device *pce_dev, |
| unsigned char **pvaddr) |
| { |
| uint32_t * cmd_ptr_vaddr = (uint32_t *)(*pvaddr); |
| struct ce_cmdlists *cmdlist = &pce_dev->ce_dm.cmdlist; |
| struct ce_cmdptrlists_ops *cmdptrlist = &pce_dev->ce_dm.cmdptrlist; |
| |
| /* |
| * Designate chunks of the allocated memory to various |
| * command list pointers related to authentication operations |
| * defined in ce_cmdptrlists_ops structure. |
| */ |
| cmd_ptr_vaddr = (uint32_t *) ALIGN(((unsigned int) cmd_ptr_vaddr), 16); |
| cmdptrlist->auth_sha1 = QCE_SET_CMD_PTR(cmd_ptr_vaddr); |
| |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_seg_size_ocb); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->reset_cipher_cfg); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_auth_cfg); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_auth_iv_20); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_auth_byte_count); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_go_proc); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->ce_data_in); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->get_status_wait); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->get_status_wait); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->get_auth_byte_count); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->get_auth_result_20); |
| *cmd_ptr_vaddr++ = QCE_SET_LAST_CMD_PTR(cmdlist->get_status_ocu); |
| |
| cmd_ptr_vaddr = (uint32_t *) ALIGN(((unsigned int) cmd_ptr_vaddr), 16); |
| cmdptrlist->auth_sha256 = QCE_SET_CMD_PTR(cmd_ptr_vaddr); |
| |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_seg_size_ocb); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->reset_cipher_cfg); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_auth_cfg); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_auth_iv_32); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_auth_byte_count); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_go_proc); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->ce_data_in); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->get_status_wait); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->get_status_wait); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->get_auth_byte_count); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->get_auth_result_32); |
| *cmd_ptr_vaddr++ = QCE_SET_LAST_CMD_PTR(cmdlist->get_status_ocu); |
| |
| cmd_ptr_vaddr = (uint32_t *) ALIGN(((unsigned int) cmd_ptr_vaddr), 16); |
| cmdptrlist->auth_sha1_hmac = QCE_SET_CMD_PTR(cmd_ptr_vaddr); |
| |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_seg_size_ocb); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->reset_cipher_cfg); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_auth_key_512); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_auth_cfg); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_auth_iv_20); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_auth_byte_count); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_go_proc); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->ce_data_in); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->get_status_wait); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->get_status_wait); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->get_auth_byte_count); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->get_auth_result_20); |
| *cmd_ptr_vaddr++ = QCE_SET_LAST_CMD_PTR(cmdlist->get_status_ocu); |
| |
| cmd_ptr_vaddr = (uint32_t *) ALIGN(((unsigned int) cmd_ptr_vaddr), 16); |
| cmdptrlist->auth_sha256_hmac = QCE_SET_CMD_PTR(cmd_ptr_vaddr); |
| |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_seg_size_ocb); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->reset_cipher_cfg); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_auth_key_512); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_auth_cfg); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_auth_iv_32); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_auth_byte_count); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_go_proc); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->ce_data_in); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->get_status_wait); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->get_status_wait); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->get_auth_byte_count); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->get_auth_result_32); |
| *cmd_ptr_vaddr++ = QCE_SET_LAST_CMD_PTR(cmdlist->get_status_ocu); |
| |
| cmd_ptr_vaddr = (uint32_t *) ALIGN(((unsigned int) cmd_ptr_vaddr), 16); |
| cmdptrlist->auth_aes_128_cmac = QCE_SET_CMD_PTR(cmd_ptr_vaddr); |
| |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_seg_size_ocb); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->reset_cipher_cfg); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->reset_auth_iv); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->reset_auth_key); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->reset_auth_byte_count); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_auth_key_128); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_auth_cfg); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_go_proc); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->ce_data_in); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->get_status_wait); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->get_status_wait); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->get_auth_byte_count); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->get_auth_result_16); |
| *cmd_ptr_vaddr++ = QCE_SET_LAST_CMD_PTR(cmdlist->get_status_ocu); |
| |
| cmd_ptr_vaddr = (uint32_t *) ALIGN(((unsigned int) cmd_ptr_vaddr), 16); |
| cmdptrlist->auth_aes_256_cmac = QCE_SET_CMD_PTR(cmd_ptr_vaddr); |
| |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_seg_size_ocb); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->reset_cipher_cfg); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->reset_auth_iv); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->reset_auth_key); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->reset_auth_byte_count); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_auth_key_256); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_auth_cfg); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_go_proc); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->ce_data_in); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->get_status_wait); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->get_status_wait); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->get_auth_byte_count); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->get_auth_result_16); |
| *cmd_ptr_vaddr++ = QCE_SET_LAST_CMD_PTR(cmdlist->get_status_ocu); |
| |
| *pvaddr = (unsigned char *) cmd_ptr_vaddr; |
| |
| return 0; |
| } |
| |
| static int _setup_aead_cmdptrlists(struct qce_device *pce_dev, |
| unsigned char **pvaddr) |
| { |
| uint32_t * cmd_ptr_vaddr = (uint32_t *)(*pvaddr); |
| struct ce_cmdlists *cmdlist = &pce_dev->ce_dm.cmdlist; |
| struct ce_cmdptrlists_ops *cmdptrlist = &pce_dev->ce_dm.cmdptrlist; |
| |
| /* |
| * Designate chunks of the allocated memory to various |
| * command list pointers related to aead operations |
| * defined in ce_cmdptrlists_ops structure. |
| */ |
| cmd_ptr_vaddr = (uint32_t *) ALIGN(((unsigned int) cmd_ptr_vaddr), 16); |
| cmdptrlist->aead_aes_128_ccm = QCE_SET_CMD_PTR(cmd_ptr_vaddr); |
| |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_seg_size_ocb); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->reset_auth_iv); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->reset_auth_key); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->reset_auth_byte_count); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_auth_key_128); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_auth_nonce_info); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_auth_cfg); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_cipher_cfg); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_cipher_aes_128_key); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_cipher_aes_iv); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_cipher_mask); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_go_proc); |
| *cmd_ptr_vaddr++ = QCE_SET_LAST_CMD_PTR(cmdlist->ce_data_in); |
| |
| cmd_ptr_vaddr = (uint32_t *) ALIGN(((unsigned int) cmd_ptr_vaddr), 16); |
| cmdptrlist->aead_aes_256_ccm = QCE_SET_CMD_PTR(cmd_ptr_vaddr); |
| |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_seg_size_ocb); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->reset_auth_iv); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->reset_auth_key); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->reset_auth_byte_count); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_auth_key_256); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_auth_nonce_info); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_auth_cfg); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_cipher_cfg); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_cipher_aes_256_key); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_cipher_aes_iv); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_cipher_mask); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->set_go_proc); |
| *cmd_ptr_vaddr++ = QCE_SET_LAST_CMD_PTR(cmdlist->ce_data_in); |
| |
| cmd_ptr_vaddr = (uint32_t *) ALIGN(((unsigned int) cmd_ptr_vaddr), 16); |
| cmdptrlist->aead_ce_out = QCE_SET_CMD_PTR(cmd_ptr_vaddr); |
| |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->ce_data_out); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->get_status_wait); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->get_status_wait); |
| *cmd_ptr_vaddr++ = QCE_SET_LAST_CMD_PTR(cmdlist->get_status_ocu); |
| |
| *pvaddr = (unsigned char *) cmd_ptr_vaddr; |
| |
| return 0; |
| } |
| |
| static int qce_setup_cmdptrlists(struct qce_device *pce_dev, |
| unsigned char **pvaddr) |
| { |
| uint32_t * cmd_ptr_vaddr = (uint32_t *)(*pvaddr); |
| struct ce_cmdlists *cmdlist = &pce_dev->ce_dm.cmdlist; |
| struct ce_cmdptrlists_ops *cmdptrlist = &pce_dev->ce_dm.cmdptrlist; |
| /* |
| * Designate chunks of the allocated memory to various |
| * command list pointers related to operations defined |
| * in ce_cmdptrlists_ops structure. |
| */ |
| cmd_ptr_vaddr = (uint32_t *) ALIGN(((unsigned int) cmd_ptr_vaddr), 16); |
| cmdptrlist->probe_ce_hw = QCE_SET_CMD_PTR(cmd_ptr_vaddr); |
| |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->get_hw_version); |
| *cmd_ptr_vaddr++ = QCE_SET_CMD_PTR(cmdlist->clear_status); |
| *cmd_ptr_vaddr++ = QCE_SET_LAST_CMD_PTR(cmdlist->get_status_ocu); |
| |
| *pvaddr = (unsigned char *) cmd_ptr_vaddr; |
| |
| _setup_cipher_cmdptrlists(pce_dev, pvaddr); |
| _setup_auth_cmdptrlists(pce_dev, pvaddr); |
| _setup_aead_cmdptrlists(pce_dev, pvaddr); |
| |
| return 0; |
| } |
| |
| |
| static int qce_setup_ce_dm_data(struct qce_device *pce_dev) |
| { |
| unsigned char *vaddr; |
| |
| /* 1. ce_in channel data xfer command src descriptors, 128 entries */ |
| vaddr = pce_dev->coh_vmem; |
| vaddr = (unsigned char *) ALIGN(((unsigned int)vaddr), 16); |
| pce_dev->ce_dm.ce_in_src_desc = (struct dmov_desc *) vaddr; |
| vaddr = vaddr + (sizeof(struct dmov_desc) * QCE_MAX_NUM_DESC); |
| |
| /* 2. ce_in channel data xfer command dst descriptors, 128 entries */ |
| vaddr = (unsigned char *) ALIGN(((unsigned int)vaddr), 16); |
| pce_dev->ce_dm.ce_in_dst_desc = (struct dmov_desc *) vaddr; |
| vaddr = vaddr + (sizeof(struct dmov_desc) * QCE_MAX_NUM_DESC); |
| |
| |
| /* 3. ce_out channel data xfer command src descriptors, 128 entries */ |
| vaddr = (unsigned char *) ALIGN(((unsigned int)vaddr), 16); |
| pce_dev->ce_dm.ce_out_src_desc = (struct dmov_desc *) vaddr; |
| vaddr = vaddr + (sizeof(struct dmov_desc) * QCE_MAX_NUM_DESC); |
| |
| /* 4. ce_out channel data xfer command dst descriptors, 128 entries. */ |
| vaddr = (unsigned char *) ALIGN(((unsigned int)vaddr), 16); |
| pce_dev->ce_dm.ce_out_dst_desc = (struct dmov_desc *) vaddr; |
| vaddr = vaddr + (sizeof(struct dmov_desc) * QCE_MAX_NUM_DESC); |
| |
| qce_setup_cmd_buffers(pce_dev, &vaddr); |
| qce_setup_cmdlists(pce_dev, &vaddr); |
| qce_setup_cmdptrlists(pce_dev, &vaddr); |
| |
| pce_dev->ce_dm.buffer.ignore_data = vaddr; |
| |
| pce_dev->ce_dm.phy_ce_pad = GET_PHYS_ADDR(pce_dev->ce_dm.buffer.pad); |
| pce_dev->ce_dm.phy_ce_out_ignore = |
| GET_PHYS_ADDR(pce_dev->ce_dm.buffer.ignore_data); |
| |
| pce_dev->ce_dm.chan_ce_in_cmd->user = (void *) pce_dev; |
| pce_dev->ce_dm.chan_ce_in_cmd->exec_func = NULL; |
| |
| pce_dev->ce_dm.chan_ce_out_cmd->user = (void *) pce_dev; |
| pce_dev->ce_dm.chan_ce_out_cmd->exec_func = NULL; |
| |
| return 0; |
| } |
| |
| static int _qce_start_dma(struct qce_device *pce_dev, bool ce_in, bool ce_out) |
| { |
| |
| if (ce_in) |
| pce_dev->ce_dm.chan_ce_in_state = QCE_CHAN_STATE_IN_PROG; |
| else |
| pce_dev->ce_dm.chan_ce_in_state = QCE_CHAN_STATE_COMP; |
| |
| if (ce_out) |
| pce_dev->ce_dm.chan_ce_out_state = QCE_CHAN_STATE_IN_PROG; |
| else |
| pce_dev->ce_dm.chan_ce_out_state = QCE_CHAN_STATE_COMP; |
| |
| if (ce_in) |
| msm_dmov_enqueue_cmd(pce_dev->ce_dm.chan_ce_in, |
| pce_dev->ce_dm.chan_ce_in_cmd); |
| if (ce_out) |
| msm_dmov_enqueue_cmd(pce_dev->ce_dm.chan_ce_out, |
| pce_dev->ce_dm.chan_ce_out_cmd); |
| |
| return 0; |
| }; |
| |
| int qce_aead_req(void *handle, struct qce_req *q_req) |
| { |
| struct qce_device *pce_dev = (struct qce_device *) handle; |
| struct aead_request *areq = (struct aead_request *) q_req->areq; |
| uint32_t authsize = q_req->authsize; |
| uint32_t totallen_in, totallen_out, out_len; |
| uint32_t pad_len_in, pad_len_out; |
| uint32_t pad_mac_len_out, pad_ptx_len_out; |
| int rc = 0; |
| int ce_block_size; |
| |
| ce_block_size = pce_dev->ce_dm.ce_block_size; |
| if (q_req->dir == QCE_ENCRYPT) { |
| q_req->cryptlen = areq->cryptlen; |
| totallen_in = q_req->cryptlen + areq->assoclen; |
| totallen_out = q_req->cryptlen + authsize + areq->assoclen; |
| out_len = areq->cryptlen + authsize; |
| pad_len_in = ALIGN(totallen_in, ce_block_size) - totallen_in; |
| pad_mac_len_out = ALIGN(authsize, ce_block_size) - |
| authsize; |
| pad_ptx_len_out = ALIGN(q_req->cryptlen, ce_block_size) - |
| q_req->cryptlen; |
| pad_len_out = pad_ptx_len_out + pad_mac_len_out; |
| totallen_out += pad_len_out; |
| } else { |
| q_req->cryptlen = areq->cryptlen - authsize; |
| totallen_in = areq->cryptlen + areq->assoclen; |
| totallen_out = q_req->cryptlen + areq->assoclen; |
| out_len = areq->cryptlen - authsize; |
| pad_len_in = ALIGN(areq->cryptlen, ce_block_size) - |
| areq->cryptlen; |
| pad_len_out = pad_len_in + authsize; |
| totallen_out += pad_len_out; |
| } |
| |
| _chain_buffer_in_init(pce_dev); |
| _chain_buffer_out_init(pce_dev); |
| |
| pce_dev->assoc_nents = 0; |
| pce_dev->src_nents = 0; |
| pce_dev->dst_nents = 0; |
| pce_dev->ivsize = q_req->ivsize; |
| pce_dev->authsize = q_req->authsize; |
| |
| /* associated data input */ |
| pce_dev->assoc_nents = count_sg(areq->assoc, areq->assoclen); |
| dma_map_sg(pce_dev->pdev, areq->assoc, pce_dev->assoc_nents, |
| DMA_TO_DEVICE); |
| if (_chain_sg_buffer_in(pce_dev, areq->assoc, areq->assoclen) < 0) { |
| rc = -ENOMEM; |
| goto bad; |
| } |
| /* cipher input */ |
| pce_dev->src_nents = count_sg(areq->src, areq->cryptlen); |
| dma_map_sg(pce_dev->pdev, areq->src, pce_dev->src_nents, |
| (areq->src == areq->dst) ? DMA_BIDIRECTIONAL : |
| DMA_TO_DEVICE); |
| if (_chain_sg_buffer_in(pce_dev, areq->src, areq->cryptlen) < 0) { |
| rc = -ENOMEM; |
| goto bad; |
| } |
| /* pad data in */ |
| if (pad_len_in) { |
| if (_chain_pm_buffer_in(pce_dev, pce_dev->ce_dm.phy_ce_pad, |
| pad_len_in) < 0) { |
| rc = -ENOMEM; |
| goto bad; |
| } |
| } |
| |
| /* ignore associated data */ |
| if (_chain_pm_buffer_out(pce_dev, pce_dev->ce_dm.phy_ce_out_ignore, |
| areq->assoclen) < 0) { |
| rc = -ENOMEM; |
| goto bad; |
| } |
| /* cipher + mac output for encryption */ |
| if (areq->src != areq->dst) { |
| pce_dev->dst_nents = count_sg(areq->dst, out_len); |
| dma_map_sg(pce_dev->pdev, areq->dst, pce_dev->dst_nents, |
| DMA_FROM_DEVICE); |
| }; |
| if (_chain_sg_buffer_out(pce_dev, areq->dst, out_len) < 0) { |
| rc = -ENOMEM; |
| goto bad; |
| } |
| /* pad data out */ |
| if (pad_len_out) { |
| if (_chain_pm_buffer_out(pce_dev, pce_dev->ce_dm.phy_ce_pad, |
| pad_len_out) < 0) { |
| rc = -ENOMEM; |
| goto bad; |
| } |
| } |
| |
| /* finalize the ce_in and ce_out channels command lists */ |
| _ce_in_final(pce_dev, ALIGN(totallen_in, ce_block_size)); |
| _ce_out_final(pce_dev, ALIGN(totallen_out, ce_block_size)); |
| |
| /* set up crypto device */ |
| rc = _ce_setup_cipher(pce_dev, q_req, totallen_in, areq->assoclen); |
| if (rc < 0) |
| goto bad; |
| |
| /* setup for callback, and issue command to adm */ |
| pce_dev->areq = q_req->areq; |
| pce_dev->qce_cb = q_req->qce_cb; |
| |
| pce_dev->ce_dm.chan_ce_in_cmd->complete_func = _aead_ce_in_call_back; |
| pce_dev->ce_dm.chan_ce_out_cmd->complete_func = _aead_ce_out_call_back; |
| |
| _ce_in_dump(pce_dev); |
| _ce_out_dump(pce_dev); |
| |
| rc = _qce_start_dma(pce_dev, true, true); |
| if (rc == 0) |
| return 0; |
| bad: |
| if (pce_dev->assoc_nents) { |
| dma_unmap_sg(pce_dev->pdev, areq->assoc, pce_dev->assoc_nents, |
| DMA_TO_DEVICE); |
| } |
| |
| if (pce_dev->src_nents) { |
| dma_unmap_sg(pce_dev->pdev, areq->src, pce_dev->src_nents, |
| (areq->src == areq->dst) ? DMA_BIDIRECTIONAL : |
| DMA_TO_DEVICE); |
| } |
| if (pce_dev->dst_nents) { |
| dma_unmap_sg(pce_dev->pdev, areq->dst, pce_dev->dst_nents, |
| DMA_FROM_DEVICE); |
| } |
| return rc; |
| } |
| EXPORT_SYMBOL(qce_aead_req); |
| |
| int qce_ablk_cipher_req(void *handle, struct qce_req *c_req) |
| { |
| int rc = 0; |
| struct qce_device *pce_dev = (struct qce_device *) handle; |
| struct ablkcipher_request *areq = (struct ablkcipher_request *) |
| c_req->areq; |
| |
| uint32_t pad_len = ALIGN(areq->nbytes, pce_dev->ce_dm.ce_block_size) |
| - areq->nbytes; |
| |
| _chain_buffer_in_init(pce_dev); |
| _chain_buffer_out_init(pce_dev); |
| |
| pce_dev->src_nents = 0; |
| pce_dev->dst_nents = 0; |
| |
| /* cipher input */ |
| pce_dev->src_nents = count_sg(areq->src, areq->nbytes); |
| |
| if (c_req->use_pmem != 1) |
| dma_map_sg(pce_dev->pdev, areq->src, pce_dev->src_nents, |
| (areq->src == areq->dst) ? DMA_BIDIRECTIONAL : |
| DMA_TO_DEVICE); |
| else |
| dma_map_pmem_sg(&c_req->pmem->src[0], pce_dev->src_nents, |
| areq->src); |
| |
| if (_chain_sg_buffer_in(pce_dev, areq->src, areq->nbytes) < 0) { |
| rc = -ENOMEM; |
| goto bad; |
| } |
| |
| /* cipher output */ |
| if (areq->src != areq->dst) { |
| pce_dev->dst_nents = count_sg(areq->dst, areq->nbytes); |
| if (c_req->use_pmem != 1) |
| dma_map_sg(pce_dev->pdev, areq->dst, pce_dev->dst_nents, |
| DMA_FROM_DEVICE); |
| else |
| dma_map_pmem_sg(&c_req->pmem->dst[0], |
| pce_dev->dst_nents, areq->dst); |
| }; |
| if (_chain_sg_buffer_out(pce_dev, areq->dst, areq->nbytes) < 0) { |
| rc = -ENOMEM; |
| goto bad; |
| } |
| |
| /* pad data */ |
| if (pad_len) { |
| if (_chain_pm_buffer_in(pce_dev, pce_dev->ce_dm.phy_ce_pad, |
| pad_len) < 0) { |
| rc = -ENOMEM; |
| goto bad; |
| } |
| if (_chain_pm_buffer_out(pce_dev, pce_dev->ce_dm.phy_ce_pad, |
| pad_len) < 0) { |
| rc = -ENOMEM; |
| goto bad; |
| } |
| } |
| |
| /* finalize the ce_in and ce_out channels command lists */ |
| _ce_in_final(pce_dev, areq->nbytes + pad_len); |
| _ce_out_final(pce_dev, areq->nbytes + pad_len); |
| |
| _ce_in_dump(pce_dev); |
| _ce_out_dump(pce_dev); |
| |
| /* set up crypto device */ |
| rc = _ce_setup_cipher(pce_dev, c_req, areq->nbytes, 0); |
| if (rc < 0) |
| goto bad; |
| |
| /* setup for callback, and issue command to adm */ |
| pce_dev->areq = areq; |
| pce_dev->qce_cb = c_req->qce_cb; |
| if (c_req->use_pmem == 1) { |
| pce_dev->ce_dm.chan_ce_in_cmd->complete_func = |
| _ablk_cipher_ce_in_call_back_pmem; |
| pce_dev->ce_dm.chan_ce_out_cmd->complete_func = |
| _ablk_cipher_ce_out_call_back_pmem; |
| } else { |
| pce_dev->ce_dm.chan_ce_in_cmd->complete_func = |
| _ablk_cipher_ce_in_call_back; |
| pce_dev->ce_dm.chan_ce_out_cmd->complete_func = |
| _ablk_cipher_ce_out_call_back; |
| } |
| rc = _qce_start_dma(pce_dev, true, true); |
| |
| if (rc == 0) |
| return 0; |
| bad: |
| if (c_req->use_pmem != 1) { |
| if (pce_dev->dst_nents) { |
| dma_unmap_sg(pce_dev->pdev, areq->dst, |
| pce_dev->dst_nents, DMA_FROM_DEVICE); |
| } |
| if (pce_dev->src_nents) { |
| dma_unmap_sg(pce_dev->pdev, areq->src, |
| pce_dev->src_nents, |
| (areq->src == areq->dst) ? |
| DMA_BIDIRECTIONAL : |
| DMA_TO_DEVICE); |
| } |
| } |
| return rc; |
| } |
| EXPORT_SYMBOL(qce_ablk_cipher_req); |
| |
| int qce_process_sha_req(void *handle, struct qce_sha_req *sreq) |
| { |
| struct qce_device *pce_dev = (struct qce_device *) handle; |
| int rc; |
| uint32_t pad_len = ALIGN(sreq->size, pce_dev->ce_dm.ce_block_size) - |
| sreq->size; |
| struct ahash_request *areq = (struct ahash_request *)sreq->areq; |
| |
| _chain_buffer_in_init(pce_dev); |
| pce_dev->src_nents = count_sg(sreq->src, sreq->size); |
| dma_map_sg(pce_dev->pdev, sreq->src, pce_dev->src_nents, |
| DMA_TO_DEVICE); |
| |
| if (_chain_sg_buffer_in(pce_dev, sreq->src, sreq->size) < 0) { |
| rc = -ENOMEM; |
| goto bad; |
| } |
| |
| if (pad_len) { |
| if (_chain_pm_buffer_in(pce_dev, pce_dev->ce_dm.phy_ce_pad, |
| pad_len) < 0) { |
| rc = -ENOMEM; |
| goto bad; |
| } |
| } |
| _ce_in_final(pce_dev, sreq->size + pad_len); |
| |
| _ce_in_dump(pce_dev); |
| |
| rc = _ce_setup_hash(pce_dev, sreq); |
| |
| if (rc < 0) |
| goto bad; |
| |
| pce_dev->areq = areq; |
| pce_dev->qce_cb = sreq->qce_cb; |
| pce_dev->ce_dm.chan_ce_in_cmd->complete_func = _sha_ce_in_call_back; |
| |
| rc = _qce_start_dma(pce_dev, true, false); |
| |
| if (rc == 0) |
| return 0; |
| bad: |
| if (pce_dev->src_nents) { |
| dma_unmap_sg(pce_dev->pdev, sreq->src, |
| pce_dev->src_nents, DMA_TO_DEVICE); |
| } |
| |
| return rc; |
| } |
| EXPORT_SYMBOL(qce_process_sha_req); |
| |
| /* crypto engine open function. */ |
| void *qce_open(struct platform_device *pdev, int *rc) |
| { |
| struct qce_device *pce_dev; |
| struct resource *resource; |
| struct clk *ce_core_clk; |
| struct clk *ce_clk; |
| struct clk *ce_core_src_clk; |
| int ret = 0; |
| |
| pce_dev = kzalloc(sizeof(struct qce_device), GFP_KERNEL); |
| if (!pce_dev) { |
| *rc = -ENOMEM; |
| dev_err(&pdev->dev, "Can not allocate memory\n"); |
| return NULL; |
| } |
| pce_dev->pdev = &pdev->dev; |
| |
| resource = platform_get_resource(pdev, IORESOURCE_MEM, 0); |
| if (!resource) { |
| *rc = -ENXIO; |
| dev_err(pce_dev->pdev, "Missing MEM resource\n"); |
| goto err_pce_dev; |
| }; |
| pce_dev->phy_iobase = resource->start; |
| pce_dev->iobase = ioremap_nocache(resource->start, |
| resource->end - resource->start + 1); |
| if (!pce_dev->iobase) { |
| *rc = -ENOMEM; |
| dev_err(pce_dev->pdev, "Can not map io memory\n"); |
| goto err_pce_dev; |
| } |
| |
| pce_dev->ce_dm.chan_ce_in_cmd = kzalloc(sizeof(struct msm_dmov_cmd), |
| GFP_KERNEL); |
| pce_dev->ce_dm.chan_ce_out_cmd = kzalloc(sizeof(struct msm_dmov_cmd), |
| GFP_KERNEL); |
| if (pce_dev->ce_dm.chan_ce_in_cmd == NULL || |
| pce_dev->ce_dm.chan_ce_out_cmd == NULL) { |
| dev_err(pce_dev->pdev, "Can not allocate memory\n"); |
| *rc = -ENOMEM; |
| goto err_dm_chan_cmd; |
| } |
| |
| resource = platform_get_resource_byname(pdev, IORESOURCE_DMA, |
| "crypto_channels"); |
| if (!resource) { |
| *rc = -ENXIO; |
| dev_err(pce_dev->pdev, "Missing DMA channel resource\n"); |
| goto err_dm_chan_cmd; |
| }; |
| pce_dev->ce_dm.chan_ce_in = resource->start; |
| pce_dev->ce_dm.chan_ce_out = resource->end; |
| resource = platform_get_resource_byname(pdev, IORESOURCE_DMA, |
| "crypto_crci_in"); |
| if (!resource) { |
| *rc = -ENXIO; |
| dev_err(pce_dev->pdev, "Missing DMA crci in resource\n"); |
| goto err_dm_chan_cmd; |
| }; |
| pce_dev->ce_dm.crci_in = resource->start; |
| resource = platform_get_resource_byname(pdev, IORESOURCE_DMA, |
| "crypto_crci_out"); |
| if (!resource) { |
| *rc = -ENXIO; |
| dev_err(pce_dev->pdev, "Missing DMA crci out resource\n"); |
| goto err_dm_chan_cmd; |
| }; |
| pce_dev->ce_dm.crci_out = resource->start; |
| pce_dev->memsize = 2 * PAGE_SIZE; |
| pce_dev->coh_vmem = dma_alloc_coherent(pce_dev->pdev, |
| pce_dev->memsize, &pce_dev->coh_pmem, GFP_KERNEL); |
| |
| if (pce_dev->coh_vmem == NULL) { |
| *rc = -ENOMEM; |
| dev_err(pce_dev->pdev, "Can not allocate coherent memory.\n"); |
| goto err; |
| } |
| |
| /* Get CE3 src core clk. */ |
| ce_core_src_clk = clk_get(pce_dev->pdev, "ce3_core_src_clk"); |
| if (!IS_ERR(ce_core_src_clk)) { |
| pce_dev->ce_core_src_clk = ce_core_src_clk; |
| |
| /* Set the core src clk @100Mhz */ |
| ret = clk_set_rate(pce_dev->ce_core_src_clk, 100000000); |
| if (ret) { |
| clk_put(pce_dev->ce_core_src_clk); |
| goto err; |
| } |
| } else |
| pce_dev->ce_core_src_clk = NULL; |
| |
| /* Get CE core clk */ |
| ce_core_clk = clk_get(pce_dev->pdev, "core_clk"); |
| if (IS_ERR(ce_core_clk)) { |
| *rc = PTR_ERR(ce_core_clk); |
| if (pce_dev->ce_core_src_clk != NULL) |
| clk_put(pce_dev->ce_core_src_clk); |
| goto err; |
| } |
| pce_dev->ce_core_clk = ce_core_clk; |
| /* Get CE clk */ |
| ce_clk = clk_get(pce_dev->pdev, "iface_clk"); |
| if (IS_ERR(ce_clk)) { |
| *rc = PTR_ERR(ce_clk); |
| if (pce_dev->ce_core_src_clk != NULL) |
| clk_put(pce_dev->ce_core_src_clk); |
| clk_put(pce_dev->ce_core_clk); |
| goto err; |
| } |
| pce_dev->ce_clk = ce_clk; |
| |
| /* Enable CE core clk */ |
| *rc = clk_prepare_enable(pce_dev->ce_core_clk); |
| if (*rc) { |
| if (pce_dev->ce_core_src_clk != NULL) |
| clk_put(pce_dev->ce_core_src_clk); |
| clk_put(pce_dev->ce_core_clk); |
| clk_put(pce_dev->ce_clk); |
| goto err; |
| } else { |
| /* Enable CE clk */ |
| *rc = clk_prepare_enable(pce_dev->ce_clk); |
| if (*rc) { |
| clk_disable_unprepare(pce_dev->ce_core_clk); |
| if (pce_dev->ce_core_src_clk != NULL) |
| clk_put(pce_dev->ce_core_src_clk); |
| clk_put(pce_dev->ce_core_clk); |
| clk_put(pce_dev->ce_clk); |
| goto err; |
| |
| } |
| } |
| qce_setup_ce_dm_data(pce_dev); |
| |
| pce_dev->ce_dm.chan_ce_in_state = QCE_CHAN_STATE_IDLE; |
| pce_dev->ce_dm.chan_ce_out_state = QCE_CHAN_STATE_IDLE; |
| if (_init_ce_engine(pce_dev)) { |
| *rc = -ENXIO; |
| goto err; |
| } |
| *rc = 0; |
| return pce_dev; |
| |
| err: |
| if (pce_dev->coh_vmem) |
| dma_free_coherent(pce_dev->pdev, pce_dev->memsize, |
| pce_dev->coh_vmem, pce_dev->coh_pmem); |
| err_dm_chan_cmd: |
| kfree(pce_dev->ce_dm.chan_ce_in_cmd); |
| kfree(pce_dev->ce_dm.chan_ce_out_cmd); |
| if (pce_dev->iobase) |
| iounmap(pce_dev->iobase); |
| |
| err_pce_dev: |
| |
| kfree(pce_dev); |
| |
| return NULL; |
| } |
| EXPORT_SYMBOL(qce_open); |
| |
| /* crypto engine close function. */ |
| int qce_close(void *handle) |
| { |
| struct qce_device *pce_dev = (struct qce_device *) handle; |
| |
| if (handle == NULL) |
| return -ENODEV; |
| if (pce_dev->iobase) |
| iounmap(pce_dev->iobase); |
| |
| if (pce_dev->coh_vmem) |
| dma_free_coherent(pce_dev->pdev, pce_dev->memsize, |
| pce_dev->coh_vmem, pce_dev->coh_pmem); |
| clk_disable_unprepare(pce_dev->ce_clk); |
| clk_disable_unprepare(pce_dev->ce_core_clk); |
| |
| if (pce_dev->ce_core_src_clk != NULL) |
| clk_put(pce_dev->ce_core_src_clk); |
| |
| clk_put(pce_dev->ce_clk); |
| clk_put(pce_dev->ce_core_clk); |
| |
| kfree(pce_dev->ce_dm.chan_ce_in_cmd); |
| kfree(pce_dev->ce_dm.chan_ce_out_cmd); |
| kfree(handle); |
| |
| return 0; |
| } |
| EXPORT_SYMBOL(qce_close); |
| |
| int qce_hw_support(void *handle, struct ce_hw_support *ce_support) |
| { |
| if (ce_support == NULL) |
| return -EINVAL; |
| |
| ce_support->sha1_hmac_20 = false; |
| ce_support->sha1_hmac = false; |
| ce_support->sha256_hmac = false; |
| ce_support->sha_hmac = false; |
| ce_support->cmac = true; |
| ce_support->aes_key_192 = false; |
| ce_support->aes_xts = true; |
| ce_support->aes_ccm = true; |
| ce_support->ota = false; |
| return 0; |
| } |
| EXPORT_SYMBOL(qce_hw_support); |
| |
| MODULE_LICENSE("GPL v2"); |
| MODULE_AUTHOR("Mona Hossain <mhossain@codeaurora.org>"); |
| MODULE_DESCRIPTION("Crypto Engine driver"); |
| MODULE_VERSION("2.16"); |