summaryrefslogtreecommitdiffstats
path: root/src/vppinfra/test_timing_wheel.c
blob: 0ce15ad88cb7c112a387ab656f0286a8bb10f6c0 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363
364
365
366
367
368
369
370
371
372
373
374
375
376
377
378
379
380
381
382
383
384
385
386
387
388
389
/*
 * Copyright (c) 2015 Cisco and/or its affiliates.
 * Licensed under the Apache License, Version 2.0 (the "License");
 * you may not use this file except in compliance with the License.
 * You may obtain a copy of the License at:
 *
 *     http://www.apache.org/licenses/LICENSE-2.0
 *
 * Unless required by applicable law or agreed to in writing, software
 * distributed under the License is distributed on an "AS IS" BASIS,
 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
 * See the License for the specific language governing permissions and
 * limitations under the License.
 */
#include <vppinfra/bitmap.h>
#include <vppinfra/error.h>
#include <vppinfra/format.h>
#include <vppinfra/pool.h>
#include <vppinfra/random.h>
#include <vppinfra/time.h>
#include <vppinfra/timing_wheel.h>
#include <vppinfra/zvec.h>

#include <vppinfra/math.h>

#if __GNUC__ < 4
#define SQRT(a) a
#else
#define SQRT(a) sqrt(a)
#endif

typedef struct
{
  uword n_iter;

  u32 n_events;
  u32 seed;
  u32 verbose;

  /* Time is "synthetic" e.g. not taken from CPU timer. */
  u32 synthetic_time;

  clib_time_t time;
  timing_wheel_t timing_wheel;

  u64 *events;

  f64 max_time;
  f64 wait_time;

  f64 total_iterate_time;
  f64 time_iterate_start;

  f64 time_per_status_update;
  f64 time_next_status_update;
} test_timing_wheel_main_t;

typedef struct
{
  f64 dt;
  f64 fraction;
  u64 count;
} test_timing_wheel_tmp_t;

static void
set_event (test_timing_wheel_main_t * tm, uword i)
{
  timing_wheel_t *w = &tm->timing_wheel;
  u64 cpu_time;

  cpu_time = w->current_time_index << w->log2_clocks_per_bin;
  if (tm->synthetic_time)
    cpu_time += random_u32 (&tm->seed) % tm->n_iter;
  else
    cpu_time +=
      random_f64 (&tm->seed) * tm->max_time * tm->time.clocks_per_second;

  timing_wheel_insert (w, cpu_time, i);
  timing_wheel_validate (w);
  tm->events[i] = cpu_time;
}

static int
test_timing_wheel_tmp_cmp (void *a1, void *a2)
{
  test_timing_wheel_tmp_t *f1 = a1;
  test_timing_wheel_tmp_t *f2 = a2;

  return f1->dt < f2->dt ? -1 : (f1->dt > f2->dt ? +1 : 0);
}

