1 /* SPDX-License-Identifier: BSD-3-Clause
2  * Copyright(c) 2017-2018 Intel Corporation
3  */
4 #include <rte_malloc.h>
5 #include <rte_hash.h>
6 #include <rte_jhash.h>
7 #include <rte_mbuf.h>
8 #include <rte_cryptodev.h>
9 
10 #include "rte_vhost_crypto.h"
11 #include "vhost.h"
12 #include "vhost_user.h"
13 #include "virtio_crypto.h"
14 
15 #define INHDR_LEN		(sizeof(struct virtio_crypto_inhdr))
16 #define IV_OFFSET		(sizeof(struct rte_crypto_op) + \
17 				sizeof(struct rte_crypto_sym_op))
18 
19 #ifdef RTE_LIBRTE_VHOST_DEBUG
20 #define VC_LOG_ERR(fmt, args...)				\
21 	RTE_LOG(ERR, USER1, "[%s] %s() line %u: " fmt "\n",	\
22 		"Vhost-Crypto",	__func__, __LINE__, ## args)
23 #define VC_LOG_INFO(fmt, args...)				\
24 	RTE_LOG(INFO, USER1, "[%s] %s() line %u: " fmt "\n",	\
25 		"Vhost-Crypto",	__func__, __LINE__, ## args)
26 
27 #define VC_LOG_DBG(fmt, args...)				\
28 	RTE_LOG(DEBUG, USER1, "[%s] %s() line %u: " fmt "\n",	\
29 		"Vhost-Crypto",	__func__, __LINE__, ## args)
30 #else
31 #define VC_LOG_ERR(fmt, args...)				\
32 	RTE_LOG(ERR, USER1, "[VHOST-Crypto]: " fmt "\n", ## args)
33 #define VC_LOG_INFO(fmt, args...)				\
34 	RTE_LOG(INFO, USER1, "[VHOST-Crypto]: " fmt "\n", ## args)
35 #define VC_LOG_DBG(fmt, args...)
36 #endif
37 
38 #define VIRTIO_CRYPTO_FEATURES ((1 << VIRTIO_F_NOTIFY_ON_EMPTY) |	\
39 		(1 << VIRTIO_RING_F_INDIRECT_DESC) |			\
40 		(1 << VIRTIO_RING_F_EVENT_IDX) |			\
41 		(1 << VIRTIO_CRYPTO_SERVICE_CIPHER) |			\
42 		(1 << VIRTIO_CRYPTO_SERVICE_MAC) |			\
43 		(1 << VIRTIO_NET_F_CTRL_VQ))
44 
45 #define IOVA_TO_VVA(t, r, a, l, p)					\
46 	((t)(uintptr_t)vhost_iova_to_vva(r->dev, r->vq, a, l, p))
47 
48 static int
49 cipher_algo_transform(uint32_t virtio_cipher_algo)
50 {
51 	int ret;
52 
53 	switch (virtio_cipher_algo) {
54 	case VIRTIO_CRYPTO_CIPHER_AES_CBC:
55 		ret = RTE_CRYPTO_CIPHER_AES_CBC;
56 		break;
57 	case VIRTIO_CRYPTO_CIPHER_AES_CTR:
58 		ret = RTE_CRYPTO_CIPHER_AES_CTR;
59 		break;
60 	case VIRTIO_CRYPTO_CIPHER_DES_ECB:
61 		ret = -VIRTIO_CRYPTO_NOTSUPP;
62 		break;
63 	case VIRTIO_CRYPTO_CIPHER_DES_CBC:
64 		ret = RTE_CRYPTO_CIPHER_DES_CBC;
65 		break;
66 	case VIRTIO_CRYPTO_CIPHER_3DES_ECB:
67 		ret = RTE_CRYPTO_CIPHER_3DES_ECB;
68 		break;
69 	case VIRTIO_CRYPTO_CIPHER_3DES_CBC:
70 		ret = RTE_CRYPTO_CIPHER_3DES_CBC;
71 		break;
72 	case VIRTIO_CRYPTO_CIPHER_3DES_CTR:
73 		ret = RTE_CRYPTO_CIPHER_3DES_CTR;
74 		break;
75 	case VIRTIO_CRYPTO_CIPHER_KASUMI_F8:
76 		ret = RTE_CRYPTO_CIPHER_KASUMI_F8;
77 		break;
78 	case VIRTIO_CRYPTO_CIPHER_SNOW3G_UEA2:
79 		ret = RTE_CRYPTO_CIPHER_SNOW3G_UEA2;
80 		break;
81 	case VIRTIO_CRYPTO_CIPHER_AES_F8:
82 		ret = RTE_CRYPTO_CIPHER_AES_F8;
83 		break;
84 	case VIRTIO_CRYPTO_CIPHER_AES_XTS:
85 		ret = RTE_CRYPTO_CIPHER_AES_XTS;
86 		break;
87 	case VIRTIO_CRYPTO_CIPHER_ZUC_EEA3:
88 		ret = RTE_CRYPTO_CIPHER_ZUC_EEA3;
89 		break;
90 	default:
91 		ret = -VIRTIO_CRYPTO_BADMSG;
92 		break;
93 	}
94 
95 	return ret;
96 }
97 
98 static int
99 auth_algo_transform(uint32_t virtio_auth_algo)
100 {
101 	int ret;
102 
103 	switch (virtio_auth_algo) {
104 
105 	case VIRTIO_CRYPTO_NO_MAC:
106 		ret = RTE_CRYPTO_AUTH_NULL;
107 		break;
108 	case VIRTIO_CRYPTO_MAC_HMAC_MD5:
109 		ret = RTE_CRYPTO_AUTH_MD5_HMAC;
110 		break;
111 	case VIRTIO_CRYPTO_MAC_HMAC_SHA1:
112 		ret = RTE_CRYPTO_AUTH_SHA1_HMAC;
113 		break;
114 	case VIRTIO_CRYPTO_MAC_HMAC_SHA_224:
115 		ret = RTE_CRYPTO_AUTH_SHA224_HMAC;
116 		break;
117 	case VIRTIO_CRYPTO_MAC_HMAC_SHA_256:
118 		ret = RTE_CRYPTO_AUTH_SHA256_HMAC;
119 		break;
120 	case VIRTIO_CRYPTO_MAC_HMAC_SHA_384:
121 		ret = RTE_CRYPTO_AUTH_SHA384_HMAC;
122 		break;
123 	case VIRTIO_CRYPTO_MAC_HMAC_SHA_512:
124 		ret = RTE_CRYPTO_AUTH_SHA512_HMAC;
125 		break;
126 	case VIRTIO_CRYPTO_MAC_CMAC_3DES:
127 		ret = -VIRTIO_CRYPTO_NOTSUPP;
128 		break;
129 	case VIRTIO_CRYPTO_MAC_CMAC_AES:
130 		ret = RTE_CRYPTO_AUTH_AES_CMAC;
131 		break;
132 	case VIRTIO_CRYPTO_MAC_KASUMI_F9:
133 		ret = RTE_CRYPTO_AUTH_KASUMI_F9;
134 		break;
135 	case VIRTIO_CRYPTO_MAC_SNOW3G_UIA2:
136 		ret = RTE_CRYPTO_AUTH_SNOW3G_UIA2;
137 		break;
138 	case VIRTIO_CRYPTO_MAC_GMAC_AES:
139 		ret = RTE_CRYPTO_AUTH_AES_GMAC;
140 		break;
141 	case VIRTIO_CRYPTO_MAC_GMAC_TWOFISH:
142 		ret = -VIRTIO_CRYPTO_NOTSUPP;
143 		break;
144 	case VIRTIO_CRYPTO_MAC_CBCMAC_AES:
145 		ret = RTE_CRYPTO_AUTH_AES_CBC_MAC;
146 		break;
147 	case VIRTIO_CRYPTO_MAC_CBCMAC_KASUMI_F9:
148 		ret = -VIRTIO_CRYPTO_NOTSUPP;
149 		break;
150 	case VIRTIO_CRYPTO_MAC_XCBC_AES:
151 		ret = RTE_CRYPTO_AUTH_AES_XCBC_MAC;
152 		break;
153 	default:
154 		ret = -VIRTIO_CRYPTO_BADMSG;
155 		break;
156 	}
157 
158 	return ret;
159 }
160 
161 static int get_iv_len(enum rte_crypto_cipher_algorithm algo)
162 {
163 	int len;
164 
165 	switch (algo) {
166 	case RTE_CRYPTO_CIPHER_3DES_CBC:
167 		len = 8;
168 		break;
169 	case RTE_CRYPTO_CIPHER_3DES_CTR:
170 		len = 8;
171 		break;
172 	case RTE_CRYPTO_CIPHER_3DES_ECB:
173 		len = 8;
174 		break;
175 	case RTE_CRYPTO_CIPHER_AES_CBC:
176 		len = 16;
177 		break;
178 
179 	/* TODO: add common algos */
180 
181 	default:
182 		len = -1;
183 		break;
184 	}
185 
186 	return len;
187 }
188 
189 /**
190  * vhost_crypto struct is used to maintain a number of virtio_cryptos and
191  * one DPDK crypto device that deals with all crypto workloads. It is declared
192  * here and defined in vhost_crypto.c
193  */
194 struct vhost_crypto {
195 	/** Used to lookup DPDK Cryptodev Session based on VIRTIO crypto
196 	 *  session ID.
197 	 */
198 	struct rte_hash *session_map;
199 	struct rte_mempool *mbuf_pool;
200 	struct rte_mempool *sess_pool;
201 	struct rte_mempool *wb_pool;
202 
203 	/** DPDK cryptodev ID */
204 	uint8_t cid;
205 	uint16_t nb_qps;
206 
207 	uint64_t last_session_id;
208 
209 	uint64_t cache_session_id;
210 	struct rte_cryptodev_sym_session *cache_session;
211 	/** socket id for the device */
212 	int socket_id;
213 
214 	struct virtio_net *dev;
215 
216 	uint8_t option;
217 } __rte_cache_aligned;
218 
219 struct vhost_crypto_writeback_data {
220 	uint8_t *src;
221 	uint8_t *dst;
222 	uint64_t len;
223 	struct vhost_crypto_writeback_data *next;
224 };
225 
226 struct vhost_crypto_data_req {
227 	struct vring_desc *head;
228 	struct virtio_net *dev;
229 	struct virtio_crypto_inhdr *inhdr;
230 	struct vhost_virtqueue *vq;
231 	struct vhost_crypto_writeback_data *wb;
232 	struct rte_mempool *wb_pool;
233 	uint16_t desc_idx;
234 	uint16_t len;
235 	uint16_t zero_copy;
236 };
237 
238 static int
239 transform_cipher_param(struct rte_crypto_sym_xform *xform,
240 		VhostUserCryptoSessionParam *param)
241 {
242 	int ret;
243 
244 	ret = cipher_algo_transform(param->cipher_algo);
245 	if (unlikely(ret < 0))
246 		return ret;
247 
248 	xform->type = RTE_CRYPTO_SYM_XFORM_CIPHER;
249 	xform->cipher.algo = (enum rte_crypto_cipher_algorithm)ret;
250 	xform->cipher.key.length = param->cipher_key_len;
251 	if (xform->cipher.key.length > 0)
252 		xform->cipher.key.data = param->cipher_key_buf;
253 	if (param->dir == VIRTIO_CRYPTO_OP_ENCRYPT)
254 		xform->cipher.op = RTE_CRYPTO_CIPHER_OP_ENCRYPT;
255 	else if (param->dir == VIRTIO_CRYPTO_OP_DECRYPT)
256 		xform->cipher.op = RTE_CRYPTO_CIPHER_OP_DECRYPT;
257 	else {
258 		VC_LOG_DBG("Bad operation type");
259 		return -VIRTIO_CRYPTO_BADMSG;
260 	}
261 
262 	ret = get_iv_len(xform->cipher.algo);
263 	if (unlikely(ret < 0))
264 		return ret;
265 	xform->cipher.iv.length = (uint16_t)ret;
266 	xform->cipher.iv.offset = IV_OFFSET;
267 	return 0;
268 }
269 
270 static int
271 transform_chain_param(struct rte_crypto_sym_xform *xforms,
272 		VhostUserCryptoSessionParam *param)
273 {
274 	struct rte_crypto_sym_xform *xform_cipher, *xform_auth;
275 	int ret;
276 
277 	switch (param->chaining_dir) {
278 	case VIRTIO_CRYPTO_SYM_ALG_CHAIN_ORDER_HASH_THEN_CIPHER:
279 		xform_auth = xforms;
280 		xform_cipher = xforms->next;
281 		xform_cipher->cipher.op = RTE_CRYPTO_CIPHER_OP_DECRYPT;
282 		xform_auth->auth.op = RTE_CRYPTO_AUTH_OP_VERIFY;
283 		break;
284 	case VIRTIO_CRYPTO_SYM_ALG_CHAIN_ORDER_CIPHER_THEN_HASH:
285 		xform_cipher = xforms;
286 		xform_auth = xforms->next;
287 		xform_cipher->cipher.op = RTE_CRYPTO_CIPHER_OP_ENCRYPT;
288 		xform_auth->auth.op = RTE_CRYPTO_AUTH_OP_GENERATE;
289 		break;
290 	default:
291 		return -VIRTIO_CRYPTO_BADMSG;
292 	}
293 
294 	/* cipher */
295 	ret = cipher_algo_transform(param->cipher_algo);
296 	if (unlikely(ret < 0))
297 		return ret;
298 	xform_cipher->type = RTE_CRYPTO_SYM_XFORM_CIPHER;
299 	xform_cipher->cipher.algo = (enum rte_crypto_cipher_algorithm)ret;
300 	xform_cipher->cipher.key.length = param->cipher_key_len;
301 	xform_cipher->cipher.key.data = param->cipher_key_buf;
302 	ret = get_iv_len(xform_cipher->cipher.algo);
303 	if (unlikely(ret < 0))
304 		return ret;
305 	xform_cipher->cipher.iv.length = (uint16_t)ret;
306 	xform_cipher->cipher.iv.offset = IV_OFFSET;
307 
308 	/* auth */
309 	xform_auth->type = RTE_CRYPTO_SYM_XFORM_AUTH;
310 	ret = auth_algo_transform(param->hash_algo);
311 	if (unlikely(ret < 0))
312 		return ret;
313 	xform_auth->auth.algo = (enum rte_crypto_auth_algorithm)ret;
314 	xform_auth->auth.digest_length = param->digest_len;
315 	xform_auth->auth.key.length = param->auth_key_len;
316 	xform_auth->auth.key.data = param->auth_key_buf;
317 
318 	return 0;
319 }
320 
321 static void
322 vhost_crypto_create_sess(struct vhost_crypto *vcrypto,
323 		VhostUserCryptoSessionParam *sess_param)
324 {
325 	struct rte_crypto_sym_xform xform1 = {0}, xform2 = {0};
326 	struct rte_cryptodev_sym_session *session;
327 	int ret;
328 
329 	switch (sess_param->op_type) {
330 	case VIRTIO_CRYPTO_SYM_OP_NONE:
331 	case VIRTIO_CRYPTO_SYM_OP_CIPHER:
332 		ret = transform_cipher_param(&xform1, sess_param);
333 		if (unlikely(ret)) {
334 			VC_LOG_ERR("Error transform session msg (%i)", ret);
335 			sess_param->session_id = ret;
336 			return;
337 		}
338 		break;
339 	case VIRTIO_CRYPTO_SYM_OP_ALGORITHM_CHAINING:
340 		if (unlikely(sess_param->hash_mode !=
341 				VIRTIO_CRYPTO_SYM_HASH_MODE_AUTH)) {
342 			sess_param->session_id = -VIRTIO_CRYPTO_NOTSUPP;
343 			VC_LOG_ERR("Error transform session message (%i)",
344 					-VIRTIO_CRYPTO_NOTSUPP);
345 			return;
346 		}
347 
348 		xform1.next = &xform2;
349 
350 		ret = transform_chain_param(&xform1, sess_param);
351 		if (unlikely(ret)) {
352 			VC_LOG_ERR("Error transform session message (%i)", ret);
353 			sess_param->session_id = ret;
354 			return;
355 		}
356 
357 		break;
358 	default:
359 		VC_LOG_ERR("Algorithm not yet supported");
360 		sess_param->session_id = -VIRTIO_CRYPTO_NOTSUPP;
361 		return;
362 	}
363 
364 	session = rte_cryptodev_sym_session_create(vcrypto->sess_pool);
365 	if (!session) {
366 		VC_LOG_ERR("Failed to create session");
367 		sess_param->session_id = -VIRTIO_CRYPTO_ERR;
368 		return;
369 	}
370 
371 	if (rte_cryptodev_sym_session_init(vcrypto->cid, session, &xform1,
372 			vcrypto->sess_pool) < 0) {
373 		VC_LOG_ERR("Failed to initialize session");
374 		sess_param->session_id = -VIRTIO_CRYPTO_ERR;
375 		return;
376 	}
377 
378 	/* insert hash to map */
379 	if (rte_hash_add_key_data(vcrypto->session_map,
380 			&vcrypto->last_session_id, session) < 0) {
381 		VC_LOG_ERR("Failed to insert session to hash table");
382 
383 		if (rte_cryptodev_sym_session_clear(vcrypto->cid, session) < 0)
384 			VC_LOG_ERR("Failed to clear session");
385 		else {
386 			if (rte_cryptodev_sym_session_free(session) < 0)
387 				VC_LOG_ERR("Failed to free session");
388 		}
389 		sess_param->session_id = -VIRTIO_CRYPTO_ERR;
390 		return;
391 	}
392 
393 	VC_LOG_INFO("Session %"PRIu64" created for vdev %i.",
394 			vcrypto->last_session_id, vcrypto->dev->vid);
395 
396 	sess_param->session_id = vcrypto->last_session_id;
397 	vcrypto->last_session_id++;
398 }
399 
400 static int
401 vhost_crypto_close_sess(struct vhost_crypto *vcrypto, uint64_t session_id)
402 {
403 	struct rte_cryptodev_sym_session *session;
404 	uint64_t sess_id = session_id;
405 	int ret;
406 
407 	ret = rte_hash_lookup_data(vcrypto->session_map, &sess_id,
408 			(void **)&session);
409 
410 	if (unlikely(ret < 0)) {
411 		VC_LOG_ERR("Failed to delete session %"PRIu64".", session_id);
412 		return -VIRTIO_CRYPTO_INVSESS;
413 	}
414 
415 	if (rte_cryptodev_sym_session_clear(vcrypto->cid, session) < 0) {
416 		VC_LOG_DBG("Failed to clear session");
417 		return -VIRTIO_CRYPTO_ERR;
418 	}
419 
420 	if (rte_cryptodev_sym_session_free(session) < 0) {
421 		VC_LOG_DBG("Failed to free session");
422 		return -VIRTIO_CRYPTO_ERR;
423 	}
424 
425 	if (rte_hash_del_key(vcrypto->session_map, &sess_id) < 0) {
426 		VC_LOG_DBG("Failed to delete session from hash table.");
427 		return -VIRTIO_CRYPTO_ERR;
428 	}
429 
430 	VC_LOG_INFO("Session %"PRIu64" deleted for vdev %i.", sess_id,
431 			vcrypto->dev->vid);
432 
433 	return 0;
434 }
435 
436 static enum vh_result
437 vhost_crypto_msg_post_handler(int vid, void *msg)
438 {
439 	struct virtio_net *dev = get_device(vid);
440 	struct vhost_crypto *vcrypto;
441 	VhostUserMsg *vmsg = msg;
442 	enum vh_result ret = VH_RESULT_OK;
443 
444 	if (dev == NULL) {
445 		VC_LOG_ERR("Invalid vid %i", vid);
446 		return VH_RESULT_ERR;
447 	}
448 
449 	vcrypto = dev->extern_data;
450 	if (vcrypto == NULL) {
451 		VC_LOG_ERR("Cannot find required data, is it initialized?");
452 		return VH_RESULT_ERR;
453 	}
454 
455 	if (vmsg->request.master == VHOST_USER_CRYPTO_CREATE_SESS) {
456 		vhost_crypto_create_sess(vcrypto,
457 				&vmsg->payload.crypto_session);
458 		vmsg->fd_num = 0;
459 		ret = VH_RESULT_REPLY;
460 	} else if (vmsg->request.master == VHOST_USER_CRYPTO_CLOSE_SESS) {
461 		if (vhost_crypto_close_sess(vcrypto, vmsg->payload.u64))
462 			ret = VH_RESULT_ERR;
463 	}
464 
465 	return ret;
466 }
467 
468 static __rte_always_inline struct vring_desc *
469 find_write_desc(struct vring_desc *head, struct vring_desc *desc,
470 		uint32_t *nb_descs, uint32_t vq_size)
471 {
472 	if (desc->flags & VRING_DESC_F_WRITE)
473 		return desc;
474 
475 	while (desc->flags & VRING_DESC_F_NEXT) {
476 		if (unlikely(*nb_descs == 0 || desc->next >= vq_size))
477 			return NULL;
478 		(*nb_descs)--;
479 
480 		desc = &head[desc->next];
481 		if (desc->flags & VRING_DESC_F_WRITE)
482 			return desc;
483 	}
484 
485 	return NULL;
486 }
487 
488 static struct virtio_crypto_inhdr *
489 reach_inhdr(struct vhost_crypto_data_req *vc_req, struct vring_desc *desc,
490 		uint32_t *nb_descs, uint32_t vq_size)
491 {
492 	uint64_t dlen;
493 	struct virtio_crypto_inhdr *inhdr;
494 
495 	while (desc->flags & VRING_DESC_F_NEXT) {
496 		if (unlikely(*nb_descs == 0 || desc->next >= vq_size))
497 			return NULL;
498 		(*nb_descs)--;
499 		desc = &vc_req->head[desc->next];
500 	}
501 
502 	dlen = desc->len;
503 	inhdr = IOVA_TO_VVA(struct virtio_crypto_inhdr *, vc_req, desc->addr,
504 			&dlen, VHOST_ACCESS_WO);
505 	if (unlikely(!inhdr || dlen != desc->len))
506 		return NULL;
507 
508 	return inhdr;
509 }
510 
511 static __rte_always_inline int
512 move_desc(struct vring_desc *head, struct vring_desc **cur_desc,
513 		uint32_t size, uint32_t *nb_descs, uint32_t vq_size)
514 {
515 	struct vring_desc *desc = *cur_desc;
516 	int left = size - desc->len;
517 
518 	while ((desc->flags & VRING_DESC_F_NEXT) && left > 0) {
519 		(*nb_descs)--;
520 		if (unlikely(*nb_descs == 0 || desc->next >= vq_size))
521 			return -1;
522 
523 		desc = &head[desc->next];
524 		rte_prefetch0(&head[desc->next]);
525 		left -= desc->len;
526 	}
527 
528 	if (unlikely(left > 0))
529 		return -1;
530 
531 	if (unlikely(*nb_descs == 0))
532 		*cur_desc = NULL;
533 	else {
534 		if (unlikely(desc->next >= vq_size))
535 			return -1;
536 		*cur_desc = &head[desc->next];
537 	}
538 
539 	return 0;
540 }
541 
542 static __rte_always_inline void *
543 get_data_ptr(struct vhost_crypto_data_req *vc_req, struct vring_desc *cur_desc,
544 		uint8_t perm)
545 {
546 	void *data;
547 	uint64_t dlen = cur_desc->len;
548 
549 	data = IOVA_TO_VVA(void *, vc_req, cur_desc->addr, &dlen, perm);
550 	if (unlikely(!data || dlen != cur_desc->len)) {
551 		VC_LOG_ERR("Failed to map object");
552 		return NULL;
553 	}
554 
555 	return data;
556 }
557 
558 static int
559 copy_data(void *dst_data, struct vhost_crypto_data_req *vc_req,
560 		struct vring_desc **cur_desc, uint32_t size,
561 		uint32_t *nb_descs, uint32_t vq_size)
562 {
563 	struct vring_desc *desc = *cur_desc;
564 	uint64_t remain, addr, dlen, len;
565 	uint32_t to_copy;
566 	uint8_t *data = dst_data;
567 	uint8_t *src;
568 	int left = size;
569 
570 	to_copy = RTE_MIN(desc->len, (uint32_t)left);
571 	dlen = to_copy;
572 	src = IOVA_TO_VVA(uint8_t *, vc_req, desc->addr, &dlen,
573 			VHOST_ACCESS_RO);
574 	if (unlikely(!src || !dlen))
575 		return -1;
576 
577 	rte_memcpy((uint8_t *)data, src, dlen);
578 	data += dlen;
579 
580 	if (unlikely(dlen < to_copy)) {
581 		remain = to_copy - dlen;
582 		addr = desc->addr + dlen;
583 
584 		while (remain) {
585 			len = remain;
586 			src = IOVA_TO_VVA(uint8_t *, vc_req, addr, &len,
587 					VHOST_ACCESS_RO);
588 			if (unlikely(!src || !len)) {
589 				VC_LOG_ERR("Failed to map descriptor");
590 				return -1;
591 			}
592 
593 			rte_memcpy(data, src, len);
594 			addr += len;
595 			remain -= len;
596 			data += len;
597 		}
598 	}
599 
600 	left -= to_copy;
601 
602 	while ((desc->flags & VRING_DESC_F_NEXT) && left > 0) {
603 		if (unlikely(*nb_descs == 0 || desc->next >= vq_size)) {
604 			VC_LOG_ERR("Invalid descriptors");
605 			return -1;
606 		}
607 		(*nb_descs)--;
608 
609 		desc = &vc_req->head[desc->next];
610 		rte_prefetch0(&vc_req->head[desc->next]);
611 		to_copy = RTE_MIN(desc->len, (uint32_t)left);
612 		dlen = desc->len;
613 		src = IOVA_TO_VVA(uint8_t *, vc_req, desc->addr, &dlen,
614 				VHOST_ACCESS_RO);
615 		if (unlikely(!src || !dlen)) {
616 			VC_LOG_ERR("Failed to map descriptor");
617 			return -1;
618 		}
619 
620 		rte_memcpy(data, src, dlen);
621 		data += dlen;
622 
623 		if (unlikely(dlen < to_copy)) {
624 			remain = to_copy - dlen;
625 			addr = desc->addr + dlen;
626 
627 			while (remain) {
628 				len = remain;
629 				src = IOVA_TO_VVA(uint8_t *, vc_req, addr, &len,
630 						VHOST_ACCESS_RO);
631 				if (unlikely(!src || !len)) {
632 					VC_LOG_ERR("Failed to map descriptor");
633 					return -1;
634 				}
635 
636 				rte_memcpy(data, src, len);
637 				addr += len;
638 				remain -= len;
639 				data += len;
640 			}
641 		}
642 
643 		left -= to_copy;
644 	}
645 
646 	if (unlikely(left > 0)) {
647 		VC_LOG_ERR("Incorrect virtio descriptor");
648 		return -1;
649 	}
650 
651 	if (unlikely(*nb_descs == 0))
652 		*cur_desc = NULL;
653 	else {
654 		if (unlikely(desc->next >= vq_size))
655 			return -1;
656 		*cur_desc = &vc_req->head[desc->next];
657 	}
658 
659 	return 0;
660 }
661 
662 static void
663 write_back_data(struct vhost_crypto_data_req *vc_req)
664 {
665 	struct vhost_crypto_writeback_data *wb_data = vc_req->wb, *wb_last;
666 
667 	while (wb_data) {
668 		rte_memcpy(wb_data->dst, wb_data->src, wb_data->len);
669 		wb_last = wb_data;
670 		wb_data = wb_data->next;
671 		rte_mempool_put(vc_req->wb_pool, wb_last);
672 	}
673 }
674 
675 static void
676 free_wb_data(struct vhost_crypto_writeback_data *wb_data,
677 		struct rte_mempool *mp)
678 {
679 	while (wb_data->next != NULL)
680 		free_wb_data(wb_data->next, mp);
681 
682 	rte_mempool_put(mp, wb_data);
683 }
684 
685 /**
686  * The function will allocate a vhost_crypto_writeback_data linked list
687  * containing the source and destination data pointers for the write back
688  * operation after dequeued from Cryptodev PMD queues.
689  *
690  * @param vc_req
691  *   The vhost crypto data request pointer
692  * @param cur_desc
693  *   The pointer of the current in use descriptor pointer. The content of
694  *   cur_desc is expected to be updated after the function execution.
695  * @param end_wb_data
696  *   The last write back data element to be returned. It is used only in cipher
697  *   and hash chain operations.
698  * @param src
699  *   The source data pointer
700  * @param offset
701  *   The offset to both source and destination data. For source data the offset
702  *   is the number of bytes between src and start point of cipher operation. For
703  *   destination data the offset is the number of bytes from *cur_desc->addr
704  *   to the point where the src will be written to.
705  * @param write_back_len
706  *   The size of the write back length.
707  * @return
708  *   The pointer to the start of the write back data linked list.
709  */
710 static struct vhost_crypto_writeback_data *
711 prepare_write_back_data(struct vhost_crypto_data_req *vc_req,
712 		struct vring_desc **cur_desc,
713 		struct vhost_crypto_writeback_data **end_wb_data,
714 		uint8_t *src,
715 		uint32_t offset,
716 		uint64_t write_back_len,
717 		uint32_t *nb_descs, uint32_t vq_size)
718 {
719 	struct vhost_crypto_writeback_data *wb_data, *head;
720 	struct vring_desc *desc = *cur_desc;
721 	uint64_t dlen;
722 	uint8_t *dst;
723 	int ret;
724 
725 	ret = rte_mempool_get(vc_req->wb_pool, (void **)&head);
726 	if (unlikely(ret < 0)) {
727 		VC_LOG_ERR("no memory");
728 		goto error_exit;
729 	}
730 
731 	wb_data = head;
732 
733 	if (likely(desc->len > offset)) {
734 		wb_data->src = src + offset;
735 		dlen = desc->len;
736 		dst = IOVA_TO_VVA(uint8_t *, vc_req, desc->addr,
737 			&dlen, VHOST_ACCESS_RW) + offset;
738 		if (unlikely(!dst || dlen != desc->len)) {
739 			VC_LOG_ERR("Failed to map descriptor");
740 			goto error_exit;
741 		}
742 
743 		wb_data->dst = dst;
744 		wb_data->len = desc->len - offset;
745 		write_back_len -= wb_data->len;
746 		src += offset + wb_data->len;
747 		offset = 0;
748 
749 		if (unlikely(write_back_len)) {
750 			ret = rte_mempool_get(vc_req->wb_pool,
751 					(void **)&(wb_data->next));
752 			if (unlikely(ret < 0)) {
753 				VC_LOG_ERR("no memory");
754 				goto error_exit;
755 			}
756 
757 			wb_data = wb_data->next;
758 		} else
759 			wb_data->next = NULL;
760 	} else
761 		offset -= desc->len;
762 
763 	while (write_back_len) {
764 		if (unlikely(*nb_descs == 0 || desc->next >= vq_size)) {
765 			VC_LOG_ERR("Invalid descriptors");
766 			goto error_exit;
767 		}
768 		(*nb_descs)--;
769 
770 		desc = &vc_req->head[desc->next];
771 		if (unlikely(!(desc->flags & VRING_DESC_F_WRITE))) {
772 			VC_LOG_ERR("incorrect descriptor");
773 			goto error_exit;
774 		}
775 
776 		if (desc->len <= offset) {
777 			offset -= desc->len;
778 			continue;
779 		}
780 
781 		dlen = desc->len;
782 		dst = IOVA_TO_VVA(uint8_t *, vc_req, desc->addr, &dlen,
783 				VHOST_ACCESS_RW) + offset;
784 		if (unlikely(dst == NULL || dlen != desc->len)) {
785 			VC_LOG_ERR("Failed to map descriptor");
786 			goto error_exit;
787 		}
788 
789 		wb_data->src = src;
790 		wb_data->dst = dst;
791 		wb_data->len = RTE_MIN(desc->len - offset, write_back_len);
792 		write_back_len -= wb_data->len;
793 		src += wb_data->len;
794 		offset = 0;
795 
796 		if (write_back_len) {
797 			ret = rte_mempool_get(vc_req->wb_pool,
798 					(void **)&(wb_data->next));
799 			if (unlikely(ret < 0)) {
800 				VC_LOG_ERR("no memory");
801 				goto error_exit;
802 			}
803 
804 			wb_data = wb_data->next;
805 		} else
806 			wb_data->next = NULL;
807 	}
808 
809 	if (unlikely(*nb_descs == 0))
810 		*cur_desc = NULL;
811 	else {
812 		if (unlikely(desc->next >= vq_size))
813 			goto error_exit;
814 		*cur_desc = &vc_req->head[desc->next];
815 	}
816 
817 	*end_wb_data = wb_data;
818 
819 	return head;
820 
821 error_exit:
822 	if (head)
823 		free_wb_data(head, vc_req->wb_pool);
824 
825 	return NULL;
826 }
827 
828 static uint8_t
829 prepare_sym_cipher_op(struct vhost_crypto *vcrypto, struct rte_crypto_op *op,
830 		struct vhost_crypto_data_req *vc_req,
831 		struct virtio_crypto_cipher_data_req *cipher,
832 		struct vring_desc *cur_desc,
833 		uint32_t *nb_descs, uint32_t vq_size)
834 {
835 	struct vring_desc *desc = cur_desc;
836 	struct vhost_crypto_writeback_data *ewb = NULL;
837 	struct rte_mbuf *m_src = op->sym->m_src, *m_dst = op->sym->m_dst;
838 	uint8_t *iv_data = rte_crypto_op_ctod_offset(op, uint8_t *, IV_OFFSET);
839 	uint8_t ret = 0;
840 
841 	/* prepare */
842 	/* iv */
843 	if (unlikely(copy_data(iv_data, vc_req, &desc, cipher->para.iv_len,
844 			nb_descs, vq_size) < 0)) {
845 		ret = VIRTIO_CRYPTO_BADMSG;
846 		goto error_exit;
847 	}
848 
849 	m_src->data_len = cipher->para.src_data_len;
850 
851 	switch (vcrypto->option) {
852 	case RTE_VHOST_CRYPTO_ZERO_COPY_ENABLE:
853 		m_src->buf_iova = gpa_to_hpa(vcrypto->dev, desc->addr,
854 				cipher->para.src_data_len);
855 		m_src->buf_addr = get_data_ptr(vc_req, desc, VHOST_ACCESS_RO);
856 		if (unlikely(m_src->buf_iova == 0 ||
857 				m_src->buf_addr == NULL)) {
858 			VC_LOG_ERR("zero_copy may fail due to cross page data");
859 			ret = VIRTIO_CRYPTO_ERR;
860 			goto error_exit;
861 		}
862 
863 		if (unlikely(move_desc(vc_req->head, &desc,
864 				cipher->para.src_data_len, nb_descs,
865 				vq_size) < 0)) {
866 			VC_LOG_ERR("Incorrect descriptor");
867 			ret = VIRTIO_CRYPTO_ERR;
868 			goto error_exit;
869 		}
870 
871 		break;
872 	case RTE_VHOST_CRYPTO_ZERO_COPY_DISABLE:
873 		vc_req->wb_pool = vcrypto->wb_pool;
874 
875 		if (unlikely(cipher->para.src_data_len >
876 				RTE_MBUF_DEFAULT_BUF_SIZE)) {
877 			VC_LOG_ERR("Not enough space to do data copy");
878 			ret = VIRTIO_CRYPTO_ERR;
879 			goto error_exit;
880 		}
881 		if (unlikely(copy_data(rte_pktmbuf_mtod(m_src, uint8_t *),
882 				vc_req, &desc, cipher->para.src_data_len,
883 				nb_descs, vq_size) < 0)) {
884 			ret = VIRTIO_CRYPTO_BADMSG;
885 			goto error_exit;
886 		}
887 		break;
888 	default:
889 		ret = VIRTIO_CRYPTO_BADMSG;
890 		goto error_exit;
891 	}
892 
893 	/* dst */
894 	desc = find_write_desc(vc_req->head, desc, nb_descs, vq_size);
895 	if (unlikely(!desc)) {
896 		VC_LOG_ERR("Cannot find write location");
897 		ret = VIRTIO_CRYPTO_BADMSG;
898 		goto error_exit;
899 	}
900 
901 	switch (vcrypto->option) {
902 	case RTE_VHOST_CRYPTO_ZERO_COPY_ENABLE:
903 		m_dst->buf_iova = gpa_to_hpa(vcrypto->dev,
904 				desc->addr, cipher->para.dst_data_len);
905 		m_dst->buf_addr = get_data_ptr(vc_req, desc, VHOST_ACCESS_RW);
906 		if (unlikely(m_dst->buf_iova == 0 || m_dst->buf_addr == NULL)) {
907 			VC_LOG_ERR("zero_copy may fail due to cross page data");
908 			ret = VIRTIO_CRYPTO_ERR;
909 			goto error_exit;
910 		}
911 
912 		if (unlikely(move_desc(vc_req->head, &desc,
913 				cipher->para.dst_data_len,
914 				nb_descs, vq_size) < 0)) {
915 			VC_LOG_ERR("Incorrect descriptor");
916 			ret = VIRTIO_CRYPTO_ERR;
917 			goto error_exit;
918 		}
919 
920 		m_dst->data_len = cipher->para.dst_data_len;
921 		break;
922 	case RTE_VHOST_CRYPTO_ZERO_COPY_DISABLE:
923 		vc_req->wb = prepare_write_back_data(vc_req, &desc, &ewb,
924 				rte_pktmbuf_mtod(m_src, uint8_t *), 0,
925 				cipher->para.dst_data_len, nb_descs, vq_size);
926 		if (unlikely(vc_req->wb == NULL)) {
927 			ret = VIRTIO_CRYPTO_ERR;
928 			goto error_exit;
929 		}
930 
931 		break;
932 	default:
933 		ret = VIRTIO_CRYPTO_BADMSG;
934 		goto error_exit;
935 	}
936 
937 	/* src data */
938 	op->type = RTE_CRYPTO_OP_TYPE_SYMMETRIC;
939 	op->sess_type = RTE_CRYPTO_OP_WITH_SESSION;
940 
941 	op->sym->cipher.data.offset = 0;
942 	op->sym->cipher.data.length = cipher->para.src_data_len;
943 
944 	vc_req->inhdr = get_data_ptr(vc_req, desc, VHOST_ACCESS_WO);
945 	if (unlikely(vc_req->inhdr == NULL)) {
946 		ret = VIRTIO_CRYPTO_BADMSG;
947 		goto error_exit;
948 	}
949 
950 	vc_req->inhdr->status = VIRTIO_CRYPTO_OK;
951 	vc_req->len = cipher->para.dst_data_len + INHDR_LEN;
952 
953 	return 0;
954 
955 error_exit:
956 	if (vc_req->wb)
957 		free_wb_data(vc_req->wb, vc_req->wb_pool);
958 
959 	vc_req->len = INHDR_LEN;
960 	return ret;
961 }
962 
963 static uint8_t
964 prepare_sym_chain_op(struct vhost_crypto *vcrypto, struct rte_crypto_op *op,
965 		struct vhost_crypto_data_req *vc_req,
966 		struct virtio_crypto_alg_chain_data_req *chain,
967 		struct vring_desc *cur_desc,
968 		uint32_t *nb_descs, uint32_t vq_size)
969 {
970 	struct vring_desc *desc = cur_desc, *digest_desc;
971 	struct vhost_crypto_writeback_data *ewb = NULL, *ewb2 = NULL;
972 	struct rte_mbuf *m_src = op->sym->m_src, *m_dst = op->sym->m_dst;
973 	uint8_t *iv_data = rte_crypto_op_ctod_offset(op, uint8_t *, IV_OFFSET);
974 	uint32_t digest_offset;
975 	void *digest_addr;
976 	uint8_t ret = 0;
977 
978 	/* prepare */
979 	/* iv */
980 	if (unlikely(copy_data(iv_data, vc_req, &desc,
981 			chain->para.iv_len, nb_descs, vq_size) < 0)) {
982 		ret = VIRTIO_CRYPTO_BADMSG;
983 		goto error_exit;
984 	}
985 
986 	m_src->data_len = chain->para.src_data_len;
987 
988 	switch (vcrypto->option) {
989 	case RTE_VHOST_CRYPTO_ZERO_COPY_ENABLE:
990 		m_dst->data_len = chain->para.dst_data_len;
991 
992 		m_src->buf_iova = gpa_to_hpa(vcrypto->dev, desc->addr,
993 				chain->para.src_data_len);
994 		m_src->buf_addr = get_data_ptr(vc_req, desc, VHOST_ACCESS_RO);
995 		if (unlikely(m_src->buf_iova == 0 || m_src->buf_addr == NULL)) {
996 			VC_LOG_ERR("zero_copy may fail due to cross page data");
997 			ret = VIRTIO_CRYPTO_ERR;
998 			goto error_exit;
999 		}
1000 
1001 		if (unlikely(move_desc(vc_req->head, &desc,
1002 				chain->para.src_data_len,
1003 				nb_descs, vq_size) < 0)) {
1004 			VC_LOG_ERR("Incorrect descriptor");
1005 			ret = VIRTIO_CRYPTO_ERR;
1006 			goto error_exit;
1007 		}
1008 		break;
1009 	case RTE_VHOST_CRYPTO_ZERO_COPY_DISABLE:
1010 		vc_req->wb_pool = vcrypto->wb_pool;
1011 
1012 		if (unlikely(chain->para.src_data_len >
1013 				RTE_MBUF_DEFAULT_BUF_SIZE)) {
1014 			VC_LOG_ERR("Not enough space to do data copy");
1015 			ret = VIRTIO_CRYPTO_ERR;
1016 			goto error_exit;
1017 		}
1018 		if (unlikely(copy_data(rte_pktmbuf_mtod(m_src, uint8_t *),
1019 				vc_req, &desc, chain->para.src_data_len,
1020 				nb_descs, vq_size)) < 0) {
1021 			ret = VIRTIO_CRYPTO_BADMSG;
1022 			goto error_exit;
1023 		}
1024 
1025 		break;
1026 	default:
1027 		ret = VIRTIO_CRYPTO_BADMSG;
1028 		goto error_exit;
1029 	}
1030 
1031 	/* dst */
1032 	desc = find_write_desc(vc_req->head, desc, nb_descs, vq_size);
1033 	if (unlikely(!desc)) {
1034 		VC_LOG_ERR("Cannot find write location");
1035 		ret = VIRTIO_CRYPTO_BADMSG;
1036 		goto error_exit;
1037 	}
1038 
1039 	switch (vcrypto->option) {
1040 	case RTE_VHOST_CRYPTO_ZERO_COPY_ENABLE:
1041 		m_dst->buf_iova = gpa_to_hpa(vcrypto->dev,
1042 				desc->addr, chain->para.dst_data_len);
1043 		m_dst->buf_addr = get_data_ptr(vc_req, desc, VHOST_ACCESS_RW);
1044 		if (unlikely(m_dst->buf_iova == 0 || m_dst->buf_addr == NULL)) {
1045 			VC_LOG_ERR("zero_copy may fail due to cross page data");
1046 			ret = VIRTIO_CRYPTO_ERR;
1047 			goto error_exit;
1048 		}
1049 
1050 		if (unlikely(move_desc(vc_req->head, &desc,
1051 				chain->para.dst_data_len,
1052 				nb_descs, vq_size) < 0)) {
1053 			VC_LOG_ERR("Incorrect descriptor");
1054 			ret = VIRTIO_CRYPTO_ERR;
1055 			goto error_exit;
1056 		}
1057 
1058 		op->sym->auth.digest.phys_addr = gpa_to_hpa(vcrypto->dev,
1059 				desc->addr, chain->para.hash_result_len);
1060 		op->sym->auth.digest.data = get_data_ptr(vc_req, desc,
1061 				VHOST_ACCESS_RW);
1062 		if (unlikely(op->sym->auth.digest.phys_addr == 0)) {
1063 			VC_LOG_ERR("zero_copy may fail due to cross page data");
1064 			ret = VIRTIO_CRYPTO_ERR;
1065 			goto error_exit;
1066 		}
1067 
1068 		if (unlikely(move_desc(vc_req->head, &desc,
1069 				chain->para.hash_result_len,
1070 				nb_descs, vq_size) < 0)) {
1071 			VC_LOG_ERR("Incorrect descriptor");
1072 			ret = VIRTIO_CRYPTO_ERR;
1073 			goto error_exit;
1074 		}
1075 
1076 		break;
1077 	case RTE_VHOST_CRYPTO_ZERO_COPY_DISABLE:
1078 		vc_req->wb = prepare_write_back_data(vc_req, &desc, &ewb,
1079 				rte_pktmbuf_mtod(m_src, uint8_t *),
1080 				chain->para.cipher_start_src_offset,
1081 				chain->para.dst_data_len -
1082 				chain->para.cipher_start_src_offset,
1083 				nb_descs, vq_size);
1084 		if (unlikely(vc_req->wb == NULL)) {
1085 			ret = VIRTIO_CRYPTO_ERR;
1086 			goto error_exit;
1087 		}
1088 
1089 		digest_offset = m_src->data_len;
1090 		digest_addr = rte_pktmbuf_mtod_offset(m_src, void *,
1091 				digest_offset);
1092 		digest_desc = desc;
1093 
1094 		/** create a wb_data for digest */
1095 		ewb->next = prepare_write_back_data(vc_req, &desc, &ewb2,
1096 				digest_addr, 0, chain->para.hash_result_len,
1097 				nb_descs, vq_size);
1098 		if (unlikely(ewb->next == NULL)) {
1099 			ret = VIRTIO_CRYPTO_ERR;
1100 			goto error_exit;
1101 		}
1102 
1103 		if (unlikely(copy_data(digest_addr, vc_req, &digest_desc,
1104 				chain->para.hash_result_len,
1105 				nb_descs, vq_size) < 0)) {
1106 			ret = VIRTIO_CRYPTO_BADMSG;
1107 			goto error_exit;
1108 		}
1109 
1110 		op->sym->auth.digest.data = digest_addr;
1111 		op->sym->auth.digest.phys_addr = rte_pktmbuf_iova_offset(m_src,
1112 				digest_offset);
1113 		break;
1114 	default:
1115 		ret = VIRTIO_CRYPTO_BADMSG;
1116 		goto error_exit;
1117 	}
1118 
1119 	/* record inhdr */
1120 	vc_req->inhdr = get_data_ptr(vc_req, desc, VHOST_ACCESS_WO);
1121 	if (unlikely(vc_req->inhdr == NULL)) {
1122 		ret = VIRTIO_CRYPTO_BADMSG;
1123 		goto error_exit;
1124 	}
1125 
1126 	vc_req->inhdr->status = VIRTIO_CRYPTO_OK;
1127 
1128 	op->type = RTE_CRYPTO_OP_TYPE_SYMMETRIC;
1129 	op->sess_type = RTE_CRYPTO_OP_WITH_SESSION;
1130 
1131 	op->sym->cipher.data.offset = chain->para.cipher_start_src_offset;
1132 	op->sym->cipher.data.length = chain->para.src_data_len -
1133 			chain->para.cipher_start_src_offset;
1134 
1135 	op->sym->auth.data.offset = chain->para.hash_start_src_offset;
1136 	op->sym->auth.data.length = chain->para.len_to_hash;
1137 
1138 	vc_req->len = chain->para.dst_data_len + chain->para.hash_result_len +
1139 			INHDR_LEN;
1140 	return 0;
1141 
1142 error_exit:
1143 	if (vc_req->wb)
1144 		free_wb_data(vc_req->wb, vc_req->wb_pool);
1145 	vc_req->len = INHDR_LEN;
1146 	return ret;
1147 }
1148 
1149 /**
1150  * Process on descriptor
1151  */
1152 static __rte_always_inline int
1153 vhost_crypto_process_one_req(struct vhost_crypto *vcrypto,
1154 		struct vhost_virtqueue *vq, struct rte_crypto_op *op,
1155 		struct vring_desc *head, uint16_t desc_idx)
1156 {
1157 	struct vhost_crypto_data_req *vc_req = rte_mbuf_to_priv(op->sym->m_src);
1158 	struct rte_cryptodev_sym_session *session;
1159 	struct virtio_crypto_op_data_req *req, tmp_req;
1160 	struct virtio_crypto_inhdr *inhdr;
1161 	struct vring_desc *desc = NULL;
1162 	uint64_t session_id;
1163 	uint64_t dlen;
1164 	uint32_t nb_descs = vq->size;
1165 	int err = 0;
1166 
1167 	vc_req->desc_idx = desc_idx;
1168 	vc_req->dev = vcrypto->dev;
1169 	vc_req->vq = vq;
1170 
1171 	if (likely(head->flags & VRING_DESC_F_INDIRECT)) {
1172 		dlen = head->len;
1173 		nb_descs = dlen / sizeof(struct vring_desc);
1174 		/* drop invalid descriptors */
1175 		if (unlikely(nb_descs > vq->size))
1176 			return -1;
1177 		desc = IOVA_TO_VVA(struct vring_desc *, vc_req, head->addr,
1178 				&dlen, VHOST_ACCESS_RO);
1179 		if (unlikely(!desc || dlen != head->len))
1180 			return -1;
1181 		desc_idx = 0;
1182 		head = desc;
1183 	} else {
1184 		desc = head;
1185 	}
1186 
1187 	vc_req->head = head;
1188 	vc_req->zero_copy = vcrypto->option;
1189 
1190 	req = get_data_ptr(vc_req, desc, VHOST_ACCESS_RO);
1191 	if (unlikely(req == NULL)) {
1192 		switch (vcrypto->option) {
1193 		case RTE_VHOST_CRYPTO_ZERO_COPY_ENABLE:
1194 			err = VIRTIO_CRYPTO_BADMSG;
1195 			VC_LOG_ERR("Invalid descriptor");
1196 			goto error_exit;
1197 		case RTE_VHOST_CRYPTO_ZERO_COPY_DISABLE:
1198 			req = &tmp_req;
1199 			if (unlikely(copy_data(req, vc_req, &desc, sizeof(*req),
1200 					&nb_descs, vq->size) < 0)) {
1201 				err = VIRTIO_CRYPTO_BADMSG;
1202 				VC_LOG_ERR("Invalid descriptor");
1203 				goto error_exit;
1204 			}
1205 			break;
1206 		default:
1207 			err = VIRTIO_CRYPTO_ERR;
1208 			VC_LOG_ERR("Invalid option");
1209 			goto error_exit;
1210 		}
1211 	} else {
1212 		if (unlikely(move_desc(vc_req->head, &desc,
1213 				sizeof(*req), &nb_descs, vq->size) < 0)) {
1214 			VC_LOG_ERR("Incorrect descriptor");
1215 			goto error_exit;
1216 		}
1217 	}
1218 
1219 	switch (req->header.opcode) {
1220 	case VIRTIO_CRYPTO_CIPHER_ENCRYPT:
1221 	case VIRTIO_CRYPTO_CIPHER_DECRYPT:
1222 		session_id = req->header.session_id;
1223 
1224 		/* one branch to avoid unnecessary table lookup */
1225 		if (vcrypto->cache_session_id != session_id) {
1226 			err = rte_hash_lookup_data(vcrypto->session_map,
1227 					&session_id, (void **)&session);
1228 			if (unlikely(err < 0)) {
1229 				err = VIRTIO_CRYPTO_ERR;
1230 				VC_LOG_ERR("Failed to find session %"PRIu64,
1231 						session_id);
1232 				goto error_exit;
1233 			}
1234 
1235 			vcrypto->cache_session = session;
1236 			vcrypto->cache_session_id = session_id;
1237 		}
1238 
1239 		session = vcrypto->cache_session;
1240 
1241 		err = rte_crypto_op_attach_sym_session(op, session);
1242 		if (unlikely(err < 0)) {
1243 			err = VIRTIO_CRYPTO_ERR;
1244 			VC_LOG_ERR("Failed to attach session to op");
1245 			goto error_exit;
1246 		}
1247 
1248 		switch (req->u.sym_req.op_type) {
1249 		case VIRTIO_CRYPTO_SYM_OP_NONE:
1250 			err = VIRTIO_CRYPTO_NOTSUPP;
1251 			break;
1252 		case VIRTIO_CRYPTO_SYM_OP_CIPHER:
1253 			err = prepare_sym_cipher_op(vcrypto, op, vc_req,
1254 					&req->u.sym_req.u.cipher, desc,
1255 					&nb_descs, vq->size);
1256 			break;
1257 		case VIRTIO_CRYPTO_SYM_OP_ALGORITHM_CHAINING:
1258 			err = prepare_sym_chain_op(vcrypto, op, vc_req,
1259 					&req->u.sym_req.u.chain, desc,
1260 					&nb_descs, vq->size);
1261 			break;
1262 		}
1263 		if (unlikely(err != 0)) {
1264 			VC_LOG_ERR("Failed to process sym request");
1265 			goto error_exit;
1266 		}
1267 		break;
1268 	default:
1269 		VC_LOG_ERR("Unsupported symmetric crypto request type %u",
1270 				req->header.opcode);
1271 		goto error_exit;
1272 	}
1273 
1274 	return 0;
1275 
1276 error_exit:
1277 
1278 	inhdr = reach_inhdr(vc_req, desc, &nb_descs, vq->size);
1279 	if (likely(inhdr != NULL))
1280 		inhdr->status = (uint8_t)err;
1281 
1282 	return -1;
1283 }
1284 
1285 static __rte_always_inline struct vhost_virtqueue *
1286 vhost_crypto_finalize_one_request(struct rte_crypto_op *op,
1287 		struct vhost_virtqueue *old_vq)
1288 {
1289 	struct rte_mbuf *m_src = op->sym->m_src;
1290 	struct rte_mbuf *m_dst = op->sym->m_dst;
1291 	struct vhost_crypto_data_req *vc_req = rte_mbuf_to_priv(m_src);
1292 	uint16_t desc_idx;
1293 
1294 	if (unlikely(!vc_req)) {
1295 		VC_LOG_ERR("Failed to retrieve vc_req");
1296 		return NULL;
1297 	}
1298 
1299 	if (old_vq && (vc_req->vq != old_vq))
1300 		return vc_req->vq;
1301 
1302 	desc_idx = vc_req->desc_idx;
1303 
1304 	if (unlikely(op->status != RTE_CRYPTO_OP_STATUS_SUCCESS))
1305 		vc_req->inhdr->status = VIRTIO_CRYPTO_ERR;
1306 	else {
1307 		if (vc_req->zero_copy == 0)
1308 			write_back_data(vc_req);
1309 	}
1310 
1311 	vc_req->vq->used->ring[desc_idx].id = desc_idx;
1312 	vc_req->vq->used->ring[desc_idx].len = vc_req->len;
1313 
1314 	rte_mempool_put(m_src->pool, (void *)m_src);
1315 
1316 	if (m_dst)
1317 		rte_mempool_put(m_dst->pool, (void *)m_dst);
1318 
1319 	return vc_req->vq;
1320 }
1321 
1322 static __rte_always_inline uint16_t
1323 vhost_crypto_complete_one_vm_requests(struct rte_crypto_op **ops,
1324 		uint16_t nb_ops, int *callfd)
1325 {
1326 	uint16_t processed = 1;
1327 	struct vhost_virtqueue *vq, *tmp_vq;
1328 
1329 	if (unlikely(nb_ops == 0))
1330 		return 0;
1331 
1332 	vq = vhost_crypto_finalize_one_request(ops[0], NULL);
1333 	if (unlikely(vq == NULL))
1334 		return 0;
1335 	tmp_vq = vq;
1336 
1337 	while ((processed < nb_ops)) {
1338 		tmp_vq = vhost_crypto_finalize_one_request(ops[processed],
1339 				tmp_vq);
1340 
1341 		if (unlikely(vq != tmp_vq))
1342 			break;
1343 
1344 		processed++;
1345 	}
1346 
1347 	*callfd = vq->callfd;
1348 
1349 	*(volatile uint16_t *)&vq->used->idx += processed;
1350 
1351 	return processed;
1352 }
1353 
1354 int __rte_experimental
1355 rte_vhost_crypto_create(int vid, uint8_t cryptodev_id,
1356 		struct rte_mempool *sess_pool, int socket_id)
1357 {
1358 	struct virtio_net *dev = get_device(vid);
1359 	struct rte_hash_parameters params = {0};
1360 	struct vhost_crypto *vcrypto;
1361 	char name[128];
1362 	int ret;
1363 
1364 	if (!dev) {
1365 		VC_LOG_ERR("Invalid vid %i", vid);
1366 		return -EINVAL;
1367 	}
1368 
1369 	ret = rte_vhost_driver_set_features(dev->ifname,
1370 			VIRTIO_CRYPTO_FEATURES);
1371 	if (ret < 0) {
1372 		VC_LOG_ERR("Error setting features");
1373 		return -1;
1374 	}
1375 
1376 	vcrypto = rte_zmalloc_socket(NULL, sizeof(*vcrypto),
1377 			RTE_CACHE_LINE_SIZE, socket_id);
1378 	if (!vcrypto) {
1379 		VC_LOG_ERR("Insufficient memory");
1380 		return -ENOMEM;
1381 	}
1382 
1383 	vcrypto->sess_pool = sess_pool;
1384 	vcrypto->cid = cryptodev_id;
1385 	vcrypto->cache_session_id = UINT64_MAX;
1386 	vcrypto->last_session_id = 1;
1387 	vcrypto->dev = dev;
1388 	vcrypto->option = RTE_VHOST_CRYPTO_ZERO_COPY_DISABLE;
1389 
1390 	snprintf(name, 127, "HASH_VHOST_CRYPT_%u", (uint32_t)vid);
1391 	params.name = name;
1392 	params.entries = VHOST_CRYPTO_SESSION_MAP_ENTRIES;
1393 	params.hash_func = rte_jhash;
1394 	params.key_len = sizeof(uint64_t);
1395 	params.socket_id = socket_id;
1396 	vcrypto->session_map = rte_hash_create(&params);
1397 	if (!vcrypto->session_map) {
1398 		VC_LOG_ERR("Failed to creath session map");
1399 		ret = -ENOMEM;
1400 		goto error_exit;
1401 	}
1402 
1403 	snprintf(name, 127, "MBUF_POOL_VM_%u", (uint32_t)vid);
1404 	vcrypto->mbuf_pool = rte_pktmbuf_pool_create(name,
1405 			VHOST_CRYPTO_MBUF_POOL_SIZE, 512,
1406 			sizeof(struct vhost_crypto_data_req),
1407 			RTE_MBUF_DEFAULT_DATAROOM * 2 + RTE_PKTMBUF_HEADROOM,
1408 			rte_socket_id());
1409 	if (!vcrypto->mbuf_pool) {
1410 		VC_LOG_ERR("Failed to creath mbuf pool");
1411 		ret = -ENOMEM;
1412 		goto error_exit;
1413 	}
1414 
1415 	snprintf(name, 127, "WB_POOL_VM_%u", (uint32_t)vid);
1416 	vcrypto->wb_pool = rte_mempool_create(name,
1417 			VHOST_CRYPTO_MBUF_POOL_SIZE,
1418 			sizeof(struct vhost_crypto_writeback_data),
1419 			128, 0, NULL, NULL, NULL, NULL,
1420 			rte_socket_id(), 0);
1421 	if (!vcrypto->wb_pool) {
1422 		VC_LOG_ERR("Failed to creath mempool");
1423 		ret = -ENOMEM;
1424 		goto error_exit;
1425 	}
1426 
1427 	dev->extern_data = vcrypto;
1428 	dev->extern_ops.pre_msg_handle = NULL;
1429 	dev->extern_ops.post_msg_handle = vhost_crypto_msg_post_handler;
1430 
1431 	return 0;
1432 
1433 error_exit:
1434 	if (vcrypto->session_map)
1435 		rte_hash_free(vcrypto->session_map);
1436 	if (vcrypto->mbuf_pool)
1437 		rte_mempool_free(vcrypto->mbuf_pool);
1438 
1439 	rte_free(vcrypto);
1440 
1441 	return ret;
1442 }
1443 
1444 int __rte_experimental
1445 rte_vhost_crypto_free(int vid)
1446 {
1447 	struct virtio_net *dev = get_device(vid);
1448 	struct vhost_crypto *vcrypto;
1449 
1450 	if (unlikely(dev == NULL)) {
1451 		VC_LOG_ERR("Invalid vid %i", vid);
1452 		return -EINVAL;
1453 	}
1454 
1455 	vcrypto = dev->extern_data;
1456 	if (unlikely(vcrypto == NULL)) {
1457 		VC_LOG_ERR("Cannot find required data, is it initialized?");
1458 		return -ENOENT;
1459 	}
1460 
1461 	rte_hash_free(vcrypto->session_map);
1462 	rte_mempool_free(vcrypto->mbuf_pool);
1463 	rte_mempool_free(vcrypto->wb_pool);
1464 	rte_free(vcrypto);
1465 
1466 	dev->extern_data = NULL;
1467 	dev->extern_ops.pre_msg_handle = NULL;
1468 	dev->extern_ops.post_msg_handle = NULL;
1469 
1470 	return 0;
1471 }
1472 
1473 int __rte_experimental
1474 rte_vhost_crypto_set_zero_copy(int vid, enum rte_vhost_crypto_zero_copy option)
1475 {
1476 	struct virtio_net *dev = get_device(vid);
1477 	struct vhost_crypto *vcrypto;
1478 
1479 	if (unlikely(dev == NULL)) {
1480 		VC_LOG_ERR("Invalid vid %i", vid);
1481 		return -EINVAL;
1482 	}
1483 
1484 	if (unlikely((uint32_t)option >=
1485 				RTE_VHOST_CRYPTO_MAX_ZERO_COPY_OPTIONS)) {
1486 		VC_LOG_ERR("Invalid option %i", option);
1487 		return -EINVAL;
1488 	}
1489 
1490 	vcrypto = (struct vhost_crypto *)dev->extern_data;
1491 	if (unlikely(vcrypto == NULL)) {
1492 		VC_LOG_ERR("Cannot find required data, is it initialized?");
1493 		return -ENOENT;
1494 	}
1495 
1496 	if (vcrypto->option == (uint8_t)option)
1497 		return 0;
1498 
1499 	if (!(rte_mempool_full(vcrypto->mbuf_pool)) ||
1500 			!(rte_mempool_full(vcrypto->wb_pool))) {
1501 		VC_LOG_ERR("Cannot update zero copy as mempool is not full");
1502 		return -EINVAL;
1503 	}
1504 
1505 	if (option == RTE_VHOST_CRYPTO_ZERO_COPY_DISABLE) {
1506 		char name[128];
1507 
1508 		snprintf(name, 127, "WB_POOL_VM_%u", (uint32_t)vid);
1509 		vcrypto->wb_pool = rte_mempool_create(name,
1510 				VHOST_CRYPTO_MBUF_POOL_SIZE,
1511 				sizeof(struct vhost_crypto_writeback_data),
1512 				128, 0, NULL, NULL, NULL, NULL,
1513 				rte_socket_id(), 0);
1514 		if (!vcrypto->wb_pool) {
1515 			VC_LOG_ERR("Failed to creath mbuf pool");
1516 			return -ENOMEM;
1517 		}
1518 	} else {
1519 		rte_mempool_free(vcrypto->wb_pool);
1520 		vcrypto->wb_pool = NULL;
1521 	}
1522 
1523 	vcrypto->option = (uint8_t)option;
1524 
1525 	return 0;
1526 }
1527 
1528 uint16_t __rte_experimental
1529 rte_vhost_crypto_fetch_requests(int vid, uint32_t qid,
1530 		struct rte_crypto_op **ops, uint16_t nb_ops)
1531 {
1532 	struct rte_mbuf *mbufs[VHOST_CRYPTO_MAX_BURST_SIZE * 2];
1533 	struct virtio_net *dev = get_device(vid);
1534 	struct vhost_crypto *vcrypto;
1535 	struct vhost_virtqueue *vq;
1536 	uint16_t avail_idx;
1537 	uint16_t start_idx;
1538 	uint16_t count;
1539 	uint16_t i = 0;
1540 
1541 	if (unlikely(dev == NULL)) {
1542 		VC_LOG_ERR("Invalid vid %i", vid);
1543 		return -EINVAL;
1544 	}
1545 
1546 	if (unlikely(qid >= VHOST_MAX_QUEUE_PAIRS)) {
1547 		VC_LOG_ERR("Invalid qid %u", qid);
1548 		return -EINVAL;
1549 	}
1550 
1551 	vcrypto = (struct vhost_crypto *)dev->extern_data;
1552 	if (unlikely(vcrypto == NULL)) {
1553 		VC_LOG_ERR("Cannot find required data, is it initialized?");
1554 		return -ENOENT;
1555 	}
1556 
1557 	vq = dev->virtqueue[qid];
1558 
1559 	avail_idx = *((volatile uint16_t *)&vq->avail->idx);
1560 	start_idx = vq->last_used_idx;
1561 	count = avail_idx - start_idx;
1562 	count = RTE_MIN(count, VHOST_CRYPTO_MAX_BURST_SIZE);
1563 	count = RTE_MIN(count, nb_ops);
1564 
1565 	if (unlikely(count == 0))
1566 		return 0;
1567 
1568 	/* for zero copy, we need 2 empty mbufs for src and dst, otherwise
1569 	 * we need only 1 mbuf as src and dst
1570 	 */
1571 	switch (vcrypto->option) {
1572 	case RTE_VHOST_CRYPTO_ZERO_COPY_ENABLE:
1573 		if (unlikely(rte_mempool_get_bulk(vcrypto->mbuf_pool,
1574 				(void **)mbufs, count * 2) < 0)) {
1575 			VC_LOG_ERR("Insufficient memory");
1576 			return -ENOMEM;
1577 		}
1578 
1579 		for (i = 0; i < count; i++) {
1580 			uint16_t used_idx = (start_idx + i) & (vq->size - 1);
1581 			uint16_t desc_idx = vq->avail->ring[used_idx];
1582 			struct vring_desc *head = &vq->desc[desc_idx];
1583 			struct rte_crypto_op *op = ops[i];
1584 
1585 			op->sym->m_src = mbufs[i * 2];
1586 			op->sym->m_dst = mbufs[i * 2 + 1];
1587 			op->sym->m_src->data_off = 0;
1588 			op->sym->m_dst->data_off = 0;
1589 
1590 			if (unlikely(vhost_crypto_process_one_req(vcrypto, vq,
1591 					op, head, desc_idx)) < 0)
1592 				break;
1593 		}
1594 
1595 		if (unlikely(i < count))
1596 			rte_mempool_put_bulk(vcrypto->mbuf_pool,
1597 					(void **)&mbufs[i * 2],
1598 					(count - i) * 2);
1599 
1600 		break;
1601 
1602 	case RTE_VHOST_CRYPTO_ZERO_COPY_DISABLE:
1603 		if (unlikely(rte_mempool_get_bulk(vcrypto->mbuf_pool,
1604 				(void **)mbufs, count) < 0)) {
1605 			VC_LOG_ERR("Insufficient memory");
1606 			return -ENOMEM;
1607 		}
1608 
1609 		for (i = 0; i < count; i++) {
1610 			uint16_t used_idx = (start_idx + i) & (vq->size - 1);
1611 			uint16_t desc_idx = vq->avail->ring[used_idx];
1612 			struct vring_desc *head = &vq->desc[desc_idx];
1613 			struct rte_crypto_op *op = ops[i];
1614 
1615 			op->sym->m_src = mbufs[i];
1616 			op->sym->m_dst = NULL;
1617 			op->sym->m_src->data_off = 0;
1618 
1619 			if (unlikely(vhost_crypto_process_one_req(vcrypto, vq,
1620 					op, head, desc_idx) < 0))
1621 				break;
1622 		}
1623 
1624 		if (unlikely(i < count))
1625 			rte_mempool_put_bulk(vcrypto->mbuf_pool,
1626 					(void **)&mbufs[i],
1627 					count - i);
1628 
1629 		break;
1630 
1631 	}
1632 
1633 	vq->last_used_idx += i;
1634 
1635 	return i;
1636 }
1637 
1638 uint16_t __rte_experimental
1639 rte_vhost_crypto_finalize_requests(struct rte_crypto_op **ops,
1640 		uint16_t nb_ops, int *callfds, uint16_t *nb_callfds)
1641 {
1642 	struct rte_crypto_op **tmp_ops = ops;
1643 	uint16_t count = 0, left = nb_ops;
1644 	int callfd;
1645 	uint16_t idx = 0;
1646 
1647 	while (left) {
1648 		count = vhost_crypto_complete_one_vm_requests(tmp_ops, left,
1649 				&callfd);
1650 		if (unlikely(count == 0))
1651 			break;
1652 
1653 		tmp_ops = &tmp_ops[count];
1654 		left -= count;
1655 
1656 		callfds[idx++] = callfd;
1657 
1658 		if (unlikely(idx >= VIRTIO_CRYPTO_MAX_NUM_BURST_VQS)) {
1659 			VC_LOG_ERR("Too many vqs");
1660 			break;
1661 		}
1662 	}
1663 
1664 	*nb_callfds = idx;
1665 
1666 	return nb_ops - left;
1667 }
1668