FD.io VPP  v20.09-64-g4f7b92f0a
Vector Packet Processing
ip6_format.c
Go to the documentation of this file.
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_format.c: ip6 formatting
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 
42 /* Format an IP6 address. */
43 u8 *
44 format_ip6_address (u8 * s, va_list * args)
45 {
46  ip6_address_t *a = va_arg (*args, ip6_address_t *);
47  u32 max_zero_run = 0, this_zero_run = 0;
48  int max_zero_run_index = -1, this_zero_run_index = 0;
49  int in_zero_run = 0, i;
50  int last_double_colon = 0;
51 
52  /* Ugh, this is a pain. Scan forward looking for runs of 0's */
53  for (i = 0; i < ARRAY_LEN (a->as_u16); i++)
54  {
55  if (a->as_u16[i] == 0)
56  {
57  if (in_zero_run)
58  this_zero_run++;
59  else
60  {
61  in_zero_run = 1;
62  this_zero_run = 1;
63  this_zero_run_index = i;
64  }
65  }
66  else
67  {
68  if (in_zero_run)
69  {
70  /* offer to compress the biggest run of > 1 zero */
71  if (this_zero_run > max_zero_run && this_zero_run > 1)
72  {
73  max_zero_run_index = this_zero_run_index;
74  max_zero_run = this_zero_run;
75  }
76  }
77  in_zero_run = 0;
78  this_zero_run = 0;
79  }
80  }
81 
82  if (in_zero_run)
83  {
84  if (this_zero_run > max_zero_run && this_zero_run > 1)
85  {
86  max_zero_run_index = this_zero_run_index;
87  max_zero_run = this_zero_run;
88  }
89  }
90 
91  for (i = 0; i < ARRAY_LEN (a->as_u16); i++)
92  {
93  if (i == max_zero_run_index)
94  {
95  s = format (s, "::");
96  i += max_zero_run - 1;
97  last_double_colon = 1;
98  }
99  else
100  {
101  s = format (s, "%s%x",
102  (last_double_colon || i == 0) ? "" : ":",
103  clib_net_to_host_u16 (a->as_u16[i]));
104  last_double_colon = 0;
105  }
106  }
107 
108  return s;
109 }
110 
111 /* Format an IP6 route destination and length. */
112 u8 *
113 format_ip6_address_and_length (u8 * s, va_list * args)
114 {
115  ip6_address_t *a = va_arg (*args, ip6_address_t *);
116  u8 l = va_arg (*args, u32);
117  return format (s, "%U/%d", format_ip6_address, a, l);
118 }
119 
120 u8 *
121 format_ip6_address_and_mask (u8 * s, va_list * args)
122 {
123  ip6_address_and_mask_t *am = va_arg (*args, ip6_address_and_mask_t *);
124 
125  if (am->addr.as_u64[0] == 0 && am->addr.as_u64[1] == 0 &&
126  am->mask.as_u64[0] == 0 && am->mask.as_u64[1] == 0)
127  return format (s, "any");
128 
129  if (am->mask.as_u64[0] == ~0 && am->mask.as_u64[1] == ~0)
130  return format (s, "%U", format_ip6_address, &am->addr);
131 
132  return format (s, "%U/%U", format_ip6_address, &am->addr,
133  format_ip6_address, &am->mask);
134 }
135 
136 /* Parse an IP6 address. */
137 uword
138 unformat_ip6_address (unformat_input_t * input, va_list * args)
139 {
140  ip6_address_t *result = va_arg (*args, ip6_address_t *);
141  u16 hex_quads[8];
142  uword hex_quad, n_hex_quads, hex_digit, n_hex_digits;
143  uword c, n_colon, double_colon_index;
144 
145  n_hex_quads = hex_quad = n_hex_digits = n_colon = 0;
146  double_colon_index = ARRAY_LEN (hex_quads);
147  while ((c = unformat_get_input (input)) != UNFORMAT_END_OF_INPUT)
148  {
149  hex_digit = 16;
150  if (c >= '0' && c <= '9')
151  hex_digit = c - '0';
152  else if (c >= 'a' && c <= 'f')
153  hex_digit = c + 10 - 'a';
154  else if (c >= 'A' && c <= 'F')
155  hex_digit = c + 10 - 'A';
156  else if (c == ':' && n_colon < 2)
157  n_colon++;
158  else
159  {
160  unformat_put_input (input);
161  break;
162  }
163 
164  /* Too many hex quads. */
165  if (n_hex_quads >= ARRAY_LEN (hex_quads))
166  return 0;
167 
168  if (hex_digit < 16)
169  {
170  hex_quad = (hex_quad << 4) | hex_digit;
171 
172  /* Hex quad must fit in 16 bits. */
173  if (n_hex_digits >= 4)
174  return 0;
175 
176  n_colon = 0;
177  n_hex_digits++;
178  }
179 
180  /* Save position of :: */
181  if (n_colon == 2)
182  {
183  /* More than one :: ? */
184  if (double_colon_index < ARRAY_LEN (hex_quads))
185  return 0;
186  double_colon_index = n_hex_quads;
187  }
188 
189  if (n_colon > 0 && n_hex_digits > 0)
190  {
191  hex_quads[n_hex_quads++] = hex_quad;
192  hex_quad = 0;
193  n_hex_digits = 0;
194  }
195  }
196 
197  if (n_hex_digits > 0)
198  hex_quads[n_hex_quads++] = hex_quad;
199 
200  {
201  word i;
202 
203  /* Expand :: to appropriate number of zero hex quads. */
204  if (double_colon_index < ARRAY_LEN (hex_quads))
205  {
206  word n_zero = ARRAY_LEN (hex_quads) - n_hex_quads;
207 
208  for (i = n_hex_quads - 1; i >= (signed) double_colon_index; i--)
209  hex_quads[n_zero + i] = hex_quads[i];
210 
211  for (i = 0; i < n_zero; i++)
212  {
213  ASSERT ((double_colon_index + i) < ARRAY_LEN (hex_quads));
214  hex_quads[double_colon_index + i] = 0;
215  }
216 
217  n_hex_quads = ARRAY_LEN (hex_quads);
218  }
219 
220  /* Too few hex quads given. */
221  if (n_hex_quads < ARRAY_LEN (hex_quads))
222  return 0;
223 
224  for (i = 0; i < ARRAY_LEN (hex_quads); i++)
225  result->as_u16[i] = clib_host_to_net_u16 (hex_quads[i]);
226 
227  return 1;
228  }
229 }
230 
231 uword
233 {
234  ip6_address_and_mask_t *am = va_arg (*args, ip6_address_and_mask_t *);
235  ip6_address_t addr, mask;
236 
237  clib_memset (&addr, 0, sizeof (ip6_address_t));
238  clib_memset (&mask, 0, sizeof (ip6_address_t));
239 
240  if (unformat (input, "any"))
241  ;
242  else if (unformat (input, "%U/%U", unformat_ip6_address, &addr,
243  unformat_ip6_address, &mask))
244  ;
245  else if (unformat (input, "%U", unformat_ip6_address, &addr))
246  mask.as_u64[0] = mask.as_u64[1] = ~0;
247  else
248  return 0;
249 
250  am->addr.as_u64[0] = addr.as_u64[0];
251  am->addr.as_u64[1] = addr.as_u64[1];
252  am->mask.as_u64[0] = mask.as_u64[0];
253  am->mask.as_u64[1] = mask.as_u64[1];
254  return 1;
255 }
256 
257 /* Format an IP6 header. */
258 u8 *
259 format_ip6_header (u8 * s, va_list * args)
260 {
261  ip6_header_t *ip = va_arg (*args, ip6_header_t *);
262  u32 max_header_bytes = va_arg (*args, u32);
263  u32 i, ip_version, traffic_class, flow_label;
264  u32 indent;
265 
266  /* Nothing to do. */
267  if (max_header_bytes < sizeof (ip[0]))
268  return format (s, "IP header truncated");
269 
270  indent = format_get_indent (s);
271  indent += 2;
272 
273  s = format (s, "%U: %U -> %U",
277 
278  i = clib_net_to_host_u32 (ip->ip_version_traffic_class_and_flow_label);
279  ip_version = (i >> 28);
280  traffic_class = (i >> 20) & 0xff;
281  flow_label = i & pow2_mask (20);
282 
283  if (ip_version != 6)
284  s = format (s, "\n%Uversion %d", format_white_space, indent, ip_version);
285 
286  s =
287  format (s,
288  "\n%Utos 0x%02x, flow label 0x%x, hop limit %d, payload length %d",
289  format_white_space, indent, traffic_class, flow_label,
290  ip->hop_limit, clib_net_to_host_u16 (ip->payload_length));
291 
292  /* Recurse into next protocol layer. */
293  if (max_header_bytes != 0 && sizeof (ip[0]) < max_header_bytes)
294  {
295  ip_main_t *im = &ip_main;
297 
298  if (pi && pi->format_header)
299  s = format (s, "\n%U%U",
300  format_white_space, indent - 2, pi->format_header,
301  /* next protocol header */ (void *) (ip + 1),
302  max_header_bytes - sizeof (ip[0]));
303  }
304 
305  return s;
306 }
307 
308 /* Parse an IP6 header. */
309 uword
310 unformat_ip6_header (unformat_input_t * input, va_list * args)
311 {
312  u8 **result = va_arg (*args, u8 **);
313  ip6_header_t *ip;
314  int old_length;
315 
316  /* Allocate space for IP header. */
317  {
318  void *p;
319 
320  old_length = vec_len (*result);
321  vec_add2 (*result, p, sizeof (ip[0]));
322  ip = p;
323  }
324 
325  clib_memset (ip, 0, sizeof (ip[0]));
327  clib_host_to_net_u32 (6 << 28);
328 
329  if (!unformat (input, "%U: %U -> %U",
333  return 0;
334 
335  /* Parse options. */
336  while (1)
337  {
338  int i;
339 
340  if (unformat (input, "tos %U", unformat_vlib_number, &i))
342  clib_host_to_net_u32 ((i & 0xff) << 20);
343 
344  else if (unformat (input, "hop-limit %U", unformat_vlib_number, &i))
345  ip->hop_limit = i;
346 
347  /* Can't parse input: try next protocol level. */
348  else
349  break;
350  }
351 
352  /* Recurse into next protocol layer. */
353  {
354  ip_main_t *im = &ip_main;
356 
357  if (pi && pi->unformat_header)
358  {
359  if (!unformat_user (input, pi->unformat_header, result))
360  return 0;
361 
362  /* Result may have moved. */
363  ip = (void *) *result + old_length;
364  }
365  }
366 
367  ip->payload_length =
368  clib_host_to_net_u16 (vec_len (*result) - (old_length + sizeof (ip[0])));
369 
370  return 1;
371 }
372 
373 /* Parse an IP46 address. */
374 uword
375 unformat_ip46_address (unformat_input_t * input, va_list * args)
376 {
377  ip46_address_t *ip46 = va_arg (*args, ip46_address_t *);
378  ip46_type_t type = va_arg (*args, ip46_type_t);
379  if ((type != IP46_TYPE_IP6) &&
380  unformat (input, "%U", unformat_ip4_address, &ip46->ip4))
381  {
382  ip46_address_mask_ip4 (ip46);
383  return 1;
384  }
385  else if ((type != IP46_TYPE_IP4) &&
386  unformat (input, "%U", unformat_ip6_address, &ip46->ip6))
387  {
388  return 1;
389  }
390  return 0;
391 }
392 
393 /* Format an IP46 address. */
394 u8 *
395 format_ip46_address (u8 * s, va_list * args)
396 {
397  ip46_address_t *ip46 = va_arg (*args, ip46_address_t *);
398  ip46_type_t type = va_arg (*args, ip46_type_t);
399  int is_ip4 = 1;
400 
401  switch (type)
402  {
403  case IP46_TYPE_ANY:
404  is_ip4 = ip46_address_is_ip4 (ip46);
405  break;
406  case IP46_TYPE_IP4:
407  is_ip4 = 1;
408  break;
409  case IP46_TYPE_IP6:
410  is_ip4 = 0;
411  break;
412  }
413 
414  return is_ip4 ?
415  format (s, "%U", format_ip4_address, &ip46->ip4) :
416  format (s, "%U", format_ip6_address, &ip46->ip6);
417 }
418 
419 u8 *
420 format_ip6_frag_hdr (u8 * s, va_list * args)
421 {
422  ip6_frag_hdr_t *h = va_arg (*args, ip6_frag_hdr_t *);
423  u32 max_header_bytes = va_arg (*args, u32);
424  u32 header_bytes;
425 
426  header_bytes = sizeof (h[0]);
427  if (max_header_bytes != 0 && header_bytes > max_header_bytes)
428  return format (s, "ipv6 frag header truncated");
429 
430  s =
431  format (s,
432  "IPV6_FRAG_HDR: next_hdr: %u, rsv: %u, frag_offset_and_more: %u, id: %u",
433  h->next_hdr, h->rsv, h->fragment_offset_and_more,
434  clib_net_to_host_u32 (h->identification));
435  return s;
436 }
437 
438 /*
439  * fd.io coding-style-patch-verification: ON
440  *
441  * Local Variables:
442  * eval: (c-set-style "gnu")
443  * End:
444  */
format_function_t format_ip_protocol
Definition: format.h:45
unformat_function_t unformat_ip_protocol
Definition: format.h:46
a
Definition: bitmap.h:538
static void ip46_address_mask_ip4(ip46_address_t *ip46)
Definition: ip46_address.h:61
static uword unformat_get_input(unformat_input_t *input)
Definition: format.h:192
u8 * format_ip6_header(u8 *s, va_list *args)
Definition: ip6_format.c:259
clib_memset(h->entries, 0, sizeof(h->entries[0]) *entries)
#define vec_add2(V, P, N)
Add N elements to end of vector V, return pointer to new elements in P.
Definition: vec.h:630
uword unformat_user(unformat_input_t *input, unformat_function_t *func,...)
Definition: unformat.c:989
static u32 format_get_indent(u8 *s)
Definition: format.h:72
u8 * format(u8 *s, const char *fmt,...)
Definition: format.c:424
Definition: ip.h:107
u16 mask
Definition: flow_types.api:52
static u8 ip46_address_is_ip4(const ip46_address_t *ip46)
Definition: ip46_address.h:55
vhost_vring_addr_t addr
Definition: vhost_user.h:111
ip6_address_t src_address
Definition: ip6_packet.h:310
unsigned char u8
Definition: types.h:56
uword unformat_vlib_number(unformat_input_t *input, va_list *args)
Definition: format.c:148
format_function_t format_ip4_address
Definition: format.h:73
i64 word
Definition: types.h:111
unformat_function_t unformat_ip4_address
Definition: format.h:68
static uword pow2_mask(uword x)
Definition: clib.h:237
u8 * format_white_space(u8 *s, va_list *va)
Definition: std-formats.c:129
uword unformat_ip46_address(unformat_input_t *input, va_list *args)
Definition: ip6_format.c:375
unsigned int u32
Definition: types.h:88
uword unformat_ip6_header(unformat_input_t *input, va_list *args)
Definition: ip6_format.c:310
vl_api_fib_path_type_t type
Definition: fib_types.api:123
static ip_protocol_info_t * ip_get_protocol_info(ip_main_t *im, u32 protocol)
Definition: ip.h:134
ip6_address_t mask
Definition: ip6_packet.h:61
format_function_t * format_header
Definition: ip.h:79
struct _unformat_input_t unformat_input_t
unsigned short u16
Definition: types.h:57
vec_header_t h
Definition: buffer.c:322
static void unformat_put_input(unformat_input_t *input)
Definition: format.h:205
#define UNFORMAT_END_OF_INPUT
Definition: format.h:145
svmdb_client_t * c
ip_main_t ip_main
Definition: ip_init.c:42
sll srl srl sll sra u16x4 i
Definition: vector_sse42.h:317
uword unformat_ip6_address(unformat_input_t *input, va_list *args)
Definition: ip6_format.c:138
#define ARRAY_LEN(x)
Definition: clib.h:67
u8 * format_ip6_frag_hdr(u8 *s, va_list *args)
Definition: ip6_format.c:420
#define ASSERT(truth)
u8 * format_ip6_address_and_length(u8 *s, va_list *args)
Definition: ip6_format.c:113
unformat_function_t * unformat_header
Definition: ip.h:82
u8 * format_ip6_address_and_mask(u8 *s, va_list *args)
Definition: ip6_format.c:121
u8 * format_ip6_address(u8 *s, va_list *args)
Definition: ip6_format.c:44
u32 ip_version_traffic_class_and_flow_label
Definition: ip6_packet.h:297
ip6_address_t addr
Definition: ip6_packet.h:61
u16 payload_length
Definition: ip6_packet.h:301
vl_api_address_t ip
Definition: l2.api:501
uword unformat_ip6_address_and_mask(unformat_input_t *input, va_list *args)
Definition: ip6_format.c:232
#define vec_len(v)
Number of elements in vector (rvalue-only, NULL tolerant)
u8 * format_ip46_address(u8 *s, va_list *args)
Definition: ip6_format.c:395
u64 uword
Definition: types.h:112
uword unformat(unformat_input_t *i, const char *fmt,...)
Definition: unformat.c:978
ip6_address_t dst_address
Definition: ip6_packet.h:310
ip46_type_t
Definition: ip46_address.h:22