f848310e8a8706c5b882a8b575ba6536bc9db452
[dpdk.git] / examples / ip_pipeline / init.c
1 /* SPDX-License-Identifier: BSD-3-Clause
2  * Copyright(c) 2010-2016 Intel Corporation
3  */
4
5 #include <inttypes.h>
6 #include <stdio.h>
7 #include <string.h>
8 #include <netinet/in.h>
9 #ifdef RTE_EXEC_ENV_LINUXAPP
10 #include <linux/if.h>
11 #include <linux/if_tun.h>
12 #endif
13 #include <fcntl.h>
14 #include <sys/ioctl.h>
15 #include <unistd.h>
16
17 #include <rte_cycles.h>
18 #include <rte_ethdev.h>
19 #include <rte_ether.h>
20 #include <rte_ip.h>
21 #include <rte_eal.h>
22 #include <rte_malloc.h>
23 #include <rte_bus_pci.h>
24
25 #include "app.h"
26 #include "pipeline.h"
27 #include "pipeline_common_fe.h"
28 #include "pipeline_master.h"
29 #include "thread_fe.h"
30
31 #define APP_NAME_SIZE   32
32
33 #define APP_RETA_SIZE_MAX     (ETH_RSS_RETA_SIZE_512 / RTE_RETA_GROUP_SIZE)
34
35 static void
36 app_init_core_map(struct app_params *app)
37 {
38         APP_LOG(app, HIGH, "Initializing CPU core map ...");
39         app->core_map = cpu_core_map_init(RTE_MAX_NUMA_NODES, RTE_MAX_LCORE,
40                                 4, 0);
41
42         if (app->core_map == NULL)
43                 rte_panic("Cannot create CPU core map\n");
44
45         if (app->log_level >= APP_LOG_LEVEL_LOW)
46                 cpu_core_map_print(app->core_map);
47 }
48
49 /* Core Mask String in Hex Representation */
50 #define APP_CORE_MASK_STRING_SIZE ((64 * APP_CORE_MASK_SIZE) / 8 * 2 + 1)
51
52 static void
53 app_init_core_mask(struct app_params *app)
54 {
55         uint32_t i;
56         char core_mask_str[APP_CORE_MASK_STRING_SIZE];
57
58         for (i = 0; i < app->n_pipelines; i++) {
59                 struct app_pipeline_params *p = &app->pipeline_params[i];
60                 int lcore_id;
61
62                 lcore_id = cpu_core_map_get_lcore_id(app->core_map,
63                         p->socket_id,
64                         p->core_id,
65                         p->hyper_th_id);
66
67                 if (lcore_id < 0)
68                         rte_panic("Cannot create CPU core mask\n");
69
70                 app_core_enable_in_core_mask(app, lcore_id);
71         }
72
73         app_core_build_core_mask_string(app, core_mask_str);
74         APP_LOG(app, HIGH, "CPU core mask = 0x%s", core_mask_str);
75 }
76
77 static void
78 app_init_eal(struct app_params *app)
79 {
80         char buffer[256];
81         char core_mask_str[APP_CORE_MASK_STRING_SIZE];
82         struct app_eal_params *p = &app->eal_params;
83         uint32_t n_args = 0;
84         uint32_t i;
85         int status;
86
87         app->eal_argv[n_args++] = strdup(app->app_name);
88
89         app_core_build_core_mask_string(app, core_mask_str);
90         snprintf(buffer, sizeof(buffer), "-c%s", core_mask_str);
91         app->eal_argv[n_args++] = strdup(buffer);
92
93         if (p->coremap) {
94                 snprintf(buffer, sizeof(buffer), "--lcores=%s", p->coremap);
95                 app->eal_argv[n_args++] = strdup(buffer);
96         }
97
98         if (p->master_lcore_present) {
99                 snprintf(buffer,
100                         sizeof(buffer),
101                         "--master-lcore=%" PRIu32,
102                         p->master_lcore);
103                 app->eal_argv[n_args++] = strdup(buffer);
104         }
105
106         snprintf(buffer, sizeof(buffer), "-n%" PRIu32, p->channels);
107         app->eal_argv[n_args++] = strdup(buffer);
108
109         if (p->memory_present) {
110                 snprintf(buffer, sizeof(buffer), "-m%" PRIu32, p->memory);
111                 app->eal_argv[n_args++] = strdup(buffer);
112         }
113
114         if (p->ranks_present) {
115                 snprintf(buffer, sizeof(buffer), "-r%" PRIu32, p->ranks);
116                 app->eal_argv[n_args++] = strdup(buffer);
117         }
118
119         for (i = 0; i < APP_MAX_LINKS; i++) {
120                 if (p->pci_blacklist[i] == NULL)
121                         break;
122
123                 snprintf(buffer,
124                         sizeof(buffer),
125                         "--pci-blacklist=%s",
126                         p->pci_blacklist[i]);
127                 app->eal_argv[n_args++] = strdup(buffer);
128         }
129
130         if (app->port_mask != 0)
131                 for (i = 0; i < APP_MAX_LINKS; i++) {
132                         if (p->pci_whitelist[i] == NULL)
133                                 break;
134
135                         snprintf(buffer,
136                                 sizeof(buffer),
137                                 "--pci-whitelist=%s",
138                                 p->pci_whitelist[i]);
139                         app->eal_argv[n_args++] = strdup(buffer);
140                 }
141         else
142                 for (i = 0; i < app->n_links; i++) {
143                         char *pci_bdf = app->link_params[i].pci_bdf;
144
145                         snprintf(buffer,
146                                 sizeof(buffer),
147                                 "--pci-whitelist=%s",
148                                 pci_bdf);
149                         app->eal_argv[n_args++] = strdup(buffer);
150                 }
151
152         for (i = 0; i < APP_MAX_LINKS; i++) {
153                 if (p->vdev[i] == NULL)
154                         break;
155
156                 snprintf(buffer,
157                         sizeof(buffer),
158                         "--vdev=%s",
159                         p->vdev[i]);
160                 app->eal_argv[n_args++] = strdup(buffer);
161         }
162
163         if ((p->vmware_tsc_map_present) && p->vmware_tsc_map) {
164                 snprintf(buffer, sizeof(buffer), "--vmware-tsc-map");
165                 app->eal_argv[n_args++] = strdup(buffer);
166         }
167
168         if (p->proc_type) {
169                 snprintf(buffer,
170                         sizeof(buffer),
171                         "--proc-type=%s",
172                         p->proc_type);
173                 app->eal_argv[n_args++] = strdup(buffer);
174         }
175
176         if (p->syslog) {
177                 snprintf(buffer, sizeof(buffer), "--syslog=%s", p->syslog);
178                 app->eal_argv[n_args++] = strdup(buffer);
179         }
180
181         if (p->log_level_present) {
182                 snprintf(buffer,
183                         sizeof(buffer),
184                         "--log-level=%" PRIu32,
185                         p->log_level);
186                 app->eal_argv[n_args++] = strdup(buffer);
187         }
188
189         if ((p->version_present) && p->version) {
190                 snprintf(buffer, sizeof(buffer), "-v");
191                 app->eal_argv[n_args++] = strdup(buffer);
192         }
193
194         if ((p->help_present) && p->help) {
195                 snprintf(buffer, sizeof(buffer), "--help");
196                 app->eal_argv[n_args++] = strdup(buffer);
197         }
198
199         if ((p->no_huge_present) && p->no_huge) {
200                 snprintf(buffer, sizeof(buffer), "--no-huge");
201                 app->eal_argv[n_args++] = strdup(buffer);
202         }
203
204         if ((p->no_pci_present) && p->no_pci) {
205                 snprintf(buffer, sizeof(buffer), "--no-pci");
206                 app->eal_argv[n_args++] = strdup(buffer);
207         }
208
209         if ((p->no_hpet_present) && p->no_hpet) {
210                 snprintf(buffer, sizeof(buffer), "--no-hpet");
211                 app->eal_argv[n_args++] = strdup(buffer);
212         }
213
214         if ((p->no_shconf_present) && p->no_shconf) {
215                 snprintf(buffer, sizeof(buffer), "--no-shconf");
216                 app->eal_argv[n_args++] = strdup(buffer);
217         }
218
219         if (p->add_driver) {
220                 snprintf(buffer, sizeof(buffer), "-d%s", p->add_driver);
221                 app->eal_argv[n_args++] = strdup(buffer);
222         }
223
224         if (p->socket_mem) {
225                 snprintf(buffer,
226                         sizeof(buffer),
227                         "--socket-mem=%s",
228                         p->socket_mem);
229                 app->eal_argv[n_args++] = strdup(buffer);
230         }
231
232         if (p->huge_dir) {
233                 snprintf(buffer, sizeof(buffer), "--huge-dir=%s", p->huge_dir);
234                 app->eal_argv[n_args++] = strdup(buffer);
235         }
236
237         if (p->file_prefix) {
238                 snprintf(buffer,
239                         sizeof(buffer),
240                         "--file-prefix=%s",
241                         p->file_prefix);
242                 app->eal_argv[n_args++] = strdup(buffer);
243         }
244
245         if (p->base_virtaddr) {
246                 snprintf(buffer,
247                         sizeof(buffer),
248                         "--base-virtaddr=%s",
249                         p->base_virtaddr);
250                 app->eal_argv[n_args++] = strdup(buffer);
251         }
252
253         if ((p->create_uio_dev_present) && p->create_uio_dev) {
254                 snprintf(buffer, sizeof(buffer), "--create-uio-dev");
255                 app->eal_argv[n_args++] = strdup(buffer);
256         }
257
258         if (p->vfio_intr) {
259                 snprintf(buffer,
260                         sizeof(buffer),
261                         "--vfio-intr=%s",
262                         p->vfio_intr);
263                 app->eal_argv[n_args++] = strdup(buffer);
264         }
265
266         snprintf(buffer, sizeof(buffer), "--");
267         app->eal_argv[n_args++] = strdup(buffer);
268
269         app->eal_argc = n_args;
270
271         APP_LOG(app, HIGH, "Initializing EAL ...");
272         if (app->log_level >= APP_LOG_LEVEL_LOW) {
273                 int i;
274
275                 fprintf(stdout, "[APP] EAL arguments: \"");
276                 for (i = 1; i < app->eal_argc; i++)
277                         fprintf(stdout, "%s ", app->eal_argv[i]);
278                 fprintf(stdout, "\"\n");
279         }
280
281         status = rte_eal_init(app->eal_argc, app->eal_argv);
282         if (status < 0)
283                 rte_panic("EAL init error\n");
284 }
285
286 static void
287 app_init_mempool(struct app_params *app)
288 {
289         uint32_t i;
290
291         for (i = 0; i < app->n_mempools; i++) {
292                 struct app_mempool_params *p = &app->mempool_params[i];
293
294                 APP_LOG(app, HIGH, "Initializing %s ...", p->name);
295                 app->mempool[i] = rte_pktmbuf_pool_create(
296                         p->name,
297                         p->pool_size,
298                         p->cache_size,
299                         0, /* priv_size */
300                         p->buffer_size -
301                                 sizeof(struct rte_mbuf), /* mbuf data size */
302                         p->cpu_socket_id);
303
304                 if (app->mempool[i] == NULL)
305                         rte_panic("%s init error\n", p->name);
306         }
307 }
308
309 static inline int
310 app_link_filter_arp_add(struct app_link_params *link)
311 {
312         struct rte_eth_ethertype_filter filter = {
313                 .ether_type = ETHER_TYPE_ARP,
314                 .flags = 0,
315                 .queue = link->arp_q,
316         };
317
318         return rte_eth_dev_filter_ctrl(link->pmd_id,
319                 RTE_ETH_FILTER_ETHERTYPE,
320                 RTE_ETH_FILTER_ADD,
321                 &filter);
322 }
323
324 static inline int
325 app_link_filter_tcp_syn_add(struct app_link_params *link)
326 {
327         struct rte_eth_syn_filter filter = {
328                 .hig_pri = 1,
329                 .queue = link->tcp_syn_q,
330         };
331
332         return rte_eth_dev_filter_ctrl(link->pmd_id,
333                 RTE_ETH_FILTER_SYN,
334                 RTE_ETH_FILTER_ADD,
335                 &filter);
336 }
337
338 static inline int
339 app_link_filter_ip_add(struct app_link_params *l1, struct app_link_params *l2)
340 {
341         struct rte_eth_ntuple_filter filter = {
342                 .flags = RTE_5TUPLE_FLAGS,
343                 .dst_ip = rte_bswap32(l2->ip),
344                 .dst_ip_mask = UINT32_MAX, /* Enable */
345                 .src_ip = 0,
346                 .src_ip_mask = 0, /* Disable */
347                 .dst_port = 0,
348                 .dst_port_mask = 0, /* Disable */
349                 .src_port = 0,
350                 .src_port_mask = 0, /* Disable */
351                 .proto = 0,
352                 .proto_mask = 0, /* Disable */
353                 .tcp_flags = 0,
354                 .priority = 1, /* Lowest */
355                 .queue = l1->ip_local_q,
356         };
357
358         return rte_eth_dev_filter_ctrl(l1->pmd_id,
359                 RTE_ETH_FILTER_NTUPLE,
360                 RTE_ETH_FILTER_ADD,
361                 &filter);
362 }
363
364 static inline int
365 app_link_filter_ip_del(struct app_link_params *l1, struct app_link_params *l2)
366 {
367         struct rte_eth_ntuple_filter filter = {
368                 .flags = RTE_5TUPLE_FLAGS,
369                 .dst_ip = rte_bswap32(l2->ip),
370                 .dst_ip_mask = UINT32_MAX, /* Enable */
371                 .src_ip = 0,
372                 .src_ip_mask = 0, /* Disable */
373                 .dst_port = 0,
374                 .dst_port_mask = 0, /* Disable */
375                 .src_port = 0,
376                 .src_port_mask = 0, /* Disable */
377                 .proto = 0,
378                 .proto_mask = 0, /* Disable */
379                 .tcp_flags = 0,
380                 .priority = 1, /* Lowest */
381                 .queue = l1->ip_local_q,
382         };
383
384         return rte_eth_dev_filter_ctrl(l1->pmd_id,
385                 RTE_ETH_FILTER_NTUPLE,
386                 RTE_ETH_FILTER_DELETE,
387                 &filter);
388 }
389
390 static inline int
391 app_link_filter_tcp_add(struct app_link_params *l1, struct app_link_params *l2)
392 {
393         struct rte_eth_ntuple_filter filter = {
394                 .flags = RTE_5TUPLE_FLAGS,
395                 .dst_ip = rte_bswap32(l2->ip),
396                 .dst_ip_mask = UINT32_MAX, /* Enable */
397                 .src_ip = 0,
398                 .src_ip_mask = 0, /* Disable */
399                 .dst_port = 0,
400                 .dst_port_mask = 0, /* Disable */
401                 .src_port = 0,
402                 .src_port_mask = 0, /* Disable */
403                 .proto = IPPROTO_TCP,
404                 .proto_mask = UINT8_MAX, /* Enable */
405                 .tcp_flags = 0,
406                 .priority = 2, /* Higher priority than IP */
407                 .queue = l1->tcp_local_q,
408         };
409
410         return rte_eth_dev_filter_ctrl(l1->pmd_id,
411                 RTE_ETH_FILTER_NTUPLE,
412                 RTE_ETH_FILTER_ADD,
413                 &filter);
414 }
415
416 static inline int
417 app_link_filter_tcp_del(struct app_link_params *l1, struct app_link_params *l2)
418 {
419         struct rte_eth_ntuple_filter filter = {
420                 .flags = RTE_5TUPLE_FLAGS,
421                 .dst_ip = rte_bswap32(l2->ip),
422                 .dst_ip_mask = UINT32_MAX, /* Enable */
423                 .src_ip = 0,
424                 .src_ip_mask = 0, /* Disable */
425                 .dst_port = 0,
426                 .dst_port_mask = 0, /* Disable */
427                 .src_port = 0,
428                 .src_port_mask = 0, /* Disable */
429                 .proto = IPPROTO_TCP,
430                 .proto_mask = UINT8_MAX, /* Enable */
431                 .tcp_flags = 0,
432                 .priority = 2, /* Higher priority than IP */
433                 .queue = l1->tcp_local_q,
434         };
435
436         return rte_eth_dev_filter_ctrl(l1->pmd_id,
437                 RTE_ETH_FILTER_NTUPLE,
438                 RTE_ETH_FILTER_DELETE,
439                 &filter);
440 }
441
442 static inline int
443 app_link_filter_udp_add(struct app_link_params *l1, struct app_link_params *l2)
444 {
445         struct rte_eth_ntuple_filter filter = {
446                 .flags = RTE_5TUPLE_FLAGS,
447                 .dst_ip = rte_bswap32(l2->ip),
448                 .dst_ip_mask = UINT32_MAX, /* Enable */
449                 .src_ip = 0,
450                 .src_ip_mask = 0, /* Disable */
451                 .dst_port = 0,
452                 .dst_port_mask = 0, /* Disable */
453                 .src_port = 0,
454                 .src_port_mask = 0, /* Disable */
455                 .proto = IPPROTO_UDP,
456                 .proto_mask = UINT8_MAX, /* Enable */
457                 .tcp_flags = 0,
458                 .priority = 2, /* Higher priority than IP */
459                 .queue = l1->udp_local_q,
460         };
461
462         return rte_eth_dev_filter_ctrl(l1->pmd_id,
463                 RTE_ETH_FILTER_NTUPLE,
464                 RTE_ETH_FILTER_ADD,
465                 &filter);
466 }
467
468 static inline int
469 app_link_filter_udp_del(struct app_link_params *l1, struct app_link_params *l2)
470 {
471         struct rte_eth_ntuple_filter filter = {
472                 .flags = RTE_5TUPLE_FLAGS,
473                 .dst_ip = rte_bswap32(l2->ip),
474                 .dst_ip_mask = UINT32_MAX, /* Enable */
475                 .src_ip = 0,
476                 .src_ip_mask = 0, /* Disable */
477                 .dst_port = 0,
478                 .dst_port_mask = 0, /* Disable */
479                 .src_port = 0,
480                 .src_port_mask = 0, /* Disable */
481                 .proto = IPPROTO_UDP,
482                 .proto_mask = UINT8_MAX, /* Enable */
483                 .tcp_flags = 0,
484                 .priority = 2, /* Higher priority than IP */
485                 .queue = l1->udp_local_q,
486         };
487
488         return rte_eth_dev_filter_ctrl(l1->pmd_id,
489                 RTE_ETH_FILTER_NTUPLE,
490                 RTE_ETH_FILTER_DELETE,
491                 &filter);
492 }
493
494 static inline int
495 app_link_filter_sctp_add(struct app_link_params *l1, struct app_link_params *l2)
496 {
497         struct rte_eth_ntuple_filter filter = {
498                 .flags = RTE_5TUPLE_FLAGS,
499                 .dst_ip = rte_bswap32(l2->ip),
500                 .dst_ip_mask = UINT32_MAX, /* Enable */
501                 .src_ip = 0,
502                 .src_ip_mask = 0, /* Disable */
503                 .dst_port = 0,
504                 .dst_port_mask = 0, /* Disable */
505                 .src_port = 0,
506                 .src_port_mask = 0, /* Disable */
507                 .proto = IPPROTO_SCTP,
508                 .proto_mask = UINT8_MAX, /* Enable */
509                 .tcp_flags = 0,
510                 .priority = 2, /* Higher priority than IP */
511                 .queue = l1->sctp_local_q,
512         };
513
514         return rte_eth_dev_filter_ctrl(l1->pmd_id,
515                 RTE_ETH_FILTER_NTUPLE,
516                 RTE_ETH_FILTER_ADD,
517                 &filter);
518 }
519
520 static inline int
521 app_link_filter_sctp_del(struct app_link_params *l1, struct app_link_params *l2)
522 {
523         struct rte_eth_ntuple_filter filter = {
524                 .flags = RTE_5TUPLE_FLAGS,
525                 .dst_ip = rte_bswap32(l2->ip),
526                 .dst_ip_mask = UINT32_MAX, /* Enable */
527                 .src_ip = 0,
528                 .src_ip_mask = 0, /* Disable */
529                 .dst_port = 0,
530                 .dst_port_mask = 0, /* Disable */
531                 .src_port = 0,
532                 .src_port_mask = 0, /* Disable */
533                 .proto = IPPROTO_SCTP,
534                 .proto_mask = UINT8_MAX, /* Enable */
535                 .tcp_flags = 0,
536                 .priority = 2, /* Higher priority than IP */
537                 .queue = l1->sctp_local_q,
538         };
539
540         return rte_eth_dev_filter_ctrl(l1->pmd_id,
541                 RTE_ETH_FILTER_NTUPLE,
542                 RTE_ETH_FILTER_DELETE,
543                 &filter);
544 }
545
546 static void
547 app_link_set_arp_filter(struct app_params *app, struct app_link_params *cp)
548 {
549         if (cp->arp_q != 0) {
550                 int status = app_link_filter_arp_add(cp);
551
552                 APP_LOG(app, LOW, "%s (%" PRIu32 "): "
553                         "Adding ARP filter (queue = %" PRIu32 ")",
554                         cp->name, cp->pmd_id, cp->arp_q);
555
556                 if (status)
557                         rte_panic("%s (%" PRIu32 "): "
558                                 "Error adding ARP filter "
559                                 "(queue = %" PRIu32 ") (%" PRId32 ")\n",
560                                 cp->name, cp->pmd_id, cp->arp_q, status);
561         }
562 }
563
564 static void
565 app_link_set_tcp_syn_filter(struct app_params *app, struct app_link_params *cp)
566 {
567         if (cp->tcp_syn_q != 0) {
568                 int status = app_link_filter_tcp_syn_add(cp);
569
570                 APP_LOG(app, LOW, "%s (%" PRIu32 "): "
571                         "Adding TCP SYN filter (queue = %" PRIu32 ")",
572                         cp->name, cp->pmd_id, cp->tcp_syn_q);
573
574                 if (status)
575                         rte_panic("%s (%" PRIu32 "): "
576                                 "Error adding TCP SYN filter "
577                                 "(queue = %" PRIu32 ") (%" PRId32 ")\n",
578                                 cp->name, cp->pmd_id, cp->tcp_syn_q,
579                                 status);
580         }
581 }
582
583 void
584 app_link_up_internal(struct app_params *app, struct app_link_params *cp)
585 {
586         uint32_t i;
587         int status;
588
589         /* For each link, add filters for IP of current link */
590         if (cp->ip != 0) {
591                 for (i = 0; i < app->n_links; i++) {
592                         struct app_link_params *p = &app->link_params[i];
593
594                         /* IP */
595                         if (p->ip_local_q != 0) {
596                                 int status = app_link_filter_ip_add(p, cp);
597
598                                 APP_LOG(app, LOW, "%s (%" PRIu32 "): "
599                                         "Adding IP filter (queue= %" PRIu32
600                                         ", IP = 0x%08" PRIx32 ")",
601                                         p->name, p->pmd_id, p->ip_local_q,
602                                         cp->ip);
603
604                                 if (status)
605                                         rte_panic("%s (%" PRIu32 "): "
606                                                 "Error adding IP "
607                                                 "filter (queue= %" PRIu32 ", "
608                                                 "IP = 0x%08" PRIx32
609                                                 ") (%" PRId32 ")\n",
610                                                 p->name, p->pmd_id,
611                                                 p->ip_local_q, cp->ip, status);
612                         }
613
614                         /* TCP */
615                         if (p->tcp_local_q != 0) {
616                                 int status = app_link_filter_tcp_add(p, cp);
617
618                                 APP_LOG(app, LOW, "%s (%" PRIu32 "): "
619                                         "Adding TCP filter "
620                                         "(queue = %" PRIu32
621                                         ", IP = 0x%08" PRIx32 ")",
622                                         p->name, p->pmd_id, p->tcp_local_q,
623                                         cp->ip);
624
625                                 if (status)
626                                         rte_panic("%s (%" PRIu32 "): "
627                                                 "Error adding TCP "
628                                                 "filter (queue = %" PRIu32 ", "
629                                                 "IP = 0x%08" PRIx32
630                                                 ") (%" PRId32 ")\n",
631                                                 p->name, p->pmd_id,
632                                                 p->tcp_local_q, cp->ip, status);
633                         }
634
635                         /* UDP */
636                         if (p->udp_local_q != 0) {
637                                 int status = app_link_filter_udp_add(p, cp);
638
639                                 APP_LOG(app, LOW, "%s (%" PRIu32 "): "
640                                         "Adding UDP filter "
641                                         "(queue = %" PRIu32
642                                         ", IP = 0x%08" PRIx32 ")",
643                                         p->name, p->pmd_id, p->udp_local_q,
644                                         cp->ip);
645
646                                 if (status)
647                                         rte_panic("%s (%" PRIu32 "): "
648                                                 "Error adding UDP "
649                                                 "filter (queue = %" PRIu32 ", "
650                                                 "IP = 0x%08" PRIx32
651                                                 ") (%" PRId32 ")\n",
652                                                 p->name, p->pmd_id,
653                                                 p->udp_local_q, cp->ip, status);
654                         }
655
656                         /* SCTP */
657                         if (p->sctp_local_q != 0) {
658                                 int status = app_link_filter_sctp_add(p, cp);
659
660                                 APP_LOG(app, LOW, "%s (%" PRIu32
661                                         "): Adding SCTP filter "
662                                         "(queue = %" PRIu32
663                                         ", IP = 0x%08" PRIx32 ")",
664                                         p->name, p->pmd_id, p->sctp_local_q,
665                                         cp->ip);
666
667                                 if (status)
668                                         rte_panic("%s (%" PRIu32 "): "
669                                                 "Error adding SCTP "
670                                                 "filter (queue = %" PRIu32 ", "
671                                                 "IP = 0x%08" PRIx32
672                                                 ") (%" PRId32 ")\n",
673                                                 p->name, p->pmd_id,
674                                                 p->sctp_local_q, cp->ip,
675                                                 status);
676                         }
677                 }
678         }
679
680         /* PMD link up */
681         status = rte_eth_dev_set_link_up(cp->pmd_id);
682         /* Do not panic if PMD does not provide link up functionality */
683         if (status < 0 && status != -ENOTSUP)
684                 rte_panic("%s (%" PRIu32 "): PMD set link up error %"
685                         PRId32 "\n", cp->name, cp->pmd_id, status);
686
687         /* Mark link as UP */
688         cp->state = 1;
689 }
690
691 void
692 app_link_down_internal(struct app_params *app, struct app_link_params *cp)
693 {
694         uint32_t i;
695         int status;
696
697         /* PMD link down */
698         status = rte_eth_dev_set_link_down(cp->pmd_id);
699         /* Do not panic if PMD does not provide link down functionality */
700         if (status < 0 && status != -ENOTSUP)
701                 rte_panic("%s (%" PRIu32 "): PMD set link down error %"
702                         PRId32 "\n", cp->name, cp->pmd_id, status);
703
704         /* Mark link as DOWN */
705         cp->state = 0;
706
707         /* Return if current link IP is not valid */
708         if (cp->ip == 0)
709                 return;
710
711         /* For each link, remove filters for IP of current link */
712         for (i = 0; i < app->n_links; i++) {
713                 struct app_link_params *p = &app->link_params[i];
714
715                 /* IP */
716                 if (p->ip_local_q != 0) {
717                         int status = app_link_filter_ip_del(p, cp);
718
719                         APP_LOG(app, LOW, "%s (%" PRIu32
720                                 "): Deleting IP filter "
721                                 "(queue = %" PRIu32 ", IP = 0x%" PRIx32 ")",
722                                 p->name, p->pmd_id, p->ip_local_q, cp->ip);
723
724                         if (status)
725                                 rte_panic("%s (%" PRIu32
726                                         "): Error deleting IP filter "
727                                         "(queue = %" PRIu32
728                                         ", IP = 0x%" PRIx32
729                                         ") (%" PRId32 ")\n",
730                                         p->name, p->pmd_id, p->ip_local_q,
731                                         cp->ip, status);
732                 }
733
734                 /* TCP */
735                 if (p->tcp_local_q != 0) {
736                         int status = app_link_filter_tcp_del(p, cp);
737
738                         APP_LOG(app, LOW, "%s (%" PRIu32
739                                 "): Deleting TCP filter "
740                                 "(queue = %" PRIu32
741                                 ", IP = 0x%" PRIx32 ")",
742                                 p->name, p->pmd_id, p->tcp_local_q, cp->ip);
743
744                         if (status)
745                                 rte_panic("%s (%" PRIu32
746                                         "): Error deleting TCP filter "
747                                         "(queue = %" PRIu32
748                                         ", IP = 0x%" PRIx32
749                                         ") (%" PRId32 ")\n",
750                                         p->name, p->pmd_id, p->tcp_local_q,
751                                         cp->ip, status);
752                 }
753
754                 /* UDP */
755                 if (p->udp_local_q != 0) {
756                         int status = app_link_filter_udp_del(p, cp);
757
758                         APP_LOG(app, LOW, "%s (%" PRIu32
759                                 "): Deleting UDP filter "
760                                 "(queue = %" PRIu32 ", IP = 0x%" PRIx32 ")",
761                                 p->name, p->pmd_id, p->udp_local_q, cp->ip);
762
763                         if (status)
764                                 rte_panic("%s (%" PRIu32
765                                         "): Error deleting UDP filter "
766                                         "(queue = %" PRIu32
767                                         ", IP = 0x%" PRIx32
768                                         ") (%" PRId32 ")\n",
769                                         p->name, p->pmd_id, p->udp_local_q,
770                                         cp->ip, status);
771                 }
772
773                 /* SCTP */
774                 if (p->sctp_local_q != 0) {
775                         int status = app_link_filter_sctp_del(p, cp);
776
777                         APP_LOG(app, LOW, "%s (%" PRIu32
778                                 "): Deleting SCTP filter "
779                                 "(queue = %" PRIu32
780                                 ", IP = 0x%" PRIx32 ")",
781                                 p->name, p->pmd_id, p->sctp_local_q, cp->ip);
782
783                         if (status)
784                                 rte_panic("%s (%" PRIu32
785                                         "): Error deleting SCTP filter "
786                                         "(queue = %" PRIu32
787                                         ", IP = 0x%" PRIx32
788                                         ") (%" PRId32 ")\n",
789                                         p->name, p->pmd_id, p->sctp_local_q,
790                                         cp->ip, status);
791                 }
792         }
793 }
794
795 static void
796 app_check_link(struct app_params *app)
797 {
798         uint32_t all_links_up, i;
799
800         all_links_up = 1;
801
802         for (i = 0; i < app->n_links; i++) {
803                 struct app_link_params *p = &app->link_params[i];
804                 struct rte_eth_link link_params;
805
806                 memset(&link_params, 0, sizeof(link_params));
807                 rte_eth_link_get(p->pmd_id, &link_params);
808
809                 APP_LOG(app, HIGH, "%s (%" PRIu32 ") (%" PRIu32 " Gbps) %s",
810                         p->name,
811                         p->pmd_id,
812                         link_params.link_speed / 1000,
813                         link_params.link_status ? "UP" : "DOWN");
814
815                 if (link_params.link_status == ETH_LINK_DOWN)
816                         all_links_up = 0;
817         }
818
819         if (all_links_up == 0)
820                 rte_panic("Some links are DOWN\n");
821 }
822
823 static uint32_t
824 is_any_swq_frag_or_ras(struct app_params *app)
825 {
826         uint32_t i;
827
828         for (i = 0; i < app->n_pktq_swq; i++) {
829                 struct app_pktq_swq_params *p = &app->swq_params[i];
830
831                 if ((p->ipv4_frag == 1) || (p->ipv6_frag == 1) ||
832                         (p->ipv4_ras == 1) || (p->ipv6_ras == 1))
833                         return 1;
834         }
835
836         return 0;
837 }
838
839 static void
840 app_init_link_frag_ras(struct app_params *app)
841 {
842         uint32_t i;
843
844         if (is_any_swq_frag_or_ras(app)) {
845                 for (i = 0; i < app->n_links; i++) {
846                         struct app_link_params *p_link = &app->link_params[i];
847                                 p_link->conf.txmode.offloads |=
848                                                 DEV_TX_OFFLOAD_MULTI_SEGS;
849                 }
850         }
851 }
852
853 static inline int
854 app_get_cpu_socket_id(uint32_t pmd_id)
855 {
856         int status = rte_eth_dev_socket_id(pmd_id);
857
858         return (status != SOCKET_ID_ANY) ? status : 0;
859 }
860
861 static inline int
862 app_link_rss_enabled(struct app_link_params *cp)
863 {
864         return (cp->n_rss_qs) ? 1 : 0;
865 }
866
867 static void
868 app_link_rss_setup(struct app_link_params *cp)
869 {
870         struct rte_eth_dev_info dev_info;
871         struct rte_eth_rss_reta_entry64 reta_conf[APP_RETA_SIZE_MAX];
872         uint32_t i;
873         int status;
874
875     /* Get RETA size */
876         memset(&dev_info, 0, sizeof(dev_info));
877         rte_eth_dev_info_get(cp->pmd_id, &dev_info);
878
879         if (dev_info.reta_size == 0)
880                 rte_panic("%s (%u): RSS setup error (null RETA size)\n",
881                         cp->name, cp->pmd_id);
882
883         if (dev_info.reta_size > ETH_RSS_RETA_SIZE_512)
884                 rte_panic("%s (%u): RSS setup error (RETA size too big)\n",
885                         cp->name, cp->pmd_id);
886
887         /* Setup RETA contents */
888         memset(reta_conf, 0, sizeof(reta_conf));
889
890         for (i = 0; i < dev_info.reta_size; i++)
891                 reta_conf[i / RTE_RETA_GROUP_SIZE].mask = UINT64_MAX;
892
893         for (i = 0; i < dev_info.reta_size; i++) {
894                 uint32_t reta_id = i / RTE_RETA_GROUP_SIZE;
895                 uint32_t reta_pos = i % RTE_RETA_GROUP_SIZE;
896                 uint32_t rss_qs_pos = i % cp->n_rss_qs;
897
898                 reta_conf[reta_id].reta[reta_pos] =
899                         (uint16_t) cp->rss_qs[rss_qs_pos];
900         }
901
902         /* RETA update */
903         status = rte_eth_dev_rss_reta_update(cp->pmd_id,
904                 reta_conf,
905                 dev_info.reta_size);
906         if (status != 0)
907                 rte_panic("%s (%u): RSS setup error (RETA update failed)\n",
908                         cp->name, cp->pmd_id);
909 }
910
911 static void
912 app_init_link_set_config(struct app_link_params *p)
913 {
914         if (p->n_rss_qs) {
915                 p->conf.rxmode.mq_mode = ETH_MQ_RX_RSS;
916                 p->conf.rx_adv_conf.rss_conf.rss_hf = p->rss_proto_ipv4 |
917                         p->rss_proto_ipv6 |
918                         p->rss_proto_l2;
919         }
920 }
921
922 static void
923 app_init_link(struct app_params *app)
924 {
925         uint32_t i;
926
927         app_init_link_frag_ras(app);
928
929         for (i = 0; i < app->n_links; i++) {
930                 struct app_link_params *p_link = &app->link_params[i];
931                 struct rte_eth_dev_info dev_info;
932                 uint32_t link_id, n_hwq_in, n_hwq_out, j;
933                 int status;
934
935                 sscanf(p_link->name, "LINK%" PRIu32, &link_id);
936                 n_hwq_in = app_link_get_n_rxq(app, p_link);
937                 n_hwq_out = app_link_get_n_txq(app, p_link);
938                 app_init_link_set_config(p_link);
939
940                 APP_LOG(app, HIGH, "Initializing %s (%" PRIu32") "
941                         "(%" PRIu32 " RXQ, %" PRIu32 " TXQ) ...",
942                         p_link->name,
943                         p_link->pmd_id,
944                         n_hwq_in,
945                         n_hwq_out);
946
947                 /* LINK */
948                 rte_eth_dev_info_get(p_link->pmd_id, &dev_info);
949                 if (dev_info.tx_offload_capa & DEV_TX_OFFLOAD_MBUF_FAST_FREE)
950                         p_link->conf.txmode.offloads |=
951                                 DEV_TX_OFFLOAD_MBUF_FAST_FREE;
952                 status = rte_eth_dev_configure(
953                         p_link->pmd_id,
954                         n_hwq_in,
955                         n_hwq_out,
956                         &p_link->conf);
957                 if (status < 0)
958                         rte_panic("%s (%" PRId32 "): "
959                                 "init error (%" PRId32 ")\n",
960                                 p_link->name, p_link->pmd_id, status);
961
962                 rte_eth_macaddr_get(p_link->pmd_id,
963                         (struct ether_addr *) &p_link->mac_addr);
964
965                 if (p_link->promisc)
966                         rte_eth_promiscuous_enable(p_link->pmd_id);
967
968                 /* RXQ */
969                 for (j = 0; j < app->n_pktq_hwq_in; j++) {
970                         struct app_pktq_hwq_in_params *p_rxq =
971                                 &app->hwq_in_params[j];
972                         uint32_t rxq_link_id, rxq_queue_id;
973                         uint16_t nb_rxd = p_rxq->size;
974
975                         sscanf(p_rxq->name, "RXQ%" PRIu32 ".%" PRIu32,
976                                 &rxq_link_id, &rxq_queue_id);
977                         if (rxq_link_id != link_id)
978                                 continue;
979
980                         status = rte_eth_dev_adjust_nb_rx_tx_desc(
981                                 p_link->pmd_id,
982                                 &nb_rxd,
983                                 NULL);
984                         if (status < 0)
985                                 rte_panic("%s (%" PRIu32 "): "
986                                         "%s adjust number of Rx descriptors "
987                                         "error (%" PRId32 ")\n",
988                                         p_link->name,
989                                         p_link->pmd_id,
990                                         p_rxq->name,
991                                         status);
992
993                         p_rxq->conf.offloads = p_link->conf.rxmode.offloads;
994                         status = rte_eth_rx_queue_setup(
995                                 p_link->pmd_id,
996                                 rxq_queue_id,
997                                 nb_rxd,
998                                 app_get_cpu_socket_id(p_link->pmd_id),
999                                 &p_rxq->conf,
1000                                 app->mempool[p_rxq->mempool_id]);
1001                         if (status < 0)
1002                                 rte_panic("%s (%" PRIu32 "): "
1003                                         "%s init error (%" PRId32 ")\n",
1004                                         p_link->name,
1005                                         p_link->pmd_id,
1006                                         p_rxq->name,
1007                                         status);
1008                 }
1009
1010                 /* TXQ */
1011                 for (j = 0; j < app->n_pktq_hwq_out; j++) {
1012                         struct app_pktq_hwq_out_params *p_txq =
1013                                 &app->hwq_out_params[j];
1014                         uint32_t txq_link_id, txq_queue_id;
1015                         uint16_t nb_txd = p_txq->size;
1016
1017                         sscanf(p_txq->name, "TXQ%" PRIu32 ".%" PRIu32,
1018                                 &txq_link_id, &txq_queue_id);
1019                         if (txq_link_id != link_id)
1020                                 continue;
1021
1022                         status = rte_eth_dev_adjust_nb_rx_tx_desc(
1023                                 p_link->pmd_id,
1024                                 NULL,
1025                                 &nb_txd);
1026                         if (status < 0)
1027                                 rte_panic("%s (%" PRIu32 "): "
1028                                         "%s adjust number of Tx descriptors "
1029                                         "error (%" PRId32 ")\n",
1030                                         p_link->name,
1031                                         p_link->pmd_id,
1032                                         p_txq->name,
1033                                         status);
1034
1035                         p_txq->conf.offloads = p_link->conf.txmode.offloads;
1036                         status = rte_eth_tx_queue_setup(
1037                                 p_link->pmd_id,
1038                                 txq_queue_id,
1039                                 nb_txd,
1040                                 app_get_cpu_socket_id(p_link->pmd_id),
1041                                 &p_txq->conf);
1042                         if (status < 0)
1043                                 rte_panic("%s (%" PRIu32 "): "
1044                                         "%s init error (%" PRId32 ")\n",
1045                                         p_link->name,
1046                                         p_link->pmd_id,
1047                                         p_txq->name,
1048                                         status);
1049                 }
1050
1051                 /* LINK START */
1052                 status = rte_eth_dev_start(p_link->pmd_id);
1053                 if (status < 0)
1054                         rte_panic("Cannot start %s (error %" PRId32 ")\n",
1055                                 p_link->name, status);
1056
1057                 /* LINK FILTERS */
1058                 app_link_set_arp_filter(app, p_link);
1059                 app_link_set_tcp_syn_filter(app, p_link);
1060                 if (app_link_rss_enabled(p_link))
1061                         app_link_rss_setup(p_link);
1062
1063                 /* LINK UP */
1064                 app_link_up_internal(app, p_link);
1065         }
1066
1067         app_check_link(app);
1068 }
1069
1070 static void
1071 app_init_swq(struct app_params *app)
1072 {
1073         uint32_t i;
1074
1075         for (i = 0; i < app->n_pktq_swq; i++) {
1076                 struct app_pktq_swq_params *p = &app->swq_params[i];
1077                 unsigned flags = 0;
1078
1079                 if (app_swq_get_readers(app, p) == 1)
1080                         flags |= RING_F_SC_DEQ;
1081                 if (app_swq_get_writers(app, p) == 1)
1082                         flags |= RING_F_SP_ENQ;
1083
1084                 APP_LOG(app, HIGH, "Initializing %s...", p->name);
1085                 app->swq[i] = rte_ring_create(
1086                                 p->name,
1087                                 p->size,
1088                                 p->cpu_socket_id,
1089                                 flags);
1090
1091                 if (app->swq[i] == NULL)
1092                         rte_panic("%s init error\n", p->name);
1093         }
1094 }
1095
1096 static void
1097 app_init_tm(struct app_params *app)
1098 {
1099         uint32_t i;
1100
1101         for (i = 0; i < app->n_pktq_tm; i++) {
1102                 struct app_pktq_tm_params *p_tm = &app->tm_params[i];
1103                 struct app_link_params *p_link;
1104                 struct rte_eth_link link_eth_params;
1105                 struct rte_sched_port *sched;
1106                 uint32_t n_subports, subport_id;
1107                 int status;
1108
1109                 p_link = app_get_link_for_tm(app, p_tm);
1110                 /* LINK */
1111                 rte_eth_link_get(p_link->pmd_id, &link_eth_params);
1112
1113                 /* TM */
1114                 p_tm->sched_port_params.name = p_tm->name;
1115                 p_tm->sched_port_params.socket =
1116                         app_get_cpu_socket_id(p_link->pmd_id);
1117                 p_tm->sched_port_params.rate =
1118                         (uint64_t) link_eth_params.link_speed * 1000 * 1000 / 8;
1119
1120                 APP_LOG(app, HIGH, "Initializing %s ...", p_tm->name);
1121                 sched = rte_sched_port_config(&p_tm->sched_port_params);
1122                 if (sched == NULL)
1123                         rte_panic("%s init error\n", p_tm->name);
1124                 app->tm[i] = sched;
1125
1126                 /* Subport */
1127                 n_subports = p_tm->sched_port_params.n_subports_per_port;
1128                 for (subport_id = 0; subport_id < n_subports; subport_id++) {
1129                         uint32_t n_pipes_per_subport, pipe_id;
1130
1131                         status = rte_sched_subport_config(sched,
1132                                 subport_id,
1133                                 &p_tm->sched_subport_params[subport_id]);
1134                         if (status)
1135                                 rte_panic("%s subport %" PRIu32
1136                                         " init error (%" PRId32 ")\n",
1137                                         p_tm->name, subport_id, status);
1138
1139                         /* Pipe */
1140                         n_pipes_per_subport =
1141                                 p_tm->sched_port_params.n_pipes_per_subport;
1142                         for (pipe_id = 0;
1143                                 pipe_id < n_pipes_per_subport;
1144                                 pipe_id++) {
1145                                 int profile_id = p_tm->sched_pipe_to_profile[
1146                                         subport_id * APP_MAX_SCHED_PIPES +
1147                                         pipe_id];
1148
1149                                 if (profile_id == -1)
1150                                         continue;
1151
1152                                 status = rte_sched_pipe_config(sched,
1153                                         subport_id,
1154                                         pipe_id,
1155                                         profile_id);
1156                                 if (status)
1157                                         rte_panic("%s subport %" PRIu32
1158                                                 " pipe %" PRIu32
1159                                                 " (profile %" PRId32 ") "
1160                                                 "init error (% " PRId32 ")\n",
1161                                                 p_tm->name, subport_id, pipe_id,
1162                                                 profile_id, status);
1163                         }
1164                 }
1165         }
1166 }
1167
1168 #ifndef RTE_EXEC_ENV_LINUXAPP
1169 static void
1170 app_init_tap(struct app_params *app) {
1171         if (app->n_pktq_tap == 0)
1172                 return;
1173
1174         rte_panic("TAP device not supported.\n");
1175 }
1176 #else
1177 static void
1178 app_init_tap(struct app_params *app)
1179 {
1180         uint32_t i;
1181
1182         for (i = 0; i < app->n_pktq_tap; i++) {
1183                 struct app_pktq_tap_params *p_tap = &app->tap_params[i];
1184                 struct ifreq ifr;
1185                 int fd, status;
1186
1187                 APP_LOG(app, HIGH, "Initializing %s ...", p_tap->name);
1188
1189                 fd = open("/dev/net/tun", O_RDWR | O_NONBLOCK);
1190                 if (fd < 0)
1191                         rte_panic("Cannot open file /dev/net/tun\n");
1192
1193                 memset(&ifr, 0, sizeof(ifr));
1194                 ifr.ifr_flags = IFF_TAP | IFF_NO_PI; /* No packet information */
1195                 snprintf(ifr.ifr_name, IFNAMSIZ, "%s", p_tap->name);
1196
1197                 status = ioctl(fd, TUNSETIFF, (void *) &ifr);
1198                 if (status < 0)
1199                         rte_panic("TAP setup error\n");
1200
1201                 app->tap[i] = fd;
1202         }
1203 }
1204 #endif
1205
1206 #ifdef RTE_LIBRTE_KNI
1207 static int
1208 kni_config_network_interface(uint16_t port_id, uint8_t if_up) {
1209         int ret = 0;
1210
1211         if (port_id >= rte_eth_dev_count())
1212                 return -EINVAL;
1213
1214         ret = (if_up) ?
1215                 rte_eth_dev_set_link_up(port_id) :
1216                 rte_eth_dev_set_link_down(port_id);
1217
1218         return ret;
1219 }
1220
1221 static int
1222 kni_change_mtu(uint16_t port_id, unsigned int new_mtu) {
1223         int ret;
1224
1225         if (port_id >= rte_eth_dev_count())
1226                 return -EINVAL;
1227
1228         if (new_mtu > ETHER_MAX_LEN)
1229                 return -EINVAL;
1230
1231         /* Set new MTU */
1232         ret = rte_eth_dev_set_mtu(port_id, new_mtu);
1233         if (ret < 0)
1234                 return ret;
1235
1236         return 0;
1237 }
1238 #endif /* RTE_LIBRTE_KNI */
1239
1240 #ifndef RTE_LIBRTE_KNI
1241 static void
1242 app_init_kni(struct app_params *app) {
1243         if (app->n_pktq_kni == 0)
1244                 return;
1245
1246         rte_panic("Can not init KNI without librte_kni support.\n");
1247 }
1248 #else
1249 static void
1250 app_init_kni(struct app_params *app) {
1251         uint32_t i;
1252
1253         if (app->n_pktq_kni == 0)
1254                 return;
1255
1256         rte_kni_init(app->n_pktq_kni);
1257
1258         for (i = 0; i < app->n_pktq_kni; i++) {
1259                 struct app_pktq_kni_params *p_kni = &app->kni_params[i];
1260                 struct app_link_params *p_link;
1261                 struct rte_eth_dev_info dev_info;
1262                 struct app_mempool_params *mempool_params;
1263                 struct rte_mempool *mempool;
1264                 struct rte_kni_conf conf;
1265                 struct rte_kni_ops ops;
1266
1267                 /* LINK */
1268                 p_link = app_get_link_for_kni(app, p_kni);
1269                 memset(&dev_info, 0, sizeof(dev_info));
1270                 rte_eth_dev_info_get(p_link->pmd_id, &dev_info);
1271
1272                 /* MEMPOOL */
1273                 mempool_params = &app->mempool_params[p_kni->mempool_id];
1274                 mempool = app->mempool[p_kni->mempool_id];
1275
1276                 /* KNI */
1277                 memset(&conf, 0, sizeof(conf));
1278                 snprintf(conf.name, RTE_KNI_NAMESIZE, "%s", p_kni->name);
1279                 conf.force_bind = p_kni->force_bind;
1280                 if (conf.force_bind) {
1281                         int lcore_id;
1282
1283                         lcore_id = cpu_core_map_get_lcore_id(app->core_map,
1284                                 p_kni->socket_id,
1285                                 p_kni->core_id,
1286                                 p_kni->hyper_th_id);
1287
1288                         if (lcore_id < 0)
1289                                 rte_panic("%s invalid CPU core\n", p_kni->name);
1290
1291                         conf.core_id = (uint32_t) lcore_id;
1292                 }
1293                 conf.group_id = p_link->pmd_id;
1294                 conf.mbuf_size = mempool_params->buffer_size;
1295                 conf.addr = dev_info.pci_dev->addr;
1296                 conf.id = dev_info.pci_dev->id;
1297
1298                 memset(&ops, 0, sizeof(ops));
1299                 ops.port_id = (uint8_t) p_link->pmd_id;
1300                 ops.change_mtu = kni_change_mtu;
1301                 ops.config_network_if = kni_config_network_interface;
1302
1303                 APP_LOG(app, HIGH, "Initializing %s ...", p_kni->name);
1304                 app->kni[i] = rte_kni_alloc(mempool, &conf, &ops);
1305                 if (!app->kni[i])
1306                         rte_panic("%s init error\n", p_kni->name);
1307         }
1308 }
1309 #endif /* RTE_LIBRTE_KNI */
1310
1311 static void
1312 app_init_msgq(struct app_params *app)
1313 {
1314         uint32_t i;
1315
1316         for (i = 0; i < app->n_msgq; i++) {
1317                 struct app_msgq_params *p = &app->msgq_params[i];
1318
1319                 APP_LOG(app, HIGH, "Initializing %s ...", p->name);
1320                 app->msgq[i] = rte_ring_create(
1321                                 p->name,
1322                                 p->size,
1323                                 p->cpu_socket_id,
1324                                 RING_F_SP_ENQ | RING_F_SC_DEQ);
1325
1326                 if (app->msgq[i] == NULL)
1327                         rte_panic("%s init error\n", p->name);
1328         }
1329 }
1330
1331 void app_pipeline_params_get(struct app_params *app,
1332         struct app_pipeline_params *p_in,
1333         struct pipeline_params *p_out)
1334 {
1335         uint32_t i;
1336
1337         snprintf(p_out->name, PIPELINE_NAME_SIZE, "%s", p_in->name);
1338
1339         snprintf(p_out->type, PIPELINE_TYPE_SIZE, "%s", p_in->type);
1340
1341         p_out->socket_id = (int) p_in->socket_id;
1342
1343         p_out->log_level = app->log_level;
1344
1345         /* pktq_in */
1346         p_out->n_ports_in = p_in->n_pktq_in;
1347         for (i = 0; i < p_in->n_pktq_in; i++) {
1348                 struct app_pktq_in_params *in = &p_in->pktq_in[i];
1349                 struct pipeline_port_in_params *out = &p_out->port_in[i];
1350
1351                 switch (in->type) {
1352                 case APP_PKTQ_IN_HWQ:
1353                 {
1354                         struct app_pktq_hwq_in_params *p_hwq_in =
1355                                 &app->hwq_in_params[in->id];
1356                         struct app_link_params *p_link =
1357                                 app_get_link_for_rxq(app, p_hwq_in);
1358                         uint32_t rxq_link_id, rxq_queue_id;
1359
1360                         sscanf(p_hwq_in->name, "RXQ%" SCNu32 ".%" SCNu32,
1361                                 &rxq_link_id,
1362                                 &rxq_queue_id);
1363
1364                         out->type = PIPELINE_PORT_IN_ETHDEV_READER;
1365                         out->params.ethdev.port_id = p_link->pmd_id;
1366                         out->params.ethdev.queue_id = rxq_queue_id;
1367                         out->burst_size = p_hwq_in->burst;
1368                         break;
1369                 }
1370                 case APP_PKTQ_IN_SWQ:
1371                 {
1372                         struct app_pktq_swq_params *swq_params = &app->swq_params[in->id];
1373
1374                         if ((swq_params->ipv4_frag == 0) && (swq_params->ipv6_frag == 0)) {
1375                                 if (app_swq_get_readers(app, swq_params) == 1) {
1376                                         out->type = PIPELINE_PORT_IN_RING_READER;
1377                                         out->params.ring.ring = app->swq[in->id];
1378                                         out->burst_size = app->swq_params[in->id].burst_read;
1379                                 } else {
1380                                         out->type = PIPELINE_PORT_IN_RING_MULTI_READER;
1381                                         out->params.ring_multi.ring = app->swq[in->id];
1382                                         out->burst_size = swq_params->burst_read;
1383                                 }
1384                         } else {
1385                                 if (swq_params->ipv4_frag == 1) {
1386                                         struct rte_port_ring_reader_ipv4_frag_params *params =
1387                                                 &out->params.ring_ipv4_frag;
1388
1389                                         out->type = PIPELINE_PORT_IN_RING_READER_IPV4_FRAG;
1390                                         params->ring = app->swq[in->id];
1391                                         params->mtu = swq_params->mtu;
1392                                         params->metadata_size = swq_params->metadata_size;
1393                                         params->pool_direct =
1394                                                 app->mempool[swq_params->mempool_direct_id];
1395                                         params->pool_indirect =
1396                                                 app->mempool[swq_params->mempool_indirect_id];
1397                                         out->burst_size = swq_params->burst_read;
1398                                 } else {
1399                                         struct rte_port_ring_reader_ipv6_frag_params *params =
1400                                                 &out->params.ring_ipv6_frag;
1401
1402                                         out->type = PIPELINE_PORT_IN_RING_READER_IPV6_FRAG;
1403                                         params->ring = app->swq[in->id];
1404                                         params->mtu = swq_params->mtu;
1405                                         params->metadata_size = swq_params->metadata_size;
1406                                         params->pool_direct =
1407                                                 app->mempool[swq_params->mempool_direct_id];
1408                                         params->pool_indirect =
1409                                                 app->mempool[swq_params->mempool_indirect_id];
1410                                         out->burst_size = swq_params->burst_read;
1411                                 }
1412                         }
1413                         break;
1414                 }
1415                 case APP_PKTQ_IN_TM:
1416                 {
1417                         out->type = PIPELINE_PORT_IN_SCHED_READER;
1418                         out->params.sched.sched = app->tm[in->id];
1419                         out->burst_size = app->tm_params[in->id].burst_read;
1420                         break;
1421                 }
1422 #ifdef RTE_EXEC_ENV_LINUXAPP
1423                 case APP_PKTQ_IN_TAP:
1424                 {
1425                         struct app_pktq_tap_params *tap_params =
1426                                 &app->tap_params[in->id];
1427                         struct app_mempool_params *mempool_params =
1428                                 &app->mempool_params[tap_params->mempool_id];
1429                         struct rte_mempool *mempool =
1430                                 app->mempool[tap_params->mempool_id];
1431
1432                         out->type = PIPELINE_PORT_IN_FD_READER;
1433                         out->params.fd.fd = app->tap[in->id];
1434                         out->params.fd.mtu = mempool_params->buffer_size;
1435                         out->params.fd.mempool = mempool;
1436                         out->burst_size = app->tap_params[in->id].burst_read;
1437                         break;
1438                 }
1439 #endif
1440 #ifdef RTE_LIBRTE_KNI
1441                 case APP_PKTQ_IN_KNI:
1442                 {
1443                         out->type = PIPELINE_PORT_IN_KNI_READER;
1444                         out->params.kni.kni = app->kni[in->id];
1445                         out->burst_size = app->kni_params[in->id].burst_read;
1446                         break;
1447                 }
1448 #endif /* RTE_LIBRTE_KNI */
1449                 case APP_PKTQ_IN_SOURCE:
1450                 {
1451                         uint32_t mempool_id =
1452                                 app->source_params[in->id].mempool_id;
1453
1454                         out->type = PIPELINE_PORT_IN_SOURCE;
1455                         out->params.source.mempool = app->mempool[mempool_id];
1456                         out->burst_size = app->source_params[in->id].burst;
1457                         out->params.source.file_name =
1458                                 app->source_params[in->id].file_name;
1459                         out->params.source.n_bytes_per_pkt =
1460                                 app->source_params[in->id].n_bytes_per_pkt;
1461                         break;
1462                 }
1463                 default:
1464                         break;
1465                 }
1466         }
1467
1468         /* pktq_out */
1469         p_out->n_ports_out = p_in->n_pktq_out;
1470         for (i = 0; i < p_in->n_pktq_out; i++) {
1471                 struct app_pktq_out_params *in = &p_in->pktq_out[i];
1472                 struct pipeline_port_out_params *out = &p_out->port_out[i];
1473
1474                 switch (in->type) {
1475                 case APP_PKTQ_OUT_HWQ:
1476                 {
1477                         struct app_pktq_hwq_out_params *p_hwq_out =
1478                                 &app->hwq_out_params[in->id];
1479                         struct app_link_params *p_link =
1480                                 app_get_link_for_txq(app, p_hwq_out);
1481                         uint32_t txq_link_id, txq_queue_id;
1482
1483                         sscanf(p_hwq_out->name,
1484                                 "TXQ%" SCNu32 ".%" SCNu32,
1485                                 &txq_link_id,
1486                                 &txq_queue_id);
1487
1488                         if (p_hwq_out->dropless == 0) {
1489                                 struct rte_port_ethdev_writer_params *params =
1490                                         &out->params.ethdev;
1491
1492                                 out->type = PIPELINE_PORT_OUT_ETHDEV_WRITER;
1493                                 params->port_id = p_link->pmd_id;
1494                                 params->queue_id = txq_queue_id;
1495                                 params->tx_burst_sz =
1496                                         app->hwq_out_params[in->id].burst;
1497                         } else {
1498                                 struct rte_port_ethdev_writer_nodrop_params
1499                                         *params = &out->params.ethdev_nodrop;
1500
1501                                 out->type =
1502                                         PIPELINE_PORT_OUT_ETHDEV_WRITER_NODROP;
1503                                 params->port_id = p_link->pmd_id;
1504                                 params->queue_id = txq_queue_id;
1505                                 params->tx_burst_sz = p_hwq_out->burst;
1506                                 params->n_retries = p_hwq_out->n_retries;
1507                         }
1508                         break;
1509                 }
1510                 case APP_PKTQ_OUT_SWQ:
1511                 {
1512                         struct app_pktq_swq_params *swq_params = &app->swq_params[in->id];
1513
1514                         if ((swq_params->ipv4_ras == 0) && (swq_params->ipv6_ras == 0)) {
1515                                 if (app_swq_get_writers(app, swq_params) == 1) {
1516                                         if (app->swq_params[in->id].dropless == 0) {
1517                                                 struct rte_port_ring_writer_params *params =
1518                                                         &out->params.ring;
1519
1520                                                 out->type = PIPELINE_PORT_OUT_RING_WRITER;
1521                                                 params->ring = app->swq[in->id];
1522                                                 params->tx_burst_sz =
1523                                                         app->swq_params[in->id].burst_write;
1524                                         } else {
1525                                                 struct rte_port_ring_writer_nodrop_params
1526                                                         *params = &out->params.ring_nodrop;
1527
1528                                                 out->type =
1529                                                         PIPELINE_PORT_OUT_RING_WRITER_NODROP;
1530                                                 params->ring = app->swq[in->id];
1531                                                 params->tx_burst_sz =
1532                                                         app->swq_params[in->id].burst_write;
1533                                                 params->n_retries =
1534                                                         app->swq_params[in->id].n_retries;
1535                                         }
1536                                 } else {
1537                                         if (swq_params->dropless == 0) {
1538                                                 struct rte_port_ring_multi_writer_params *params =
1539                                                         &out->params.ring_multi;
1540
1541                                                 out->type = PIPELINE_PORT_OUT_RING_MULTI_WRITER;
1542                                                 params->ring = app->swq[in->id];
1543                                                 params->tx_burst_sz = swq_params->burst_write;
1544                                         } else {
1545                                                 struct rte_port_ring_multi_writer_nodrop_params
1546                                                         *params = &out->params.ring_multi_nodrop;
1547
1548                                                 out->type = PIPELINE_PORT_OUT_RING_MULTI_WRITER_NODROP;
1549                                                 params->ring = app->swq[in->id];
1550                                                 params->tx_burst_sz = swq_params->burst_write;
1551                                                 params->n_retries = swq_params->n_retries;
1552                                         }
1553                                 }
1554                         } else {
1555                                 if (swq_params->ipv4_ras == 1) {
1556                                         struct rte_port_ring_writer_ipv4_ras_params *params =
1557                                                 &out->params.ring_ipv4_ras;
1558
1559                                         out->type = PIPELINE_PORT_OUT_RING_WRITER_IPV4_RAS;
1560                                         params->ring = app->swq[in->id];
1561                                         params->tx_burst_sz = swq_params->burst_write;
1562                                 } else {
1563                                         struct rte_port_ring_writer_ipv6_ras_params *params =
1564                                                 &out->params.ring_ipv6_ras;
1565
1566                                         out->type = PIPELINE_PORT_OUT_RING_WRITER_IPV6_RAS;
1567                                         params->ring = app->swq[in->id];
1568                                         params->tx_burst_sz = swq_params->burst_write;
1569                                 }
1570                         }
1571                         break;
1572                 }
1573                 case APP_PKTQ_OUT_TM:
1574                 {
1575                         struct rte_port_sched_writer_params *params =
1576                                 &out->params.sched;
1577
1578                         out->type = PIPELINE_PORT_OUT_SCHED_WRITER;
1579                         params->sched = app->tm[in->id];
1580                         params->tx_burst_sz =
1581                                 app->tm_params[in->id].burst_write;
1582                         break;
1583                 }
1584 #ifdef RTE_EXEC_ENV_LINUXAPP
1585                 case APP_PKTQ_OUT_TAP:
1586                 {
1587                         struct rte_port_fd_writer_params *params =
1588                                 &out->params.fd;
1589
1590                         out->type = PIPELINE_PORT_OUT_FD_WRITER;
1591                         params->fd = app->tap[in->id];
1592                         params->tx_burst_sz =
1593                                 app->tap_params[in->id].burst_write;
1594                         break;
1595                 }
1596 #endif
1597 #ifdef RTE_LIBRTE_KNI
1598                 case APP_PKTQ_OUT_KNI:
1599                 {
1600                         struct app_pktq_kni_params *p_kni =
1601                                 &app->kni_params[in->id];
1602
1603                         if (p_kni->dropless == 0) {
1604                                 struct rte_port_kni_writer_params *params =
1605                                         &out->params.kni;
1606
1607                                 out->type = PIPELINE_PORT_OUT_KNI_WRITER;
1608                                 params->kni = app->kni[in->id];
1609                                 params->tx_burst_sz =
1610                                         app->kni_params[in->id].burst_write;
1611                         } else {
1612                                 struct rte_port_kni_writer_nodrop_params
1613                                         *params = &out->params.kni_nodrop;
1614
1615                                 out->type = PIPELINE_PORT_OUT_KNI_WRITER_NODROP;
1616                                 params->kni = app->kni[in->id];
1617                                 params->tx_burst_sz =
1618                                         app->kni_params[in->id].burst_write;
1619                                 params->n_retries =
1620                                         app->kni_params[in->id].n_retries;
1621                         }
1622                         break;
1623                 }
1624 #endif /* RTE_LIBRTE_KNI */
1625                 case APP_PKTQ_OUT_SINK:
1626                 {
1627                         out->type = PIPELINE_PORT_OUT_SINK;
1628                         out->params.sink.file_name =
1629                                 app->sink_params[in->id].file_name;
1630                         out->params.sink.max_n_pkts =
1631                                 app->sink_params[in->id].
1632                                 n_pkts_to_dump;
1633
1634                         break;
1635                 }
1636                 default:
1637                         break;
1638                 }
1639         }
1640
1641         /* msgq */
1642         p_out->n_msgq = p_in->n_msgq_in;
1643
1644         for (i = 0; i < p_in->n_msgq_in; i++)
1645                 p_out->msgq_in[i] = app->msgq[p_in->msgq_in[i]];
1646
1647         for (i = 0; i < p_in->n_msgq_out; i++)
1648                 p_out->msgq_out[i] = app->msgq[p_in->msgq_out[i]];
1649
1650         /* args */
1651         p_out->n_args = p_in->n_args;
1652         for (i = 0; i < p_in->n_args; i++) {
1653                 p_out->args_name[i] = p_in->args_name[i];
1654                 p_out->args_value[i] = p_in->args_value[i];
1655         }
1656 }
1657
1658 static void
1659 app_init_pipelines(struct app_params *app)
1660 {
1661         uint32_t p_id;
1662
1663         for (p_id = 0; p_id < app->n_pipelines; p_id++) {
1664                 struct app_pipeline_params *params =
1665                         &app->pipeline_params[p_id];
1666                 struct app_pipeline_data *data = &app->pipeline_data[p_id];
1667                 struct pipeline_type *ptype;
1668                 struct pipeline_params pp;
1669
1670                 APP_LOG(app, HIGH, "Initializing %s ...", params->name);
1671
1672                 ptype = app_pipeline_type_find(app, params->type);
1673                 if (ptype == NULL)
1674                         rte_panic("Init error: Unknown pipeline type \"%s\"\n",
1675                                 params->type);
1676
1677                 app_pipeline_params_get(app, params, &pp);
1678
1679                 /* Back-end */
1680                 data->be = NULL;
1681                 if (ptype->be_ops->f_init) {
1682                         data->be = ptype->be_ops->f_init(&pp, (void *) app);
1683
1684                         if (data->be == NULL)
1685                                 rte_panic("Pipeline instance \"%s\" back-end "
1686                                         "init error\n", params->name);
1687                 }
1688
1689                 /* Front-end */
1690                 data->fe = NULL;
1691                 if (ptype->fe_ops->f_init) {
1692                         data->fe = ptype->fe_ops->f_init(&pp, (void *) app);
1693
1694                         if (data->fe == NULL)
1695                                 rte_panic("Pipeline instance \"%s\" front-end "
1696                                 "init error\n", params->name);
1697                 }
1698
1699                 data->ptype = ptype;
1700
1701                 data->timer_period = (rte_get_tsc_hz() *
1702                         params->timer_period) / 1000;
1703         }
1704 }
1705
1706 static void
1707 app_post_init_pipelines(struct app_params *app)
1708 {
1709         uint32_t p_id;
1710
1711         for (p_id = 0; p_id < app->n_pipelines; p_id++) {
1712                 struct app_pipeline_params *params =
1713                         &app->pipeline_params[p_id];
1714                 struct app_pipeline_data *data = &app->pipeline_data[p_id];
1715                 int status;
1716
1717                 if (data->ptype->fe_ops->f_post_init == NULL)
1718                         continue;
1719
1720                 status = data->ptype->fe_ops->f_post_init(data->fe);
1721                 if (status)
1722                         rte_panic("Pipeline instance \"%s\" front-end "
1723                                 "post-init error\n", params->name);
1724         }
1725 }
1726
1727 static void
1728 app_init_threads(struct app_params *app)
1729 {
1730         uint64_t time = rte_get_tsc_cycles();
1731         uint32_t p_id;
1732
1733         for (p_id = 0; p_id < app->n_pipelines; p_id++) {
1734                 struct app_pipeline_params *params =
1735                         &app->pipeline_params[p_id];
1736                 struct app_pipeline_data *data = &app->pipeline_data[p_id];
1737                 struct pipeline_type *ptype;
1738                 struct app_thread_data *t;
1739                 struct app_thread_pipeline_data *p;
1740                 int lcore_id;
1741
1742                 lcore_id = cpu_core_map_get_lcore_id(app->core_map,
1743                         params->socket_id,
1744                         params->core_id,
1745                         params->hyper_th_id);
1746
1747                 if (lcore_id < 0)
1748                         rte_panic("Invalid core s%" PRIu32 "c%" PRIu32 "%s\n",
1749                                 params->socket_id,
1750                                 params->core_id,
1751                                 (params->hyper_th_id) ? "h" : "");
1752
1753                 t = &app->thread_data[lcore_id];
1754
1755                 t->timer_period = (rte_get_tsc_hz() * APP_THREAD_TIMER_PERIOD) / 1000;
1756                 t->thread_req_deadline = time + t->timer_period;
1757
1758                 t->headroom_cycles = 0;
1759                 t->headroom_time = rte_get_tsc_cycles();
1760                 t->headroom_ratio = 0.0;
1761
1762                 t->msgq_in = app_thread_msgq_in_get(app,
1763                                 params->socket_id,
1764                                 params->core_id,
1765                                 params->hyper_th_id);
1766                 if (t->msgq_in == NULL)
1767                         rte_panic("Init error: Cannot find MSGQ_IN for thread %" PRId32,
1768                                 lcore_id);
1769
1770                 t->msgq_out = app_thread_msgq_out_get(app,
1771                                 params->socket_id,
1772                                 params->core_id,
1773                                 params->hyper_th_id);
1774                 if (t->msgq_out == NULL)
1775                         rte_panic("Init error: Cannot find MSGQ_OUT for thread %" PRId32,
1776                                 lcore_id);
1777
1778                 ptype = app_pipeline_type_find(app, params->type);
1779                 if (ptype == NULL)
1780                         rte_panic("Init error: Unknown pipeline "
1781                                 "type \"%s\"\n", params->type);
1782
1783                 p = (ptype->be_ops->f_run == NULL) ?
1784                         &t->regular[t->n_regular] :
1785                         &t->custom[t->n_custom];
1786
1787                 p->pipeline_id = p_id;
1788                 p->be = data->be;
1789                 p->f_run = ptype->be_ops->f_run;
1790                 p->f_timer = ptype->be_ops->f_timer;
1791                 p->timer_period = data->timer_period;
1792                 p->deadline = time + data->timer_period;
1793
1794                 data->enabled = 1;
1795
1796                 if (ptype->be_ops->f_run == NULL)
1797                         t->n_regular++;
1798                 else
1799                         t->n_custom++;
1800         }
1801 }
1802
1803 int app_init(struct app_params *app)
1804 {
1805         app_init_core_map(app);
1806         app_init_core_mask(app);
1807
1808         app_init_eal(app);
1809         app_init_mempool(app);
1810         app_init_link(app);
1811         app_init_swq(app);
1812         app_init_tm(app);
1813         app_init_tap(app);
1814         app_init_kni(app);
1815         app_init_msgq(app);
1816
1817         app_pipeline_common_cmd_push(app);
1818         app_pipeline_thread_cmd_push(app);
1819         app_pipeline_type_register(app, &pipeline_master);
1820
1821         app_init_pipelines(app);
1822         app_init_threads(app);
1823
1824         return 0;
1825 }
1826
1827 int app_post_init(struct app_params *app)
1828 {
1829         app_post_init_pipelines(app);
1830
1831         return 0;
1832 }
1833
1834 static int
1835 app_pipeline_type_cmd_push(struct app_params *app,
1836         struct pipeline_type *ptype)
1837 {
1838         cmdline_parse_ctx_t *cmds;
1839         uint32_t n_cmds, i;
1840
1841         /* Check input arguments */
1842         if ((app == NULL) ||
1843                 (ptype == NULL))
1844                 return -EINVAL;
1845
1846         n_cmds = pipeline_type_cmds_count(ptype);
1847         if (n_cmds == 0)
1848                 return 0;
1849
1850         cmds = ptype->fe_ops->cmds;
1851
1852         /* Check for available slots in the application commands array */
1853         if (n_cmds > APP_MAX_CMDS - app->n_cmds)
1854                 return -ENOMEM;
1855
1856         /* Push pipeline commands into the application */
1857         memcpy(&app->cmds[app->n_cmds],
1858                 cmds,
1859                 n_cmds * sizeof(cmdline_parse_ctx_t));
1860
1861         for (i = 0; i < n_cmds; i++)
1862                 app->cmds[app->n_cmds + i]->data = app;
1863
1864         app->n_cmds += n_cmds;
1865         app->cmds[app->n_cmds] = NULL;
1866
1867         return 0;
1868 }
1869
1870 int
1871 app_pipeline_type_register(struct app_params *app, struct pipeline_type *ptype)
1872 {
1873         uint32_t n_cmds, i;
1874
1875         /* Check input arguments */
1876         if ((app == NULL) ||
1877                 (ptype == NULL) ||
1878                 (ptype->name == NULL) ||
1879                 (strlen(ptype->name) == 0) ||
1880                 (ptype->be_ops->f_init == NULL) ||
1881                 (ptype->be_ops->f_timer == NULL))
1882                 return -EINVAL;
1883
1884         /* Check for duplicate entry */
1885         for (i = 0; i < app->n_pipeline_types; i++)
1886                 if (strcmp(app->pipeline_type[i].name, ptype->name) == 0)
1887                         return -EEXIST;
1888
1889         /* Check for resource availability */
1890         n_cmds = pipeline_type_cmds_count(ptype);
1891         if ((app->n_pipeline_types == APP_MAX_PIPELINE_TYPES) ||
1892                 (n_cmds > APP_MAX_CMDS - app->n_cmds))
1893                 return -ENOMEM;
1894
1895         /* Copy pipeline type */
1896         memcpy(&app->pipeline_type[app->n_pipeline_types++],
1897                 ptype,
1898                 sizeof(struct pipeline_type));
1899
1900         /* Copy CLI commands */
1901         if (n_cmds)
1902                 app_pipeline_type_cmd_push(app, ptype);
1903
1904         return 0;
1905 }
1906
1907 struct
1908 pipeline_type *app_pipeline_type_find(struct app_params *app, char *name)
1909 {
1910         uint32_t i;
1911
1912         for (i = 0; i < app->n_pipeline_types; i++)
1913                 if (strcmp(app->pipeline_type[i].name, name) == 0)
1914                         return &app->pipeline_type[i];
1915
1916         return NULL;
1917 }