7b5470dc5530dba1872971a9b8ac87c2df87d23e
[vpp.git] / vnet / vnet / ip / ip6_input.c
1 /*
2  * Copyright (c) 2015 Cisco and/or its affiliates.
3  * Licensed under the Apache License, Version 2.0 (the "License");
4  * you may not use this file except in compliance with the License.
5  * You may obtain a copy of the License at:
6  *
7  *     http://www.apache.org/licenses/LICENSE-2.0
8  *
9  * Unless required by applicable law or agreed to in writing, software
10  * distributed under the License is distributed on an "AS IS" BASIS,
11  * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
12  * See the License for the specific language governing permissions and
13  * limitations under the License.
14  */
15 /*
16  * ip/ip6_input.c: IP v6 input node
17  *
18  * Copyright (c) 2008 Eliot Dresselhaus
19  *
20  * Permission is hereby granted, free of charge, to any person obtaining
21  * a copy of this software and associated documentation files (the
22  * "Software"), to deal in the Software without restriction, including
23  * without limitation the rights to use, copy, modify, merge, publish,
24  * distribute, sublicense, and/or sell copies of the Software, and to
25  * permit persons to whom the Software is furnished to do so, subject to
26  * the following conditions:
27  *
28  * The above copyright notice and this permission notice shall be
29  * included in all copies or substantial portions of the Software.
30  *
31  *  THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
32  *  EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
33  *  MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
34  *  NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE
35  *  LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION
36  *  OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION
37  *  WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
38  */
39
40 #include <vnet/ip/ip.h>
41 #include <vnet/ethernet/ethernet.h>
42 #include <vnet/ppp/ppp.h>
43 #include <vnet/hdlc/hdlc.h>
44
45 typedef struct {
46   u8 packet_data[64];
47 } ip6_input_trace_t;
48
49 static u8 * format_ip6_input_trace (u8 * s, va_list * va)
50 {
51   CLIB_UNUSED (vlib_main_t * vm) = va_arg (*va, vlib_main_t *);
52   CLIB_UNUSED (vlib_node_t * node) = va_arg (*va, vlib_node_t *);
53   ip6_input_trace_t * t = va_arg (*va, ip6_input_trace_t *);
54
55   s = format (s, "%U",
56               format_ip6_header,
57               t->packet_data, sizeof (t->packet_data));
58
59   return s;
60 }
61
62 typedef enum {
63   IP6_INPUT_NEXT_DROP,
64   IP6_INPUT_NEXT_LOOKUP,
65   IP6_INPUT_NEXT_ICMP_ERROR,
66   IP6_INPUT_N_NEXT,
67 } ip6_input_next_t;
68
69 /* Validate IP v6 packets and pass them either to forwarding code
70    or drop exception packets. */
71 static uword
72 ip6_input (vlib_main_t * vm,
73            vlib_node_runtime_t * node,
74            vlib_frame_t * frame)
75 {
76   vnet_main_t * vnm = vnet_get_main();
77   ip6_main_t * im = &ip6_main;
78   ip_lookup_main_t * lm = &im->lookup_main;
79   u32 n_left_from, * from, * to_next;
80   ip6_input_next_t next_index;
81   vlib_node_runtime_t * error_node = vlib_node_get_runtime (vm, ip6_input_node.index);
82   vlib_simple_counter_main_t * cm;
83   u32 cpu_index = os_get_cpu_number();
84
85   from = vlib_frame_vector_args (frame);
86   n_left_from = frame->n_vectors;
87   next_index = node->cached_next_index;
88
89   if (node->flags & VLIB_NODE_FLAG_TRACE)
90     vlib_trace_frame_buffers_only (vm, node, from, frame->n_vectors,
91                                    /* stride */ 1,
92                                    sizeof (ip6_input_trace_t));
93
94   cm = vec_elt_at_index (vnm->interface_main.sw_if_counters,
95                          VNET_INTERFACE_COUNTER_IP6);
96
97   while (n_left_from > 0)
98     {
99       u32 n_left_to_next;
100
101       vlib_get_next_frame (vm, node, next_index,
102                            to_next, n_left_to_next);
103
104       while (n_left_from >= 4 && n_left_to_next >= 2)
105         {
106           vlib_buffer_t * p0, * p1;
107           ip6_header_t * ip0, * ip1;
108           ip_config_main_t * cm0, * cm1;
109           u32 pi0, sw_if_index0, next0;
110           u32 pi1, sw_if_index1, next1;
111           u8 error0, error1, cast0, cast1;
112
113           /* Prefetch next iteration. */
114           {
115             vlib_buffer_t * p2, * p3;
116
117             p2 = vlib_get_buffer (vm, from[2]);
118             p3 = vlib_get_buffer (vm, from[3]);
119
120             vlib_prefetch_buffer_header (p2, LOAD);
121             vlib_prefetch_buffer_header (p3, LOAD);
122
123             CLIB_PREFETCH (p2->data, sizeof (ip0[0]), LOAD);
124             CLIB_PREFETCH (p3->data, sizeof (ip1[0]), LOAD);
125           }
126
127           pi0 = from[0];
128           pi1 = from[1];
129
130           to_next[0] = pi0;
131           to_next[1] = pi1;
132           from += 2;
133           to_next += 2;
134           n_left_from -= 2;
135           n_left_to_next -= 2;
136
137           p0 = vlib_get_buffer (vm, pi0);
138           p1 = vlib_get_buffer (vm, pi1);
139
140           ip0 = vlib_buffer_get_current (p0);
141           ip1 = vlib_buffer_get_current (p1);
142
143           sw_if_index0 = vnet_buffer (p0)->sw_if_index[VLIB_RX];
144           sw_if_index1 = vnet_buffer (p1)->sw_if_index[VLIB_RX];
145
146           cast0 = ip6_address_is_multicast (&ip0->dst_address) ? VNET_MULTICAST : VNET_UNICAST;
147           cast1 = ip6_address_is_multicast (&ip1->dst_address) ? VNET_MULTICAST : VNET_UNICAST;
148
149           cm0 = lm->rx_config_mains + cast0;
150           cm1 = lm->rx_config_mains + cast1;
151
152           p0->current_config_index = vec_elt (cm0->config_index_by_sw_if_index, sw_if_index0);
153           p1->current_config_index = vec_elt (cm1->config_index_by_sw_if_index, sw_if_index1);
154
155           vnet_buffer (p0)->ip.adj_index[VLIB_RX] = ~0;
156           vnet_buffer (p1)->ip.adj_index[VLIB_RX] = ~0;
157
158           vnet_get_config_data (&cm0->config_main,
159                                 &p0->current_config_index,
160                                 &next0,
161                                 /* # bytes of config data */ 0);
162           vnet_get_config_data (&cm1->config_main,
163                                 &p1->current_config_index,
164                                 &next1,
165                                 /* # bytes of config data */ 0);
166
167           vlib_increment_simple_counter (cm, cpu_index, sw_if_index0, 1);
168           vlib_increment_simple_counter (cm, cpu_index, sw_if_index1, 1);
169
170           error0 = error1 = IP6_ERROR_NONE;
171
172           /* Version != 6?  Drop it. */
173           error0 = (clib_net_to_host_u32 (ip0->ip_version_traffic_class_and_flow_label) >> 28) != 6 ? IP6_ERROR_VERSION : error0;
174           error1 = (clib_net_to_host_u32 (ip1->ip_version_traffic_class_and_flow_label) >> 28) != 6 ? IP6_ERROR_VERSION : error1;
175
176           /* hop limit < 1? Drop it.  for link-local broadcast packets,
177            * like dhcpv6 packets from client has hop-limit 1, which should not
178            * be dropped.
179            */
180           error0 = ip0->hop_limit <= 1 ? IP6_ERROR_TIME_EXPIRED : error0;
181           error1 = ip1->hop_limit <= 1 ? IP6_ERROR_TIME_EXPIRED : error1;
182
183           /* L2 length must be at least minimal IP header. */
184           error0 = p0->current_length < sizeof (ip0[0]) ? IP6_ERROR_TOO_SHORT : error0;
185           error1 = p1->current_length < sizeof (ip1[0]) ? IP6_ERROR_TOO_SHORT : error1;
186
187       if (PREDICT_FALSE(error0 != IP6_ERROR_NONE))
188         {
189           if (error0 == IP6_ERROR_TIME_EXPIRED) {
190             icmp6_error_set_vnet_buffer(p0, ICMP6_time_exceeded,
191                                           ICMP6_time_exceeded_ttl_exceeded_in_transit, 0);
192             next0 = IP6_INPUT_NEXT_ICMP_ERROR;
193           } else {
194             next0 = IP6_INPUT_NEXT_DROP;
195           }
196         }
197       if (PREDICT_FALSE(error1 != IP6_ERROR_NONE))
198         {
199           if (error1 == IP6_ERROR_TIME_EXPIRED) {
200             icmp6_error_set_vnet_buffer(p1, ICMP6_time_exceeded,
201                                           ICMP6_time_exceeded_ttl_exceeded_in_transit, 0);
202             next1 = IP6_INPUT_NEXT_ICMP_ERROR;
203           } else {
204             next1 = IP6_INPUT_NEXT_DROP;
205           }
206         }
207
208           p0->error = error_node->errors[error0];
209           p1->error = error_node->errors[error1];
210
211           vlib_validate_buffer_enqueue_x2 (vm, node, next_index,
212                                            to_next, n_left_to_next,
213                                            pi0, pi1, next0, next1);
214         }
215     
216       while (n_left_from > 0 && n_left_to_next > 0)
217         {
218           vlib_buffer_t * p0;
219           ip6_header_t * ip0;
220                   ip_config_main_t * cm0;
221           u32 pi0, sw_if_index0, next0;
222           u8 error0, cast0;
223
224           pi0 = from[0];
225           to_next[0] = pi0;
226           from += 1;
227           to_next += 1;
228           n_left_from -= 1;
229           n_left_to_next -= 1;
230
231           p0 = vlib_get_buffer (vm, pi0);
232           ip0 = vlib_buffer_get_current (p0);
233
234           sw_if_index0 = vnet_buffer (p0)->sw_if_index[VLIB_RX];
235           cast0 = ip6_address_is_multicast (&ip0->dst_address) ? VNET_MULTICAST : VNET_UNICAST;
236           cm0 = lm->rx_config_mains + cast0;
237           p0->current_config_index = vec_elt (cm0->config_index_by_sw_if_index, sw_if_index0);
238           vnet_buffer (p0)->ip.adj_index[VLIB_RX] = ~0;
239
240           vnet_get_config_data (&cm0->config_main,
241                                 &p0->current_config_index,
242                                 &next0,
243                                 /* # bytes of config data */ 0);
244
245           vlib_increment_simple_counter (cm, cpu_index, sw_if_index0, 1);
246           error0 = IP6_ERROR_NONE;
247
248           /* Version != 6?  Drop it. */
249           error0 = (clib_net_to_host_u32 (ip0->ip_version_traffic_class_and_flow_label) >> 28) != 6 ? IP6_ERROR_VERSION : error0;
250
251           /* hop limit < 1? Drop it. for link-local broadcast packets,
252            * like dhcpv6 packets from client has hop-limit 1, which should not
253            * be dropped.
254            */
255           error0 = ip0->hop_limit <= 1 ? IP6_ERROR_TIME_EXPIRED : error0;
256
257           /* L2 length must be at least minimal IP header. */
258           error0 = p0->current_length < sizeof (ip0[0]) ? IP6_ERROR_TOO_SHORT : error0;
259
260       if (PREDICT_FALSE(error0 != IP6_ERROR_NONE))
261         {
262           if (error0 == IP6_ERROR_TIME_EXPIRED) {
263             icmp6_error_set_vnet_buffer(p0, ICMP6_time_exceeded,
264                                           ICMP6_time_exceeded_ttl_exceeded_in_transit, 0);
265             next0 = IP6_INPUT_NEXT_ICMP_ERROR;
266           } else {
267             next0 = IP6_INPUT_NEXT_DROP;
268           }
269         }
270           p0->error = error_node->errors[error0];
271
272           vlib_validate_buffer_enqueue_x1 (vm, node, next_index,
273                                            to_next, n_left_to_next,
274                                            pi0, next0);
275         }
276
277       vlib_put_next_frame (vm, node, next_index, n_left_to_next);
278     }
279
280   return frame->n_vectors;
281 }
282
283 static char * ip6_error_strings[] = {
284 #define _(sym,string) string,
285   foreach_ip6_error
286 #undef _
287 };
288
289 VLIB_REGISTER_NODE (ip6_input_node) = {
290   .function = ip6_input,
291   .name = "ip6-input",
292   .vector_size = sizeof (u32),
293
294   .n_errors = IP6_N_ERROR,
295   .error_strings = ip6_error_strings,
296
297   .n_next_nodes = IP6_INPUT_N_NEXT,
298   .next_nodes = {
299     [IP6_INPUT_NEXT_DROP] = "error-drop",
300     [IP6_INPUT_NEXT_LOOKUP] = "ip6-lookup",
301     [IP6_INPUT_NEXT_ICMP_ERROR] = "ip6-icmp-error",
302   },
303
304   .format_buffer = format_ip6_header,
305   .format_trace = format_ip6_input_trace,
306 };
307
308 VLIB_NODE_FUNCTION_MULTIARCH (ip6_input_node, ip6_input)
309
310 static clib_error_t * ip6_init (vlib_main_t * vm)
311 {
312   ethernet_register_input_type (vm, ETHERNET_TYPE_IP6,
313                                 ip6_input_node.index);
314   ppp_register_input_protocol (vm, PPP_PROTOCOL_ip6,
315                                ip6_input_node.index);
316   hdlc_register_input_protocol (vm, HDLC_PROTOCOL_ip6,
317                                 ip6_input_node.index);
318
319   {
320     pg_node_t * pn;
321     pn = pg_get_node (ip6_input_node.index);
322     pn->unformat_edit = unformat_pg_ip6_header;
323   }
324
325   /* Set flow hash to something non-zero. */
326   ip6_main.flow_hash_seed = 0xdeadbeef;
327
328   /* Default hop limit for packets we generate. */
329   ip6_main.host_config.ttl = 64;
330
331   return /* no error */ 0;
332 }
333
334 VLIB_INIT_FUNCTION (ip6_init);