Fixes for buliding for 32bit targets:
[vpp.git] / src / tests / vnet / session / udp_echo.c
1 /*
2  * Copyright (c) 2016 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 #include <stdio.h>
17 #include <setjmp.h>
18 #include <signal.h>
19 #include <vppinfra/clib.h>
20 #include <vppinfra/format.h>
21 #include <vppinfra/error.h>
22 #include <vppinfra/time.h>
23 #include <vppinfra/macros.h>
24 #include <vnet/vnet.h>
25 #include <vlib/vlib.h>
26 #include <vlib/unix/unix.h>
27 #include <vlibapi/api.h>
28 #include <vlibmemory/api.h>
29 #include <vpp/api/vpe_msg_enum.h>
30 #include <svm/svm_fifo_segment.h>
31 #include <pthread.h>
32 #include <vnet/session/application_interface.h>
33
34 #define vl_typedefs             /* define message structures */
35 #include <vpp/api/vpe_all_api_h.h>
36 #undef vl_typedefs
37
38 /* declare message handlers for each api */
39
40 #define vl_endianfun            /* define message structures */
41 #include <vpp/api/vpe_all_api_h.h>
42 #undef vl_endianfun
43
44 /* instantiate all the print functions we know about */
45 #define vl_print(handle, ...)
46 #define vl_printfun
47 #include <vpp/api/vpe_all_api_h.h>
48 #undef vl_printfun
49
50 typedef enum
51 {
52   STATE_START,
53   STATE_ATTACHED,
54   STATE_BOUND,
55   STATE_READY,
56   STATE_FAILED,
57   STATE_DISCONNECTING,
58   STATE_DETACHED
59 } connection_state_t;
60
61 typedef struct
62 {
63   /* vpe input queue */
64   svm_queue_t *vl_input_queue;
65
66   /* API client handle */
67   u32 my_client_index;
68
69   /* The URI we're playing with */
70   u8 *listen_uri;
71
72   /* URI for connect */
73   u8 *connect_uri;
74
75   /* Session pool */
76   app_session_t *sessions;
77
78   /* Hash table for disconnect processing */
79   uword *session_index_by_vpp_handles;
80
81   /* fifo segment */
82   svm_fifo_segment_private_t *seg;
83
84   /* intermediate rx buffer */
85   u8 *rx_buf;
86
87   u32 fifo_size;
88   int i_am_server;
89   u8 is_connected;
90
91   /* Our event queue */
92   svm_msg_q_t *our_event_queue;
93   svm_msg_q_t *ct_event_queue;
94
95   /* $$$ single thread only for the moment */
96   svm_msg_q_t *vpp_event_queue;
97
98   /* $$$$ hack: cut-through session index */
99   volatile u32 cut_through_session_index;
100   volatile u32 connected_session;
101
102   /* unique segment name counter */
103   u32 unique_segment_index;
104
105   pid_t my_pid;
106
107   /* pthread handle */
108   pthread_t cut_through_thread_handle;
109
110   /* For deadman timers */
111   clib_time_t clib_time;
112
113   /* State of the connection, shared between msg RX thread and main thread */
114   volatile connection_state_t state;
115
116   volatile int time_to_stop;
117   volatile int time_to_print_stats;
118
119   u32 configured_segment_size;
120
121   /* VNET_API_ERROR_FOO -> "Foo" hash table */
122   uword *error_string_by_error_number;
123
124   svm_fifo_segment_main_t segment_main;
125
126   u8 *connect_test_data;
127
128   uword *segments_table;
129   u8 do_echo;
130   u8 have_return;
131   u64 total_to_send;
132   u64 bytes_to_send;
133   u64 bytes_sent;
134 } udp_echo_main_t;
135
136 udp_echo_main_t udp_echo_main;
137
138 static void
139 stop_signal (int signum)
140 {
141   udp_echo_main_t *um = &udp_echo_main;
142
143   um->time_to_stop = 1;
144 }
145
146 static void
147 stats_signal (int signum)
148 {
149   udp_echo_main_t *um = &udp_echo_main;
150   um->time_to_print_stats = 1;
151 }
152
153 static clib_error_t *
154 setup_signal_handlers (void)
155 {
156   signal (SIGINT, stats_signal);
157   signal (SIGQUIT, stop_signal);
158   signal (SIGTERM, stop_signal);
159
160   return 0;
161 }
162
163 uword
164 unformat_ip4_address (unformat_input_t * input, va_list * args)
165 {
166   u8 *result = va_arg (*args, u8 *);
167   unsigned a[4];
168
169   if (!unformat (input, "%d.%d.%d.%d", &a[0], &a[1], &a[2], &a[3]))
170     return 0;
171
172   if (a[0] >= 256 || a[1] >= 256 || a[2] >= 256 || a[3] >= 256)
173     return 0;
174
175   result[0] = a[0];
176   result[1] = a[1];
177   result[2] = a[2];
178   result[3] = a[3];
179
180   return 1;
181 }
182
183 uword
184 unformat_ip6_address (unformat_input_t * input, va_list * args)
185 {
186   ip6_address_t *result = va_arg (*args, ip6_address_t *);
187   u16 hex_quads[8];
188   uword hex_quad, n_hex_quads, hex_digit, n_hex_digits;
189   uword c, n_colon, double_colon_index;
190
191   n_hex_quads = hex_quad = n_hex_digits = n_colon = 0;
192   double_colon_index = ARRAY_LEN (hex_quads);
193   while ((c = unformat_get_input (input)) != UNFORMAT_END_OF_INPUT)
194     {
195       hex_digit = 16;
196       if (c >= '0' && c <= '9')
197         hex_digit = c - '0';
198       else if (c >= 'a' && c <= 'f')
199         hex_digit = c + 10 - 'a';
200       else if (c >= 'A' && c <= 'F')
201         hex_digit = c + 10 - 'A';
202       else if (c == ':' && n_colon < 2)
203         n_colon++;
204       else
205         {
206           unformat_put_input (input);
207           break;
208         }
209
210       /* Too many hex quads. */
211       if (n_hex_quads >= ARRAY_LEN (hex_quads))
212         return 0;
213
214       if (hex_digit < 16)
215         {
216           hex_quad = (hex_quad << 4) | hex_digit;
217
218           /* Hex quad must fit in 16 bits. */
219           if (n_hex_digits >= 4)
220             return 0;
221
222           n_colon = 0;
223           n_hex_digits++;
224         }
225
226       /* Save position of :: */
227       if (n_colon == 2)
228         {
229           /* More than one :: ? */
230           if (double_colon_index < ARRAY_LEN (hex_quads))
231             return 0;
232           double_colon_index = n_hex_quads;
233         }
234
235       if (n_colon > 0 && n_hex_digits > 0)
236         {
237           hex_quads[n_hex_quads++] = hex_quad;
238           hex_quad = 0;
239           n_hex_digits = 0;
240         }
241     }
242
243   if (n_hex_digits > 0)
244     hex_quads[n_hex_quads++] = hex_quad;
245
246   {
247     word i;
248
249     /* Expand :: to appropriate number of zero hex quads. */
250     if (double_colon_index < ARRAY_LEN (hex_quads))
251       {
252         word n_zero = ARRAY_LEN (hex_quads) - n_hex_quads;
253
254         for (i = n_hex_quads - 1; i >= (signed) double_colon_index; i--)
255           hex_quads[n_zero + i] = hex_quads[i];
256
257         for (i = 0; i < n_zero; i++)
258           hex_quads[double_colon_index + i] = 0;
259
260         n_hex_quads = ARRAY_LEN (hex_quads);
261       }
262
263     /* Too few hex quads given. */
264     if (n_hex_quads < ARRAY_LEN (hex_quads))
265       return 0;
266
267     for (i = 0; i < ARRAY_LEN (hex_quads); i++)
268       result->as_u16[i] = clib_host_to_net_u16 (hex_quads[i]);
269
270     return 1;
271   }
272 }
273
274 uword
275 unformat_uri (unformat_input_t * input, va_list * args)
276 {
277   session_endpoint_cfg_t *sep = va_arg (*args, session_endpoint_cfg_t *);
278   u32 port;
279   char *tmp;
280
281   if (unformat (input, "%s://%U/%d", &tmp, unformat_ip4_address, &sep->ip.ip4,
282                 &port))
283     {
284       sep->port = clib_host_to_net_u16 (port);
285       sep->is_ip4 = 1;
286       return 1;
287     }
288   else if (unformat (input, "%s://%U/%d", &tmp, unformat_ip6_address,
289                      &sep->ip.ip6, &port))
290     {
291       sep->port = clib_host_to_net_u16 (port);
292       sep->is_ip4 = 0;
293       return 1;
294     }
295   return 0;
296 }
297
298 static void
299 application_send_attach (udp_echo_main_t * utm)
300 {
301   vl_api_application_attach_t *bmp;
302   bmp = vl_msg_api_alloc (sizeof (*bmp));
303   clib_memset (bmp, 0, sizeof (*bmp));
304
305   bmp->_vl_msg_id = ntohs (VL_API_APPLICATION_ATTACH);
306   bmp->client_index = utm->my_client_index;
307   bmp->context = ntohl (0xfeedface);
308   bmp->options[APP_OPTIONS_FLAGS] = APP_OPTIONS_FLAGS_ADD_SEGMENT;
309   bmp->options[APP_OPTIONS_FLAGS] |= APP_OPTIONS_FLAGS_USE_GLOBAL_SCOPE;
310   bmp->options[APP_OPTIONS_FLAGS] |= APP_OPTIONS_FLAGS_USE_LOCAL_SCOPE;
311   bmp->options[APP_OPTIONS_FLAGS] |= APP_OPTIONS_FLAGS_USE_MQ_FOR_CTRL_MSGS;
312   bmp->options[APP_OPTIONS_PREALLOC_FIFO_PAIRS] = 2;
313   bmp->options[APP_OPTIONS_RX_FIFO_SIZE] = utm->fifo_size;
314   bmp->options[APP_OPTIONS_TX_FIFO_SIZE] = utm->fifo_size;
315   bmp->options[APP_OPTIONS_ADD_SEGMENT_SIZE] = 128 << 20;
316   bmp->options[APP_OPTIONS_SEGMENT_SIZE] = 256 << 20;
317   bmp->options[APP_OPTIONS_EVT_QUEUE_SIZE] = 16768;
318   vl_msg_api_send_shmem (utm->vl_input_queue, (u8 *) & bmp);
319 }
320
321 void
322 application_detach (udp_echo_main_t * utm)
323 {
324   vl_api_application_detach_t *bmp;
325   bmp = vl_msg_api_alloc (sizeof (*bmp));
326   clib_memset (bmp, 0, sizeof (*bmp));
327
328   bmp->_vl_msg_id = ntohs (VL_API_APPLICATION_DETACH);
329   bmp->client_index = utm->my_client_index;
330   bmp->context = ntohl (0xfeedface);
331   vl_msg_api_send_shmem (utm->vl_input_queue, (u8 *) & bmp);
332 }
333
334 static void
335 vl_api_application_attach_reply_t_handler (vl_api_application_attach_reply_t *
336                                            mp)
337 {
338   svm_fifo_segment_create_args_t _a = { 0 }, *a = &_a;
339   udp_echo_main_t *utm = &udp_echo_main;
340   svm_fifo_segment_main_t *sm = &utm->segment_main;
341   int rv;
342
343   if (mp->retval)
344     {
345       clib_warning ("attach failed: %d", mp->retval);
346       utm->state = STATE_FAILED;
347       return;
348     }
349
350   if (mp->segment_name_length == 0)
351     {
352       clib_warning ("segment_name_length zero");
353       return;
354     }
355
356   a->segment_name = (char *) mp->segment_name;
357   a->segment_size = mp->segment_size;
358
359   ASSERT (mp->app_event_queue_address);
360
361   /* Attach to the segment vpp created */
362   rv = svm_fifo_segment_attach (sm, a);
363   if (rv)
364     {
365       clib_warning ("svm_fifo_segment_attach ('%s') failed",
366                     mp->segment_name);
367       return;
368     }
369
370   utm->our_event_queue = uword_to_pointer (mp->app_event_queue_address,
371                                            svm_msg_q_t *);
372   utm->state = STATE_ATTACHED;
373 }
374
375 static void
376 vl_api_application_detach_reply_t_handler (vl_api_application_detach_reply_t *
377                                            mp)
378 {
379   if (mp->retval)
380     clib_warning ("detach returned with err: %d", mp->retval);
381   udp_echo_main.state = STATE_DETACHED;
382 }
383
384 u8 *
385 format_api_error (u8 * s, va_list * args)
386 {
387   udp_echo_main_t *utm = va_arg (*args, udp_echo_main_t *);
388   i32 error = va_arg (*args, u32);
389   uword *p;
390
391   p = hash_get (utm->error_string_by_error_number, -error);
392
393   if (p)
394     s = format (s, "%s", p[0]);
395   else
396     s = format (s, "%d", error);
397   return s;
398 }
399
400 int
401 wait_for_state_change (udp_echo_main_t * utm, connection_state_t state)
402 {
403 #if CLIB_DEBUG > 0
404 #define TIMEOUT 600.0
405 #else
406 #define TIMEOUT 600.0
407 #endif
408
409   f64 timeout = clib_time_now (&utm->clib_time) + TIMEOUT;
410
411   while (clib_time_now (&utm->clib_time) < timeout)
412     {
413       if (utm->state == state)
414         return 0;
415       if (utm->state == STATE_FAILED)
416         return -1;
417     }
418   return -1;
419 }
420
421 u64 server_bytes_received, server_bytes_sent;
422
423 static void *
424 cut_through_thread_fn (void *arg)
425 {
426   app_session_t *s;
427   svm_fifo_t *rx_fifo;
428   svm_fifo_t *tx_fifo;
429   u8 *my_copy_buffer = 0;
430   udp_echo_main_t *utm = &udp_echo_main;
431   i32 actual_transfer;
432   int rv, do_dequeue = 0;
433   u32 buffer_offset;
434
435   while (utm->cut_through_session_index == ~0)
436     ;
437
438   s = pool_elt_at_index (utm->sessions, utm->cut_through_session_index);
439
440   rx_fifo = s->rx_fifo;
441   tx_fifo = s->tx_fifo;
442
443   vec_validate (my_copy_buffer, 64 * 1024 - 1);
444
445   while (1)
446     {
447       do
448         {
449           /* We read from the tx fifo and write to the rx fifo */
450           if (utm->have_return || do_dequeue)
451             actual_transfer = svm_fifo_dequeue_nowait (rx_fifo,
452                                                        vec_len
453                                                        (my_copy_buffer),
454                                                        my_copy_buffer);
455           else
456             {
457               /* We don't do anything with the data, drop it */
458               actual_transfer = svm_fifo_max_dequeue (rx_fifo);
459               svm_fifo_dequeue_drop (rx_fifo, actual_transfer);
460             }
461         }
462       while (actual_transfer <= 0);
463
464       server_bytes_received += actual_transfer;
465
466       if (utm->have_return)
467         {
468           buffer_offset = 0;
469           while (actual_transfer > 0)
470             {
471               rv = svm_fifo_enqueue_nowait (tx_fifo, actual_transfer,
472                                             my_copy_buffer + buffer_offset);
473               if (rv > 0)
474                 {
475                   actual_transfer -= rv;
476                   buffer_offset += rv;
477                   server_bytes_sent += rv;
478                 }
479
480             }
481         }
482       if (PREDICT_FALSE (utm->time_to_stop))
483         break;
484     }
485
486   pthread_exit (0);
487 }
488
489 static void
490 session_accepted_handler (session_accepted_msg_t * mp)
491 {
492   app_session_evt_t _app_evt, *app_evt = &_app_evt;
493   udp_echo_main_t *utm = &udp_echo_main;
494   session_accepted_reply_msg_t *rmp;
495   svm_fifo_t *rx_fifo, *tx_fifo;
496   app_session_t *session;
497   static f64 start_time;
498   u32 session_index;
499   int rv = 0;
500
501   if (start_time == 0.0)
502     start_time = clib_time_now (&utm->clib_time);
503
504   utm->vpp_event_queue = uword_to_pointer (mp->vpp_event_queue_address,
505                                            svm_msg_q_t *);
506   rx_fifo = uword_to_pointer (mp->server_rx_fifo, svm_fifo_t *);
507   tx_fifo = uword_to_pointer (mp->server_tx_fifo, svm_fifo_t *);
508
509   pool_get (utm->sessions, session);
510   clib_memset (session, 0, sizeof (*session));
511   session_index = session - utm->sessions;
512   session->session_index = session_index;
513
514   /* Cut-through case */
515   if (mp->server_event_queue_address)
516     {
517       clib_warning ("cut-through session");
518       session->vpp_evt_q = uword_to_pointer (mp->client_event_queue_address,
519                                              svm_msg_q_t *);
520       sleep (1);
521       rx_fifo->master_session_index = session_index;
522       tx_fifo->master_session_index = session_index;
523       utm->cut_through_session_index = session_index;
524       session->rx_fifo = rx_fifo;
525       session->tx_fifo = tx_fifo;
526       session->is_dgram = 0;
527
528       rv = pthread_create (&utm->cut_through_thread_handle,
529                            NULL /*attr */ , cut_through_thread_fn, 0);
530       if (rv)
531         {
532           clib_warning ("pthread_create returned %d", rv);
533           rv = VNET_API_ERROR_SYSCALL_ERROR_1;
534         }
535     }
536   else
537     {
538       rx_fifo->client_session_index = session_index;
539       tx_fifo->client_session_index = session_index;
540       session->rx_fifo = rx_fifo;
541       session->tx_fifo = tx_fifo;
542       clib_memcpy_fast (&session->transport.rmt_ip, mp->ip,
543                         sizeof (ip46_address_t));
544       session->transport.is_ip4 = mp->is_ip4;
545       session->transport.rmt_port = mp->port;
546     }
547
548   hash_set (utm->session_index_by_vpp_handles, mp->handle, session_index);
549   if (pool_elts (utm->sessions) && (pool_elts (utm->sessions) % 20000) == 0)
550     {
551       f64 now = clib_time_now (&utm->clib_time);
552       fformat (stdout, "%d active sessions in %.2f seconds, %.2f/sec...\n",
553                pool_elts (utm->sessions), now - start_time,
554                (f64) pool_elts (utm->sessions) / (now - start_time));
555     }
556
557   app_alloc_ctrl_evt_to_vpp (utm->vpp_event_queue, app_evt,
558                              SESSION_CTRL_EVT_ACCEPTED_REPLY);
559   rmp = (session_accepted_reply_msg_t *) app_evt->evt->data;
560   rmp->handle = mp->handle;
561   rmp->context = mp->context;
562   rmp->retval = rv;
563   app_send_ctrl_evt_to_vpp (utm->vpp_event_queue, app_evt);
564
565   CLIB_MEMORY_BARRIER ();
566   utm->state = STATE_READY;
567 }
568
569 static void
570 session_disconnected_handler (session_disconnected_msg_t * mp)
571 {
572   app_session_evt_t _app_evt, *app_evt = &_app_evt;
573   udp_echo_main_t *utm = &udp_echo_main;
574   session_disconnected_reply_msg_t *rmp;
575   app_session_t *session;
576   uword *p;
577   int rv = 0;
578
579   p = hash_get (utm->session_index_by_vpp_handles, mp->handle);
580
581   if (p)
582     {
583       session = pool_elt_at_index (utm->sessions, p[0]);
584       hash_unset (utm->session_index_by_vpp_handles, mp->handle);
585       clib_warning ("disconnecting %u", session->session_index);
586       pool_put (utm->sessions, session);
587     }
588   else
589     {
590       clib_warning ("couldn't find session key %llx", mp->handle);
591       return;
592     }
593
594   app_alloc_ctrl_evt_to_vpp (session->vpp_evt_q, app_evt,
595                              SESSION_CTRL_EVT_DISCONNECTED_REPLY);
596   rmp = (session_disconnected_reply_msg_t *) app_evt->evt->data;
597   rmp->retval = rv;
598   rmp->handle = mp->handle;
599   rmp->context = mp->context;
600   app_send_ctrl_evt_to_vpp (session->vpp_evt_q, app_evt);
601 }
602
603 static void
604 session_connected_handler (session_connected_msg_t * mp)
605 {
606   udp_echo_main_t *utm = &udp_echo_main;
607   unformat_input_t _input, *input = &_input;
608   session_endpoint_cfg_t _sep, *sep = &_sep;
609   app_session_t *session;
610
611   ASSERT (utm->i_am_server == 0);
612
613   if (mp->retval)
614     {
615       clib_warning ("failed connect");
616       return;
617     }
618
619   ASSERT (mp->server_rx_fifo && mp->server_tx_fifo);
620
621   pool_get (utm->sessions, session);
622   session->session_index = session - utm->sessions;
623   session->rx_fifo = uword_to_pointer (mp->server_rx_fifo, svm_fifo_t *);
624   session->tx_fifo = uword_to_pointer (mp->server_tx_fifo, svm_fifo_t *);
625
626   /* Cut-through case */
627   if (mp->client_event_queue_address)
628     {
629       clib_warning ("cut-through session");
630       session->vpp_evt_q = uword_to_pointer (mp->server_event_queue_address,
631                                              svm_msg_q_t *);
632       utm->ct_event_queue = uword_to_pointer (mp->client_event_queue_address,
633                                               svm_msg_q_t *);
634       utm->cut_through_session_index = session->session_index;
635       session->is_dgram = 0;
636       sleep (1);
637       session->rx_fifo->client_session_index = session->session_index;
638       session->tx_fifo->client_session_index = session->session_index;
639     }
640   else
641     {
642       utm->connected_session = session->session_index;
643       utm->vpp_event_queue = uword_to_pointer (mp->vpp_event_queue_address,
644                                                svm_msg_q_t *);
645
646       session->rx_fifo->client_session_index = session->session_index;
647       session->tx_fifo->client_session_index = session->session_index;
648       clib_memcpy_fast (&session->transport.lcl_ip, mp->lcl_ip,
649                         sizeof (ip46_address_t));
650       session->transport.is_ip4 = mp->is_ip4;
651       session->transport.lcl_port = mp->lcl_port;
652
653       unformat_init_vector (input, utm->connect_uri);
654       if (!unformat (input, "%U", unformat_uri, sep))
655         {
656           clib_warning ("can't figure out remote ip and port");
657           utm->state = STATE_FAILED;
658           unformat_free (input);
659           return;
660         }
661       unformat_free (input);
662       clib_memcpy_fast (&session->transport.rmt_ip, &sep->ip,
663                         sizeof (ip46_address_t));
664       session->transport.rmt_port = sep->port;
665       session->is_dgram = !utm->is_connected;
666     }
667   utm->state = STATE_READY;
668 }
669
670 static void
671 session_bound_handler (session_bound_msg_t * mp)
672 {
673   udp_echo_main_t *utm = &udp_echo_main;
674   svm_fifo_t *rx_fifo, *tx_fifo;
675   app_session_t *session;
676   u32 session_index;
677
678   if (mp->retval)
679     {
680       clib_warning ("bind failed: %d", mp->retval);
681       utm->state = STATE_FAILED;
682       return;
683     }
684
685   rx_fifo = uword_to_pointer (mp->rx_fifo, svm_fifo_t *);
686   tx_fifo = uword_to_pointer (mp->tx_fifo, svm_fifo_t *);
687
688   pool_get (utm->sessions, session);
689   clib_memset (session, 0, sizeof (*session));
690   session_index = session - utm->sessions;
691
692   rx_fifo->client_session_index = session_index;
693   tx_fifo->client_session_index = session_index;
694   session->rx_fifo = rx_fifo;
695   session->tx_fifo = tx_fifo;
696   clib_memcpy_fast (&session->transport.lcl_ip, mp->lcl_ip,
697                     sizeof (ip46_address_t));
698   session->transport.is_ip4 = mp->lcl_is_ip4;
699   session->transport.lcl_port = mp->lcl_port;
700   session->vpp_evt_q = uword_to_pointer (mp->vpp_evt_q, svm_msg_q_t *);
701
702   utm->state = utm->is_connected ? STATE_BOUND : STATE_READY;
703 }
704
705 static void
706 handle_mq_event (session_event_t * e)
707 {
708   switch (e->event_type)
709     {
710     case SESSION_CTRL_EVT_BOUND:
711       session_bound_handler ((session_bound_msg_t *) e->data);
712       break;
713     case SESSION_CTRL_EVT_ACCEPTED:
714       session_accepted_handler ((session_accepted_msg_t *) e->data);
715       break;
716     case SESSION_CTRL_EVT_CONNECTED:
717       session_connected_handler ((session_connected_msg_t *) e->data);
718       break;
719     case SESSION_CTRL_EVT_DISCONNECTED:
720       session_disconnected_handler ((session_disconnected_msg_t *) e->data);
721       break;
722     default:
723       clib_warning ("unhandled %u", e->event_type);
724     }
725 }
726
727 static void
728 udp_client_send_connect (udp_echo_main_t * utm)
729 {
730   vl_api_connect_uri_t *cmp;
731   cmp = vl_msg_api_alloc (sizeof (*cmp));
732   clib_memset (cmp, 0, sizeof (*cmp));
733
734   cmp->_vl_msg_id = ntohs (VL_API_CONNECT_URI);
735   cmp->client_index = utm->my_client_index;
736   cmp->context = ntohl (0xfeedface);
737   memcpy (cmp->uri, utm->connect_uri, vec_len (utm->connect_uri));
738   vl_msg_api_send_shmem (utm->vl_input_queue, (u8 *) & cmp);
739 }
740
741 static void
742 send_test_chunk (udp_echo_main_t * utm, app_session_t * s, u32 bytes)
743 {
744   u64 test_buf_len, bytes_this_chunk, test_buf_offset;
745
746   u8 *test_data = utm->connect_test_data;
747   u32 bytes_to_snd, enq_space, min_chunk;
748   session_evt_type_t et = FIFO_EVENT_APP_TX;
749   int written;
750
751   test_buf_len = vec_len (test_data);
752   test_buf_offset = utm->bytes_sent % test_buf_len;
753   bytes_this_chunk = clib_min (test_buf_len - test_buf_offset,
754                                utm->bytes_to_send);
755   enq_space = svm_fifo_max_enqueue (s->tx_fifo);
756   bytes_this_chunk = clib_min (bytes_this_chunk, enq_space);
757   et += (s->session_index == utm->cut_through_session_index);
758
759   if (s->is_dgram)
760     written = app_send_dgram_raw (s->tx_fifo, &s->transport, s->vpp_evt_q,
761                                   test_data + test_buf_offset,
762                                   bytes_this_chunk, et, SVM_Q_WAIT);
763   else
764     written = app_send_stream_raw (s->tx_fifo, s->vpp_evt_q,
765                                    test_data + test_buf_offset,
766                                    bytes_this_chunk, et, SVM_Q_WAIT);
767
768   if (written > 0)
769     {
770       utm->bytes_to_send -= written;
771       utm->bytes_sent += written;
772     }
773 }
774
775 static void
776 recv_test_chunk (udp_echo_main_t * utm, app_session_t * s)
777 {
778   app_recv (s, utm->rx_buf, vec_len (utm->rx_buf));
779 }
780
781 void
782 client_send_data (udp_echo_main_t * utm, u32 session_index)
783 {
784   f64 start_time, end_time, delta;
785   app_session_t *session;
786   char *transfer_type;
787   u8 *test_data;
788   int i;
789
790   vec_validate_aligned (utm->connect_test_data, 1024 * 1024 - 1,
791                         CLIB_CACHE_LINE_BYTES);
792   for (i = 0; i < vec_len (utm->connect_test_data); i++)
793     utm->connect_test_data[i] = i & 0xff;
794
795   test_data = utm->connect_test_data;
796   session = pool_elt_at_index (utm->sessions, session_index);
797   ASSERT (vec_len (test_data) > 0);
798
799   utm->total_to_send = utm->bytes_to_send;
800   vec_validate (utm->rx_buf, vec_len (test_data) - 1);
801   start_time = clib_time_now (&utm->clib_time);
802   while (!utm->time_to_stop && utm->bytes_to_send)
803     {
804       send_test_chunk (utm, session, 0);
805       if (utm->have_return)
806         recv_test_chunk (utm, session);
807       if (utm->time_to_stop)
808         break;
809     }
810
811   if (utm->have_return)
812     {
813       f64 timeout = clib_time_now (&utm->clib_time) + 5;
814       while (clib_time_now (&utm->clib_time) < timeout)
815         recv_test_chunk (utm, session);
816     }
817
818   end_time = clib_time_now (&utm->clib_time);
819   delta = end_time - start_time;
820   transfer_type = utm->have_return ? "full-duplex" : "half-duplex";
821   clib_warning ("%lld bytes (%lld mbytes, %lld gbytes) in %.2f seconds",
822                 utm->total_to_send, utm->total_to_send / (1ULL << 20),
823                 utm->total_to_send / (1ULL << 30), delta);
824   clib_warning ("%.2f bytes/second %s", ((f64) utm->total_to_send) / (delta),
825                 transfer_type);
826   clib_warning ("%.4f gbit/second %s",
827                 (((f64) utm->total_to_send * 8.0) / delta / 1e9),
828                 transfer_type);
829 }
830
831 static int
832 application_attach (udp_echo_main_t * utm)
833 {
834   application_send_attach (utm);
835   if (wait_for_state_change (utm, STATE_ATTACHED))
836     {
837       clib_warning ("timeout waiting for STATE_ATTACHED");
838       return -1;
839     }
840   return 0;
841 }
842
843 static void
844 client_test (udp_echo_main_t * utm)
845 {
846   f64 start_time, timeout = 100.0;
847   app_session_t *session;
848   svm_msg_q_msg_t msg;
849   session_event_t *e;
850
851   if (application_attach (utm))
852     return;
853
854   udp_client_send_connect (utm);
855
856   start_time = clib_time_now (&utm->clib_time);
857   while (pool_elts (utm->sessions) != 1 && utm->state != STATE_FAILED)
858     {
859       svm_msg_q_sub (utm->our_event_queue, &msg, SVM_Q_WAIT, 0);
860       e = svm_msg_q_msg_data (utm->our_event_queue, &msg);
861       handle_mq_event (e);
862       svm_msg_q_free_msg (utm->our_event_queue, &msg);
863
864       if (clib_time_now (&utm->clib_time) - start_time >= timeout)
865         break;
866     }
867
868   if (utm->cut_through_session_index != ~0)
869     client_send_data (utm, utm->cut_through_session_index);
870   else
871     client_send_data (utm, utm->connected_session);
872
873   application_detach (utm);
874   wait_for_state_change (utm, STATE_DETACHED);
875 }
876
877 static void
878 vl_api_bind_uri_reply_t_handler (vl_api_bind_uri_reply_t * mp)
879 {
880   udp_echo_main_t *utm = &udp_echo_main;
881   svm_fifo_t *rx_fifo, *tx_fifo;
882   app_session_t *session;
883   u32 session_index;
884
885   if (mp->retval)
886     {
887       clib_warning ("bind failed: %d", mp->retval);
888       utm->state = STATE_FAILED;
889       return;
890     }
891
892   rx_fifo = uword_to_pointer (mp->rx_fifo, svm_fifo_t *);
893   tx_fifo = uword_to_pointer (mp->tx_fifo, svm_fifo_t *);
894
895   pool_get (utm->sessions, session);
896   clib_memset (session, 0, sizeof (*session));
897   session_index = session - utm->sessions;
898
899   rx_fifo->client_session_index = session_index;
900   tx_fifo->client_session_index = session_index;
901   session->rx_fifo = rx_fifo;
902   session->tx_fifo = tx_fifo;
903   clib_memcpy_fast (&session->transport.lcl_ip, mp->lcl_ip,
904                     sizeof (ip46_address_t));
905   session->transport.is_ip4 = mp->lcl_is_ip4;
906   session->transport.lcl_port = mp->lcl_port;
907   session->vpp_evt_q = uword_to_pointer (mp->vpp_evt_q, svm_msg_q_t *);
908
909   utm->state = utm->is_connected ? STATE_BOUND : STATE_READY;
910 }
911
912 static void
913 vl_api_map_another_segment_t_handler (vl_api_map_another_segment_t * mp)
914 {
915   svm_fifo_segment_create_args_t _a, *a = &_a;
916   udp_echo_main_t *utm = &udp_echo_main;
917   svm_fifo_segment_main_t *sm = &utm->segment_main;
918   svm_fifo_segment_private_t *seg;
919   int rv;
920
921   clib_memset (a, 0, sizeof (*a));
922   a->segment_name = (char *) mp->segment_name;
923   a->segment_size = mp->segment_size;
924   /* Attach to the segment vpp created */
925   rv = svm_fifo_segment_attach (sm, a);
926   if (rv)
927     {
928       clib_warning ("svm_fifo_segment_attach ('%s') failed",
929                     mp->segment_name);
930       return;
931     }
932   seg = svm_fifo_segment_get_segment (sm, a->new_segment_indices[0]);
933   clib_warning ("Mapped new segment '%s' size %d", seg->ssvm.name,
934                 seg->ssvm.ssvm_size);
935   hash_set (utm->segments_table, clib_net_to_host_u64 (mp->segment_handle),
936             a->new_segment_indices[0]);
937 }
938
939 static void
940 vl_api_unmap_segment_t_handler (vl_api_unmap_segment_t * mp)
941 {
942   udp_echo_main_t *utm = &udp_echo_main;
943   svm_fifo_segment_main_t *sm = &utm->segment_main;
944   svm_fifo_segment_private_t *seg;
945   uword *seg_indexp;
946   u64 segment_handle;
947
948   segment_handle = clib_net_to_host_u64 (mp->segment_handle);
949   seg_indexp = hash_get (utm->segments_table, segment_handle);
950   if (!seg_indexp)
951     {
952       clib_warning ("segment not mapped: %s", segment_handle);
953       return;
954     }
955   hash_unset (utm->segments_table, segment_handle);
956   seg = svm_fifo_segment_get_segment (sm, (u32) seg_indexp[0]);
957   svm_fifo_segment_delete (sm, seg);
958   clib_warning ("Unmapped segment '%s'", segment_handle);
959 }
960
961 static void
962 vl_api_unbind_uri_reply_t_handler (vl_api_unbind_uri_reply_t * mp)
963 {
964   udp_echo_main_t *utm = &udp_echo_main;
965
966   if (mp->retval != 0)
967     clib_warning ("returned %d", ntohl (mp->retval));
968
969   utm->state = STATE_START;
970 }
971
972 static void
973   vl_api_app_cut_through_registration_add_t_handler
974   (vl_api_app_cut_through_registration_add_t * mp)
975 {
976
977 }
978
979 #define foreach_tcp_echo_msg                                            \
980 _(BIND_URI_REPLY, bind_uri_reply)                                       \
981 _(UNBIND_URI_REPLY, unbind_uri_reply)                                   \
982 _(MAP_ANOTHER_SEGMENT, map_another_segment)                             \
983 _(UNMAP_SEGMENT, unmap_segment)                                         \
984 _(APPLICATION_ATTACH_REPLY, application_attach_reply)                   \
985 _(APPLICATION_DETACH_REPLY, application_detach_reply)                   \
986 _(APP_CUT_THROUGH_REGISTRATION_ADD, app_cut_through_registration_add)   \
987
988 void
989 tcp_echo_api_hookup (udp_echo_main_t * utm)
990 {
991 #define _(N,n)                                                  \
992     vl_msg_api_set_handlers(VL_API_##N, #n,                     \
993                            vl_api_##n##_t_handler,              \
994                            vl_noop_handler,                     \
995                            vl_api_##n##_t_endian,               \
996                            vl_api_##n##_t_print,                \
997                            sizeof(vl_api_##n##_t), 1);
998   foreach_tcp_echo_msg;
999 #undef _
1000
1001 }
1002
1003 int
1004 connect_to_vpp (char *name)
1005 {
1006   udp_echo_main_t *utm = &udp_echo_main;
1007   api_main_t *am = &api_main;
1008
1009   if (vl_client_connect_to_vlib ("/vpe-api", name, 32) < 0)
1010     return -1;
1011
1012   utm->vl_input_queue = am->shmem_hdr->vl_input_queue;
1013   utm->my_client_index = am->my_client_index;
1014
1015   return 0;
1016 }
1017
1018 void
1019 vlib_cli_output (struct vlib_main_t *vm, char *fmt, ...)
1020 {
1021   clib_warning ("BUG");
1022 }
1023
1024 static void
1025 init_error_string_table (udp_echo_main_t * utm)
1026 {
1027   utm->error_string_by_error_number = hash_create (0, sizeof (uword));
1028
1029 #define _(n,v,s) hash_set (utm->error_string_by_error_number, -v, s);
1030   foreach_vnet_api_error;
1031 #undef _
1032
1033   hash_set (utm->error_string_by_error_number, 99, "Misc");
1034 }
1035
1036 void
1037 server_handle_fifo_event_rx (udp_echo_main_t * utm, u32 session_index)
1038 {
1039   svm_fifo_t *rx_fifo, *tx_fifo;
1040   int n_read;
1041   app_session_t *session;
1042   int rv;
1043   u32 max_dequeue, offset, max_transfer, rx_buf_len;
1044   session_evt_type_t et = FIFO_EVENT_APP_TX;
1045
1046   session = pool_elt_at_index (utm->sessions, session_index);
1047   rx_buf_len = vec_len (utm->rx_buf);
1048   rx_fifo = session->rx_fifo;
1049   tx_fifo = session->tx_fifo;
1050
1051   et += (session->session_index == utm->cut_through_session_index);
1052
1053   max_dequeue = svm_fifo_max_dequeue (rx_fifo);
1054   /* Allow enqueuing of a new event */
1055   svm_fifo_unset_event (rx_fifo);
1056
1057   if (PREDICT_FALSE (!max_dequeue))
1058     return;
1059
1060   /* Read the max_dequeue */
1061   do
1062     {
1063       max_transfer = clib_min (rx_buf_len, max_dequeue);
1064       if (session->is_dgram)
1065         n_read = app_recv_dgram_raw (rx_fifo, utm->rx_buf, max_transfer,
1066                                      &session->transport, 0, 0);
1067       else
1068         n_read = app_recv_stream_raw (rx_fifo, utm->rx_buf, max_transfer, 0,
1069                                       0);
1070
1071       if (n_read > 0)
1072         max_dequeue -= n_read;
1073
1074       /* Reflect if a non-drop session */
1075       if (utm->have_return && n_read > 0)
1076         {
1077           offset = 0;
1078           do
1079             {
1080               if (session->is_dgram)
1081                 rv = app_send_dgram_raw (tx_fifo, &session->transport,
1082                                          session->vpp_evt_q,
1083                                          &utm->rx_buf[offset], n_read, et,
1084                                          SVM_Q_WAIT);
1085               else
1086                 rv = app_send_stream_raw (tx_fifo, session->vpp_evt_q,
1087                                           &utm->rx_buf[offset], n_read, et,
1088                                           SVM_Q_WAIT);
1089               if (rv > 0)
1090                 {
1091                   n_read -= rv;
1092                   offset += rv;
1093                 }
1094             }
1095           while ((rv <= 0 || n_read > 0) && !utm->time_to_stop);
1096
1097           /* If event wasn't set, add one */
1098           if (svm_fifo_set_event (tx_fifo))
1099             app_send_io_evt_to_vpp (session->vpp_evt_q, tx_fifo,
1100                                     et, SVM_Q_WAIT);
1101         }
1102     }
1103   while ((n_read < 0 || max_dequeue > 0) && !utm->time_to_stop);
1104 }
1105
1106 static void
1107 server_handle_event_queue (udp_echo_main_t * utm)
1108 {
1109   session_event_t *e;
1110   svm_msg_q_msg_t msg;
1111   svm_msg_q_t *mq = utm->our_event_queue;
1112   int i;
1113
1114   while (utm->state != STATE_READY)
1115     sleep (5);
1116
1117   while (1)
1118     {
1119       if (svm_msg_q_sub (mq, &msg, SVM_Q_WAIT, 0))
1120         {
1121           clib_warning ("svm msg q returned");
1122           continue;
1123         }
1124       e = svm_msg_q_msg_data (mq, &msg);
1125       switch (e->event_type)
1126         {
1127         case FIFO_EVENT_APP_RX:
1128           server_handle_fifo_event_rx (utm, e->fifo->client_session_index);
1129           break;
1130         case SESSION_IO_EVT_CT_TX:
1131           break;
1132
1133         default:
1134           handle_mq_event (e);
1135           break;
1136         }
1137       svm_msg_q_free_msg (mq, &msg);
1138       if (PREDICT_FALSE (utm->time_to_stop == 1))
1139         return;
1140       if (PREDICT_FALSE (utm->time_to_print_stats == 1))
1141         {
1142           utm->time_to_print_stats = 0;
1143           fformat (stdout, "%d connections\n", pool_elts (utm->sessions));
1144         }
1145     }
1146 }
1147
1148 static void
1149 server_unbind (udp_echo_main_t * utm)
1150 {
1151   vl_api_unbind_uri_t *ump;
1152
1153   ump = vl_msg_api_alloc (sizeof (*ump));
1154   clib_memset (ump, 0, sizeof (*ump));
1155
1156   ump->_vl_msg_id = ntohs (VL_API_UNBIND_URI);
1157   ump->client_index = utm->my_client_index;
1158   memcpy (ump->uri, utm->listen_uri, vec_len (utm->listen_uri));
1159   vl_msg_api_send_shmem (utm->vl_input_queue, (u8 *) & ump);
1160 }
1161
1162 static void
1163 server_bind (udp_echo_main_t * utm)
1164 {
1165   vl_api_bind_uri_t *bmp;
1166
1167   bmp = vl_msg_api_alloc (sizeof (*bmp));
1168   clib_memset (bmp, 0, sizeof (*bmp));
1169
1170   bmp->_vl_msg_id = ntohs (VL_API_BIND_URI);
1171   bmp->client_index = utm->my_client_index;
1172   bmp->context = ntohl (0xfeedface);
1173   memcpy (bmp->uri, utm->listen_uri, vec_len (utm->listen_uri));
1174   vl_msg_api_send_shmem (utm->vl_input_queue, (u8 *) & bmp);
1175 }
1176
1177 void
1178 udp_server_test (udp_echo_main_t * utm)
1179 {
1180   u8 wait_for_state = utm->is_connected ? STATE_BOUND : STATE_READY;
1181   application_send_attach (utm);
1182
1183   /* Bind to uri */
1184   server_bind (utm);
1185
1186   if (wait_for_state_change (utm, wait_for_state))
1187     {
1188       clib_warning ("timeout waiting for state change");
1189       return;
1190     }
1191
1192   server_handle_event_queue (utm);
1193
1194   /* Cleanup */
1195   server_unbind (utm);
1196
1197   if (wait_for_state_change (utm, STATE_START))
1198     {
1199       clib_warning ("timeout waiting for STATE_START");
1200       return;
1201     }
1202
1203   application_detach (utm);
1204
1205   fformat (stdout, "Test complete...\n");
1206 }
1207
1208 int
1209 main (int argc, char **argv)
1210 {
1211   udp_echo_main_t *utm = &udp_echo_main;
1212   svm_fifo_segment_main_t *sm = &utm->segment_main;
1213   u8 *uri = (u8 *) "udp://6.0.1.1/1234";
1214   unformat_input_t _argv, *a = &_argv;
1215   int i_am_server = 1;
1216   app_session_t *session;
1217   u8 *chroot_prefix;
1218   char *app_name;
1219   u32 tmp;
1220   int i;
1221
1222   clib_mem_init_thread_safe (0, 256 << 20);
1223
1224   svm_fifo_segment_main_init (sm, HIGH_SEGMENT_BASEVA, 20);
1225
1226   vec_validate (utm->rx_buf, 128 << 10);
1227   utm->session_index_by_vpp_handles = hash_create (0, sizeof (uword));
1228   utm->my_pid = getpid ();
1229   utm->configured_segment_size = 1 << 20;
1230   utm->have_return = 1;
1231   utm->bytes_to_send = 1024;
1232   utm->fifo_size = 128 << 10;
1233   utm->cut_through_session_index = ~0;
1234   clib_time_init (&utm->clib_time);
1235
1236   init_error_string_table (utm);
1237   unformat_init_command_line (a, argv);
1238
1239   while (unformat_check_input (a) != UNFORMAT_END_OF_INPUT)
1240     {
1241       if (unformat (a, "chroot prefix %s", &chroot_prefix))
1242         {
1243           vl_set_memory_root_path ((char *) chroot_prefix);
1244         }
1245       else if (unformat (a, "uri %s", &uri))
1246         ;
1247       else if (unformat (a, "segment-size %dM", &tmp))
1248         utm->configured_segment_size = tmp << 20;
1249       else if (unformat (a, "segment-size %dG", &tmp))
1250         utm->configured_segment_size = tmp << 30;
1251       else if (unformat (a, "server"))
1252         i_am_server = 1;
1253       else if (unformat (a, "client"))
1254         i_am_server = 0;
1255       else if (unformat (a, "no-return"))
1256         utm->have_return = 0;
1257       else if (unformat (a, "mbytes %d", &tmp))
1258         utm->bytes_to_send = (u64) tmp << 20;
1259       else if (unformat (a, "fifo-size %d", &tmp))
1260         utm->fifo_size = tmp << 10;
1261       else
1262         {
1263           fformat (stderr, "%s: usage [server|client]\n");
1264           exit (1);
1265         }
1266     }
1267
1268   utm->i_am_server = i_am_server;
1269
1270   setup_signal_handlers ();
1271   tcp_echo_api_hookup (utm);
1272
1273   if (i_am_server)
1274     {
1275       utm->listen_uri = format (0, "%s%c", uri, 0);
1276       utm->is_connected = (utm->listen_uri[4] == 'c');
1277       app_name = "udp_echo_server";
1278     }
1279   else
1280     {
1281       app_name = "udp_echo_client";
1282       utm->connect_uri = format (0, "%s%c", uri, 0);
1283       utm->is_connected = (utm->connect_uri[4] == 'c');
1284     }
1285   if (connect_to_vpp (app_name) < 0)
1286     {
1287       svm_region_exit ();
1288       fformat (stderr, "Couldn't connect to vpe, exiting...\n");
1289       exit (1);
1290     }
1291
1292   if (i_am_server == 0)
1293     {
1294       client_test (utm);
1295       goto done;
1296     }
1297
1298   /* $$$$ hack preallocation */
1299   for (i = 0; i < 200000; i++)
1300     {
1301       pool_get (utm->sessions, session);
1302       clib_memset (session, 0, sizeof (*session));
1303     }
1304   for (i = 0; i < 200000; i++)
1305     pool_put_index (utm->sessions, i);
1306
1307   udp_server_test (utm);
1308
1309 done:
1310   vl_client_disconnect_from_vlib ();
1311   exit (0);
1312 }
1313
1314 #undef vl_api_version
1315 #define vl_api_version(n,v) static u32 vpe_api_version = v;
1316 #include <vpp/api/vpe.api.h>
1317 #undef vl_api_version
1318
1319 void
1320 vl_client_add_api_signatures (vl_api_memclnt_create_t * mp)
1321 {
1322   /*
1323    * Send the main API signature in slot 0. This bit of code must
1324    * match the checks in ../vpe/api/api.c: vl_msg_api_version_check().
1325    */
1326   mp->api_versions[0] = clib_host_to_net_u32 (vpe_api_version);
1327 }
1328
1329 u32
1330 vl (void *p)
1331 {
1332   return vec_len (p);
1333 }
1334
1335 /*
1336  * fd.io coding-style-patch-verification: ON
1337  *
1338  * Local Variables:
1339  * eval: (c-set-style "gnu")
1340  * End:
1341  */