xref: /dpdk/examples/l2fwd-crypto/main.c (revision 4e30ead5e7ca886535e2b30632b2948d2aac1681)
1 /*-
2  *   BSD LICENSE
3  *
4  *   Copyright(c) 2015-2016 Intel Corporation. All rights reserved.
5  *   All rights reserved.
6  *
7  *   Redistribution and use in source and binary forms, with or without
8  *   modification, are permitted provided that the following conditions
9  *   are met:
10  *
11  *     * Redistributions of source code must retain the above copyright
12  *       notice, this list of conditions and the following disclaimer.
13  *     * Redistributions in binary form must reproduce the above copyright
14  *       notice, this list of conditions and the following disclaimer in
15  *       the documentation and/or other materials provided with the
16  *       distribution.
17  *     * Neither the name of Intel Corporation nor the names of its
18  *       contributors may be used to endorse or promote products derived
19  *       from this software without specific prior written permission.
20  *
21  *   THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
22  *   "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
23  *   LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
24  *   A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
25  *   OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
26  *   SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
27  *   LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
28  *   DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
29  *   THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
30  *   (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
31  *   OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
32  */
33 
34 #include <time.h>
35 #include <stdio.h>
36 #include <stdlib.h>
37 #include <string.h>
38 #include <stdint.h>
39 #include <inttypes.h>
40 #include <sys/types.h>
41 #include <sys/queue.h>
42 #include <netinet/in.h>
43 #include <setjmp.h>
44 #include <stdarg.h>
45 #include <ctype.h>
46 #include <errno.h>
47 #include <getopt.h>
48 #include <fcntl.h>
49 #include <unistd.h>
50 
51 #include <rte_atomic.h>
52 #include <rte_branch_prediction.h>
53 #include <rte_common.h>
54 #include <rte_cryptodev.h>
55 #include <rte_cycles.h>
56 #include <rte_debug.h>
57 #include <rte_eal.h>
58 #include <rte_ether.h>
59 #include <rte_ethdev.h>
60 #include <rte_interrupts.h>
61 #include <rte_ip.h>
62 #include <rte_launch.h>
63 #include <rte_lcore.h>
64 #include <rte_log.h>
65 #include <rte_malloc.h>
66 #include <rte_mbuf.h>
67 #include <rte_memcpy.h>
68 #include <rte_memory.h>
69 #include <rte_mempool.h>
70 #include <rte_memzone.h>
71 #include <rte_pci.h>
72 #include <rte_per_lcore.h>
73 #include <rte_prefetch.h>
74 #include <rte_random.h>
75 #include <rte_hexdump.h>
76 
77 enum cdev_type {
78 	CDEV_TYPE_ANY,
79 	CDEV_TYPE_HW,
80 	CDEV_TYPE_SW
81 };
82 
83 #define RTE_LOGTYPE_L2FWD RTE_LOGTYPE_USER1
84 
85 #define NB_MBUF   8192
86 
87 #define MAX_STR_LEN 32
88 #define MAX_KEY_SIZE 128
89 #define MAX_PKT_BURST 32
90 #define BURST_TX_DRAIN_US 100 /* TX drain every ~100us */
91 
92 /*
93  * Configurable number of RX/TX ring descriptors
94  */
95 #define RTE_TEST_RX_DESC_DEFAULT 128
96 #define RTE_TEST_TX_DESC_DEFAULT 512
97 
98 static uint16_t nb_rxd = RTE_TEST_RX_DESC_DEFAULT;
99 static uint16_t nb_txd = RTE_TEST_TX_DESC_DEFAULT;
100 
101 /* ethernet addresses of ports */
102 static struct ether_addr l2fwd_ports_eth_addr[RTE_MAX_ETHPORTS];
103 
104 /* mask of enabled ports */
105 static uint64_t l2fwd_enabled_port_mask;
106 static uint64_t l2fwd_enabled_crypto_mask;
107 
108 /* list of enabled ports */
109 static uint32_t l2fwd_dst_ports[RTE_MAX_ETHPORTS];
110 
111 
112 struct pkt_buffer {
113 	unsigned len;
114 	struct rte_mbuf *buffer[MAX_PKT_BURST];
115 };
116 
117 struct op_buffer {
118 	unsigned len;
119 	struct rte_crypto_op *buffer[MAX_PKT_BURST];
120 };
121 
122 #define MAX_RX_QUEUE_PER_LCORE 16
123 #define MAX_TX_QUEUE_PER_PORT 16
124 
125 enum l2fwd_crypto_xform_chain {
126 	L2FWD_CRYPTO_CIPHER_HASH,
127 	L2FWD_CRYPTO_HASH_CIPHER,
128 	L2FWD_CRYPTO_CIPHER_ONLY,
129 	L2FWD_CRYPTO_HASH_ONLY
130 };
131 
132 struct l2fwd_key {
133 	uint8_t *data;
134 	uint32_t length;
135 	phys_addr_t phys_addr;
136 };
137 
138 /** l2fwd crypto application command line options */
139 struct l2fwd_crypto_options {
140 	unsigned portmask;
141 	unsigned nb_ports_per_lcore;
142 	unsigned refresh_period;
143 	unsigned single_lcore:1;
144 
145 	enum cdev_type type;
146 	unsigned sessionless:1;
147 
148 	enum l2fwd_crypto_xform_chain xform_chain;
149 
150 	struct rte_crypto_sym_xform cipher_xform;
151 	unsigned ckey_param;
152 	int ckey_random_size;
153 
154 	struct l2fwd_key iv;
155 	unsigned iv_param;
156 	int iv_random_size;
157 
158 	struct rte_crypto_sym_xform auth_xform;
159 	uint8_t akey_param;
160 	int akey_random_size;
161 
162 	struct l2fwd_key aad;
163 	unsigned aad_param;
164 	int aad_random_size;
165 
166 	int digest_size;
167 
168 	uint16_t block_size;
169 	char string_type[MAX_STR_LEN];
170 };
171 
172 /** l2fwd crypto lcore params */
173 struct l2fwd_crypto_params {
174 	uint8_t dev_id;
175 	uint8_t qp_id;
176 
177 	unsigned digest_length;
178 	unsigned block_size;
179 
180 	struct l2fwd_key iv;
181 	struct l2fwd_key aad;
182 	struct rte_cryptodev_sym_session *session;
183 
184 	uint8_t do_cipher;
185 	uint8_t do_hash;
186 	uint8_t hash_verify;
187 
188 	enum rte_crypto_cipher_algorithm cipher_algo;
189 	enum rte_crypto_auth_algorithm auth_algo;
190 };
191 
192 /** lcore configuration */
193 struct lcore_queue_conf {
194 	unsigned nb_rx_ports;
195 	unsigned rx_port_list[MAX_RX_QUEUE_PER_LCORE];
196 
197 	unsigned nb_crypto_devs;
198 	unsigned cryptodev_list[MAX_RX_QUEUE_PER_LCORE];
199 
200 	struct op_buffer op_buf[RTE_CRYPTO_MAX_DEVS];
201 	struct pkt_buffer pkt_buf[RTE_MAX_ETHPORTS];
202 } __rte_cache_aligned;
203 
204 struct lcore_queue_conf lcore_queue_conf[RTE_MAX_LCORE];
205 
206 static const struct rte_eth_conf port_conf = {
207 	.rxmode = {
208 		.mq_mode = ETH_MQ_RX_NONE,
209 		.max_rx_pkt_len = ETHER_MAX_LEN,
210 		.split_hdr_size = 0,
211 		.header_split   = 0, /**< Header Split disabled */
212 		.hw_ip_checksum = 0, /**< IP checksum offload disabled */
213 		.hw_vlan_filter = 0, /**< VLAN filtering disabled */
214 		.jumbo_frame    = 0, /**< Jumbo Frame Support disabled */
215 		.hw_strip_crc   = 1, /**< CRC stripped by hardware */
216 	},
217 	.txmode = {
218 		.mq_mode = ETH_MQ_TX_NONE,
219 	},
220 };
221 
222 struct rte_mempool *l2fwd_pktmbuf_pool;
223 struct rte_mempool *l2fwd_crypto_op_pool;
224 
225 /* Per-port statistics struct */
226 struct l2fwd_port_statistics {
227 	uint64_t tx;
228 	uint64_t rx;
229 
230 	uint64_t crypto_enqueued;
231 	uint64_t crypto_dequeued;
232 
233 	uint64_t dropped;
234 } __rte_cache_aligned;
235 
236 struct l2fwd_crypto_statistics {
237 	uint64_t enqueued;
238 	uint64_t dequeued;
239 
240 	uint64_t errors;
241 } __rte_cache_aligned;
242 
243 struct l2fwd_port_statistics port_statistics[RTE_MAX_ETHPORTS];
244 struct l2fwd_crypto_statistics crypto_statistics[RTE_CRYPTO_MAX_DEVS];
245 
246 /* A tsc-based timer responsible for triggering statistics printout */
247 #define TIMER_MILLISECOND 2000000ULL /* around 1ms at 2 Ghz */
248 #define MAX_TIMER_PERIOD 86400UL /* 1 day max */
249 
250 /* default period is 10 seconds */
251 static int64_t timer_period = 10 * TIMER_MILLISECOND * 1000;
252 
253 /* Print out statistics on packets dropped */
254 static void
255 print_stats(void)
256 {
257 	uint64_t total_packets_dropped, total_packets_tx, total_packets_rx;
258 	uint64_t total_packets_enqueued, total_packets_dequeued,
259 		total_packets_errors;
260 	unsigned portid;
261 	uint64_t cdevid;
262 
263 	total_packets_dropped = 0;
264 	total_packets_tx = 0;
265 	total_packets_rx = 0;
266 	total_packets_enqueued = 0;
267 	total_packets_dequeued = 0;
268 	total_packets_errors = 0;
269 
270 	const char clr[] = { 27, '[', '2', 'J', '\0' };
271 	const char topLeft[] = { 27, '[', '1', ';', '1', 'H', '\0' };
272 
273 		/* Clear screen and move to top left */
274 	printf("%s%s", clr, topLeft);
275 
276 	printf("\nPort statistics ====================================");
277 
278 	for (portid = 0; portid < RTE_MAX_ETHPORTS; portid++) {
279 		/* skip disabled ports */
280 		if ((l2fwd_enabled_port_mask & (1 << portid)) == 0)
281 			continue;
282 		printf("\nStatistics for port %u ------------------------------"
283 			   "\nPackets sent: %32"PRIu64
284 			   "\nPackets received: %28"PRIu64
285 			   "\nPackets dropped: %29"PRIu64,
286 			   portid,
287 			   port_statistics[portid].tx,
288 			   port_statistics[portid].rx,
289 			   port_statistics[portid].dropped);
290 
291 		total_packets_dropped += port_statistics[portid].dropped;
292 		total_packets_tx += port_statistics[portid].tx;
293 		total_packets_rx += port_statistics[portid].rx;
294 	}
295 	printf("\nCrypto statistics ==================================");
296 
297 	for (cdevid = 0; cdevid < RTE_CRYPTO_MAX_DEVS; cdevid++) {
298 		/* skip disabled ports */
299 		if ((l2fwd_enabled_crypto_mask & (((uint64_t)1) << cdevid)) == 0)
300 			continue;
301 		printf("\nStatistics for cryptodev %"PRIu64
302 				" -------------------------"
303 			   "\nPackets enqueued: %28"PRIu64
304 			   "\nPackets dequeued: %28"PRIu64
305 			   "\nPackets errors: %30"PRIu64,
306 			   cdevid,
307 			   crypto_statistics[cdevid].enqueued,
308 			   crypto_statistics[cdevid].dequeued,
309 			   crypto_statistics[cdevid].errors);
310 
311 		total_packets_enqueued += crypto_statistics[cdevid].enqueued;
312 		total_packets_dequeued += crypto_statistics[cdevid].dequeued;
313 		total_packets_errors += crypto_statistics[cdevid].errors;
314 	}
315 	printf("\nAggregate statistics ==============================="
316 		   "\nTotal packets received: %22"PRIu64
317 		   "\nTotal packets enqueued: %22"PRIu64
318 		   "\nTotal packets dequeued: %22"PRIu64
319 		   "\nTotal packets sent: %26"PRIu64
320 		   "\nTotal packets dropped: %23"PRIu64
321 		   "\nTotal packets crypto errors: %17"PRIu64,
322 		   total_packets_rx,
323 		   total_packets_enqueued,
324 		   total_packets_dequeued,
325 		   total_packets_tx,
326 		   total_packets_dropped,
327 		   total_packets_errors);
328 	printf("\n====================================================\n");
329 }
330 
331 static int
332 l2fwd_crypto_send_burst(struct lcore_queue_conf *qconf, unsigned n,
333 		struct l2fwd_crypto_params *cparams)
334 {
335 	struct rte_crypto_op **op_buffer;
336 	unsigned ret;
337 
338 	op_buffer = (struct rte_crypto_op **)
339 			qconf->op_buf[cparams->dev_id].buffer;
340 
341 	ret = rte_cryptodev_enqueue_burst(cparams->dev_id,
342 			cparams->qp_id,	op_buffer, (uint16_t) n);
343 
344 	crypto_statistics[cparams->dev_id].enqueued += ret;
345 	if (unlikely(ret < n)) {
346 		crypto_statistics[cparams->dev_id].errors += (n - ret);
347 		do {
348 			rte_pktmbuf_free(op_buffer[ret]->sym->m_src);
349 			rte_crypto_op_free(op_buffer[ret]);
350 		} while (++ret < n);
351 	}
352 
353 	return 0;
354 }
355 
356 static int
357 l2fwd_crypto_enqueue(struct rte_crypto_op *op,
358 		struct l2fwd_crypto_params *cparams)
359 {
360 	unsigned lcore_id, len;
361 	struct lcore_queue_conf *qconf;
362 
363 	lcore_id = rte_lcore_id();
364 
365 	qconf = &lcore_queue_conf[lcore_id];
366 	len = qconf->op_buf[cparams->dev_id].len;
367 	qconf->op_buf[cparams->dev_id].buffer[len] = op;
368 	len++;
369 
370 	/* enough ops to be sent */
371 	if (len == MAX_PKT_BURST) {
372 		l2fwd_crypto_send_burst(qconf, MAX_PKT_BURST, cparams);
373 		len = 0;
374 	}
375 
376 	qconf->op_buf[cparams->dev_id].len = len;
377 	return 0;
378 }
379 
380 static int
381 l2fwd_simple_crypto_enqueue(struct rte_mbuf *m,
382 		struct rte_crypto_op *op,
383 		struct l2fwd_crypto_params *cparams)
384 {
385 	struct ether_hdr *eth_hdr;
386 	struct ipv4_hdr *ip_hdr;
387 
388 	uint32_t ipdata_offset, data_len;
389 	uint32_t pad_len = 0;
390 	char *padding;
391 
392 	eth_hdr = rte_pktmbuf_mtod(m, struct ether_hdr *);
393 
394 	if (eth_hdr->ether_type != rte_cpu_to_be_16(ETHER_TYPE_IPv4))
395 		return -1;
396 
397 	ipdata_offset = sizeof(struct ether_hdr);
398 
399 	ip_hdr = (struct ipv4_hdr *)(rte_pktmbuf_mtod(m, char *) +
400 			ipdata_offset);
401 
402 	ipdata_offset += (ip_hdr->version_ihl & IPV4_HDR_IHL_MASK)
403 			* IPV4_IHL_MULTIPLIER;
404 
405 
406 	/* Zero pad data to be crypto'd so it is block aligned */
407 	data_len  = rte_pktmbuf_data_len(m) - ipdata_offset;
408 
409 	if (cparams->do_hash && cparams->hash_verify)
410 		data_len -= cparams->digest_length;
411 
412 	if (cparams->do_cipher) {
413 		/*
414 		 * Following algorithms are block cipher algorithms,
415 		 * and might need padding
416 		 */
417 		switch (cparams->cipher_algo) {
418 		case RTE_CRYPTO_CIPHER_AES_CBC:
419 		case RTE_CRYPTO_CIPHER_AES_ECB:
420 		case RTE_CRYPTO_CIPHER_DES_CBC:
421 		case RTE_CRYPTO_CIPHER_3DES_CBC:
422 		case RTE_CRYPTO_CIPHER_3DES_ECB:
423 			if (data_len % cparams->block_size)
424 				pad_len = cparams->block_size -
425 					(data_len % cparams->block_size);
426 			break;
427 		default:
428 			pad_len = 0;
429 		}
430 
431 		if (pad_len) {
432 			padding = rte_pktmbuf_append(m, pad_len);
433 			if (unlikely(!padding))
434 				return -1;
435 
436 			data_len += pad_len;
437 			memset(padding, 0, pad_len);
438 		}
439 	}
440 
441 	/* Set crypto operation data parameters */
442 	rte_crypto_op_attach_sym_session(op, cparams->session);
443 
444 	if (cparams->do_hash) {
445 		if (!cparams->hash_verify) {
446 			/* Append space for digest to end of packet */
447 			op->sym->auth.digest.data = (uint8_t *)rte_pktmbuf_append(m,
448 				cparams->digest_length);
449 		} else {
450 			op->sym->auth.digest.data = rte_pktmbuf_mtod(m,
451 				uint8_t *) + ipdata_offset + data_len;
452 		}
453 
454 		op->sym->auth.digest.phys_addr = rte_pktmbuf_mtophys_offset(m,
455 				rte_pktmbuf_pkt_len(m) - cparams->digest_length);
456 		op->sym->auth.digest.length = cparams->digest_length;
457 
458 		/* For wireless algorithms, offset/length must be in bits */
459 		if (cparams->auth_algo == RTE_CRYPTO_AUTH_SNOW3G_UIA2 ||
460 				cparams->auth_algo == RTE_CRYPTO_AUTH_KASUMI_F9 ||
461 				cparams->auth_algo == RTE_CRYPTO_AUTH_ZUC_EIA3) {
462 			op->sym->auth.data.offset = ipdata_offset << 3;
463 			op->sym->auth.data.length = data_len << 3;
464 		} else {
465 			op->sym->auth.data.offset = ipdata_offset;
466 			op->sym->auth.data.length = data_len;
467 		}
468 
469 		if (cparams->aad.length) {
470 			op->sym->auth.aad.data = cparams->aad.data;
471 			op->sym->auth.aad.phys_addr = cparams->aad.phys_addr;
472 			op->sym->auth.aad.length = cparams->aad.length;
473 		}
474 	}
475 
476 	if (cparams->do_cipher) {
477 		op->sym->cipher.iv.data = cparams->iv.data;
478 		op->sym->cipher.iv.phys_addr = cparams->iv.phys_addr;
479 		op->sym->cipher.iv.length = cparams->iv.length;
480 
481 		/* For wireless algorithms, offset/length must be in bits */
482 		if (cparams->cipher_algo == RTE_CRYPTO_CIPHER_SNOW3G_UEA2 ||
483 				cparams->cipher_algo == RTE_CRYPTO_CIPHER_KASUMI_F8 ||
484 				cparams->cipher_algo == RTE_CRYPTO_CIPHER_ZUC_EEA3) {
485 			op->sym->cipher.data.offset = ipdata_offset << 3;
486 			op->sym->cipher.data.length = data_len << 3;
487 		} else {
488 			op->sym->cipher.data.offset = ipdata_offset;
489 			op->sym->cipher.data.length = data_len;
490 		}
491 	}
492 
493 	op->sym->m_src = m;
494 
495 	return l2fwd_crypto_enqueue(op, cparams);
496 }
497 
498 
499 /* Send the burst of packets on an output interface */
500 static int
501 l2fwd_send_burst(struct lcore_queue_conf *qconf, unsigned n,
502 		uint8_t port)
503 {
504 	struct rte_mbuf **pkt_buffer;
505 	unsigned ret;
506 
507 	pkt_buffer = (struct rte_mbuf **)qconf->pkt_buf[port].buffer;
508 
509 	ret = rte_eth_tx_burst(port, 0, pkt_buffer, (uint16_t)n);
510 	port_statistics[port].tx += ret;
511 	if (unlikely(ret < n)) {
512 		port_statistics[port].dropped += (n - ret);
513 		do {
514 			rte_pktmbuf_free(pkt_buffer[ret]);
515 		} while (++ret < n);
516 	}
517 
518 	return 0;
519 }
520 
521 /* Enqueue packets for TX and prepare them to be sent */
522 static int
523 l2fwd_send_packet(struct rte_mbuf *m, uint8_t port)
524 {
525 	unsigned lcore_id, len;
526 	struct lcore_queue_conf *qconf;
527 
528 	lcore_id = rte_lcore_id();
529 
530 	qconf = &lcore_queue_conf[lcore_id];
531 	len = qconf->pkt_buf[port].len;
532 	qconf->pkt_buf[port].buffer[len] = m;
533 	len++;
534 
535 	/* enough pkts to be sent */
536 	if (unlikely(len == MAX_PKT_BURST)) {
537 		l2fwd_send_burst(qconf, MAX_PKT_BURST, port);
538 		len = 0;
539 	}
540 
541 	qconf->pkt_buf[port].len = len;
542 	return 0;
543 }
544 
545 static void
546 l2fwd_simple_forward(struct rte_mbuf *m, unsigned portid)
547 {
548 	struct ether_hdr *eth;
549 	void *tmp;
550 	unsigned dst_port;
551 
552 	dst_port = l2fwd_dst_ports[portid];
553 	eth = rte_pktmbuf_mtod(m, struct ether_hdr *);
554 
555 	/* 02:00:00:00:00:xx */
556 	tmp = &eth->d_addr.addr_bytes[0];
557 	*((uint64_t *)tmp) = 0x000000000002 + ((uint64_t)dst_port << 40);
558 
559 	/* src addr */
560 	ether_addr_copy(&l2fwd_ports_eth_addr[dst_port], &eth->s_addr);
561 
562 	l2fwd_send_packet(m, (uint8_t) dst_port);
563 }
564 
565 /** Generate random key */
566 static void
567 generate_random_key(uint8_t *key, unsigned length)
568 {
569 	int fd;
570 	int ret;
571 
572 	fd = open("/dev/urandom", O_RDONLY);
573 	if (fd < 0)
574 		rte_exit(EXIT_FAILURE, "Failed to generate random key\n");
575 
576 	ret = read(fd, key, length);
577 	close(fd);
578 
579 	if (ret != (signed)length)
580 		rte_exit(EXIT_FAILURE, "Failed to generate random key\n");
581 }
582 
583 static struct rte_cryptodev_sym_session *
584 initialize_crypto_session(struct l2fwd_crypto_options *options,
585 		uint8_t cdev_id)
586 {
587 	struct rte_crypto_sym_xform *first_xform;
588 
589 	if (options->xform_chain == L2FWD_CRYPTO_CIPHER_HASH) {
590 		first_xform = &options->cipher_xform;
591 		first_xform->next = &options->auth_xform;
592 	} else if (options->xform_chain == L2FWD_CRYPTO_HASH_CIPHER) {
593 		first_xform = &options->auth_xform;
594 		first_xform->next = &options->cipher_xform;
595 	} else if (options->xform_chain == L2FWD_CRYPTO_CIPHER_ONLY) {
596 		first_xform = &options->cipher_xform;
597 	} else {
598 		first_xform = &options->auth_xform;
599 	}
600 
601 	/* Setup Cipher Parameters */
602 	return rte_cryptodev_sym_session_create(cdev_id, first_xform);
603 }
604 
605 static void
606 l2fwd_crypto_options_print(struct l2fwd_crypto_options *options);
607 
608 /* main processing loop */
609 static void
610 l2fwd_main_loop(struct l2fwd_crypto_options *options)
611 {
612 	struct rte_mbuf *m, *pkts_burst[MAX_PKT_BURST];
613 	struct rte_crypto_op *ops_burst[MAX_PKT_BURST];
614 
615 	unsigned lcore_id = rte_lcore_id();
616 	uint64_t prev_tsc = 0, diff_tsc, cur_tsc, timer_tsc = 0;
617 	unsigned i, j, portid, nb_rx, len;
618 	struct lcore_queue_conf *qconf = &lcore_queue_conf[lcore_id];
619 	const uint64_t drain_tsc = (rte_get_tsc_hz() + US_PER_S - 1) /
620 			US_PER_S * BURST_TX_DRAIN_US;
621 	struct l2fwd_crypto_params *cparams;
622 	struct l2fwd_crypto_params port_cparams[qconf->nb_crypto_devs];
623 
624 	if (qconf->nb_rx_ports == 0) {
625 		RTE_LOG(INFO, L2FWD, "lcore %u has nothing to do\n", lcore_id);
626 		return;
627 	}
628 
629 	RTE_LOG(INFO, L2FWD, "entering main loop on lcore %u\n", lcore_id);
630 
631 	for (i = 0; i < qconf->nb_rx_ports; i++) {
632 
633 		portid = qconf->rx_port_list[i];
634 		RTE_LOG(INFO, L2FWD, " -- lcoreid=%u portid=%u\n", lcore_id,
635 			portid);
636 	}
637 
638 	for (i = 0; i < qconf->nb_crypto_devs; i++) {
639 		port_cparams[i].do_cipher = 0;
640 		port_cparams[i].do_hash = 0;
641 
642 		switch (options->xform_chain) {
643 		case L2FWD_CRYPTO_CIPHER_HASH:
644 		case L2FWD_CRYPTO_HASH_CIPHER:
645 			port_cparams[i].do_cipher = 1;
646 			port_cparams[i].do_hash = 1;
647 			break;
648 		case L2FWD_CRYPTO_HASH_ONLY:
649 			port_cparams[i].do_hash = 1;
650 			break;
651 		case L2FWD_CRYPTO_CIPHER_ONLY:
652 			port_cparams[i].do_cipher = 1;
653 			break;
654 		}
655 
656 		port_cparams[i].dev_id = qconf->cryptodev_list[i];
657 		port_cparams[i].qp_id = 0;
658 
659 		port_cparams[i].block_size = options->block_size;
660 
661 		if (port_cparams[i].do_hash) {
662 			port_cparams[i].digest_length =
663 					options->auth_xform.auth.digest_length;
664 			if (options->auth_xform.auth.add_auth_data_length) {
665 				port_cparams[i].aad.data = options->aad.data;
666 				port_cparams[i].aad.length =
667 					options->auth_xform.auth.add_auth_data_length;
668 				port_cparams[i].aad.phys_addr = options->aad.phys_addr;
669 				if (!options->aad_param)
670 					generate_random_key(port_cparams[i].aad.data,
671 						port_cparams[i].aad.length);
672 
673 			}
674 
675 			if (options->auth_xform.auth.op == RTE_CRYPTO_AUTH_OP_VERIFY)
676 				port_cparams[i].hash_verify = 1;
677 			else
678 				port_cparams[i].hash_verify = 0;
679 
680 			port_cparams[i].auth_algo = options->auth_xform.auth.algo;
681 		}
682 
683 		if (port_cparams[i].do_cipher) {
684 			port_cparams[i].iv.data = options->iv.data;
685 			port_cparams[i].iv.length = options->iv.length;
686 			port_cparams[i].iv.phys_addr = options->iv.phys_addr;
687 			if (!options->iv_param)
688 				generate_random_key(port_cparams[i].iv.data,
689 						port_cparams[i].iv.length);
690 
691 			port_cparams[i].cipher_algo = options->cipher_xform.cipher.algo;
692 		}
693 
694 		port_cparams[i].session = initialize_crypto_session(options,
695 				port_cparams[i].dev_id);
696 
697 		if (port_cparams[i].session == NULL)
698 			return;
699 		RTE_LOG(INFO, L2FWD, " -- lcoreid=%u cryptoid=%u\n", lcore_id,
700 				port_cparams[i].dev_id);
701 	}
702 
703 	l2fwd_crypto_options_print(options);
704 
705 	/*
706 	 * Initialize previous tsc timestamp before the loop,
707 	 * to avoid showing the port statistics immediately,
708 	 * so user can see the crypto information.
709 	 */
710 	prev_tsc = rte_rdtsc();
711 	while (1) {
712 
713 		cur_tsc = rte_rdtsc();
714 
715 		/*
716 		 * Crypto device/TX burst queue drain
717 		 */
718 		diff_tsc = cur_tsc - prev_tsc;
719 		if (unlikely(diff_tsc > drain_tsc)) {
720 			/* Enqueue all crypto ops remaining in buffers */
721 			for (i = 0; i < qconf->nb_crypto_devs; i++) {
722 				cparams = &port_cparams[i];
723 				len = qconf->op_buf[cparams->dev_id].len;
724 				l2fwd_crypto_send_burst(qconf, len, cparams);
725 				qconf->op_buf[cparams->dev_id].len = 0;
726 			}
727 			/* Transmit all packets remaining in buffers */
728 			for (portid = 0; portid < RTE_MAX_ETHPORTS; portid++) {
729 				if (qconf->pkt_buf[portid].len == 0)
730 					continue;
731 				l2fwd_send_burst(&lcore_queue_conf[lcore_id],
732 						 qconf->pkt_buf[portid].len,
733 						 (uint8_t) portid);
734 				qconf->pkt_buf[portid].len = 0;
735 			}
736 
737 			/* if timer is enabled */
738 			if (timer_period > 0) {
739 
740 				/* advance the timer */
741 				timer_tsc += diff_tsc;
742 
743 				/* if timer has reached its timeout */
744 				if (unlikely(timer_tsc >=
745 						(uint64_t)timer_period)) {
746 
747 					/* do this only on master core */
748 					if (lcore_id == rte_get_master_lcore()
749 						&& options->refresh_period) {
750 						print_stats();
751 						timer_tsc = 0;
752 					}
753 				}
754 			}
755 
756 			prev_tsc = cur_tsc;
757 		}
758 
759 		/*
760 		 * Read packet from RX queues
761 		 */
762 		for (i = 0; i < qconf->nb_rx_ports; i++) {
763 			portid = qconf->rx_port_list[i];
764 
765 			cparams = &port_cparams[i];
766 
767 			nb_rx = rte_eth_rx_burst((uint8_t) portid, 0,
768 						 pkts_burst, MAX_PKT_BURST);
769 
770 			port_statistics[portid].rx += nb_rx;
771 
772 			if (nb_rx) {
773 				/*
774 				 * If we can't allocate a crypto_ops, then drop
775 				 * the rest of the burst and dequeue and
776 				 * process the packets to free offload structs
777 				 */
778 				if (rte_crypto_op_bulk_alloc(
779 						l2fwd_crypto_op_pool,
780 						RTE_CRYPTO_OP_TYPE_SYMMETRIC,
781 						ops_burst, nb_rx) !=
782 								nb_rx) {
783 					for (j = 0; j < nb_rx; j++)
784 						rte_pktmbuf_free(pkts_burst[i]);
785 
786 					nb_rx = 0;
787 				}
788 
789 				/* Enqueue packets from Crypto device*/
790 				for (j = 0; j < nb_rx; j++) {
791 					m = pkts_burst[j];
792 
793 					l2fwd_simple_crypto_enqueue(m,
794 							ops_burst[j], cparams);
795 				}
796 			}
797 
798 			/* Dequeue packets from Crypto device */
799 			do {
800 				nb_rx = rte_cryptodev_dequeue_burst(
801 						cparams->dev_id, cparams->qp_id,
802 						ops_burst, MAX_PKT_BURST);
803 
804 				crypto_statistics[cparams->dev_id].dequeued +=
805 						nb_rx;
806 
807 				/* Forward crypto'd packets */
808 				for (j = 0; j < nb_rx; j++) {
809 					m = ops_burst[j]->sym->m_src;
810 
811 					rte_crypto_op_free(ops_burst[j]);
812 					l2fwd_simple_forward(m, portid);
813 				}
814 			} while (nb_rx == MAX_PKT_BURST);
815 		}
816 	}
817 }
818 
819 static int
820 l2fwd_launch_one_lcore(void *arg)
821 {
822 	l2fwd_main_loop((struct l2fwd_crypto_options *)arg);
823 	return 0;
824 }
825 
826 /* Display command line arguments usage */
827 static void
828 l2fwd_crypto_usage(const char *prgname)
829 {
830 	printf("%s [EAL options] --\n"
831 		"  -p PORTMASK: hexadecimal bitmask of ports to configure\n"
832 		"  -q NQ: number of queue (=ports) per lcore (default is 1)\n"
833 		"  -s manage all ports from single lcore\n"
834 		"  -T PERIOD: statistics will be refreshed each PERIOD seconds"
835 		" (0 to disable, 10 default, 86400 maximum)\n"
836 
837 		"  --cdev_type HW / SW / ANY\n"
838 		"  --chain HASH_CIPHER / CIPHER_HASH\n"
839 
840 		"  --cipher_algo ALGO\n"
841 		"  --cipher_op ENCRYPT / DECRYPT\n"
842 		"  --cipher_key KEY (bytes separated with \":\")\n"
843 		"  --cipher_key_random_size SIZE: size of cipher key when generated randomly\n"
844 		"  --iv IV (bytes separated with \":\")\n"
845 		"  --iv_random_size SIZE: size of IV when generated randomly\n"
846 
847 		"  --auth_algo ALGO\n"
848 		"  --auth_op GENERATE / VERIFY\n"
849 		"  --auth_key KEY (bytes separated with \":\")\n"
850 		"  --auth_key_random_size SIZE: size of auth key when generated randomly\n"
851 		"  --aad AAD (bytes separated with \":\")\n"
852 		"  --aad_random_size SIZE: size of AAD when generated randomly\n"
853 		"  --digest_size SIZE: size of digest to be generated/verified\n"
854 
855 		"  --sessionless\n",
856 	       prgname);
857 }
858 
859 /** Parse crypto device type command line argument */
860 static int
861 parse_cryptodev_type(enum cdev_type *type, char *optarg)
862 {
863 	if (strcmp("HW", optarg) == 0) {
864 		*type = CDEV_TYPE_HW;
865 		return 0;
866 	} else if (strcmp("SW", optarg) == 0) {
867 		*type = CDEV_TYPE_SW;
868 		return 0;
869 	} else if (strcmp("ANY", optarg) == 0) {
870 		*type = CDEV_TYPE_ANY;
871 		return 0;
872 	}
873 
874 	return -1;
875 }
876 
877 /** Parse crypto chain xform command line argument */
878 static int
879 parse_crypto_opt_chain(struct l2fwd_crypto_options *options, char *optarg)
880 {
881 	if (strcmp("CIPHER_HASH", optarg) == 0) {
882 		options->xform_chain = L2FWD_CRYPTO_CIPHER_HASH;
883 		return 0;
884 	} else if (strcmp("HASH_CIPHER", optarg) == 0) {
885 		options->xform_chain = L2FWD_CRYPTO_HASH_CIPHER;
886 		return 0;
887 	} else if (strcmp("CIPHER_ONLY", optarg) == 0) {
888 		options->xform_chain = L2FWD_CRYPTO_CIPHER_ONLY;
889 		return 0;
890 	} else if (strcmp("HASH_ONLY", optarg) == 0) {
891 		options->xform_chain = L2FWD_CRYPTO_HASH_ONLY;
892 		return 0;
893 	}
894 
895 	return -1;
896 }
897 
898 /** Parse crypto cipher algo option command line argument */
899 static int
900 parse_cipher_algo(enum rte_crypto_cipher_algorithm *algo, char *optarg)
901 {
902 
903 	if (rte_cryptodev_get_cipher_algo_enum(algo, optarg) < 0) {
904 		RTE_LOG(ERR, USER1, "Cipher algorithm specified "
905 				"not supported!\n");
906 		return -1;
907 	}
908 
909 	return 0;
910 }
911 
912 /** Parse crypto cipher operation command line argument */
913 static int
914 parse_cipher_op(enum rte_crypto_cipher_operation *op, char *optarg)
915 {
916 	if (strcmp("ENCRYPT", optarg) == 0) {
917 		*op = RTE_CRYPTO_CIPHER_OP_ENCRYPT;
918 		return 0;
919 	} else if (strcmp("DECRYPT", optarg) == 0) {
920 		*op = RTE_CRYPTO_CIPHER_OP_DECRYPT;
921 		return 0;
922 	}
923 
924 	printf("Cipher operation not supported!\n");
925 	return -1;
926 }
927 
928 /** Parse crypto key command line argument */
929 static int
930 parse_key(uint8_t *data, char *input_arg)
931 {
932 	unsigned byte_count;
933 	char *token;
934 
935 	for (byte_count = 0, token = strtok(input_arg, ":");
936 			(byte_count < MAX_KEY_SIZE) && (token != NULL);
937 			token = strtok(NULL, ":")) {
938 
939 		int number = (int)strtol(token, NULL, 16);
940 
941 		if (errno == EINVAL || errno == ERANGE || number > 0xFF)
942 			return -1;
943 
944 		data[byte_count++] = (uint8_t)number;
945 	}
946 
947 	return byte_count;
948 }
949 
950 /** Parse size param*/
951 static int
952 parse_size(int *size, const char *q_arg)
953 {
954 	char *end = NULL;
955 	unsigned long n;
956 
957 	/* parse hexadecimal string */
958 	n = strtoul(q_arg, &end, 10);
959 	if ((q_arg[0] == '\0') || (end == NULL) || (*end != '\0'))
960 		n = 0;
961 
962 	if (n == 0) {
963 		printf("invalid size\n");
964 		return -1;
965 	}
966 
967 	*size = n;
968 	return 0;
969 }
970 
971 /** Parse crypto cipher operation command line argument */
972 static int
973 parse_auth_algo(enum rte_crypto_auth_algorithm *algo, char *optarg)
974 {
975 	if (rte_cryptodev_get_auth_algo_enum(algo, optarg) < 0) {
976 		RTE_LOG(ERR, USER1, "Authentication algorithm specified "
977 				"not supported!\n");
978 		return -1;
979 	}
980 
981 	return 0;
982 }
983 
984 static int
985 parse_auth_op(enum rte_crypto_auth_operation *op, char *optarg)
986 {
987 	if (strcmp("VERIFY", optarg) == 0) {
988 		*op = RTE_CRYPTO_AUTH_OP_VERIFY;
989 		return 0;
990 	} else if (strcmp("GENERATE", optarg) == 0) {
991 		*op = RTE_CRYPTO_AUTH_OP_GENERATE;
992 		return 0;
993 	}
994 
995 	printf("Authentication operation specified not supported!\n");
996 	return -1;
997 }
998 
999 /** Parse long options */
1000 static int
1001 l2fwd_crypto_parse_args_long_options(struct l2fwd_crypto_options *options,
1002 		struct option *lgopts, int option_index)
1003 {
1004 	int retval;
1005 
1006 	if (strcmp(lgopts[option_index].name, "cdev_type") == 0) {
1007 		retval = parse_cryptodev_type(&options->type, optarg);
1008 		if (retval == 0)
1009 			snprintf(options->string_type, MAX_STR_LEN,
1010 				"%s", optarg);
1011 		return retval;
1012 	}
1013 
1014 	else if (strcmp(lgopts[option_index].name, "chain") == 0)
1015 		return parse_crypto_opt_chain(options, optarg);
1016 
1017 	/* Cipher options */
1018 	else if (strcmp(lgopts[option_index].name, "cipher_algo") == 0)
1019 		return parse_cipher_algo(&options->cipher_xform.cipher.algo,
1020 				optarg);
1021 
1022 	else if (strcmp(lgopts[option_index].name, "cipher_op") == 0)
1023 		return parse_cipher_op(&options->cipher_xform.cipher.op,
1024 				optarg);
1025 
1026 	else if (strcmp(lgopts[option_index].name, "cipher_key") == 0) {
1027 		options->ckey_param = 1;
1028 		options->cipher_xform.cipher.key.length =
1029 			parse_key(options->cipher_xform.cipher.key.data, optarg);
1030 		if (options->cipher_xform.cipher.key.length > 0)
1031 			return 0;
1032 		else
1033 			return -1;
1034 	}
1035 
1036 	else if (strcmp(lgopts[option_index].name, "cipher_key_random_size") == 0)
1037 		return parse_size(&options->ckey_random_size, optarg);
1038 
1039 	else if (strcmp(lgopts[option_index].name, "iv") == 0) {
1040 		options->iv_param = 1;
1041 		options->iv.length =
1042 			parse_key(options->iv.data, optarg);
1043 		if (options->iv.length > 0)
1044 			return 0;
1045 		else
1046 			return -1;
1047 	}
1048 
1049 	else if (strcmp(lgopts[option_index].name, "iv_random_size") == 0)
1050 		return parse_size(&options->iv_random_size, optarg);
1051 
1052 	/* Authentication options */
1053 	else if (strcmp(lgopts[option_index].name, "auth_algo") == 0) {
1054 		return parse_auth_algo(&options->auth_xform.auth.algo,
1055 				optarg);
1056 	}
1057 
1058 	else if (strcmp(lgopts[option_index].name, "auth_op") == 0)
1059 		return parse_auth_op(&options->auth_xform.auth.op,
1060 				optarg);
1061 
1062 	else if (strcmp(lgopts[option_index].name, "auth_key") == 0) {
1063 		options->akey_param = 1;
1064 		options->auth_xform.auth.key.length =
1065 			parse_key(options->auth_xform.auth.key.data, optarg);
1066 		if (options->auth_xform.auth.key.length > 0)
1067 			return 0;
1068 		else
1069 			return -1;
1070 	}
1071 
1072 	else if (strcmp(lgopts[option_index].name, "auth_key_random_size") == 0) {
1073 		return parse_size(&options->akey_random_size, optarg);
1074 	}
1075 
1076 	else if (strcmp(lgopts[option_index].name, "aad") == 0) {
1077 		options->aad_param = 1;
1078 		options->aad.length =
1079 			parse_key(options->aad.data, optarg);
1080 		if (options->aad.length > 0)
1081 			return 0;
1082 		else
1083 			return -1;
1084 	}
1085 
1086 	else if (strcmp(lgopts[option_index].name, "aad_random_size") == 0) {
1087 		return parse_size(&options->aad_random_size, optarg);
1088 	}
1089 
1090 	else if (strcmp(lgopts[option_index].name, "digest_size") == 0) {
1091 		return parse_size(&options->digest_size, optarg);
1092 	}
1093 
1094 	else if (strcmp(lgopts[option_index].name, "sessionless") == 0) {
1095 		options->sessionless = 1;
1096 		return 0;
1097 	}
1098 
1099 	return -1;
1100 }
1101 
1102 /** Parse port mask */
1103 static int
1104 l2fwd_crypto_parse_portmask(struct l2fwd_crypto_options *options,
1105 		const char *q_arg)
1106 {
1107 	char *end = NULL;
1108 	unsigned long pm;
1109 
1110 	/* parse hexadecimal string */
1111 	pm = strtoul(q_arg, &end, 16);
1112 	if ((pm == '\0') || (end == NULL) || (*end != '\0'))
1113 		pm = 0;
1114 
1115 	options->portmask = pm;
1116 	if (options->portmask == 0) {
1117 		printf("invalid portmask specified\n");
1118 		return -1;
1119 	}
1120 
1121 	return pm;
1122 }
1123 
1124 /** Parse number of queues */
1125 static int
1126 l2fwd_crypto_parse_nqueue(struct l2fwd_crypto_options *options,
1127 		const char *q_arg)
1128 {
1129 	char *end = NULL;
1130 	unsigned long n;
1131 
1132 	/* parse hexadecimal string */
1133 	n = strtoul(q_arg, &end, 10);
1134 	if ((q_arg[0] == '\0') || (end == NULL) || (*end != '\0'))
1135 		n = 0;
1136 	else if (n >= MAX_RX_QUEUE_PER_LCORE)
1137 		n = 0;
1138 
1139 	options->nb_ports_per_lcore = n;
1140 	if (options->nb_ports_per_lcore == 0) {
1141 		printf("invalid number of ports selected\n");
1142 		return -1;
1143 	}
1144 
1145 	return 0;
1146 }
1147 
1148 /** Parse timer period */
1149 static int
1150 l2fwd_crypto_parse_timer_period(struct l2fwd_crypto_options *options,
1151 		const char *q_arg)
1152 {
1153 	char *end = NULL;
1154 	unsigned long n;
1155 
1156 	/* parse number string */
1157 	n = (unsigned)strtol(q_arg, &end, 10);
1158 	if ((q_arg[0] == '\0') || (end == NULL) || (*end != '\0'))
1159 		n = 0;
1160 
1161 	if (n >= MAX_TIMER_PERIOD) {
1162 		printf("Warning refresh period specified %lu is greater than "
1163 				"max value %lu! using max value",
1164 				n, MAX_TIMER_PERIOD);
1165 		n = MAX_TIMER_PERIOD;
1166 	}
1167 
1168 	options->refresh_period = n * 1000 * TIMER_MILLISECOND;
1169 
1170 	return 0;
1171 }
1172 
1173 /** Generate default options for application */
1174 static void
1175 l2fwd_crypto_default_options(struct l2fwd_crypto_options *options)
1176 {
1177 	options->portmask = 0xffffffff;
1178 	options->nb_ports_per_lcore = 1;
1179 	options->refresh_period = 10000;
1180 	options->single_lcore = 0;
1181 	options->sessionless = 0;
1182 
1183 	options->xform_chain = L2FWD_CRYPTO_CIPHER_HASH;
1184 
1185 	/* Cipher Data */
1186 	options->cipher_xform.type = RTE_CRYPTO_SYM_XFORM_CIPHER;
1187 	options->cipher_xform.next = NULL;
1188 	options->ckey_param = 0;
1189 	options->ckey_random_size = -1;
1190 	options->cipher_xform.cipher.key.length = 0;
1191 	options->iv_param = 0;
1192 	options->iv_random_size = -1;
1193 	options->iv.length = 0;
1194 
1195 	options->cipher_xform.cipher.algo = RTE_CRYPTO_CIPHER_AES_CBC;
1196 	options->cipher_xform.cipher.op = RTE_CRYPTO_CIPHER_OP_ENCRYPT;
1197 
1198 	/* Authentication Data */
1199 	options->auth_xform.type = RTE_CRYPTO_SYM_XFORM_AUTH;
1200 	options->auth_xform.next = NULL;
1201 	options->akey_param = 0;
1202 	options->akey_random_size = -1;
1203 	options->auth_xform.auth.key.length = 0;
1204 	options->aad_param = 0;
1205 	options->aad_random_size = -1;
1206 	options->aad.length = 0;
1207 	options->digest_size = -1;
1208 
1209 	options->auth_xform.auth.algo = RTE_CRYPTO_AUTH_SHA1_HMAC;
1210 	options->auth_xform.auth.op = RTE_CRYPTO_AUTH_OP_GENERATE;
1211 
1212 	options->type = CDEV_TYPE_ANY;
1213 }
1214 
1215 static void
1216 display_cipher_info(struct l2fwd_crypto_options *options)
1217 {
1218 	printf("\n---- Cipher information ---\n");
1219 	printf("Algorithm: %s\n",
1220 		rte_crypto_cipher_algorithm_strings[options->cipher_xform.cipher.algo]);
1221 	rte_hexdump(stdout, "Cipher key:",
1222 			options->cipher_xform.cipher.key.data,
1223 			options->cipher_xform.cipher.key.length);
1224 	rte_hexdump(stdout, "IV:", options->iv.data, options->iv.length);
1225 }
1226 
1227 static void
1228 display_auth_info(struct l2fwd_crypto_options *options)
1229 {
1230 	printf("\n---- Authentication information ---\n");
1231 	printf("Algorithm: %s\n",
1232 		rte_crypto_auth_algorithm_strings[options->auth_xform.cipher.algo]);
1233 	rte_hexdump(stdout, "Auth key:",
1234 			options->auth_xform.auth.key.data,
1235 			options->auth_xform.auth.key.length);
1236 	rte_hexdump(stdout, "AAD:", options->aad.data, options->aad.length);
1237 }
1238 
1239 static void
1240 l2fwd_crypto_options_print(struct l2fwd_crypto_options *options)
1241 {
1242 	char string_cipher_op[MAX_STR_LEN];
1243 	char string_auth_op[MAX_STR_LEN];
1244 
1245 	if (options->cipher_xform.cipher.op == RTE_CRYPTO_CIPHER_OP_ENCRYPT)
1246 		strcpy(string_cipher_op, "Encrypt");
1247 	else
1248 		strcpy(string_cipher_op, "Decrypt");
1249 
1250 	if (options->auth_xform.auth.op == RTE_CRYPTO_AUTH_OP_GENERATE)
1251 		strcpy(string_auth_op, "Auth generate");
1252 	else
1253 		strcpy(string_auth_op, "Auth verify");
1254 
1255 	printf("Options:-\nn");
1256 	printf("portmask: %x\n", options->portmask);
1257 	printf("ports per lcore: %u\n", options->nb_ports_per_lcore);
1258 	printf("refresh period : %u\n", options->refresh_period);
1259 	printf("single lcore mode: %s\n",
1260 			options->single_lcore ? "enabled" : "disabled");
1261 	printf("stats_printing: %s\n",
1262 			options->refresh_period == 0 ? "disabled" : "enabled");
1263 
1264 	printf("sessionless crypto: %s\n",
1265 			options->sessionless ? "enabled" : "disabled");
1266 
1267 	if (options->ckey_param && (options->ckey_random_size != -1))
1268 		printf("Cipher key already parsed, ignoring size of random key\n");
1269 
1270 	if (options->akey_param && (options->akey_random_size != -1))
1271 		printf("Auth key already parsed, ignoring size of random key\n");
1272 
1273 	if (options->iv_param && (options->iv_random_size != -1))
1274 		printf("IV already parsed, ignoring size of random IV\n");
1275 
1276 	if (options->aad_param && (options->aad_random_size != -1))
1277 		printf("AAD already parsed, ignoring size of random AAD\n");
1278 
1279 	printf("\nCrypto chain: ");
1280 	switch (options->xform_chain) {
1281 	case L2FWD_CRYPTO_CIPHER_HASH:
1282 		printf("Input --> %s --> %s --> Output\n",
1283 			string_cipher_op, string_auth_op);
1284 		display_cipher_info(options);
1285 		display_auth_info(options);
1286 		break;
1287 	case L2FWD_CRYPTO_HASH_CIPHER:
1288 		printf("Input --> %s --> %s --> Output\n",
1289 			string_auth_op, string_cipher_op);
1290 		display_cipher_info(options);
1291 		display_auth_info(options);
1292 		break;
1293 	case L2FWD_CRYPTO_HASH_ONLY:
1294 		printf("Input --> %s --> Output\n", string_auth_op);
1295 		display_auth_info(options);
1296 		break;
1297 	case L2FWD_CRYPTO_CIPHER_ONLY:
1298 		printf("Input --> %s --> Output\n", string_cipher_op);
1299 		display_cipher_info(options);
1300 		break;
1301 	}
1302 }
1303 
1304 /* Parse the argument given in the command line of the application */
1305 static int
1306 l2fwd_crypto_parse_args(struct l2fwd_crypto_options *options,
1307 		int argc, char **argv)
1308 {
1309 	int opt, retval, option_index;
1310 	char **argvopt = argv, *prgname = argv[0];
1311 
1312 	static struct option lgopts[] = {
1313 			{ "sessionless", no_argument, 0, 0 },
1314 
1315 			{ "cdev_type", required_argument, 0, 0 },
1316 			{ "chain", required_argument, 0, 0 },
1317 
1318 			{ "cipher_algo", required_argument, 0, 0 },
1319 			{ "cipher_op", required_argument, 0, 0 },
1320 			{ "cipher_key", required_argument, 0, 0 },
1321 			{ "cipher_key_random_size", required_argument, 0, 0 },
1322 
1323 			{ "auth_algo", required_argument, 0, 0 },
1324 			{ "auth_op", required_argument, 0, 0 },
1325 			{ "auth_key", required_argument, 0, 0 },
1326 			{ "auth_key_random_size", required_argument, 0, 0 },
1327 
1328 			{ "iv", required_argument, 0, 0 },
1329 			{ "iv_random_size", required_argument, 0, 0 },
1330 			{ "aad", required_argument, 0, 0 },
1331 			{ "aad_random_size", required_argument, 0, 0 },
1332 			{ "digest_size", required_argument, 0, 0 },
1333 
1334 			{ "sessionless", no_argument, 0, 0 },
1335 
1336 			{ NULL, 0, 0, 0 }
1337 	};
1338 
1339 	l2fwd_crypto_default_options(options);
1340 
1341 	while ((opt = getopt_long(argc, argvopt, "p:q:st:", lgopts,
1342 			&option_index)) != EOF) {
1343 		switch (opt) {
1344 		/* long options */
1345 		case 0:
1346 			retval = l2fwd_crypto_parse_args_long_options(options,
1347 					lgopts, option_index);
1348 			if (retval < 0) {
1349 				l2fwd_crypto_usage(prgname);
1350 				return -1;
1351 			}
1352 			break;
1353 
1354 		/* portmask */
1355 		case 'p':
1356 			retval = l2fwd_crypto_parse_portmask(options, optarg);
1357 			if (retval < 0) {
1358 				l2fwd_crypto_usage(prgname);
1359 				return -1;
1360 			}
1361 			break;
1362 
1363 		/* nqueue */
1364 		case 'q':
1365 			retval = l2fwd_crypto_parse_nqueue(options, optarg);
1366 			if (retval < 0) {
1367 				l2fwd_crypto_usage(prgname);
1368 				return -1;
1369 			}
1370 			break;
1371 
1372 		/* single  */
1373 		case 's':
1374 			options->single_lcore = 1;
1375 
1376 			break;
1377 
1378 		/* timer period */
1379 		case 'T':
1380 			retval = l2fwd_crypto_parse_timer_period(options,
1381 					optarg);
1382 			if (retval < 0) {
1383 				l2fwd_crypto_usage(prgname);
1384 				return -1;
1385 			}
1386 			break;
1387 
1388 		default:
1389 			l2fwd_crypto_usage(prgname);
1390 			return -1;
1391 		}
1392 	}
1393 
1394 
1395 	if (optind >= 0)
1396 		argv[optind-1] = prgname;
1397 
1398 	retval = optind-1;
1399 	optind = 1; /* reset getopt lib */
1400 
1401 	return retval;
1402 }
1403 
1404 /* Check the link status of all ports in up to 9s, and print them finally */
1405 static void
1406 check_all_ports_link_status(uint8_t port_num, uint32_t port_mask)
1407 {
1408 #define CHECK_INTERVAL 100 /* 100ms */
1409 #define MAX_CHECK_TIME 90 /* 9s (90 * 100ms) in total */
1410 	uint8_t portid, count, all_ports_up, print_flag = 0;
1411 	struct rte_eth_link link;
1412 
1413 	printf("\nChecking link status");
1414 	fflush(stdout);
1415 	for (count = 0; count <= MAX_CHECK_TIME; count++) {
1416 		all_ports_up = 1;
1417 		for (portid = 0; portid < port_num; portid++) {
1418 			if ((port_mask & (1 << portid)) == 0)
1419 				continue;
1420 			memset(&link, 0, sizeof(link));
1421 			rte_eth_link_get_nowait(portid, &link);
1422 			/* print link status if flag set */
1423 			if (print_flag == 1) {
1424 				if (link.link_status)
1425 					printf("Port %d Link Up - speed %u "
1426 						"Mbps - %s\n", (uint8_t)portid,
1427 						(unsigned)link.link_speed,
1428 				(link.link_duplex == ETH_LINK_FULL_DUPLEX) ?
1429 					("full-duplex") : ("half-duplex\n"));
1430 				else
1431 					printf("Port %d Link Down\n",
1432 						(uint8_t)portid);
1433 				continue;
1434 			}
1435 			/* clear all_ports_up flag if any link down */
1436 			if (link.link_status == ETH_LINK_DOWN) {
1437 				all_ports_up = 0;
1438 				break;
1439 			}
1440 		}
1441 		/* after finally printing all link status, get out */
1442 		if (print_flag == 1)
1443 			break;
1444 
1445 		if (all_ports_up == 0) {
1446 			printf(".");
1447 			fflush(stdout);
1448 			rte_delay_ms(CHECK_INTERVAL);
1449 		}
1450 
1451 		/* set the print_flag if all ports up or timeout */
1452 		if (all_ports_up == 1 || count == (MAX_CHECK_TIME - 1)) {
1453 			print_flag = 1;
1454 			printf("done\n");
1455 		}
1456 	}
1457 }
1458 
1459 /* Check if device has to be HW/SW or any */
1460 static int
1461 check_type(struct l2fwd_crypto_options *options, struct rte_cryptodev_info *dev_info)
1462 {
1463 	if (options->type == CDEV_TYPE_HW &&
1464 			(dev_info->feature_flags & RTE_CRYPTODEV_FF_HW_ACCELERATED))
1465 		return 0;
1466 	if (options->type == CDEV_TYPE_SW &&
1467 			!(dev_info->feature_flags & RTE_CRYPTODEV_FF_HW_ACCELERATED))
1468 		return 0;
1469 	if (options->type == CDEV_TYPE_ANY)
1470 		return 0;
1471 
1472 	return -1;
1473 }
1474 
1475 static inline int
1476 check_supported_size(uint16_t length, uint16_t min, uint16_t max,
1477 		uint16_t increment)
1478 {
1479 	uint16_t supp_size;
1480 
1481 	/* Single value */
1482 	if (increment == 0) {
1483 		if (length == min)
1484 			return 0;
1485 		else
1486 			return -1;
1487 	}
1488 
1489 	/* Range of values */
1490 	for (supp_size = min; supp_size <= max; supp_size += increment) {
1491 		if (length == supp_size)
1492 			return 0;
1493 	}
1494 
1495 	return -1;
1496 }
1497 static int
1498 initialize_cryptodevs(struct l2fwd_crypto_options *options, unsigned nb_ports,
1499 		uint8_t *enabled_cdevs)
1500 {
1501 	unsigned i, cdev_id, cdev_count, enabled_cdev_count = 0;
1502 	const struct rte_cryptodev_capabilities *cap;
1503 	enum rte_crypto_auth_algorithm cap_auth_algo;
1504 	enum rte_crypto_auth_algorithm opt_auth_algo;
1505 	enum rte_crypto_cipher_algorithm cap_cipher_algo;
1506 	enum rte_crypto_cipher_algorithm opt_cipher_algo;
1507 	int retval;
1508 
1509 	cdev_count = rte_cryptodev_count();
1510 	if (cdev_count == 0) {
1511 		printf("No crypto devices available\n");
1512 		return -1;
1513 	}
1514 
1515 	for (cdev_id = 0; cdev_id < cdev_count && enabled_cdev_count < nb_ports;
1516 			cdev_id++) {
1517 		struct rte_cryptodev_qp_conf qp_conf;
1518 		struct rte_cryptodev_info dev_info;
1519 
1520 		struct rte_cryptodev_config conf = {
1521 			.nb_queue_pairs = 1,
1522 			.socket_id = SOCKET_ID_ANY,
1523 			.session_mp = {
1524 				.nb_objs = 2048,
1525 				.cache_size = 64
1526 			}
1527 		};
1528 
1529 		rte_cryptodev_info_get(cdev_id, &dev_info);
1530 
1531 		/* Set cipher parameters */
1532 		if (options->xform_chain == L2FWD_CRYPTO_CIPHER_HASH ||
1533 				options->xform_chain == L2FWD_CRYPTO_HASH_CIPHER ||
1534 				options->xform_chain == L2FWD_CRYPTO_CIPHER_ONLY) {
1535 			/* Check if device supports cipher algo */
1536 			i = 0;
1537 			opt_cipher_algo = options->cipher_xform.cipher.algo;
1538 			cap = &dev_info.capabilities[i];
1539 			while (cap->op != RTE_CRYPTO_OP_TYPE_UNDEFINED) {
1540 				cap_cipher_algo = cap->sym.cipher.algo;
1541 				if (cap->sym.xform_type ==
1542 						RTE_CRYPTO_SYM_XFORM_CIPHER) {
1543 					if (cap_cipher_algo == opt_cipher_algo) {
1544 						if (check_type(options, &dev_info) == 0)
1545 							break;
1546 					}
1547 				}
1548 				cap = &dev_info.capabilities[++i];
1549 			}
1550 
1551 			if (cap->op == RTE_CRYPTO_OP_TYPE_UNDEFINED) {
1552 				printf("Algorithm %s not supported by cryptodev %u"
1553 					" or device not of preferred type (%s)\n",
1554 					rte_crypto_cipher_algorithm_strings[opt_cipher_algo],
1555 					cdev_id,
1556 					options->string_type);
1557 				continue;
1558 			}
1559 
1560 			options->block_size = cap->sym.cipher.block_size;
1561 			/*
1562 			 * Check if length of provided IV is supported
1563 			 * by the algorithm chosen.
1564 			 */
1565 			if (options->iv_param) {
1566 				if (check_supported_size(options->iv.length,
1567 						cap->sym.cipher.iv_size.min,
1568 						cap->sym.cipher.iv_size.max,
1569 						cap->sym.cipher.iv_size.increment)
1570 							!= 0) {
1571 					printf("Unsupported IV length\n");
1572 					return -1;
1573 				}
1574 			/*
1575 			 * Check if length of IV to be randomly generated
1576 			 * is supported by the algorithm chosen.
1577 			 */
1578 			} else if (options->iv_random_size != -1) {
1579 				if (check_supported_size(options->iv_random_size,
1580 						cap->sym.cipher.iv_size.min,
1581 						cap->sym.cipher.iv_size.max,
1582 						cap->sym.cipher.iv_size.increment)
1583 							!= 0) {
1584 					printf("Unsupported IV length\n");
1585 					return -1;
1586 				}
1587 				options->iv.length = options->iv_random_size;
1588 			/* No size provided, use minimum size. */
1589 			} else
1590 				options->iv.length = cap->sym.cipher.iv_size.min;
1591 
1592 			/*
1593 			 * Check if length of provided cipher key is supported
1594 			 * by the algorithm chosen.
1595 			 */
1596 			if (options->ckey_param) {
1597 				if (check_supported_size(
1598 						options->cipher_xform.cipher.key.length,
1599 						cap->sym.cipher.key_size.min,
1600 						cap->sym.cipher.key_size.max,
1601 						cap->sym.cipher.key_size.increment)
1602 							!= 0) {
1603 					printf("Unsupported cipher key length\n");
1604 					return -1;
1605 				}
1606 			/*
1607 			 * Check if length of the cipher key to be randomly generated
1608 			 * is supported by the algorithm chosen.
1609 			 */
1610 			} else if (options->ckey_random_size != -1) {
1611 				if (check_supported_size(options->ckey_random_size,
1612 						cap->sym.cipher.key_size.min,
1613 						cap->sym.cipher.key_size.max,
1614 						cap->sym.cipher.key_size.increment)
1615 							!= 0) {
1616 					printf("Unsupported cipher key length\n");
1617 					return -1;
1618 				}
1619 				options->cipher_xform.cipher.key.length =
1620 							options->ckey_random_size;
1621 			/* No size provided, use minimum size. */
1622 			} else
1623 				options->cipher_xform.cipher.key.length =
1624 						cap->sym.cipher.key_size.min;
1625 
1626 			if (!options->ckey_param)
1627 				generate_random_key(
1628 					options->cipher_xform.cipher.key.data,
1629 					options->cipher_xform.cipher.key.length);
1630 
1631 		}
1632 
1633 		/* Set auth parameters */
1634 		if (options->xform_chain == L2FWD_CRYPTO_CIPHER_HASH ||
1635 				options->xform_chain == L2FWD_CRYPTO_HASH_CIPHER ||
1636 				options->xform_chain == L2FWD_CRYPTO_HASH_ONLY) {
1637 			/* Check if device supports auth algo */
1638 			i = 0;
1639 			opt_auth_algo = options->auth_xform.auth.algo;
1640 			cap = &dev_info.capabilities[i];
1641 			while (cap->op != RTE_CRYPTO_OP_TYPE_UNDEFINED) {
1642 				cap_auth_algo = cap->sym.auth.algo;
1643 				if ((cap->sym.xform_type == RTE_CRYPTO_SYM_XFORM_AUTH) &&
1644 						(cap_auth_algo == opt_auth_algo) &&
1645 						(check_type(options, &dev_info) == 0)) {
1646 					break;
1647 				}
1648 				cap = &dev_info.capabilities[++i];
1649 			}
1650 
1651 			if (cap->op == RTE_CRYPTO_OP_TYPE_UNDEFINED) {
1652 				printf("Algorithm %s not supported by cryptodev %u"
1653 					" or device not of preferred type (%s)\n",
1654 					rte_crypto_auth_algorithm_strings[opt_auth_algo],
1655 					cdev_id,
1656 					options->string_type);
1657 				continue;
1658 			}
1659 
1660 			options->block_size = cap->sym.auth.block_size;
1661 			/*
1662 			 * Check if length of provided AAD is supported
1663 			 * by the algorithm chosen.
1664 			 */
1665 			if (options->aad_param) {
1666 				if (check_supported_size(options->aad.length,
1667 						cap->sym.auth.aad_size.min,
1668 						cap->sym.auth.aad_size.max,
1669 						cap->sym.auth.aad_size.increment)
1670 							!= 0) {
1671 					printf("Unsupported AAD length\n");
1672 					return -1;
1673 				}
1674 			/*
1675 			 * Check if length of AAD to be randomly generated
1676 			 * is supported by the algorithm chosen.
1677 			 */
1678 			} else if (options->aad_random_size != -1) {
1679 				if (check_supported_size(options->aad_random_size,
1680 						cap->sym.auth.aad_size.min,
1681 						cap->sym.auth.aad_size.max,
1682 						cap->sym.auth.aad_size.increment)
1683 							!= 0) {
1684 					printf("Unsupported AAD length\n");
1685 					return -1;
1686 				}
1687 				options->aad.length = options->aad_random_size;
1688 			/* No size provided, use minimum size. */
1689 			} else
1690 				options->aad.length = cap->sym.auth.aad_size.min;
1691 
1692 			options->auth_xform.auth.add_auth_data_length =
1693 						options->aad.length;
1694 
1695 			/*
1696 			 * Check if length of provided auth key is supported
1697 			 * by the algorithm chosen.
1698 			 */
1699 			if (options->akey_param) {
1700 				if (check_supported_size(
1701 						options->auth_xform.auth.key.length,
1702 						cap->sym.auth.key_size.min,
1703 						cap->sym.auth.key_size.max,
1704 						cap->sym.auth.key_size.increment)
1705 							!= 0) {
1706 					printf("Unsupported auth key length\n");
1707 					return -1;
1708 				}
1709 			/*
1710 			 * Check if length of the auth key to be randomly generated
1711 			 * is supported by the algorithm chosen.
1712 			 */
1713 			} else if (options->akey_random_size != -1) {
1714 				if (check_supported_size(options->akey_random_size,
1715 						cap->sym.auth.key_size.min,
1716 						cap->sym.auth.key_size.max,
1717 						cap->sym.auth.key_size.increment)
1718 							!= 0) {
1719 					printf("Unsupported auth key length\n");
1720 					return -1;
1721 				}
1722 				options->auth_xform.auth.key.length =
1723 							options->akey_random_size;
1724 			/* No size provided, use minimum size. */
1725 			} else
1726 				options->auth_xform.auth.key.length =
1727 						cap->sym.auth.key_size.min;
1728 
1729 			if (!options->akey_param)
1730 				generate_random_key(
1731 					options->auth_xform.auth.key.data,
1732 					options->auth_xform.auth.key.length);
1733 
1734 			/* Check if digest size is supported by the algorithm. */
1735 			if (options->digest_size != -1) {
1736 				if (check_supported_size(options->digest_size,
1737 						cap->sym.auth.digest_size.min,
1738 						cap->sym.auth.digest_size.max,
1739 						cap->sym.auth.digest_size.increment)
1740 							!= 0) {
1741 					printf("Unsupported digest length\n");
1742 					return -1;
1743 				}
1744 				options->auth_xform.auth.digest_length =
1745 							options->digest_size;
1746 			/* No size provided, use minimum size. */
1747 			} else
1748 				options->auth_xform.auth.digest_length =
1749 						cap->sym.auth.digest_size.min;
1750 		}
1751 
1752 		retval = rte_cryptodev_configure(cdev_id, &conf);
1753 		if (retval < 0) {
1754 			printf("Failed to configure cryptodev %u", cdev_id);
1755 			return -1;
1756 		}
1757 
1758 		qp_conf.nb_descriptors = 2048;
1759 
1760 		retval = rte_cryptodev_queue_pair_setup(cdev_id, 0, &qp_conf,
1761 				SOCKET_ID_ANY);
1762 		if (retval < 0) {
1763 			printf("Failed to setup queue pair %u on cryptodev %u",
1764 					0, cdev_id);
1765 			return -1;
1766 		}
1767 
1768 		retval = rte_cryptodev_start(cdev_id);
1769 		if (retval < 0) {
1770 			printf("Failed to start device %u: error %d\n",
1771 					cdev_id, retval);
1772 			return -1;
1773 		}
1774 
1775 		l2fwd_enabled_crypto_mask |= (((uint64_t)1) << cdev_id);
1776 
1777 		enabled_cdevs[cdev_id] = 1;
1778 		enabled_cdev_count++;
1779 	}
1780 
1781 	return enabled_cdev_count;
1782 }
1783 
1784 static int
1785 initialize_ports(struct l2fwd_crypto_options *options)
1786 {
1787 	uint8_t last_portid, portid;
1788 	unsigned enabled_portcount = 0;
1789 	unsigned nb_ports = rte_eth_dev_count();
1790 
1791 	if (nb_ports == 0) {
1792 		printf("No Ethernet ports - bye\n");
1793 		return -1;
1794 	}
1795 
1796 	/* Reset l2fwd_dst_ports */
1797 	for (portid = 0; portid < RTE_MAX_ETHPORTS; portid++)
1798 		l2fwd_dst_ports[portid] = 0;
1799 
1800 	for (last_portid = 0, portid = 0; portid < nb_ports; portid++) {
1801 		int retval;
1802 
1803 		/* Skip ports that are not enabled */
1804 		if ((options->portmask & (1 << portid)) == 0)
1805 			continue;
1806 
1807 		/* init port */
1808 		printf("Initializing port %u... ", (unsigned) portid);
1809 		fflush(stdout);
1810 		retval = rte_eth_dev_configure(portid, 1, 1, &port_conf);
1811 		if (retval < 0) {
1812 			printf("Cannot configure device: err=%d, port=%u\n",
1813 				  retval, (unsigned) portid);
1814 			return -1;
1815 		}
1816 
1817 		/* init one RX queue */
1818 		fflush(stdout);
1819 		retval = rte_eth_rx_queue_setup(portid, 0, nb_rxd,
1820 					     rte_eth_dev_socket_id(portid),
1821 					     NULL, l2fwd_pktmbuf_pool);
1822 		if (retval < 0) {
1823 			printf("rte_eth_rx_queue_setup:err=%d, port=%u\n",
1824 					retval, (unsigned) portid);
1825 			return -1;
1826 		}
1827 
1828 		/* init one TX queue on each port */
1829 		fflush(stdout);
1830 		retval = rte_eth_tx_queue_setup(portid, 0, nb_txd,
1831 				rte_eth_dev_socket_id(portid),
1832 				NULL);
1833 		if (retval < 0) {
1834 			printf("rte_eth_tx_queue_setup:err=%d, port=%u\n",
1835 				retval, (unsigned) portid);
1836 
1837 			return -1;
1838 		}
1839 
1840 		/* Start device */
1841 		retval = rte_eth_dev_start(portid);
1842 		if (retval < 0) {
1843 			printf("rte_eth_dev_start:err=%d, port=%u\n",
1844 					retval, (unsigned) portid);
1845 			return -1;
1846 		}
1847 
1848 		rte_eth_promiscuous_enable(portid);
1849 
1850 		rte_eth_macaddr_get(portid, &l2fwd_ports_eth_addr[portid]);
1851 
1852 		printf("Port %u, MAC address: %02X:%02X:%02X:%02X:%02X:%02X\n\n",
1853 				(unsigned) portid,
1854 				l2fwd_ports_eth_addr[portid].addr_bytes[0],
1855 				l2fwd_ports_eth_addr[portid].addr_bytes[1],
1856 				l2fwd_ports_eth_addr[portid].addr_bytes[2],
1857 				l2fwd_ports_eth_addr[portid].addr_bytes[3],
1858 				l2fwd_ports_eth_addr[portid].addr_bytes[4],
1859 				l2fwd_ports_eth_addr[portid].addr_bytes[5]);
1860 
1861 		/* initialize port stats */
1862 		memset(&port_statistics, 0, sizeof(port_statistics));
1863 
1864 		/* Setup port forwarding table */
1865 		if (enabled_portcount % 2) {
1866 			l2fwd_dst_ports[portid] = last_portid;
1867 			l2fwd_dst_ports[last_portid] = portid;
1868 		} else {
1869 			last_portid = portid;
1870 		}
1871 
1872 		l2fwd_enabled_port_mask |= (1 << portid);
1873 		enabled_portcount++;
1874 	}
1875 
1876 	if (enabled_portcount == 1) {
1877 		l2fwd_dst_ports[last_portid] = last_portid;
1878 	} else if (enabled_portcount % 2) {
1879 		printf("odd number of ports in portmask- bye\n");
1880 		return -1;
1881 	}
1882 
1883 	check_all_ports_link_status(nb_ports, l2fwd_enabled_port_mask);
1884 
1885 	return enabled_portcount;
1886 }
1887 
1888 static void
1889 reserve_key_memory(struct l2fwd_crypto_options *options)
1890 {
1891 	options->cipher_xform.cipher.key.data = rte_malloc("crypto key",
1892 						MAX_KEY_SIZE, 0);
1893 	if (options->cipher_xform.cipher.key.data == NULL)
1894 		rte_exit(EXIT_FAILURE, "Failed to allocate memory for cipher key");
1895 
1896 
1897 	options->auth_xform.auth.key.data = rte_malloc("auth key",
1898 						MAX_KEY_SIZE, 0);
1899 	if (options->auth_xform.auth.key.data == NULL)
1900 		rte_exit(EXIT_FAILURE, "Failed to allocate memory for auth key");
1901 
1902 	options->iv.data = rte_malloc("iv", MAX_KEY_SIZE, 0);
1903 	if (options->iv.data == NULL)
1904 		rte_exit(EXIT_FAILURE, "Failed to allocate memory for IV");
1905 	options->iv.phys_addr = rte_malloc_virt2phy(options->iv.data);
1906 
1907 	options->aad.data = rte_malloc("aad", MAX_KEY_SIZE, 0);
1908 	if (options->aad.data == NULL)
1909 		rte_exit(EXIT_FAILURE, "Failed to allocate memory for AAD");
1910 	options->aad.phys_addr = rte_malloc_virt2phy(options->aad.data);
1911 }
1912 
1913 int
1914 main(int argc, char **argv)
1915 {
1916 	struct lcore_queue_conf *qconf;
1917 	struct l2fwd_crypto_options options;
1918 
1919 	uint8_t nb_ports, nb_cryptodevs, portid, cdev_id;
1920 	unsigned lcore_id, rx_lcore_id;
1921 	int ret, enabled_cdevcount, enabled_portcount;
1922 	uint8_t enabled_cdevs[RTE_CRYPTO_MAX_DEVS] = {0};
1923 
1924 	/* init EAL */
1925 	ret = rte_eal_init(argc, argv);
1926 	if (ret < 0)
1927 		rte_exit(EXIT_FAILURE, "Invalid EAL arguments\n");
1928 	argc -= ret;
1929 	argv += ret;
1930 
1931 	/* reserve memory for Cipher/Auth key and IV */
1932 	reserve_key_memory(&options);
1933 
1934 	/* parse application arguments (after the EAL ones) */
1935 	ret = l2fwd_crypto_parse_args(&options, argc, argv);
1936 	if (ret < 0)
1937 		rte_exit(EXIT_FAILURE, "Invalid L2FWD-CRYPTO arguments\n");
1938 
1939 	/* create the mbuf pool */
1940 	l2fwd_pktmbuf_pool = rte_pktmbuf_pool_create("mbuf_pool", NB_MBUF, 512,
1941 			sizeof(struct rte_crypto_op),
1942 			RTE_MBUF_DEFAULT_BUF_SIZE, rte_socket_id());
1943 	if (l2fwd_pktmbuf_pool == NULL)
1944 		rte_exit(EXIT_FAILURE, "Cannot create mbuf pool\n");
1945 
1946 	/* create crypto op pool */
1947 	l2fwd_crypto_op_pool = rte_crypto_op_pool_create("crypto_op_pool",
1948 			RTE_CRYPTO_OP_TYPE_SYMMETRIC, NB_MBUF, 128, 0,
1949 			rte_socket_id());
1950 	if (l2fwd_crypto_op_pool == NULL)
1951 		rte_exit(EXIT_FAILURE, "Cannot create crypto op pool\n");
1952 
1953 	/* Enable Ethernet ports */
1954 	enabled_portcount = initialize_ports(&options);
1955 	if (enabled_portcount < 1)
1956 		rte_exit(EXIT_FAILURE, "Failed to initial Ethernet ports\n");
1957 
1958 	nb_ports = rte_eth_dev_count();
1959 	/* Initialize the port/queue configuration of each logical core */
1960 	for (rx_lcore_id = 0, qconf = NULL, portid = 0;
1961 			portid < nb_ports; portid++) {
1962 
1963 		/* skip ports that are not enabled */
1964 		if ((options.portmask & (1 << portid)) == 0)
1965 			continue;
1966 
1967 		if (options.single_lcore && qconf == NULL) {
1968 			while (rte_lcore_is_enabled(rx_lcore_id) == 0) {
1969 				rx_lcore_id++;
1970 				if (rx_lcore_id >= RTE_MAX_LCORE)
1971 					rte_exit(EXIT_FAILURE,
1972 							"Not enough cores\n");
1973 			}
1974 		} else if (!options.single_lcore) {
1975 			/* get the lcore_id for this port */
1976 			while (rte_lcore_is_enabled(rx_lcore_id) == 0 ||
1977 			       lcore_queue_conf[rx_lcore_id].nb_rx_ports ==
1978 			       options.nb_ports_per_lcore) {
1979 				rx_lcore_id++;
1980 				if (rx_lcore_id >= RTE_MAX_LCORE)
1981 					rte_exit(EXIT_FAILURE,
1982 							"Not enough cores\n");
1983 			}
1984 		}
1985 
1986 		/* Assigned a new logical core in the loop above. */
1987 		if (qconf != &lcore_queue_conf[rx_lcore_id])
1988 			qconf = &lcore_queue_conf[rx_lcore_id];
1989 
1990 		qconf->rx_port_list[qconf->nb_rx_ports] = portid;
1991 		qconf->nb_rx_ports++;
1992 
1993 		printf("Lcore %u: RX port %u\n", rx_lcore_id, (unsigned)portid);
1994 	}
1995 
1996 	/* Enable Crypto devices */
1997 	enabled_cdevcount = initialize_cryptodevs(&options, enabled_portcount,
1998 			enabled_cdevs);
1999 	if (enabled_cdevcount < 0)
2000 		rte_exit(EXIT_FAILURE, "Failed to initialize crypto devices\n");
2001 
2002 	if (enabled_cdevcount < enabled_portcount)
2003 		rte_exit(EXIT_FAILURE, "Number of capable crypto devices (%d) "
2004 				"has to be more or equal to number of ports (%d)\n",
2005 				enabled_cdevcount, enabled_portcount);
2006 
2007 	nb_cryptodevs = rte_cryptodev_count();
2008 
2009 	/* Initialize the port/cryptodev configuration of each logical core */
2010 	for (rx_lcore_id = 0, qconf = NULL, cdev_id = 0;
2011 			cdev_id < nb_cryptodevs && enabled_cdevcount;
2012 			cdev_id++) {
2013 		/* Crypto op not supported by crypto device */
2014 		if (!enabled_cdevs[cdev_id])
2015 			continue;
2016 
2017 		if (options.single_lcore && qconf == NULL) {
2018 			while (rte_lcore_is_enabled(rx_lcore_id) == 0) {
2019 				rx_lcore_id++;
2020 				if (rx_lcore_id >= RTE_MAX_LCORE)
2021 					rte_exit(EXIT_FAILURE,
2022 							"Not enough cores\n");
2023 			}
2024 		} else if (!options.single_lcore) {
2025 			/* get the lcore_id for this port */
2026 			while (rte_lcore_is_enabled(rx_lcore_id) == 0 ||
2027 			       lcore_queue_conf[rx_lcore_id].nb_crypto_devs ==
2028 			       options.nb_ports_per_lcore) {
2029 				rx_lcore_id++;
2030 				if (rx_lcore_id >= RTE_MAX_LCORE)
2031 					rte_exit(EXIT_FAILURE,
2032 							"Not enough cores\n");
2033 			}
2034 		}
2035 
2036 		/* Assigned a new logical core in the loop above. */
2037 		if (qconf != &lcore_queue_conf[rx_lcore_id])
2038 			qconf = &lcore_queue_conf[rx_lcore_id];
2039 
2040 		qconf->cryptodev_list[qconf->nb_crypto_devs] = cdev_id;
2041 		qconf->nb_crypto_devs++;
2042 
2043 		enabled_cdevcount--;
2044 
2045 		printf("Lcore %u: cryptodev %u\n", rx_lcore_id,
2046 				(unsigned)cdev_id);
2047 	}
2048 
2049 	/* launch per-lcore init on every lcore */
2050 	rte_eal_mp_remote_launch(l2fwd_launch_one_lcore, (void *)&options,
2051 			CALL_MASTER);
2052 	RTE_LCORE_FOREACH_SLAVE(lcore_id) {
2053 		if (rte_eal_wait_lcore(lcore_id) < 0)
2054 			return -1;
2055 	}
2056 
2057 	return 0;
2058 }
2059