Initial commit of vpp code.
[vpp.git] / vnet / vnet / dpdk_replication.h
1 #ifndef __included_dpdk_replication_h__
2 #define __included_dpdk_replication_h__
3 #include <vnet/devices/dpdk/dpdk.h>
4
5 /*
6  * vlib_dpdk_clone_buffer - clone a buffer 
7  * for port mirroring, lawful intercept, etc.
8  * rte_pktmbuf_clone (...) requires that the forwarding path
9  * not touch any of the cloned data. The hope is that we'll
10  * figure out how to relax that restriction. 
11  * 
12  * For the moment, copy packet data.
13  */
14
15 static inline vlib_buffer_t *
16 vlib_dpdk_clone_buffer (vlib_main_t * vm, vlib_buffer_t * b)
17 {
18   u32 new_buffers_needed = 1;
19   unsigned socket_id = rte_socket_id();
20   struct rte_mempool *rmp = vm->buffer_main->pktmbuf_pools[socket_id];
21   struct rte_mbuf *rte_mbufs[5];
22   vlib_buffer_free_list_t * fl;
23   vlib_buffer_t * rv;
24   u8 * copy_src, * copy_dst;
25   vlib_buffer_t *src_buf, *dst_buf;
26
27   fl = vlib_buffer_get_free_list (vm, VLIB_BUFFER_DEFAULT_FREE_LIST_INDEX);
28
29   if (PREDICT_FALSE(b->flags & VLIB_BUFFER_NEXT_PRESENT))
30     {
31       vlib_buffer_t *tmp = b;
32       int i;
33
34       while (tmp->flags & VLIB_BUFFER_NEXT_PRESENT)
35         {
36           new_buffers_needed ++;
37           tmp = vlib_get_buffer (vm, tmp->next_buffer);
38         }
39
40       /* Should never happen... */
41       if (PREDICT_FALSE(new_buffers_needed > ARRAY_LEN(rte_mbufs)))
42         {
43           clib_warning ("need %d buffers", new_buffers_needed);
44           return 0;
45         }
46       
47       if (rte_mempool_get_bulk (rmp, (void **)rte_mbufs, 
48                                 new_buffers_needed) < 0)
49         return 0;
50
51       src_buf = b;
52       rv = dst_buf = (vlib_buffer_t *)(rte_mbufs[0] + 1);
53       vlib_buffer_init_for_free_list (dst_buf, fl);
54       copy_src = b->data + src_buf->current_data;
55       copy_dst = dst_buf->data + src_buf->current_data;
56
57       for (i = 0; i < new_buffers_needed; i++)
58         {
59           memcpy (copy_src, copy_dst, src_buf->current_length);
60           dst_buf->current_data = src_buf->current_data;
61           dst_buf->current_length = src_buf->current_length;
62           dst_buf->flags = src_buf->flags;
63
64           if (i == 0)
65             {
66               dst_buf->total_length_not_including_first_buffer = 
67                 src_buf->total_length_not_including_first_buffer;
68               vnet_buffer(dst_buf)->sw_if_index[VLIB_RX] =
69                 vnet_buffer(src_buf)->sw_if_index[VLIB_RX];
70               vnet_buffer(dst_buf)->sw_if_index[VLIB_TX] =
71                 vnet_buffer(src_buf)->sw_if_index[VLIB_TX];
72               vnet_buffer(dst_buf)->l2 = vnet_buffer(b)->l2;
73             }
74
75           if (i < new_buffers_needed - 1)
76             {
77               src_buf = vlib_get_buffer (vm, src_buf->next_buffer);
78               dst_buf = (vlib_buffer_t *)(rte_mbufs[i+1] + 1);
79               vlib_buffer_init_for_free_list (dst_buf, fl);
80               copy_src = src_buf->data;
81               copy_dst = dst_buf->data;
82             }
83         }
84       return rv;
85     }
86
87   if (rte_mempool_get_bulk (rmp, (void **)rte_mbufs, 1) < 0)
88     return 0;
89
90   rv = (vlib_buffer_t *)(rte_mbufs[0] + 1);
91   vlib_buffer_init_for_free_list (rv, fl);
92
93   memcpy(rv->data + b->current_data, b->data + b->current_data, 
94          b->current_length);
95   rv->current_data = b->current_data;
96   rv->current_length = b->current_length;
97   vnet_buffer(rv)->sw_if_index[VLIB_RX] =
98     vnet_buffer(b)->sw_if_index[VLIB_RX];
99   vnet_buffer(rv)->sw_if_index[VLIB_TX] =
100     vnet_buffer(b)->sw_if_index[VLIB_TX];
101   vnet_buffer(rv)->l2 = vnet_buffer(b)->l2;
102
103   return (rv);
104 }
105
106
107 #endif /* __included_dpdk_replication_h__ */