From: Murthy NSSR <nidadavolu.mur...@cavium.com>

These functions help in preparing symmetric crypto request
for Kasumi of both cipher and auth but not cipher+auth in single
xform.

Signed-off-by: Ankur Dwivedi <ankur.dwiv...@cavium.com>
Signed-off-by: Murthy NSSR <nidadavolu.mur...@cavium.com>
Signed-off-by: Nithin Dabilpuram <nithin.dabilpu...@cavium.com>
Signed-off-by: Ragothaman Jayaraman <ragothaman.jayara...@cavium.com>
Signed-off-by: Srisivasubramanian Srinivasan 
<srisivasubramanian.sriniva...@cavium.com>
---
 drivers/crypto/cpt/base/cpt_ops.c | 545 ++++++++++++++++++++++++++++++++++++++
 1 file changed, 545 insertions(+)

diff --git a/drivers/crypto/cpt/base/cpt_ops.c 
b/drivers/crypto/cpt/base/cpt_ops.c
index ff7522a..15c3413 100644
--- a/drivers/crypto/cpt/base/cpt_ops.c
+++ b/drivers/crypto/cpt/base/cpt_ops.c
@@ -1933,6 +1933,545 @@ static inline int  __attribute__((always_inline))
        return 0;
 }
 
+static int
+cpt_kasumi_enc_prep(uint32_t req_flags,
+                   uint64_t d_offs,
+                   uint64_t d_lens,
+                   fc_params_t *params,
+                   void *op,
+                   void **prep_req)
+{
+       uint32_t size;
+       int32_t inputlen = 0, outputlen = 0;
+       struct cpt_ctx *cpt_ctx;
+       uint32_t mac_len = 0;
+       uint8_t i = 0;
+       cpt_request_info_t *req;
+       buf_ptr_t *buf_p;
+       uint32_t encr_offset, auth_offset;
+       uint32_t encr_data_len, auth_data_len;
+       int flags, m_size;
+       uint8_t *iv_s, *iv_d, iv_len = 8;
+       uint8_t dir = 0;
+       void *m_vaddr, *c_vaddr;
+       uint64_t m_dma, c_dma;
+       uint64_t *offset_vaddr, offset_dma;
+       vq_cmd_word0_t vq_cmd_w0;
+       vq_cmd_word3_t vq_cmd_w3;
+       opcode_info_t opcode;
+       uint8_t *in_buffer;
+       uint32_t g_size_bytes, s_size_bytes;
+       uint64_t dptr_dma, rptr_dma;
+       sg_comp_t *gather_comp;
+       sg_comp_t *scatter_comp;
+
+       buf_p = &params->meta_buf;
+#ifdef CPTVF_STRICT_PARAM_CHECK
+       if (!params || !buf_p->vaddr || !buf_p->size)
+               return ERR_BAD_INPUT_ARG;
+#endif
+       m_vaddr = buf_p->vaddr;
+       m_dma = buf_p->dma_addr;
+       m_size = buf_p->size;
+
+       encr_offset = ENCR_OFFSET(d_offs) / 8;
+       auth_offset = AUTH_OFFSET(d_offs) / 8;
+       encr_data_len = ENCR_DLEN(d_lens);
+       auth_data_len = AUTH_DLEN(d_lens);
+
+       cpt_ctx = params->ctx_buf.vaddr;
+       flags = cpt_ctx->zsk_flags;
+       mac_len = cpt_ctx->mac_len;
+
+#ifdef CPTVF_STRICT_PARAM_CHECK
+       if (flags == 0x0) {
+               /* F8 Mode */
+               if (auth_offset || auth_data_len)
+                       return ERR_BAD_INPUT_ARG;
+
+               if (!params->iv_buf)
+                       return ERR_BAD_INPUT_ARG;
+       } else if (flags == 0x1) {
+               /* F9 mode */
+               if (encr_offset || encr_data_len)
+                       return ERR_BAD_INPUT_ARG;
+
+               if (!params->auth_iv_buf)
+                       return ERR_BAD_INPUT_ARG;
+       } else {
+               return ERR_EIO;
+       }
+#endif
+       if (flags == 0x0)
+               iv_s = params->iv_buf;
+       else
+               iv_s = params->auth_iv_buf;
+
+       dir = iv_s[8] & 0x1;
+
+       /*
+        * Save initial space that followed app data for completion code &
+        * alternate completion code to fall in same cache line as app data
+        */
+       m_vaddr = (uint8_t *)m_vaddr + COMPLETION_CODE_SIZE;
+       m_dma += COMPLETION_CODE_SIZE;
+       size = (uint8_t *)RTE_PTR_ALIGN((uint8_t *)m_vaddr, 16) -
+               (uint8_t *)m_vaddr;
+
+       c_vaddr = (uint8_t *)m_vaddr + size;
+       c_dma = m_dma + size;
+       size += sizeof(cpt_res_s_t);
+
+       m_vaddr = (uint8_t *)m_vaddr + size;
+       m_dma += size;
+       m_size -= size;
+
+       /* Reserve memory for cpt request info */
+       req = m_vaddr;
+
+       size = sizeof(cpt_request_info_t);
+       m_vaddr = (uint8_t *)m_vaddr + size;
+       m_dma += size;
+       m_size -= size;
+
+       /* Initialising ctrl and opcode
+        * fields for cpt request
+        */
+
+       req->se_req = SE_CORE_REQ;
+       req->dma_mode = CTRL_DMA_MODE_SGIO;
+
+       opcode.s.major = MAJOR_OP_KASUMI | DMA_MODE;
+
+       /* indicates ECB/CBC, direction, ctx from cptr, iv from dptr */
+       opcode.s.minor = ((1 << 6) | (cpt_ctx->k_ecb << 5) |
+                         (dir << 4) | (0 << 3) | (flags & 0x7));
+
+       /*
+        * GP op header, lengths are expected in bits.
+        */
+       vq_cmd_w0.u64 = 0;
+       vq_cmd_w0.s.param1 = htobe16(encr_data_len);
+       vq_cmd_w0.s.param2 = htobe16(auth_data_len);
+       vq_cmd_w0.s.opcode = htobe16(opcode.flags);
+
+       /* consider iv len */
+       if (flags == 0x0) {
+               encr_offset += iv_len;
+               auth_offset += iv_len;
+       }
+
+       /* save space for offset ctrl and iv */
+       offset_vaddr = m_vaddr;
+       offset_dma = m_dma;
+
+       m_vaddr = (uint8_t *)m_vaddr + OFF_CTRL_LEN + iv_len;
+       m_dma += OFF_CTRL_LEN + iv_len;
+       m_size -= OFF_CTRL_LEN + iv_len;
+
+       /* DPTR has SG list */
+       in_buffer = m_vaddr;
+       dptr_dma = m_dma;
+
+       ((uint16_t *)in_buffer)[0] = 0;
+       ((uint16_t *)in_buffer)[1] = 0;
+
+       /* TODO Add error check if space will be sufficient */
+       gather_comp = (sg_comp_t *)((uint8_t *)m_vaddr + 8);
+
+       /*
+        * Input Gather List
+        */
+       i = 0;
+
+       /* Offset control word followed by iv */
+
+       if (flags == 0x0) {
+               inputlen = encr_offset +
+                       (RTE_ALIGN(encr_data_len, 8) / 8);
+               outputlen = inputlen;
+               /* iv offset is 0 */
+               *offset_vaddr = htobe64((uint64_t)encr_offset << 16);
+       } else {
+               inputlen = auth_offset +
+                       (RTE_ALIGN(auth_data_len, 8) / 8);
+               outputlen = mac_len;
+               /* iv offset is 0 */
+               *offset_vaddr = htobe64((uint64_t)auth_offset);
+       }
+
+       i = fill_sg_comp(gather_comp, i, offset_dma,
+                        offset_vaddr, OFF_CTRL_LEN + iv_len);
+
+       /* IV */
+       iv_d = (uint8_t *)offset_vaddr + OFF_CTRL_LEN;
+       memcpy(iv_d, iv_s, iv_len);
+
+       /* input data */
+       size = inputlen - iv_len;
+       if (size) {
+#ifdef CPTVF_STRICT_PARAM_CHECK
+               if (!params->src_iov)
+                       return ERR_BAD_INPUT_ARG;
+#endif
+               i = fill_sg_comp_from_iov(gather_comp, i,
+                                         params->src_iov, 0,
+                                         &size, NULL, 0);
+
+               if (size)
+                       return ERR_BAD_INPUT_ARG;
+       }
+       ((uint16_t *)in_buffer)[2] = htobe16(i);
+       g_size_bytes = ((i + 3) / 4) * sizeof(sg_comp_t);
+
+       /*
+        * Output Scatter List
+        */
+
+       i = 0;
+       scatter_comp =
+               (sg_comp_t *)((uint8_t *)gather_comp + g_size_bytes);
+
+       if (flags == 0x1) {
+               /* IV in SLIST only for F8 */
+               iv_len = 0;
+       }
+
+       /* IV */
+       if (iv_len) {
+
+               i = fill_sg_comp(scatter_comp, i,
+                                offset_dma + OFF_CTRL_LEN,
+                                (uint8_t *)offset_vaddr + OFF_CTRL_LEN,
+                                iv_len);
+       }
+
+       /* Add output data */
+       if (req_flags & VALID_MAC_BUF) {
+               size = outputlen - iv_len - mac_len;
+               if (size) {
+#ifdef CPTVF_STRICT_PARAM_CHECK
+                       if (!params->dst_iov)
+                               return ERR_BAD_INPUT_ARG;
+#endif
+                       i = fill_sg_comp_from_iov(scatter_comp, i,
+                                                 params->dst_iov, 0,
+                                                 &size, NULL, 0);
+
+                       if (size)
+                               return ERR_BAD_INPUT_ARG;
+               }
+
+               /* mac data */
+               if (mac_len) {
+                       i = fill_sg_comp_from_buf(scatter_comp, i,
+                                                 &params->mac_buf);
+               }
+       } else {
+               /* Output including mac */
+               size = outputlen - iv_len;
+               if (size) {
+#ifdef CPTVF_STRICT_PARAM_CHECK
+                       if (!params->dst_iov)
+                               return ERR_BAD_INPUT_ARG;
+#endif
+                       i = fill_sg_comp_from_iov(scatter_comp, i,
+                                                 params->dst_iov, 0,
+                                                 &size, NULL, 0);
+
+                       if (size)
+                               return ERR_BAD_INPUT_ARG;
+               }
+       }
+       ((uint16_t *)in_buffer)[3] = htobe16(i);
+       s_size_bytes = ((i + 3) / 4) * sizeof(sg_comp_t);
+
+       size = g_size_bytes + s_size_bytes + SG_LIST_HDR_SIZE;
+
+       /* This is DPTR len incase of SG mode */
+       vq_cmd_w0.s.dlen = htobe16(size);
+
+       m_vaddr = (uint8_t *)m_vaddr + size;
+       m_dma += size;
+       m_size -= size;
+
+       /* cpt alternate completion address saved earlier */
+       req->alternate_caddr = (uint64_t *)((uint8_t *)c_vaddr - 8);
+       *req->alternate_caddr = ~((uint64_t)COMPLETION_CODE_INIT);
+       rptr_dma = c_dma - 8;
+
+       req->ist.ei1 = dptr_dma;
+       req->ist.ei2 = rptr_dma;
+
+       /* First 16-bit swap then 64-bit swap */
+       /* TODO: HACK: Reverse the vq_cmd and cpt_req bit field definitions
+        * to eliminate all the swapping
+        */
+       vq_cmd_w0.u64 = htobe64(vq_cmd_w0.u64);
+
+       /* vq command w3 */
+       vq_cmd_w3.u64 = 0;
+       vq_cmd_w3.s.grp = 0;
+       vq_cmd_w3.s.cptr = params->ctx_buf.dma_addr +
+               offsetof(struct cpt_ctx, k_ctx);
+
+       /* 16 byte aligned cpt res address */
+       req->completion_addr = (uint64_t *)((uint8_t *)c_vaddr);
+       *req->completion_addr = COMPLETION_CODE_INIT;
+       req->comp_baddr  = c_dma;
+
+       /* Fill microcode part of instruction */
+       req->ist.ei0 = vq_cmd_w0.u64;
+       req->ist.ei3 = vq_cmd_w3.u64;
+
+       req->op = op;
+
+#ifdef CPTVF_STRICT_PARAM_CHECK
+       if (!(m_size >= 0)) {
+               PMD_TX_LOG(ERR, "!!! Buffer Overflow %d\n",
+                          m_size);
+               abort();
+       }
+#endif
+       *prep_req = req;
+       return 0;
+}
+
+
+static inline int
+cpt_kasumi_dec_prep(uint32_t req_flags,
+                   uint64_t d_offs,
+                   uint64_t d_lens,
+                   fc_params_t *params,
+                   void *op,
+                   void **prep_req)
+{
+       uint32_t size;
+       int32_t inputlen = 0, outputlen;
+       struct cpt_ctx *cpt_ctx;
+       uint8_t i = 0, iv_len = 8;
+       cpt_request_info_t *req;
+       buf_ptr_t *buf_p;
+       uint32_t encr_offset;
+       uint32_t encr_data_len;
+       int flags, m_size;
+       uint8_t dir = 0;
+       void *m_vaddr, *c_vaddr;
+       uint64_t m_dma, c_dma;
+       uint64_t *offset_vaddr, offset_dma;
+       vq_cmd_word0_t vq_cmd_w0;
+       vq_cmd_word3_t vq_cmd_w3;
+       opcode_info_t opcode;
+       uint8_t *in_buffer;
+       uint32_t g_size_bytes, s_size_bytes;
+       uint64_t dptr_dma, rptr_dma;
+       sg_comp_t *gather_comp;
+       sg_comp_t *scatter_comp;
+
+       (void)req_flags;
+       buf_p = &params->meta_buf;
+#ifdef CPTVF_STRICT_PARAM_CHECK
+       if (!params || !buf_p->vaddr || !buf_p->size)
+               return ERR_BAD_INPUT_ARG;
+#endif
+       m_vaddr = buf_p->vaddr;
+       m_dma = buf_p->dma_addr;
+       m_size = buf_p->size;
+
+       encr_offset = ENCR_OFFSET(d_offs) / 8;
+       encr_data_len = ENCR_DLEN(d_lens);
+
+       cpt_ctx = params->ctx_buf.vaddr;
+       flags = cpt_ctx->zsk_flags;
+#ifdef CPTVF_STRICT_PARAM_CHECK
+       if (!params->iv_buf)
+               return ERR_BAD_INPUT_ARG;
+#endif
+#ifdef CPTVF_STRICT_PARAM_CHECK
+       if (flags != 0) {
+               /* Dec not supported for F9 */
+               return ERR_BAD_INPUT_ARG;
+       }
+#endif
+       /*
+        * Save initial space that followed app data for completion code &
+        * alternate completion code to fall in same cache line as app data
+        */
+       m_vaddr = (uint8_t *)m_vaddr + COMPLETION_CODE_SIZE;
+       m_dma += COMPLETION_CODE_SIZE;
+       size = (uint8_t *)RTE_PTR_ALIGN((uint8_t *)m_vaddr, 16) -
+               (uint8_t *)m_vaddr;
+
+       c_vaddr = (uint8_t *)m_vaddr + size;
+       c_dma = m_dma + size;
+       size += sizeof(cpt_res_s_t);
+
+       m_vaddr = (uint8_t *)m_vaddr + size;
+       m_dma += size;
+       m_size -= size;
+
+       /* Reserve memory for cpt request info */
+       req = m_vaddr;
+
+       size = sizeof(cpt_request_info_t);
+       m_vaddr = (uint8_t *)m_vaddr + size;
+       m_dma += size;
+       m_size -= size;
+
+       /* Initialising ctrl and opcode
+        * fields for cpt req
+        */
+
+       req->se_req = SE_CORE_REQ;
+       req->dma_mode = CTRL_DMA_MODE_SGIO;
+
+       opcode.s.major = MAJOR_OP_KASUMI | DMA_MODE;
+
+       /* indicates ECB/CBC, direction, ctx from cptr, iv from dptr */
+       opcode.s.minor = ((1 << 6) | (cpt_ctx->k_ecb << 5) |
+                         (dir << 4) | (0 << 3) | (flags & 0x7));
+
+       /*
+        * GP op header, lengths are expected in bits.
+        */
+       vq_cmd_w0.u64 = 0;
+       vq_cmd_w0.s.param1 = htobe16(encr_data_len);
+       vq_cmd_w0.s.opcode = htobe16(opcode.flags);
+
+       /* consider iv len */
+       encr_offset += iv_len;
+
+       inputlen = iv_len + (RTE_ALIGN(encr_data_len, 8) / 8);
+       outputlen = inputlen;
+
+       /* save space for offset ctrl & iv */
+       offset_vaddr = m_vaddr;
+       offset_dma = m_dma;
+
+       m_vaddr = (uint8_t *)m_vaddr + OFF_CTRL_LEN + iv_len;
+       m_dma += OFF_CTRL_LEN + iv_len;
+       m_size -= OFF_CTRL_LEN + iv_len;
+
+       /* DPTR has SG list */
+       in_buffer = m_vaddr;
+       dptr_dma = m_dma;
+
+       ((uint16_t *)in_buffer)[0] = 0;
+       ((uint16_t *)in_buffer)[1] = 0;
+
+       /* TODO Add error check if space will be sufficient */
+       gather_comp = (sg_comp_t *)((uint8_t *)m_vaddr + 8);
+
+       /*
+        * Input Gather List
+        */
+       i = 0;
+
+       /* Offset control word followed by iv */
+       *offset_vaddr = htobe64((uint64_t)encr_offset << 16);
+
+       i = fill_sg_comp(gather_comp, i, offset_dma, offset_vaddr,
+                        OFF_CTRL_LEN + iv_len);
+
+
+       /* IV */
+       memcpy((uint8_t *)offset_vaddr + OFF_CTRL_LEN,
+              params->iv_buf, iv_len);
+
+       /* Add input data */
+       size = inputlen - iv_len;
+       if (size) {
+#ifdef CPTVF_STRICT_PARAM_CHECK
+               if (!params->src_iov)
+                       return ERR_BAD_INPUT_ARG;
+#endif
+               i = fill_sg_comp_from_iov(gather_comp, i,
+                                         params->src_iov,
+                                         0, &size, NULL, 0);
+               if (size)
+                       return ERR_BAD_INPUT_ARG;
+       }
+       ((uint16_t *)in_buffer)[2] = htobe16(i);
+       g_size_bytes = ((i + 3) / 4) * sizeof(sg_comp_t);
+
+       /*
+        * Output Scatter List
+        */
+
+       i = 0;
+       scatter_comp =
+               (sg_comp_t *)((uint8_t *)gather_comp + g_size_bytes);
+
+       /* IV */
+       i = fill_sg_comp(scatter_comp, i,
+                        offset_dma + OFF_CTRL_LEN,
+                        (uint8_t *)offset_vaddr + OFF_CTRL_LEN,
+                        iv_len);
+
+       /* Add output data */
+       size = outputlen - iv_len;
+       if (size) {
+#ifdef CPTVF_STRICT_PARAM_CHECK
+               if (!params->dst_iov)
+                       return ERR_BAD_INPUT_ARG;
+#endif
+               i = fill_sg_comp_from_iov(scatter_comp, i,
+                                         params->dst_iov, 0,
+                                         &size, NULL, 0);
+               if (size)
+                       return ERR_BAD_INPUT_ARG;
+       }
+       ((uint16_t *)in_buffer)[3] = htobe16(i);
+       s_size_bytes = ((i + 3) / 4) * sizeof(sg_comp_t);
+
+       size = g_size_bytes + s_size_bytes + SG_LIST_HDR_SIZE;
+
+       /* This is DPTR len incase of SG mode */
+       vq_cmd_w0.s.dlen = htobe16(size);
+
+       m_vaddr = (uint8_t *)m_vaddr + size;
+       m_dma += size;
+       m_size -= size;
+
+       /* cpt alternate completion address saved earlier */
+       req->alternate_caddr = (uint64_t *)((uint8_t *)c_vaddr - 8);
+       *req->alternate_caddr = ~((uint64_t)COMPLETION_CODE_INIT);
+       rptr_dma = c_dma - 8;
+
+       req->ist.ei1 = dptr_dma;
+       req->ist.ei2 = rptr_dma;
+
+       /* First 16-bit swap then 64-bit swap */
+       /* TODO: HACK: Reverse the vq_cmd and cpt_req bit field definitions
+        * to eliminate all the swapping
+        */
+       vq_cmd_w0.u64 = htobe64(vq_cmd_w0.u64);
+
+       /* vq command w3 */
+       vq_cmd_w3.u64 = 0;
+       vq_cmd_w3.s.grp = 0;
+       vq_cmd_w3.s.cptr = params->ctx_buf.dma_addr +
+               offsetof(struct cpt_ctx, k_ctx);
+
+       /* 16 byte aligned cpt res address */
+       req->completion_addr = (uint64_t *)((uint8_t *)c_vaddr);
+       *req->completion_addr = COMPLETION_CODE_INIT;
+       req->comp_baddr  = c_dma;
+
+       /* Fill microcode part of instruction */
+       req->ist.ei0 = vq_cmd_w0.u64;
+       req->ist.ei3 = vq_cmd_w3.u64;
+
+       req->op = op;
+
+#ifdef CPTVF_STRICT_PARAM_CHECK
+       if (!(m_size >= 0))
+               abort();
+#endif
+       *prep_req = req;
+       return 0;
+}
+
 void *
 cpt_fc_dec_hmac_prep(uint32_t flags,
                     uint64_t d_offs,
@@ -1953,6 +2492,9 @@ static inline int  __attribute__((always_inline))
        } else if (fc_type == ZUC_SNOW3G) {
                ret = cpt_zuc_snow3g_dec_prep(flags, d_offs, d_lens,
                                              fc_params, op, &prep_req);
+       } else if (fc_type == KASUMI) {
+               ret = cpt_kasumi_dec_prep(flags, d_offs, d_lens,
+                                         fc_params, op, &prep_req);
        } else {
                /*
                 * For AUTH_ONLY case,
@@ -1986,6 +2528,9 @@ static inline int  __attribute__((always_inline))
        } else if (fc_type == ZUC_SNOW3G) {
                ret = cpt_zuc_snow3g_enc_prep(flags, d_offs, d_lens,
                                              fc_params, op, &prep_req);
+       } else if (fc_type == KASUMI) {
+               ret = cpt_kasumi_enc_prep(flags, d_offs, d_lens,
+                                         fc_params, op, &prep_req);
        } else {
                ret = ERR_EIO;
        }
-- 
1.9.3

Reply via email to