41 #include <sys/types.h>
43 #include <sys/socket.h>
46 #include <sys/ioctl.h>
47 #include <sys/param.h>
48 #include <netinet/in.h>
49 #include <arpa/inet.h>
65 #include <qb/qbdefs.h>
66 #include <qb/qbloop.h>
67 #define LOGSYS_UTILS_ONLY 1
80 #define MSG_NOSIGNAL 0
83 #define MCAST_SOCKET_BUFFER_SIZE (TRANSMITS_ALLOWED * FRAME_SIZE_MAX)
84 #define NETIF_STATE_REPORT_UP 1
85 #define NETIF_STATE_REPORT_DOWN 2
87 #define BIND_STATE_UNBOUND 0
88 #define BIND_STATE_REGULAR 1
89 #define BIND_STATE_LOOPBACK 2
91 #define MESSAGE_TYPE_MEMB_JOIN 3
122 unsigned int msg_len);
148 const char *
function,
203 static int totemudp_build_sockets (
231 #define log_printf(level, format, args...) \
233 instance->totemudp_log_printf ( \
234 level, instance->totemudp_subsys_id, \
235 __FUNCTION__, __FILE__, __LINE__, \
236 (const char *)format, ##args); \
239 #define LOGSYS_PERROR(err_num, level, fmt, args...) \
241 char _error_str[LOGSYS_MAX_PERROR_MSG_LEN]; \
242 const char *_error_ptr = qb_strerror_r(err_num, _error_str, sizeof(_error_str)); \
243 instance->totemudp_log_printf ( \
244 level, instance->totemudp_subsys_id, \
245 __FUNCTION__, __FILE__, __LINE__, \
246 fmt ": %s (%d)\n", ##args, _error_ptr, err_num); \
251 const char *cipher_type,
252 const char *hash_type)
259 static inline void ucast_sendmsg (
263 unsigned int msg_len)
265 struct msghdr msg_ucast;
269 struct sockaddr_storage sockaddr;
278 (
const unsigned char *)msg,
281 &buf_out_len) != 0) {
286 iovec.iov_base = (
void *)buf_out;
287 iovec.iov_len = buf_out_len;
292 memset(&msg_ucast, 0,
sizeof(msg_ucast));
295 msg_ucast.msg_name = &sockaddr;
296 msg_ucast.msg_namelen = addrlen;
297 msg_ucast.msg_iov = (
void *)&iovec;
298 msg_ucast.msg_iovlen = 1;
299 #ifdef HAVE_MSGHDR_CONTROL
300 msg_ucast.msg_control = 0;
302 #ifdef HAVE_MSGHDR_CONTROLLEN
303 msg_ucast.msg_controllen = 0;
305 #ifdef HAVE_MSGHDR_FLAGS
306 msg_ucast.msg_flags = 0;
308 #ifdef HAVE_MSGHDR_ACCRIGHTS
309 msg_ucast.msg_accrights = NULL;
311 #ifdef HAVE_MSGHDR_ACCRIGHTSLEN
312 msg_ucast.msg_accrightslen = 0;
324 "sendmsg(ucast) failed (non-critical)");
328 static inline void mcast_sendmsg (
331 unsigned int msg_len)
333 struct msghdr msg_mcast;
338 struct sockaddr_storage sockaddr;
346 (
const unsigned char *)msg,
349 &buf_out_len) != 0) {
354 iovec.iov_base = (
void *)&buf_out;
355 iovec.iov_len = buf_out_len;
362 memset(&msg_mcast, 0,
sizeof(msg_mcast));
363 msg_mcast.msg_name = &sockaddr;
364 msg_mcast.msg_namelen = addrlen;
365 msg_mcast.msg_iov = (
void *)&iovec;
366 msg_mcast.msg_iovlen = 1;
367 #ifdef HAVE_MSGHDR_CONTROL
368 msg_mcast.msg_control = 0;
370 #ifdef HAVE_MSGHDR_CONTROLLEN
371 msg_mcast.msg_controllen = 0;
373 #ifdef HAVE_MSGHDR_FLAGS
374 msg_mcast.msg_flags = 0;
376 #ifdef HAVE_MSGHDR_ACCRIGHTS
377 msg_mcast.msg_accrights = NULL;
379 #ifdef HAVE_MSGHDR_ACCRIGHTSLEN
380 msg_mcast.msg_accrightslen = 0;
391 "sendmsg(mcast) failed (non-critical)");
401 msg_mcast.msg_name = NULL;
402 msg_mcast.msg_namelen = 0;
408 "sendmsg(local mcast loop) failed (non-critical)");
446 static int net_deliver_fn (
452 struct msghdr msg_recv;
469 msg_recv.msg_namelen =
sizeof (
struct sockaddr_storage);
470 msg_recv.msg_iov = iovec;
471 msg_recv.msg_iovlen = 1;
472 #ifdef HAVE_MSGHDR_CONTROL
473 msg_recv.msg_control = 0;
475 #ifdef HAVE_MSGHDR_CONTROLLEN
476 msg_recv.msg_controllen = 0;
478 #ifdef HAVE_MSGHDR_FLAGS
479 msg_recv.msg_flags = 0;
481 #ifdef HAVE_MSGHDR_ACCRIGHTS
482 msg_recv.msg_accrights = NULL;
484 #ifdef HAVE_MSGHDR_ACCRIGHTSLEN
485 msg_recv.msg_accrightslen = 0;
488 bytes_received = recvmsg (fd, &msg_recv,
MSG_NOSIGNAL | MSG_DONTWAIT);
489 if (bytes_received == -1) {
502 "Invalid packet data");
506 iovec->iov_len = bytes_received;
512 message_type = (
char *)iovec->iov_base;
530 static int netif_determine (
540 interface_up, interface_num,
552 static void timer_function_netif_check_timeout (
563 netif_determine (instance,
566 &interface_up, &interface_num);
572 interface_up == 0) ||
576 interface_up == 1)) {
582 timer_function_netif_check_timeout,
611 if (interface_up == 0) {
616 bind_address = &localhost;
625 timer_function_netif_check_timeout,
637 (void)totemudp_build_sockets (instance,
647 POLLIN, instance, net_deliver_fn);
653 POLLIN, instance, net_deliver_fn);
659 POLLIN, instance, net_deliver_fn);
669 "The network interface [%s] is now up.",
682 timer_function_netif_check_timeout,
689 "The network interface is down.");
699 static void totemudp_traffic_control_set(
struct totemudp_instance *instance,
int sock)
704 if (setsockopt(sock, SOL_SOCKET, SO_PRIORITY, &prio,
sizeof(
int))) {
710 static int totemudp_build_sockets_ip (
718 struct sockaddr_storage sockaddr;
719 struct ipv6_mreq mreq6;
721 struct sockaddr_storage mcast_ss, boundto_ss;
722 struct sockaddr_in6 *mcast_sin6 = (
struct sockaddr_in6 *)&mcast_ss;
723 struct sockaddr_in *mcast_sin = (
struct sockaddr_in *)&mcast_ss;
724 struct sockaddr_in *boundto_sin = (
struct sockaddr_in *)&boundto_ss;
725 unsigned int sendbuf_size;
726 unsigned int recvbuf_size;
727 unsigned int optlen =
sizeof (sendbuf_size);
745 res = fcntl (sockets->
mcast_recv, F_SETFL, O_NONBLOCK);
748 "Could not set non-blocking operation on multicast socket");
756 if ( setsockopt(sockets->
mcast_recv, SOL_SOCKET, SO_REUSEADDR, (
char *)&flag, sizeof (flag)) < 0) {
758 "setsockopt(SO_REUSEADDR) failed");
767 res = bind (sockets->
mcast_recv, (
struct sockaddr *)&sockaddr, addrlen);
770 "Unable to bind the socket to receive multicast packets");
783 for (i = 0; i < 2; i++) {
788 "Could not set non-blocking operation on multicast socket");
806 res = fcntl (sockets->
mcast_send, F_SETFL, O_NONBLOCK);
809 "Could not set non-blocking operation on multicast socket");
817 if ( setsockopt(sockets->
mcast_send, SOL_SOCKET, SO_REUSEADDR, (
char *)&flag, sizeof (flag)) < 0) {
819 "setsockopt(SO_REUSEADDR) failed");
824 &sockaddr, &addrlen);
825 res = bind (sockets->
mcast_send, (
struct sockaddr *)&sockaddr, addrlen);
828 "Unable to bind the socket to send multicast packets");
835 sockets->
token = socket (bindnet_address->
family, SOCK_DGRAM, 0);
836 if (sockets->
token == -1) {
843 res = fcntl (sockets->
token, F_SETFL, O_NONBLOCK);
846 "Could not set non-blocking operation on token socket");
854 if ( setsockopt(sockets->
token, SOL_SOCKET, SO_REUSEADDR, (
char *)&flag, sizeof (flag)) < 0) {
856 "setsockopt(SO_REUSEADDR) failed");
865 res = bind (sockets->
token, (
struct sockaddr *)&sockaddr, addrlen);
868 "Unable to bind UDP unicast socket");
877 res = setsockopt (sockets->
mcast_recv, SOL_SOCKET, SO_RCVBUF, &recvbuf_size, optlen);
880 "Unable to set SO_RCVBUF size on UDP mcast socket");
883 res = setsockopt (sockets->
mcast_send, SOL_SOCKET, SO_SNDBUF, &sendbuf_size, optlen);
886 "Unable to set SO_SNDBUF size on UDP mcast socket");
889 res = setsockopt (sockets->
local_mcast_loop[0], SOL_SOCKET, SO_RCVBUF, &recvbuf_size, optlen);
892 "Unable to set SO_RCVBUF size on UDP local mcast loop socket");
895 res = setsockopt (sockets->
local_mcast_loop[1], SOL_SOCKET, SO_SNDBUF, &sendbuf_size, optlen);
898 "Unable to set SO_SNDBUF size on UDP local mcast loop socket");
902 res = getsockopt (sockets->
mcast_recv, SOL_SOCKET, SO_RCVBUF, &recvbuf_size, &optlen);
905 "Receive multicast socket recv buffer size (%d bytes).", recvbuf_size);
908 res = getsockopt (sockets->
mcast_send, SOL_SOCKET, SO_SNDBUF, &sendbuf_size, &optlen);
911 "Transmit multicast socket send buffer size (%d bytes).", sendbuf_size);
914 res = getsockopt (sockets->
local_mcast_loop[0], SOL_SOCKET, SO_RCVBUF, &recvbuf_size, &optlen);
917 "Local receive multicast loop socket recv buffer size (%d bytes).", recvbuf_size);
920 res = getsockopt (sockets->
local_mcast_loop[1], SOL_SOCKET, SO_SNDBUF, &sendbuf_size, &optlen);
923 "Local transmit multicast loop socket send buffer size (%d bytes).", sendbuf_size);
934 unsigned int broadcast = 1;
936 if ((setsockopt(sockets->
mcast_recv, SOL_SOCKET,
937 SO_BROADCAST, &broadcast, sizeof (broadcast))) == -1) {
939 "setting broadcast option failed");
942 if ((setsockopt(sockets->
mcast_send, SOL_SOCKET,
943 SO_BROADCAST, &broadcast, sizeof (broadcast))) == -1) {
945 "setting broadcast option failed");
949 switch (bindnet_address->
family) {
951 memset(&mreq, 0,
sizeof(mreq));
952 mreq.imr_multiaddr.s_addr = mcast_sin->sin_addr.s_addr;
953 mreq.imr_interface.s_addr = boundto_sin->sin_addr.s_addr;
954 res = setsockopt (sockets->
mcast_recv, IPPROTO_IP, IP_ADD_MEMBERSHIP,
955 &mreq, sizeof (mreq));
958 "join ipv4 multicast group failed");
963 memset(&mreq6, 0,
sizeof(mreq6));
964 memcpy(&mreq6.ipv6mr_multiaddr, &mcast_sin6->sin6_addr,
sizeof(
struct in6_addr));
965 mreq6.ipv6mr_interface = interface_num;
967 res = setsockopt (sockets->
mcast_recv, IPPROTO_IPV6, IPV6_JOIN_GROUP,
968 &mreq6, sizeof (mreq6));
971 "join ipv6 multicast group failed");
983 switch ( bindnet_address->
family ) {
986 res = setsockopt (sockets->
mcast_send, IPPROTO_IP, IP_MULTICAST_LOOP,
987 &sflag, sizeof (sflag));
990 res = setsockopt (sockets->
mcast_send, IPPROTO_IPV6, IPV6_MULTICAST_LOOP,
991 &flag, sizeof (flag));
995 "Unable to turn off multicast loopback");
1003 if (bindnet_address->
family == AF_INET6) {
1004 res = setsockopt (sockets->
mcast_send, IPPROTO_IPV6, IPV6_MULTICAST_HOPS,
1005 &flag, sizeof (flag));
1008 "set mcast v6 TTL failed");
1013 res = setsockopt(sockets->
mcast_send, IPPROTO_IP, IP_MULTICAST_TTL,
1014 &sflag,
sizeof(sflag));
1017 "set mcast v4 TTL failed");
1025 switch ( bindnet_address->
family ) {
1027 if (setsockopt (sockets->
mcast_send, IPPROTO_IP, IP_MULTICAST_IF,
1028 &boundto_sin->sin_addr, sizeof (boundto_sin->sin_addr)) < 0) {
1030 "cannot select interface for multicast packets (send)");
1033 if (setsockopt (sockets->
mcast_recv, IPPROTO_IP, IP_MULTICAST_IF,
1034 &boundto_sin->sin_addr, sizeof (boundto_sin->sin_addr)) < 0) {
1036 "cannot select interface for multicast packets (recv)");
1041 if (setsockopt (sockets->
mcast_send, IPPROTO_IPV6, IPV6_MULTICAST_IF,
1042 &interface_num, sizeof (interface_num)) < 0) {
1044 "cannot select interface for multicast packets (send v6)");
1047 if (setsockopt (sockets->
mcast_recv, IPPROTO_IPV6, IPV6_MULTICAST_IF,
1048 &interface_num, sizeof (interface_num)) < 0) {
1050 "cannot select interface for multicast packets (recv v6)");
1059 static int totemudp_build_sockets (
1073 res = netif_determine (instance,
1085 res = totemudp_build_sockets_ip (instance, mcast_address,
1086 bindnet_address, sockets, bound_to, interface_num);
1089 totemudp_traffic_control_set(instance, sockets->
token);
1102 qb_loop_t *poll_handle,
1109 void (*deliver_fn) (
1112 unsigned int msg_len),
1114 void (*iface_change_fn) (
1118 void (*target_set_completed) (
1124 if (instance == NULL) {
1128 totemudp_instance_initialize (instance);
1187 100*QB_TIME_NS_IN_MSEC,
1189 timer_function_netif_check_timeout,
1192 *udp_context = instance;
1208 int processor_count)
1216 if (processor_count == 1) {
1221 timer_function_netif_check_timeout,
1239 for (i = 0; i < 2; i++) {
1251 ufd.events = POLLIN;
1252 nfds = poll (&ufd, 1, 0);
1253 if (nfds == 1 && ufd.revents & POLLIN) {
1254 net_deliver_fn (sock, ufd.revents, instance);
1256 }
while (nfds == 1);
1272 unsigned int msg_len)
1277 ucast_sendmsg (instance, &instance->
token_target, msg, msg_len);
1284 unsigned int msg_len)
1289 mcast_sendmsg (instance, msg, msg_len);
1297 unsigned int msg_len)
1302 mcast_sendmsg (instance, msg, msg_len);
1312 timer_function_netif_check_timeout (instance);
1319 #define UDPIP_HEADER_SIZE (20 + 8)
1327 const char *ret_char;
1366 struct sockaddr_storage system_from;
1367 struct msghdr msg_recv;
1370 int msg_processed = 0;
1378 msg_recv.msg_namelen =
sizeof (
struct sockaddr_storage);
1380 msg_recv.msg_iovlen = 1;
1381 #ifdef HAVE_MSGHDR_CONTROL
1382 msg_recv.msg_control = 0;
1384 #ifdef HAVE_MSGHDR_CONTROLLEN
1385 msg_recv.msg_controllen = 0;
1387 #ifdef HAVE_MSGHDR_FLAGS
1388 msg_recv.msg_flags = 0;
1390 #ifdef HAVE_MSGHDR_ACCRIGHTS
1391 msg_recv.msg_accrights = NULL;
1393 #ifdef HAVE_MSGHDR_ACCRIGHTSLEN
1394 msg_recv.msg_accrightslen = 0;
1397 for (i = 0; i < 2; i++) {
1409 ufd.events = POLLIN;
1410 nfds = poll (&ufd, 1, 0);
1411 if (nfds == 1 && ufd.revents & POLLIN) {
1412 res = recvmsg (sock, &msg_recv,
MSG_NOSIGNAL | MSG_DONTWAIT);
1419 }
while (nfds == 1);
1422 return (msg_processed);
unsigned int clear_node_high_bit
int totemudp_crypto_set(void *udp_context, const char *cipher_type, const char *hash_type)
int totemudp_processor_count_set(void *udp_context, int processor_count)
int totemip_localhost(int family, struct totem_ip_address *localhost)
struct iovec totemudp_iov_recv_flush
struct totem_interface * interfaces
struct totemudp_instance * instance
struct crypto_instance * crypto_inst
size_t crypto_sec_header_size(const char *crypto_cipher_type, const char *crypto_hash_type)
const char * totemip_print(const struct totem_ip_address *addr)
struct timeval stats_tv_start
void totemudp_net_mtu_adjust(void *udp_context, struct totem_config *totem_config)
void(* totemudp_target_set_completed)(void *context)
void(* totemudp_log_printf)(int level, int subsys, const char *function, const char *file, int line, const char *format,...) __attribute__((format(printf
void * totemudp_buffer_alloc(void)
int totemudp_mcast_flush_send(void *udp_context, const void *msg, unsigned int msg_len)
int totemudp_token_target_set(void *udp_context, const struct totem_ip_address *token_target)
unsigned char private_key[TOTEM_PRIVATE_KEY_LEN]
char iov_buffer[FRAME_SIZE_MAX]
struct totemudp_socket totemudp_sockets
unsigned char addr[TOTEMIP_ADDRLEN]
struct crypto_instance * crypto_init(const unsigned char *private_key, unsigned int private_key_len, const char *crypto_cipher_type, const char *crypto_hash_type, void(*log_printf_func)(int level, int subsys, const char *function, const char *file, int line, const char *format,...) __attribute__((format(printf, 6, 7))), int log_level_security, int log_level_notice, int log_level_error, int log_subsys_id)
void totemip_copy(struct totem_ip_address *addr1, const struct totem_ip_address *addr2)
struct totem_ip_address mcast_address
unsigned int downcheck_timeout
int totemudp_mcast_noflush_send(void *udp_context, const void *msg, unsigned int msg_len)
unsigned int private_key_len
int totemudp_log_level_security
#define BIND_STATE_REGULAR
struct totem_config * totem_config
#define NETIF_STATE_REPORT_DOWN
#define totemip_nosigpipe(s)
int totemudp_log_level_error
int totemudp_send_flush(void *udp_context)
void(* totemudp_iface_change_fn)(void *context, const struct totem_ip_address *iface_address)
int totemudp_recv_flush(void *udp_context)
struct iovec totemudp_iov_recv
int totemip_iface_check(struct totem_ip_address *bindnet, struct totem_ip_address *boundto, int *interface_up, int *interface_num, int mask_high_bit)
int crypto_encrypt_and_sign(struct crypto_instance *instance, const unsigned char *buf_in, const size_t buf_in_len, unsigned char *buf_out, size_t *buf_out_len)
int totemudp_token_send(void *udp_context, const void *msg, unsigned int msg_len)
struct totem_interface * totem_interface
int totemudp_initialize(qb_loop_t *poll_handle, void **udp_context, struct totem_config *totem_config, totemsrp_stats_t *stats, int interface_no, void *context, void(*deliver_fn)(void *context, const void *msg, unsigned int msg_len), void(*iface_change_fn)(void *context, const struct totem_ip_address *iface_address), void(*target_set_completed)(void *context))
Create an instance.
qb_loop_t * totemudp_poll_handle
unsigned int my_memb_entries
struct totem_ip_address mcast_addr
void(* log_printf)(int level, int subsys, const char *function_name, const char *file_name, int file_line, const char *format,...) __attribute__((format(printf
int totemudp_finalize(void *udp_context)
struct totem_ip_address boundto
#define BIND_STATE_LOOPBACK
#define UDPIP_HEADER_SIZE
const char * totemudp_iface_print(void *udp_context)
#define NETIF_STATE_REPORT_UP
#define MCAST_SOCKET_BUFFER_SIZE
char iov_buffer_flush[FRAME_SIZE_MAX]
int totemudp_log_level_debug
int crypto_authenticate_and_decrypt(struct crypto_instance *instance, unsigned char *buf, int *buf_len)
int totemudp_log_level_notice
#define MESSAGE_TYPE_MEMB_JOIN
unsigned int broadcast_use
int totemudp_iface_get(void *udp_context, struct totem_ip_address *addr)
void(*) void udp_context)
#define LOGSYS_LEVEL_CRIT
int totemip_totemip_to_sockaddr_convert(struct totem_ip_address *ip_addr, uint16_t port, struct sockaddr_storage *saddr, int *addrlen)
struct totem_logging_configuration totem_logging_configuration
#define LOGSYS_PERROR(err_num, level, fmt, args...)
struct srp_addr system_from
#define log_printf(level, format, args...)
char * crypto_cipher_type
struct totem_ip_address my_id
void(* totemudp_deliver_fn)(void *context, const void *msg, unsigned int msg_len)
int totemudp_recv_mcast_empty(void *udp_context)
int totemudp_iface_check(void *udp_context)
struct totem_ip_address bindnet
uint32_t continuous_sendmsg_failures
struct totem_ip_address token_target
qb_loop_timer_handle timer_netif_check_timeout
void totemudp_buffer_release(void *ptr)
int totemudp_log_level_warning