Support for recent GCC compiler
[samplevnf.git] / VNFs / DPPD-PROX / handle_dump.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 <rte_cycles.h>
18 #include <pcap.h>
19
20 #include "prox_malloc.h"
21 #include "clock.h"
22 #include "log.h"
23 #include "lconf.h"
24 #include "task_init.h"
25 #include "task_base.h"
26 #include "stats.h"
27 #include "prox_compat.h"
28
29 struct task_dump {
30         struct task_base base;
31         uint32_t n_mbufs;
32         struct rte_mbuf **mbufs;
33         uint32_t n_pkts;
34         char pcap_file[256];
35 };
36
37 static uint16_t buffer_packets(struct task_dump *task, struct rte_mbuf **mbufs, uint16_t n_pkts)
38 {
39         uint16_t j = 0;
40
41         if (task->n_mbufs == task->n_pkts)
42                 return 0;
43
44         for (j = 0; j < n_pkts && task->n_mbufs < task->n_pkts; ++j) {
45                 mbufs[j]->udata64 = rte_rdtsc();
46                 task->mbufs[task->n_mbufs++] = mbufs[j];
47         }
48
49         return j;
50 }
51
52 static int handle_dump_bulk(struct task_base *tbase, struct rte_mbuf **mbufs, uint16_t n_pkts)
53 {
54         struct task_dump *task = (struct task_dump *)tbase;
55         const uint16_t ofs = buffer_packets(task, mbufs, n_pkts);
56
57         for (uint16_t j = ofs; j < n_pkts; ++j)
58                 rte_pktmbuf_free(mbufs[j]);
59         TASK_STATS_ADD_DROP_DISCARD(&tbase->aux->stats, n_pkts - ofs);
60         return n_pkts;
61 }
62
63 static void init_task_dump(struct task_base *tbase, __attribute__((unused)) struct task_args *targ)
64 {
65         struct task_dump *task = (struct task_dump *)tbase;
66         const int socket_id = rte_lcore_to_socket_id(targ->lconf->id);
67
68         task->mbufs = prox_zmalloc(sizeof(*task->mbufs) * targ->n_pkts, socket_id);
69         task->n_pkts = targ->n_pkts;
70         if (!strcmp(targ->pcap_file, "")) {
71                 strcpy(targ->pcap_file, "out.pcap");
72         }
73         prox_strncpy(task->pcap_file, targ->pcap_file, sizeof(task->pcap_file));
74 }
75
76 static void stop(struct task_base *tbase)
77 {
78         struct task_dump *task = (struct task_dump *)tbase;
79         static pcap_dumper_t *pcap_dump_handle;
80         pcap_t *handle;
81         uint32_t n_pkts = 65536;
82         struct pcap_pkthdr header = {{0}, 0, 0};
83         static int once = 0;
84         char err_str[PCAP_ERRBUF_SIZE];
85         const uint64_t hz = rte_get_tsc_hz();
86         struct timeval tv = {0};
87         uint64_t tsc, beg = 0;
88
89         plogx_info("Dumping %d packets to '%s'\n", task->n_mbufs, task->pcap_file);
90         handle = pcap_open_dead(DLT_EN10MB, n_pkts);
91         pcap_dump_handle = pcap_dump_open(handle, task->pcap_file);
92
93         if (task->n_mbufs) {
94                 beg = task->mbufs[0]->udata64;
95         }
96         for (uint32_t j = 0; j < task->n_mbufs; ++j) {
97                 tsc = task->mbufs[j]->udata64 - beg;
98                 header.len = rte_pktmbuf_pkt_len(task->mbufs[j]);
99                 header.caplen = header.len;
100                 tsc_to_tv(&header.ts, tsc);
101                 pcap_dump((unsigned char *)pcap_dump_handle, &header, rte_pktmbuf_mtod(task->mbufs[j], void *));
102         }
103
104         pcap_dump_close(pcap_dump_handle);
105         pcap_close(handle);
106         plogx_info("Dump complete, releasing mbufs\n");
107
108         uint32_t j = 0;
109
110         while (j + 64 < task->n_mbufs) {
111                 tbase->tx_pkt(tbase, &task->mbufs[j], 64, NULL);
112                 j += 64;
113         }
114         if (j < task->n_mbufs) {
115                 tbase->tx_pkt(tbase, &task->mbufs[j], task->n_mbufs - j, NULL);
116         }
117         task->n_mbufs = 0;
118 }
119
120 static struct task_init task_init_dump = {
121         .mode_str = "dump",
122         .init = init_task_dump,
123         .handle = handle_dump_bulk,
124         .stop = stop,
125         .flag_features = TASK_FEATURE_ZERO_RX,
126         .size = sizeof(struct task_dump)
127 };
128
129 __attribute__((constructor)) static void reg_task_dump(void)
130 {
131         reg_task(&task_init_dump);
132 }