clib_error_t *
test_timing_wheel_main (unformat_input_t * input)
{
  clib_error_t *error = 0;
  test_timing_wheel_main_t _tm, *tm = &_tm;
  timing_wheel_t *w = &tm->timing_wheel;
  uword iter, i;

  memset (tm, 0, sizeof (tm[0]));
  tm->n_iter = 10;
  tm->time_per_status_update = 0;
  tm->n_events = 100;
  tm->seed = 1;
  tm->synthetic_time = 1;
  tm->max_time = 1;
  tm->wait_time = 1e-3;

  w->validate = 0;
  w->n_wheel_elt_time_bits = 32;

  while (unformat_check_input (input) != UNFORMAT_END_OF_INPUT)
    {
      if (unformat (input, "iter %wd", &tm->n_iter))
	;
      else if (unformat (input, "events %d", &tm->n_events))
	;
      else
	if (unformat (input, "elt-time-bits %d", &w->n_wheel_elt_time_bits))
	;
      else if (unformat (input, "seed %d", &tm->seed))
	;
      else if (unformat (input, "verbose"))
	tm->verbose = 1;
      else if (unformat (input, "validate"))
	w->validate = 1;

      else if (unformat (input, "real-time"))
	tm->synthetic_time = 0;
      else if (unformat (input, "synthetic-time"))
	tm->synthetic_time = 1;
      else if (unformat (input, "max-time %f", &tm->max_time))
	;
      else if (unformat (input, "wait-time %f", &tm->wait_time))
	;
      else if (unformat (input, "iter-time %f", &tm->total_iterate_time))
	;
      else if (unformat (input, "print %f", &tm->time_per_status_update))
	;

      else
	{
	  error = clib_error_create ("unknown input `%U'\n",
				     format_unformat_error, input);
	  goto done;
	}
    }

  if (!tm->seed)
    tm->seed = random_default_seed ();

  clib_time_init (&tm->time);

  if (tm->synthetic_time)
    {
      w->min_sched_time = tm->time.seconds_per_clock;
      w->max_sched_time = w->min_sched_time * 256;
      timing_wheel_init (w, 0, tm->time.clocks_per_second);
    }
  else
    {
      timing_wheel_init (w, clib_cpu_time_now (), tm->time.clocks_per_second);
    }

  clib_warning ("iter %wd, events %d, seed %u, %U",
		tm->n_iter, tm->n_events, tm->seed,
		format_timing_wheel, &tm->timing_wheel, /* verbose */ 0);

  /* Make some events. */
  vec_resize (tm->events, tm->n_events);
  for (i = 0; i < vec_len (tm->events); i++)
    set_event (tm, i);

  {
    u32 *expired = 0;
    f64 ave_error = 0;
    f64 rms_error = 0;
    f64 max_error = 0, min_error = 1e30;
    u32 *error_hist = 0;
    uword n_expired = 0;
    uword *expired_bitmap[2] = { 0 };
    uword n_events_in_wheel = vec_len (tm->events);

    vec_resize (expired, 32);
    vec_resize (error_hist, 1024);

    tm->time_iterate_start = clib_time_now (&tm->time);
    tm->time_next_status_update =
      tm->time_iterate_start + tm->time_per_status_update;

    if (tm->total_iterate_time != 0)
      tm->n_iter = ~0;

    for (iter = 0; iter < tm->n_iter || n_events_in_wheel > 0; iter++)
      {
	u64 cpu_time, min_next_time[2];

	if (tm->synthetic_time)
	  cpu_time = iter << w->log2_clocks_per_bin;
	else
	  cpu_time = clib_cpu_time_now ();

	_vec_len (expired) = 0;
	expired =
	  timing_wheel_advance (w, cpu_time, expired, &min_next_time[0]);
	timing_wheel_validate (w);

	/* Update bitmap of expired events. */
	if (w->validate)
	  {
	    for (i = 0; i < vec_len (tm->events); i++)
	      {
		uword is_expired;

		is_expired =
		  (cpu_time >> w->log2_clocks_per_bin) >=
		  (tm->events[i] >> w->log2_clocks_per_bin);
		expired_bitmap[0] =
		  clib_bitmap_set (expired_bitmap[0], i, is_expired);

		/* Validate min next time. */
		if (is_expired)
		  ASSERT (min_next_time[0] > tm->events[i]);
		else
		  ASSERT (min_next_time[0] <= tm->events[i]);
	      }
	  }

	n_expired += vec_len (expired);
	for (i = 0; i < vec_len (expired); i++)
	  {
	    word j, idt;
	    i64 dt_cpu;
	    f64 fdt_cpu;

	    j = expired[i];
	    expired_bitmap[1] = clib_bitmap_ori (expired_bitmap[1], j);

	    dt_cpu = cpu_time - tm->events[j];

	    /* Event must be scheduled in correct bin. */
	    if (tm->synthetic_time)
	      ASSERT (dt_cpu >= 0 && dt_cpu <= (1 << w->log2_clocks_per_bin));

	    fdt_cpu = dt_cpu * tm->time.seconds_per_clock;

	    ave_error += fdt_cpu;
	    rms_error += fdt_cpu * fdt_cpu;

	    if (fdt_cpu > max_error)
	      max_error = fdt_cpu;
	    if (fdt_cpu < min_error)
	      min_error = fdt_cpu;

	    idt =
	      (cpu_time >> w->log2_clocks_per_bin) -
	      (tm->events[j] >> w->log2_clocks_per_bin);
	    idt = zvec_signed_to_unsigned (idt);
	    vec_validate (error_hist, idt);
	    error_hist[idt] += 1;
	  }

	if (w->validate)
	  for (i = 0; i < vec_len (tm->events); i++)
	    {
	      int is_expired = clib_bitmap_get (expired_bitmap[0], i);
	      int is_expired_w = clib_bitmap_get (expired_bitmap[1], i);
	      ASSERT (is_expired == is_expired_w);
	    }

	min_next_time[1] = ~0;
	for (i = 0; i < vec_len (tm->events); i++)
	  {
	    if (!clib_bitmap_get (expired_bitmap[1], i))
	      min_next_time[1] = clib_min (min_next_time[1], tm->events[i]);
	  }
	if (min_next_time[0] != min_next_time[1])
	  clib_error ("min next time wrong 0x%Lx != 0x%Lx", min_next_time[0],
		      min_next_time[1]);

	if (tm->time_per_status_update != 0
	    && clib_time_now (&tm->time) >= tm->time_next_status_update)
	  {
	    f64 ave = 0, rms = 0;

	    tm->time_next_status_update += tm->time_per_status_update;
	    if (n_expired > 0)
	      {
		ave = ave_error / n_expired;
		rms = SQRT (rms_error / n_expired - ave * ave);
	      }

	    clib_warning
	      ("%12wd iter done %10wd expired; ave. error %.4e +- %.4e, range %.4e %.4e",
	       iter, n_expired, ave, rms, min_error, max_error);
	  }

	if (tm->total_iterate_time != 0
	    && (clib_time_now (&tm->time) - tm->time_iterate_start
		>= tm->total_iterate_time))
	  tm->n_iter = iter;

	/* Add new events to wheel to replace expired ones. */
	n_events_in_wheel -= vec_len (expired);
	if (iter < tm->n_iter)
	  {
	    for (i = 0; i < vec_len (expired); i++)
	      {
		uword j = expired[i];
		set_event (tm, j);
		expired_bitmap[1] =
		  clib_bitmap_andnoti (expired_bitmap[1], j);
	      }
	    n_events_in_wheel += vec_len (expired);
	  }
      }

    ave_error /= n_expired;
    rms_error = SQRT (rms_error / n_expired - ave_error * ave_error);

    clib_warning
      ("%wd iter done %wd expired; ave. error %.4e +- %.4e, range %.4e %.4e",
       1 + iter, n_expired, ave_error, rms_error, min_error, max_error);

    {
      test_timing_wheel_tmp_t *fs, *f;
      f64 total_fraction;

      fs = 0;
      for (i = 0; i < vec_len (error_hist); i++)
	{
	  if (error_hist[i] == 0)
	    continue;
	  vec_add2 (fs, f, 1);
	  f->dt =
	    (((i64) zvec_unsigned_to_signed (i) << w->log2_clocks_per_bin) *
	     tm->time.seconds_per_clock);
	  f->fraction = (f64) error_hist[i] / (f64) n_expired;
	  f->count = error_hist[i];
	}

      vec_sort_with_function (fs, test_timing_wheel_tmp_cmp);

      total_fraction = 0;
      vec_foreach (f, fs)
      {
	total_fraction += f->fraction;
	if (f == fs)
	  fformat (stdout, "%=12s %=16s %=16s %s\n", "Error max", "Fraction",
		   "Total", "Count");
	fformat (stdout, "%12.4e %16.4f%% %16.4f%% %Ld\n", f->dt,
		 f->fraction * 100, total_fraction * 100, f->count);
      }
    }

    clib_warning ("%U", format_timing_wheel, w, /* verbose */ 1);
  }

done:
  return error;
}

#ifdef CLIB_UNIX
int
main (int argc, char *argv[])
{
  unformat_input_t i;
  clib_error_t *error;

  unformat_init_command_line (&i, argv);
  error = test_timing_wheel_main (&i);
  unformat_free (&i);
  if (error)
    {
      clib_error_report (error);
      return 1;
    }
  else
    return 0;
}
#endif /* CLIB_UNIX */

/*
 * fd.io coding-style-patch-verification: ON
 *
 * Local Variables:
 * eval: (c-set-style "gnu")
 * End:
 */
