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:
7 * http://www.apache.org/licenses/LICENSE-2.0
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.
22 #include <sys/resource.h>
23 #include <netinet/tcp.h>
25 #include <vcl/ldp_socket_wrapper.h>
29 #include <vcl/vcl_locked.h>
30 #include <vppinfra/time.h>
31 #include <vppinfra/bitmap.h>
32 #include <vppinfra/lock.h>
33 #include <vppinfra/pool.h>
34 #include <vppinfra/hash.h>
36 #define HAVE_CONSTRUCTOR_ATTRIBUTE
37 #ifdef HAVE_CONSTRUCTOR_ATTRIBUTE
38 #define CONSTRUCTOR_ATTRIBUTE \
39 __attribute__ ((constructor))
41 #define CONSTRUCTOR_ATTRIBUTE
42 #endif /* HAVE_CONSTRUCTOR_ATTRIBUTE */
44 #define HAVE_DESTRUCTOR_ATTRIBUTE
45 #ifdef HAVE_DESTRUCTOR_ATTRIBUTE
46 #define DESTRUCTOR_ATTRIBUTE \
47 __attribute__ ((destructor))
49 #define DESTRUCTOR_ATTRIBUTE
52 #define LDP_MAX_NWORKERS 32
54 typedef struct ldp_worker_ctx_
57 clib_time_t clib_time;
62 clib_bitmap_t *rd_bitmap;
63 clib_bitmap_t *wr_bitmap;
64 clib_bitmap_t *ex_bitmap;
65 clib_bitmap_t *si_rd_bitmap;
66 clib_bitmap_t *si_wr_bitmap;
67 clib_bitmap_t *si_ex_bitmap;
68 clib_bitmap_t *libc_rd_bitmap;
69 clib_bitmap_t *libc_wr_bitmap;
70 clib_bitmap_t *libc_ex_bitmap;
76 struct pollfd *libc_poll;
87 /* clib_bitmap_t, fd_mask and vcl_si_set are used interchangeably. Make sure
88 * they are the same size */
89 STATIC_ASSERT (sizeof (clib_bitmap_t) == sizeof (fd_mask),
90 "ldp bitmap size mismatch");
91 STATIC_ASSERT (sizeof (vcl_si_set) == sizeof (fd_mask),
92 "ldp bitmap size mismatch");
96 ldp_worker_ctx_t *workers;
98 char app_name[LDP_APP_NAME_MAX];
103 /** vcl needs next epoll_create to go to libc_epoll */
104 u8 vcl_needs_real_epoll;
107 #define LDP_DEBUG ldp->debug
109 #define LDBG(_lvl, _fmt, _args...) \
110 if (ldp->debug > _lvl) \
111 clib_warning ("ldp<%d>: " _fmt, getpid(), ##_args)
113 static ldp_main_t ldp_main = {
114 .vlsh_bit_val = (1 << LDP_SID_BIT_MIN),
115 .vlsh_bit_mask = (1 << LDP_SID_BIT_MIN) - 1,
116 .debug = LDP_DEBUG_INIT,
119 static ldp_main_t *ldp = &ldp_main;
121 static inline ldp_worker_ctx_t *
122 ldp_worker_get_current (void)
124 return (ldp->workers + vppcom_worker_index ());
128 * RETURN: 0 on success or -1 on error.
131 ldp_set_app_name (char *app_name)
133 int rv = snprintf (ldp->app_name, LDP_APP_NAME_MAX,
134 "ldp-%d-%s", getpid (), app_name);
136 if (rv >= LDP_APP_NAME_MAX)
137 app_name[LDP_APP_NAME_MAX - 1] = 0;
143 if (ldp->app_name[0] == '\0')
144 ldp_set_app_name ("app");
146 return ldp->app_name;
150 ldp_vlsh_to_fd (vls_handle_t vlsh)
152 return (vlsh + ldp->vlsh_bit_val);
155 static inline vls_handle_t
156 ldp_fd_to_vlsh (int fd)
158 if (fd < ldp->vlsh_bit_val)
159 return VLS_INVALID_HANDLE;
161 return (fd - ldp->vlsh_bit_val);
165 ldp_alloc_workers (void)
169 pool_alloc (ldp->workers, LDP_MAX_NWORKERS);
175 ldp_worker_ctx_t *ldpw;
178 if (PREDICT_TRUE (ldp->init))
182 ldp->vcl_needs_real_epoll = 1;
183 rv = vls_app_create (ldp_get_app_name ());
186 ldp->vcl_needs_real_epoll = 0;
187 if (rv == VPPCOM_EEXIST)
189 LDBG (2, "\nERROR: ldp_init: vppcom_app_create()"
190 " failed! rv = %d (%s)\n", rv, vppcom_retval_str (rv));
194 ldp->vcl_needs_real_epoll = 0;
195 ldp_alloc_workers ();
196 ldpw = ldp_worker_get_current ();
198 char *env_var_str = getenv (LDP_ENV_DEBUG);
202 if (sscanf (env_var_str, "%u", &tmp) != 1)
203 clib_warning ("LDP<%d>: WARNING: Invalid LDP debug level specified in"
204 " the env var " LDP_ENV_DEBUG " (%s)!", getpid (),
209 LDBG (0, "configured LDP debug level (%u) from env var "
210 LDP_ENV_DEBUG "!", ldp->debug);
214 env_var_str = getenv (LDP_ENV_APP_NAME);
217 ldp_set_app_name (env_var_str);
218 LDBG (0, "configured LDP app name (%s) from the env var "
219 LDP_ENV_APP_NAME "!", ldp->app_name);
222 env_var_str = getenv (LDP_ENV_SID_BIT);
226 if (sscanf (env_var_str, "%u", &sb) != 1)
228 LDBG (0, "WARNING: Invalid LDP sid bit specified in the env var "
229 LDP_ENV_SID_BIT " (%s)! sid bit value %d (0x%x)", env_var_str,
230 ldp->vlsh_bit_val, ldp->vlsh_bit_val);
232 else if (sb < LDP_SID_BIT_MIN)
234 ldp->vlsh_bit_val = (1 << LDP_SID_BIT_MIN);
235 ldp->vlsh_bit_mask = ldp->vlsh_bit_val - 1;
237 LDBG (0, "WARNING: LDP sid bit (%u) specified in the env var "
238 LDP_ENV_SID_BIT " (%s) is too small. Using LDP_SID_BIT_MIN"
239 " (%d)! sid bit value %d (0x%x)", sb, env_var_str,
240 LDP_SID_BIT_MIN, ldp->vlsh_bit_val, ldp->vlsh_bit_val);
242 else if (sb > LDP_SID_BIT_MAX)
244 ldp->vlsh_bit_val = (1 << LDP_SID_BIT_MAX);
245 ldp->vlsh_bit_mask = ldp->vlsh_bit_val - 1;
247 LDBG (0, "WARNING: LDP sid bit (%u) specified in the env var "
248 LDP_ENV_SID_BIT " (%s) is too big. Using LDP_SID_BIT_MAX"
249 " (%d)! sid bit value %d (0x%x)", sb, env_var_str,
250 LDP_SID_BIT_MAX, ldp->vlsh_bit_val, ldp->vlsh_bit_val);
254 ldp->vlsh_bit_val = (1 << sb);
255 ldp->vlsh_bit_mask = ldp->vlsh_bit_val - 1;
257 LDBG (0, "configured LDP sid bit (%u) from "
258 LDP_ENV_SID_BIT "! sid bit value %d (0x%x)", sb,
259 ldp->vlsh_bit_val, ldp->vlsh_bit_val);
262 /* Make sure there are enough bits in the fd set for vcl sessions */
263 if (ldp->vlsh_bit_val > FD_SETSIZE / 2)
265 LDBG (0, "ERROR: LDP vlsh bit value %d > FD_SETSIZE/2 %d!",
266 ldp->vlsh_bit_val, FD_SETSIZE / 2);
273 pool_foreach (ldpw, ldp->workers, ({
274 clib_memset (&ldpw->clib_time, 0, sizeof (ldpw->clib_time));
278 LDBG (0, "LDP initialization: done!");
289 if ((errno = -ldp_init ()))
292 vlsh = ldp_fd_to_vlsh (fd);
293 if (vlsh != VLS_INVALID_HANDLE)
295 epfd = vls_attr (vlsh, VPPCOM_ATTR_GET_LIBC_EPFD, 0, 0);
298 LDBG (0, "fd %d: calling libc_close: epfd %u", fd, epfd);
300 rv = libc_close (epfd);
303 u32 size = sizeof (epfd);
306 (void) vls_attr (vlsh, VPPCOM_ATTR_SET_LIBC_EPFD, &epfd, &size);
309 else if (PREDICT_FALSE (epfd < 0))
316 LDBG (0, "fd %d: calling vls_close: vlsh %u", fd, vlsh);
318 rv = vls_close (vlsh);
327 LDBG (0, "fd %d: calling libc_close", fd);
328 rv = libc_close (fd);
336 read (int fd, void *buf, size_t nbytes)
341 if ((errno = -ldp_init ()))
344 vlsh = ldp_fd_to_vlsh (fd);
345 if (vlsh != VLS_INVALID_HANDLE)
347 size = vls_read (vlsh, buf, nbytes);
356 size = libc_read (fd, buf, nbytes);
363 readv (int fd, const struct iovec * iov, int iovcnt)
365 int rv = 0, i, total = 0;
369 if ((errno = -ldp_init ()))
372 vlsh = ldp_fd_to_vlsh (fd);
373 if (vlsh != VLS_INVALID_HANDLE)
377 for (i = 0; i < iovcnt; ++i)
379 rv = vls_read (vlsh, iov[i].iov_base, iov[i].iov_len);
385 if (rv < iov[i].iov_len)
390 while ((rv >= 0) && (total == 0));
402 size = libc_readv (fd, iov, iovcnt);
409 write (int fd, const void *buf, size_t nbytes)
414 if ((errno = -ldp_init ()))
417 vlsh = ldp_fd_to_vlsh (fd);
418 if (vlsh != VLS_INVALID_HANDLE)
420 size = vls_write_msg (vlsh, (void *) buf, nbytes);
429 size = libc_write (fd, buf, nbytes);
436 writev (int fd, const struct iovec * iov, int iovcnt)
438 ssize_t size = 0, total = 0;
442 if ((errno = -ldp_init ()))
445 vlsh = ldp_fd_to_vlsh (fd);
446 if (vlsh != VLS_INVALID_HANDLE)
450 for (i = 0; i < iovcnt; ++i)
452 rv = vls_write_msg (vlsh, iov[i].iov_base, iov[i].iov_len);
458 if (rv < iov[i].iov_len)
463 while ((rv >= 0) && (total == 0));
475 size = libc_writev (fd, iov, iovcnt);
482 fcntl (int fd, int cmd, ...)
488 if ((errno = -ldp_init ()))
493 vlsh = ldp_fd_to_vlsh (fd);
494 LDBG (0, "fd %u vlsh %d, cmd %u", fd, vlsh, cmd);
495 if (vlsh != VLS_INVALID_HANDLE)
497 int flags = va_arg (ap, int);
500 size = sizeof (flags);
505 rv = vls_attr (vlsh, VPPCOM_ATTR_SET_FLAGS, &flags, &size);
509 rv = vls_attr (vlsh, VPPCOM_ATTR_GET_FLAGS, &flags, &size);
514 /* TODO handle this */
515 LDBG (0, "F_SETFD ignored flags %u", flags);
530 rv = libc_vfcntl (fd, cmd, ap);
539 ioctl (int fd, unsigned long int cmd, ...)
545 if ((errno = -ldp_init ()))
550 vlsh = ldp_fd_to_vlsh (fd);
551 if (vlsh != VLS_INVALID_HANDLE)
556 rv = vls_attr (vlsh, VPPCOM_ATTR_GET_NREAD, 0, 0);
561 u32 flags = va_arg (ap, int) ? O_NONBLOCK : 0;
562 u32 size = sizeof (flags);
564 /* TBD: When VPPCOM_ATTR_[GS]ET_FLAGS supports flags other than
565 * non-blocking, the flags should be read here and merged
568 rv = vls_attr (vlsh, VPPCOM_ATTR_SET_FLAGS, &flags, &size);
584 rv = libc_vioctl (fd, cmd, ap);
592 ldp_select_init_maps (fd_set * __restrict original,
593 clib_bitmap_t ** resultb, clib_bitmap_t ** libcb,
594 clib_bitmap_t ** vclb, int nfds, u32 minbits,
595 u32 n_bytes, uword * si_bits, uword * libc_bits)
597 uword si_bits_set, libc_bits_set;
601 clib_bitmap_validate (*vclb, minbits);
602 clib_bitmap_validate (*libcb, minbits);
603 clib_bitmap_validate (*resultb, minbits);
604 clib_memcpy_fast (*resultb, original, n_bytes);
605 memset (original, 0, n_bytes);
608 clib_bitmap_foreach (fd, *resultb, ({
611 vlsh = ldp_fd_to_vlsh (fd);
612 if (vlsh == VLS_INVALID_HANDLE)
613 clib_bitmap_set_no_check (*libcb, fd, 1);
615 clib_bitmap_set_no_check (*vclb, vlsh_to_session_index (vlsh), 1);
619 si_bits_set = clib_bitmap_last_set (*vclb) + 1;
620 *si_bits = (si_bits_set > *si_bits) ? si_bits_set : *si_bits;
622 libc_bits_set = clib_bitmap_last_set (*libcb) + 1;
623 *libc_bits = (libc_bits_set > *libc_bits) ? libc_bits_set : *libc_bits;
627 ldp_select_vcl_map_to_libc (clib_bitmap_t * vclb, fd_set * __restrict libcb)
637 clib_bitmap_foreach (si, vclb, ({
638 vlsh = vls_session_index_to_vlsh (si);
639 fd = ldp_vlsh_to_fd (vlsh);
640 if (PREDICT_FALSE (fd < 0))
653 ldp_select_libc_map_merge (clib_bitmap_t * result, fd_set * __restrict libcb)
661 clib_bitmap_foreach (fd, result, ({
662 FD_SET ((int)fd, libcb);
668 ldp_pselect (int nfds, fd_set * __restrict readfds,
669 fd_set * __restrict writefds,
670 fd_set * __restrict exceptfds,
671 const struct timespec *__restrict timeout,
672 const __sigset_t * __restrict sigmask)
674 u32 minbits = clib_max (nfds, BITS (uword)), n_bytes;
675 ldp_worker_ctx_t *ldpw = ldp_worker_get_current ();
676 struct timespec libc_tspec = { 0 };
677 f64 time_out, vcl_timeout = 0;
678 uword si_bits, libc_bits;
679 int rv, bits_set = 0;
687 if (PREDICT_FALSE (ldpw->clib_time.init_cpu_time == 0))
688 clib_time_init (&ldpw->clib_time);
692 time_out = (timeout->tv_sec == 0 && timeout->tv_nsec == 0) ?
693 (f64) 0 : (f64) timeout->tv_sec + (f64) timeout->tv_nsec / (f64) 1e9;
695 /* select as fine grained sleep */
698 time_out += clib_time_now (&ldpw->clib_time);
699 while (clib_time_now (&ldpw->clib_time) < time_out)
712 if (nfds <= ldp->vlsh_bit_val)
714 rv = libc_pselect (nfds, readfds, writefds, exceptfds,
719 si_bits = libc_bits = 0;
720 n_bytes = nfds / 8 + ((nfds % 8) ? 1 : 0);
723 ldp_select_init_maps (readfds, &ldpw->rd_bitmap, &ldpw->libc_rd_bitmap,
724 &ldpw->si_rd_bitmap, nfds, minbits, n_bytes,
725 &si_bits, &libc_bits);
727 ldp_select_init_maps (writefds, &ldpw->wr_bitmap,
728 &ldpw->libc_wr_bitmap, &ldpw->si_wr_bitmap, nfds,
729 minbits, n_bytes, &si_bits, &libc_bits);
731 ldp_select_init_maps (exceptfds, &ldpw->ex_bitmap,
732 &ldpw->libc_ex_bitmap, &ldpw->si_ex_bitmap, nfds,
733 minbits, n_bytes, &si_bits, &libc_bits);
735 if (PREDICT_FALSE (!si_bits && !libc_bits))
743 libc_tspec = timeout ? *timeout : libc_tspec;
750 clib_memcpy_fast (ldpw->rd_bitmap, ldpw->si_rd_bitmap,
751 vec_len (ldpw->rd_bitmap) *
752 sizeof (clib_bitmap_t));
754 clib_memcpy_fast (ldpw->wr_bitmap, ldpw->si_wr_bitmap,
755 vec_len (ldpw->wr_bitmap) *
756 sizeof (clib_bitmap_t));
758 clib_memcpy_fast (ldpw->ex_bitmap, ldpw->si_ex_bitmap,
759 vec_len (ldpw->ex_bitmap) *
760 sizeof (clib_bitmap_t));
762 rv = vls_select (si_bits, readfds ? ldpw->rd_bitmap : NULL,
763 writefds ? ldpw->wr_bitmap : NULL,
764 exceptfds ? ldpw->ex_bitmap : NULL, vcl_timeout);
772 if (ldp_select_vcl_map_to_libc (ldpw->rd_bitmap, readfds))
778 if (ldp_select_vcl_map_to_libc (ldpw->wr_bitmap, writefds))
784 if (ldp_select_vcl_map_to_libc (ldpw->ex_bitmap, exceptfds))
795 clib_memcpy_fast (ldpw->rd_bitmap, ldpw->libc_rd_bitmap,
796 vec_len (ldpw->libc_rd_bitmap) *
797 sizeof (clib_bitmap_t));
799 clib_memcpy_fast (ldpw->wr_bitmap, ldpw->libc_wr_bitmap,
800 vec_len (ldpw->libc_wr_bitmap) *
801 sizeof (clib_bitmap_t));
803 clib_memcpy_fast (ldpw->ex_bitmap, ldpw->libc_ex_bitmap,
804 vec_len (ldpw->libc_ex_bitmap) *
805 sizeof (clib_bitmap_t));
807 rv = libc_pselect (libc_bits,
808 readfds ? (fd_set *) ldpw->rd_bitmap : NULL,
809 writefds ? (fd_set *) ldpw->wr_bitmap : NULL,
810 exceptfds ? (fd_set *) ldpw->ex_bitmap : NULL,
811 &libc_tspec, sigmask);
814 ldp_select_libc_map_merge (ldpw->rd_bitmap, readfds);
815 ldp_select_libc_map_merge (ldpw->wr_bitmap, writefds);
816 ldp_select_libc_map_merge (ldpw->ex_bitmap, exceptfds);
827 while ((time_out == -1) || (clib_time_now (&ldpw->clib_time) < time_out));
831 /* TBD: set timeout to amount of time left */
832 clib_bitmap_zero (ldpw->rd_bitmap);
833 clib_bitmap_zero (ldpw->si_rd_bitmap);
834 clib_bitmap_zero (ldpw->libc_rd_bitmap);
835 clib_bitmap_zero (ldpw->wr_bitmap);
836 clib_bitmap_zero (ldpw->si_wr_bitmap);
837 clib_bitmap_zero (ldpw->libc_wr_bitmap);
838 clib_bitmap_zero (ldpw->ex_bitmap);
839 clib_bitmap_zero (ldpw->si_ex_bitmap);
840 clib_bitmap_zero (ldpw->libc_ex_bitmap);
846 select (int nfds, fd_set * __restrict readfds,
847 fd_set * __restrict writefds,
848 fd_set * __restrict exceptfds, struct timeval *__restrict timeout)
850 struct timespec tspec;
854 tspec.tv_sec = timeout->tv_sec;
855 tspec.tv_nsec = timeout->tv_usec * 1000;
857 return ldp_pselect (nfds, readfds, writefds, exceptfds,
858 timeout ? &tspec : NULL, NULL);
863 pselect (int nfds, fd_set * __restrict readfds,
864 fd_set * __restrict writefds,
865 fd_set * __restrict exceptfds,
866 const struct timespec *__restrict timeout,
867 const __sigset_t * __restrict sigmask)
869 return ldp_pselect (nfds, readfds, writefds, exceptfds, timeout, 0);
874 socket (int domain, int type, int protocol)
876 int rv, sock_type = type & ~(SOCK_CLOEXEC | SOCK_NONBLOCK);
877 u8 is_nonblocking = type & SOCK_NONBLOCK ? 1 : 0;
880 if ((errno = -ldp_init ()))
883 if (((domain == AF_INET) || (domain == AF_INET6)) &&
884 ((sock_type == SOCK_STREAM) || (sock_type == SOCK_DGRAM)))
886 u8 proto = ((sock_type == SOCK_DGRAM) ?
887 VPPCOM_PROTO_UDP : VPPCOM_PROTO_TCP);
889 LDBG (0, "calling vls_create: proto %u (%s), is_nonblocking %u",
890 proto, vppcom_proto_str (proto), is_nonblocking);
892 vlsh = vls_create (proto, is_nonblocking);
900 rv = ldp_vlsh_to_fd (vlsh);
905 LDBG (0, "calling libc_socket");
906 rv = libc_socket (domain, type, protocol);
913 * Create two new sockets, of type TYPE in domain DOMAIN and using
914 * protocol PROTOCOL, which are connected to each other, and put file
915 * descriptors for them in FDS[0] and FDS[1]. If PROTOCOL is zero,
916 * one will be chosen automatically.
917 * Returns 0 on success, -1 for errors.
920 socketpair (int domain, int type, int protocol, int fds[2])
922 int rv, sock_type = type & ~(SOCK_CLOEXEC | SOCK_NONBLOCK);
924 if ((errno = -ldp_init ()))
927 if (((domain == AF_INET) || (domain == AF_INET6)) &&
928 ((sock_type == SOCK_STREAM) || (sock_type == SOCK_DGRAM)))
936 LDBG (1, "calling libc_socketpair");
937 rv = libc_socketpair (domain, type, protocol, fds);
944 bind (int fd, __CONST_SOCKADDR_ARG addr, socklen_t len)
949 if ((errno = -ldp_init ()))
952 vlsh = ldp_fd_to_vlsh (fd);
953 if (vlsh != VLS_INVALID_HANDLE)
957 switch (addr->sa_family)
960 if (len != sizeof (struct sockaddr_in))
962 LDBG (0, "ERROR: fd %d: vlsh %u: Invalid AF_INET addr len %u!",
968 ep.is_ip4 = VPPCOM_IS_IP4;
969 ep.ip = (u8 *) & ((const struct sockaddr_in *) addr)->sin_addr;
970 ep.port = (u16) ((const struct sockaddr_in *) addr)->sin_port;
974 if (len != sizeof (struct sockaddr_in6))
976 LDBG (0, "ERROR: fd %d: vlsh %u: Invalid AF_INET6 addr len %u!",
982 ep.is_ip4 = VPPCOM_IS_IP6;
983 ep.ip = (u8 *) & ((const struct sockaddr_in6 *) addr)->sin6_addr;
984 ep.port = (u16) ((const struct sockaddr_in6 *) addr)->sin6_port;
988 LDBG (0, "ERROR: fd %d: vlsh %u: Unsupported address family %u!",
989 fd, vlsh, addr->sa_family);
990 errno = EAFNOSUPPORT;
994 LDBG (0, "fd %d: calling vls_bind: vlsh %u, addr %p, len %u", fd, vlsh,
997 rv = vls_bind (vlsh, &ep);
1006 LDBG (0, "fd %d: calling libc_bind: addr %p, len %u", fd, addr, len);
1007 rv = libc_bind (fd, addr, len);
1011 LDBG (1, "fd %d: returning %d", fd, rv);
1017 ldp_copy_ep_to_sockaddr (__SOCKADDR_ARG addr, socklen_t * __restrict len,
1018 vppcom_endpt_t * ep)
1021 int sa_len, copy_len;
1023 if ((errno = -ldp_init ()))
1026 if (addr && len && ep)
1028 addr->sa_family = (ep->is_ip4 == VPPCOM_IS_IP4) ? AF_INET : AF_INET6;
1029 switch (addr->sa_family)
1032 ((struct sockaddr_in *) addr)->sin_port = ep->port;
1033 if (*len > sizeof (struct sockaddr_in))
1034 *len = sizeof (struct sockaddr_in);
1035 sa_len = sizeof (struct sockaddr_in) - sizeof (struct in_addr);
1036 copy_len = *len - sa_len;
1038 memcpy (&((struct sockaddr_in *) addr)->sin_addr, ep->ip,
1043 ((struct sockaddr_in6 *) addr)->sin6_port = ep->port;
1044 if (*len > sizeof (struct sockaddr_in6))
1045 *len = sizeof (struct sockaddr_in6);
1046 sa_len = sizeof (struct sockaddr_in6) - sizeof (struct in6_addr);
1047 copy_len = *len - sa_len;
1049 memcpy (((struct sockaddr_in6 *) addr)->sin6_addr.
1050 __in6_u.__u6_addr8, ep->ip, copy_len);
1063 getsockname (int fd, __SOCKADDR_ARG addr, socklen_t * __restrict len)
1068 if ((errno = -ldp_init ()))
1071 vlsh = ldp_fd_to_vlsh (fd);
1072 if (vlsh != VLS_INVALID_HANDLE)
1075 u8 addr_buf[sizeof (struct in6_addr)];
1076 u32 size = sizeof (ep);
1080 rv = vls_attr (vlsh, VPPCOM_ATTR_GET_LCL_ADDR, &ep, &size);
1081 if (rv != VPPCOM_OK)
1088 rv = ldp_copy_ep_to_sockaddr (addr, len, &ep);
1089 if (rv != VPPCOM_OK)
1098 rv = libc_getsockname (fd, addr, len);
1105 connect (int fd, __CONST_SOCKADDR_ARG addr, socklen_t len)
1110 if ((errno = -ldp_init ()))
1115 LDBG (0, "ERROR: fd %d: NULL addr, len %u", fd, len);
1121 vlsh = ldp_fd_to_vlsh (fd);
1122 if (vlsh != VLS_INVALID_HANDLE)
1126 switch (addr->sa_family)
1129 if (len != sizeof (struct sockaddr_in))
1131 LDBG (0, "fd %d: ERROR vlsh %u: Invalid AF_INET addr len %u!",
1137 ep.is_ip4 = VPPCOM_IS_IP4;
1138 ep.ip = (u8 *) & ((const struct sockaddr_in *) addr)->sin_addr;
1139 ep.port = (u16) ((const struct sockaddr_in *) addr)->sin_port;
1143 if (len != sizeof (struct sockaddr_in6))
1145 LDBG (0, "fd %d: ERROR vlsh %u: Invalid AF_INET6 addr len %u!",
1151 ep.is_ip4 = VPPCOM_IS_IP6;
1152 ep.ip = (u8 *) & ((const struct sockaddr_in6 *) addr)->sin6_addr;
1153 ep.port = (u16) ((const struct sockaddr_in6 *) addr)->sin6_port;
1157 LDBG (0, "fd %d: ERROR vlsh %u: Unsupported address family %u!",
1158 fd, vlsh, addr->sa_family);
1159 errno = EAFNOSUPPORT;
1163 LDBG (0, "fd %d: calling vls_connect(): vlsh %u addr %p len %u", fd,
1166 rv = vls_connect (vlsh, &ep);
1167 if (rv != VPPCOM_OK)
1175 LDBG (0, "fd %d: calling libc_connect(): addr %p, len %u",
1178 rv = libc_connect (fd, addr, len);
1182 LDBG (1, "fd %d: returning %d (0x%x)", fd, rv, rv);
1187 getpeername (int fd, __SOCKADDR_ARG addr, socklen_t * __restrict len)
1192 if ((errno = -ldp_init ()))
1195 vlsh = ldp_fd_to_vlsh (fd);
1196 if (vlsh != VLS_INVALID_HANDLE)
1199 u8 addr_buf[sizeof (struct in6_addr)];
1200 u32 size = sizeof (ep);
1203 rv = vls_attr (vlsh, VPPCOM_ATTR_GET_PEER_ADDR, &ep, &size);
1204 if (rv != VPPCOM_OK)
1211 rv = ldp_copy_ep_to_sockaddr (addr, len, &ep);
1212 if (rv != VPPCOM_OK)
1221 rv = libc_getpeername (fd, addr, len);
1228 send (int fd, const void *buf, size_t n, int flags)
1230 vls_handle_t vlsh = ldp_fd_to_vlsh (fd);
1233 if ((errno = -ldp_init ()))
1236 if (vlsh != VLS_INVALID_HANDLE)
1238 size = vls_sendto (vlsh, (void *) buf, n, flags, NULL);
1239 if (size < VPPCOM_OK)
1247 size = libc_send (fd, buf, n, flags);
1254 sendfile (int out_fd, int in_fd, off_t * offset, size_t len)
1256 ldp_worker_ctx_t *ldpw = ldp_worker_get_current ();
1260 if ((errno = -ldp_init ()))
1263 vlsh = ldp_fd_to_vlsh (out_fd);
1264 if (vlsh != VLS_INVALID_HANDLE)
1267 ssize_t results = 0;
1268 size_t n_bytes_left = len;
1269 size_t bytes_to_read;
1272 u32 flags, flags_len = sizeof (flags);
1274 rv = vls_attr (vlsh, VPPCOM_ATTR_GET_FLAGS, &flags, &flags_len);
1275 if (PREDICT_FALSE (rv != VPPCOM_OK))
1277 LDBG (0, "ERROR: out fd %d: vls_attr: vlsh %u, returned %d (%s)!",
1278 out_fd, vlsh, rv, vppcom_retval_str (rv));
1280 vec_reset_length (ldpw->io_buffer);
1288 off_t off = lseek (in_fd, *offset, SEEK_SET);
1289 if (PREDICT_FALSE (off == -1))
1295 ASSERT (off == *offset);
1300 size = vls_attr (vlsh, VPPCOM_ATTR_GET_NWRITE, 0, 0);
1303 LDBG (0, "ERROR: fd %d: vls_attr: vlsh %u returned %d (%s)!",
1304 out_fd, vlsh, size, vppcom_retval_str (size));
1305 vec_reset_length (ldpw->io_buffer);
1311 bytes_to_read = size;
1312 if (bytes_to_read == 0)
1314 if (flags & O_NONBLOCK)
1323 bytes_to_read = clib_min (n_bytes_left, bytes_to_read);
1324 vec_validate (ldpw->io_buffer, bytes_to_read);
1325 nbytes = libc_read (in_fd, ldpw->io_buffer, bytes_to_read);
1330 vec_reset_length (ldpw->io_buffer);
1337 size = vls_write (vlsh, ldpw->io_buffer, nbytes);
1340 if (size == VPPCOM_EAGAIN)
1342 if (flags & O_NONBLOCK)
1353 vec_reset_length (ldpw->io_buffer);
1362 ASSERT (n_bytes_left >= nbytes);
1363 n_bytes_left = n_bytes_left - nbytes;
1365 while (n_bytes_left > 0);
1368 vec_reset_length (ldpw->io_buffer);
1371 off_t off = lseek (in_fd, *offset, SEEK_SET);
1372 if (PREDICT_FALSE (off == -1))
1378 ASSERT (off == *offset);
1379 *offset += results + 1;
1391 size = libc_sendfile (out_fd, in_fd, offset, len);
1399 sendfile64 (int out_fd, int in_fd, off_t * offset, size_t len)
1401 return sendfile (out_fd, in_fd, offset, len);
1405 recv (int fd, void *buf, size_t n, int flags)
1410 if ((errno = -ldp_init ()))
1413 vlsh = ldp_fd_to_vlsh (fd);
1414 if (vlsh != VLS_INVALID_HANDLE)
1416 size = vls_recvfrom (vlsh, buf, n, flags, NULL);
1422 size = libc_recv (fd, buf, n, flags);
1429 sendto (int fd, const void *buf, size_t n, int flags,
1430 __CONST_SOCKADDR_ARG addr, socklen_t addr_len)
1435 if ((errno = -ldp_init ()))
1438 vlsh = ldp_fd_to_vlsh (fd);
1439 if (vlsh != INVALID_SESSION_ID)
1441 vppcom_endpt_t *ep = 0;
1447 switch (addr->sa_family)
1450 ep->is_ip4 = VPPCOM_IS_IP4;
1452 (uint8_t *) & ((const struct sockaddr_in *) addr)->sin_addr;
1454 (uint16_t) ((const struct sockaddr_in *) addr)->sin_port;
1458 ep->is_ip4 = VPPCOM_IS_IP6;
1460 (uint8_t *) & ((const struct sockaddr_in6 *) addr)->sin6_addr;
1462 (uint16_t) ((const struct sockaddr_in6 *) addr)->sin6_port;
1466 errno = EAFNOSUPPORT;
1472 size = vls_sendto (vlsh, (void *) buf, n, flags, ep);
1481 size = libc_sendto (fd, buf, n, flags, addr, addr_len);
1489 recvfrom (int fd, void *__restrict buf, size_t n, int flags,
1490 __SOCKADDR_ARG addr, socklen_t * __restrict addr_len)
1495 if ((errno = -ldp_init ()))
1498 sid = ldp_fd_to_vlsh (fd);
1499 if (sid != VLS_INVALID_HANDLE)
1502 u8 src_addr[sizeof (struct sockaddr_in6)];
1507 size = vls_recvfrom (sid, buf, n, flags, &ep);
1511 rv = ldp_copy_ep_to_sockaddr (addr, addr_len, &ep);
1517 size = vls_recvfrom (sid, buf, n, flags, NULL);
1527 size = libc_recvfrom (fd, buf, n, flags, addr, addr_len);
1534 sendmsg (int fd, const struct msghdr * message, int flags)
1539 if ((errno = -ldp_init ()))
1542 vlsh = ldp_fd_to_vlsh (fd);
1543 if (vlsh != VLS_INVALID_HANDLE)
1545 LDBG (0, "LDP-TBD");
1551 size = libc_sendmsg (fd, message, flags);
1559 sendmmsg (int fd, struct mmsghdr *vmessages, unsigned int vlen, int flags)
1562 const char *func_str;
1563 u32 sh = ldp_fd_to_vlsh (fd);
1565 if ((errno = -ldp_init ()))
1568 if (sh != INVALID_SESSION_ID)
1570 clib_warning ("LDP<%d>: LDP-TBD", getpid ());
1576 func_str = "libc_sendmmsg";
1579 clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): "
1580 "vmessages %p, vlen %u, flags 0x%x",
1581 getpid (), fd, fd, func_str, vmessages, vlen, flags);
1583 size = libc_sendmmsg (fd, vmessages, vlen, flags);
1590 int errno_val = errno;
1592 clib_warning ("LDP<%d>: ERROR: fd %d (0x%x): %s() failed! "
1593 "rv %d, errno = %d", getpid (), fd, fd,
1594 func_str, size, errno_val);
1598 clib_warning ("LDP<%d>: fd %d (0x%x): returning %d (0x%x)",
1599 getpid (), fd, fd, size, size);
1606 recvmsg (int fd, struct msghdr * message, int flags)
1611 if ((errno = -ldp_init ()))
1614 vlsh = ldp_fd_to_vlsh (fd);
1615 if (vlsh != VLS_INVALID_HANDLE)
1617 LDBG (0, "LDP-TBD");
1623 size = libc_recvmsg (fd, message, flags);
1631 recvmmsg (int fd, struct mmsghdr *vmessages,
1632 unsigned int vlen, int flags, struct timespec *tmo)
1635 const char *func_str;
1636 u32 sh = ldp_fd_to_vlsh (fd);
1638 if ((errno = -ldp_init ()))
1641 if (sh != INVALID_SESSION_ID)
1643 clib_warning ("LDP<%d>: LDP-TBD", getpid ());
1649 func_str = "libc_recvmmsg";
1652 clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): "
1653 "vmessages %p, vlen %u, flags 0x%x, tmo %p",
1654 getpid (), fd, fd, func_str, vmessages, vlen,
1657 size = libc_recvmmsg (fd, vmessages, vlen, flags, tmo);
1664 int errno_val = errno;
1666 clib_warning ("LDP<%d>: ERROR: fd %d (0x%x): %s() failed! "
1667 "rv %d, errno = %d", getpid (), fd, fd,
1668 func_str, size, errno_val);
1672 clib_warning ("LDP<%d>: fd %d (0x%x): returning %d (0x%x)",
1673 getpid (), fd, fd, size, size);
1680 getsockopt (int fd, int level, int optname,
1681 void *__restrict optval, socklen_t * __restrict optlen)
1686 if ((errno = -ldp_init ()))
1689 vlsh = ldp_fd_to_vlsh (fd);
1690 if (vlsh != VLS_INVALID_HANDLE)
1700 rv = vls_attr (vlsh, VPPCOM_ATTR_GET_TCP_NODELAY,
1704 rv = vls_attr (vlsh, VPPCOM_ATTR_GET_TCP_USER_MSS,
1708 rv = vls_attr (vlsh, VPPCOM_ATTR_GET_TCP_KEEPIDLE,
1712 rv = vls_attr (vlsh, VPPCOM_ATTR_GET_TCP_KEEPINTVL,
1716 if (optval && optlen && (*optlen == sizeof (struct tcp_info)))
1718 LDBG (1, "fd %d: vlsh %u SOL_TCP, TCP_INFO, optval %p, "
1719 "optlen %d: #LDP-NOP#", fd, vlsh, optval, *optlen);
1720 memset (optval, 0, *optlen);
1726 case TCP_CONGESTION:
1727 strcpy (optval, "cubic");
1728 *optlen = strlen ("cubic");
1732 LDBG (0, "ERROR: fd %d: getsockopt SOL_TCP: sid %u, "
1733 "optname %d unsupported!", fd, vlsh, optname);
1741 rv = vls_attr (vlsh, VPPCOM_ATTR_GET_V6ONLY, optval, optlen);
1744 LDBG (0, "ERROR: fd %d: getsockopt SOL_IPV6: vlsh %u "
1745 "optname %d unsupported!", fd, vlsh, optname);
1753 rv = vls_attr (vlsh, VPPCOM_ATTR_GET_LISTEN, optval, optlen);
1756 rv = vls_attr (vlsh, VPPCOM_ATTR_GET_KEEPALIVE, optval, optlen);
1759 rv = vls_attr (vlsh, VPPCOM_ATTR_GET_PROTOCOL, optval, optlen);
1760 *(int *) optval = *(int *) optval ? SOCK_DGRAM : SOCK_STREAM;
1763 rv = vls_attr (vlsh, VPPCOM_ATTR_GET_TX_FIFO_LEN,
1767 rv = vls_attr (vlsh, VPPCOM_ATTR_GET_RX_FIFO_LEN,
1771 rv = vls_attr (vlsh, VPPCOM_ATTR_GET_REUSEADDR, optval, optlen);
1774 rv = vls_attr (vlsh, VPPCOM_ATTR_GET_BROADCAST, optval, optlen);
1777 rv = vls_attr (vlsh, VPPCOM_ATTR_GET_ERROR, optval, optlen);
1780 LDBG (0, "ERROR: fd %d: getsockopt SOL_SOCKET: vlsh %u "
1781 "optname %d unsupported!", fd, vlsh, optname);
1789 if (rv != VPPCOM_OK)
1797 rv = libc_getsockopt (fd, level, optname, optval, optlen);
1804 setsockopt (int fd, int level, int optname,
1805 const void *optval, socklen_t optlen)
1810 if ((errno = -ldp_init ()))
1813 vlsh = ldp_fd_to_vlsh (fd);
1814 if (vlsh != VLS_INVALID_HANDLE)
1824 rv = vls_attr (vlsh, VPPCOM_ATTR_SET_TCP_NODELAY,
1825 (void *) optval, &optlen);
1828 rv = vls_attr (vlsh, VPPCOM_ATTR_SET_TCP_USER_MSS,
1829 (void *) optval, &optlen);
1832 rv = vls_attr (vlsh, VPPCOM_ATTR_SET_TCP_KEEPIDLE,
1833 (void *) optval, &optlen);
1836 rv = vls_attr (vlsh, VPPCOM_ATTR_SET_TCP_KEEPINTVL,
1837 (void *) optval, &optlen);
1839 case TCP_CONGESTION:
1844 LDBG (0, "ERROR: fd %d: setsockopt() SOL_TCP: vlsh %u"
1845 "optname %d unsupported!", fd, vlsh, optname);
1853 rv = vls_attr (vlsh, VPPCOM_ATTR_SET_V6ONLY,
1854 (void *) optval, &optlen);
1857 LDBG (0, "ERROR: fd %d: setsockopt SOL_IPV6: vlsh %u"
1858 "optname %d unsupported!", fd, vlsh, optname);
1866 rv = vls_attr (vlsh, VPPCOM_ATTR_SET_KEEPALIVE,
1867 (void *) optval, &optlen);
1870 rv = vls_attr (vlsh, VPPCOM_ATTR_SET_REUSEADDR,
1871 (void *) optval, &optlen);
1874 rv = vls_attr (vlsh, VPPCOM_ATTR_SET_BROADCAST,
1875 (void *) optval, &optlen);
1878 LDBG (0, "ERROR: fd %d: setsockopt SOL_SOCKET: vlsh %u "
1879 "optname %d unsupported!", fd, vlsh, optname);
1887 if (rv != VPPCOM_OK)
1895 rv = libc_setsockopt (fd, level, optname, optval, optlen);
1902 listen (int fd, int n)
1907 if ((errno = -ldp_init ()))
1910 vlsh = ldp_fd_to_vlsh (fd);
1911 if (vlsh != VLS_INVALID_HANDLE)
1913 LDBG (0, "fd %d: calling vls_listen: vlsh %u, n %d", fd, vlsh, n);
1915 rv = vls_listen (vlsh, n);
1916 if (rv != VPPCOM_OK)
1924 LDBG (0, "fd %d: calling libc_listen(): n %d", fd, n);
1925 rv = libc_listen (fd, n);
1928 LDBG (1, "fd %d: returning %d", fd, rv);
1933 ldp_accept4 (int listen_fd, __SOCKADDR_ARG addr,
1934 socklen_t * __restrict addr_len, int flags)
1936 vls_handle_t listen_vlsh, accept_vlsh;
1939 if ((errno = -ldp_init ()))
1942 listen_vlsh = ldp_fd_to_vlsh (listen_fd);
1943 if (listen_vlsh != VLS_INVALID_HANDLE)
1946 u8 src_addr[sizeof (struct sockaddr_in6)];
1947 memset (&ep, 0, sizeof (ep));
1950 LDBG (0, "listen fd %d: calling vppcom_session_accept: listen sid %u,"
1951 " ep %p, flags 0x%x", listen_fd, listen_vlsh, ep, flags);
1953 accept_vlsh = vls_accept (listen_vlsh, &ep, flags);
1954 if (accept_vlsh < 0)
1956 errno = -accept_vlsh;
1961 rv = ldp_copy_ep_to_sockaddr (addr, addr_len, &ep);
1962 if (rv != VPPCOM_OK)
1964 (void) vls_close (accept_vlsh);
1970 rv = ldp_vlsh_to_fd (accept_vlsh);
1976 LDBG (0, "listen fd %d: calling libc_accept4(): addr %p, addr_len %p,"
1977 " flags 0x%x", listen_fd, addr, addr_len, flags);
1979 rv = libc_accept4 (listen_fd, addr, addr_len, flags);
1982 LDBG (1, "listen fd %d: accept returning %d", listen_fd, rv);
1988 accept4 (int fd, __SOCKADDR_ARG addr, socklen_t * __restrict addr_len,
1991 return ldp_accept4 (fd, addr, addr_len, flags);
1995 accept (int fd, __SOCKADDR_ARG addr, socklen_t * __restrict addr_len)
1997 return ldp_accept4 (fd, addr, addr_len, 0);
2001 shutdown (int fd, int how)
2005 u32 flags_len = sizeof (flags);
2007 if ((errno = -ldp_init ()))
2010 vlsh = ldp_fd_to_vlsh (fd);
2011 if (vlsh != VLS_INVALID_HANDLE)
2013 LDBG (0, "called shutdown: fd %u vlsh %u how %d", fd, vlsh, how);
2015 if (vls_attr (vlsh, VPPCOM_ATTR_SET_SHUT, &how, &flags_len))
2021 if (vls_attr (vlsh, VPPCOM_ATTR_GET_SHUT, &flags, &flags_len))
2027 if (flags == SHUT_RDWR)
2032 LDBG (0, "fd %d: calling libc_shutdown: how %d", fd, how);
2033 rv = libc_shutdown (fd, how);
2040 epoll_create1 (int flags)
2042 ldp_worker_ctx_t *ldpw = ldp_worker_get_current ();
2046 if ((errno = -ldp_init ()))
2049 if (ldp->vcl_needs_real_epoll)
2051 /* Make sure workers have been allocated */
2054 ldp_alloc_workers ();
2055 ldpw = ldp_worker_get_current ();
2057 rv = libc_epoll_create1 (flags);
2058 ldp->vcl_needs_real_epoll = 0;
2059 ldpw->vcl_mq_epfd = rv;
2060 LDBG (0, "created vcl epfd %u", rv);
2064 vlsh = vls_epoll_create ();
2065 if (PREDICT_FALSE (vlsh == VLS_INVALID_HANDLE))
2072 rv = ldp_vlsh_to_fd (vlsh);
2074 LDBG (0, "epoll_create epfd %u vlsh %u", rv, vlsh);
2079 epoll_create (int size)
2081 return epoll_create1 (0);
2085 epoll_ctl (int epfd, int op, int fd, struct epoll_event *event)
2087 vls_handle_t vep_vlsh, vlsh;
2090 if ((errno = -ldp_init ()))
2093 vep_vlsh = ldp_fd_to_vlsh (epfd);
2094 if (PREDICT_FALSE (vep_vlsh == VLS_INVALID_HANDLE))
2096 /* The LDP epoll_create1 always creates VCL epfd's.
2097 * The app should never have a kernel base epoll fd unless it
2098 * was acquired outside of the LD_PRELOAD process context.
2099 * In any case, if we get one, punt it to libc_epoll_ctl.
2101 LDBG (1, "epfd %d: calling libc_epoll_ctl: op %d, fd %d"
2102 " event %p", epfd, op, fd, event);
2104 rv = libc_epoll_ctl (epfd, op, fd, event);
2108 vlsh = ldp_fd_to_vlsh (fd);
2110 LDBG (0, "epfd %d ep_vlsh %d, fd %u vlsh %d, op %u", epfd, vep_vlsh, fd,
2113 if (vlsh != VLS_INVALID_HANDLE)
2115 LDBG (1, "epfd %d: calling vls_epoll_ctl: ep_vlsh %d op %d, vlsh %u,"
2116 " event %p", epfd, vep_vlsh, vlsh, event);
2118 rv = vls_epoll_ctl (vep_vlsh, op, vlsh, event);
2119 if (rv != VPPCOM_OK)
2128 u32 size = sizeof (epfd);
2130 libc_epfd = vls_attr (vep_vlsh, VPPCOM_ATTR_GET_LIBC_EPFD, 0, 0);
2133 LDBG (1, "epfd %d, vep_vlsh %d calling libc_epoll_create1: "
2134 "EPOLL_CLOEXEC", epfd, vep_vlsh);
2136 libc_epfd = libc_epoll_create1 (EPOLL_CLOEXEC);
2143 rv = vls_attr (vep_vlsh, VPPCOM_ATTR_SET_LIBC_EPFD, &libc_epfd,
2152 else if (PREDICT_FALSE (libc_epfd < 0))
2159 LDBG (1, "epfd %d: calling libc_epoll_ctl: libc_epfd %d, op %d, fd %d,"
2160 " event %p", epfd, libc_epfd, op, fd, event);
2162 rv = libc_epoll_ctl (libc_epfd, op, fd, event);
2170 ldp_epoll_pwait (int epfd, struct epoll_event *events, int maxevents,
2171 int timeout, const sigset_t * sigmask)
2173 ldp_worker_ctx_t *ldpw = ldp_worker_get_current ();
2174 double time_to_wait = (double) 0, max_time;
2175 int libc_epfd, rv = 0;
2176 vls_handle_t ep_vlsh;
2178 if ((errno = -ldp_init ()))
2181 if (PREDICT_FALSE (!events || (timeout < -1)))
2187 if (epfd == ldpw->vcl_mq_epfd)
2188 return libc_epoll_pwait (epfd, events, maxevents, timeout, sigmask);
2190 ep_vlsh = ldp_fd_to_vlsh (epfd);
2191 if (PREDICT_FALSE (ep_vlsh == VLS_INVALID_HANDLE))
2193 LDBG (0, "epfd %d: bad ep_vlsh %d!", epfd, ep_vlsh);
2198 if (PREDICT_FALSE (ldpw->clib_time.init_cpu_time == 0))
2199 clib_time_init (&ldpw->clib_time);
2200 time_to_wait = ((timeout >= 0) ? (double) timeout / 1000 : 0);
2201 max_time = clib_time_now (&ldpw->clib_time) + time_to_wait;
2203 libc_epfd = vls_attr (ep_vlsh, VPPCOM_ATTR_GET_LIBC_EPFD, 0, 0);
2204 if (PREDICT_FALSE (libc_epfd < 0))
2211 LDBG (2, "epfd %d: vep_idx %d, libc_epfd %d, events %p, maxevents %d, "
2212 "timeout %d, sigmask %p: time_to_wait %.02f", epfd, ep_vlsh,
2213 libc_epfd, events, maxevents, timeout, sigmask, time_to_wait);
2216 if (!ldpw->epoll_wait_vcl)
2218 rv = vls_epoll_wait (ep_vlsh, events, maxevents, 0);
2221 ldpw->epoll_wait_vcl = 1;
2232 ldpw->epoll_wait_vcl = 0;
2236 rv = libc_epoll_pwait (libc_epfd, events, maxevents, 0, sigmask);
2241 while ((timeout == -1) || (clib_time_now (&ldpw->clib_time) < max_time));
2248 epoll_pwait (int epfd, struct epoll_event *events,
2249 int maxevents, int timeout, const sigset_t * sigmask)
2251 return ldp_epoll_pwait (epfd, events, maxevents, timeout, sigmask);
2255 epoll_wait (int epfd, struct epoll_event *events, int maxevents, int timeout)
2257 return ldp_epoll_pwait (epfd, events, maxevents, timeout, NULL);
2261 poll (struct pollfd *fds, nfds_t nfds, int timeout)
2263 ldp_worker_ctx_t *ldpw = ldp_worker_get_current ();
2264 int rv, i, n_revents = 0;
2269 LDBG (3, "fds %p, nfds %d, timeout %d", fds, nfds, timeout);
2271 if (PREDICT_FALSE (ldpw->clib_time.init_cpu_time == 0))
2272 clib_time_init (&ldpw->clib_time);
2274 max_time = (timeout >= 0) ? (f64) timeout / 1000 : 0;
2275 max_time += clib_time_now (&ldpw->clib_time);
2277 for (i = 0; i < nfds; i++)
2282 vlsh = ldp_fd_to_vlsh (fds[i].fd);
2283 if (vlsh != VLS_INVALID_HANDLE)
2285 fds[i].fd = -fds[i].fd;
2286 vec_add2 (ldpw->vcl_poll, vp, 1);
2288 vp->sh = vlsh_to_sh (vlsh);
2289 vp->events = fds[i].events;
2290 #ifdef __USE_XOPEN2K
2291 if (fds[i].events & POLLRDNORM)
2292 vp->events |= POLLIN;
2293 if (fds[i].events & POLLWRNORM)
2294 vp->events |= POLLOUT;
2296 vp->revents = fds[i].revents;
2300 vec_add1 (ldpw->libc_poll, fds[i]);
2301 vec_add1 (ldpw->libc_poll_idxs, i);
2307 if (vec_len (ldpw->vcl_poll))
2309 rv = vppcom_poll (ldpw->vcl_poll, vec_len (ldpw->vcl_poll), 0);
2320 if (vec_len (ldpw->libc_poll))
2322 rv = libc_poll (ldpw->libc_poll, vec_len (ldpw->libc_poll), 0);
2335 while ((timeout < 0) || (clib_time_now (&ldpw->clib_time) < max_time));
2339 vec_foreach (vp, ldpw->vcl_poll)
2341 fds[vp->fds_ndx].fd = -fds[vp->fds_ndx].fd;
2342 fds[vp->fds_ndx].revents = vp->revents;
2343 #ifdef __USE_XOPEN2K
2344 if ((fds[vp->fds_ndx].revents & POLLIN) &&
2345 (fds[vp->fds_ndx].events & POLLRDNORM))
2346 fds[vp->fds_ndx].revents |= POLLRDNORM;
2347 if ((fds[vp->fds_ndx].revents & POLLOUT) &&
2348 (fds[vp->fds_ndx].events & POLLWRNORM))
2349 fds[vp->fds_ndx].revents |= POLLWRNORM;
2352 vec_reset_length (ldpw->vcl_poll);
2354 for (i = 0; i < vec_len (ldpw->libc_poll); i++)
2356 fds[ldpw->libc_poll_idxs[i]].revents = ldpw->libc_poll[i].revents;
2358 vec_reset_length (ldpw->libc_poll_idxs);
2359 vec_reset_length (ldpw->libc_poll);
2366 ppoll (struct pollfd *fds, nfds_t nfds,
2367 const struct timespec *timeout, const sigset_t * sigmask)
2369 if ((errno = -ldp_init ()))
2372 clib_warning ("LDP<%d>: LDP-TBD", getpid ());
2380 void CONSTRUCTOR_ATTRIBUTE ldp_constructor (void);
2382 void DESTRUCTOR_ATTRIBUTE ldp_destructor (void);
2385 * This function is called when the library is loaded
2388 ldp_constructor (void)
2390 swrap_constructor ();
2391 if (ldp_init () != 0)
2392 fprintf (stderr, "\nLDP<%d>: ERROR: ldp_constructor: failed!\n",
2394 else if (LDP_DEBUG > 0)
2395 clib_warning ("LDP<%d>: LDP constructor: done!\n", getpid ());
2399 * This function is called when the library is unloaded
2402 ldp_destructor (void)
2405 swrap_destructor ();
2410 /* Don't use clib_warning() here because that calls writev()
2411 * which will call ldp_init().
2414 fprintf (stderr, "%s:%d: LDP<%d>: LDP destructor: done!\n",
2415 __func__, __LINE__, getpid ());
2420 * fd.io coding-style-patch-verification: ON
2423 * eval: (c-set-style "gnu")