9f0be145b311cf91f1ff583b592154ea69c4246d
[samplevnf.git] / VNFs / DPPD-PROX / commands.c
1 /*
2 // Copyright (c) 2010-2017 Intel Corporation
3 //
4 // Licensed under the Apache License, Version 2.0 (the "License");
5 // you may not use this file except in compliance with the License.
6 // You may obtain a copy of the License at
7 //
8 //     http://www.apache.org/licenses/LICENSE-2.0
9 //
10 // Unless required by applicable law or agreed to in writing, software
11 // distributed under the License is distributed on an "AS IS" BASIS,
12 // WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
13 // See the License for the specific language governing permissions and
14 // limitations under the License.
15 */
16
17 #include <string.h>
18 #include <rte_table_hash.h>
19 #include <rte_version.h>
20 #include <rte_malloc.h>
21
22 #include "prox_malloc.h"
23 #include "display.h"
24 #include "commands.h"
25 #include "log.h"
26 #include "run.h"
27 #include "lconf.h"
28 #include "hash_utils.h"
29 #include "prox_cfg.h"
30 #include "prox_port_cfg.h"
31 #include "defines.h"
32 #include "handle_qos.h"
33 #include "handle_qinq_encap4.h"
34 #include "quit.h"
35 #include "input.h"
36 #include "rw_reg.h"
37 #include "cqm.h"
38 #include "stats_core.h"
39
40 void start_core_all(int task_id)
41 {
42         uint32_t cores[RTE_MAX_LCORE];
43         uint32_t lcore_id;
44         char tmp[256];
45         int cnt = 0;
46
47         prox_core_to_str(tmp, sizeof(tmp), 0);
48         plog_info("Starting cores: %s\n", tmp);
49
50         lcore_id = -1;
51         while (prox_core_next(&lcore_id, 0) == 0) {
52                 cores[cnt++] = lcore_id;
53         }
54         start_cores(cores, cnt, task_id);
55 }
56
57 void stop_core_all(int task_id)
58 {
59         uint32_t cores[RTE_MAX_LCORE];
60         uint32_t lcore_id;
61         char tmp[256];
62         int cnt = 0;
63
64         prox_core_to_str(tmp, sizeof(tmp), 0);
65         plog_info("Stopping cores: %s\n", tmp);
66
67         lcore_id = -1;
68         while (prox_core_next(&lcore_id, 0) == 0) {
69                 cores[cnt++] = lcore_id;
70         }
71
72         stop_cores(cores, cnt, task_id);
73 }
74
75 static void warn_inactive_cores(uint32_t *cores, int count, const char *prefix)
76 {
77         for (int i = 0; i < count; ++i) {
78                 if (!prox_core_active(cores[i], 0)) {
79                         plog_warn("%s %u: core is not active\n", prefix, cores[i]);
80                 }
81         }
82 }
83
84 static inline int wait_command_handled(struct lcore_cfg *lconf)
85 {
86         uint64_t t1 = rte_rdtsc(), t2;
87         int max_time = 5;
88
89         if (lconf->msg.type == LCONF_MSG_STOP)
90                 max_time = 30;
91
92         while (lconf_is_req(lconf)) {
93                 t2 = rte_rdtsc();
94                 if (t2 - t1 > max_time * rte_get_tsc_hz()) {
95                         // Failed to handle command ...
96                         for (uint8_t task_id = 0; task_id < lconf->n_tasks_all; ++task_id) {
97                                 struct task_args *targs = &lconf->targs[task_id];
98                                 if (!(targs->flags & TASK_ARG_DROP)) {
99                                         plogx_err("Failed to handle command - task is in NO_DROP and might be stuck...\n");
100                                         return - 1;
101                                 }
102                         }
103                         plogx_err("Failed to handle command\n");
104                         return -1;
105                 }
106         }
107         return 0;
108 }
109
110 static inline void start_l3(struct task_args *targ)
111 {
112         if (!task_is_master(targ)) {
113                 if ((targ->nb_txrings != 0) || (targ->nb_txports != 0)) {
114                         if (targ->flags & TASK_ARG_L3)
115                                 task_start_l3(targ->tbase, targ);
116                 }
117         }
118 }
119
120 void start_cores(uint32_t *cores, int count, int task_id)
121 {
122         int n_started_cores = 0;
123         uint32_t started_cores[RTE_MAX_LCORE];
124         struct task_args *targ;
125
126         warn_inactive_cores(cores, count, "Can't start core");
127
128         for (int i = 0; i < count; ++i) {
129                 struct lcore_cfg *lconf = &lcore_cfg[cores[i]];
130
131                 if (lconf->n_tasks_run != lconf->n_tasks_all) {
132                         if (task_id == -1) {
133                                 for (uint8_t tid = 0; tid < lconf->n_tasks_all; ++tid) {
134                                         targ = &lconf->targs[tid];
135                                         start_l3(targ);
136                                 }
137                         } else {
138                                 targ = &lconf->targs[task_id];
139                                 start_l3(targ);
140                         }
141                         lconf->msg.type = LCONF_MSG_START;
142                         lconf->msg.task_id = task_id;
143                         lconf_set_req(lconf);
144                         if (task_id == -1)
145                                 plog_info("Starting core %u (all tasks)\n", cores[i]);
146                         else
147                                 plog_info("Starting core %u task %u\n", cores[i], task_id);
148                         started_cores[n_started_cores++] = cores[i];
149                         lconf->flags |= LCONF_FLAG_RUNNING;
150                         rte_eal_remote_launch(lconf_run, NULL, cores[i]);
151                 }
152                 else {
153                         plog_warn("Core %u is already running all its tasks\n", cores[i]);
154                 }
155         }
156
157         /* This function is blocking, so detect when each core has
158            consumed the message. */
159         for (int i = 0; i < n_started_cores; ++i) {
160                 struct lcore_cfg *lconf = &lcore_cfg[started_cores[i]];
161                 plog_info("Waiting for core %u to start...", started_cores[i]);
162                 if (wait_command_handled(lconf) == -1) return;
163                 plog_info(" OK\n");
164         }
165 }
166
167 void stop_cores(uint32_t *cores, int count, int task_id)
168 {
169         int n_stopped_cores = 0;
170         uint32_t stopped_cores[RTE_MAX_LCORE];
171         uint32_t c;
172
173         warn_inactive_cores(cores, count, "Can't stop core");
174
175         for (int i = 0; i < count; ++i) {
176                 struct lcore_cfg *lconf = &lcore_cfg[cores[i]];
177                 if (lconf->n_tasks_run) {
178                         if (wait_command_handled(lconf) == -1) return;
179
180                         lconf->msg.type = LCONF_MSG_STOP;
181                         lconf->msg.task_id = task_id;
182                         lconf_set_req(lconf);
183                         stopped_cores[n_stopped_cores++] = cores[i];
184                 }
185         }
186
187         for (int i = 0; i < n_stopped_cores; ++i) {
188                 c = stopped_cores[i];
189                 struct lcore_cfg *lconf = &lcore_cfg[c];
190                 if (wait_command_handled(lconf) == -1) return;
191
192                 if (lconf->n_tasks_run == 0) {
193                         plog_info("All tasks stopped on core %u, waiting for core to stop...", c);
194                         rte_eal_wait_lcore(c);
195                         plog_info(" OK\n");
196                         lconf->flags &= ~LCONF_FLAG_RUNNING;
197                 }
198                 else {
199                         plog_info("Stopped task %u on core %u\n", task_id, c);
200                 }
201         }
202 }
203
204 struct size_unit {
205         uint64_t val;
206         uint64_t frac;
207         char     unit[8];
208 };
209
210 static struct size_unit to_size_unit(uint64_t bytes)
211 {
212         struct size_unit ret;
213
214         if (bytes > 1 << 30) {
215                 ret.val = bytes >> 30;
216                 ret.frac = ((bytes - (ret.val << 30)) * 1000) / (1 << 30);
217                 strcpy(ret.unit, "GB");
218         }
219         else if (bytes > 1 << 20) {
220                 ret.val = bytes >> 20;
221                 ret.frac = ((bytes - (ret.val << 20)) * 1000) / (1 << 20);
222                 strcpy(ret.unit, "MB");
223         }
224         else if (bytes > 1 << 10) {
225                 ret.val = bytes >> 10;
226                 ret.frac = (bytes - (ret.val << 10)) * 1000 / (1 << 10);
227                 strcpy(ret.unit, "KB");
228         }
229         else {
230                 ret.val = bytes;
231                 ret.frac = 0;
232                 strcpy(ret.unit, "B");
233         }
234
235         return ret;
236 }
237
238 void cmd_mem_stats(void)
239 {
240         struct rte_malloc_socket_stats sock_stats;
241         uint64_t v;
242         struct size_unit su;
243
244         for (uint32_t i = 0; i < RTE_MAX_NUMA_NODES; ++i) {
245                 if (rte_malloc_get_socket_stats(i, &sock_stats) < 0 || sock_stats.heap_totalsz_bytes == 0)
246                         continue;
247
248                 plogx_info("Socket %u memory stats:\n", i);
249                 su = to_size_unit(sock_stats.heap_totalsz_bytes);
250                 plogx_info("\tHeap_size: %zu.%03zu %s\n", su.val, su.frac, su.unit);
251                 su = to_size_unit(sock_stats.heap_freesz_bytes);
252                 plogx_info("\tFree_size: %zu.%03zu %s\n", su.val, su.frac, su.unit);
253                 su = to_size_unit(sock_stats.heap_allocsz_bytes);
254                 plogx_info("\tAlloc_size: %zu.%03zu %s\n", su.val, su.frac, su.unit);
255                 su = to_size_unit(sock_stats.greatest_free_size);
256                 plogx_info("\tGreatest_free_size: %zu %s\n", su.val, su.unit);
257                 plogx_info("\tAlloc_count: %u\n", sock_stats.alloc_count);
258                 plogx_info("\tFree_count: %u\n", sock_stats.free_count);
259         }
260 }
261
262 void cmd_mem_layout(void)
263 {
264         const struct rte_memseg* memseg = rte_eal_get_physmem_layout();
265
266         plog_info("Memory layout:\n");
267         for (uint32_t i = 0; i < RTE_MAX_MEMSEG; i++) {
268                 if (memseg[i].addr == NULL)
269                         break;
270
271                 const char *sz_str;
272                 switch (memseg[i].hugepage_sz >> 20) {
273                 case 2:
274                         sz_str = "2MB";
275                         break;
276                 case 1024:
277                         sz_str = "1GB";
278                         break;
279                 default:
280                         sz_str = "??";
281                 }
282
283                 plog_info("Segment %u: [%#lx-%#lx] at %p using %zu pages of %s\n",
284                           i,
285                           memseg[i].phys_addr,
286                           memseg[i].phys_addr + memseg[i].len,
287                           memseg[i].addr,
288                           memseg[i].len/memseg[i].hugepage_sz, sz_str);
289         }
290 }
291
292 void cmd_dump(uint8_t lcore_id, uint8_t task_id, uint32_t nb_packets, struct input *input, int rx, int tx)
293 {
294         plog_info("dump %u %u %u\n", lcore_id, task_id, nb_packets);
295         if (lcore_id > RTE_MAX_LCORE) {
296                 plog_warn("core_id too high, maximum allowed is: %u\n", RTE_MAX_LCORE);
297         }
298         else if (task_id >= lcore_cfg[lcore_id].n_tasks_all) {
299                 plog_warn("task_id too high, should be in [0, %u]\n", lcore_cfg[lcore_id].n_tasks_all - 1);
300         }
301         else {
302                 struct lcore_cfg *lconf = &lcore_cfg[lcore_id];
303
304                 lconf->tasks_all[task_id]->aux->task_rt_dump.input = input;
305
306                 if (wait_command_handled(lconf) == -1) return;
307                 if (rx && tx)
308                         lconf->msg.type = LCONF_MSG_DUMP;
309                 else if (rx)
310                         lconf->msg.type = LCONF_MSG_DUMP_RX;
311                 else if (tx)
312                         lconf->msg.type = LCONF_MSG_DUMP_TX;
313
314                 if (rx || tx) {
315                         lconf->msg.task_id = task_id;
316                         lconf->msg.val  = nb_packets;
317                         lconf_set_req(lconf);
318                 }
319
320                 if (lconf->n_tasks_run == 0) {
321                         lconf_do_flags(lconf);
322                 }
323         }
324 }
325
326 void cmd_trace(uint8_t lcore_id, uint8_t task_id, uint32_t nb_packets)
327 {
328         plog_info("trace %u %u %u\n", lcore_id, task_id, nb_packets);
329         if (lcore_id > RTE_MAX_LCORE) {
330                 plog_warn("core_id too high, maximum allowed is: %u\n", RTE_MAX_LCORE);
331         }
332         else if (task_id >= lcore_cfg[lcore_id].n_tasks_all) {
333                 plog_warn("task_id too high, should be in [0, %u]\n", lcore_cfg[lcore_id].n_tasks_all - 1);
334         }
335         else {
336                 struct lcore_cfg *lconf = &lcore_cfg[lcore_id];
337
338                 if (wait_command_handled(lconf) == -1) return;
339
340                 lconf->msg.type = LCONF_MSG_TRACE;
341                 lconf->msg.task_id = task_id;
342                 lconf->msg.val  = nb_packets;
343                 lconf_set_req(lconf);
344
345                 if (lconf->n_tasks_run == 0) {
346                         lconf_do_flags(lconf);
347                 }
348         }
349 }
350
351 void cmd_rx_bw_start(uint32_t lcore_id)
352 {
353         if (lcore_id > RTE_MAX_LCORE) {
354                 plog_warn("core_id too high, maximum allowed is: %u\n", RTE_MAX_LCORE);
355         } else if (lcore_cfg[lcore_id].flags & LCONF_FLAG_RX_BW_ACTIVE) {
356                 plog_warn("rx bandwidt already on core %u\n", lcore_id);
357         } else {
358
359                 struct lcore_cfg *lconf = &lcore_cfg[lcore_id];
360
361                 if (wait_command_handled(lconf) == -1) return;
362                 lconf->msg.type = LCONF_MSG_RX_BW_START;
363                 lconf_set_req(lconf);
364
365                 if (lconf->n_tasks_run == 0) {
366                         lconf_do_flags(lconf);
367                 }
368         }
369 }
370
371 void cmd_tx_bw_start(uint32_t lcore_id)
372 {
373         if (lcore_id > RTE_MAX_LCORE) {
374                 plog_warn("core_id too high, maximum allowed is: %u\n", RTE_MAX_LCORE);
375         } else if (lcore_cfg[lcore_id].flags & LCONF_FLAG_TX_BW_ACTIVE) {
376                 plog_warn("tx bandwidth already running on core %u\n", lcore_id);
377         } else {
378
379                 struct lcore_cfg *lconf = &lcore_cfg[lcore_id];
380
381                 if (wait_command_handled(lconf) == -1) return;
382                 lconf->msg.type = LCONF_MSG_TX_BW_START;
383                 lconf_set_req(lconf);
384
385                 if (lconf->n_tasks_run == 0) {
386                         lconf_do_flags(lconf);
387                 }
388         }
389 }
390
391 void cmd_rx_bw_stop(uint32_t lcore_id)
392 {
393         if (lcore_id > RTE_MAX_LCORE) {
394                 plog_warn("core_id too high, maximum allowed is: %u\n", RTE_MAX_LCORE);
395         } else if (!(lcore_cfg[lcore_id].flags & LCONF_FLAG_RX_BW_ACTIVE)) {
396                 plog_warn("rx bandwidth not running on core %u\n", lcore_id);
397         } else {
398
399                 struct lcore_cfg *lconf = &lcore_cfg[lcore_id];
400
401                 if (wait_command_handled(lconf) == -1) return;
402                 lconf->msg.type = LCONF_MSG_RX_BW_STOP;
403                 lconf_set_req(lconf);
404
405                 if (lconf->n_tasks_run == 0) {
406                         lconf_do_flags(lconf);
407                 }
408         }
409 }
410
411 void cmd_tx_bw_stop(uint32_t lcore_id)
412 {
413         if (lcore_id > RTE_MAX_LCORE) {
414                 plog_warn("core_id too high, maximum allowed is: %u\n", RTE_MAX_LCORE);
415         } else if (!(lcore_cfg[lcore_id].flags & LCONF_FLAG_TX_BW_ACTIVE)) {
416                 plog_warn("tx bandwidth not running on core %u\n", lcore_id);
417         } else {
418
419                 struct lcore_cfg *lconf = &lcore_cfg[lcore_id];
420
421                 if (wait_command_handled(lconf) == -1) return;
422                 lconf->msg.type = LCONF_MSG_TX_BW_STOP;
423                 lconf_set_req(lconf);
424
425                 if (lconf->n_tasks_run == 0) {
426                         lconf_do_flags(lconf);
427                 }
428         }
429 }
430 void cmd_rx_distr_start(uint32_t lcore_id)
431 {
432         if (lcore_id > RTE_MAX_LCORE) {
433                 plog_warn("core_id too high, maximum allowed is: %u\n", RTE_MAX_LCORE);
434         } else if (lcore_cfg[lcore_id].flags & LCONF_FLAG_RX_DISTR_ACTIVE) {
435                 plog_warn("rx distribution already xrunning on core %u\n", lcore_id);
436         } else {
437                 struct lcore_cfg *lconf = &lcore_cfg[lcore_id];
438
439                 if (wait_command_handled(lconf) == -1) return;
440                 lconf->msg.type = LCONF_MSG_RX_DISTR_START;
441                 lconf_set_req(lconf);
442
443                 if (lconf->n_tasks_run == 0) {
444                         lconf_do_flags(lconf);
445                 }
446         }
447 }
448
449 void cmd_tx_distr_start(uint32_t lcore_id)
450 {
451         if (lcore_id > RTE_MAX_LCORE) {
452                 plog_warn("core_id too high, maximum allowed is: %u\n", RTE_MAX_LCORE);
453         } else if (lcore_cfg[lcore_id].flags & LCONF_FLAG_TX_DISTR_ACTIVE) {
454                 plog_warn("tx distribution already xrunning on core %u\n", lcore_id);
455         } else {
456                 struct lcore_cfg *lconf = &lcore_cfg[lcore_id];
457
458                 if (wait_command_handled(lconf) == -1) return;
459                 lconf->msg.type = LCONF_MSG_TX_DISTR_START;
460                 lconf_set_req(lconf);
461
462                 if (lconf->n_tasks_run == 0) {
463                         lconf_do_flags(lconf);
464                 }
465         }
466 }
467
468 void cmd_rx_distr_stop(uint32_t lcore_id)
469 {
470         if (lcore_id > RTE_MAX_LCORE) {
471                 plog_warn("core_id too high, maximum allowed is: %u\n", RTE_MAX_LCORE);
472         } else if ((lcore_cfg[lcore_id].flags & LCONF_FLAG_RX_DISTR_ACTIVE) == 0) {
473                 plog_warn("rx distribution not running on core %u\n", lcore_id);
474         } else {
475                 struct lcore_cfg *lconf = &lcore_cfg[lcore_id];
476
477                 if (wait_command_handled(lconf) == -1) return;
478                 lconf->msg.type = LCONF_MSG_RX_DISTR_STOP;
479                 lconf_set_req(lconf);
480
481                 if (lconf->n_tasks_run == 0) {
482                         lconf_do_flags(lconf);
483                 }
484         }
485 }
486
487 void cmd_tx_distr_stop(uint32_t lcore_id)
488 {
489         if (lcore_id > RTE_MAX_LCORE) {
490                 plog_warn("core_id too high, maximum allowed is: %u\n", RTE_MAX_LCORE);
491         } else if ((lcore_cfg[lcore_id].flags & LCONF_FLAG_TX_DISTR_ACTIVE) == 0) {
492                 plog_warn("tx distribution not running on core %u\n", lcore_id);
493         } else {
494                 struct lcore_cfg *lconf = &lcore_cfg[lcore_id];
495
496                 if (wait_command_handled(lconf) == -1) return;
497                 lconf->msg.type = LCONF_MSG_TX_DISTR_STOP;
498                 lconf_set_req(lconf);
499
500                 if (lconf->n_tasks_run == 0) {
501                         lconf_do_flags(lconf);
502                 }
503         }
504 }
505
506 void cmd_rx_distr_rst(uint32_t lcore_id)
507 {
508         if (lcore_id > RTE_MAX_LCORE) {
509                 plog_warn("core_id too high, maximum allowed is: %u\n", RTE_MAX_LCORE);
510         } else {
511                 struct lcore_cfg *lconf = &lcore_cfg[lcore_id];
512
513                 if (wait_command_handled(lconf) == -1) return;
514                 lconf->msg.type = LCONF_MSG_RX_DISTR_RESET;
515                 lconf_set_req(lconf);
516
517                 if (lconf->n_tasks_run == 0) {
518                         lconf_do_flags(lconf);
519                 }
520         }
521 }
522
523 void cmd_tx_distr_rst(uint32_t lcore_id)
524 {
525         if (lcore_id > RTE_MAX_LCORE) {
526                 plog_warn("core_id too high, maximum allowed is: %u\n", RTE_MAX_LCORE);
527         } else {
528                 struct lcore_cfg *lconf = &lcore_cfg[lcore_id];
529
530                 if (wait_command_handled(lconf) == -1) return;
531                 lconf->msg.type = LCONF_MSG_TX_DISTR_RESET;
532                 lconf_set_req(lconf);
533
534                 if (lconf->n_tasks_run == 0) {
535                         lconf_do_flags(lconf);
536                 }
537         }
538 }
539
540 void cmd_rx_distr_show(uint32_t lcore_id)
541 {
542         if (lcore_id > RTE_MAX_LCORE) {
543                 plog_warn("core_id too high, maximum allowed is: %u\n", RTE_MAX_LCORE);
544         } else {
545                 for (uint32_t i = 0; i < lcore_cfg[lcore_id].n_tasks_all; ++i) {
546                         struct task_base *t = lcore_cfg[lcore_id].tasks_all[i];
547                         plog_info("t[%u]: ", i);
548                         for (uint32_t j = 0; j < sizeof(t->aux->rx_bucket)/sizeof(t->aux->rx_bucket[0]); ++j) {
549                                 plog_info("%u ", t->aux->rx_bucket[j]);
550                         }
551                         plog_info("\n");
552                 }
553         }
554 }
555 void cmd_tx_distr_show(uint32_t lcore_id)
556 {
557         if (lcore_id > RTE_MAX_LCORE) {
558                 plog_warn("core_id too high, maximum allowed is: %u\n", RTE_MAX_LCORE);
559         } else {
560                 for (uint32_t i = 0; i < lcore_cfg[lcore_id].n_tasks_all; ++i) {
561                         struct task_base *t = lcore_cfg[lcore_id].tasks_all[i];
562                         uint64_t tot = 0, avg = 0;
563                         for (uint32_t j = 0; j < sizeof(t->aux->tx_bucket)/sizeof(t->aux->tx_bucket[0]); ++j) {
564                                 tot += t->aux->tx_bucket[j];
565                                 avg += j * t->aux->tx_bucket[j];
566                         }
567                         if (tot) {
568                                 avg = avg / tot;
569                         }
570                         plog_info("t[%u]: %lu: ", i, avg);
571                         for (uint32_t j = 0; j < sizeof(t->aux->tx_bucket)/sizeof(t->aux->tx_bucket[0]); ++j) {
572                                 plog_info("%u ", t->aux->tx_bucket[j]);
573                         }
574                         plog_info("\n");
575                 }
576         }
577 }
578
579 void cmd_ringinfo_all(void)
580 {
581         struct lcore_cfg *lconf;
582         uint32_t lcore_id = -1;
583
584         while(prox_core_next(&lcore_id, 0) == 0) {
585                 lconf = &lcore_cfg[lcore_id];
586                 for (uint8_t task_id = 0; task_id < lconf->n_tasks_all; ++task_id) {
587                         cmd_ringinfo(lcore_id, task_id);
588                 }
589         }
590 }
591
592 void cmd_ringinfo(uint8_t lcore_id, uint8_t task_id)
593 {
594         struct lcore_cfg *lconf;
595         struct rte_ring *ring;
596         struct task_args* targ;
597         uint32_t count;
598
599         if (!prox_core_active(lcore_id, 0)) {
600                 plog_info("lcore %u is not active\n", lcore_id);
601                 return;
602         }
603         lconf = &lcore_cfg[lcore_id];
604         if (task_id >= lconf->n_tasks_all) {
605                 plog_warn("Invalid task index %u: lcore %u has %u tasks\n", task_id, lcore_id, lconf->n_tasks_all);
606                 return;
607         }
608
609         targ = &lconf->targs[task_id];
610         plog_info("Core %u task %u: %u rings\n", lcore_id, task_id, targ->nb_rxrings);
611         for (uint8_t i = 0; i < targ->nb_rxrings; ++i) {
612                 ring = targ->rx_rings[i];
613 #if RTE_VERSION < RTE_VERSION_NUM(17,5,0,1)
614                 count = ring->prod.mask + 1;
615 #else
616                 count = ring->mask + 1;
617 #endif
618                 plog_info("\tRing %u:\n", i);
619                 plog_info("\t\tFlags: %s,%s\n", ring->flags & RING_F_SP_ENQ? "sp":"mp", ring->flags & RING_F_SC_DEQ? "sc":"mc");
620                 plog_info("\t\tMemory size: %zu bytes\n", rte_ring_get_memsize(count));
621                 plog_info("\t\tOccupied: %u/%u\n", rte_ring_count(ring), count);
622         }
623 }
624
625 void cmd_port_up(uint8_t port_id)
626 {
627         int err;
628
629         if (!port_is_active(port_id)) {
630                 return ;
631         }
632
633         if ((err = rte_eth_dev_set_link_up(port_id)) == 0) {
634                 plog_info("Bringing port %d up\n", port_id);
635         }
636         else {
637                 plog_warn("Failed to bring port %d up with error %d\n", port_id, err);
638         }
639 }
640
641 void cmd_port_down(uint8_t port_id)
642 {
643         int err;
644
645         if (!port_is_active(port_id)) {
646                 return ;
647         }
648
649         if ((err = rte_eth_dev_set_link_down(port_id)) == 0) {
650                 plog_info("Bringing port %d down\n", port_id);
651         }
652         else {
653                 plog_warn("Failed to bring port %d down with error %d\n", port_id, err);
654         }
655 }
656
657 void cmd_xstats(uint8_t port_id)
658 {
659 #if RTE_VERSION >= RTE_VERSION_NUM(16,7,0,0)
660         int n_xstats;
661         struct rte_eth_xstat *eth_xstat = NULL; // id and value
662         struct rte_eth_xstat_name *eth_xstat_name = NULL;       // only names
663         struct prox_port_cfg* port_cfg = &prox_port_cfg[port_id];
664         int rc;
665
666         n_xstats = rte_eth_xstats_get(port_id, NULL, 0);
667         eth_xstat_name = prox_zmalloc(n_xstats * sizeof(*eth_xstat_name), port_cfg->socket);
668         PROX_ASSERT(eth_xstat_name);
669         rc = rte_eth_xstats_get_names(port_id, eth_xstat_name, n_xstats);
670         if ((rc < 0) || (rc > n_xstats)) {
671                 if (rc < 0) {
672                         plog_warn("Failed to get xstats_names on port %d with error %d\n", port_id, rc);
673                 } else if (rc > n_xstats) {
674                         plog_warn("Failed to get xstats_names on port %d: too many xstats (%d)\n", port_id, rc);
675                 }
676         }
677
678         eth_xstat = prox_zmalloc(n_xstats * sizeof(*eth_xstat), port_cfg->socket);
679         PROX_ASSERT(eth_xstat);
680         rc = rte_eth_xstats_get(port_id, eth_xstat, n_xstats);
681         if ((rc < 0) || (rc > n_xstats)) {
682                 if (rc < 0) {
683                         plog_warn("Failed to get xstats on port %d with error %d\n", port_id, rc);
684                 } else if (rc > n_xstats) {
685                         plog_warn("Failed to get xstats on port %d: too many xstats (%d)\n", port_id, rc);
686                 }
687         } else {
688                 for (int i=0;i<rc;i++) {
689                         plog_info("%s: %ld\n", eth_xstat_name[i].name, eth_xstat[i].value);
690                 }
691         }
692         if (eth_xstat_name)
693                 prox_free(eth_xstat_name);
694         if (eth_xstat)
695                 prox_free(eth_xstat);
696 #else
697 #if RTE_VERSION >= RTE_VERSION_NUM(2,1,0,0)
698         int n_xstats;
699         struct rte_eth_xstats *eth_xstats;
700         struct prox_port_cfg* port_cfg = &prox_port_cfg[port_id];
701         int rc;
702
703         n_xstats = rte_eth_xstats_get(port_id, NULL, 0);
704         eth_xstats = prox_zmalloc(n_xstats * sizeof(*eth_xstats), port_cfg->socket);
705         PROX_ASSERT(eth_xstats);
706         rc = rte_eth_xstats_get(port_id, eth_xstats, n_xstats);
707         if ((rc < 0) || (rc > n_xstats)) {
708                 if (rc < 0) {
709                         plog_warn("Failed to get xstats on port %d with error %d\n", port_id, rc);
710                 } else if (rc > n_xstats) {
711                         plog_warn("Failed to get xstats on port %d: too many xstats (%d)\n", port_id, rc);
712                 }
713         } else {
714                 for (int i=0;i<rc;i++) {
715                         plog_info("%s: %ld\n", eth_xstats[i].name, eth_xstats[i].value);
716                 }
717         }
718         if (eth_xstats)
719                 prox_free(eth_xstats);
720 #else
721         plog_warn("Failed to get xstats, xstats are not supported in this version of dpdk\n");
722 #endif
723 #endif
724 }
725
726 void cmd_portinfo(int port_id, char *dst, size_t max_len)
727 {
728         char *end = dst + max_len;
729
730         *dst = 0;
731         if (port_id == -1) {
732                 uint8_t max_port_idx = prox_last_port_active() + 1;
733
734                 for (uint8_t port_id = 0; port_id < max_port_idx; ++port_id) {
735                         if (!prox_port_cfg[port_id].active) {
736                                 continue;
737                         }
738                         struct prox_port_cfg* port_cfg = &prox_port_cfg[port_id];
739
740                         dst += snprintf(dst, end - dst,
741                                         "%2d:%10s; "MAC_BYTES_FMT"; %s\n",
742                                         port_id,
743                                         port_cfg->name,
744                                         MAC_BYTES(port_cfg->eth_addr.addr_bytes),
745                                         port_cfg->pci_addr);
746                 }
747                 return;
748         }
749
750         if (!port_is_active(port_id)) {
751                 return ;
752         }
753
754         struct prox_port_cfg* port_cfg = &prox_port_cfg[port_id];
755
756         dst += snprintf(dst, end - dst, "Port info for port %u\n", port_id);
757         dst += snprintf(dst, end - dst, "\tName: %s\n", port_cfg->name);
758         dst += snprintf(dst, end - dst, "\tDriver: %s\n", port_cfg->driver_name);
759         dst += snprintf(dst, end - dst, "\tMac address: "MAC_BYTES_FMT"\n", MAC_BYTES(port_cfg->eth_addr.addr_bytes));
760         dst += snprintf(dst, end - dst, "\tLink speed: %u Mbps\n", port_cfg->link_speed);
761         dst += snprintf(dst, end - dst, "\tLink status: %s\n", port_cfg->link_up? "up" : "down");
762         dst += snprintf(dst, end - dst, "\tSocket: %u\n", port_cfg->socket);
763         dst += snprintf(dst, end - dst, "\tPCI address: %s\n", port_cfg->pci_addr);
764         dst += snprintf(dst, end - dst, "\tPromiscuous: %s\n", port_cfg->promiscuous? "yes" : "no");
765         dst += snprintf(dst, end - dst, "\tNumber of RX/TX descriptors: %u/%u\n", port_cfg->n_rxd, port_cfg->n_txd);
766         dst += snprintf(dst, end - dst, "\tNumber of RX/TX queues: %u/%u (max: %u/%u)\n", port_cfg->n_rxq, port_cfg->n_txq, port_cfg->max_rxq, port_cfg->max_txq);
767         dst += snprintf(dst, end - dst, "\tMemory pools:\n");
768
769         for (uint8_t i = 0; i < 32; ++i) {
770                 if (port_cfg->pool[i]) {
771                         dst += snprintf(dst, end - dst, "\t\tname: %s (%p)\n",
772                                         port_cfg->pool[i]->name, port_cfg->pool[i]);
773                 }
774         }
775 }
776
777 void cmd_read_reg(uint8_t port_id, unsigned int id)
778 {
779         unsigned int val, rc;
780         if (!port_is_active(port_id)) {
781                 return ;
782         }
783         rc = read_reg(port_id, id, &val);
784         if (rc) {
785                 plog_warn("Failed to read register %d on port %d\n", id, port_id);
786         }
787         else {
788                 plog_info("Register 0x%08X : %08X \n", id, val);
789         }
790 }
791
792 void cmd_reset_port(uint8_t portid)
793 {
794         unsigned int rc;
795         if (!prox_port_cfg[portid].active) {
796                 plog_info("port not active \n");
797                 return;
798         }
799         rte_eth_dev_stop(portid);
800         rc = rte_eth_dev_start(portid);
801         if (rc) {
802                 plog_warn("Failed to restart port %d\n", portid);
803         }
804 }
805 void cmd_write_reg(uint8_t port_id, unsigned int id, unsigned int val)
806 {
807         if (!port_is_active(port_id)) {
808                 return ;
809         }
810
811         plog_info("writing 0x%08X %08X\n", id, val);
812         write_reg(port_id, id, val);
813 }
814
815 void cmd_set_vlan_offload(uint8_t port_id, unsigned int val)
816 {
817         if (!port_is_active(port_id)) {
818                 return ;
819         }
820
821         plog_info("setting vlan offload to %d\n", val);
822         if (val & ~(ETH_VLAN_STRIP_OFFLOAD | ETH_VLAN_FILTER_OFFLOAD | ETH_VLAN_EXTEND_OFFLOAD)) {
823                 plog_info("wrong vlan offload value\n");
824         }
825         int ret = rte_eth_dev_set_vlan_offload(port_id, val);
826         plog_info("rte_eth_dev_set_vlan_offload return %d\n", ret);
827 }
828
829 void cmd_set_vlan_filter(uint8_t port_id, unsigned int id, unsigned int val)
830 {
831         if (!port_is_active(port_id)) {
832                 return ;
833         }
834
835         plog_info("setting vln filter for vlan %d to %d\n", id, val);
836         int ret = rte_eth_dev_vlan_filter(port_id, id, val);
837         plog_info("rte_eth_dev_vlan_filter return %d\n", ret);
838 }
839
840 void cmd_thread_info(uint8_t lcore_id, uint8_t task_id)
841 {
842         plog_info("thread_info %u %u \n", lcore_id, task_id);
843         if (lcore_id > RTE_MAX_LCORE) {
844                 plog_warn("core_id too high, maximum allowed is: %u\n", RTE_MAX_LCORE);
845         }
846         if (!prox_core_active(lcore_id, 0)) {
847                 plog_warn("lcore %u is not active\n", lcore_id);
848                 return;
849         }
850         if (task_id >= lcore_cfg[lcore_id].n_tasks_all) {
851                 plog_warn("task_id too high, should be in [0, %u]\n", lcore_cfg[lcore_id].n_tasks_all - 1);
852                 return;
853         }
854         if (strcmp(lcore_cfg[lcore_id].targs[task_id].task_init->mode_str, "qos") == 0) {
855                 struct task_base *task;
856
857                 task = lcore_cfg[lcore_id].tasks_all[task_id];
858                 plog_info("core %d, task %d: %d mbufs stored in QoS\n", lcore_id, task_id,
859                           task_qos_n_pkts_buffered(task));
860
861 #ifdef ENABLE_EXTRA_USER_STATISTICS
862         }
863         else if (lcore_cfg[lcore_id].targs[task_id].mode == QINQ_ENCAP4) {
864                 struct task_qinq_encap4 *task;
865                 task = (struct task_qinq_encap4 *)(lcore_cfg[lcore_id].tasks_all[task_id]);
866                 for (int i=0;i<task->n_users;i++) {
867                         if (task->stats_per_user[i])
868                                 plog_info("User %d: %d packets\n", i, task->stats_per_user[i]);
869                 }
870 #endif
871         }
872         else {
873                 // Only QoS thread info so far
874                 plog_err("core %d, task %d: not a qos core (%p)\n", lcore_id, task_id, lcore_cfg[lcore_id].thread_x);
875         }
876 }
877
878 void cmd_rx_tx_info(void)
879 {
880         uint32_t lcore_id = -1;
881         while(prox_core_next(&lcore_id, 0) == 0) {
882                 for (uint8_t task_id = 0; task_id < lcore_cfg[lcore_id].n_tasks_all; ++task_id) {
883                         struct task_args *targ = &lcore_cfg[lcore_id].targs[task_id];
884
885                         plog_info("Core %u:", lcore_id);
886                         if (targ->rx_port_queue[0].port != OUT_DISCARD) {
887                                 for (int i = 0; i < targ->nb_rxports; i++) {
888                                         plog_info(" RX port %u (queue %u)", targ->rx_port_queue[i].port, targ->rx_port_queue[i].queue);
889                                 }
890                         }
891                         else {
892                                 for (uint8_t j = 0; j < targ->nb_rxrings; ++j) {
893                                         plog_info(" RX ring[%u,%u] %p", task_id, j, targ->rx_rings[j]);
894                                 }
895                         }
896                         plog_info(" ==>");
897                         for (uint8_t j = 0; j < targ->nb_txports; ++j) {
898                                 plog_info(" TX port %u (queue %u)", targ->tx_port_queue[j].port,
899                                           targ->tx_port_queue[j].queue);
900                         }
901
902                         for (uint8_t j = 0; j < targ->nb_txrings; ++j) {
903                                 plog_info(" TX ring %p", targ->tx_rings[j]);
904                         }
905
906                         plog_info("\n");
907                 }
908         }
909 }
910 void cmd_get_cache_class(uint32_t lcore_id, uint32_t *set)
911 {
912         uint64_t tmp_rmid = 0;
913         cqm_assoc_read(lcore_id, &tmp_rmid);
914         *set = (uint32_t)(tmp_rmid >> 32);
915 }
916
917 void cmd_get_cache_class_mask(uint32_t lcore_id, uint32_t set, uint32_t *val)
918 {
919         cat_get_class_mask(lcore_id, set, val);
920 }
921
922 void cmd_set_cache_class_mask(uint32_t lcore_id, uint32_t set, uint32_t val)
923 {
924         cat_set_class_mask(lcore_id, set, val);
925         lcore_cfg[lcore_id].cache_set = set;
926         uint32_t id = -1;
927         while(prox_core_next(&id, 0) == 0) {
928                 if ((lcore_cfg[id].cache_set == set) && (rte_lcore_to_socket_id(id) == rte_lcore_to_socket_id(lcore_id))) {
929                         plog_info("Updating mask for core %d to %d\n", id, set);
930                         stats_update_cache_mask(id, val);
931                 }
932         }
933 }
934
935 void cmd_set_cache_class(uint32_t lcore_id, uint32_t set)
936 {
937         uint64_t tmp_rmid = 0;
938         uint32_t val = 0;
939         cqm_assoc_read(lcore_id, &tmp_rmid);
940         cqm_assoc(lcore_id, (tmp_rmid & 0xffffffff) | ((set * 1L) << 32));
941         cat_get_class_mask(lcore_id, set, &val);
942         stats_update_cache_mask(lcore_id, val);
943 }
944
945 void cmd_cache_reset(void)
946 {
947         uint8_t sockets[MAX_SOCKETS] = {0};
948         uint8_t cores[MAX_SOCKETS] = {0};
949         uint32_t mask = (1 << cat_get_num_ways()) - 1;
950         uint32_t lcore_id = -1, socket_id;
951         while(prox_core_next(&lcore_id, 0) == 0) {
952                 cqm_assoc(lcore_id, 0);
953                 socket_id = rte_lcore_to_socket_id(lcore_id);
954                 if (socket_id < MAX_SOCKETS) {
955                         sockets[socket_id] = 1;
956                         cores[socket_id] = lcore_id;
957                 }
958                 stats_update_cache_mask(lcore_id, mask);
959                 plog_info("Setting core %d to cache mask %x\n", lcore_id, mask);
960                 lcore_cfg[lcore_id].cache_set = 0;
961         }
962         for (uint32_t s = 0; s < MAX_SOCKETS; s++) {
963                 if (sockets[s])
964                         cat_reset_cache(cores[s]);
965         }
966         stats_lcore_assoc_rmid();
967 }
968
969 int bypass_task(uint32_t lcore_id, uint32_t task_id)
970 {
971         struct lcore_cfg *lconf = &lcore_cfg[lcore_id];
972         struct task_args *targ, *starg, *dtarg;
973         struct rte_ring *ring = NULL;
974
975         if (task_id >= lconf->n_tasks_all)
976                 return -1;
977
978         targ = &lconf->targs[task_id];
979         if (targ->nb_txrings == 1) {
980                 plog_info("Task has %d receive and 1 transmmit ring and can be bypassed, %d precedent tasks\n", targ->nb_rxrings, targ->n_prev_tasks);
981                 // Find source task
982                 for (unsigned int i = 0; i < targ->n_prev_tasks; i++) {
983                         starg = targ->prev_tasks[i];
984                         for (unsigned int j = 0; j < starg->nb_txrings; j++) {
985                                 for (unsigned int k = 0; k < targ->nb_rxrings; k++) {
986                                         if (starg->tx_rings[j] == targ->rx_rings[k]) {
987                                                 plog_info("bypassing ring %p and connecting it to %p\n", starg->tx_rings[j], targ->tx_rings[0]);
988                                                 starg->tx_rings[j] = targ->tx_rings[0];
989                                                 struct task_base *tbase = starg->tbase;
990                                                 tbase->tx_params_sw.tx_rings[j] = starg->tx_rings[j];
991                                         }
992                                 }
993                         }
994                 }
995         } else {
996                 plog_info("Task has %d receive and %d transmit ring and cannot be bypassed\n", targ->nb_rxrings, targ->nb_txrings);
997                 return -1;
998         }
999
1000         return 0;
1001 }
1002
1003 int reconnect_task(uint32_t lcore_id, uint32_t task_id)
1004 {
1005         struct lcore_cfg *lconf = &lcore_cfg[lcore_id];
1006         struct task_args *targ, *starg, *dtarg = NULL;
1007         struct rte_ring *ring = NULL;
1008
1009         if (task_id >= lconf->n_tasks_all)
1010                 return -1;
1011
1012         targ = &lconf->targs[task_id];
1013         if (targ->nb_txrings == 1) {
1014                 // Find source task
1015                 for (unsigned int i = 0; i < targ->n_prev_tasks; i++) {
1016                         starg = targ->prev_tasks[i];
1017                         for (unsigned int j = 0; j < starg->nb_txrings; j++) {
1018                                 if (starg->tx_rings[j] == targ->tx_rings[0]) {
1019                                         if (targ->n_prev_tasks == targ->nb_rxrings) {
1020                                                 starg->tx_rings[j] = targ->rx_rings[i];
1021                                                 struct task_base *tbase = starg->tbase;
1022                                                 tbase->tx_params_sw.tx_rings[j] = starg->tx_rings[j];
1023                                                 plog_info("Task has %d receive and 1 transmmit ring and can be reconnected, %d precedent tasks\n", targ->nb_rxrings, targ->n_prev_tasks);
1024                                         } else if (targ->nb_rxrings == 1) {
1025                                                 starg->tx_rings[j] = targ->rx_rings[0];
1026                                                 struct task_base *tbase = starg->tbase;
1027                                                 tbase->tx_params_sw.tx_rings[j] = starg->tx_rings[j];
1028                                                 plog_info("Task has %d receive and 1 transmmit ring and ring %p can be reconnected, %d precedent tasks\n", targ->nb_rxrings, starg->tx_rings[j], targ->n_prev_tasks);
1029                                         } else {
1030                                                 plog_err("Unexpected configuration: %d precedent tasks, %d rx rings\n", targ->n_prev_tasks, targ->nb_rxrings);
1031                                         }
1032                                 }
1033                         }
1034                 }
1035         } else {
1036                 plog_info("Task has %d receive and %d transmit ring and cannot be bypassed\n", targ->nb_rxrings, targ->nb_txrings);
1037                 return -1;
1038         }
1039
1040         return 0;
1041 }