/span>vm, bi0); b1 = vlib_get_buffer (vm, bi1); /* udp leaves current_data pointing at the gtpu header */ gtpu0 = vlib_buffer_get_current (b0); gtpu1 = vlib_buffer_get_current (b1); if (is_ip4) { vlib_buffer_advance (b0, -(word)(sizeof(udp_header_t)+sizeof(ip4_header_t))); vlib_buffer_advance (b1, -(word)(sizeof(udp_header_t)+sizeof(ip4_header_t))); ip4_0 = vlib_buffer_get_current (b0); ip4_1 = vlib_buffer_get_current (b1); } else { vlib_buffer_advance (b0, -(word)(sizeof(udp_header_t)+sizeof(ip6_header_t))); vlib_buffer_advance (b1, -(word)(sizeof(udp_header_t)+sizeof(ip6_header_t))); ip6_0 = vlib_buffer_get_current (b0); ip6_1 = vlib_buffer_get_current (b1); } /* pop (ip, udp, gtpu) */ if (is_ip4) { vlib_buffer_advance (b0, sizeof(*ip4_0)+sizeof(udp_header_t)); vlib_buffer_advance (b1, sizeof(*ip4_1)+sizeof(udp_header_t)); } else { vlib_buffer_advance (b0, sizeof(*ip6_0)+sizeof(udp_header_t)); vlib_buffer_advance (b1, sizeof(*ip6_1)+sizeof(udp_header_t)); } tunnel_index0 = ~0; error0 = 0; tunnel_index1 = ~0; error1 = 0; if (PREDICT_FALSE ((gtpu0->ver_flags & GTPU_VER_MASK) != GTPU_V1_VER)) { error0 = GTPU_ERROR_BAD_VER; next0 = GTPU_INPUT_NEXT_DROP; goto trace0; } /* Manipulate packet 0 */ if (is_ip4) { key4_0.src = ip4_0->src_address.as_u32; key4_0.teid = gtpu0->teid; /* Make sure GTPU tunnel exist according to packet SIP and teid * SIP identify a GTPU path, and teid identify a tunnel in a given GTPU path */ if (PREDICT_FALSE (key4_0.as_u64 != last_key4.as_u64)) { p0 = hash_get (gtm->gtpu4_tunnel_by_key, key4_0.as_u64); if (PREDICT_FALSE (p0 == NULL)) { error0 = GTPU_ERROR_NO_SUCH_TUNNEL; next0 = GTPU_INPUT_NEXT_DROP; goto trace0; } last_key4.as_u64 = key4_0.as_u64; tunnel_index0 = last_tunnel_index = p0[0]; } else tunnel_index0 = last_tunnel_index; t0 = pool_elt_at_index (gtm->tunnels, tunnel_index0); /* Validate GTPU tunnel encap-fib index agaist packet */ if (PREDICT_FALSE (validate_gtpu_fib (b0, t0, is_ip4) == 0)) { error0 = GTPU_ERROR_NO_SUCH_TUNNEL; next0 = GTPU_INPUT_NEXT_DROP; goto trace0; } /* Validate GTPU tunnel SIP against packet DIP */ if (PREDICT_TRUE (ip4_0->dst_address.as_u32 == t0->src.ip4.as_u32)) goto next0; /* valid packet */ if (PREDICT_FALSE (ip4_address_is_multicast (&ip4_0->dst_address))) { key4_0.src = ip4_0->dst_address.as_u32; key4_0.teid = gtpu0->teid; /* Make sure mcast GTPU tunnel exist by packet DIP and teid */ p0 = hash_get (gtm->gtpu4_tunnel_by_key, key4_0.as_u64); if (PREDICT_TRUE (p0 != NULL)) { mt0 = pool_elt_at_index (gtm->tunnels, p0[0]); goto next0; /* valid packet */ } } error0 = GTPU_ERROR_NO_SUCH_TUNNEL; next0 = GTPU_INPUT_NEXT_DROP; goto trace0; } else /* !is_ip4 */ { key6_0.src.as_u64[0] = ip6_0->src_address.as_u64[0]; key6_0.src.as_u64[1] = ip6_0->src_address.as_u64[1]; key6_0.teid = gtpu0->teid; /* Make sure GTPU tunnel exist according to packet SIP and teid * SIP identify a GTPU path, and teid identify a tunnel in a given GTPU path */ if (PREDICT_FALSE (memcmp(&key6_0, &last_key6, sizeof(last_key6)) != 0)) { p0 = hash_get_mem (gtm->gtpu6_tunnel_by_key, &key6_0); if (PREDICT_FALSE (p0 == NULL)) { error0 = GTPU_ERROR_NO_SUCH_TUNNEL; next0 = GTPU_INPUT_NEXT_DROP; goto trace0; } clib_memcpy (&last_key6, &key6_0, sizeof(key6_0)); tunnel_index0 = last_tunnel_index = p0[0]; } else tunnel_index0 = last_tunnel_index; t0 = pool_elt_at_index (gtm->tunnels, tunnel_index0); /* Validate GTPU tunnel encap-fib index agaist packet */ if (PREDICT_FALSE (validate_gtpu_fib (b0, t0, is_ip4) == 0)) { error0 = GTPU_ERROR_NO_SUCH_TUNNEL; next0 = GTPU_INPUT_NEXT_DROP; goto trace0; } /* Validate GTPU tunnel SIP against packet DIP */ if (PREDICT_TRUE (ip6_address_is_equal (&ip6_0->dst_address, &t0->src.ip6))) goto next0; /* valid packet */ if (PREDICT_FALSE (ip6_address_is_multicast (&ip6_0->dst_address))) { key6_0.src.as_u64[0] = ip6_0->dst_address.as_u64[0]; key6_0.src.as_u64[1] = ip6_0->dst_address.as_u64[1]; key6_0.teid = gtpu0->teid; p0 = hash_get_mem (gtm->gtpu6_tunnel_by_key, &key6_0); if (PREDICT_TRUE (p0 != NULL)) { mt0 = pool_elt_at_index (gtm->tunnels, p0[0]); goto next0; /* valid packet */ } } error0 = GTPU_ERROR_NO_SUCH_TUNNEL; next0 = GTPU_INPUT_NEXT_DROP; goto trace0; } next0: /* Manipulate gtpu header */ if (PREDICT_FALSE((gtpu0->ver_flags & GTPU_E_S_PN_BIT) != 0)) { gtpu_hdr_len0 = sizeof(gtpu_header_t); /* Manipulate Sequence Number and N-PDU Number */ /* TBD */ /* Manipulate Next Extension Header */ /* TBD */ } else { gtpu_hdr_len0 = sizeof(gtpu_header_t) - 4; } /* Pop gtpu header */ vlib_buffer_advance (b0, gtpu_hdr_len0); next0 = t0->decap_next_index; sw_if_index0 = t0->sw_if_index; len0 = vlib_buffer_length_in_chain (vm, b0); /* Required to make the l2 tag push / pop code work on l2 subifs */ if (PREDICT_TRUE(next0 == GTPU_INPUT_NEXT_L2_INPUT)) vnet_update_l2_len (b0); /* Set packet input sw_if_index to unicast GTPU tunnel for learning */ vnet_buffer(b0)->sw_if_index[VLIB_RX] = sw_if_index0; sw_if_index0 = (mt0) ? mt0->sw_if_index : sw_if_index0; pkts_decapsulated ++; stats_n_packets += 1; stats_n_bytes += len0; /* Batch stats increment on the same gtpu tunnel so counter is not incremented per packet */ if (PREDICT_FALSE (sw_if_index0 != stats_sw_if_index)) { stats_n_packets -= 1; stats_n_bytes -= len0; if (stats_n_packets) vlib_increment_combined_counter (im->combined_sw_if_counters + VNET_INTERFACE_COUNTER_RX, thread_index, stats_sw_if_index, stats_n_packets, stats_n_bytes); stats_n_packets = 1; stats_n_bytes = len0; stats_sw_if_index = sw_if_index0; } trace0: b0->error = error0 ? node->errors[error0] : 0; if (PREDICT_FALSE(b0->flags & VLIB_BUFFER_IS_TRACED)) { gtpu_rx_trace_t *tr = vlib_add_trace (vm, node, b0, sizeof (*tr)); tr->next_index = next0; tr->error = error0; tr->tunnel_index = tunnel_index0; tr->teid = clib_net_to_host_u32(gtpu0->teid); } if (PREDICT_FALSE ((gtpu1->ver_flags & GTPU_VER_MASK) != GTPU_V1_VER)) { error1 = GTPU_ERROR_BAD_VER; next1 = GTPU_INPUT_NEXT_DROP; goto trace1; } /* Manipulate packet 1 */ if (is_ip4) { key4_1.src = ip4_1->src_address.as_u32; key4_1.teid = gtpu1->teid; /* Make sure GTPU tunnel exist according to packet SIP and teid * SIP identify a GTPU path, and teid identify a tunnel in a given GTPU path */ if (PREDICT_FALSE (key4_1.as_u64 != last_key4.as_u64)) { p1 = hash_get (gtm->gtpu4_tunnel_by_key, key4_1.as_u64); if (PREDICT_FALSE (p1 == NULL)) { error1 = GTPU_ERROR_NO_SUCH_TUNNEL; next1 = GTPU_INPUT_NEXT_DROP; goto trace1; } last_key4.as_u64 = key4_1.as_u64; tunnel_index1 = last_tunnel_index = p1[0]; } else tunnel_index1 = last_tunnel_index; t1 = pool_elt_at_index (gtm->tunnels, tunnel_index1); /* Validate GTPU tunnel encap-fib index agaist packet */ if (PREDICT_FALSE (validate_gtpu_fib (b1, t1, is_ip4) == 0)) { error1 = GTPU_ERROR_NO_SUCH_TUNNEL; next1 = GTPU_INPUT_NEXT_DROP; goto trace1; } /* Validate GTPU tunnel SIP against packet DIP */ if (PREDICT_TRUE (ip4_1->dst_address.as_u32 == t1->src.ip4.as_u32)) goto next1; /* valid packet */ if (PREDICT_FALSE (ip4_address_is_multicast (&ip4_1->dst_address))) { key4_1.src = ip4_1->dst_address.as_u32; key4_1.teid = gtpu1->teid; /* Make sure mcast GTPU tunnel exist by packet DIP and teid */ p1 = hash_get (gtm->gtpu4_tunnel_by_key, key4_1.as_u64); if (PREDICT_TRUE (p1 != NULL)) { mt1 = pool_elt_at_index (gtm->tunnels, p1[0]); goto next1; /* valid packet */ } } error1 = GTPU_ERROR_NO_SUCH_TUNNEL; next1 = GTPU_INPUT_NEXT_DROP; goto trace1; } else /* !is_ip4 */ { key6_1.src.as_u64[0] = ip6_1->src_address.as_u64[0]; key6_1.src.as_u64[1] = ip6_1->src_address.as_u64[1]; key6_1.teid = gtpu1->teid; /* Make sure GTPU tunnel exist according to packet SIP and teid * SIP identify a GTPU path, and teid identify a tunnel in a given GTPU path */ if (PREDICT_FALSE (memcmp(&key6_1, &last_key6, sizeof(last_key6)) != 0)) { p1 = hash_get_mem (gtm->gtpu6_tunnel_by_key, &key6_1); if (PREDICT_FALSE (p1 == NULL)) { error1 = GTPU_ERROR_NO_SUCH_TUNNEL; next1 = GTPU_INPUT_NEXT_DROP; goto trace1; } clib_memcpy (&last_key6, &key6_1, sizeof(key6_1)); tunnel_index1 = last_tunnel_index = p1[0]; } else tunnel_index1 = last_tunnel_index; t1 = pool_elt_at_index (gtm->tunnels, tunnel_index1); /* Validate GTPU tunnel encap-fib index agaist packet */ if (PREDICT_FALSE (validate_gtpu_fib (b1, t1, is_ip4) == 0)) { error1 = GTPU_ERROR_NO_SUCH_TUNNEL; next1 = GTPU_INPUT_NEXT_DROP; goto trace1; } /* Validate GTPU tunnel SIP against packet DIP */ if (PREDICT_TRUE (ip6_address_is_equal (&ip6_1->dst_address, &t1->src.ip6))) goto next1; /* valid packet */ if (PREDICT_FALSE (ip6_address_is_multicast (&ip6_1->dst_address))) { key6_1.src.as_u64[0] = ip6_1->dst_address.as_u64[0]; key6_1.src.as_u64[1] = ip6_1->dst_address.as_u64[1]; key6_1.teid = gtpu1->teid; p1 = hash_get_mem (gtm->gtpu6_tunnel_by_key, &key6_1); if (PREDICT_TRUE (p1 != NULL)) { mt1 = pool_elt_at_index (gtm->tunnels, p1[0]); goto next1; /* valid packet */ } } error1 = GTPU_ERROR_NO_SUCH_TUNNEL; next1 = GTPU_INPUT_NEXT_DROP; goto trace1; } next1: /* Manipulate gtpu header */ if (PREDICT_FALSE((gtpu1->ver_flags & GTPU_E_S_PN_BIT) != 0)) { gtpu_hdr_len1 = sizeof(gtpu_header_t); /* Manipulate Sequence Number and N-PDU Number */ /* TBD */ /* Manipulate Next Extension Header */ /* TBD */ } else { gtpu_hdr_len1 = sizeof(gtpu_header_t) - 4; } /* Pop gtpu header */ vlib_buffer_advance (b1, gtpu_hdr_len1); next1 = t1->decap_next_index; sw_if_index1 = t1->sw_if_index; len1 = vlib_buffer_length_in_chain (vm, b1); /* Required to make the l2 tag push / pop code work on l2 subifs */ if (PREDICT_TRUE(next1 == GTPU_INPUT_NEXT_L2_INPUT)) vnet_update_l2_len (b1); /* Set packet input sw_if_index to unicast GTPU tunnel for learning */ vnet_buffer(b1)->sw_if_index[VLIB_RX] = sw_if_index1; sw_if_index1 = (mt1) ? mt1->sw_if_index : sw_if_index1; pkts_decapsulated ++; stats_n_packets += 1; stats_n_bytes += len1; /* Batch stats increment on the same gtpu tunnel so counter is not incremented per packet */ if (PREDICT_FALSE (sw_if_index1 != stats_sw_if_index)) { stats_n_packets -= 1; stats_n_bytes -= len1; if (stats_n_packets) vlib_increment_combined_counter (im->combined_sw_if_counters + VNET_INTERFACE_COUNTER_RX, thread_index, stats_sw_if_index, stats_n_packets, stats_n_bytes); stats_n_packets = 1; stats_n_bytes = len1; stats_sw_if_index = sw_if_index1; } trace1: b1->error = error1 ? node->errors[error1] : 0; if (PREDICT_FALSE(b1->flags & VLIB_BUFFER_IS_TRACED)) { gtpu_rx_trace_t *tr = vlib_add_trace (vm, node, b1, sizeof (*tr)); tr->next_index = next1; tr->error = error1; tr->tunnel_index = tunnel_index1; tr->teid = clib_net_to_host_u32(gtpu1->teid); } vlib_validate_buffer_enqueue_x2 (vm, node, next_index, to_next, n_left_to_next, bi0, bi1, next0, next1); } while (n_left_from > 0 && n_left_to_next > 0) { u32 bi0; vlib_buffer_t * b0; u32 next0; ip4_header_t * ip4_0; ip6_header_t * ip6_0; gtpu_header_t * gtpu0; u32 gtpu_hdr_len0 = 0; uword * p0; u32 tunnel_index0; gtpu_tunnel_t * t0, * mt0 = NULL; gtpu4_tunnel_key_t key4_0; gtpu6_tunnel_key_t key6_0; u32 error0; u32 sw_if_index0, len0; bi0 = from[0]; to_next[0] = bi0; from += 1; to_next += 1; n_left_from -= 1; n_left_to_next -= 1; b0 = vlib_get_buffer (vm, bi0); /* udp leaves current_data pointing at the gtpu header */ gtpu0 = vlib_buffer_get_current (b0); if (is_ip4) { vlib_buffer_advance (b0, -(word)(sizeof(udp_header_t)+sizeof(ip4_header_t))); ip4_0 = vlib_buffer_get_current (b0); } else { vlib_buffer_advance (b0, -(word)(sizeof(udp_header_t)+sizeof(ip6_header_t))); ip6_0 = vlib_buffer_get_current (b0); } /* pop (ip, udp) */ if (is_ip4) { vlib_buffer_advance (b0, sizeof(*ip4_0)+sizeof(udp_header_t)); } else { vlib_buffer_advance (b0, sizeof(*ip6_0)+sizeof(udp_header_t)); } tunnel_index0 = ~0; error0 = 0; if (PREDICT_FALSE ((gtpu0->ver_flags & GTPU_VER_MASK) != GTPU_V1_VER)) { error0 = GTPU_ERROR_BAD_VER; next0 = GTPU_INPUT_NEXT_DROP; goto trace00; } if (is_ip4) { key4_0.src = ip4_0->src_address.as_u32; key4_0.teid = gtpu0->teid; /* Make sure GTPU tunnel exist according to packet SIP and teid * SIP identify a GTPU path, and teid identify a tunnel in a given GTPU path */ if (PREDICT_FALSE (key4_0.as_u64 != last_key4.as_u64)) { p0 = hash_get (gtm->gtpu4_tunnel_by_key, key4_0.as_u64); if (PREDICT_FALSE (p0 == NULL)) { error0 = GTPU_ERROR_NO_SUCH_TUNNEL; next0 = GTPU_INPUT_NEXT_DROP; goto trace00; } last_key4.as_u64 = key4_0.as_u64; tunnel_index0 = last_tunnel_index = p0[0]; } else tunnel_index0 = last_tunnel_index; t0 = pool_elt_at_index (gtm->tunnels, tunnel_index0); /* Validate GTPU tunnel encap-fib index agaist packet */ if (PREDICT_FALSE (validate_gtpu_fib (b0, t0, is_ip4) == 0)) { error0 = GTPU_ERROR_NO_SUCH_TUNNEL; next0 = GTPU_INPUT_NEXT_DROP; goto trace00; } /* Validate GTPU tunnel SIP against packet DIP */ if (PREDICT_TRUE (ip4_0->dst_address.as_u32 == t0->src.ip4.as_u32)) goto next00; /* valid packet */ if (PREDICT_FALSE (ip4_address_is_multicast (&ip4_0->dst_address))) { key4_0.src = ip4_0->dst_address.as_u32; key4_0.teid = gtpu0->teid; /* Make sure mcast GTPU tunnel exist by packet DIP and teid */ p0 = hash_get (gtm->gtpu4_tunnel_by_key, key4_0.as_u64); if (PREDICT_TRUE (p0 != NULL)) { mt0 = pool_elt_at_index (gtm->tunnels, p0[0]); goto next00; /* valid packet */ } } error0 = GTPU_ERROR_NO_SUCH_TUNNEL; next0 = GTPU_INPUT_NEXT_DROP; goto trace00; } else /* !is_ip4 */ { key6_0.src.as_u64[0] = ip6_0->src_address.as_u64[0]; key6_0.src.as_u64[1] = ip6_0->src_address.as_u64[1]; key6_0.teid = gtpu0->teid; /* Make sure GTPU tunnel exist according to packet SIP and teid * SIP identify a GTPU path, and teid identify a tunnel in a given GTPU path */ if (PREDICT_FALSE (memcmp(&key6_0, &last_key6, sizeof(last_key6)) != 0)) { p0 = hash_get_mem (gtm->gtpu6_tunnel_by_key, &key6_0); if (PREDICT_FALSE (p0 == NULL)) { error0 = GTPU_ERROR_NO_SUCH_TUNNEL; next0 = GTPU_INPUT_NEXT_DROP; goto trace00; } clib_memcpy (&last_key6, &key6_0, sizeof(key6_0)); tunnel_index0 = last_tunnel_index = p0[0]; } else tunnel_index0 = last_tunnel_index; t0 = pool_elt_at_index (gtm->tunnels, tunnel_index0); /* Validate GTPU tunnel encap-fib index agaist packet */ if (PREDICT_FALSE (validate_gtpu_fib (b0, t0, is_ip4) == 0)) { error0 = GTPU_ERROR_NO_SUCH_TUNNEL; next0 = GTPU_INPUT_NEXT_DROP; goto trace00; } /* Validate GTPU tunnel SIP against packet DIP */ if (PREDICT_TRUE (ip6_address_is_equal (&ip6_0->dst_address, &t0->src.ip6))) goto next00; /* valid packet */ if (PREDICT_FALSE (ip6_address_is_multicast (&ip6_0->dst_address))) { key6_0.src.as_u64[0] = ip6_0->dst_address.as_u64[0]; key6_0.src.as_u64[1] = ip6_0->dst_address.as_u64[1]; key6_0.teid = gtpu0->teid; p0 = hash_get_mem (gtm->gtpu6_tunnel_by_key, &key6_0); if (PREDICT_TRUE (p0 != NULL)) { mt0 = pool_elt_at_index (gtm->tunnels, p0[0]); goto next00; /* valid packet */ } } error0 = GTPU_ERROR_NO_SUCH_TUNNEL; next0 = GTPU_INPUT_NEXT_DROP; goto trace00; } next00: /* Manipulate gtpu header */ if (PREDICT_FALSE((gtpu0->ver_flags & GTPU_E_S_PN_BIT) != 0)) { gtpu_hdr_len0 = sizeof(gtpu_header_t); /* Manipulate Sequence Number and N-PDU Number */ /* TBD */ /* Manipulate Next Extension Header */ /* TBD */ } else { gtpu_hdr_len0 = sizeof(gtpu_header_t) - 4; } /* Pop gtpu header */ vlib_buffer_advance (b0, gtpu_hdr_len0); next0 = t0->decap_next_index; sw_if_index0 = t0->sw_if_index; len0 = vlib_buffer_length_in_chain (vm, b0); /* Required to make the l2 tag push / pop code work on l2 subifs */ if (PREDICT_TRUE(next0 == GTPU_INPUT_NEXT_L2_INPUT)) vnet_update_l2_len (b0); /* Set packet input sw_if_index to unicast GTPU tunnel for learning */ vnet_buffer(b0)->sw_if_index[VLIB_RX] = sw_if_index0; sw_if_index0 = (mt0) ? mt0->sw_if_index : sw_if_index0; pkts_decapsulated ++; stats_n_packets += 1; stats_n_bytes += len0; /* Batch stats increment on the same gtpu tunnel so counter is not incremented per packet */ if (PREDICT_FALSE (sw_if_index0 != stats_sw_if_index)) { stats_n_packets -= 1; stats_n_bytes -= len0; if (stats_n_packets) vlib_increment_combined_counter (im->combined_sw_if_counters + VNET_INTERFACE_COUNTER_RX, thread_index, stats_sw_if_index, stats_n_packets, stats_n_bytes); stats_n_packets = 1; stats_n_bytes = len0; stats_sw_if_index = sw_if_index0; } trace00: b0->error = error0 ? node->errors[error0] : 0; if (PREDICT_FALSE(b0->flags & VLIB_BUFFER_IS_TRACED)) { gtpu_rx_trace_t *tr = vlib_add_trace (vm, node, b0, sizeof (*tr)); tr->next_index = next0; tr->error = error0; tr->tunnel_index = tunnel_index0; tr->teid = clib_net_to_host_u32(gtpu0->teid); } vlib_validate_buffer_enqueue_x1 (vm, node, next_index, to_next, n_left_to_next, bi0, next0); } vlib_put_next_frame (vm, node, next_index, n_left_to_next); } /* Do we still need this now that tunnel tx stats is kept? */ vlib_node_increment_counter (vm, is_ip4? gtpu4_input_node.index:gtpu6_input_node.index, GTPU_ERROR_DECAPSULATED, pkts_decapsulated); /* Increment any remaining batch stats */ if (stats_n_packets) { vlib_increment_combined_counter (im->combined_sw_if_counters + VNET_INTERFACE_COUNTER_RX, thread_index, stats_sw_if_index, stats_n_packets, stats_n_bytes); node->runtime_data[0] = stats_sw_if_index; } return from_frame->n_vectors; } static uword gtpu4_input (vlib_main_t * vm, vlib_node_runtime_t * node, vlib_frame_t * from_frame) { return gtpu_input(vm, node, from_frame, /* is_ip4 */ 1); } static uword gtpu6_input (vlib_main_t * vm, vlib_node_runtime_t * node, vlib_frame_t * from_frame) { return gtpu_input(vm, node, from_frame, /* is_ip4 */ 0); } static char * gtpu_error_strings[] = { #define gtpu_error(n,s) s, #include <gtpu/gtpu_error.def> #undef gtpu_error #undef _ }; VLIB_REGISTER_NODE (gtpu4_input_node) = { .function = gtpu4_input, .name = "gtpu4-input", /* Takes a vector of packets. */ .vector_size = sizeof (u32), .n_errors = GTPU_N_ERROR, .error_strings = gtpu_error_strings, .n_next_nodes = GTPU_INPUT_N_NEXT, .next_nodes = { #define _(s,n) [GTPU_INPUT_NEXT_##s] = n, foreach_gtpu_input_next #undef _ }, //temp .format_buffer = format_gtpu_header, .format_trace = format_gtpu_rx_trace, // $$$$ .unformat_buffer = unformat_gtpu_header, }; VLIB_NODE_FUNCTION_MULTIARCH (gtpu4_input_node, gtpu4_input) VLIB_REGISTER_NODE (gtpu6_input_node) = { .function = gtpu6_input, .name = "gtpu6-input", /* Takes a vector of packets. */ .vector_size = sizeof (u32), .n_errors = GTPU_N_ERROR, .error_strings = gtpu_error_strings, .n_next_nodes = GTPU_INPUT_N_NEXT, .next_nodes = { #define _(s,n) [GTPU_INPUT_NEXT_##s] = n, foreach_gtpu_input_next #undef _ }, //temp .format_buffer = format_gtpu_header, .format_trace = format_gtpu_rx_trace, // $$$$ .unformat_buffer = unformat_gtpu_header, }; VLIB_NODE_FUNCTION_MULTIARCH (gtpu6_input_node, gtpu6_input) typedef enum { IP_GTPU_BYPASS_NEXT_DROP, IP_GTPU_BYPASS_NEXT_GTPU, IP_GTPU_BYPASS_N_NEXT, } ip_vxan_bypass_next_t; always_inline uword ip_gtpu_bypass_inline (vlib_main_t * vm, vlib_node_runtime_t * node, vlib_frame_t * frame, u32 is_ip4) { gtpu_main_t * gtm = &gtpu_main; u32 * from, * to_next, n_left_from, n_left_to_next, next_index; vlib_node_runtime_t * error_node = vlib_node_get_runtime (vm, ip4_input_node.index); ip4_address_t addr4; /* last IPv4 address matching a local VTEP address */ ip6_address_t addr6; /* last IPv6 address matching a local VTEP address */ from = vlib_frame_vector_args (frame); n_left_from = frame->n_vectors; next_index = node->cached_next_index; if (node->flags & VLIB_NODE_FLAG_TRACE) ip4_forward_next_trace (vm, node, frame, VLIB_TX); if (is_ip4) addr4.data_u32 = ~0; else ip6_address_set_zero (&addr6); while (n_left_from > 0) { vlib_get_next_frame (vm, node, next_index, to_next, n_left_to_next); while (n_left_from >= 4 && n_left_to_next >= 2) { vlib_buffer_t * b0, * b1; ip4_header_t * ip40, * ip41; ip6_header_t * ip60, * ip61; udp_header_t * udp0, * udp1; u32 bi0, ip_len0, udp_len0, flags0, next0; u32 bi1, ip_len1, udp_len1, flags1, next1; i32 len_diff0, len_diff1; u8 error0, good_udp0, proto0; u8 error1, good_udp1, proto1; /* Prefetch next iteration. */ { vlib_buffer_t * p2, * p3; p2 = vlib_get_buffer (vm, from[2]); p3 = vlib_get_buffer (vm, from[3]); vlib_prefetch_buffer_header (p2, LOAD); vlib_prefetch_buffer_header (p3, LOAD); CLIB_PREFETCH (p2->data, 2*CLIB_CACHE_LINE_BYTES, LOAD); CLIB_PREFETCH (p3->data, 2*CLIB_CACHE_LINE_BYTES, LOAD); } bi0 = to_next[0] = from[0]; bi1 = to_next[1] = from[1]; from += 2; n_left_from -= 2; to_next += 2; n_left_to_next -= 2; b0 = vlib_get_buffer (vm, bi0); b1 = vlib_get_buffer (vm, bi1); if (is_ip4) { ip40 = vlib_buffer_get_current (b0); ip41 = vlib_buffer_get_current (b1); } else { ip60 = vlib_buffer_get_current (b0); ip61 = vlib_buffer_get_current (b1); } /* Setup packet for next IP feature */ vnet_feature_next(vnet_buffer(b0)->sw_if_index[VLIB_RX], &next0, b0); vnet_feature_next(vnet_buffer(b1)->sw_if_index[VLIB_RX], &next1, b1); if (is_ip4) { /* Treat IP frag packets as "experimental" protocol for now until support of IP frag reassembly is implemented */ proto0 = ip4_is_fragment(ip40) ? 0xfe : ip40->protocol; proto1 = ip4_is_fragment(ip41) ? 0xfe : ip41->protocol; } else { proto0 = ip60->protocol; proto1 = ip61->protocol; } /* Process packet 0 */ if (proto0 != IP_PROTOCOL_UDP) goto exit0; /* not UDP packet */ if (is_ip4) udp0 = ip4_next_header (ip40); else udp0 = ip6_next_header (ip60); if (udp0->dst_port != clib_host_to_net_u16 (UDP_DST_PORT_GTPU)) goto exit0; /* not GTPU packet */ /* Validate DIP against VTEPs*/ if (is_ip4) { if (addr4.as_u32 != ip40->dst_address.as_u32) { if (!hash_get (gtm->vtep4, ip40->dst_address.as_u32)) goto exit0; /* no local VTEP for GTPU packet */ addr4 = ip40->dst_address; } } else { if (!ip6_address_is_equal (&addr6, &ip60->dst_address)) { if (!hash_get_mem (gtm->vtep6, &ip60->dst_address)) goto exit0; /* no local VTEP for GTPU packet */ addr6 = ip60->dst_address; } } flags0 = b0->flags; good_udp0 = (flags0 & IP_BUFFER_L4_CHECKSUM_CORRECT) != 0; /* Don't verify UDP checksum for packets with explicit zero checksum. */ good_udp0 |= udp0->checksum == 0; /* Verify UDP length */ if (is_ip4) ip_len0 = clib_net_to_host_u16 (ip40->length); else ip_len0 = clib_net_to_host_u16 (ip60->payload_length); udp_len0 = clib_net_to_host_u16 (udp0->length); len_diff0 = ip_len0 - udp_len0; /* Verify UDP checksum */ if (PREDICT_FALSE (!good_udp0)) { if ((flags0 & IP_BUFFER_L4_CHECKSUM_COMPUTED) == 0) { if (is_ip4) flags0 = ip4_tcp_udp_validate_checksum (vm, b0); else flags0 = ip6_tcp_udp_icmp_validate_checksum (vm, b0); good_udp0 = (flags0 & IP_BUFFER_L4_CHECKSUM_CORRECT) != 0; } } if (is_ip4) { error0 = good_udp0 ? 0 : IP4_ERROR_UDP_CHECKSUM; error0 = (len_diff0 >= 0) ? error0 : IP4_ERROR_UDP_LENGTH; } else { error0 = good_udp0 ? 0 : IP6_ERROR_UDP_CHECKSUM; error0 = (len_diff0 >= 0) ? error0 : IP6_ERROR_UDP_LENGTH; } next0 = error0 ? IP_GTPU_BYPASS_NEXT_DROP : IP_GTPU_BYPASS_NEXT_GTPU; b0->error = error0 ? error_node->errors[error0] : 0; /* gtpu-input node expect current at GTPU header */ if (is_ip4) vlib_buffer_advance (b0, sizeof(ip4_header_t)+sizeof(udp_header_t)); else vlib_buffer_advance (b0, sizeof(ip6_header_t)+sizeof(udp_header_t)); exit0: /* Process packet 1 */ if (proto1 != IP_PROTOCOL_UDP) goto exit1; /* not UDP packet */ if (is_ip4) udp1 = ip4_next_header (ip41); else udp1 = ip6_next_header (ip61); if (udp1->dst_port != clib_host_to_net_u16 (UDP_DST_PORT_GTPU)) goto exit1; /* not GTPU packet */ /* Validate DIP against VTEPs*/ if (is_ip4) { if (addr4.as_u32 != ip41->dst_address.as_u32) { if (!hash_get (gtm->vtep4, ip41->dst_address.as_u32)) goto exit1; /* no local VTEP for GTPU packet */ addr4 = ip41->dst_address; } } else { if (!ip6_address_is_equal (&addr6, &ip61->dst_address)) { if (!hash_get_mem (gtm->vtep6, &ip61->dst_address)) goto exit1; /* no local VTEP for GTPU packet */ addr6 = ip61->dst_address; } } flags1 = b1->flags; good_udp1 = (flags1 & IP_BUFFER_L4_CHECKSUM_CORRECT) != 0; /* Don't verify UDP checksum for packets with explicit zero checksum. */ good_udp1 |= udp1->checksum == 0; /* Verify UDP length */ if (is_ip4) ip_len1 = clib_net_to_host_u16 (ip41->length); else ip_len1 = clib_net_to_host_u16 (ip61->payload_length); udp_len1 = clib_net_to_host_u16 (udp1->length); len_diff1 = ip_len1 - udp_len1; /* Verify UDP checksum */ if (PREDICT_FALSE (!good_udp1)) { if ((flags1 & IP_BUFFER_L4_CHECKSUM_COMPUTED) == 0) { if (is_ip4) flags1 = ip4_tcp_udp_validate_checksum (vm, b1); else flags1 = ip6_tcp_udp_icmp_validate_checksum (vm, b1); good_udp1 = (flags1 & IP_BUFFER_L4_CHECKSUM_CORRECT) != 0; } } if (is_ip4) { error1 = good_udp1 ? 0 : IP4_ERROR_UDP_CHECKSUM; error1 = (len_diff1 >= 0) ? error1 : IP4_ERROR_UDP_LENGTH; } else { error1 = good_udp1 ? 0 : IP6_ERROR_UDP_CHECKSUM; error1 = (len_diff1 >= 0) ? error1 : IP6_ERROR_UDP_LENGTH; } next1 = error1 ? IP_GTPU_BYPASS_NEXT_DROP : IP_GTPU_BYPASS_NEXT_GTPU; b1->error = error1 ? error_node->errors[error1] : 0; /* gtpu-input node expect current at GTPU header */ if (is_ip4) vlib_buffer_advance (b1, sizeof(ip4_header_t)+sizeof(udp_header_t)); else vlib_buffer_advance (b1, sizeof(ip6_header_t)+sizeof(udp_header_t)); exit1: vlib_validate_buffer_enqueue_x2 (vm, node, next_index, to_next, n_left_to_next, bi0, bi1, next0, next1); } while (n_left_from > 0 && n_left_to_next > 0) { vlib_buffer_t * b0; ip4_header_t * ip40; ip6_header_t * ip60; udp_header_t * udp0; u32 bi0, ip_len0, udp_len0, flags0, next0; i32 len_diff0; u8 error0, good_udp0, proto0; bi0 = to_next[0] = from[0]; from += 1; n_left_from -= 1; to_next += 1; n_left_to_next -= 1; b0 = vlib_get_buffer (vm, bi0); if (is_ip4) ip40 = vlib_buffer_get_current (b0); else ip60 = vlib_buffer_get_current (b0); /* Setup packet for next IP feature */ vnet_feature_next(vnet_buffer(b0)->sw_if_index[VLIB_RX], &next0, b0); if (is_ip4) /* Treat IP4 frag packets as "experimental" protocol for now until support of IP frag reassembly is implemented */ proto0 = ip4_is_fragment(ip40) ? 0xfe : ip40->protocol; else proto0 = ip60->protocol; if (proto0 != IP_PROTOCOL_UDP) goto exit; /* not UDP packet */ if (is_ip4) udp0 = ip4_next_header (ip40); else udp0 = ip6_next_header (ip60); if (udp0->dst_port != clib_host_to_net_u16 (UDP_DST_PORT_GTPU)) goto exit; /* not GTPU packet */ /* Validate DIP against VTEPs*/ if (is_ip4) { if (addr4.as_u32 != ip40->dst_address.as_u32) { if (!hash_get (gtm->vtep4, ip40->dst_address.as_u32)) goto exit; /* no local VTEP for GTPU packet */ addr4 = ip40->dst_address; } } else { if (!ip6_address_is_equal (&addr6, &ip60->dst_address)) { if (!hash_get_mem (gtm->vtep6, &ip60->dst_address)) goto exit; /* no local VTEP for GTPU packet */ addr6 = ip60->dst_address; } } flags0 = b0->flags; good_udp0 = (flags0 & IP_BUFFER_L4_CHECKSUM_CORRECT) != 0; /* Don't verify UDP checksum for packets with explicit zero checksum. */ good_udp0 |= udp0->checksum == 0; /* Verify UDP length */ if (is_ip4) ip_len0 = clib_net_to_host_u16 (ip40->length); else ip_len0 = clib_net_to_host_u16 (ip60->payload_length); udp_len0 = clib_net_to_host_u16 (udp0->length); len_diff0 = ip_len0 - udp_len0; /* Verify UDP checksum */ if (PREDICT_FALSE (!good_udp0)) { if ((flags0 & IP_BUFFER_L4_CHECKSUM_COMPUTED) == 0) { if (is_ip4) flags0 = ip4_tcp_udp_validate_checksum (vm, b0); else flags0 = ip6_tcp_udp_icmp_validate_checksum (vm, b0); good_udp0 = (flags0 & IP_BUFFER_L4_CHECKSUM_CORRECT) != 0; } } if (is_ip4) { error0 = good_udp0 ? 0 : IP4_ERROR_UDP_CHECKSUM; error0 = (len_diff0 >= 0) ? error0 : IP4_ERROR_UDP_LENGTH; } else { error0 = good_udp0 ? 0 : IP6_ERROR_UDP_CHECKSUM; error0 = (len_diff0 >= 0) ? error0 : IP6_ERROR_UDP_LENGTH; } next0 = error0 ? IP_GTPU_BYPASS_NEXT_DROP : IP_GTPU_BYPASS_NEXT_GTPU; b0->error = error0 ? error_node->errors[error0] : 0; /* gtpu-input node expect current at GTPU header */ if (is_ip4) vlib_buffer_advance (b0, sizeof(ip4_header_t)+sizeof(udp_header_t)); else vlib_buffer_advance (b0, sizeof(ip6_header_t)+sizeof(udp_header_t)); exit: vlib_validate_buffer_enqueue_x1 (vm, node, next_index, to_next, n_left_to_next, bi0, next0); } vlib_put_next_frame (vm, node, next_index, n_left_to_next); } return frame->n_vectors; } static uword ip4_gtpu_bypass (vlib_main_t * vm, vlib_node_runtime_t * node, vlib_frame_t * frame) { return ip_gtpu_bypass_inline (vm, node, frame, /* is_ip4 */ 1); } VLIB_REGISTER_NODE (ip4_gtpu_bypass_node) = { .function = ip4_gtpu_bypass, .name = "ip4-gtpu-bypass", .vector_size = sizeof (u32), .n_next_nodes = IP_GTPU_BYPASS_N_NEXT, .next_nodes = { [IP_GTPU_BYPASS_NEXT_DROP] = "error-drop", [IP_GTPU_BYPASS_NEXT_GTPU] = "gtpu4-input", }, .format_buffer = format_ip4_header, .format_trace = format_ip4_forward_next_trace, }; VLIB_NODE_FUNCTION_MULTIARCH (ip4_gtpu_bypass_node,ip4_gtpu_bypass) /* Dummy init function to get us linked in. */ clib_error_t * ip4_gtpu_bypass_init (vlib_main_t * vm) { return 0; } VLIB_INIT_FUNCTION (ip4_gtpu_bypass_init); static uword ip6_gtpu_bypass (vlib_main_t * vm, vlib_node_runtime_t * node, vlib_frame_t * frame) { return ip_gtpu_bypass_inline (vm, node, frame, /* is_ip4 */ 0); } VLIB_REGISTER_NODE (ip6_gtpu_bypass_node) = { .function = ip6_gtpu_bypass, .name = "ip6-gtpu-bypass", .vector_size = sizeof (u32), .n_next_nodes = IP_GTPU_BYPASS_N_NEXT, .next_nodes = { [IP_GTPU_BYPASS_NEXT_DROP] = "error-drop", [IP_GTPU_BYPASS_NEXT_GTPU] = "gtpu6-input", }, .format_buffer = format_ip6_header, .format_trace = format_ip6_forward_next_trace, }; VLIB_NODE_FUNCTION_MULTIARCH (ip6_gtpu_bypass_node,ip6_gtpu_bypass) /* Dummy init function to get us linked in. */ clib_error_t * ip6_gtpu_bypass_init (vlib_main_t * vm) { return 0; } VLIB_INIT_FUNCTION (ip6_gtpu_bypass_init);