| /* |
| * Copyright (c) 2016 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 <unistd.h> |
| #include <stdio.h> |
| #include <signal.h> |
| #include <dlfcn.h> |
| #include <pthread.h> |
| #include <time.h> |
| #include <stdarg.h> |
| #include <sys/resource.h> |
| #include <netinet/tcp.h> |
| |
| #include <vcl/ldp_socket_wrapper.h> |
| #include <vcl/ldp.h> |
| #include <sys/time.h> |
| |
| #include <vcl/vppcom.h> |
| #include <vppinfra/time.h> |
| #include <vppinfra/bitmap.h> |
| |
| #define HAVE_CONSTRUCTOR_ATTRIBUTE |
| #ifdef HAVE_CONSTRUCTOR_ATTRIBUTE |
| #define CONSTRUCTOR_ATTRIBUTE \ |
| __attribute__ ((constructor)) |
| #else |
| #define CONSTRUCTOR_ATTRIBUTE |
| #endif /* HAVE_CONSTRUCTOR_ATTRIBUTE */ |
| |
| #define HAVE_DESTRUCTOR_ATTRIBUTE |
| #ifdef HAVE_DESTRUCTOR_ATTRIBUTE |
| #define DESTRUCTOR_ATTRIBUTE \ |
| __attribute__ ((destructor)) |
| #else |
| #define DESTRUCTOR_ATTRIBUTE |
| #endif |
| |
| typedef struct |
| { |
| int init; |
| char app_name[LDP_APP_NAME_MAX]; |
| u32 sid_bit_val; |
| u32 sid_bit_mask; |
| u32 debug; |
| u8 *io_buffer; |
| clib_time_t clib_time; |
| clib_bitmap_t *rd_bitmap; |
| clib_bitmap_t *wr_bitmap; |
| clib_bitmap_t *ex_bitmap; |
| clib_bitmap_t *sid_rd_bitmap; |
| clib_bitmap_t *sid_wr_bitmap; |
| clib_bitmap_t *sid_ex_bitmap; |
| clib_bitmap_t *libc_rd_bitmap; |
| clib_bitmap_t *libc_wr_bitmap; |
| clib_bitmap_t *libc_ex_bitmap; |
| vcl_poll_t *vcl_poll; |
| u8 select_vcl; |
| u8 epoll_wait_vcl; |
| } ldp_main_t; |
| #define LDP_DEBUG ldp->debug |
| |
| static ldp_main_t ldp_main = { |
| .sid_bit_val = (1 << LDP_SID_BIT_MIN), |
| .sid_bit_mask = (1 << LDP_SID_BIT_MIN) - 1, |
| .debug = LDP_DEBUG_INIT, |
| }; |
| |
| static ldp_main_t *ldp = &ldp_main; |
| |
| /* |
| * RETURN: 0 on success or -1 on error. |
| * */ |
| static inline void |
| ldp_set_app_name (char *app_name) |
| { |
| int rv = snprintf (ldp->app_name, LDP_APP_NAME_MAX, |
| "ldp-%d-%s", getpid (), app_name); |
| |
| if (rv >= LDP_APP_NAME_MAX) |
| app_name[LDP_APP_NAME_MAX - 1] = 0; |
| } |
| |
| static inline char * |
| ldp_get_app_name () |
| { |
| if (ldp->app_name[0] == '\0') |
| ldp_set_app_name ("app"); |
| |
| return ldp->app_name; |
| } |
| |
| static inline int |
| ldp_fd_from_sid (u32 sid) |
| { |
| if (PREDICT_FALSE (sid >= ldp->sid_bit_val)) |
| return -EMFILE; |
| else |
| return (sid | ldp->sid_bit_val); |
| } |
| |
| static inline int |
| ldp_fd_is_sid (int fd) |
| { |
| return ((u32) fd & ldp->sid_bit_val) ? 1 : 0; |
| } |
| |
| static inline u32 |
| ldp_sid_from_fd (int fd) |
| { |
| return (ldp_fd_is_sid (fd) ? ((u32) fd & ldp->sid_bit_mask) : |
| INVALID_SESSION_ID); |
| } |
| |
| static inline int |
| ldp_init (void) |
| { |
| int rv = 0; |
| |
| if (PREDICT_FALSE (!ldp->init)) |
| { |
| ldp->init = 1; |
| rv = vppcom_app_create (ldp_get_app_name ()); |
| if (rv == VPPCOM_OK) |
| { |
| char *env_var_str = getenv (LDP_ENV_DEBUG); |
| if (env_var_str) |
| { |
| u32 tmp; |
| if (sscanf (env_var_str, "%u", &tmp) != 1) |
| clib_warning ("LDP<%d>: WARNING: Invalid LDP debug level " |
| "specified in the env var " LDP_ENV_DEBUG |
| " (%s)!", getpid (), env_var_str); |
| else |
| { |
| ldp->debug = tmp; |
| clib_warning ("LDP<%d>: configured LDP debug level (%u) " |
| "from the env var " LDP_ENV_DEBUG "!", |
| getpid (), ldp->debug); |
| } |
| } |
| |
| env_var_str = getenv (LDP_ENV_APP_NAME); |
| if (env_var_str) |
| { |
| ldp_set_app_name (env_var_str); |
| clib_warning ("LDP<%d>: configured LDP app name (%s) " |
| "from the env var " LDP_ENV_APP_NAME "!", |
| getpid (), ldp->app_name); |
| } |
| |
| env_var_str = getenv (LDP_ENV_SID_BIT); |
| if (env_var_str) |
| { |
| u32 sb; |
| if (sscanf (env_var_str, "%u", &sb) != 1) |
| { |
| clib_warning ("LDP<%d>: WARNING: Invalid LDP sid bit " |
| "specified in the env var " |
| LDP_ENV_SID_BIT " (%s)!" |
| "sid bit value %d (0x%x)", |
| getpid (), env_var_str, |
| ldp->sid_bit_val, ldp->sid_bit_val); |
| } |
| else if (sb < LDP_SID_BIT_MIN) |
| { |
| ldp->sid_bit_val = (1 << LDP_SID_BIT_MIN); |
| ldp->sid_bit_mask = ldp->sid_bit_val - 1; |
| |
| clib_warning ("LDP<%d>: WARNING: LDP sid bit (%u) " |
| "specified in the env var " |
| LDP_ENV_SID_BIT " (%s) is too small. " |
| "Using LDP_SID_BIT_MIN (%d)! " |
| "sid bit value %d (0x%x)", |
| getpid (), sb, env_var_str, LDP_SID_BIT_MIN, |
| ldp->sid_bit_val, ldp->sid_bit_val); |
| } |
| else if (sb > LDP_SID_BIT_MAX) |
| { |
| ldp->sid_bit_val = (1 << LDP_SID_BIT_MAX); |
| ldp->sid_bit_mask = ldp->sid_bit_val - 1; |
| |
| clib_warning ("LDP<%d>: WARNING: LDP sid bit (%u) " |
| "specified in the env var " |
| LDP_ENV_SID_BIT " (%s) is too big. " |
| "Using LDP_SID_BIT_MAX (%d)! " |
| "sid bit value %d (0x%x)", |
| getpid (), sb, env_var_str, LDP_SID_BIT_MAX, |
| ldp->sid_bit_val, ldp->sid_bit_val); |
| } |
| else |
| { |
| ldp->sid_bit_val = (1 << sb); |
| ldp->sid_bit_mask = ldp->sid_bit_val - 1; |
| |
| clib_warning ("LDP<%d>: configured LDP sid bit (%u) " |
| "from " LDP_ENV_SID_BIT |
| "! sid bit value %d (0x%x)", getpid (), |
| sb, ldp->sid_bit_val, ldp->sid_bit_val); |
| } |
| } |
| |
| clib_time_init (&ldp->clib_time); |
| clib_warning ("LDP<%d>: LDP initialization: done!", getpid ()); |
| } |
| else |
| { |
| fprintf (stderr, "\nLDP<%d>: ERROR: ldp_init: vppcom_app_create()" |
| " failed! rv = %d (%s)\n", |
| getpid (), rv, vppcom_retval_str (rv)); |
| ldp->init = 0; |
| } |
| } |
| return rv; |
| } |
| |
| int |
| close (int fd) |
| { |
| int rv; |
| const char *func_str; |
| u32 sid = ldp_sid_from_fd (fd); |
| |
| if ((errno = -ldp_init ())) |
| return -1; |
| |
| if (sid != INVALID_SESSION_ID) |
| { |
| int epfd; |
| |
| func_str = "vppcom_session_attr[GET_LIBC_EPFD]"; |
| epfd = vppcom_session_attr (sid, VPPCOM_ATTR_GET_LIBC_EPFD, 0, 0); |
| if (epfd > 0) |
| { |
| func_str = "libc_close"; |
| |
| if (LDP_DEBUG > 0) |
| clib_warning |
| ("LDP<%d>: fd %d (0x%x): calling %s(): epfd %u (0x%x)", |
| getpid (), fd, fd, func_str, epfd, epfd); |
| |
| rv = libc_close (epfd); |
| if (rv < 0) |
| { |
| u32 size = sizeof (epfd); |
| epfd = 0; |
| |
| (void) vppcom_session_attr (sid, VPPCOM_ATTR_SET_LIBC_EPFD, |
| &epfd, &size); |
| } |
| } |
| else if (PREDICT_FALSE (epfd < 0)) |
| { |
| errno = -epfd; |
| rv = -1; |
| goto done; |
| } |
| |
| func_str = "vppcom_session_close"; |
| |
| if (LDP_DEBUG > 0) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): sid %u (0x%x)", |
| getpid (), fd, fd, func_str, sid, sid); |
| |
| rv = vppcom_session_close (sid); |
| if (rv != VPPCOM_OK) |
| { |
| errno = -rv; |
| rv = -1; |
| } |
| } |
| else |
| { |
| func_str = "libc_close"; |
| |
| if (LDP_DEBUG > 0) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s()", |
| getpid (), fd, fd, func_str); |
| |
| rv = libc_close (fd); |
| } |
| |
| done: |
| if (LDP_DEBUG > 0) |
| { |
| if (rv < 0) |
| { |
| int errno_val = errno; |
| perror (func_str); |
| clib_warning ("LDP<%d>: ERROR: fd %d (0x%x): %s() failed! " |
| "rv %d, errno = %d", getpid (), fd, fd, |
| func_str, rv, errno_val); |
| errno = errno_val; |
| } |
| else |
| clib_warning ("LDP<%d>: fd %d (0x%x): returning %d (0x%x)", |
| getpid (), fd, fd, rv, rv); |
| } |
| return rv; |
| } |
| |
| ssize_t |
| read (int fd, void *buf, size_t nbytes) |
| { |
| ssize_t size; |
| const char *func_str; |
| u32 sid = ldp_sid_from_fd (fd); |
| |
| if ((errno = -ldp_init ())) |
| return -1; |
| |
| if (sid != INVALID_SESSION_ID) |
| { |
| func_str = "vppcom_session_read"; |
| |
| if (LDP_DEBUG > 2) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): " |
| "sid %u (0x%x), buf %p, nbytes %u", getpid (), |
| fd, fd, func_str, sid, sid, buf, nbytes); |
| |
| size = vppcom_session_read (sid, buf, nbytes); |
| if (size < 0) |
| { |
| errno = -size; |
| size = -1; |
| } |
| } |
| else |
| { |
| func_str = "libc_read"; |
| |
| if (LDP_DEBUG > 2) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): " |
| "buf %p, nbytes %u", getpid (), |
| fd, fd, func_str, buf, nbytes); |
| |
| size = libc_read (fd, buf, nbytes); |
| } |
| |
| if (LDP_DEBUG > 2) |
| { |
| if (size < 0) |
| { |
| int errno_val = errno; |
| perror (func_str); |
| clib_warning ("LDP<%d>: ERROR: fd %d (0x%x): %s() failed! " |
| "rv %d, errno = %d", getpid (), fd, fd, |
| func_str, size, errno_val); |
| errno = errno_val; |
| } |
| else |
| clib_warning ("LDP<%d>: fd %d (0x%x): returning %d (0x%x)", |
| getpid (), fd, fd, size, size); |
| } |
| return size; |
| } |
| |
| ssize_t |
| readv (int fd, const struct iovec * iov, int iovcnt) |
| { |
| const char *func_str; |
| ssize_t size = 0; |
| u32 sid = ldp_sid_from_fd (fd); |
| int rv = 0, i, total = 0; |
| |
| if ((errno = -ldp_init ())) |
| return -1; |
| |
| if (sid != INVALID_SESSION_ID) |
| { |
| func_str = "vppcom_session_read"; |
| do |
| { |
| for (i = 0; i < iovcnt; ++i) |
| { |
| if (LDP_DEBUG > 2) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s() [%d]: " |
| "sid %u (0x%x), iov %p, iovcnt %d, total %d", |
| getpid (), fd, fd, func_str, i, sid, sid, |
| iov, iovcnt, total); |
| |
| rv = vppcom_session_read (sid, iov[i].iov_base, iov[i].iov_len); |
| if (rv < 0) |
| break; |
| else |
| { |
| total += rv; |
| if (rv < iov[i].iov_len) |
| { |
| if (LDP_DEBUG > 2) |
| clib_warning ("LDP<%d>: fd %d (0x%x): " |
| "rv (%d) < iov[%d].iov_len (%d)", |
| getpid (), fd, fd, rv, i, |
| iov[i].iov_len); |
| break; |
| } |
| } |
| } |
| } |
| while ((rv >= 0) && (total == 0)); |
| |
| if (rv < 0) |
| { |
| errno = -rv; |
| size = -1; |
| } |
| else |
| size = total; |
| } |
| else |
| { |
| func_str = "libc_readv"; |
| |
| if (LDP_DEBUG > 2) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): " |
| "iov %p, iovcnt %d", getpid (), fd, fd, iov, iovcnt); |
| |
| size = libc_readv (fd, iov, iovcnt); |
| } |
| |
| if (LDP_DEBUG > 2) |
| { |
| if (size < 0) |
| { |
| int errno_val = errno; |
| perror (func_str); |
| clib_warning ("LDP<%d>: ERROR: fd %d (0x%x): %s() failed! " |
| "rv %d, errno = %d", getpid (), fd, fd, |
| func_str, size, errno_val); |
| errno = errno_val; |
| } |
| else |
| clib_warning ("LDP<%d>: fd %d (0x%x): returning %d (0x%x)", |
| getpid (), fd, fd, size, size); |
| } |
| return size; |
| } |
| |
| ssize_t |
| write (int fd, const void *buf, size_t nbytes) |
| { |
| const char *func_str; |
| ssize_t size = 0; |
| u32 sid = ldp_sid_from_fd (fd); |
| |
| if ((errno = -ldp_init ())) |
| return -1; |
| |
| if (sid != INVALID_SESSION_ID) |
| { |
| func_str = "vppcom_session_write"; |
| |
| if (LDP_DEBUG > 2) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): " |
| "sid %u (0x%x), buf %p, nbytes %u", getpid (), |
| fd, fd, func_str, sid, sid, buf, nbytes); |
| |
| size = vppcom_session_write (sid, (void *) buf, nbytes); |
| if (size < 0) |
| { |
| errno = -size; |
| size = -1; |
| } |
| } |
| else |
| { |
| func_str = "libc_write"; |
| |
| if (LDP_DEBUG > 2) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): " |
| "buf %p, nbytes %u", getpid (), |
| fd, fd, func_str, buf, nbytes); |
| |
| size = libc_write (fd, buf, nbytes); |
| } |
| |
| if (LDP_DEBUG > 2) |
| { |
| if (size < 0) |
| { |
| int errno_val = errno; |
| perror (func_str); |
| clib_warning ("LDP<%d>: ERROR: fd %d (0x%x): %s() failed! " |
| "rv %d, errno = %d", getpid (), fd, fd, |
| func_str, size, errno_val); |
| errno = errno_val; |
| } |
| else |
| clib_warning ("LDP<%d>: fd %d (0x%x): returning %d (0x%x)", |
| getpid (), fd, fd, size, size); |
| } |
| return size; |
| } |
| |
| ssize_t |
| writev (int fd, const struct iovec * iov, int iovcnt) |
| { |
| const char *func_str; |
| ssize_t size = 0, total = 0; |
| u32 sid = ldp_sid_from_fd (fd); |
| int i, rv = 0; |
| |
| /* |
| * Use [f]printf() instead of clib_warning() to prevent recursion SIGSEGV. |
| */ |
| |
| if ((errno = -ldp_init ())) |
| return -1; |
| |
| if (sid != INVALID_SESSION_ID) |
| { |
| func_str = "vppcom_session_write"; |
| do |
| { |
| for (i = 0; i < iovcnt; ++i) |
| { |
| if (LDP_DEBUG > 4) |
| printf ("%s:%d: LDP<%d>: fd %d (0x%x): calling %s() [%d]: " |
| "sid %u (0x%x), buf %p, nbytes %ld, total %ld", |
| __func__, __LINE__, getpid (), fd, fd, func_str, |
| i, sid, sid, iov[i].iov_base, iov[i].iov_len, total); |
| |
| rv = vppcom_session_write (sid, iov[i].iov_base, |
| iov[i].iov_len); |
| if (rv < 0) |
| break; |
| else |
| { |
| total += rv; |
| if (rv < iov[i].iov_len) |
| { |
| if (LDP_DEBUG > 4) |
| printf ("%s:%d: LDP<%d>: fd %d (0x%x): " |
| "rv (%d) < iov[%d].iov_len (%ld)", |
| __func__, __LINE__, getpid (), fd, fd, |
| rv, i, iov[i].iov_len); |
| break; |
| } |
| } |
| } |
| } |
| while ((rv >= 0) && (total == 0)); |
| |
| if (rv < 0) |
| { |
| errno = -rv; |
| size = -1; |
| } |
| else |
| size = total; |
| } |
| else |
| { |
| func_str = "libc_writev"; |
| |
| if (LDP_DEBUG > 4) |
| printf ("%s:%d: LDP<%d>: fd %d (0x%x): calling %s(): " |
| "iov %p, iovcnt %d\n", __func__, __LINE__, getpid (), |
| fd, fd, func_str, iov, iovcnt); |
| |
| size = libc_writev (fd, iov, iovcnt); |
| } |
| |
| if (LDP_DEBUG > 4) |
| { |
| if (size < 0) |
| { |
| int errno_val = errno; |
| perror (func_str); |
| fprintf (stderr, |
| "%s:%d: LDP<%d>: ERROR: fd %d (0x%x): %s() failed! " |
| "rv %ld, errno = %d\n", __func__, __LINE__, getpid (), fd, |
| fd, func_str, size, errno_val); |
| errno = errno_val; |
| } |
| else |
| printf ("%s:%d: LDP<%d>: fd %d (0x%x): returning %ld\n", |
| __func__, __LINE__, getpid (), fd, fd, size); |
| } |
| return size; |
| } |
| |
| int |
| fcntl (int fd, int cmd, ...) |
| { |
| const char *func_str = __func__; |
| int rv = 0; |
| va_list ap; |
| u32 sid = ldp_sid_from_fd (fd); |
| |
| if ((errno = -ldp_init ())) |
| return -1; |
| |
| va_start (ap, cmd); |
| if (sid != INVALID_SESSION_ID) |
| { |
| int flags = va_arg (ap, int); |
| u32 size; |
| |
| size = sizeof (flags); |
| rv = -EOPNOTSUPP; |
| switch (cmd) |
| { |
| case F_SETFL: |
| func_str = "vppcom_session_attr[SET_FLAGS]"; |
| if (LDP_DEBUG > 2) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): " |
| "sid %u (0x%x) flags %d (0x%x), size %d", |
| getpid (), fd, fd, func_str, sid, sid, |
| flags, flags, size); |
| |
| rv = |
| vppcom_session_attr (sid, VPPCOM_ATTR_SET_FLAGS, &flags, &size); |
| break; |
| |
| case F_GETFL: |
| func_str = "vppcom_session_attr[GET_FLAGS]"; |
| if (LDP_DEBUG > 2) |
| clib_warning |
| ("LDP<%d>: fd %d (0x%x): calling %s(): sid %u (0x%x), " |
| "flags %d (0x%x), size %d", getpid (), fd, fd, func_str, sid, |
| sid, flags, flags, size); |
| |
| rv = |
| vppcom_session_attr (sid, VPPCOM_ATTR_GET_FLAGS, &flags, &size); |
| if (rv == VPPCOM_OK) |
| { |
| if (LDP_DEBUG > 2) |
| clib_warning ("LDP<%d>: fd %d (0x%x), cmd %d (F_GETFL): " |
| "%s() returned flags %d (0x%x)", |
| getpid (), fd, fd, cmd, func_str, flags, flags); |
| rv = flags; |
| } |
| break; |
| |
| default: |
| rv = -EOPNOTSUPP; |
| break; |
| } |
| if (rv < 0) |
| { |
| errno = -rv; |
| rv = -1; |
| } |
| } |
| else |
| { |
| func_str = "libc_vfcntl"; |
| |
| if (LDP_DEBUG > 2) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): cmd %d", |
| getpid (), fd, fd, func_str, cmd); |
| |
| rv = libc_vfcntl (fd, cmd, ap); |
| } |
| |
| va_end (ap); |
| |
| if (LDP_DEBUG > 2) |
| { |
| if (rv < 0) |
| { |
| int errno_val = errno; |
| perror (func_str); |
| clib_warning ("LDP<%d>: ERROR: fd %d (0x%x): %s() failed! " |
| "rv %d, errno = %d", getpid (), fd, fd, |
| func_str, rv, errno_val); |
| errno = errno_val; |
| } |
| else |
| clib_warning ("LDP<%d>: fd %d (0x%x): returning %d (0x%x)", |
| getpid (), fd, fd, rv, rv); |
| } |
| return rv; |
| } |
| |
| int |
| ioctl (int fd, unsigned long int cmd, ...) |
| { |
| const char *func_str; |
| int rv; |
| va_list ap; |
| u32 sid = ldp_sid_from_fd (fd); |
| |
| if ((errno = -ldp_init ())) |
| return -1; |
| |
| va_start (ap, cmd); |
| if (sid != INVALID_SESSION_ID) |
| { |
| func_str = "vppcom_session_attr[GET_NREAD]"; |
| |
| switch (cmd) |
| { |
| case FIONREAD: |
| if (LDP_DEBUG > 2) |
| clib_warning |
| ("LDP<%d>: fd %d (0x%x): calling %s(): sid %u (0x%x)", |
| getpid (), fd, fd, func_str, sid, sid); |
| |
| rv = vppcom_session_attr (sid, VPPCOM_ATTR_GET_NREAD, 0, 0); |
| break; |
| |
| case FIONBIO: |
| { |
| u32 flags = va_arg (ap, int) ? O_NONBLOCK : 0; |
| u32 size = sizeof (flags); |
| |
| /* TBD: When VPPCOM_ATTR_[GS]ET_FLAGS supports flags other than |
| * non-blocking, the flags should be read here and merged |
| * with O_NONBLOCK. |
| */ |
| if (LDP_DEBUG > 2) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): " |
| "sid %u (0x%x), flags %d (0x%x), size %d", |
| getpid (), fd, fd, func_str, sid, sid, |
| flags, flags, size); |
| |
| rv = vppcom_session_attr (sid, VPPCOM_ATTR_SET_FLAGS, &flags, |
| &size); |
| } |
| break; |
| |
| default: |
| rv = -EOPNOTSUPP; |
| break; |
| } |
| if (rv < 0) |
| { |
| errno = -rv; |
| rv = -1; |
| } |
| } |
| else |
| { |
| func_str = "libc_vioctl"; |
| |
| if (LDP_DEBUG > 2) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): cmd %d", |
| getpid (), fd, fd, func_str, cmd); |
| |
| rv = libc_vioctl (fd, cmd, ap); |
| } |
| |
| if (LDP_DEBUG > 2) |
| { |
| if (rv < 0) |
| { |
| int errno_val = errno; |
| perror (func_str); |
| clib_warning ("LDP<%d>: ERROR: fd %d (0x%x): %s() failed! " |
| "rv %d, errno = %d", getpid (), fd, fd, |
| func_str, rv, errno_val); |
| errno = errno_val; |
| } |
| else |
| clib_warning ("LDP<%d>: fd %d (0x%x): returning %d (0x%x)", |
| getpid (), fd, fd, rv, rv); |
| } |
| va_end (ap); |
| return rv; |
| } |
| |
| int |
| ldp_pselect (int nfds, fd_set * __restrict readfds, |
| fd_set * __restrict writefds, |
| fd_set * __restrict exceptfds, |
| const struct timespec *__restrict timeout, |
| const __sigset_t * __restrict sigmask) |
| { |
| int rv; |
| char *func_str = "##"; |
| f64 time_out; |
| int fd; |
| uword sid_bits, sid_bits_set, libc_bits, libc_bits_set; |
| u32 minbits = clib_max (nfds, BITS (uword)); |
| u32 sid; |
| |
| if (nfds < 0) |
| { |
| errno = EINVAL; |
| return -1; |
| } |
| |
| if (nfds <= ldp->sid_bit_val) |
| { |
| func_str = "libc_pselect"; |
| |
| if (LDP_DEBUG > 3) |
| clib_warning |
| ("LDP<%d>: calling %s(): nfds %d, readfds %p, writefds %p, " |
| "exceptfds %p, timeout %p, sigmask %p", getpid (), func_str, nfds, |
| readfds, writefds, exceptfds, timeout, sigmask); |
| |
| rv = libc_pselect (nfds, readfds, writefds, exceptfds, |
| timeout, sigmask); |
| goto done; |
| } |
| |
| if (PREDICT_FALSE (ldp->sid_bit_val > FD_SETSIZE / 2)) |
| { |
| clib_warning ("LDP<%d>: ERROR: LDP sid bit value %d (0x%x) > " |
| "FD_SETSIZE/2 %d (0x%x)!", getpid (), |
| ldp->sid_bit_val, ldp->sid_bit_val, |
| FD_SETSIZE / 2, FD_SETSIZE / 2); |
| errno = EOVERFLOW; |
| return -1; |
| } |
| |
| if (timeout) |
| { |
| time_out = (timeout->tv_sec == 0 && timeout->tv_nsec == 0) ? |
| (f64) 0 : (f64) timeout->tv_sec + |
| (f64) timeout->tv_nsec / (f64) 1000000000 + |
| (f64) (timeout->tv_nsec % 1000000000) / (f64) 1000000000; |
| |
| /* select as fine grained sleep */ |
| if (!nfds) |
| { |
| if (LDP_DEBUG > 3) |
| clib_warning ("LDP<%d>: sleeping for %f seconds", |
| getpid (), time_out); |
| |
| time_out += clib_time_now (&ldp->clib_time); |
| while (clib_time_now (&ldp->clib_time) < time_out) |
| ; |
| return 0; |
| } |
| } |
| else if (!nfds) |
| { |
| errno = EINVAL; |
| return -1; |
| } |
| else |
| time_out = -1; |
| |
| sid_bits = libc_bits = 0; |
| if (readfds) |
| { |
| clib_bitmap_validate (ldp->sid_rd_bitmap, minbits); |
| clib_bitmap_validate (ldp->libc_rd_bitmap, minbits); |
| clib_bitmap_validate (ldp->rd_bitmap, minbits); |
| clib_memcpy (ldp->rd_bitmap, readfds, |
| vec_len (ldp->rd_bitmap) * sizeof (clib_bitmap_t)); |
| FD_ZERO (readfds); |
| |
| /* *INDENT-OFF* */ |
| clib_bitmap_foreach (fd, ldp->rd_bitmap, |
| ({ |
| sid = ldp_sid_from_fd (fd); |
| if (LDP_DEBUG > 3) |
| clib_warning ("LDP<%d>: readfds: fd %d (0x%x), sid %u (0x%x)", |
| getpid (), fd, fd, sid, sid); |
| if (sid == INVALID_SESSION_ID) |
| clib_bitmap_set_no_check (ldp->libc_rd_bitmap, fd, 1); |
| else |
| clib_bitmap_set_no_check (ldp->sid_rd_bitmap, sid, 1); |
| })); |
| /* *INDENT-ON* */ |
| |
| sid_bits_set = clib_bitmap_last_set (ldp->sid_rd_bitmap) + 1; |
| sid_bits = (sid_bits_set > sid_bits) ? sid_bits_set : sid_bits; |
| |
| libc_bits_set = clib_bitmap_last_set (ldp->libc_rd_bitmap) + 1; |
| libc_bits = (libc_bits_set > libc_bits) ? libc_bits_set : libc_bits; |
| |
| if (LDP_DEBUG > 3) |
| clib_warning ("LDP<%d>: readfds: sid_bits_set %d, sid_bits %d, " |
| "libc_bits_set %d, libc_bits %d", getpid (), |
| sid_bits_set, sid_bits, libc_bits_set, libc_bits); |
| } |
| if (writefds) |
| { |
| clib_bitmap_validate (ldp->sid_wr_bitmap, minbits); |
| clib_bitmap_validate (ldp->libc_wr_bitmap, minbits); |
| clib_bitmap_validate (ldp->wr_bitmap, minbits); |
| clib_memcpy (ldp->wr_bitmap, writefds, |
| vec_len (ldp->wr_bitmap) * sizeof (clib_bitmap_t)); |
| FD_ZERO (writefds); |
| |
| /* *INDENT-OFF* */ |
| clib_bitmap_foreach (fd, ldp->wr_bitmap, |
| ({ |
| sid = ldp_sid_from_fd (fd); |
| if (LDP_DEBUG > 3) |
| clib_warning ("LDP<%d>: writefds: fd %d (0x%x), sid %u (0x%x)", |
| getpid (), fd, fd, sid, sid); |
| if (sid == INVALID_SESSION_ID) |
| clib_bitmap_set_no_check (ldp->libc_wr_bitmap, fd, 1); |
| else |
| clib_bitmap_set_no_check (ldp->sid_wr_bitmap, sid, 1); |
| })); |
| /* *INDENT-ON* */ |
| |
| sid_bits_set = clib_bitmap_last_set (ldp->sid_wr_bitmap) + 1; |
| sid_bits = (sid_bits_set > sid_bits) ? sid_bits_set : sid_bits; |
| |
| libc_bits_set = clib_bitmap_last_set (ldp->libc_wr_bitmap) + 1; |
| libc_bits = (libc_bits_set > libc_bits) ? libc_bits_set : libc_bits; |
| |
| if (LDP_DEBUG > 3) |
| clib_warning ("LDP<%d>: writefds: sid_bits_set %d, sid_bits %d, " |
| "libc_bits_set %d, libc_bits %d", getpid (), |
| sid_bits_set, sid_bits, libc_bits_set, libc_bits); |
| } |
| if (exceptfds) |
| { |
| clib_bitmap_validate (ldp->sid_ex_bitmap, minbits); |
| clib_bitmap_validate (ldp->libc_ex_bitmap, minbits); |
| clib_bitmap_validate (ldp->ex_bitmap, minbits); |
| clib_memcpy (ldp->ex_bitmap, exceptfds, |
| vec_len (ldp->ex_bitmap) * sizeof (clib_bitmap_t)); |
| FD_ZERO (exceptfds); |
| |
| /* *INDENT-OFF* */ |
| clib_bitmap_foreach (fd, ldp->ex_bitmap, |
| ({ |
| sid = ldp_sid_from_fd (fd); |
| if (LDP_DEBUG > 3) |
| clib_warning ("LDP<%d>: exceptfds: fd %d (0x%x), sid %u (0x%x)", |
| getpid (), fd, fd, sid, sid); |
| if (sid == INVALID_SESSION_ID) |
| clib_bitmap_set_no_check (ldp->libc_ex_bitmap, fd, 1); |
| else |
| clib_bitmap_set_no_check (ldp->sid_ex_bitmap, sid, 1); |
| })); |
| /* *INDENT-ON* */ |
| |
| sid_bits_set = clib_bitmap_last_set (ldp->sid_ex_bitmap) + 1; |
| sid_bits = (sid_bits_set > sid_bits) ? sid_bits_set : sid_bits; |
| |
| libc_bits_set = clib_bitmap_last_set (ldp->libc_ex_bitmap) + 1; |
| libc_bits = (libc_bits_set > libc_bits) ? libc_bits_set : libc_bits; |
| |
| if (LDP_DEBUG > 3) |
| clib_warning ("LDP<%d>: exceptfds: sid_bits_set %d, sid_bits %d, " |
| "libc_bits_set %d, libc_bits %d", getpid (), |
| sid_bits_set, sid_bits, libc_bits_set, libc_bits); |
| } |
| |
| if (PREDICT_FALSE (!sid_bits && !libc_bits)) |
| { |
| errno = EINVAL; |
| rv = -1; |
| goto done; |
| } |
| |
| do |
| { |
| if (sid_bits) |
| { |
| if (!ldp->select_vcl) |
| { |
| func_str = "vppcom_select"; |
| |
| if (readfds) |
| clib_memcpy (ldp->rd_bitmap, ldp->sid_rd_bitmap, |
| vec_len (ldp->rd_bitmap) * |
| sizeof (clib_bitmap_t)); |
| if (writefds) |
| clib_memcpy (ldp->wr_bitmap, ldp->sid_wr_bitmap, |
| vec_len (ldp->wr_bitmap) * |
| sizeof (clib_bitmap_t)); |
| if (exceptfds) |
| clib_memcpy (ldp->ex_bitmap, ldp->sid_ex_bitmap, |
| vec_len (ldp->ex_bitmap) * |
| sizeof (clib_bitmap_t)); |
| |
| rv = vppcom_select (sid_bits, |
| readfds ? ldp->rd_bitmap : NULL, |
| writefds ? ldp->wr_bitmap : NULL, |
| exceptfds ? ldp->ex_bitmap : NULL, 0); |
| if (rv < 0) |
| { |
| errno = -rv; |
| rv = -1; |
| } |
| else if (rv > 0) |
| { |
| if (readfds) |
| { |
| /* *INDENT-OFF* */ |
| clib_bitmap_foreach (sid, ldp->rd_bitmap, |
| ({ |
| fd = ldp_fd_from_sid (sid); |
| if (PREDICT_FALSE (fd < 0)) |
| { |
| errno = EBADFD; |
| rv = -1; |
| goto done; |
| } |
| FD_SET (fd, readfds); |
| })); |
| /* *INDENT-ON* */ |
| } |
| if (writefds) |
| { |
| /* *INDENT-OFF* */ |
| clib_bitmap_foreach (sid, ldp->wr_bitmap, |
| ({ |
| fd = ldp_fd_from_sid (sid); |
| if (PREDICT_FALSE (fd < 0)) |
| { |
| errno = EBADFD; |
| rv = -1; |
| goto done; |
| } |
| FD_SET (fd, writefds); |
| })); |
| /* *INDENT-ON* */ |
| } |
| if (exceptfds) |
| { |
| /* *INDENT-OFF* */ |
| clib_bitmap_foreach (sid, ldp->ex_bitmap, |
| ({ |
| fd = ldp_fd_from_sid (sid); |
| if (PREDICT_FALSE (fd < 0)) |
| { |
| errno = EBADFD; |
| rv = -1; |
| goto done; |
| } |
| FD_SET (fd, exceptfds); |
| })); |
| /* *INDENT-ON* */ |
| } |
| ldp->select_vcl = 1; |
| goto done; |
| } |
| } |
| else |
| ldp->select_vcl = 0; |
| } |
| if (libc_bits) |
| { |
| struct timespec tspec; |
| |
| func_str = "libc_pselect"; |
| |
| if (readfds) |
| clib_memcpy (readfds, ldp->libc_rd_bitmap, |
| vec_len (ldp->rd_bitmap) * sizeof (clib_bitmap_t)); |
| if (writefds) |
| clib_memcpy (writefds, ldp->libc_wr_bitmap, |
| vec_len (ldp->wr_bitmap) * sizeof (clib_bitmap_t)); |
| if (exceptfds) |
| clib_memcpy (exceptfds, ldp->libc_ex_bitmap, |
| vec_len (ldp->ex_bitmap) * sizeof (clib_bitmap_t)); |
| tspec.tv_sec = tspec.tv_nsec = 0; |
| rv = libc_pselect (libc_bits, |
| readfds ? readfds : NULL, |
| writefds ? writefds : NULL, |
| exceptfds ? exceptfds : NULL, &tspec, sigmask); |
| if (rv != 0) |
| goto done; |
| } |
| } |
| while ((time_out == -1) || (clib_time_now (&ldp->clib_time) < time_out)); |
| rv = 0; |
| |
| done: |
| /* TBD: set timeout to amount of time left */ |
| vec_reset_length (ldp->rd_bitmap); |
| vec_reset_length (ldp->sid_rd_bitmap); |
| vec_reset_length (ldp->libc_rd_bitmap); |
| vec_reset_length (ldp->wr_bitmap); |
| vec_reset_length (ldp->sid_wr_bitmap); |
| vec_reset_length (ldp->libc_wr_bitmap); |
| vec_reset_length (ldp->ex_bitmap); |
| vec_reset_length (ldp->sid_ex_bitmap); |
| vec_reset_length (ldp->libc_ex_bitmap); |
| |
| if (LDP_DEBUG > 3) |
| { |
| if (rv < 0) |
| { |
| int errno_val = errno; |
| perror (func_str); |
| clib_warning ("LDP<%d>: ERROR: %s() failed! " |
| "rv %d, errno = %d", getpid (), |
| func_str, rv, errno_val); |
| errno = errno_val; |
| } |
| else |
| clib_warning ("LDP<%d>: returning %d (0x%x)", getpid (), rv, rv); |
| } |
| return rv; |
| } |
| |
| int |
| select (int nfds, fd_set * __restrict readfds, |
| fd_set * __restrict writefds, |
| fd_set * __restrict exceptfds, struct timeval *__restrict timeout) |
| { |
| struct timespec tspec; |
| |
| if (timeout) |
| { |
| tspec.tv_sec = timeout->tv_sec; |
| tspec.tv_nsec = timeout->tv_usec * 1000; |
| } |
| return ldp_pselect (nfds, readfds, writefds, exceptfds, |
| timeout ? &tspec : NULL, NULL); |
| } |
| |
| #ifdef __USE_XOPEN2K |
| int |
| pselect (int nfds, fd_set * __restrict readfds, |
| fd_set * __restrict writefds, |
| fd_set * __restrict exceptfds, |
| const struct timespec *__restrict timeout, |
| const __sigset_t * __restrict sigmask) |
| { |
| return ldp_pselect (nfds, readfds, writefds, exceptfds, timeout, 0); |
| } |
| #endif |
| |
| int |
| socket (int domain, int type, int protocol) |
| { |
| const char *func_str; |
| int rv; |
| u8 is_nonblocking = type & SOCK_NONBLOCK ? 1 : 0; |
| int sock_type = type & ~(SOCK_CLOEXEC | SOCK_NONBLOCK); |
| |
| if ((errno = -ldp_init ())) |
| return -1; |
| |
| if (((domain == AF_INET) || (domain == AF_INET6)) && |
| ((sock_type == SOCK_STREAM) || (sock_type == SOCK_DGRAM))) |
| { |
| int sid; |
| u8 proto = ((sock_type == SOCK_DGRAM) ? |
| VPPCOM_PROTO_UDP : VPPCOM_PROTO_TCP); |
| |
| func_str = "vppcom_session_create"; |
| |
| if (LDP_DEBUG > 0) |
| clib_warning ("LDP<%d>: : calling %s(): " |
| "proto %u (%s), is_nonblocking %u", |
| getpid (), func_str, proto, |
| vppcom_proto_str (proto), is_nonblocking); |
| |
| sid = vppcom_session_create (proto, is_nonblocking); |
| if (sid < 0) |
| { |
| errno = -sid; |
| rv = -1; |
| } |
| else |
| { |
| func_str = "ldp_fd_from_sid"; |
| rv = ldp_fd_from_sid (sid); |
| if (rv < 0) |
| { |
| (void) vppcom_session_close (sid); |
| errno = -rv; |
| rv = -1; |
| } |
| } |
| } |
| else |
| { |
| func_str = "libc_socket"; |
| |
| if (LDP_DEBUG > 0) |
| clib_warning ("LDP<%d>: : calling %s()", getpid (), func_str); |
| |
| rv = libc_socket (domain, type, protocol); |
| } |
| |
| if (LDP_DEBUG > 0) |
| { |
| if (rv < 0) |
| { |
| int errno_val = errno; |
| perror (func_str); |
| clib_warning ("LDP<%d>: ERROR: %s() failed! " |
| "rv %d, errno = %d", |
| getpid (), func_str, rv, errno_val); |
| errno = errno_val; |
| } |
| else |
| clib_warning ("LDP<%d>: : returning fd %d (0x%x)", getpid (), rv, rv); |
| } |
| return rv; |
| } |
| |
| /* |
| * Create two new sockets, of type TYPE in domain DOMAIN and using |
| * protocol PROTOCOL, which are connected to each other, and put file |
| * descriptors for them in FDS[0] and FDS[1]. If PROTOCOL is zero, |
| * one will be chosen automatically. |
| * Returns 0 on success, -1 for errors. |
| * */ |
| int |
| socketpair (int domain, int type, int protocol, int fds[2]) |
| { |
| const char *func_str; |
| int rv; |
| int sock_type = type & ~(SOCK_CLOEXEC | SOCK_NONBLOCK); |
| |
| if ((errno = -ldp_init ())) |
| return -1; |
| |
| if (((domain == AF_INET) || (domain == AF_INET6)) && |
| ((sock_type == SOCK_STREAM) || (sock_type == SOCK_DGRAM))) |
| { |
| func_str = __func__; |
| |
| clib_warning ("LDP<%d>: LDP-TBD", getpid ()); |
| errno = ENOSYS; |
| rv = -1; |
| } |
| else |
| { |
| func_str = "libc_socket"; |
| |
| if (LDP_DEBUG > 1) |
| clib_warning ("LDP<%d>: : calling %s()", getpid (), func_str); |
| |
| rv = libc_socket (domain, type, protocol); |
| } |
| |
| if (LDP_DEBUG > 1) |
| { |
| if (rv < 0) |
| { |
| int errno_val = errno; |
| perror (func_str); |
| clib_warning ("LDP<%d>: ERROR: %s() failed! " |
| "rv %d, errno = %d", |
| getpid (), func_str, rv, errno_val); |
| errno = errno_val; |
| } |
| else |
| clib_warning ("LDP<%d>: : returning fd %d (0x%x)", getpid (), rv, rv); |
| } |
| return rv; |
| } |
| |
| int |
| bind (int fd, __CONST_SOCKADDR_ARG addr, socklen_t len) |
| { |
| int rv; |
| const char *func_str; |
| u32 sid = ldp_sid_from_fd (fd); |
| |
| if ((errno = -ldp_init ())) |
| return -1; |
| |
| if (sid != INVALID_SESSION_ID) |
| { |
| vppcom_endpt_t ep; |
| |
| func_str = "vppcom_session_bind"; |
| |
| switch (addr->sa_family) |
| { |
| case AF_INET: |
| if (len != sizeof (struct sockaddr_in)) |
| { |
| clib_warning |
| ("LDP<%d>: ERROR: fd %d (0x%x): sid %u (0x%x): Invalid " |
| "AF_INET addr len %u!", getpid (), fd, fd, sid, sid, len); |
| errno = EINVAL; |
| rv = -1; |
| goto done; |
| } |
| ep.is_ip4 = VPPCOM_IS_IP4; |
| ep.ip = (u8 *) & ((const struct sockaddr_in *) addr)->sin_addr; |
| ep.port = (u16) ((const struct sockaddr_in *) addr)->sin_port; |
| break; |
| |
| case AF_INET6: |
| if (len != sizeof (struct sockaddr_in6)) |
| { |
| clib_warning |
| ("LDP<%d>: ERROR: fd %d (0x%x): sid %u (0x%x): Invalid " |
| "AF_INET6 addr len %u!", getpid (), fd, fd, sid, sid, len); |
| errno = EINVAL; |
| rv = -1; |
| goto done; |
| } |
| ep.is_ip4 = VPPCOM_IS_IP6; |
| ep.ip = (u8 *) & ((const struct sockaddr_in6 *) addr)->sin6_addr; |
| ep.port = (u16) ((const struct sockaddr_in6 *) addr)->sin6_port; |
| break; |
| |
| default: |
| clib_warning ("LDP<%d>: ERROR: fd %d (0x%x): sid %u (0x%x): " |
| "Unsupported address family %u!", |
| getpid (), fd, fd, sid, sid, addr->sa_family); |
| errno = EAFNOSUPPORT; |
| rv = -1; |
| goto done; |
| } |
| if (LDP_DEBUG > 0) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): sid %u (0x%x), " |
| "addr %p, len %u", |
| getpid (), fd, fd, func_str, sid, sid, addr, len); |
| |
| rv = vppcom_session_bind (sid, &ep); |
| if (rv != VPPCOM_OK) |
| { |
| errno = -rv; |
| rv = -1; |
| } |
| } |
| else |
| { |
| func_str = "libc_bind"; |
| |
| if (LDP_DEBUG > 0) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): " |
| "addr %p, len %u", |
| getpid (), fd, fd, func_str, addr, len); |
| |
| rv = libc_bind (fd, addr, len); |
| } |
| |
| done: |
| if (LDP_DEBUG > 0) |
| { |
| if (rv < 0) |
| { |
| int errno_val = errno; |
| perror (func_str); |
| clib_warning ("LDP<%d>: ERROR: fd %d (0x%x): %s() failed! " |
| "rv %d, errno = %d", getpid (), fd, fd, |
| func_str, rv, errno_val); |
| errno = errno_val; |
| } |
| else |
| clib_warning ("LDP<%d>: fd %d (0x%x): returning %d (0x%x)", |
| getpid (), fd, fd, rv, rv); |
| } |
| return rv; |
| } |
| |
| static inline int |
| ldp_copy_ep_to_sockaddr (__SOCKADDR_ARG addr, socklen_t * __restrict len, |
| vppcom_endpt_t * ep) |
| { |
| int rv = 0; |
| int sa_len, copy_len; |
| |
| if ((errno = -ldp_init ())) |
| return -1; |
| |
| if (addr && len && ep) |
| { |
| addr->sa_family = (ep->is_ip4 == VPPCOM_IS_IP4) ? AF_INET : AF_INET6; |
| switch (addr->sa_family) |
| { |
| case AF_INET: |
| ((struct sockaddr_in *) addr)->sin_port = ep->port; |
| if (*len > sizeof (struct sockaddr_in)) |
| *len = sizeof (struct sockaddr_in); |
| sa_len = sizeof (struct sockaddr_in) - sizeof (struct in_addr); |
| copy_len = *len - sa_len; |
| if (copy_len > 0) |
| memcpy (&((struct sockaddr_in *) addr)->sin_addr, ep->ip, |
| copy_len); |
| break; |
| |
| case AF_INET6: |
| ((struct sockaddr_in6 *) addr)->sin6_port = ep->port; |
| if (*len > sizeof (struct sockaddr_in6)) |
| *len = sizeof (struct sockaddr_in6); |
| sa_len = sizeof (struct sockaddr_in6) - sizeof (struct in6_addr); |
| copy_len = *len - sa_len; |
| if (copy_len > 0) |
| memcpy (((struct sockaddr_in6 *) addr)->sin6_addr. |
| __in6_u.__u6_addr8, ep->ip, copy_len); |
| break; |
| |
| default: |
| /* Not possible */ |
| rv = -EAFNOSUPPORT; |
| break; |
| } |
| } |
| return rv; |
| } |
| |
| int |
| getsockname (int fd, __SOCKADDR_ARG addr, socklen_t * __restrict len) |
| { |
| int rv; |
| const char *func_str; |
| u32 sid = ldp_sid_from_fd (fd); |
| |
| if ((errno = -ldp_init ())) |
| return -1; |
| |
| if (sid != INVALID_SESSION_ID) |
| { |
| vppcom_endpt_t ep; |
| u8 addr_buf[sizeof (struct in6_addr)]; |
| u32 size = sizeof (ep); |
| |
| ep.ip = addr_buf; |
| func_str = "vppcom_session_attr[GET_LCL_ADDR]"; |
| |
| if (LDP_DEBUG > 2) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): sid %u (0x%x), " |
| "addr %p, len %u", |
| getpid (), fd, fd, func_str, sid, sid, addr, len); |
| |
| rv = vppcom_session_attr (sid, VPPCOM_ATTR_GET_LCL_ADDR, &ep, &size); |
| if (rv != VPPCOM_OK) |
| { |
| errno = -rv; |
| rv = -1; |
| } |
| else |
| { |
| rv = ldp_copy_ep_to_sockaddr (addr, len, &ep); |
| if (rv != VPPCOM_OK) |
| { |
| errno = -rv; |
| rv = -1; |
| } |
| } |
| } |
| else |
| { |
| func_str = "libc_getsockname"; |
| |
| if (LDP_DEBUG > 2) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): " |
| "addr %p, len %u", |
| getpid (), fd, fd, func_str, addr, len); |
| |
| rv = libc_getsockname (fd, addr, len); |
| } |
| |
| if (LDP_DEBUG > 2) |
| { |
| if (rv < 0) |
| { |
| int errno_val = errno; |
| perror (func_str); |
| clib_warning ("LDP<%d>: ERROR: fd %d (0x%x): %s() failed! " |
| "rv %d, errno = %d", getpid (), fd, fd, |
| func_str, rv, errno_val); |
| errno = errno_val; |
| } |
| else |
| clib_warning ("LDP<%d>: fd %d (0x%x): returning %d (0x%x)", |
| getpid (), fd, fd, rv, rv); |
| } |
| return rv; |
| } |
| |
| int |
| connect (int fd, __CONST_SOCKADDR_ARG addr, socklen_t len) |
| { |
| int rv; |
| const char *func_str = __func__; |
| u32 sid = ldp_sid_from_fd (fd); |
| |
| if ((errno = -ldp_init ())) |
| return -1; |
| |
| if (!addr) |
| { |
| clib_warning ("LDP<%d>: ERROR: fd %d (0x%x): NULL addr, len %u", |
| getpid (), fd, fd, len); |
| errno = EINVAL; |
| rv = -1; |
| goto done; |
| } |
| |
| if (sid != INVALID_SESSION_ID) |
| { |
| vppcom_endpt_t ep; |
| |
| func_str = "vppcom_session_connect"; |
| |
| switch (addr->sa_family) |
| { |
| case AF_INET: |
| if (len != sizeof (struct sockaddr_in)) |
| { |
| clib_warning |
| ("LDP<%d>: fd %d (0x%x): ERROR sid %u (0x%x): Invalid " |
| "AF_INET addr len %u!", getpid (), fd, fd, sid, sid, len); |
| errno = EINVAL; |
| rv = -1; |
| goto done; |
| } |
| ep.is_ip4 = VPPCOM_IS_IP4; |
| ep.ip = (u8 *) & ((const struct sockaddr_in *) addr)->sin_addr; |
| ep.port = (u16) ((const struct sockaddr_in *) addr)->sin_port; |
| break; |
| |
| case AF_INET6: |
| if (len != sizeof (struct sockaddr_in6)) |
| { |
| clib_warning |
| ("LDP<%d>: fd %d (0x%x): ERROR sid %u (0x%x): Invalid " |
| "AF_INET6 addr len %u!", getpid (), fd, fd, sid, sid, len); |
| errno = EINVAL; |
| rv = -1; |
| goto done; |
| } |
| ep.is_ip4 = VPPCOM_IS_IP6; |
| ep.ip = (u8 *) & ((const struct sockaddr_in6 *) addr)->sin6_addr; |
| ep.port = (u16) ((const struct sockaddr_in6 *) addr)->sin6_port; |
| break; |
| |
| default: |
| clib_warning ("LDP<%d>: fd %d (0x%x): ERROR sid %u (0x%x): " |
| "Unsupported address family %u!", |
| getpid (), fd, fd, sid, sid, addr->sa_family); |
| errno = EAFNOSUPPORT; |
| rv = -1; |
| goto done; |
| } |
| if (LDP_DEBUG > 0) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): sid %u (0x%x) " |
| "addr %p len %u", |
| getpid (), fd, fd, func_str, sid, sid, addr, len); |
| |
| rv = vppcom_session_connect (sid, &ep); |
| if (rv != VPPCOM_OK) |
| { |
| errno = -rv; |
| rv = -1; |
| } |
| } |
| else |
| { |
| func_str = "libc_connect"; |
| |
| if (LDP_DEBUG > 0) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): " |
| "addr %p, len %u", |
| getpid (), fd, fd, func_str, addr, len); |
| |
| rv = libc_connect (fd, addr, len); |
| } |
| |
| done: |
| if (LDP_DEBUG > 0) |
| { |
| if (rv < 0) |
| { |
| int errno_val = errno; |
| perror (func_str); |
| clib_warning ("LDP<%d>: ERROR: fd %d (0x%x): %s() failed! " |
| "rv %d, errno = %d", getpid (), fd, fd, |
| func_str, rv, errno_val); |
| errno = errno_val; |
| } |
| else |
| clib_warning ("LDP<%d>: fd %d (0x%x): returning %d (0x%x)", |
| getpid (), fd, fd, rv, rv); |
| } |
| return rv; |
| } |
| |
| int |
| getpeername (int fd, __SOCKADDR_ARG addr, socklen_t * __restrict len) |
| { |
| int rv; |
| const char *func_str; |
| u32 sid = ldp_sid_from_fd (fd); |
| |
| if ((errno = -ldp_init ())) |
| return -1; |
| |
| if (sid != INVALID_SESSION_ID) |
| { |
| vppcom_endpt_t ep; |
| u8 addr_buf[sizeof (struct in6_addr)]; |
| u32 size = sizeof (ep); |
| |
| ep.ip = addr_buf; |
| func_str = "vppcom_session_attr[GET_PEER_ADDR]"; |
| |
| if (LDP_DEBUG > 2) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): sid %u (0x%x), " |
| "addr %p, len %u", |
| getpid (), fd, fd, func_str, sid, sid, addr, len); |
| |
| rv = vppcom_session_attr (sid, VPPCOM_ATTR_GET_PEER_ADDR, &ep, &size); |
| if (rv != VPPCOM_OK) |
| { |
| errno = -rv; |
| rv = -1; |
| } |
| else |
| { |
| rv = ldp_copy_ep_to_sockaddr (addr, len, &ep); |
| if (rv != VPPCOM_OK) |
| { |
| errno = -rv; |
| rv = -1; |
| } |
| } |
| } |
| else |
| { |
| func_str = "libc_getpeername"; |
| |
| if (LDP_DEBUG > 2) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): " |
| "addr %p, len %u", |
| getpid (), fd, fd, func_str, addr, len); |
| |
| rv = libc_getpeername (fd, addr, len); |
| } |
| |
| if (LDP_DEBUG > 2) |
| { |
| if (rv < 0) |
| { |
| int errno_val = errno; |
| perror (func_str); |
| clib_warning ("LDP<%d>: ERROR: fd %d (0x%x): %s() failed! " |
| "rv %d, errno = %d", getpid (), fd, fd, |
| func_str, rv, errno_val); |
| errno = errno_val; |
| } |
| else |
| clib_warning ("LDP<%d>: fd %d (0x%x): returning %d (0x%x)", |
| getpid (), fd, fd, rv, rv); |
| } |
| return rv; |
| } |
| |
| ssize_t |
| send (int fd, const void *buf, size_t n, int flags) |
| { |
| ssize_t size; |
| const char *func_str; |
| u32 sid = ldp_sid_from_fd (fd); |
| |
| if ((errno = -ldp_init ())) |
| return -1; |
| |
| if (sid != INVALID_SESSION_ID) |
| { |
| |
| func_str = "vppcom_session_sendto"; |
| |
| if (LDP_DEBUG > 2) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): sid %u (0x%x), " |
| "buf %p, n %u, flags 0x%x", |
| getpid (), fd, fd, func_str, sid, sid, buf, n, flags); |
| |
| size = vppcom_session_sendto (sid, (void *) buf, n, flags, NULL); |
| if (size != VPPCOM_OK) |
| { |
| errno = -size; |
| size = -1; |
| } |
| } |
| else |
| { |
| func_str = "libc_send"; |
| |
| if (LDP_DEBUG > 2) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): " |
| "buf %p, n %u, flags 0x%x", |
| getpid (), fd, fd, func_str, buf, n, flags); |
| |
| size = libc_send (fd, buf, n, flags); |
| } |
| |
| if (LDP_DEBUG > 2) |
| { |
| if (size < 0) |
| { |
| int errno_val = errno; |
| perror (func_str); |
| clib_warning ("LDP<%d>: ERROR: fd %d (0x%x): %s() failed! " |
| "rv %d, errno = %d", getpid (), fd, fd, |
| func_str, size, errno_val); |
| errno = errno_val; |
| } |
| else |
| clib_warning ("LDP<%d>: fd %d (0x%x): returning %d (0x%x)", |
| getpid (), fd, fd, size, size); |
| } |
| return size; |
| } |
| |
| ssize_t |
| sendfile (int out_fd, int in_fd, off_t * offset, size_t len) |
| { |
| ssize_t size = 0; |
| const char *func_str; |
| u32 sid = ldp_sid_from_fd (out_fd); |
| |
| if ((errno = -ldp_init ())) |
| return -1; |
| |
| if (sid != INVALID_SESSION_ID) |
| { |
| int rv; |
| ssize_t results = 0; |
| size_t n_bytes_left = len; |
| size_t bytes_to_read; |
| int nbytes; |
| int errno_val; |
| u8 eagain = 0; |
| u32 flags, flags_len = sizeof (flags); |
| |
| func_str = "vppcom_session_attr[GET_FLAGS]"; |
| rv = vppcom_session_attr (sid, VPPCOM_ATTR_GET_FLAGS, &flags, |
| &flags_len); |
| if (PREDICT_FALSE (rv != VPPCOM_OK)) |
| { |
| clib_warning ("LDP<%d>: ERROR: out fd %d (0x%x): %s(): " |
| "sid %u (0x%x), returned %d (%s)!", getpid (), |
| out_fd, out_fd, func_str, sid, sid, rv, |
| vppcom_retval_str (rv)); |
| |
| vec_reset_length (ldp->io_buffer); |
| errno = -rv; |
| size = -1; |
| goto done; |
| } |
| |
| if (offset) |
| { |
| off_t off = lseek (in_fd, *offset, SEEK_SET); |
| if (PREDICT_FALSE (off == -1)) |
| { |
| func_str = "lseek"; |
| errno_val = errno; |
| clib_warning ("LDP<%d>: ERROR: out fd %d (0x%x): %s(): " |
| "SEEK_SET failed: in_fd %d, offset %p, " |
| "*offset %ld, rv %ld, errno %d", getpid (), |
| out_fd, out_fd, in_fd, offset, *offset, off, |
| errno_val); |
| errno = errno_val; |
| size = -1; |
| goto done; |
| } |
| |
| ASSERT (off == *offset); |
| } |
| |
| do |
| { |
| func_str = "vppcom_session_attr[GET_NWRITE]"; |
| size = vppcom_session_attr (sid, VPPCOM_ATTR_GET_NWRITE, 0, 0); |
| if (size < 0) |
| { |
| clib_warning |
| ("LDP<%d>: ERROR: fd %d (0x%x): %s(): sid %u (0x%x), " |
| "returned %d (%s)!", getpid (), out_fd, out_fd, func_str, |
| sid, sid, size, vppcom_retval_str (size)); |
| vec_reset_length (ldp->io_buffer); |
| errno = -size; |
| size = -1; |
| goto done; |
| } |
| |
| bytes_to_read = size; |
| if (LDP_DEBUG > 2) |
| clib_warning |
| ("LDP<%d>: fd %d (0x%x): called %s(): sid %u (0x%x), " |
| "results %ld, n_bytes_left %lu, bytes_to_read %lu", getpid (), |
| out_fd, out_fd, func_str, sid, sid, results, n_bytes_left, |
| bytes_to_read); |
| |
| if (bytes_to_read == 0) |
| { |
| if (flags & O_NONBLOCK) |
| { |
| if (!results) |
| { |
| if (LDP_DEBUG > 2) |
| clib_warning ("LDP<%d>: fd %d (0x%x): sid %u (0x%x): " |
| "EAGAIN", |
| getpid (), out_fd, out_fd, sid, sid); |
| eagain = 1; |
| } |
| goto update_offset; |
| } |
| else |
| continue; |
| } |
| bytes_to_read = clib_min (n_bytes_left, bytes_to_read); |
| vec_validate (ldp->io_buffer, bytes_to_read); |
| nbytes = libc_read (in_fd, ldp->io_buffer, bytes_to_read); |
| if (nbytes < 0) |
| { |
| func_str = "libc_read"; |
| errno_val = errno; |
| clib_warning ("LDP<%d>: ERROR: fd %d (0x%x): %s(): in_fd (%d), " |
| "io_buffer %p, bytes_to_read %lu, rv %d, " |
| "errno %d", getpid (), out_fd, out_fd, func_str, |
| in_fd, ldp->io_buffer, bytes_to_read, nbytes, |
| errno_val); |
| errno = errno_val; |
| |
| if (results == 0) |
| { |
| vec_reset_length (ldp->io_buffer); |
| size = -1; |
| goto done; |
| } |
| goto update_offset; |
| } |
| func_str = "vppcom_session_write"; |
| if (LDP_DEBUG > 2) |
| clib_warning |
| ("LDP<%d>: fd %d (0x%x): calling %s(): sid %u (0x%x), " |
| "buf %p, nbytes %u: results %d, n_bytes_left %d", getpid (), |
| out_fd, out_fd, func_str, sid, sid, ldp->io_buffer, nbytes, |
| results, n_bytes_left); |
| |
| size = vppcom_session_write (sid, ldp->io_buffer, nbytes); |
| if (size < 0) |
| { |
| if (size == VPPCOM_EAGAIN) |
| { |
| if (flags & O_NONBLOCK) |
| { |
| if (!results) |
| { |
| if (LDP_DEBUG > 2) |
| clib_warning |
| ("LDP<%d>: fd %d (0x%x): sid %u (0x%x): " |
| "EAGAIN", getpid (), out_fd, out_fd, sid, sid); |
| eagain = 1; |
| } |
| goto update_offset; |
| } |
| else |
| continue; |
| } |
| else |
| { |
| clib_warning ("LDP<%d>: ERROR: fd %d (0x%x): %s():" |
| "sid %u, io_buffer %p, nbytes %u " |
| "returned %d (%s)", |
| getpid (), out_fd, out_fd, func_str, |
| sid, ldp->io_buffer, nbytes, |
| size, vppcom_retval_str (size)); |
| } |
| if (results == 0) |
| { |
| vec_reset_length (ldp->io_buffer); |
| errno = -size; |
| size = -1; |
| goto done; |
| } |
| goto update_offset; |
| } |
| |
| results += nbytes; |
| ASSERT (n_bytes_left >= nbytes); |
| n_bytes_left = n_bytes_left - nbytes; |
| } |
| while (n_bytes_left > 0); |
| |
| update_offset: |
| vec_reset_length (ldp->io_buffer); |
| if (offset) |
| { |
| off_t off = lseek (in_fd, *offset, SEEK_SET); |
| if (PREDICT_FALSE (off == -1)) |
| { |
| func_str = "lseek"; |
| errno_val = errno; |
| clib_warning ("LDP<%d>: ERROR: %s(): SEEK_SET failed: " |
| "in_fd %d, offset %p, *offset %ld, " |
| "rv %ld, errno %d", getpid (), in_fd, |
| offset, *offset, off, errno_val); |
| errno = errno_val; |
| size = -1; |
| goto done; |
| } |
| |
| ASSERT (off == *offset); |
| *offset += results + 1; |
| } |
| if (eagain) |
| { |
| errno = EAGAIN; |
| size = -1; |
| } |
| else |
| size = results; |
| } |
| else |
| { |
| func_str = "libc_send"; |
| |
| if (LDP_DEBUG > 2) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): " |
| "in_fd %d, offset %p, len %u", |
| getpid (), out_fd, out_fd, func_str, |
| in_fd, offset, len); |
| |
| size = libc_sendfile (out_fd, in_fd, offset, len); |
| } |
| |
| done: |
| if (LDP_DEBUG > 2) |
| { |
| if (size < 0) |
| { |
| int errno_val = errno; |
| perror (func_str); |
| clib_warning ("LDP<%d>: ERROR: fd %d (0x%x): %s() failed! " |
| "rv %d, errno = %d", getpid (), out_fd, out_fd, |
| func_str, size, errno_val); |
| errno = errno_val; |
| } |
| else |
| clib_warning ("LDP<%d>: fd %d (0x%x): returning %d (0x%x)", |
| getpid (), out_fd, out_fd, size, size); |
| } |
| return size; |
| } |
| |
| ssize_t |
| sendfile64 (int out_fd, int in_fd, off_t * offset, size_t len) |
| { |
| return sendfile (out_fd, in_fd, offset, len); |
| } |
| |
| ssize_t |
| recv (int fd, void *buf, size_t n, int flags) |
| { |
| ssize_t size; |
| const char *func_str; |
| u32 sid = ldp_sid_from_fd (fd); |
| |
| if ((errno = -ldp_init ())) |
| return -1; |
| |
| if (sid != INVALID_SESSION_ID) |
| { |
| func_str = "vppcom_session_recvfrom"; |
| |
| if (LDP_DEBUG > 2) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): " |
| "sid %u (0x%x), buf %p, n %u, flags 0x%x", getpid (), |
| fd, fd, func_str, sid, sid, buf, n, flags); |
| |
| size = vppcom_session_recvfrom (sid, buf, n, flags, NULL); |
| if (size < 0) |
| { |
| errno = -size; |
| size = -1; |
| } |
| } |
| else |
| { |
| func_str = "libc_recv"; |
| |
| if (LDP_DEBUG > 2) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): " |
| "buf %p, n %u, flags 0x%x", getpid (), |
| fd, fd, func_str, buf, n, flags); |
| |
| size = libc_recv (fd, buf, n, flags); |
| } |
| |
| if (LDP_DEBUG > 2) |
| { |
| if (size < 0) |
| { |
| int errno_val = errno; |
| perror (func_str); |
| clib_warning ("LDP<%d>: ERROR: fd %d (0x%x): %s() failed! " |
| "rv %d, errno = %d", getpid (), fd, fd, |
| func_str, size, errno_val); |
| errno = errno_val; |
| } |
| else |
| clib_warning ("LDP<%d>: fd %d (0x%x): returning %d (0x%x)", |
| getpid (), fd, fd, size, size); |
| } |
| return size; |
| } |
| |
| ssize_t |
| sendto (int fd, const void *buf, size_t n, int flags, |
| __CONST_SOCKADDR_ARG addr, socklen_t addr_len) |
| { |
| ssize_t size; |
| const char *func_str = __func__; |
| u32 sid = ldp_sid_from_fd (fd); |
| |
| if ((errno = -ldp_init ())) |
| return -1; |
| |
| if (sid != INVALID_SESSION_ID) |
| { |
| vppcom_endpt_t *ep = 0; |
| vppcom_endpt_t _ep; |
| |
| if (addr) |
| { |
| ep = &_ep; |
| switch (addr->sa_family) |
| { |
| case AF_INET: |
| ep->is_ip4 = VPPCOM_IS_IP4; |
| ep->ip = |
| (uint8_t *) & ((const struct sockaddr_in *) addr)->sin_addr; |
| ep->port = |
| (uint16_t) ((const struct sockaddr_in *) addr)->sin_port; |
| break; |
| |
| case AF_INET6: |
| ep->is_ip4 = VPPCOM_IS_IP6; |
| ep->ip = |
| (uint8_t *) & ((const struct sockaddr_in6 *) addr)->sin6_addr; |
| ep->port = |
| (uint16_t) ((const struct sockaddr_in6 *) addr)->sin6_port; |
| break; |
| |
| default: |
| errno = EAFNOSUPPORT; |
| size = -1; |
| goto done; |
| } |
| } |
| |
| func_str = "vppcom_session_sendto"; |
| |
| if (LDP_DEBUG > 2) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): " |
| "sid %u (0x%x), buf %p, n %u, flags 0x%x, ep %p", |
| getpid (), fd, fd, func_str, sid, sid, buf, n, |
| flags, ep); |
| |
| size = vppcom_session_sendto (sid, (void *) buf, n, flags, ep); |
| if (size < 0) |
| { |
| errno = -size; |
| size = -1; |
| } |
| } |
| else |
| { |
| func_str = "libc_sendto"; |
| |
| if (LDP_DEBUG > 2) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): " |
| "buf %p, n %u, flags 0x%x, addr %p, addr_len %d", |
| getpid (), fd, fd, func_str, buf, n, flags, |
| addr, addr_len); |
| |
| size = libc_sendto (fd, buf, n, flags, addr, addr_len); |
| } |
| |
| done: |
| if (LDP_DEBUG > 2) |
| { |
| if (size < 0) |
| { |
| int errno_val = errno; |
| perror (func_str); |
| clib_warning ("LDP<%d>: ERROR: fd %d (0x%x): %s() failed! " |
| "rv %d, errno = %d", getpid (), fd, fd, |
| func_str, size, errno_val); |
| errno = errno_val; |
| } |
| else |
| clib_warning ("LDP<%d>: fd %d (0x%x): returning %d (0x%x)", |
| getpid (), fd, fd, size, size); |
| } |
| return size; |
| } |
| |
| ssize_t |
| recvfrom (int fd, void *__restrict buf, size_t n, int flags, |
| __SOCKADDR_ARG addr, socklen_t * __restrict addr_len) |
| { |
| ssize_t size; |
| const char *func_str; |
| u32 sid = ldp_sid_from_fd (fd); |
| |
| if ((errno = -ldp_init ())) |
| return -1; |
| |
| if (sid != INVALID_SESSION_ID) |
| { |
| vppcom_endpt_t ep; |
| u8 src_addr[sizeof (struct sockaddr_in6)]; |
| |
| func_str = "vppcom_session_recvfrom"; |
| |
| if (LDP_DEBUG > 2) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): " |
| "sid %u (0x%x), buf %p, n %u, flags 0x%x, ep %p", |
| getpid (), fd, fd, func_str, sid, sid, buf, n, |
| flags, &ep); |
| if (addr) |
| { |
| ep.ip = src_addr; |
| size = vppcom_session_recvfrom (sid, buf, n, flags, &ep); |
| |
| if (size > 0) |
| size = ldp_copy_ep_to_sockaddr (addr, addr_len, &ep); |
| } |
| else |
| size = vppcom_session_recvfrom (sid, buf, n, flags, NULL); |
| |
| if (size < 0) |
| { |
| errno = -size; |
| size = -1; |
| } |
| } |
| else |
| { |
| func_str = "libc_recvfrom"; |
| |
| if (LDP_DEBUG > 2) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): " |
| "buf %p, n %u, flags 0x%x, addr %p, addr_len %d", |
| getpid (), fd, fd, func_str, buf, n, flags, |
| addr, addr_len); |
| |
| size = libc_recvfrom (fd, buf, n, flags, addr, addr_len); |
| } |
| |
| if (LDP_DEBUG > 2) |
| { |
| if (size < 0) |
| { |
| int errno_val = errno; |
| perror (func_str); |
| clib_warning ("LDP<%d>: ERROR: fd %d (0x%x): %s() failed! " |
| "rv %d, errno = %d", getpid (), fd, fd, |
| func_str, size, errno_val); |
| errno = errno_val; |
| } |
| else |
| clib_warning ("LDP<%d>: fd %d (0x%x): returning %d (0x%x)", |
| getpid (), fd, fd, size, size); |
| } |
| return size; |
| } |
| |
| ssize_t |
| sendmsg (int fd, const struct msghdr * message, int flags) |
| { |
| ssize_t size; |
| const char *func_str; |
| u32 sid = ldp_sid_from_fd (fd); |
| |
| if ((errno = -ldp_init ())) |
| return -1; |
| |
| if (sid != INVALID_SESSION_ID) |
| { |
| func_str = __func__; |
| |
| clib_warning ("LDP<%d>: LDP-TBD", getpid ()); |
| errno = ENOSYS; |
| size = -1; |
| } |
| else |
| { |
| func_str = "libc_sendmsg"; |
| |
| if (LDP_DEBUG > 2) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): " |
| "message %p, flags 0x%x", |
| getpid (), fd, fd, func_str, message, flags); |
| |
| size = libc_sendmsg (fd, message, flags); |
| } |
| |
| if (LDP_DEBUG > 2) |
| { |
| if (size < 0) |
| { |
| int errno_val = errno; |
| perror (func_str); |
| clib_warning ("LDP<%d>: ERROR: fd %d (0x%x): %s() failed! " |
| "rv %d, errno = %d", getpid (), fd, fd, |
| func_str, size, errno_val); |
| errno = errno_val; |
| } |
| else |
| clib_warning ("LDP<%d>: fd %d (0x%x): returning %d (0x%x)", |
| getpid (), fd, fd, size, size); |
| } |
| return size; |
| } |
| |
| #ifdef USE_GNU |
| int |
| sendmmsg (int fd, struct mmsghdr *vmessages, unsigned int vlen, int flags) |
| { |
| ssize_t size; |
| const char *func_str; |
| u32 sid = ldp_sid_from_fd (fd); |
| |
| if ((errno = -ldp_init ())) |
| return -1; |
| |
| if (sid != INVALID_SESSION_ID) |
| { |
| clib_warning ("LDP<%d>: LDP-TBD", getpid ()); |
| errno = ENOSYS; |
| size = -1; |
| } |
| else |
| { |
| func_str = "libc_sendmmsg"; |
| |
| if (LDP_DEBUG > 2) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): " |
| "vmessages %p, vlen %u, flags 0x%x", |
| getpid (), fd, fd, func_str, vmessages, vlen, flags); |
| |
| size = libc_sendmmsg (fd, vmessages, vlen, flags); |
| } |
| |
| if (LDP_DEBUG > 2) |
| { |
| if (size < 0) |
| { |
| int errno_val = errno; |
| perror (func_str); |
| clib_warning ("LDP<%d>: ERROR: fd %d (0x%x): %s() failed! " |
| "rv %d, errno = %d", getpid (), fd, fd, |
| func_str, size, errno_val); |
| errno = errno_val; |
| } |
| else |
| clib_warning ("LDP<%d>: fd %d (0x%x): returning %d (0x%x)", |
| getpid (), fd, fd, size, size); |
| } |
| return size; |
| } |
| #endif |
| |
| ssize_t |
| recvmsg (int fd, struct msghdr * message, int flags) |
| { |
| ssize_t size; |
| const char *func_str; |
| u32 sid = ldp_sid_from_fd (fd); |
| |
| if ((errno = -ldp_init ())) |
| return -1; |
| |
| if (sid != INVALID_SESSION_ID) |
| { |
| func_str = __func__; |
| |
| clib_warning ("LDP<%d>: LDP-TBD", getpid ()); |
| errno = ENOSYS; |
| size = -1; |
| } |
| else |
| { |
| func_str = "libc_recvmsg"; |
| |
| if (LDP_DEBUG > 2) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): " |
| "message %p, flags 0x%x", |
| getpid (), fd, fd, func_str, message, flags); |
| |
| size = libc_recvmsg (fd, message, flags); |
| } |
| |
| if (LDP_DEBUG > 2) |
| { |
| if (size < 0) |
| { |
| int errno_val = errno; |
| perror (func_str); |
| clib_warning ("LDP<%d>: ERROR: fd %d (0x%x): %s() failed! " |
| "rv %d, errno = %d", getpid (), fd, fd, |
| func_str, size, errno_val); |
| errno = errno_val; |
| } |
| else |
| clib_warning ("LDP<%d>: fd %d (0x%x): returning %d (0x%x)", |
| getpid (), fd, fd, size, size); |
| } |
| return size; |
| } |
| |
| #ifdef USE_GNU |
| int |
| recvmmsg (int fd, struct mmsghdr *vmessages, |
| unsigned int vlen, int flags, struct timespec *tmo) |
| { |
| ssize_t size; |
| const char *func_str; |
| u32 sid = ldp_sid_from_fd (fd); |
| |
| if ((errno = -ldp_init ())) |
| return -1; |
| |
| if (sid != INVALID_SESSION_ID) |
| { |
| clib_warning ("LDP<%d>: LDP-TBD", getpid ()); |
| errno = ENOSYS; |
| size = -1; |
| } |
| else |
| { |
| func_str = "libc_recvmmsg"; |
| |
| if (LDP_DEBUG > 2) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): " |
| "vmessages %p, vlen %u, flags 0x%x, tmo %p", |
| getpid (), fd, fd, func_str, vmessages, vlen, |
| flags, tmo); |
| |
| size = libc_recvmmsg (fd, vmessages, vlen, flags, tmo); |
| } |
| |
| if (LDP_DEBUG > 2) |
| { |
| if (size < 0) |
| { |
| int errno_val = errno; |
| perror (func_str); |
| clib_warning ("LDP<%d>: ERROR: fd %d (0x%x): %s() failed! " |
| "rv %d, errno = %d", getpid (), fd, fd, |
| func_str, size, errno_val); |
| errno = errno_val; |
| } |
| else |
| clib_warning ("LDP<%d>: fd %d (0x%x): returning %d (0x%x)", |
| getpid (), fd, fd, size, size); |
| } |
| return size; |
| } |
| #endif |
| |
| int |
| getsockopt (int fd, int level, int optname, |
| void *__restrict optval, socklen_t * __restrict optlen) |
| { |
| int rv; |
| const char *func_str = __func__; |
| u32 sid = ldp_sid_from_fd (fd); |
| u32 buflen = optlen ? (u32) * optlen : 0; |
| |
| if ((errno = -ldp_init ())) |
| return -1; |
| |
| if (sid != INVALID_SESSION_ID) |
| { |
| rv = -EOPNOTSUPP; |
| |
| switch (level) |
| { |
| case SOL_TCP: |
| switch (optname) |
| { |
| case TCP_NODELAY: |
| func_str = "vppcom_session_attr[SOL_TCP,GET_TCP_NODELAY]"; |
| if (LDP_DEBUG > 1) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): " |
| "sid %u (0x%x)", |
| getpid (), fd, fd, func_str, sid, sid); |
| rv = vppcom_session_attr (sid, VPPCOM_ATTR_GET_TCP_NODELAY, |
| optval, optlen); |
| break; |
| case TCP_MAXSEG: |
| func_str = "vppcom_session_attr[SOL_TCP,GET_TCP_USER_MSS]"; |
| if (LDP_DEBUG > 1) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): " |
| "sid %u (0x%x)", |
| getpid (), fd, fd, func_str, sid, sid); |
| rv = vppcom_session_attr (sid, VPPCOM_ATTR_GET_TCP_USER_MSS, |
| optval, optlen); |
| break; |
| case TCP_KEEPIDLE: |
| func_str = "vppcom_session_attr[SOL_TCP,GET_TCP_KEEPIDLE]"; |
| if (LDP_DEBUG > 1) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): " |
| "sid %u (0x%x)", |
| getpid (), fd, fd, func_str, sid, sid); |
| rv = vppcom_session_attr (sid, VPPCOM_ATTR_GET_TCP_KEEPIDLE, |
| optval, optlen); |
| break; |
| case TCP_KEEPINTVL: |
| func_str = "vppcom_session_attr[SOL_TCP,GET_TCP_KEEPINTVL]"; |
| if (LDP_DEBUG > 1) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): " |
| "sid %u (0x%x), SOL_TCP", |
| getpid (), fd, fd, func_str, sid, sid); |
| rv = vppcom_session_attr (sid, VPPCOM_ATTR_GET_TCP_KEEPINTVL, |
| optval, optlen); |
| break; |
| case TCP_INFO: |
| if (optval && optlen && (*optlen == sizeof (struct tcp_info))) |
| { |
| if (LDP_DEBUG > 1) |
| clib_warning ("LDP<%d>: fd %d (0x%x): sid %u (0x%x), " |
| "SOL_TCP, TCP_INFO, optval %p, " |
| "optlen %d: #LDP-NOP#", |
| getpid (), fd, fd, sid, sid, |
| optval, *optlen); |
| memset (optval, 0, *optlen); |
| rv = VPPCOM_OK; |
| } |
| else |
| rv = -EFAULT; |
| break; |
| default: |
| if (LDP_DEBUG > 1) |
| clib_warning ("LDP<%d>: ERROR: fd %d (0x%x): %s(): " |
| "sid %u (0x%x), SOL_TCP, " |
| "optname %d unsupported!", |
| getpid (), fd, fd, func_str, sid, sid, optname); |
| break; |
| } |
| break; |
| case SOL_IPV6: |
| switch (optname) |
| { |
| case IPV6_V6ONLY: |
| func_str = "vppcom_session_attr[SOL_IPV6,GET_V6ONLY]"; |
| if (LDP_DEBUG > 1) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): " |
| "sid %u (0x%x)", |
| getpid (), fd, fd, func_str, sid, sid); |
| rv = vppcom_session_attr (sid, VPPCOM_ATTR_GET_V6ONLY, |
| optval, optlen); |
| break; |
| default: |
| if (LDP_DEBUG > 1) |
| clib_warning ("LDP<%d>: ERROR: fd %d (0x%x): %s(): " |
| "sid %u (0x%x), SOL_IPV6, " |
| "optname %d unsupported!", |
| getpid (), fd, fd, func_str, sid, sid, optname); |
| break; |
| } |
| break; |
| case SOL_SOCKET: |
| switch (optname) |
| { |
| case SO_ACCEPTCONN: |
| func_str = "vppcom_session_attr[SOL_SOCKET,GET_ACCEPTCONN]"; |
| if (LDP_DEBUG > 1) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): " |
| "sid %u (0x%x)", |
| getpid (), fd, fd, func_str, sid, sid); |
| rv = vppcom_session_attr (sid, VPPCOM_ATTR_GET_LISTEN, |
| optval, optlen); |
| break; |
| case SO_KEEPALIVE: |
| func_str = "vppcom_session_attr[SOL_SOCKET,GET_KEEPALIVE]"; |
| if (LDP_DEBUG > 1) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): " |
| "sid %u (0x%x)", |
| getpid (), fd, fd, func_str, sid, sid); |
| rv = vppcom_session_attr (sid, VPPCOM_ATTR_GET_KEEPALIVE, |
| optval, optlen); |
| break; |
| case SO_PROTOCOL: |
| func_str = "vppcom_session_attr[SOL_SOCKET,GET_PROTOCOL]"; |
| if (LDP_DEBUG > 1) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): " |
| "sid %u (0x%x)", |
| getpid (), fd, fd, func_str, sid, sid); |
| rv = vppcom_session_attr (sid, VPPCOM_ATTR_GET_PROTOCOL, |
| optval, optlen); |
| *(int *) optval = *(int *) optval ? SOCK_DGRAM : SOCK_STREAM; |
| break; |
| case SO_SNDBUF: |
| func_str = "vppcom_session_attr[SOL_SOCKET,GET_TX_FIFO_LEN]"; |
| if (LDP_DEBUG > 1) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): " |
| "sid %u (0x%x), optlen %d", |
| getpid (), fd, fd, func_str, sid, sid, buflen); |
| rv = vppcom_session_attr (sid, VPPCOM_ATTR_GET_TX_FIFO_LEN, |
| optval, optlen); |
| break; |
| case SO_RCVBUF: |
| func_str = "vppcom_session_attr[SOL_SOCKET,GET_RX_FIFO_LEN]"; |
| if (LDP_DEBUG > 1) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): " |
| "sid %u (0x%x), optlen %d", |
| getpid (), fd, fd, func_str, sid, sid, buflen); |
| rv = vppcom_session_attr (sid, VPPCOM_ATTR_GET_RX_FIFO_LEN, |
| optval, optlen); |
| break; |
| case SO_REUSEADDR: |
| func_str = "vppcom_session_attr[SOL_SOCKET,GET_REUSEADDR]"; |
| if (LDP_DEBUG > 1) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): " |
| "sid %u (0x%x)", |
| getpid (), fd, fd, func_str, sid, sid); |
| rv = vppcom_session_attr (sid, VPPCOM_ATTR_GET_REUSEADDR, |
| optval, optlen); |
| break; |
| case SO_BROADCAST: |
| func_str = "vppcom_session_attr[SOL_SOCKET,GET_BROADCAST]"; |
| if (LDP_DEBUG > 1) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): " |
| "sid %u (0x%x)", |
| getpid (), fd, fd, func_str, sid, sid); |
| rv = vppcom_session_attr (sid, VPPCOM_ATTR_GET_BROADCAST, |
| optval, optlen); |
| break; |
| case SO_ERROR: |
| func_str = "vppcom_session_attr[SOL_SOCKET,GET_ERROR]"; |
| if (LDP_DEBUG > 1) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): " |
| "sid %u (0x%x)", |
| getpid (), fd, fd, func_str, sid, sid); |
| rv = vppcom_session_attr (sid, VPPCOM_ATTR_GET_ERROR, |
| optval, optlen); |
| break; |
| default: |
| if (LDP_DEBUG > 1) |
| clib_warning ("LDP<%d>: ERROR: fd %d (0x%x): %s(): " |
| "sid %u (0x%x), SOL_SOCKET, " |
| "optname %d unsupported!", |
| getpid (), fd, fd, func_str, sid, sid, optname); |
| break; |
| } |
| break; |
| default: |
| break; |
| } |
| |
| if (rv != VPPCOM_OK) |
| { |
| errno = -rv; |
| rv = -1; |
| } |
| } |
| else |
| { |
| func_str = "libc_getsockopt"; |
| |
| if (LDP_DEBUG > 1) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): level %d, " |
| "optname %d, optval %p, optlen %d", |
| getpid (), fd, fd, func_str, level, optname, |
| optval, optlen); |
| |
| rv = libc_getsockopt (fd, level, optname, optval, optlen); |
| } |
| |
| if (LDP_DEBUG > 1) |
| { |
| if (rv < 0) |
| { |
| int errno_val = errno; |
| perror (func_str); |
| clib_warning ("LDP<%d>: ERROR: fd %d (0x%x): %s() failed! " |
| "rv %d, errno = %d", getpid (), fd, fd, |
| func_str, rv, errno_val); |
| errno = errno_val; |
| } |
| else |
| clib_warning ("LDP<%d>: fd %d (0x%x): returning %d (0x%x)", |
| getpid (), fd, fd, rv, rv); |
| } |
| return rv; |
| } |
| |
| int |
| setsockopt (int fd, int level, int optname, |
| const void *optval, socklen_t optlen) |
| { |
| int rv; |
| const char *func_str = __func__; |
| u32 sid = ldp_sid_from_fd (fd); |
| |
| if ((errno = -ldp_init ())) |
| return -1; |
| |
| if (sid != INVALID_SESSION_ID) |
| { |
| rv = -EOPNOTSUPP; |
| |
| switch (level) |
| { |
| case SOL_TCP: |
| switch (optname) |
| { |
| case TCP_NODELAY: |
| func_str = "vppcom_session_attr[SOL_TCP,SET_TCP_NODELAY]"; |
| if (LDP_DEBUG > 1) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): " |
| "sid %u (0x%x)", |
| getpid (), fd, fd, func_str, sid, sid); |
| rv = vppcom_session_attr (sid, VPPCOM_ATTR_SET_TCP_NODELAY, |
| (void *) optval, &optlen); |
| break; |
| case TCP_MAXSEG: |
| func_str = "vppcom_session_attr[SOL_TCP,SET_TCP_USER_MSS]"; |
| if (LDP_DEBUG > 1) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): " |
| "sid %u (0x%x)", |
| getpid (), fd, fd, func_str, sid, sid); |
| rv = vppcom_session_attr (sid, VPPCOM_ATTR_SET_TCP_USER_MSS, |
| (void *) optval, &optlen); |
| break; |
| case TCP_KEEPIDLE: |
| func_str = "vppcom_session_attr[SOL_TCP,SET_TCP_KEEPIDLE]"; |
| if (LDP_DEBUG > 1) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): " |
| "sid %u (0x%x)", |
| getpid (), fd, fd, func_str, sid, sid); |
| rv = vppcom_session_attr (sid, VPPCOM_ATTR_SET_TCP_KEEPIDLE, |
| (void *) optval, &optlen); |
| break; |
| case TCP_KEEPINTVL: |
| func_str = "vppcom_session_attr[SOL_TCP,SET_TCP_KEEPINTVL]"; |
| if (LDP_DEBUG > 1) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): " |
| "sid %u (0x%x), SOL_TCP", |
| getpid (), fd, fd, func_str, sid, sid); |
| rv = vppcom_session_attr (sid, VPPCOM_ATTR_SET_TCP_KEEPINTVL, |
| (void *) optval, &optlen); |
| break; |
| default: |
| if (LDP_DEBUG > 1) |
| clib_warning ("LDP<%d>: ERROR: fd %d (0x%x): %s(): " |
| "sid %u (0x%x), SOL_TCP, " |
| "optname %d unsupported!", |
| getpid (), fd, fd, func_str, sid, sid, optname); |
| break; |
| } |
| break; |
| case SOL_IPV6: |
| switch (optname) |
| { |
| case IPV6_V6ONLY: |
| func_str = "vppcom_session_attr[SOL_IPV6,SET_V6ONLY]"; |
| if (LDP_DEBUG > 1) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): " |
| "sid %u (0x%x)", |
| getpid (), fd, fd, func_str, sid, sid); |
| rv = vppcom_session_attr (sid, VPPCOM_ATTR_SET_V6ONLY, |
| (void *) optval, &optlen); |
| break; |
| default: |
| if (LDP_DEBUG > 1) |
| clib_warning ("LDP<%d>: ERROR: fd %d (0x%x): %s(): " |
| "sid %u (0x%x), SOL_IPV6, " |
| "optname %d unsupported!", |
| getpid (), fd, fd, func_str, sid, sid, optname); |
| break; |
| } |
| break; |
| case SOL_SOCKET: |
| switch (optname) |
| { |
| case SO_KEEPALIVE: |
| func_str = "vppcom_session_attr[SOL_SOCKET,SET_KEEPALIVE]"; |
| if (LDP_DEBUG > 1) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): " |
| "sid %u (0x%x)", |
| getpid (), fd, fd, func_str, sid, sid); |
| rv = vppcom_session_attr (sid, VPPCOM_ATTR_SET_KEEPALIVE, |
| (void *) optval, &optlen); |
| break; |
| case SO_REUSEADDR: |
| func_str = "vppcom_session_attr[SOL_SOCKET,SET_REUSEADDR]"; |
| if (LDP_DEBUG > 1) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): " |
| "sid %u (0x%x)", |
| getpid (), fd, fd, func_str, sid, sid); |
| rv = vppcom_session_attr (sid, VPPCOM_ATTR_SET_REUSEADDR, |
| (void *) optval, &optlen); |
| break; |
| case SO_BROADCAST: |
| func_str = "vppcom_session_attr[SOL_SOCKET,SET_BROADCAST]"; |
| if (LDP_DEBUG > 1) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): " |
| "sid %u (0x%x)", |
| getpid (), fd, fd, func_str, sid, sid); |
| rv = vppcom_session_attr (sid, VPPCOM_ATTR_SET_BROADCAST, |
| (void *) optval, &optlen); |
| break; |
| default: |
| if (LDP_DEBUG > 1) |
| clib_warning ("LDP<%d>: ERROR: fd %d (0x%x): %s(): " |
| "sid %u (0x%x), SOL_SOCKET, " |
| "optname %d unsupported!", |
| getpid (), fd, fd, func_str, sid, sid, optname); |
| break; |
| } |
| break; |
| default: |
| break; |
| } |
| |
| if (rv != VPPCOM_OK) |
| { |
| errno = -rv; |
| rv = -1; |
| } |
| } |
| else |
| { |
| func_str = "libc_setsockopt"; |
| |
| if (LDP_DEBUG > 1) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): level %d, " |
| "optname %d, optval %p, optlen %d", |
| getpid (), fd, fd, func_str, level, optname, |
| optval, optlen); |
| |
| rv = libc_setsockopt (fd, level, optname, optval, optlen); |
| } |
| |
| if (LDP_DEBUG > 1) |
| { |
| if (rv < 0) |
| { |
| int errno_val = errno; |
| perror (func_str); |
| clib_warning ("LDP<%d>: ERROR: fd %d (0x%x): %s() failed! " |
| "rv %d, errno = %d", getpid (), fd, fd, |
| func_str, rv, errno_val); |
| errno = errno_val; |
| } |
| else |
| clib_warning ("LDP<%d>: fd %d (0x%x): returning %d (0x%x)", |
| getpid (), fd, fd, rv, rv); |
| } |
| return rv; |
| } |
| |
| int |
| listen (int fd, int n) |
| { |
| int rv; |
| const char *func_str; |
| u32 sid = ldp_sid_from_fd (fd); |
| |
| if ((errno = -ldp_init ())) |
| return -1; |
| |
| if (sid != INVALID_SESSION_ID) |
| { |
| func_str = "vppcom_session_listen"; |
| |
| if (LDP_DEBUG > 0) |
| clib_warning |
| ("LDP<%d>: fd %d (0x%x): calling %s(): sid %u (0x%x), n %d", |
| getpid (), fd, fd, func_str, sid, sid, n); |
| |
| rv = vppcom_session_listen (sid, n); |
| if (rv != VPPCOM_OK) |
| { |
| errno = -rv; |
| rv = -1; |
| } |
| } |
| else |
| { |
| func_str = "libc_listen"; |
| |
| if (LDP_DEBUG > 0) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): n %d", |
| getpid (), fd, fd, func_str, n); |
| |
| rv = libc_listen (fd, n); |
| } |
| |
| if (LDP_DEBUG > 0) |
| { |
| if (rv < 0) |
| { |
| int errno_val = errno; |
| perror (func_str); |
| clib_warning ("LDP<%d>: ERROR: fd %d (0x%x): %s() failed! " |
| "rv %d, errno = %d", getpid (), fd, fd, |
| func_str, rv, errno_val); |
| errno = errno_val; |
| } |
| else |
| clib_warning ("LDP<%d>: fd %d (0x%x): returning %d (0x%x)", |
| getpid (), fd, fd, rv, rv); |
| } |
| return rv; |
| } |
| |
| static inline int |
| ldp_accept4 (int listen_fd, __SOCKADDR_ARG addr, |
| socklen_t * __restrict addr_len, int flags) |
| { |
| int rv; |
| const char *func_str; |
| u32 listen_sid = ldp_sid_from_fd (listen_fd); |
| int accept_sid; |
| |
| if ((errno = -ldp_init ())) |
| return -1; |
| |
| if (listen_sid != INVALID_SESSION_ID) |
| { |
| vppcom_endpt_t ep; |
| u8 src_addr[sizeof (struct sockaddr_in6)]; |
| memset (&ep, 0, sizeof (ep)); |
| ep.ip = src_addr; |
| |
| func_str = "vppcom_session_accept"; |
| |
| if (LDP_DEBUG > 0) |
| clib_warning ("LDP<%d>: listen fd %d (0x%x): calling %s(): " |
| "listen sid %u (0x%x), ep %p, flags 0x%x", |
| getpid (), listen_fd, listen_fd, func_str, |
| listen_sid, listen_sid, ep, flags); |
| |
| accept_sid = vppcom_session_accept (listen_sid, &ep, flags); |
| if (accept_sid < 0) |
| { |
| errno = -accept_sid; |
| rv = -1; |
| } |
| else |
| { |
| rv = ldp_copy_ep_to_sockaddr (addr, addr_len, &ep); |
| if (rv != VPPCOM_OK) |
| { |
| (void) vppcom_session_close ((u32) accept_sid); |
| errno = -rv; |
| rv = -1; |
| } |
| else |
| { |
| func_str = "ldp_fd_from_sid"; |
| if (LDP_DEBUG > 0) |
| clib_warning ("LDP<%d>: listen fd %d (0x%x): calling %s(): " |
| "accept sid %u (0x%x), ep %p, flags 0x%x", |
| getpid (), listen_fd, listen_fd, |
| func_str, accept_sid, accept_sid, ep, flags); |
| rv = ldp_fd_from_sid ((u32) accept_sid); |
| if (rv < 0) |
| { |
| (void) vppcom_session_close ((u32) accept_sid); |
| errno = -rv; |
| rv = -1; |
| } |
| } |
| } |
| } |
| else |
| { |
| func_str = "libc_accept4"; |
| |
| if (LDP_DEBUG > 0) |
| clib_warning ("LDP<%d>: listen fd %d (0x%x): calling %s(): " |
| "addr %p, addr_len %p, flags 0x%x", |
| getpid (), listen_fd, listen_fd, func_str, |
| addr, addr_len, flags); |
| |
| rv = libc_accept4 (listen_fd, addr, addr_len, flags); |
| } |
| |
| if (LDP_DEBUG > 0) |
| { |
| if (rv < 0) |
| { |
| int errno_val = errno; |
| perror (func_str); |
| clib_warning ("LDP<%d>: ERROR: listen fd %d (0x%x): %s() failed! " |
| "rv %d, errno = %d", getpid (), listen_fd, |
| listen_fd, func_str, rv, errno_val); |
| errno = errno_val; |
| } |
| else |
| clib_warning ("LDP<%d>: listen fd %d (0x%x): returning %d (0x%x)", |
| getpid (), listen_fd, listen_fd, rv, rv); |
| } |
| return rv; |
| } |
| |
| int |
| accept4 (int fd, __SOCKADDR_ARG addr, socklen_t * __restrict addr_len, |
| int flags) |
| { |
| return ldp_accept4 (fd, addr, addr_len, flags); |
| } |
| |
| int |
| accept (int fd, __SOCKADDR_ARG addr, socklen_t * __restrict addr_len) |
| { |
| return ldp_accept4 (fd, addr, addr_len, 0); |
| } |
| |
| int |
| shutdown (int fd, int how) |
| { |
| int rv; |
| const char *func_str; |
| u32 sid = ldp_sid_from_fd (fd); |
| |
| if ((errno = -ldp_init ())) |
| return -1; |
| |
| if (sid != INVALID_SESSION_ID) |
| { |
| func_str = __func__; |
| |
| clib_warning ("LDP<%d>: LDP-TBD", getpid ()); |
| errno = ENOSYS; |
| rv = -1; |
| } |
| else |
| { |
| func_str = "libc_shutdown"; |
| |
| if (LDP_DEBUG > 1) |
| clib_warning ("LDP<%d>: fd %d (0x%x): calling %s(): how %d", |
| getpid (), fd, fd, func_str, how); |
| |
| rv = libc_shutdown (fd, how); |
| } |
| |
| if (LDP_DEBUG > 1) |
| { |
| if (rv < 0) |
| { |
| int errno_val = errno; |
| perror (func_str); |
| clib_warning ("LDP<%d>: ERROR: fd %d (0x%x): %s() failed! " |
| "rv %d, errno = %d", getpid (), fd, fd, |
| func_str, rv, errno_val); |
| errno = errno_val; |
| } |
| else |
| clib_warning ("LDP<%d>: fd %d (0x%x): returning %d (0x%x)", |
| getpid (), fd, fd, rv, rv); |
| } |
| return rv; |
| } |
| |
| int |
| epoll_create1 (int flags) |
| { |
| const char *func_str; |
| int rv; |
| |
| if ((errno = -ldp_init ())) |
| return -1; |
| |
| func_str = "vppcom_epoll_create"; |
| |
| if (LDP_DEBUG > 1) |
| clib_warning ("LDP<%d>: calling %s()", getpid (), func_str); |
| |
| rv = vppcom_epoll_create (); |
| |
| if (PREDICT_FALSE (rv < 0)) |
| { |
| errno = -rv; |
| rv = -1; |
| } |
| else |
| rv = ldp_fd_from_sid ((u32) rv); |
| |
| if (LDP_DEBUG > 1) |
| { |
| if (rv < 0) |
| { |
| int errno_val = errno; |
| perror (func_str); |
| clib_warning ("LDP<%d>: ERROR: %s() failed! " |
| "rv %d, errno = %d", |
| getpid (), func_str, rv, errno_val); |
| errno = errno_val; |
| } |
| else |
| clib_warning ("LDP<%d>: returning epfd %d (0x%x)", getpid (), rv, rv); |
| } |
| return rv; |
| } |
| |
| int |
| epoll_create (int size) |
| { |
| return epoll_create1 (0); |
| } |
| |
| int |
| epoll_ctl (int epfd, int op, int fd, struct epoll_event *event) |
| { |
| int rv; |
| const char *func_str; |
| u32 vep_idx = ldp_sid_from_fd (epfd); |
| |
| if ((errno = -ldp_init ())) |
| return -1; |
| |
| if (vep_idx != INVALID_SESSION_ID) |
| { |
| u32 sid = ldp_sid_from_fd (fd); |
| |
| if (sid != INVALID_SESSION_ID) |
| { |
| func_str = "vppcom_epoll_create"; |
| |
| if (LDP_DEBUG > 1) |
| clib_warning ("LDP<%d>: epfd %d (0x%x): calling %s(): " |
| "vep_idx %d (0x%x), op %d, sid %u (0x%x), event %p", |
| getpid (), epfd, epfd, func_str, vep_idx, vep_idx, |
| sid, sid, event); |
| |
| rv = vppcom_epoll_ctl (vep_idx, op, sid, event); |
| if (rv != VPPCOM_OK) |
| { |
| errno = -rv; |
| rv = -1; |
| } |
| } |
| else |
| { |
| int epfd; |
| u32 size = sizeof (epfd); |
| |
| func_str = "vppcom_session_attr[GET_LIBC_EPFD]"; |
| epfd = vppcom_session_attr (vep_idx, VPPCOM_ATTR_GET_LIBC_EPFD, |
| 0, 0); |
| if (!epfd) |
| { |
| func_str = "libc_epoll_create1"; |
| |
| if (LDP_DEBUG > 1) |
| clib_warning ("LDP<%d>: calling %s(): EPOLL_CLOEXEC", |
| getpid (), func_str); |
| |
| epfd = libc_epoll_create1 (EPOLL_CLOEXEC); |
| if (epfd < 0) |
| { |
| rv = epfd; |
| goto done; |
| } |
| |
| func_str = "vppcom_session_attr[SET_LIBC_EPFD]"; |
| rv = vppcom_session_attr (vep_idx, VPPCOM_ATTR_SET_LIBC_EPFD, |
| &epfd, &size); |
| if (rv < 0) |
| { |
| errno = -rv; |
| rv = -1; |
| goto done; |
| } |
| } |
| else if (PREDICT_FALSE (epfd < 0)) |
| { |
| errno = -epfd; |
| rv = -1; |
| goto done; |
| } |
| |
| rv = libc_epoll_ctl (epfd, op, fd, event); |
| } |
| } |
| else |
| { |
| func_str = "libc_epoll_ctl"; |
| |
| if (LDP_DEBUG > 1) |
| clib_warning ("LDP<%d>: epfd %d (0x%x): calling %s(): " |
| "op %d, fd %d (0x%x), event %p", |
| getpid (), epfd, epfd, func_str, op, fd, fd, event); |
| |
| rv = libc_epoll_ctl (epfd, op, fd, event); |
| } |
| |
| done: |
| if (LDP_DEBUG > 1) |
| { |
| if (rv < 0) |
| { |
| int errno_val = errno; |
| perror (func_str); |
| clib_warning ("LDP<%d>: ERROR: fd %d (0x%x): %s() failed! " |
| "rv %d, errno = %d", getpid (), fd, fd, |
| func_str, rv, errno_val); |
| errno = errno_val; |
| } |
| else |
| clib_warning ("LDP<%d>: fd %d (0x%x): returning %d (0x%x)", |
| getpid (), fd, fd, rv, rv); |
| } |
| return rv; |
| } |
| |
| static inline int |
| ldp_epoll_pwait (int epfd, struct epoll_event *events, |
| int maxevents, int timeout, const sigset_t * sigmask) |
| { |
| const char *func_str; |
| int rv = 0; |
| double time_to_wait = (double) 0; |
| double time_out, now = 0; |
| u32 vep_idx = ldp_sid_from_fd (epfd); |
| int libc_epfd; |
| |
| if ((errno = -ldp_init ())) |
| return -1; |
| |
| if (PREDICT_FALSE (!events || (timeout < -1))) |
| { |
| errno = EFAULT; |
| return -1; |
| } |
| |
| if (PREDICT_FALSE (vep_idx == INVALID_SESSION_ID)) |
| { |
| clib_warning ("LDP<%d>: ERROR: epfd %d (0x%x): bad vep_idx %d (0x%x)!", |
| getpid (), epfd, epfd, vep_idx, vep_idx); |
| errno = EBADFD; |
| return -1; |
| } |
| |
| time_to_wait = ((timeout >= 0) ? (double) timeout / (double) 1000 : 0); |
| time_out = clib_time_now (&ldp->clib_time) + time_to_wait; |
| |
| func_str = "vppcom_session_attr[GET_LIBC_EPFD]"; |
| libc_epfd = vppcom_session_attr (vep_idx, VPPCOM_ATTR_GET_LIBC_EPFD, 0, 0); |
| if (PREDICT_FALSE (libc_epfd < 0)) |
| { |
| errno = -libc_epfd; |
| rv = -1; |
| goto done; |
| } |
| |
| if (LDP_DEBUG > 2) |
| clib_warning ("LDP<%d>: epfd %d (0x%x): vep_idx %d (0x%x), " |
| "libc_epfd %d (0x%x), events %p, maxevents %d, " |
| "timeout %d, sigmask %p", getpid (), epfd, epfd, |
| vep_idx, vep_idx, libc_epfd, libc_epfd, events, |
| maxevents, timeout, sigmask); |
| do |
| { |
| if (!ldp->epoll_wait_vcl) |
| { |
| func_str = "vppcom_epoll_wait"; |
| |
| if (LDP_DEBUG > 3) |
| clib_warning ("LDP<%d>: epfd %d (0x%x): calling %s(): " |
| "vep_idx %d (0x%x), events %p, maxevents %d", |
| getpid (), epfd, epfd, func_str, |
| vep_idx, vep_idx, events, maxevents); |
| |
| rv = vppcom_epoll_wait (vep_idx, events, maxevents, 0); |
| if (rv > 0) |
| { |
| ldp->epoll_wait_vcl = 1; |
| goto done; |
| } |
| else if (rv < 0) |
| { |
| errno = -rv; |
| rv = -1; |
| goto done; |
| } |
| } |
| else |
| ldp->epoll_wait_vcl = 0; |
| |
| if (libc_epfd > 0) |
| { |
| func_str = "libc_epoll_pwait"; |
| |
| if (LDP_DEBUG > 3) |
| clib_warning ("LDP<%d>: epfd %d (0x%x): calling %s(): " |
| "libc_epfd %d (0x%x), events %p, " |
| "maxevents %d, sigmask %p", |
| getpid (), epfd, epfd, func_str, |
| libc_epfd, libc_epfd, events, maxevents, sigmask); |
| |
| rv = libc_epoll_pwait (libc_epfd, events, maxevents, 1, sigmask); |
| if (rv != 0) |
| goto done; |
| } |
| |
| if (timeout != -1) |
| now = clib_time_now (&ldp->clib_time); |
| } |
| while (now < time_out); |
| |
| done: |
| if (LDP_DEBUG > 3) |
| { |
| if (libc_epfd > 0) |
| epfd = libc_epfd; |
| if (rv < 0) |
| { |
| int errno_val = errno; |
| perror (func_str); |
| clib_warning ("LDP<%d>: ERROR: epfd %d (0x%x): %s() failed! " |
| "rv %d, errno = %d", getpid (), epfd, epfd, |
| func_str, rv, errno_val); |
| errno = errno_val; |
| } |
| else |
| clib_warning ("LDP<%d>: epfd %d (0x%x): returning %d (0x%x)", |
| getpid (), epfd, epfd, rv, rv); |
| } |
| return rv; |
| } |
| |
| int |
| epoll_pwait (int epfd, struct epoll_event *events, |
| int maxevents, int timeout, const sigset_t * sigmask) |
| { |
| return ldp_epoll_pwait (epfd, events, maxevents, timeout, sigmask); |
| } |
| |
| int |
| epoll_wait (int epfd, struct epoll_event *events, int maxevents, int timeout) |
| { |
| return ldp_epoll_pwait (epfd, events, maxevents, timeout, NULL); |
| } |
| |
| int |
| poll (struct pollfd *fds, nfds_t nfds, int timeout) |
| { |
| const char *func_str = __func__; |
| int rv, i, n_libc_fds, n_revents; |
| u32 sid; |
| vcl_poll_t *vp; |
| double wait_for_time; |
| |
| if (LDP_DEBUG > 3) |
| clib_warning ("LDP<%d>: fds %p, nfds %d, timeout %d", |
| getpid (), fds, nfds, timeout); |
| |
| if (timeout >= 0) |
| wait_for_time = (f64) timeout / 1000; |
| else |
| wait_for_time = -1; |
| |
| n_libc_fds = 0; |
| for (i = 0; i < nfds; i++) |
| { |
| if (fds[i].fd >= 0) |
| { |
| if (LDP_DEBUG > 3) |
| clib_warning ("LDP<%d>: fds[%d].fd %d (0x%0x), .events = 0x%x, " |
| ".revents = 0x%x", getpid (), i, fds[i].fd, |
| fds[i].fd, fds[i].events, fds[i].revents); |
| |
| sid = ldp_sid_from_fd (fds[i].fd); |
| if (sid != INVALID_SESSION_ID) |
| { |
| fds[i].fd = -fds[i].fd; |
| vec_add2 (ldp->vcl_poll, vp, 1); |
| vp->fds_ndx = i; |
| vp->sid = sid; |
| vp->events = fds[i].events; |
| #ifdef __USE_XOPEN2K |
| if (fds[i].events & POLLRDNORM) |
| vp->events |= POLLIN; |
| if (fds[i].events & POLLWRNORM) |
| vp->events |= POLLOUT; |
| #endif |
| vp->revents = &fds[i].revents; |
| } |
| else |
| n_libc_fds++; |
| } |
| } |
| |
| n_revents = 0; |
| do |
| { |
| if (vec_len (ldp->vcl_poll)) |
| { |
| func_str = "vppcom_poll"; |
| |
| if (LDP_DEBUG > 3) |
| clib_warning ("LDP<%d>: calling %s(): " |
| "vcl_poll %p, n_sids %u (0x%x): " |
| "n_libc_fds %u", |
| getpid (), func_str, ldp->vcl_poll, |
| vec_len (ldp->vcl_poll), vec_len (ldp->vcl_poll), |
| n_libc_fds); |
| |
| rv = vppcom_poll (ldp->vcl_poll, vec_len (ldp->vcl_poll), 0); |
| if (rv < 0) |
| { |
| errno = -rv; |
| rv = -1; |
| goto done; |
| } |
| else |
| n_revents += rv; |
| } |
| |
| if (n_libc_fds) |
| { |
| func_str = "libc_poll"; |
| |
| if (LDP_DEBUG > 3) |
| clib_warning ("LDP<%d>: calling %s(): fds %p, nfds %u: n_sids %u", |
| getpid (), fds, nfds, vec_len (ldp->vcl_poll)); |
| |
| rv = libc_poll (fds, nfds, 0); |
| if (rv < 0) |
| goto done; |
| else |
| n_revents += rv; |
| } |
| |
| if (n_revents) |
| { |
| rv = n_revents; |
| goto done; |
| } |
| } |
| while ((wait_for_time == -1) || |
| (clib_time_now (&ldp->clib_time) < wait_for_time)); |
| rv = 0; |
| |
| done: |
| vec_foreach (vp, ldp->vcl_poll) |
| { |
| fds[vp->fds_ndx].fd = -fds[vp->fds_ndx].fd; |
| #ifdef __USE_XOPEN2K |
| if ((fds[vp->fds_ndx].revents & POLLIN) && |
| (fds[vp->fds_ndx].events & POLLRDNORM)) |
| fds[vp->fds_ndx].revents |= POLLRDNORM; |
| if ((fds[vp->fds_ndx].revents & POLLOUT) && |
| (fds[vp->fds_ndx].events & POLLWRNORM)) |
| fds[vp->fds_ndx].revents |= POLLWRNORM; |
| #endif |
| } |
| vec_reset_length (ldp->vcl_poll); |
| |
| if (LDP_DEBUG > 3) |
| { |
| if (rv < 0) |
| { |
| int errno_val = errno; |
| perror (func_str); |
| clib_warning ("LDP<%d>: ERROR: %s() failed! " |
| "rv %d, errno = %d", getpid (), |
| func_str, rv, errno_val); |
| errno = errno_val; |
| } |
| else |
| { |
| clib_warning ("LDP<%d>: returning %d (0x%x): n_sids %u, " |
| "n_libc_fds %d", getpid (), rv, rv, |
| vec_len (ldp->vcl_poll), n_libc_fds); |
| |
| for (i = 0; i < nfds; i++) |
| { |
| if (fds[i].fd >= 0) |
| { |
| if (LDP_DEBUG > 3) |
| clib_warning ("LDP<%d>: fds[%d].fd %d (0x%0x), " |
| ".events = 0x%x, .revents = 0x%x", |
| getpid (), i, fds[i].fd, fds[i].fd, |
| fds[i].events, fds[i].revents); |
| } |
| } |
| } |
| } |
| |
| return rv; |
| } |
| |
| #ifdef USE_GNU |
| int |
| ppoll (struct pollfd *fds, nfds_t nfds, |
| const struct timespec *timeout, const sigset_t * sigmask) |
| { |
| if ((errno = -ldp_init ())) |
| return -1; |
| |
| clib_warning ("LDP<%d>: LDP-TBD", getpid ()); |
| errno = ENOSYS; |
| |
| |
| return -1; |
| } |
| #endif |
| |
| void CONSTRUCTOR_ATTRIBUTE ldp_constructor (void); |
| |
| void DESTRUCTOR_ATTRIBUTE ldp_destructor (void); |
| |
| /* |
| * This function is called when the library is loaded |
| */ |
| void |
| ldp_constructor (void) |
| { |
| swrap_constructor (); |
| if (ldp_init () != 0) |
| fprintf (stderr, "\nLDP<%d>: ERROR: ldp_constructor: failed!\n", |
| getpid ()); |
| else |
| clib_warning ("LDP<%d>: LDP constructor: done!\n", getpid ()); |
| } |
| |
| /* |
| * This function is called when the library is unloaded |
| */ |
| void |
| ldp_destructor (void) |
| { |
| swrap_destructor (); |
| if (ldp->init) |
| { |
| vppcom_app_destroy (); |
| ldp->init = 0; |
| } |
| |
| /* Don't use clib_warning() here because that calls writev() |
| * which will call ldp_init(). |
| */ |
| printf ("%s:%d: LDP<%d>: LDP destructor: done!\n", |
| __func__, __LINE__, getpid ()); |
| } |
| |
| |
| /* |
| * fd.io coding-style-patch-verification: ON |
| * |
| * Local Variables: |
| * eval: (c-set-style "gnu") |
| * End: |
| */ |