|
|
@@ -0,0 +1,3322 @@
|
|
|
+int my_token_held = 0;
|
|
|
+int my_do_delivery = 0;
|
|
|
+unsigned long long token_ring_id_seq = 0;
|
|
|
+int log_digest = 0;
|
|
|
+int last_released = 0;
|
|
|
+int set_aru = -1;
|
|
|
+int totemsrp_brake;
|
|
|
+
|
|
|
+/*
|
|
|
+ * Copyright (c) 2003-2004 MontaVista Software, Inc.
|
|
|
+ *
|
|
|
+ * All rights reserved.
|
|
|
+ *
|
|
|
+ * Author: Steven Dake (sdake@mvista.com)
|
|
|
+ *
|
|
|
+ * This software licensed under BSD license, the text of which follows:
|
|
|
+ *
|
|
|
+ * Redistribution and use in source and binary forms, with or without
|
|
|
+ * modification, are permitted provided that the following conditions are met:
|
|
|
+ *
|
|
|
+ * - Redistributions of source code must retain the above copyright notice,
|
|
|
+ * this list of conditions and the following disclaimer.
|
|
|
+ * - Redistributions in binary form must reproduce the above copyright notice,
|
|
|
+ * this list of conditions and the following disclaimer in the documentation
|
|
|
+ * and/or other materials provided with the distribution.
|
|
|
+ * - Neither the name of the MontaVista Software, Inc. nor the names of its
|
|
|
+ * contributors may be used to endorse or promote products derived from this
|
|
|
+ * software without specific prior written permission.
|
|
|
+ *
|
|
|
+ * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
|
|
|
+ * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
|
|
+ * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
|
|
+ * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
|
|
|
+ * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
|
|
|
+ * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
|
|
|
+ * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
|
|
|
+ * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
|
|
|
+ * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
|
|
|
+ * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
|
|
|
+ * THE POSSIBILITY OF SUCH DAMAGE.
|
|
|
+ */
|
|
|
+
|
|
|
+/*
|
|
|
+ * The first version of this code was based upon Yair Amir's PhD thesis:
|
|
|
+ * http://www.cs.jhu.edu/~yairamir/phd.ps) (ch4,5).
|
|
|
+ *
|
|
|
+ * The current version of totemsrp implements the Totem protocol specified in:
|
|
|
+ * http://citeseer.ist.psu.edu/amir95totem.html
|
|
|
+ *
|
|
|
+ * The deviations from the above published protocols are:
|
|
|
+ * - encryption of message contents with SOBER128
|
|
|
+ * - authentication of meessage contents with SHA1/HMAC
|
|
|
+ * - token hold mode where token doesn't rotate on unused ring - reduces cpu
|
|
|
+ * usage on 1.6ghz xeon from 35% to less then .1 % as measured by top
|
|
|
+ */
|
|
|
+
|
|
|
+#include <assert.h>
|
|
|
+#include <sys/mman.h>
|
|
|
+#include <sys/types.h>
|
|
|
+#include <sys/stat.h>
|
|
|
+#include <sys/socket.h>
|
|
|
+#include <netdb.h>
|
|
|
+#include <sys/un.h>
|
|
|
+#include <sys/sysinfo.h>
|
|
|
+#include <sys/ioctl.h>
|
|
|
+#include <netinet/in.h>
|
|
|
+#include <arpa/inet.h>
|
|
|
+#include <linux/if.h>
|
|
|
+#include <linux/sockios.h>
|
|
|
+#include <unistd.h>
|
|
|
+#include <fcntl.h>
|
|
|
+#include <stdlib.h>
|
|
|
+#include <stdio.h>
|
|
|
+#include <errno.h>
|
|
|
+#include <signal.h>
|
|
|
+#include <sched.h>
|
|
|
+#include <time.h>
|
|
|
+#include <sys/time.h>
|
|
|
+#include <sys/poll.h>
|
|
|
+
|
|
|
+#include "aispoll.h"
|
|
|
+#include "totemsrp.h"
|
|
|
+#include "../include/queue.h"
|
|
|
+#include "../include/sq.h"
|
|
|
+#include "../include/list.h"
|
|
|
+#include "hdb.h"
|
|
|
+#include "swab.h"
|
|
|
+
|
|
|
+#include "crypto.h"
|
|
|
+#define AUTHENTICATION 1 /* use authentication */
|
|
|
+#define ENCRYPTION 1 /* use encryption */
|
|
|
+
|
|
|
+#define LOCALHOST_IP inet_addr("127.0.0.1")
|
|
|
+#define QUEUE_RTR_ITEMS_SIZE_MAX 2000 /* allow 512 retransmit items */
|
|
|
+#define NEW_MESSAGE_QUEUE_SIZE_MAX 2000 /* allow 500 messages to be queued */
|
|
|
+#define RETRANS_MESSAGE_QUEUE_SIZE_MAX 2000 /* allow 500 messages to be queued */
|
|
|
+#define RECEIVED_MESSAGE_QUEUE_SIZE_MAX 2000 /* allow 500 messages to be queued */
|
|
|
+#define MAXIOVS 5
|
|
|
+#define RETRANSMIT_ENTRIES_MAX 30
|
|
|
+#define MISSING_MCAST_WINDOW 128
|
|
|
+#define TIMEOUT_STATE_GATHER_JOIN 100
|
|
|
+#define TIMEOUT_STATE_GATHER_CONSENSUS 200
|
|
|
+#define TIMEOUT_TOKEN 1000
|
|
|
+#define TIMEOUT_TOKEN_RETRANSMIT 200
|
|
|
+#define MAX_MEMBERS 16
|
|
|
+#define PACKET_SIZE_MAX 2000
|
|
|
+#define FAIL_TO_RECV_CONST 250
|
|
|
+#define SEQNO_UNCHANGED_CONST 20
|
|
|
+
|
|
|
+/*
|
|
|
+ * we compare incoming messages to determine if their endian is
|
|
|
+ * different - if so convert them
|
|
|
+ *
|
|
|
+ * do not change
|
|
|
+ */
|
|
|
+#define ENDIAN_LOCAL 0xff22
|
|
|
+
|
|
|
+
|
|
|
+
|
|
|
+/*
|
|
|
+ * Authentication of messages
|
|
|
+ */
|
|
|
+hmac_state totemsrp_hmac_state;
|
|
|
+prng_state totemsrp_prng_state;
|
|
|
+
|
|
|
+unsigned char totemsrp_private_key[1024];
|
|
|
+unsigned int totemsrp_private_key_len;
|
|
|
+
|
|
|
+int stats_sent = 0;
|
|
|
+int stats_recv = 0;
|
|
|
+int stats_delv = 0;
|
|
|
+int stats_remcasts = 0;
|
|
|
+int stats_orf_token = 0;
|
|
|
+struct timeval stats_tv_start = { 0, 0 };
|
|
|
+
|
|
|
+/*
|
|
|
+ * Flow control mcasts and remcasts on last and current orf_token
|
|
|
+ */
|
|
|
+int fcc_remcast_last = 0;
|
|
|
+int fcc_mcast_last = 0;
|
|
|
+int fcc_mcast_current = 0;
|
|
|
+int fcc_remcast_current = 0;
|
|
|
+
|
|
|
+enum message_type {
|
|
|
+ MESSAGE_TYPE_ORF_TOKEN = 0, /* Ordering, Reliability, Flow (ORF) control Token */
|
|
|
+ MESSAGE_TYPE_MCAST = 1, /* ring ordered multicast message */
|
|
|
+ MESSAGE_TYPE_MEMB_JOIN = 2, /* membership join message */
|
|
|
+ MESSAGE_TYPE_MEMB_COMMIT_TOKEN = 3, /* membership commit token */
|
|
|
+};
|
|
|
+
|
|
|
+/*
|
|
|
+ * New membership algorithm local variables
|
|
|
+ */
|
|
|
+struct consensus_list_item {
|
|
|
+ struct in_addr addr;
|
|
|
+ int set;
|
|
|
+};
|
|
|
+
|
|
|
+static struct consensus_list_item consensus_list[MAX_MEMBERS];
|
|
|
+
|
|
|
+static int consensus_list_entries;
|
|
|
+
|
|
|
+static struct in_addr my_proc_list[MAX_MEMBERS];
|
|
|
+
|
|
|
+static struct in_addr my_failed_list[MAX_MEMBERS];
|
|
|
+
|
|
|
+static struct in_addr my_new_memb_list[MAX_MEMBERS];
|
|
|
+
|
|
|
+static struct in_addr my_trans_memb_list[MAX_MEMBERS];
|
|
|
+
|
|
|
+static struct in_addr my_memb_list[MAX_MEMBERS];
|
|
|
+
|
|
|
+static struct in_addr my_deliver_memb_list[MAX_MEMBERS];
|
|
|
+
|
|
|
+static int my_proc_list_entries = 0;
|
|
|
+
|
|
|
+static int my_failed_list_entries = 0;
|
|
|
+
|
|
|
+static int my_new_memb_entries = 0;
|
|
|
+
|
|
|
+static int my_trans_memb_entries = 0;
|
|
|
+
|
|
|
+static int my_memb_entries = 0;
|
|
|
+
|
|
|
+static int my_deliver_memb_entries = 0;
|
|
|
+
|
|
|
+static struct memb_ring_id my_ring_id;
|
|
|
+
|
|
|
+static int my_aru_count = 0;
|
|
|
+
|
|
|
+static int my_last_aru = 0;
|
|
|
+
|
|
|
+static int my_seq_unchanged = 0;
|
|
|
+
|
|
|
+static int my_received_flg = 1;
|
|
|
+
|
|
|
+static int my_high_seq_received;
|
|
|
+
|
|
|
+static int my_install_seq = 0;
|
|
|
+
|
|
|
+static int my_rotation_counter = 0;
|
|
|
+
|
|
|
+static int my_set_retrans_flg = 0;
|
|
|
+
|
|
|
+static int my_retrans_flg_count = 0;
|
|
|
+
|
|
|
+static unsigned int my_high_ring_delivered = 0;
|
|
|
+
|
|
|
+static unsigned int my_high_seq_delivered = 0;
|
|
|
+
|
|
|
+static unsigned int my_old_high_seq_delivered = 0;
|
|
|
+
|
|
|
+struct token_callback_instance {
|
|
|
+ struct list_head list;
|
|
|
+ int (*callback_fn) (enum totemsrp_callback_token_type type, void *);
|
|
|
+ enum totemsrp_callback_token_type callback_type;
|
|
|
+ int delete;
|
|
|
+ void *data;
|
|
|
+};
|
|
|
+
|
|
|
+/*
|
|
|
+ * Queues used to order, deliver, and recover messages
|
|
|
+ */
|
|
|
+struct queue new_message_queue;
|
|
|
+struct queue retrans_message_queue;
|
|
|
+struct sq regular_sort_queue;
|
|
|
+struct sq recovery_sort_queue;
|
|
|
+
|
|
|
+/*
|
|
|
+ * Multicast address
|
|
|
+ */
|
|
|
+struct sockaddr_in sockaddr_in_mcast;
|
|
|
+
|
|
|
+struct totemsrp_socket {
|
|
|
+ int mcast;
|
|
|
+ int token;
|
|
|
+};
|
|
|
+
|
|
|
+/*
|
|
|
+ * File descriptors in use by TOTEMSRP
|
|
|
+ */
|
|
|
+struct totemsrp_socket totemsrp_sockets[2];
|
|
|
+
|
|
|
+/*
|
|
|
+ * Received up to and including
|
|
|
+ */
|
|
|
+int my_aru = 0;
|
|
|
+
|
|
|
+int my_aru_save = 0;
|
|
|
+
|
|
|
+int my_high_seq_received_save = 0;
|
|
|
+
|
|
|
+DECLARE_LIST_INIT (token_callback_received_listhead);
|
|
|
+DECLARE_LIST_INIT (token_callback_sent_listhead);
|
|
|
+
|
|
|
+char orf_token_retransmit[15000]; // sizeof (struct orf_token) + sizeof (struct rtr_item) * RETRANSMIT_ENTRIES_MAX];
|
|
|
+
|
|
|
+int orf_token_retransmit_size;
|
|
|
+
|
|
|
+int my_token_seq = -1;
|
|
|
+
|
|
|
+/*
|
|
|
+ * Timers
|
|
|
+ */
|
|
|
+poll_timer_handle timer_orf_token_timeout = 0;
|
|
|
+
|
|
|
+poll_timer_handle timer_orf_token_retransmit_timeout = 0;
|
|
|
+
|
|
|
+poll_timer_handle memb_timer_state_gather_join_timeout = 0;
|
|
|
+
|
|
|
+poll_timer_handle memb_timer_state_gather_consensus_timeout = 0;
|
|
|
+
|
|
|
+poll_timer_handle memb_timer_state_commit_timeout = 0;
|
|
|
+
|
|
|
+/*
|
|
|
+ * Function called when new message received
|
|
|
+ */
|
|
|
+int (*totemsrp_recv) (char *group, struct iovec *iovec, int iov_len);
|
|
|
+
|
|
|
+/*
|
|
|
+ * Function and data used to log messages
|
|
|
+ */
|
|
|
+static void (*totemsrp_log_printf) (int level, char *format, ...);
|
|
|
+int totemsrp_log_level_security;
|
|
|
+int totemsrp_log_level_error;
|
|
|
+int totemsrp_log_level_warning;
|
|
|
+int totemsrp_log_level_notice;
|
|
|
+int totemsrp_log_level_debug;
|
|
|
+
|
|
|
+#define HMAC_HASH_SIZE 20
|
|
|
+struct security_header {
|
|
|
+ unsigned char hash_digest[HMAC_HASH_SIZE]; /* The hash *MUST* be first in the data structure */
|
|
|
+ unsigned char salt[16]; /* random number */
|
|
|
+} __attribute__((packed));
|
|
|
+
|
|
|
+struct message_header {
|
|
|
+ struct security_header security_header;
|
|
|
+ char type;
|
|
|
+ char encapsulated;
|
|
|
+// unsigned short filler;
|
|
|
+ unsigned short endian_detector;
|
|
|
+} __attribute__((packed));
|
|
|
+
|
|
|
+struct memb_ring_id {
|
|
|
+ struct in_addr rep;
|
|
|
+ unsigned long long seq;
|
|
|
+} __attribute__((packed));
|
|
|
+
|
|
|
+struct mcast {
|
|
|
+ struct message_header header;
|
|
|
+ int seq;
|
|
|
+ struct memb_ring_id ring_id;
|
|
|
+ struct in_addr source;
|
|
|
+ int guarantee;
|
|
|
+} __attribute__((packed));
|
|
|
+
|
|
|
+/*
|
|
|
+ * MTU - multicast message header - IP header - UDP header
|
|
|
+ *
|
|
|
+ * On lossy switches, making use of the DF UDP flag can lead to loss of
|
|
|
+ * forward progress. So the packets must be fragmented by a higher layer
|
|
|
+ *
|
|
|
+ * This layer can only handle packets of MTU size.
|
|
|
+ */
|
|
|
+#define FRAGMENT_SIZE (PACKET_SIZE_MAX - sizeof (struct mcast) - 20 - 8)
|
|
|
+
|
|
|
+struct rtr_item {
|
|
|
+ struct memb_ring_id ring_id;
|
|
|
+ int seq;
|
|
|
+}__attribute__((packed));
|
|
|
+
|
|
|
+struct orf_token {
|
|
|
+ struct message_header header;
|
|
|
+ int seq;
|
|
|
+ int token_seq;
|
|
|
+ int aru;
|
|
|
+ struct in_addr aru_addr;
|
|
|
+ struct memb_ring_id ring_id;
|
|
|
+ short int fcc;
|
|
|
+ int retrans_flg;
|
|
|
+ int rtr_list_entries;
|
|
|
+ struct rtr_item rtr_list[0];
|
|
|
+}__attribute__((packed));
|
|
|
+
|
|
|
+struct memb_join {
|
|
|
+ struct message_header header;
|
|
|
+ struct in_addr proc_list[MAX_MEMBERS];
|
|
|
+ int proc_list_entries;
|
|
|
+ struct in_addr failed_list[MAX_MEMBERS];
|
|
|
+ int failed_list_entries;
|
|
|
+ unsigned long long ring_seq;
|
|
|
+} __attribute__((packed));
|
|
|
+
|
|
|
+struct memb_commit_token_memb_entry {
|
|
|
+ struct memb_ring_id ring_id;
|
|
|
+ int aru;
|
|
|
+ int high_delivered;
|
|
|
+ int received_flg;
|
|
|
+}__attribute__((packed));
|
|
|
+
|
|
|
+struct memb_commit_token {
|
|
|
+ struct message_header header;
|
|
|
+ int token_seq;
|
|
|
+ struct memb_ring_id ring_id;
|
|
|
+ unsigned int retrans_flg;
|
|
|
+ int memb_index;
|
|
|
+ int addr_entries;
|
|
|
+ struct in_addr addr[MAX_MEMBERS];
|
|
|
+ struct memb_commit_token_memb_entry memb_list[MAX_MEMBERS];
|
|
|
+}__attribute__((packed));
|
|
|
+
|
|
|
+struct message_item {
|
|
|
+ struct mcast *mcast;
|
|
|
+ struct iovec iovec[MAXIOVS];
|
|
|
+ int iov_len;
|
|
|
+};
|
|
|
+
|
|
|
+struct sort_queue_item {
|
|
|
+ struct iovec iovec[MAXIOVS];
|
|
|
+ int iov_len;
|
|
|
+};
|
|
|
+
|
|
|
+enum memb_state {
|
|
|
+ MEMB_STATE_OPERATIONAL = 1,
|
|
|
+ MEMB_STATE_GATHER = 2,
|
|
|
+ MEMB_STATE_COMMIT = 3,
|
|
|
+ MEMB_STATE_RECOVERY = 4
|
|
|
+};
|
|
|
+
|
|
|
+static enum memb_state memb_state = MEMB_STATE_OPERATIONAL;
|
|
|
+
|
|
|
+static struct sockaddr_in my_id;
|
|
|
+
|
|
|
+struct sockaddr_in next_memb;
|
|
|
+
|
|
|
+static struct sockaddr_in memb_local_sockaddr_in;
|
|
|
+
|
|
|
+static char iov_buffer[15000]; //PACKET_SIZE_MAX];
|
|
|
+
|
|
|
+static struct iovec totemsrp_iov_recv = {
|
|
|
+ .iov_base = iov_buffer,
|
|
|
+ .iov_len = sizeof (iov_buffer)
|
|
|
+};
|
|
|
+
|
|
|
+static char iov_encrypted_buffer[15000]; //char orf_token_retransmit[15000]; // sizeof (struct orf_token) + sizeof (struct rtr_item) * RETRANSMIT_ENTRIES_MAX];
|
|
|
+
|
|
|
+static struct iovec iov_encrypted = {
|
|
|
+ .iov_base = iov_encrypted_buffer,
|
|
|
+ .iov_len = sizeof (iov_encrypted_buffer)
|
|
|
+};
|
|
|
+
|
|
|
+struct message_handlers {
|
|
|
+ int count;
|
|
|
+ int (*handler_functions[4]) (struct sockaddr_in *, struct iovec *, int, int, int);
|
|
|
+};
|
|
|
+
|
|
|
+poll_handle *totemsrp_poll_handle;
|
|
|
+
|
|
|
+void (*totemsrp_deliver_fn) (
|
|
|
+ struct in_addr source_addr,
|
|
|
+ struct iovec *iovec,
|
|
|
+ int iov_len,
|
|
|
+ int endian_conversion_required) = 0;
|
|
|
+
|
|
|
+void (*totemsrp_confchg_fn) (
|
|
|
+ enum totemsrp_configuration_type configuration_type,
|
|
|
+ struct in_addr *member_list, void *member_list_private,
|
|
|
+ int member_list_entries,
|
|
|
+ struct in_addr *left_list, void *left_list_private,
|
|
|
+ int left_list_entries,
|
|
|
+ struct in_addr *joined_list, void *joined_list_private,
|
|
|
+ int joined_list_entries) = 0;
|
|
|
+
|
|
|
+/*
|
|
|
+ * forward decls
|
|
|
+ */
|
|
|
+static int message_handler_orf_token (struct sockaddr_in *, struct iovec *, int, int, int);
|
|
|
+static int message_handler_mcast (struct sockaddr_in *, struct iovec *, int, int, int);
|
|
|
+
|
|
|
+static int message_handler_memb_join (struct sockaddr_in *, struct iovec *, int, int, int);
|
|
|
+
|
|
|
+static int message_handler_memb_commit_token (struct sockaddr_in *, struct iovec *, int, int, int);
|
|
|
+
|
|
|
+static void memb_ring_id_create_or_load (struct memb_ring_id *);
|
|
|
+static int recv_handler (poll_handle handle, int fd, int revents, void *data, unsigned int *prio);
|
|
|
+static int netif_determine (struct sockaddr_in *bindnet, struct sockaddr_in *bound_to);
|
|
|
+static int totemsrp_build_sockets (struct sockaddr_in *sockaddr_mcast,
|
|
|
+ struct sockaddr_in *sockaddr_bindnet,
|
|
|
+ struct totemsrp_socket *sockets,
|
|
|
+ struct sockaddr_in *bound_to);
|
|
|
+static void memb_state_gather_enter (void);
|
|
|
+static void messages_deliver_to_app (int skip, int *start_point, int end_point);
|
|
|
+static int orf_token_mcast (struct orf_token *oken,
|
|
|
+ int fcc_mcasts_allowed, struct sockaddr_in *system_from);
|
|
|
+static int messages_free (int token_aru);
|
|
|
+
|
|
|
+static void encrypt_and_sign (struct iovec *iovec, int iov_len);
|
|
|
+static int authenticate_and_decrypt (struct iovec *iov);
|
|
|
+static int recv_handler (poll_handle handle, int fd, int revents, void *data, unsigned int *prio);
|
|
|
+static void memb_ring_id_store (struct memb_commit_token *commit_token);
|
|
|
+static void memb_state_commit_token_update (struct memb_commit_token *memb_commit_token);
|
|
|
+static int memb_state_commit_token_send (struct memb_commit_token *memb_commit_token);
|
|
|
+static void memb_state_commit_token_create (struct memb_commit_token *commit_token);
|
|
|
+static void orf_token_endian_convert (struct orf_token *in, struct orf_token *out);
|
|
|
+static void memb_commit_token_endian_convert (struct memb_commit_token *in, struct memb_commit_token *out);
|
|
|
+static void memb_join_endian_convert (struct memb_join *in, struct memb_join *out);
|
|
|
+static void mcast_endian_convert (struct mcast *in, struct mcast *out);
|
|
|
+
|
|
|
+struct message_handlers totemsrp_message_handlers = {
|
|
|
+ 4,
|
|
|
+ {
|
|
|
+ message_handler_orf_token,
|
|
|
+ message_handler_mcast,
|
|
|
+ message_handler_memb_join,
|
|
|
+ message_handler_memb_commit_token
|
|
|
+ }
|
|
|
+};
|
|
|
+
|
|
|
+void totemsrp_log_printf_init (
|
|
|
+ void (*log_printf) (int , char *, ...),
|
|
|
+ int log_level_security,
|
|
|
+ int log_level_error,
|
|
|
+ int log_level_warning,
|
|
|
+ int log_level_notice,
|
|
|
+ int log_level_debug)
|
|
|
+{
|
|
|
+ totemsrp_log_level_security = log_level_security;
|
|
|
+ totemsrp_log_level_error = log_level_error;
|
|
|
+ totemsrp_log_level_warning = log_level_warning;
|
|
|
+ totemsrp_log_level_notice = log_level_notice;
|
|
|
+ totemsrp_log_level_debug = log_level_debug;
|
|
|
+ totemsrp_log_printf = log_printf;
|
|
|
+}
|
|
|
+
|
|
|
+void print_digest (char *where, unsigned char *digest)
|
|
|
+{
|
|
|
+ int i;
|
|
|
+
|
|
|
+ printf ("DIGEST %s:\n", where);
|
|
|
+ for (i = 0; i < 16; i++) {
|
|
|
+ printf ("%x ", digest[i]);
|
|
|
+ }
|
|
|
+ printf ("\n");
|
|
|
+}
|
|
|
+
|
|
|
+void print_msg (unsigned char *msg, int size)
|
|
|
+{
|
|
|
+ int i;
|
|
|
+ printf ("MSG CONTENTS START\n");
|
|
|
+ for (i = 0; i < size; i++) {
|
|
|
+ printf ("%x ", msg[i]);
|
|
|
+ if ((i % 16) == 15) {
|
|
|
+ printf ("\n");
|
|
|
+ }
|
|
|
+ }
|
|
|
+ printf ("MSG CONTENTS DONE\n");
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Exported interfaces
|
|
|
+ */
|
|
|
+int totemsrp_initialize (
|
|
|
+ struct sockaddr_in *sockaddr_mcast,
|
|
|
+ struct totemsrp_interface *interfaces,
|
|
|
+ int interface_count,
|
|
|
+ poll_handle *poll_handle,
|
|
|
+ unsigned char *private_key,
|
|
|
+ int private_key_len,
|
|
|
+ void *member_private,
|
|
|
+ int member_private_len,
|
|
|
+ void (*deliver_fn) (
|
|
|
+ struct in_addr source_addr,
|
|
|
+ struct iovec *iovec,
|
|
|
+ int iov_len,
|
|
|
+ int endian_conversion_required),
|
|
|
+ void (*confchg_fn) (
|
|
|
+ enum totemsrp_configuration_type configuration_type,
|
|
|
+ struct in_addr *member_list, void *member_list_private,
|
|
|
+ int member_list_entries,
|
|
|
+ struct in_addr *left_list, void *left_list_private,
|
|
|
+ int left_list_entries,
|
|
|
+ struct in_addr *joined_list, void *joined_list_private,
|
|
|
+ int joined_list_entries))
|
|
|
+{
|
|
|
+
|
|
|
+ int res;
|
|
|
+ int interface_no;
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Initialize random number generator for later use to generate salt
|
|
|
+ */
|
|
|
+ memcpy (totemsrp_private_key, private_key, private_key_len);
|
|
|
+
|
|
|
+ totemsrp_private_key_len = private_key_len;
|
|
|
+
|
|
|
+ rng_make_prng (128, PRNG_SOBER, &totemsrp_prng_state, NULL);
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Initialize local variables for totemsrp
|
|
|
+ */
|
|
|
+ memcpy (&sockaddr_in_mcast, sockaddr_mcast, sizeof (struct sockaddr_in));
|
|
|
+ memset (&next_memb, 0, sizeof (struct sockaddr_in));
|
|
|
+ memset (iov_buffer, 0, PACKET_SIZE_MAX);
|
|
|
+
|
|
|
+ queue_init (&new_message_queue, NEW_MESSAGE_QUEUE_SIZE_MAX,
|
|
|
+ sizeof (struct message_item));
|
|
|
+
|
|
|
+ queue_init (&retrans_message_queue, RETRANS_MESSAGE_QUEUE_SIZE_MAX,
|
|
|
+ sizeof (struct message_item));
|
|
|
+
|
|
|
+ sq_init (®ular_sort_queue,
|
|
|
+ QUEUE_RTR_ITEMS_SIZE_MAX, sizeof (struct sort_queue_item), 0);
|
|
|
+
|
|
|
+ sq_init (&recovery_sort_queue,
|
|
|
+ QUEUE_RTR_ITEMS_SIZE_MAX, sizeof (struct sort_queue_item), 0);
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Build sockets for every interface
|
|
|
+ */
|
|
|
+ for (interface_no = 0; interface_no < interface_count; interface_no++) {
|
|
|
+ /*
|
|
|
+ * Create and bind the multicast and unicast sockets
|
|
|
+ */
|
|
|
+ res = totemsrp_build_sockets (sockaddr_mcast,
|
|
|
+ &interfaces[interface_no].bindnet,
|
|
|
+ &totemsrp_sockets[interface_no],
|
|
|
+ &interfaces[interface_no].boundto);
|
|
|
+
|
|
|
+ if (res == -1) {
|
|
|
+ return (res);
|
|
|
+ }
|
|
|
+ totemsrp_poll_handle = poll_handle;
|
|
|
+
|
|
|
+ poll_dispatch_add (*totemsrp_poll_handle, totemsrp_sockets[interface_no].mcast,
|
|
|
+ POLLIN, 0, recv_handler, UINT_MAX);
|
|
|
+
|
|
|
+ poll_dispatch_add (*totemsrp_poll_handle, totemsrp_sockets[interface_no].token,
|
|
|
+ POLLIN, 0, recv_handler, UINT_MAX);
|
|
|
+ }
|
|
|
+
|
|
|
+ memcpy (&my_id, &interfaces->boundto, sizeof (struct sockaddr_in));
|
|
|
+
|
|
|
+ /*
|
|
|
+ * This stuff depends on totemsrp_build_sockets
|
|
|
+ */
|
|
|
+ my_memb_list[0].s_addr = interfaces->boundto.sin_addr.s_addr;
|
|
|
+
|
|
|
+ memb_ring_id_create_or_load (&my_ring_id);
|
|
|
+ totemsrp_log_printf (totemsrp_log_level_notice, "Created or loaded sequence id %lld.%s for this ring.\n",
|
|
|
+ my_ring_id.seq, inet_ntoa (my_ring_id.rep));
|
|
|
+
|
|
|
+ memb_state_gather_enter ();
|
|
|
+
|
|
|
+ totemsrp_deliver_fn = deliver_fn;
|
|
|
+
|
|
|
+ totemsrp_confchg_fn = confchg_fn;
|
|
|
+
|
|
|
+ return (0);
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Set operations for use by the membership algorithm
|
|
|
+ */
|
|
|
+static void memb_consensus_reset (void)
|
|
|
+{
|
|
|
+ consensus_list_entries = 0;
|
|
|
+}
|
|
|
+
|
|
|
+void
|
|
|
+memb_set_subtract (struct in_addr *out_list, int *out_list_entries,
|
|
|
+ struct in_addr *one_list, int one_list_entries,
|
|
|
+ struct in_addr *two_list, int two_list_entries)
|
|
|
+{
|
|
|
+ int found = 0;
|
|
|
+ int i;
|
|
|
+ int j;
|
|
|
+
|
|
|
+ *out_list_entries = 0;
|
|
|
+
|
|
|
+ for (i = 0; i < one_list_entries; i++) {
|
|
|
+ for (j = 0; j < two_list_entries; j++) {
|
|
|
+ if (one_list[i].s_addr == two_list[j].s_addr) {
|
|
|
+ found = 1;
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ if (found == 0) {
|
|
|
+ out_list[*out_list_entries].s_addr = one_list[i].s_addr;
|
|
|
+ *out_list_entries = *out_list_entries + 1;
|
|
|
+ }
|
|
|
+ found = 0;
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Set consensus for a specific processor
|
|
|
+ */
|
|
|
+static void memb_consensus_set (struct in_addr *addr)
|
|
|
+{
|
|
|
+ int found = 0;
|
|
|
+ int i;
|
|
|
+
|
|
|
+ for (i = 0; i < consensus_list_entries; i++) {
|
|
|
+ if (addr->s_addr == consensus_list[i].addr.s_addr) {
|
|
|
+ found = 1;
|
|
|
+ break; /* found entry */
|
|
|
+ }
|
|
|
+ }
|
|
|
+ consensus_list[i].addr.s_addr = addr->s_addr;
|
|
|
+ consensus_list[i].set = 1;
|
|
|
+ if (found == 0) {
|
|
|
+ consensus_list_entries++;
|
|
|
+ }
|
|
|
+ return;
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Is consensus set for a specific processor
|
|
|
+ */
|
|
|
+static int memb_consensus_isset (struct in_addr *addr)
|
|
|
+{
|
|
|
+ int i;
|
|
|
+
|
|
|
+ for (i = 0; i < consensus_list_entries; i++) {
|
|
|
+ if (addr->s_addr == consensus_list[i].addr.s_addr) {
|
|
|
+ return (consensus_list[i].set);
|
|
|
+ }
|
|
|
+ }
|
|
|
+ return (0);
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Is consensus agreed upon based upon consensus database
|
|
|
+ */
|
|
|
+static int memb_consensus_agreed (void)
|
|
|
+{
|
|
|
+ struct in_addr token_memb[MAX_MEMBERS];
|
|
|
+ int token_memb_entries = 0;
|
|
|
+ int agreed = 1;
|
|
|
+ int i;
|
|
|
+
|
|
|
+ memb_set_subtract (token_memb, &token_memb_entries,
|
|
|
+ my_proc_list, my_proc_list_entries,
|
|
|
+ my_failed_list, my_failed_list_entries);
|
|
|
+
|
|
|
+ for (i = 0; i < token_memb_entries; i++) {
|
|
|
+ if (memb_consensus_isset (&token_memb[i]) == 0) {
|
|
|
+ agreed = 0;
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ return (agreed);
|
|
|
+}
|
|
|
+
|
|
|
+void memb_consensus_notset (struct in_addr *no_consensus_list,
|
|
|
+ int *no_consensus_list_entries,
|
|
|
+ struct in_addr *comparison_list,
|
|
|
+ int comparison_list_entries)
|
|
|
+{
|
|
|
+ int i;
|
|
|
+
|
|
|
+ *no_consensus_list_entries = 0;
|
|
|
+
|
|
|
+ for (i = 0; i < my_proc_list_entries; i++) {
|
|
|
+ if (memb_consensus_isset (&my_proc_list[i]) == 0) {
|
|
|
+ no_consensus_list[*no_consensus_list_entries].s_addr = my_proc_list[i].s_addr;
|
|
|
+ *no_consensus_list_entries = *no_consensus_list_entries + 1;
|
|
|
+ }
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Is set1 equal to set2 Entries can be in different orders
|
|
|
+ */
|
|
|
+int memb_set_equal (struct in_addr *set1, int set1_entries,
|
|
|
+ struct in_addr *set2, int set2_entries)
|
|
|
+{
|
|
|
+ int i;
|
|
|
+ int j;
|
|
|
+
|
|
|
+ int found = 0;
|
|
|
+
|
|
|
+ if (set1_entries != set2_entries) {
|
|
|
+ return (0);
|
|
|
+ }
|
|
|
+ for (i = 0; i < set2_entries; i++) {
|
|
|
+ for (j = 0; j < set1_entries; j++) {
|
|
|
+ if (set1[j].s_addr == set2[i].s_addr) {
|
|
|
+ found = 1;
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ if (found == 0) {
|
|
|
+ return (0);
|
|
|
+ }
|
|
|
+ found = 0;
|
|
|
+ }
|
|
|
+ return (1);
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Is subset fully contained in fullset
|
|
|
+ */
|
|
|
+int memb_set_subset (struct in_addr *subset, int subset_entries,
|
|
|
+ struct in_addr *fullset, int fullset_entries)
|
|
|
+{
|
|
|
+ int i;
|
|
|
+ int j;
|
|
|
+ int found = 0;
|
|
|
+
|
|
|
+ if (subset_entries > fullset_entries) {
|
|
|
+ return (0);
|
|
|
+ }
|
|
|
+ for (i = 0; i < subset_entries; i++) {
|
|
|
+ for (j = 0; j < fullset_entries; j++) {
|
|
|
+ if (subset[i].s_addr == fullset[j].s_addr) {
|
|
|
+ found = 1;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ if (found == 0) {
|
|
|
+ return (0);
|
|
|
+ }
|
|
|
+ found = 1;
|
|
|
+ }
|
|
|
+ return (1);
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * merge subset into fullset taking care not to add duplicates
|
|
|
+ */
|
|
|
+void memb_set_merge (struct in_addr *subset, int subset_entries,
|
|
|
+ struct in_addr *fullset, int *fullset_entries)
|
|
|
+{
|
|
|
+ int found = 0;
|
|
|
+ int i;
|
|
|
+ int j;
|
|
|
+
|
|
|
+ for (i = 0; i < subset_entries; i++) {
|
|
|
+ for (j = 0; j < *fullset_entries; j++) {
|
|
|
+ if (fullset[j].s_addr == subset[i].s_addr) {
|
|
|
+ found = 1;
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ if (found == 0) {
|
|
|
+ fullset[j].s_addr = subset[i].s_addr;
|
|
|
+ *fullset_entries = *fullset_entries + 1;
|
|
|
+ }
|
|
|
+ found = 0;
|
|
|
+ }
|
|
|
+ return;
|
|
|
+}
|
|
|
+
|
|
|
+void memb_set_and (struct in_addr *set1, int set1_entries,
|
|
|
+ struct in_addr *set2, int set2_entries,
|
|
|
+ struct in_addr *and, int *and_entries)
|
|
|
+{
|
|
|
+ int i;
|
|
|
+ int j;
|
|
|
+ int found = 0;
|
|
|
+
|
|
|
+ *and_entries = 0;
|
|
|
+
|
|
|
+ for (i = 0; i < set2_entries; i++) {
|
|
|
+ for (j = 0; j < set1_entries; j++) {
|
|
|
+ if (set1[j].s_addr == set2[i].s_addr) {
|
|
|
+ found = 1;
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ if (found) {
|
|
|
+ and[*and_entries].s_addr = set1[j].s_addr;
|
|
|
+ *and_entries = *and_entries + 1;
|
|
|
+ }
|
|
|
+ found = 0;
|
|
|
+ }
|
|
|
+ return;
|
|
|
+}
|
|
|
+
|
|
|
+void memb_set_print (char *string,
|
|
|
+ struct in_addr *list, int list_entries)
|
|
|
+{
|
|
|
+ int i;
|
|
|
+ printf ("List '%s' contains %d entries:\n", string, list_entries);
|
|
|
+
|
|
|
+ for (i = 0; i < list_entries; i++) {
|
|
|
+ printf ("addr %s\n", inet_ntoa (list[i]));
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+static void timer_function_orf_token_timeout (void *data);
|
|
|
+static void timer_function_token_retransmit_timeout (void *data);
|
|
|
+
|
|
|
+void reset_token_retransmit_timeout (void) {
|
|
|
+ poll_timer_delete (*totemsrp_poll_handle,
|
|
|
+ timer_orf_token_retransmit_timeout);
|
|
|
+ poll_timer_add (*totemsrp_poll_handle, TIMEOUT_TOKEN_RETRANSMIT, 0,
|
|
|
+ timer_function_token_retransmit_timeout,
|
|
|
+ &timer_orf_token_retransmit_timeout);
|
|
|
+
|
|
|
+}
|
|
|
+
|
|
|
+void reset_token_timeout (void) {
|
|
|
+ poll_timer_delete (*totemsrp_poll_handle, timer_orf_token_timeout);
|
|
|
+ poll_timer_add (*totemsrp_poll_handle, TIMEOUT_TOKEN, (void *)9999,
|
|
|
+ timer_function_orf_token_timeout, &timer_orf_token_timeout);
|
|
|
+}
|
|
|
+
|
|
|
+void cancel_token_timeout (void) {
|
|
|
+ poll_timer_delete (*totemsrp_poll_handle, timer_orf_token_timeout);
|
|
|
+}
|
|
|
+
|
|
|
+void cancel_token_retransmit_timeout (void) {
|
|
|
+ poll_timer_delete (*totemsrp_poll_handle, timer_orf_token_retransmit_timeout);
|
|
|
+}
|
|
|
+
|
|
|
+static void memb_state_consensus_timeout_expired (void)
|
|
|
+{
|
|
|
+ struct in_addr no_consensus_list[MAX_MEMBERS];
|
|
|
+ int no_consensus_list_entries;
|
|
|
+
|
|
|
+ if (memb_consensus_agreed ()) {
|
|
|
+ memb_consensus_reset ();
|
|
|
+
|
|
|
+ memb_consensus_set (&my_id.sin_addr);
|
|
|
+
|
|
|
+ reset_token_timeout (); // REVIEWED
|
|
|
+ } else {
|
|
|
+ memb_consensus_notset (no_consensus_list,
|
|
|
+ &no_consensus_list_entries,
|
|
|
+ my_proc_list, my_proc_list_entries);
|
|
|
+
|
|
|
+ memb_set_merge (no_consensus_list, no_consensus_list_entries,
|
|
|
+ my_failed_list, &my_failed_list_entries);
|
|
|
+
|
|
|
+ memb_state_gather_enter ();
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+static int memb_join_message_send (void);
|
|
|
+
|
|
|
+/*
|
|
|
+ * Timers used for various states of the membership algorithm
|
|
|
+ */
|
|
|
+static void timer_function_orf_token_timeout (void *data)
|
|
|
+{
|
|
|
+ totemsrp_log_printf (totemsrp_log_level_notice,
|
|
|
+ "The token was lost in state %d from timer %x\n", memb_state, data);
|
|
|
+ switch (memb_state) {
|
|
|
+ case MEMB_STATE_OPERATIONAL:
|
|
|
+ memb_state_gather_enter ();
|
|
|
+ break;
|
|
|
+
|
|
|
+ case MEMB_STATE_GATHER:
|
|
|
+ memb_state_consensus_timeout_expired ();
|
|
|
+ memb_state_gather_enter ();
|
|
|
+ break;
|
|
|
+
|
|
|
+ case MEMB_STATE_COMMIT:
|
|
|
+ memb_state_gather_enter ();
|
|
|
+ break;
|
|
|
+
|
|
|
+ case MEMB_STATE_RECOVERY:
|
|
|
+printf ("setting my_aru %d to %d\n", my_aru, my_aru_save);
|
|
|
+ my_aru = my_aru_save;
|
|
|
+ my_high_seq_received = my_high_seq_received_save;
|
|
|
+ sq_reinit (&recovery_sort_queue, 0);
|
|
|
+ queue_reinit (&retrans_message_queue);
|
|
|
+ // TODO calculate current old ring aru
|
|
|
+ memb_state_gather_enter();
|
|
|
+ break;
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+static void memb_timer_function_state_gather (void *data)
|
|
|
+{
|
|
|
+ switch (memb_state) {
|
|
|
+ case MEMB_STATE_OPERATIONAL:
|
|
|
+ case MEMB_STATE_RECOVERY:
|
|
|
+ assert (0); /* this should never happen */
|
|
|
+ break;
|
|
|
+ case MEMB_STATE_GATHER:
|
|
|
+ case MEMB_STATE_COMMIT:
|
|
|
+ memb_join_message_send ();
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Restart the join timeout
|
|
|
+ `*/
|
|
|
+ poll_timer_delete (*totemsrp_poll_handle, memb_timer_state_gather_join_timeout);
|
|
|
+
|
|
|
+ poll_timer_add (*totemsrp_poll_handle, TIMEOUT_STATE_GATHER_JOIN, 0,
|
|
|
+ memb_timer_function_state_gather, &memb_timer_state_gather_join_timeout);
|
|
|
+ break;
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+static void memb_timer_function_gather_consensus_timeout (void *data)
|
|
|
+{
|
|
|
+ memb_state_consensus_timeout_expired ();
|
|
|
+}
|
|
|
+
|
|
|
+void deliver_messages_from_recovery_to_regular (void)
|
|
|
+{
|
|
|
+ int i;
|
|
|
+ struct sort_queue_item *recovery_message_item;
|
|
|
+ struct sort_queue_item regular_message_item;
|
|
|
+ int res;
|
|
|
+ void *ptr;
|
|
|
+ struct mcast *mcast;
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Move messages from recovery to regular sort queue
|
|
|
+ */
|
|
|
+ for (i = 1; i <= my_aru; i++) {
|
|
|
+ res = sq_item_get (&recovery_sort_queue, i, &ptr);
|
|
|
+ if (res != 0) {
|
|
|
+printf ("item not present in recovery sort queue\n");
|
|
|
+ continue;
|
|
|
+ }
|
|
|
+ recovery_message_item = (struct sort_queue_item *)ptr;
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Convert recovery message into regular message
|
|
|
+ */
|
|
|
+ if (recovery_message_item->iov_len > 1) {
|
|
|
+ mcast = recovery_message_item->iovec[1].iov_base;
|
|
|
+ memcpy (®ular_message_item.iovec[0],
|
|
|
+ &recovery_message_item->iovec[1],
|
|
|
+ sizeof (struct iovec) * recovery_message_item->iov_len);
|
|
|
+ } else {
|
|
|
+ regular_message_item.iovec[0].iov_base =
|
|
|
+ recovery_message_item->iovec[0].iov_base + sizeof (struct mcast);
|
|
|
+ regular_message_item.iovec[0].iov_len =
|
|
|
+ recovery_message_item->iovec[0].iov_len - sizeof (struct mcast);
|
|
|
+ mcast = regular_message_item.iovec[0].iov_base;
|
|
|
+ }
|
|
|
+ regular_message_item.iov_len = recovery_message_item->iov_len;
|
|
|
+
|
|
|
+ res = sq_item_inuse (®ular_sort_queue, mcast->seq);
|
|
|
+ if (res == 0) {
|
|
|
+ sq_item_add (®ular_sort_queue,
|
|
|
+ ®ular_message_item, mcast->seq);
|
|
|
+ }
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Change states in the state machine of the membership algorithm
|
|
|
+ */
|
|
|
+static void memb_state_operational_enter (void)
|
|
|
+{
|
|
|
+ my_failed_list_entries = 0;
|
|
|
+ struct in_addr joined_list[MAX_MEMBERS];
|
|
|
+ int joined_list_entries = 0;
|
|
|
+ struct in_addr left_list[MAX_MEMBERS];
|
|
|
+ int left_list_entries = 0;
|
|
|
+
|
|
|
+ deliver_messages_from_recovery_to_regular ();
|
|
|
+
|
|
|
+ messages_deliver_to_app (0, &my_old_high_seq_delivered, my_high_ring_delivered);
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Calculate joined and left list
|
|
|
+ */
|
|
|
+ memb_set_subtract (left_list, &left_list_entries,
|
|
|
+ my_memb_list, my_memb_entries,
|
|
|
+ my_trans_memb_list, my_trans_memb_entries);
|
|
|
+
|
|
|
+ memb_set_subtract (joined_list, &joined_list_entries,
|
|
|
+ my_new_memb_list, my_new_memb_entries,
|
|
|
+ my_trans_memb_list, my_trans_memb_entries);
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Deliver transitional configuration to application
|
|
|
+ */
|
|
|
+ totemsrp_confchg_fn (TOTEMSRP_CONFIGURATION_TRANSITIONAL,
|
|
|
+ my_trans_memb_list, 0, my_trans_memb_entries,
|
|
|
+ left_list, 0, left_list_entries,
|
|
|
+ 0, 0, 0);
|
|
|
+
|
|
|
+// TODO we need to filter to ensure we only deliver those
|
|
|
+// messages which are part of my_deliver_memb
|
|
|
+ messages_deliver_to_app (1, &my_old_high_seq_delivered, my_high_ring_delivered);
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Deliver regular configuration to application
|
|
|
+ */
|
|
|
+ totemsrp_confchg_fn (TOTEMSRP_CONFIGURATION_REGULAR,
|
|
|
+ my_new_memb_list, 0, my_new_memb_entries,
|
|
|
+ 0, 0, 0,
|
|
|
+ joined_list, 0, joined_list_entries);
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Install new membership
|
|
|
+ */
|
|
|
+ my_memb_entries = my_new_memb_entries;
|
|
|
+ memcpy (my_memb_list, my_new_memb_list,
|
|
|
+ sizeof (struct in_addr) * my_memb_entries);
|
|
|
+ last_released = my_aru;
|
|
|
+ my_set_retrans_flg = 0;
|
|
|
+ sq_reinit (®ular_sort_queue, my_aru);
|
|
|
+ sq_reinit (&recovery_sort_queue, 0);
|
|
|
+ my_high_seq_delivered = my_aru;
|
|
|
+ my_aru_save = my_aru;
|
|
|
+ my_high_seq_received_save = my_aru;
|
|
|
+ my_last_aru = 0;
|
|
|
+// TODO the recovery messages are leaked
|
|
|
+
|
|
|
+ totemsrp_log_printf (totemsrp_log_level_notice, "entering OPERATIONAL state.\n");
|
|
|
+ memb_state = MEMB_STATE_OPERATIONAL;
|
|
|
+ return;
|
|
|
+}
|
|
|
+
|
|
|
+static void memb_state_gather_enter (void)
|
|
|
+{
|
|
|
+// TODO this isn't part of spec but i think its needed
|
|
|
+ memb_set_merge (&my_id.sin_addr, 1,
|
|
|
+ my_proc_list, &my_proc_list_entries);
|
|
|
+
|
|
|
+ memb_join_message_send ();
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Restart the join timeout
|
|
|
+ */
|
|
|
+ poll_timer_delete (*totemsrp_poll_handle, memb_timer_state_gather_join_timeout);
|
|
|
+
|
|
|
+ poll_timer_add (*totemsrp_poll_handle, TIMEOUT_STATE_GATHER_JOIN, 0,
|
|
|
+ memb_timer_function_state_gather, &memb_timer_state_gather_join_timeout);
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Restart the consensus timeout
|
|
|
+ */
|
|
|
+ poll_timer_delete (*totemsrp_poll_handle,
|
|
|
+ memb_timer_state_gather_consensus_timeout);
|
|
|
+
|
|
|
+ poll_timer_add (*totemsrp_poll_handle, TIMEOUT_STATE_GATHER_CONSENSUS, 0,
|
|
|
+ memb_timer_function_gather_consensus_timeout,
|
|
|
+ &memb_timer_state_gather_consensus_timeout);
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Cancel the token loss and token retransmission timeouts
|
|
|
+ */
|
|
|
+ cancel_token_retransmit_timeout (); // REVIEWED
|
|
|
+ cancel_token_timeout (); // REVIEWED
|
|
|
+
|
|
|
+ memb_consensus_reset ();
|
|
|
+
|
|
|
+ memb_consensus_set (&my_id.sin_addr);
|
|
|
+
|
|
|
+ totemsrp_log_printf (totemsrp_log_level_notice, "entering GATHER state.\n");
|
|
|
+
|
|
|
+ memb_state = MEMB_STATE_GATHER;
|
|
|
+
|
|
|
+ return;
|
|
|
+}
|
|
|
+
|
|
|
+void timer_function_token_retransmit_timeout (void *data);
|
|
|
+
|
|
|
+static void memb_state_commit_enter (struct memb_commit_token *commit_token)
|
|
|
+{
|
|
|
+
|
|
|
+ memb_state_commit_token_update (commit_token);
|
|
|
+
|
|
|
+ memb_state_commit_token_send (commit_token);
|
|
|
+
|
|
|
+ memb_ring_id_store (commit_token);
|
|
|
+
|
|
|
+ poll_timer_delete (*totemsrp_poll_handle, memb_timer_state_gather_join_timeout);
|
|
|
+
|
|
|
+ memb_timer_state_gather_join_timeout = 0;
|
|
|
+
|
|
|
+ poll_timer_delete (*totemsrp_poll_handle, memb_timer_state_gather_consensus_timeout);
|
|
|
+
|
|
|
+ memb_timer_state_gather_consensus_timeout = 0;
|
|
|
+
|
|
|
+ reset_token_timeout (); // REVIEWED
|
|
|
+ reset_token_retransmit_timeout (); // REVIEWED
|
|
|
+
|
|
|
+ totemsrp_log_printf (totemsrp_log_level_notice, "entering COMMIT state.\n");
|
|
|
+
|
|
|
+ memb_state = MEMB_STATE_COMMIT;
|
|
|
+
|
|
|
+ return;
|
|
|
+}
|
|
|
+
|
|
|
+void memb_state_recovery_enter (struct memb_commit_token *commit_token)
|
|
|
+{
|
|
|
+ int i;
|
|
|
+ unsigned int low_ring_aru = 0xFFFFFFFF;
|
|
|
+ int local_received_flg = 1;
|
|
|
+
|
|
|
+ my_high_ring_delivered = 0;
|
|
|
+ int copy_min;
|
|
|
+ int copy_max;
|
|
|
+
|
|
|
+ memb_state_commit_token_send (commit_token);
|
|
|
+
|
|
|
+my_token_seq = -1;
|
|
|
+ /*
|
|
|
+ * Build regular configuration
|
|
|
+ */
|
|
|
+ my_new_memb_entries = commit_token->addr_entries;
|
|
|
+
|
|
|
+ memcpy (my_new_memb_list, commit_token->addr,
|
|
|
+ sizeof (struct in_addr) * my_new_memb_entries);
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Build transitional configuration
|
|
|
+ */
|
|
|
+ memb_set_and (my_new_memb_list, my_new_memb_entries,
|
|
|
+ my_memb_list, my_memb_entries,
|
|
|
+ my_trans_memb_list, &my_trans_memb_entries);
|
|
|
+
|
|
|
+ for (i = 0; i < my_new_memb_entries; i++) {
|
|
|
+ printf ("position [%d] member %s:\n", i, inet_ntoa (commit_token->addr[i]));
|
|
|
+ printf ("previous ring seq %lld rep %s\n",
|
|
|
+ commit_token->memb_list[i].ring_id.seq,
|
|
|
+ inet_ntoa (commit_token->memb_list[i].ring_id.rep));
|
|
|
+//assert (commit_token->memb_list[i].ring_id.rep.s_addr);
|
|
|
+ printf ("aru %d high delivered %d received flag %d\n",
|
|
|
+ commit_token->memb_list[i].aru,
|
|
|
+ commit_token->memb_list[i].high_delivered,
|
|
|
+ commit_token->memb_list[i].received_flg);
|
|
|
+assert (commit_token->memb_list[i].ring_id.rep.s_addr);
|
|
|
+ }
|
|
|
+ /*
|
|
|
+ * Determine if any received flag is false
|
|
|
+ */
|
|
|
+ for (i = 0; i < commit_token->addr_entries; i++) {
|
|
|
+ if (memb_set_subset (&my_new_memb_list[i], 1,
|
|
|
+ my_trans_memb_list, my_trans_memb_entries) &&
|
|
|
+
|
|
|
+ commit_token->memb_list[i].received_flg == 0) {
|
|
|
+ my_deliver_memb_entries = my_trans_memb_entries;
|
|
|
+ memcpy (my_deliver_memb_list, my_trans_memb_list,
|
|
|
+ sizeof (struct in_addr) * my_trans_memb_entries);
|
|
|
+ local_received_flg = 0;
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ if (local_received_flg == 0) {
|
|
|
+ /*
|
|
|
+ * Calculate low ring_aru, my_high_ring_delivered for the transitional membership
|
|
|
+ */
|
|
|
+ for (i = 0; i < commit_token->addr_entries; i++) {
|
|
|
+ if (memb_set_subset (&my_new_memb_list[i], 1,
|
|
|
+ my_deliver_memb_list, my_deliver_memb_entries)) {
|
|
|
+
|
|
|
+ if (low_ring_aru > commit_token->memb_list[i].aru) {
|
|
|
+ low_ring_aru = commit_token->memb_list[i].aru;
|
|
|
+ }
|
|
|
+ if (my_high_ring_delivered < commit_token->memb_list[i].high_delivered) {
|
|
|
+ my_high_ring_delivered = commit_token->memb_list[i].high_delivered;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ }
|
|
|
+ /*
|
|
|
+ * Copy all old ring messages to retrans_message_queue
|
|
|
+ */
|
|
|
+{ int j = 0;
|
|
|
+ // TODO this shouldn't be needed
|
|
|
+ copy_min = low_ring_aru;
|
|
|
+ if ((last_released - 1) > copy_min) {
|
|
|
+ copy_min = (last_released - 1);
|
|
|
+ }
|
|
|
+
|
|
|
+ copy_max = my_high_ring_delivered;
|
|
|
+ if (copy_max > my_high_seq_received) {
|
|
|
+ copy_max = my_high_seq_received;
|
|
|
+ }
|
|
|
+ totemsrp_log_printf (totemsrp_log_level_notice,
|
|
|
+ "copying all old messages from %d to %d, range %d-%d.\n",
|
|
|
+ low_ring_aru, my_high_ring_delivered, copy_min, copy_max);
|
|
|
+ for (i = copy_min + 1; i <= copy_max; i++) {
|
|
|
+
|
|
|
+ struct sort_queue_item *sort_queue_item;
|
|
|
+ struct message_item message_item;
|
|
|
+ void *ptr;
|
|
|
+ int res;
|
|
|
+
|
|
|
+ res = sq_item_get (®ular_sort_queue, i, &ptr);
|
|
|
+ if (res != 0) {
|
|
|
+ continue;
|
|
|
+ }
|
|
|
+j++;
|
|
|
+ sort_queue_item = ptr;
|
|
|
+ memset (&message_item, 0, sizeof (struct message_item));
|
|
|
+ message_item.mcast = malloc (sizeof (struct mcast));
|
|
|
+ assert (message_item.mcast);
|
|
|
+ memcpy (message_item.mcast, sort_queue_item->iovec[0].iov_base,
|
|
|
+ sizeof (struct mcast));
|
|
|
+ message_item.iov_len = sort_queue_item->iov_len;
|
|
|
+ message_item.iov_len = sort_queue_item->iov_len;
|
|
|
+ memcpy (&message_item.iovec, &sort_queue_item->iovec, sizeof (struct iovec) *
|
|
|
+ sort_queue_item->iov_len);
|
|
|
+ queue_item_add (&retrans_message_queue, &message_item);
|
|
|
+ }
|
|
|
+ totemsrp_log_printf (totemsrp_log_level_notice,
|
|
|
+ "Originated %d messages in RECOVERY.\n", j);
|
|
|
+}
|
|
|
+ }
|
|
|
+
|
|
|
+ my_aru_save = my_aru;
|
|
|
+ my_high_seq_received_save = my_high_seq_received;
|
|
|
+
|
|
|
+ my_aru = 0;
|
|
|
+ my_aru_count = 0;
|
|
|
+ my_seq_unchanged = 0;
|
|
|
+ my_high_seq_received = 0;
|
|
|
+ my_install_seq = 0;
|
|
|
+ my_old_high_seq_delivered = my_high_seq_delivered;
|
|
|
+
|
|
|
+ totemsrp_log_printf (totemsrp_log_level_notice, "entering RECOVERY state.\n");
|
|
|
+ reset_token_timeout (); // REVIEWED
|
|
|
+ reset_token_retransmit_timeout (); // REVIEWED
|
|
|
+
|
|
|
+
|
|
|
+ memb_state = MEMB_STATE_RECOVERY;
|
|
|
+ return;
|
|
|
+}
|
|
|
+
|
|
|
+static void encrypt_and_sign (struct iovec *iovec, int iov_len)
|
|
|
+{
|
|
|
+ char *addr = iov_encrypted.iov_base + sizeof (struct security_header);
|
|
|
+ int i;
|
|
|
+ char keys[48];
|
|
|
+ struct security_header *header = iov_encrypted.iov_base;
|
|
|
+ prng_state keygen_prng_state;
|
|
|
+ prng_state stream_prng_state;
|
|
|
+ char *hmac_key = &keys[32];
|
|
|
+ char *cipher_key = &keys[16];
|
|
|
+ char *initial_vector = &keys[0];
|
|
|
+ unsigned long len;
|
|
|
+
|
|
|
+ iov_encrypted.iov_len = 0;
|
|
|
+
|
|
|
+ memset (keys, 0, sizeof (keys));
|
|
|
+ memset (header->salt, 0, sizeof (header->salt));
|
|
|
+
|
|
|
+#if (defined(ENCRYPTION) || defined(AUTHENITCATION))
|
|
|
+ /*
|
|
|
+ * Generate MAC, CIPHER, IV keys from private key
|
|
|
+ */
|
|
|
+ sober128_read (header->salt, sizeof (header->salt), &totemsrp_prng_state);
|
|
|
+ sober128_start (&keygen_prng_state);
|
|
|
+ sober128_add_entropy (totemsrp_private_key, totemsrp_private_key_len, &keygen_prng_state);
|
|
|
+ sober128_add_entropy (header->salt, sizeof (header->salt), &keygen_prng_state);
|
|
|
+
|
|
|
+ sober128_read (keys, sizeof (keys), &keygen_prng_state);
|
|
|
+#endif
|
|
|
+
|
|
|
+#ifdef ENCRYPTION
|
|
|
+ /*
|
|
|
+ * Setup stream cipher
|
|
|
+ */
|
|
|
+ sober128_start (&stream_prng_state);
|
|
|
+ sober128_add_entropy (cipher_key, 16, &stream_prng_state);
|
|
|
+ sober128_add_entropy (initial_vector, 16, &stream_prng_state);
|
|
|
+#endif
|
|
|
+
|
|
|
+if (log_digest) {
|
|
|
+printf ("new encryption\n");
|
|
|
+print_digest ("salt", header->salt);
|
|
|
+print_digest ("initial_vector", initial_vector);
|
|
|
+print_digest ("cipher_key", cipher_key);
|
|
|
+print_digest ("hmac_key", hmac_key);
|
|
|
+}
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Copy header of message, then remainder of message, then encrypt it
|
|
|
+ */
|
|
|
+ memcpy (addr, iovec[0].iov_base + sizeof (struct security_header),
|
|
|
+ iovec[0].iov_len - sizeof (struct security_header));
|
|
|
+ addr += iovec[0].iov_len - sizeof (struct security_header);
|
|
|
+ iov_encrypted.iov_len += iovec[0].iov_len;
|
|
|
+
|
|
|
+ for (i = 1; i < iov_len; i++) {
|
|
|
+ memcpy (addr, iovec[i].iov_base, iovec[i].iov_len);
|
|
|
+ addr += iovec[i].iov_len;
|
|
|
+ iov_encrypted.iov_len += iovec[i].iov_len;
|
|
|
+ }
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Encrypt message by XORing stream cipher data
|
|
|
+ */
|
|
|
+#ifdef ENCRYPTION
|
|
|
+ sober128_read (iov_encrypted.iov_base + sizeof (struct security_header),
|
|
|
+ iov_encrypted.iov_len - sizeof (struct security_header),
|
|
|
+ &stream_prng_state);
|
|
|
+#endif
|
|
|
+
|
|
|
+#ifdef AUTHENTICATION
|
|
|
+ memset (&totemsrp_hmac_state, 0, sizeof (hmac_state));
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Sign the contents of the message with the hmac key and store signature in message
|
|
|
+ */
|
|
|
+ hmac_init (&totemsrp_hmac_state, DIGEST_SHA1, hmac_key, 16);
|
|
|
+
|
|
|
+ hmac_process (&totemsrp_hmac_state,
|
|
|
+ iov_encrypted.iov_base + HMAC_HASH_SIZE,
|
|
|
+ iov_encrypted.iov_len - HMAC_HASH_SIZE);
|
|
|
+
|
|
|
+ len = hash_descriptor[DIGEST_SHA1]->hashsize;
|
|
|
+
|
|
|
+ hmac_done (&totemsrp_hmac_state, header->hash_digest, &len);
|
|
|
+#endif
|
|
|
+
|
|
|
+#ifdef COMPILE_OUT
|
|
|
+print_digest ("initial_vector", initial_vector);
|
|
|
+print_digest ("cipher_key", cipher_key);
|
|
|
+print_digest ("hmac_key", hmac_key);
|
|
|
+print_digest ("salt", header->salt);
|
|
|
+print_digest ("sent digest", header->hash_digest);
|
|
|
+#endif
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Only designed to work with a message with one iov
|
|
|
+ */
|
|
|
+static int authenticate_and_decrypt (struct iovec *iov)
|
|
|
+{
|
|
|
+ char keys[48];
|
|
|
+ struct security_header *header = iov[0].iov_base;
|
|
|
+ prng_state keygen_prng_state;
|
|
|
+ prng_state stream_prng_state;
|
|
|
+ char *hmac_key = &keys[32];
|
|
|
+ char *cipher_key = &keys[16];
|
|
|
+ char *initial_vector = &keys[0];
|
|
|
+ char digest_comparison[HMAC_HASH_SIZE];
|
|
|
+ unsigned long len;
|
|
|
+ int res = 0;
|
|
|
+
|
|
|
+ iov_encrypted.iov_len = 0;
|
|
|
+
|
|
|
+#ifdef COMPILE_OUT
|
|
|
+ printf ("Decryption message\n");
|
|
|
+ print_msg (header, iov[0].iov_len);
|
|
|
+#endif
|
|
|
+#if (defined(ENCRYPTION) || defined(AUTHENITCATION))
|
|
|
+ /*
|
|
|
+ * Generate MAC, CIPHER, IV keys from private key
|
|
|
+ */
|
|
|
+ memset (keys, 0, sizeof (keys));
|
|
|
+ sober128_start (&keygen_prng_state);
|
|
|
+ sober128_add_entropy (totemsrp_private_key, totemsrp_private_key_len, &keygen_prng_state);
|
|
|
+ sober128_add_entropy (header->salt, sizeof (header->salt), &keygen_prng_state);
|
|
|
+
|
|
|
+ sober128_read (keys, sizeof (keys), &keygen_prng_state);
|
|
|
+#endif
|
|
|
+
|
|
|
+#ifdef ENCRYPTION
|
|
|
+ /*
|
|
|
+ * Setup stream cipher
|
|
|
+ */
|
|
|
+ sober128_start (&stream_prng_state);
|
|
|
+ sober128_add_entropy (cipher_key, 16, &stream_prng_state);
|
|
|
+ sober128_add_entropy (initial_vector, 16, &stream_prng_state);
|
|
|
+#endif
|
|
|
+
|
|
|
+if (log_digest) {
|
|
|
+printf ("New decryption\n");
|
|
|
+print_digest ("salt", header->salt);
|
|
|
+print_digest ("initial_vector", initial_vector);
|
|
|
+print_digest ("cipher_key", cipher_key);
|
|
|
+print_digest ("hmac_key", hmac_key);
|
|
|
+}
|
|
|
+
|
|
|
+#ifdef AUTHENTICATION
|
|
|
+ /*
|
|
|
+ * Authenticate contents of message
|
|
|
+ */
|
|
|
+ hmac_init (&totemsrp_hmac_state, DIGEST_SHA1, hmac_key, 16);
|
|
|
+
|
|
|
+ hmac_process (&totemsrp_hmac_state,
|
|
|
+ iov->iov_base + HMAC_HASH_SIZE,
|
|
|
+ iov->iov_len - HMAC_HASH_SIZE);
|
|
|
+
|
|
|
+ len = hash_descriptor[DIGEST_SHA1]->hashsize;
|
|
|
+ assert (HMAC_HASH_SIZE >= len);
|
|
|
+ hmac_done (&totemsrp_hmac_state, digest_comparison, &len);
|
|
|
+
|
|
|
+#ifdef PRINTDIGESTS
|
|
|
+print_digest ("received digest", header->hash_digest);
|
|
|
+print_digest ("calculated digest", digest_comparison);
|
|
|
+#endif
|
|
|
+ if (memcmp (digest_comparison, header->hash_digest, len) != 0) {
|
|
|
+print_digest ("initial_vector", initial_vector);
|
|
|
+print_digest ("cipher_key", cipher_key);
|
|
|
+print_digest ("hmac_key", hmac_key);
|
|
|
+print_digest ("salt", header->salt);
|
|
|
+print_digest ("sent digest", header->hash_digest);
|
|
|
+print_digest ("calculated digest", digest_comparison);
|
|
|
+printf ("received message size %d\n", iov->iov_len);
|
|
|
+ totemsrp_log_printf (totemsrp_log_level_security, "Received message has invalid digest... ignoring.\n");
|
|
|
+ res = -1;
|
|
|
+exit (1); // TODO this shouldn't be an exit but I want to catch invalid digests
|
|
|
+ return (-1);
|
|
|
+ }
|
|
|
+#endif /* AUTHENTICATION */
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Decrypt the contents of the message with the cipher key
|
|
|
+ */
|
|
|
+#ifdef ENCRYPTION
|
|
|
+ sober128_read (iov->iov_base + sizeof (struct security_header),
|
|
|
+ iov->iov_len - sizeof (struct security_header),
|
|
|
+ &stream_prng_state);
|
|
|
+#endif
|
|
|
+
|
|
|
+ return (res);
|
|
|
+ return (0);
|
|
|
+}
|
|
|
+
|
|
|
+int totemsrp_mcast (
|
|
|
+ struct iovec *iovec,
|
|
|
+ int iov_len,
|
|
|
+ int guarantee)
|
|
|
+{
|
|
|
+ int i;
|
|
|
+ int j;
|
|
|
+ struct message_item message_item;
|
|
|
+
|
|
|
+
|
|
|
+ if (queue_is_full (&new_message_queue)) {
|
|
|
+ assert (0);
|
|
|
+ return (-1);
|
|
|
+ }
|
|
|
+ for (j = 0, i = 0; i < iov_len; i++) {
|
|
|
+ j+= iovec[i].iov_len;
|
|
|
+ }
|
|
|
+// assert (j == FRAGMENT_SIZE || j == (FRAGMENT_SIZE - 2)); /* ensure we use the maximum badnwidth available for now */
|
|
|
+
|
|
|
+// printf ("j is %d fragment size is %d\n", j, FRAGMENT_SIZE);
|
|
|
+// assert (j <= FRAGMENT_SIZE);
|
|
|
+
|
|
|
+
|
|
|
+ totemsrp_log_printf (totemsrp_log_level_debug, "Multicasting message.\n");
|
|
|
+ memset (&message_item, 0, sizeof (struct message_item));
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Allocate pending item
|
|
|
+ */
|
|
|
+ message_item.mcast = malloc (sizeof (struct mcast));
|
|
|
+ if (message_item.mcast == 0) {
|
|
|
+ goto error_mcast;
|
|
|
+ }
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Set mcast header
|
|
|
+ */
|
|
|
+ message_item.mcast->header.type = MESSAGE_TYPE_MCAST;
|
|
|
+ message_item.mcast->header.endian_detector = ENDIAN_LOCAL;
|
|
|
+ message_item.mcast->header.encapsulated = 0;
|
|
|
+ message_item.mcast->guarantee = guarantee;
|
|
|
+ message_item.mcast->source.s_addr = my_id.sin_addr.s_addr;
|
|
|
+
|
|
|
+ for (i = 0; i < iov_len; i++) {
|
|
|
+ message_item.iovec[i].iov_base = malloc (iovec[i].iov_len);
|
|
|
+
|
|
|
+ if (message_item.iovec[i].iov_base == 0) {
|
|
|
+ goto error_iovec;
|
|
|
+ }
|
|
|
+
|
|
|
+ memcpy (message_item.iovec[i].iov_base, iovec[i].iov_base,
|
|
|
+ iovec[i].iov_len);
|
|
|
+
|
|
|
+ message_item.iovec[i].iov_len = iovec[i].iov_len;
|
|
|
+ }
|
|
|
+
|
|
|
+ message_item.iov_len = iov_len;
|
|
|
+
|
|
|
+ totemsrp_log_printf (totemsrp_log_level_debug, "mcasted message added to pending queue\n");
|
|
|
+ queue_item_add (&new_message_queue, &message_item);
|
|
|
+
|
|
|
+ return (0);
|
|
|
+error_iovec:
|
|
|
+ for (j = 0; j < i; j++) {
|
|
|
+ free (message_item.iovec[j].iov_base);
|
|
|
+ }
|
|
|
+ return (-1);
|
|
|
+error_mcast:
|
|
|
+ return (0);
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Determine if there is room to queue a new message
|
|
|
+ */
|
|
|
+int totemsrp_avail (void)
|
|
|
+{
|
|
|
+ int avail;
|
|
|
+
|
|
|
+ queue_avail (&new_message_queue, &avail);
|
|
|
+
|
|
|
+ return (avail);
|
|
|
+}
|
|
|
+
|
|
|
+static int netif_determine (struct sockaddr_in *bindnet,
|
|
|
+ struct sockaddr_in *bound_to)
|
|
|
+{
|
|
|
+ struct sockaddr_in *sockaddr_in;
|
|
|
+ int id_fd;
|
|
|
+ struct ifconf ifc;
|
|
|
+ int numreqs = 0;
|
|
|
+ int res;
|
|
|
+ int i;
|
|
|
+ in_addr_t mask_addr;
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Generate list of local interfaces in ifc.ifc_req structure
|
|
|
+ */
|
|
|
+ id_fd = socket (AF_INET, SOCK_STREAM, 0);
|
|
|
+ ifc.ifc_buf = 0;
|
|
|
+ do {
|
|
|
+ numreqs += 32;
|
|
|
+ ifc.ifc_len = sizeof (struct ifreq) * numreqs;
|
|
|
+ ifc.ifc_buf = (void *)realloc(ifc.ifc_buf, ifc.ifc_len);
|
|
|
+ res = ioctl (id_fd, SIOCGIFCONF, &ifc);
|
|
|
+ if (res < 0) {
|
|
|
+ close (id_fd);
|
|
|
+ return -1;
|
|
|
+ }
|
|
|
+ } while (ifc.ifc_len == sizeof (struct ifreq) * numreqs);
|
|
|
+ res = -1;
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Find interface address to bind to
|
|
|
+ */
|
|
|
+ for (i = 0; i < ifc.ifc_len / sizeof (struct ifreq); i++) {
|
|
|
+ sockaddr_in = (struct sockaddr_in *)&ifc.ifc_ifcu.ifcu_req[i].ifr_ifru.ifru_addr;
|
|
|
+ mask_addr = inet_addr ("255.255.255.0");
|
|
|
+
|
|
|
+ if ((sockaddr_in->sin_family == AF_INET) &&
|
|
|
+ (sockaddr_in->sin_addr.s_addr & mask_addr) ==
|
|
|
+ (bindnet->sin_addr.s_addr & mask_addr)) {
|
|
|
+
|
|
|
+ bound_to->sin_addr.s_addr = sockaddr_in->sin_addr.s_addr;
|
|
|
+ res = i;
|
|
|
+ break; /* for */
|
|
|
+ }
|
|
|
+ }
|
|
|
+ free (ifc.ifc_buf);
|
|
|
+ close (id_fd);
|
|
|
+
|
|
|
+ return (res);
|
|
|
+}
|
|
|
+
|
|
|
+static int totemsrp_build_sockets (struct sockaddr_in *sockaddr_mcast,
|
|
|
+ struct sockaddr_in *sockaddr_bindnet,
|
|
|
+ struct totemsrp_socket *sockets,
|
|
|
+ struct sockaddr_in *bound_to)
|
|
|
+{
|
|
|
+ struct ip_mreq mreq;
|
|
|
+ struct sockaddr_in sockaddr_in;
|
|
|
+ char flag;
|
|
|
+ int res;
|
|
|
+
|
|
|
+ memset (&mreq, 0, sizeof (struct ip_mreq));
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Determine the ip address bound to and the interface name
|
|
|
+ */
|
|
|
+ res = netif_determine (sockaddr_bindnet,
|
|
|
+ bound_to);
|
|
|
+
|
|
|
+ if (res == -1) {
|
|
|
+ return (-1);
|
|
|
+ }
|
|
|
+
|
|
|
+ /* TODO this should be somewhere else */
|
|
|
+ memb_local_sockaddr_in.sin_addr.s_addr = bound_to->sin_addr.s_addr;
|
|
|
+ memb_local_sockaddr_in.sin_family = AF_INET;
|
|
|
+ memb_local_sockaddr_in.sin_port = sockaddr_mcast->sin_port;
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Create multicast socket
|
|
|
+ */
|
|
|
+ sockets->mcast = socket (AF_INET, SOCK_DGRAM, 0);
|
|
|
+ if (sockets->mcast == -1) {
|
|
|
+ perror ("socket");
|
|
|
+ return (-1);
|
|
|
+ }
|
|
|
+
|
|
|
+ if (setsockopt (sockets->mcast, SOL_IP, IP_MULTICAST_IF,
|
|
|
+ &bound_to->sin_addr, sizeof (struct in_addr)) < 0) {
|
|
|
+
|
|
|
+ totemsrp_log_printf (totemsrp_log_level_warning, "Could not bind to device for multicast, group messaging may not work properly. (%s)\n", strerror (errno));
|
|
|
+ }
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Bind to multicast socket used for multicast send/receives
|
|
|
+ */
|
|
|
+ sockaddr_in.sin_family = AF_INET;
|
|
|
+ sockaddr_in.sin_addr.s_addr = sockaddr_mcast->sin_addr.s_addr;
|
|
|
+ sockaddr_in.sin_port = sockaddr_mcast->sin_port;
|
|
|
+ res = bind (sockets->mcast, (struct sockaddr *)&sockaddr_in,
|
|
|
+ sizeof (struct sockaddr_in));
|
|
|
+ if (res == -1) {
|
|
|
+ perror ("bind failed");
|
|
|
+ return (-1);
|
|
|
+ }
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Setup unicast socket
|
|
|
+ */
|
|
|
+ sockets->token = socket (AF_INET, SOCK_DGRAM, 0);
|
|
|
+ if (sockets->token == -1) {
|
|
|
+ perror ("socket2");
|
|
|
+ return (-1);
|
|
|
+ }
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Bind to unicast socket used for token send/receives
|
|
|
+ * This has the side effect of binding to the correct interface
|
|
|
+ */
|
|
|
+ sockaddr_in.sin_addr.s_addr = bound_to->sin_addr.s_addr;
|
|
|
+ res = bind (sockets->token, (struct sockaddr *)&sockaddr_in,
|
|
|
+ sizeof (struct sockaddr_in));
|
|
|
+ if (res == -1) {
|
|
|
+ perror ("bind2 failed");
|
|
|
+ return (-1);
|
|
|
+ }
|
|
|
+
|
|
|
+#ifdef CONFIG_USE_BROADCAST
|
|
|
+/* This config option doesn't work */
|
|
|
+{
|
|
|
+ int on = 1;
|
|
|
+ setsockopt (sockets->mcast, SOL_SOCKET, SO_BROADCAST, (char *)&on, sizeof (on));
|
|
|
+}
|
|
|
+#else
|
|
|
+ /*
|
|
|
+ * Join group membership on socket
|
|
|
+ */
|
|
|
+ mreq.imr_multiaddr.s_addr = sockaddr_mcast->sin_addr.s_addr;
|
|
|
+ mreq.imr_interface.s_addr = bound_to->sin_addr.s_addr;
|
|
|
+
|
|
|
+ res = setsockopt (sockets->mcast, IPPROTO_IP, IP_ADD_MEMBERSHIP,
|
|
|
+ &mreq, sizeof (mreq));
|
|
|
+ if (res == -1) {
|
|
|
+ perror ("join multicast group failed");
|
|
|
+ return (-1);
|
|
|
+ }
|
|
|
+
|
|
|
+#endif
|
|
|
+ /*
|
|
|
+ * Turn on multicast loopback
|
|
|
+ */
|
|
|
+ flag = 1;
|
|
|
+ res = setsockopt (sockets->mcast, IPPROTO_IP, IP_MULTICAST_LOOP,
|
|
|
+ &flag, sizeof (flag));
|
|
|
+ if (res == -1) {
|
|
|
+ perror ("turn off loopback");
|
|
|
+ return (-1);
|
|
|
+ }
|
|
|
+
|
|
|
+ return (0);
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Misc Management
|
|
|
+ */
|
|
|
+int in_addr_compare (const void *a, const void *b) {
|
|
|
+ struct in_addr *in_addr_a = (struct in_addr *)a;
|
|
|
+ struct in_addr *in_addr_b = (struct in_addr *)b;
|
|
|
+
|
|
|
+ return (in_addr_a->s_addr > in_addr_b->s_addr);
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * ORF Token Management
|
|
|
+ */
|
|
|
+/*
|
|
|
+ * Recast message to mcast group if it is available
|
|
|
+ */
|
|
|
+int orf_token_remcast (int seq) {
|
|
|
+ struct msghdr msg_mcast;
|
|
|
+ struct sort_queue_item *sort_queue_item;
|
|
|
+ int res;
|
|
|
+ struct mcast *mcast;
|
|
|
+ void *ptr;
|
|
|
+
|
|
|
+ struct sq *sort_queue;
|
|
|
+
|
|
|
+ if (memb_state == MEMB_STATE_RECOVERY) {
|
|
|
+ sort_queue = &recovery_sort_queue;
|
|
|
+ } else {
|
|
|
+ sort_queue = ®ular_sort_queue;
|
|
|
+ }
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Get RTR item at seq, if not available, return
|
|
|
+ */
|
|
|
+ res = sq_item_get (sort_queue, seq, &ptr);
|
|
|
+ if (res != 0) {
|
|
|
+ return -1;
|
|
|
+ }
|
|
|
+
|
|
|
+ sort_queue_item = ptr;
|
|
|
+
|
|
|
+ mcast = (struct mcast *)sort_queue_item->iovec[0].iov_base;
|
|
|
+
|
|
|
+ encrypt_and_sign (sort_queue_item->iovec, sort_queue_item->iov_len);
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Build multicast message
|
|
|
+ */
|
|
|
+ msg_mcast.msg_name = (caddr_t)&sockaddr_in_mcast;
|
|
|
+ msg_mcast.msg_namelen = sizeof (struct sockaddr_in);
|
|
|
+ msg_mcast.msg_iov = &iov_encrypted;
|
|
|
+ msg_mcast.msg_iovlen = 1;
|
|
|
+ msg_mcast.msg_control = 0;
|
|
|
+ msg_mcast.msg_controllen = 0;
|
|
|
+ msg_mcast.msg_flags = 0;
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Multicast message
|
|
|
+ */
|
|
|
+ res = sendmsg (totemsrp_sockets[0].mcast, &msg_mcast, MSG_NOSIGNAL | MSG_DONTWAIT);
|
|
|
+ if (res == -1) {
|
|
|
+printf ("error during remulticast %d %d %d\n", seq, errno, sort_queue_item->iov_len);
|
|
|
+ return (-1);
|
|
|
+ }
|
|
|
+ stats_sent += res;
|
|
|
+ return (0);
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+/*
|
|
|
+ * Free all freeable messages from ring
|
|
|
+ */
|
|
|
+static int messages_free (int token_aru)
|
|
|
+{
|
|
|
+ struct sort_queue_item *regular_message;
|
|
|
+ int i, j;
|
|
|
+ int res;
|
|
|
+ int log_release = 0;
|
|
|
+ int release_to;
|
|
|
+
|
|
|
+ release_to = token_aru;
|
|
|
+ if (release_to > my_last_aru) {
|
|
|
+ release_to = my_last_aru;
|
|
|
+ }
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Release retransmit list items if group aru indicates they are transmitted
|
|
|
+ */
|
|
|
+ for (i = last_released; i <= release_to; i++) {
|
|
|
+ void *ptr;
|
|
|
+ res = sq_item_get (®ular_sort_queue, i, &ptr);
|
|
|
+ if (res == 0) {
|
|
|
+ regular_message = ptr;
|
|
|
+ for (j = 0; j < regular_message->iov_len; j++) {
|
|
|
+ free (regular_message->iovec[j].iov_base);
|
|
|
+ }
|
|
|
+ }
|
|
|
+ sq_items_release (®ular_sort_queue, i);
|
|
|
+ last_released = i + 1;
|
|
|
+ log_release = 1;
|
|
|
+ }
|
|
|
+
|
|
|
+log_release=1;
|
|
|
+ if (log_release) {
|
|
|
+//TODprintf ("%d\n", lesser);
|
|
|
+// totemsrp_log_printf (totemsrp_log_level_notice,
|
|
|
+// "releasing messages up to and including %d\n", lesser);
|
|
|
+ }
|
|
|
+ return (0);
|
|
|
+}
|
|
|
+
|
|
|
+void update_aru (void)
|
|
|
+{
|
|
|
+ int i;
|
|
|
+ int res;
|
|
|
+ struct sq *sort_queue;
|
|
|
+
|
|
|
+ if (memb_state == MEMB_STATE_RECOVERY) {
|
|
|
+ sort_queue = &recovery_sort_queue;
|
|
|
+ } else {
|
|
|
+ sort_queue = ®ular_sort_queue;
|
|
|
+ }
|
|
|
+
|
|
|
+ for (i = my_aru + 1; i <= my_high_seq_received; i++) {
|
|
|
+ void *ptr;
|
|
|
+
|
|
|
+ res = sq_item_get (sort_queue, i, &ptr);
|
|
|
+ /*
|
|
|
+ * If hole, stop assembly
|
|
|
+ */
|
|
|
+ if (res != 0) {
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ my_aru = i;
|
|
|
+ }
|
|
|
+//printf ("setting received flag to false %d %d\n", my_aru, my_high_seq_received);
|
|
|
+ my_received_flg = 0;
|
|
|
+ if (my_aru == my_high_seq_received) {
|
|
|
+//TODOprintf ("setting received flag to TRUE %d %d\n", my_aru, my_high_seq_received);
|
|
|
+ my_received_flg = 1;
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Multicasts pending messages onto the ring (requires orf_token possession)
|
|
|
+ */
|
|
|
+static int orf_token_mcast (
|
|
|
+ struct orf_token *token,
|
|
|
+ int fcc_mcasts_allowed,
|
|
|
+ struct sockaddr_in *system_from)
|
|
|
+{
|
|
|
+ struct msghdr msg_mcast;
|
|
|
+ struct sort_queue_item sort_queue_item;
|
|
|
+ struct message_item *message_item = 0;
|
|
|
+ int res = 0;
|
|
|
+ struct mcast *mcast;
|
|
|
+ struct queue *mcast_queue;
|
|
|
+ struct sq *sort_queue;
|
|
|
+
|
|
|
+ if (memb_state == MEMB_STATE_RECOVERY) {
|
|
|
+ mcast_queue = &retrans_message_queue;
|
|
|
+ sort_queue = &recovery_sort_queue;
|
|
|
+ reset_token_retransmit_timeout (); // REVIEWED
|
|
|
+ } else {
|
|
|
+ mcast_queue = &new_message_queue;
|
|
|
+ sort_queue = ®ular_sort_queue;
|
|
|
+ }
|
|
|
+
|
|
|
+ for (fcc_mcast_current = 0; fcc_mcast_current < fcc_mcasts_allowed; fcc_mcast_current++) {
|
|
|
+ if (queue_is_empty (mcast_queue)) {
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ message_item = (struct message_item *)queue_item_get (mcast_queue);
|
|
|
+ /* preincrement required by algo */
|
|
|
+ message_item->mcast->seq = ++token->seq;
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Build IO vector
|
|
|
+ */
|
|
|
+ memset (&sort_queue_item, 0, sizeof (struct sort_queue_item));
|
|
|
+ sort_queue_item.iovec[0].iov_base = message_item->mcast;
|
|
|
+ sort_queue_item.iovec[0].iov_len = sizeof (struct mcast);
|
|
|
+
|
|
|
+ mcast = sort_queue_item.iovec[0].iov_base;
|
|
|
+
|
|
|
+ memcpy (&sort_queue_item.iovec[1], message_item->iovec,
|
|
|
+ message_item->iov_len * sizeof (struct iovec));
|
|
|
+
|
|
|
+ sort_queue_item.iov_len = message_item->iov_len + 1;
|
|
|
+
|
|
|
+ assert (sort_queue_item.iov_len < 16);
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Add message to retransmit queue
|
|
|
+ */
|
|
|
+ sq_item_add (sort_queue,
|
|
|
+ &sort_queue_item, message_item->mcast->seq);
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Delete item from pending queue
|
|
|
+ */
|
|
|
+ queue_item_remove (mcast_queue);
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Encrypt and digest the message
|
|
|
+ */
|
|
|
+ encrypt_and_sign (sort_queue_item.iovec, sort_queue_item.iov_len);
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Build multicast message
|
|
|
+ */
|
|
|
+ msg_mcast.msg_name = &sockaddr_in_mcast;
|
|
|
+ msg_mcast.msg_namelen = sizeof (struct sockaddr_in);
|
|
|
+ msg_mcast.msg_iov = &iov_encrypted;
|
|
|
+ msg_mcast.msg_iovlen = 1;
|
|
|
+ msg_mcast.msg_control = 0;
|
|
|
+ msg_mcast.msg_controllen = 0;
|
|
|
+ msg_mcast.msg_flags = 0;
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Multicast message
|
|
|
+ * An error here is recovered by the multicast algorithm
|
|
|
+ */
|
|
|
+ res = sendmsg (totemsrp_sockets[0].mcast, &msg_mcast, MSG_NOSIGNAL | MSG_DONTWAIT);
|
|
|
+//printf ("multicasting %d bytes\n", res);
|
|
|
+//f (res != iov_encrypted.iov_len) {
|
|
|
+//printf ("res %d errno is %d\n", res, errno);
|
|
|
+//}
|
|
|
+// assert (res == iov_encrypted.iov_len);
|
|
|
+ iov_encrypted.iov_len = PACKET_SIZE_MAX;
|
|
|
+
|
|
|
+ if (res > 0) {
|
|
|
+ stats_sent += res;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ assert (fcc_mcast_current < 100);
|
|
|
+
|
|
|
+ /*
|
|
|
+ * If messages mcasted, deliver any new messages to totemg
|
|
|
+ */
|
|
|
+ if (fcc_mcast_current) {
|
|
|
+ my_do_delivery = 1;
|
|
|
+ }
|
|
|
+ my_high_seq_received = token->seq;
|
|
|
+
|
|
|
+ update_aru ();
|
|
|
+ /*
|
|
|
+ * Return 1 if more messages are available for single node clusters
|
|
|
+ */
|
|
|
+ return (fcc_mcast_current);
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Remulticasts messages in orf_token's retransmit list (requires orf_token)
|
|
|
+ * Modify's orf_token's rtr to include retransmits required by this process
|
|
|
+ */
|
|
|
+static int orf_token_rtr (
|
|
|
+ struct orf_token *orf_token,
|
|
|
+ int *fcc_allowed)
|
|
|
+{
|
|
|
+ int res;
|
|
|
+ int i, j;
|
|
|
+ int found;
|
|
|
+ int total_entries;
|
|
|
+ struct sq *sort_queue;
|
|
|
+ struct rtr_item *rtr_list;
|
|
|
+
|
|
|
+ if (memb_state == MEMB_STATE_RECOVERY) {
|
|
|
+ sort_queue = &recovery_sort_queue;
|
|
|
+ } else {
|
|
|
+ sort_queue = ®ular_sort_queue;
|
|
|
+ }
|
|
|
+
|
|
|
+ rtr_list = &orf_token->rtr_list[0];
|
|
|
+if (orf_token->rtr_list_entries) {
|
|
|
+printf ("Retransmit List %d\n", orf_token->rtr_list_entries);
|
|
|
+for (i = 0; i < orf_token->rtr_list_entries; i++) {
|
|
|
+ printf ("%d ", rtr_list[i].seq);
|
|
|
+}
|
|
|
+printf ("\n");
|
|
|
+}
|
|
|
+
|
|
|
+ total_entries = orf_token->rtr_list_entries;
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Retransmit messages on orf_token's RTR list from RTR queue
|
|
|
+ */
|
|
|
+ for (fcc_remcast_current = 0, i = 0;
|
|
|
+ fcc_remcast_current <= *fcc_allowed && i < orf_token->rtr_list_entries;) {
|
|
|
+
|
|
|
+ /*
|
|
|
+ * If this retransmit request isn't from this configuration,
|
|
|
+ * try next rtr entry
|
|
|
+ */
|
|
|
+ if (memcmp (&rtr_list[i].ring_id, &my_ring_id,
|
|
|
+ sizeof (struct memb_ring_id)) != 0) {
|
|
|
+printf ("retransmit for a different config %d\n", rtr_list[i].seq);
|
|
|
+
|
|
|
+ i += 1;
|
|
|
+ continue;
|
|
|
+ }
|
|
|
+
|
|
|
+ assert (rtr_list[i].seq > 0);
|
|
|
+ res = orf_token_remcast (rtr_list[i].seq);
|
|
|
+ if (res == 0) {
|
|
|
+ /*
|
|
|
+ * Multicasted message, so no need to copy to new retransmit list
|
|
|
+ */
|
|
|
+ orf_token->rtr_list_entries -= 1;
|
|
|
+ assert (orf_token->rtr_list_entries >= 0);
|
|
|
+ memmove (&rtr_list[i], &rtr_list[i + 1],
|
|
|
+ sizeof (struct rtr_item) * (orf_token->rtr_list_entries));
|
|
|
+
|
|
|
+ fcc_remcast_current++;
|
|
|
+ stats_remcasts++;
|
|
|
+ } else {
|
|
|
+ i += 1;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ *fcc_allowed = *fcc_allowed - fcc_remcast_current - 1;
|
|
|
+
|
|
|
+#ifdef COMPILE_OUT
|
|
|
+for (i = 0; i < orf_token->rtr_list_entries; i++) {
|
|
|
+ assert (rtr_list_old[index_old].seq != -1);
|
|
|
+}
|
|
|
+#endif
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Add messages to retransmit to RTR list
|
|
|
+ * but only retry if there is room in the retransmit list
|
|
|
+ */
|
|
|
+ for (i = my_aru + 1;
|
|
|
+ orf_token->rtr_list_entries < RETRANSMIT_ENTRIES_MAX &&
|
|
|
+ i <= my_high_seq_received;
|
|
|
+ i++) {
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Find if a message is missing from this processor
|
|
|
+ */
|
|
|
+ res = sq_item_inuse (sort_queue, i);
|
|
|
+ if (res == 0) {
|
|
|
+ /*
|
|
|
+ * Determine if missing message is already in retransmit list
|
|
|
+ */
|
|
|
+ found = 0;
|
|
|
+ for (j = 0; j < orf_token->rtr_list_entries; j++) {
|
|
|
+ if (i == rtr_list[j].seq) {
|
|
|
+ found = 1;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ if (found == 0) {
|
|
|
+ /*
|
|
|
+ * Missing message not found in current retransmit list so add it
|
|
|
+ */
|
|
|
+ memcpy (&rtr_list[orf_token->rtr_list_entries].ring_id,
|
|
|
+ &my_ring_id, sizeof (struct memb_ring_id));
|
|
|
+ rtr_list[orf_token->rtr_list_entries].seq = i;
|
|
|
+ orf_token->rtr_list_entries++;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ }
|
|
|
+ return (fcc_remcast_current);
|
|
|
+}
|
|
|
+
|
|
|
+void token_retransmit (void) {
|
|
|
+ struct iovec iovec;
|
|
|
+ struct msghdr msg_orf_token;
|
|
|
+ int res;
|
|
|
+
|
|
|
+ iovec.iov_base = orf_token_retransmit;
|
|
|
+ iovec.iov_len = orf_token_retransmit_size;
|
|
|
+
|
|
|
+ msg_orf_token.msg_name = &next_memb;
|
|
|
+ msg_orf_token.msg_namelen = sizeof (struct sockaddr_in);
|
|
|
+ msg_orf_token.msg_iov = &iovec;
|
|
|
+ msg_orf_token.msg_iovlen = 1;
|
|
|
+ msg_orf_token.msg_control = 0;
|
|
|
+ msg_orf_token.msg_controllen = 0;
|
|
|
+ msg_orf_token.msg_flags = 0;
|
|
|
+
|
|
|
+ res = sendmsg (totemsrp_sockets[0].token, &msg_orf_token, MSG_NOSIGNAL);
|
|
|
+ assert (res != -1);
|
|
|
+ assert (res == orf_token_retransmit_size);
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Retransmit the regular token if no mcast or token has
|
|
|
+ * been received in retransmit token period retransmit
|
|
|
+ * the token to the next processor
|
|
|
+ */
|
|
|
+void timer_function_token_retransmit_timeout (void *data)
|
|
|
+{
|
|
|
+struct timeval timeval;
|
|
|
+
|
|
|
+ gettimeofday (&timeval, 0);
|
|
|
+ switch (memb_state) {
|
|
|
+ case MEMB_STATE_GATHER:
|
|
|
+ break;
|
|
|
+ case MEMB_STATE_COMMIT:
|
|
|
+ break;
|
|
|
+ case MEMB_STATE_OPERATIONAL:
|
|
|
+ case MEMB_STATE_RECOVERY:
|
|
|
+ token_retransmit ();
|
|
|
+ reset_token_retransmit_timeout (); // REVIEWED
|
|
|
+ break;
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+/*
|
|
|
+ * Send orf_token to next member (requires orf_token)
|
|
|
+ */
|
|
|
+static int token_send (
|
|
|
+ struct orf_token *orf_token,
|
|
|
+ int forward_token)
|
|
|
+{
|
|
|
+ struct msghdr msg_orf_token;
|
|
|
+ struct iovec iovec;
|
|
|
+ int res;
|
|
|
+
|
|
|
+ iovec.iov_base = (char *)orf_token;
|
|
|
+ iovec.iov_len = sizeof (struct orf_token) +
|
|
|
+ (orf_token->rtr_list_entries * sizeof (struct rtr_item));
|
|
|
+
|
|
|
+#ifdef COMPILE_OUT
|
|
|
+{ int i;
|
|
|
+if (orf_token->rtr_list_entries) {
|
|
|
+printf ("Retransmit List Sending %d\n", orf_token->rtr_list_entries);
|
|
|
+for (i = 0; i < orf_token->rtr_list_entries; i++) {
|
|
|
+ printf ("%d ", rtr_list[i].seq);
|
|
|
+assert (rtr_list[i].seq != 0);
|
|
|
+}
|
|
|
+printf ("\n");
|
|
|
+}
|
|
|
+}
|
|
|
+#endif
|
|
|
+
|
|
|
+ encrypt_and_sign (&iovec, 1);
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Keep an encrypted copy in case the token retransmit timer expires
|
|
|
+ */
|
|
|
+ memcpy (orf_token_retransmit, iov_encrypted.iov_base, iov_encrypted.iov_len);
|
|
|
+ orf_token_retransmit_size = iov_encrypted.iov_len;
|
|
|
+
|
|
|
+ /*
|
|
|
+ * IF the user doesn't want the token forwarded, then dont send
|
|
|
+ * it but keep an encrypted copy for the retransmit timeout
|
|
|
+ */
|
|
|
+ if (forward_token == 0) {
|
|
|
+ return (0);
|
|
|
+ }
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Send the message
|
|
|
+ */
|
|
|
+ msg_orf_token.msg_name = &next_memb;
|
|
|
+ msg_orf_token.msg_namelen = sizeof (struct sockaddr_in);
|
|
|
+ msg_orf_token.msg_iov = &iov_encrypted;
|
|
|
+ msg_orf_token.msg_iovlen = 1;
|
|
|
+ msg_orf_token.msg_control = 0;
|
|
|
+ msg_orf_token.msg_controllen = 0;
|
|
|
+ msg_orf_token.msg_flags = 0;
|
|
|
+
|
|
|
+ res = sendmsg (totemsrp_sockets[0].token, &msg_orf_token, MSG_NOSIGNAL);
|
|
|
+ if (res == -1) {
|
|
|
+ printf ("Couldn't send token to addr %s %s %d\n",
|
|
|
+ inet_ntoa (next_memb.sin_addr),
|
|
|
+ strerror (errno), totemsrp_sockets[0].token);
|
|
|
+ }
|
|
|
+ assert (res != -1);
|
|
|
+ assert (res == iov_encrypted.iov_len);
|
|
|
+
|
|
|
+ /*
|
|
|
+ * res not used here errors are handled by algorithm
|
|
|
+ */
|
|
|
+ if (res > 0) {
|
|
|
+ stats_sent += res;
|
|
|
+ }
|
|
|
+
|
|
|
+ return (res);
|
|
|
+}
|
|
|
+
|
|
|
+int orf_token_send_initial (void)
|
|
|
+{
|
|
|
+ struct orf_token orf_token;
|
|
|
+ int res;
|
|
|
+
|
|
|
+ orf_token.header.type = MESSAGE_TYPE_ORF_TOKEN;
|
|
|
+ orf_token.header.endian_detector = ENDIAN_LOCAL;
|
|
|
+ orf_token.header.encapsulated = 0;
|
|
|
+ orf_token.seq = 0;
|
|
|
+ orf_token.token_seq = 0;
|
|
|
+ orf_token.retrans_flg = 1;
|
|
|
+ my_set_retrans_flg = 1;
|
|
|
+/*
|
|
|
+ if (queue_is_empty (&retrans_message_queue) == 1) {
|
|
|
+ orf_token.retrans_flg = 0;
|
|
|
+ } else {
|
|
|
+ orf_token.retrans_flg = 1;
|
|
|
+ my_set_retrans_flg = 1;
|
|
|
+ }
|
|
|
+*/
|
|
|
+
|
|
|
+ orf_token.aru = 0;
|
|
|
+ orf_token.aru_addr.s_addr = my_id.sin_addr.s_addr;
|
|
|
+ memcpy (&orf_token.ring_id, &my_ring_id, sizeof (struct memb_ring_id));
|
|
|
+ orf_token.fcc = 0;
|
|
|
+
|
|
|
+ orf_token.rtr_list_entries = 0;
|
|
|
+
|
|
|
+ res = token_send (&orf_token, 1);
|
|
|
+
|
|
|
+ return (res);
|
|
|
+}
|
|
|
+
|
|
|
+static void memb_state_commit_token_update (struct memb_commit_token *memb_commit_token)
|
|
|
+{
|
|
|
+ int memb_index_this;
|
|
|
+
|
|
|
+printf ("Commit token update\n");
|
|
|
+ memb_index_this = (memb_commit_token->memb_index + 1) % memb_commit_token->addr_entries;
|
|
|
+printf ("memb index is %d\n", memb_index_this);
|
|
|
+ memcpy (&memb_commit_token->memb_list[memb_index_this].ring_id, &my_ring_id,
|
|
|
+ sizeof (struct memb_ring_id));
|
|
|
+assert (my_ring_id.rep.s_addr != 0);
|
|
|
+ memb_commit_token->memb_list[memb_index_this].aru = my_aru;
|
|
|
+ memb_commit_token->memb_list[memb_index_this].high_delivered = my_aru; /* no safe, for now this is my_aru */
|
|
|
+ memb_commit_token->memb_list[memb_index_this].received_flg = my_received_flg;
|
|
|
+}
|
|
|
+
|
|
|
+static int memb_state_commit_token_send (struct memb_commit_token *memb_commit_token)
|
|
|
+{
|
|
|
+ struct msghdr msghdr;
|
|
|
+ struct iovec iovec;
|
|
|
+ int res;
|
|
|
+ int memb_index_this;
|
|
|
+ int memb_index_next;
|
|
|
+
|
|
|
+ memb_commit_token->token_seq++;
|
|
|
+ memb_index_this = (memb_commit_token->memb_index + 1) % memb_commit_token->addr_entries;
|
|
|
+ memb_index_next = (memb_index_this + 1) % memb_commit_token->addr_entries;
|
|
|
+ memb_commit_token->memb_index = memb_index_this;
|
|
|
+
|
|
|
+#ifdef DEBUG
|
|
|
+for (i = 0; i < memb_commit_token->addr_entries; i++) {
|
|
|
+printf ("commit token addresses[%d] %s\n", i, inet_ntoa (memb_commit_token->addr[i]));
|
|
|
+}
|
|
|
+#endif
|
|
|
+
|
|
|
+ iovec.iov_base = memb_commit_token;
|
|
|
+ iovec.iov_len = sizeof (struct memb_commit_token);
|
|
|
+
|
|
|
+ encrypt_and_sign (&iovec, 1);
|
|
|
+
|
|
|
+// TODO do we store the commit token for retransmit don't think so
|
|
|
+// memcpy (orf_token_retransmit, memb_commit_token,
|
|
|
+// sizeof (struct memb_commit_token));
|
|
|
+// orf_token_retransmit_size = sizeof (struct memb_commit_token);
|
|
|
+
|
|
|
+ next_memb.sin_addr.s_addr = memb_commit_token->addr[memb_index_next].s_addr;
|
|
|
+ next_memb.sin_family = AF_INET;
|
|
|
+ next_memb.sin_port = sockaddr_in_mcast.sin_port;
|
|
|
+
|
|
|
+ msghdr.msg_name = &next_memb;
|
|
|
+ msghdr.msg_namelen = sizeof (struct sockaddr_in);
|
|
|
+ msghdr.msg_iov = &iov_encrypted;
|
|
|
+ msghdr.msg_iovlen = 1;
|
|
|
+ msghdr.msg_control = 0;
|
|
|
+ msghdr.msg_controllen = 0;
|
|
|
+ msghdr.msg_flags = 0;
|
|
|
+
|
|
|
+ res = sendmsg (totemsrp_sockets[0].token, &msghdr, MSG_NOSIGNAL | MSG_DONTWAIT);
|
|
|
+ assert (res != -1);
|
|
|
+ return (res);
|
|
|
+}
|
|
|
+
|
|
|
+int memb_lowest_in_config (void)
|
|
|
+{
|
|
|
+ struct in_addr token_memb[MAX_MEMBERS];
|
|
|
+ int token_memb_entries = 0;
|
|
|
+ struct in_addr lowest_addr;
|
|
|
+ int i;
|
|
|
+
|
|
|
+ lowest_addr.s_addr = 0xFFFFFFFF;
|
|
|
+
|
|
|
+ memb_set_subtract (token_memb, &token_memb_entries,
|
|
|
+ my_proc_list, my_proc_list_entries,
|
|
|
+ my_failed_list, my_failed_list_entries);
|
|
|
+
|
|
|
+ /*
|
|
|
+ * find representative by searching for smallest identifier
|
|
|
+ */
|
|
|
+ for (i = 0; i < token_memb_entries; i++) {
|
|
|
+ if (lowest_addr.s_addr > token_memb[i].s_addr) {
|
|
|
+ lowest_addr.s_addr = token_memb[i].s_addr;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ return (my_id.sin_addr.s_addr == lowest_addr.s_addr);
|
|
|
+}
|
|
|
+
|
|
|
+static void memb_state_commit_token_create (struct memb_commit_token *commit_token)
|
|
|
+{
|
|
|
+ struct in_addr token_memb[MAX_MEMBERS];
|
|
|
+ int token_memb_entries = 0;
|
|
|
+
|
|
|
+ totemsrp_log_printf (totemsrp_log_level_notice,
|
|
|
+ "Creating commit token because I am the rep.\n");
|
|
|
+
|
|
|
+ memb_set_subtract (token_memb, &token_memb_entries,
|
|
|
+ my_proc_list, my_proc_list_entries,
|
|
|
+ my_failed_list, my_failed_list_entries);
|
|
|
+
|
|
|
+ memset (commit_token, 0, sizeof (struct memb_commit_token));
|
|
|
+ commit_token->header.type = MESSAGE_TYPE_MEMB_COMMIT_TOKEN;
|
|
|
+ commit_token->header.endian_detector = ENDIAN_LOCAL;
|
|
|
+ commit_token->header.encapsulated = 0;
|
|
|
+
|
|
|
+ commit_token->ring_id.rep.s_addr = my_id.sin_addr.s_addr;
|
|
|
+ commit_token->ring_id.seq = token_ring_id_seq + 4;
|
|
|
+ qsort (token_memb, token_memb_entries,
|
|
|
+ sizeof (struct in_addr), in_addr_compare);
|
|
|
+ memcpy (commit_token->addr, token_memb,
|
|
|
+ token_memb_entries * sizeof (struct in_addr));
|
|
|
+ memset (commit_token->memb_list, 0,
|
|
|
+ sizeof (struct memb_commit_token_memb_entry) * MAX_MEMBERS);
|
|
|
+ commit_token->memb_index = token_memb_entries - 1;
|
|
|
+ commit_token->addr_entries = token_memb_entries;
|
|
|
+}
|
|
|
+
|
|
|
+int memb_join_message_send (void)
|
|
|
+{
|
|
|
+ struct msghdr msghdr;
|
|
|
+ struct iovec iovec;
|
|
|
+ struct memb_join memb_join;
|
|
|
+ int res;
|
|
|
+
|
|
|
+ memb_join.header.type = MESSAGE_TYPE_MEMB_JOIN;
|
|
|
+ memb_join.header.endian_detector = ENDIAN_LOCAL;
|
|
|
+ memb_join.header.encapsulated = 0;
|
|
|
+
|
|
|
+ memb_join.ring_seq = my_ring_id.seq;
|
|
|
+
|
|
|
+ memcpy (memb_join.proc_list, my_proc_list,
|
|
|
+ my_proc_list_entries * sizeof (struct in_addr));
|
|
|
+ memb_join.proc_list_entries = my_proc_list_entries;
|
|
|
+
|
|
|
+ memcpy (memb_join.failed_list, my_failed_list,
|
|
|
+ my_failed_list_entries * sizeof (struct in_addr));
|
|
|
+ memb_join.failed_list_entries = my_failed_list_entries;
|
|
|
+
|
|
|
+ iovec.iov_base = &memb_join;
|
|
|
+ iovec.iov_len = sizeof (struct memb_join);
|
|
|
+
|
|
|
+ encrypt_and_sign (&iovec, 1);
|
|
|
+
|
|
|
+ msghdr.msg_name = &sockaddr_in_mcast;
|
|
|
+ msghdr.msg_namelen = sizeof (struct sockaddr_in);
|
|
|
+ msghdr.msg_iov = &iov_encrypted;
|
|
|
+ msghdr.msg_iovlen = 1;
|
|
|
+ msghdr.msg_control = 0;
|
|
|
+ msghdr.msg_controllen = 0;
|
|
|
+ msghdr.msg_flags = 0;
|
|
|
+
|
|
|
+ res = sendmsg (totemsrp_sockets[0].mcast, &msghdr, MSG_NOSIGNAL | MSG_DONTWAIT);
|
|
|
+
|
|
|
+ return (res);
|
|
|
+}
|
|
|
+
|
|
|
+static void memb_ring_id_create_or_load (
|
|
|
+ struct memb_ring_id *memb_ring_id)
|
|
|
+{
|
|
|
+ int fd;
|
|
|
+ int res;
|
|
|
+ char filename[256];
|
|
|
+
|
|
|
+ sprintf (filename, "/tmp/ringid_%s",
|
|
|
+ inet_ntoa (my_id.sin_addr));
|
|
|
+ fd = open (filename, O_RDONLY, 0777);
|
|
|
+ if (fd > 0) {
|
|
|
+ res = read (fd, &memb_ring_id->seq, sizeof (unsigned long long));
|
|
|
+ assert (res == sizeof (unsigned long long));
|
|
|
+ close (fd);
|
|
|
+ } else
|
|
|
+ if (fd == -1 && errno == ENOENT) {
|
|
|
+ memb_ring_id->seq = 0;
|
|
|
+ umask(0);
|
|
|
+ fd = open (filename, O_CREAT|O_RDWR, 0777);
|
|
|
+ if (fd == -1) {
|
|
|
+ printf ("couldn't create file %d %s\n", fd, strerror(errno));
|
|
|
+ }
|
|
|
+ res = write (fd, &memb_ring_id->seq, sizeof (unsigned long long));
|
|
|
+ assert (res == sizeof (unsigned long long));
|
|
|
+ close (fd);
|
|
|
+ } else {
|
|
|
+ printf ("Couldn't open %s %s\n", filename, strerror (errno));
|
|
|
+ }
|
|
|
+
|
|
|
+ memb_ring_id->rep.s_addr = my_id.sin_addr.s_addr;
|
|
|
+ assert (memb_ring_id->rep.s_addr);
|
|
|
+ token_ring_id_seq = memb_ring_id->seq;
|
|
|
+}
|
|
|
+
|
|
|
+static void memb_ring_id_store (
|
|
|
+ struct memb_commit_token *commit_token)
|
|
|
+{
|
|
|
+ char filename[256];
|
|
|
+ int fd;
|
|
|
+ int res;
|
|
|
+
|
|
|
+ sprintf (filename, "/tmp/ringid_%s",
|
|
|
+ inet_ntoa (my_id.sin_addr));
|
|
|
+
|
|
|
+ fd = open (filename, O_WRONLY, 0777);
|
|
|
+ if (fd == -1) {
|
|
|
+ printf ("Couldn't store the ring id %s\n", strerror (errno));
|
|
|
+ }
|
|
|
+ totemsrp_log_printf (totemsrp_log_level_notice,
|
|
|
+ "Storing new sequence id for ring %d\n", commit_token->ring_id.seq);
|
|
|
+ assert (fd > 0);
|
|
|
+ res = write (fd, &commit_token->ring_id.seq, sizeof (unsigned long long));
|
|
|
+ assert (res == sizeof (unsigned long long));
|
|
|
+ close (fd);
|
|
|
+ memcpy (&my_ring_id, &commit_token->ring_id, sizeof (struct memb_ring_id));
|
|
|
+}
|
|
|
+
|
|
|
+void print_stats (void)
|
|
|
+{
|
|
|
+ struct timeval tv_end;
|
|
|
+ gettimeofday (&tv_end, NULL);
|
|
|
+
|
|
|
+ totemsrp_log_printf (totemsrp_log_level_notice, "Bytes recv %d\n", stats_recv);
|
|
|
+ totemsrp_log_printf (totemsrp_log_level_notice, "Bytes sent %d\n", stats_sent);
|
|
|
+ totemsrp_log_printf (totemsrp_log_level_notice, "Messages delivered %d\n", stats_delv);
|
|
|
+ totemsrp_log_printf (totemsrp_log_level_notice, "Re-Mcasts %d\n", stats_remcasts);
|
|
|
+ totemsrp_log_printf (totemsrp_log_level_notice, "Tokens process %d\n", stats_orf_token);
|
|
|
+}
|
|
|
+
|
|
|
+int totemsrp_callback_token_create (void **handle_out,
|
|
|
+ enum totemsrp_callback_token_type type,
|
|
|
+ int delete,
|
|
|
+ int (*callback_fn) (enum totemsrp_callback_token_type type, void *),
|
|
|
+ void *data)
|
|
|
+{
|
|
|
+ struct token_callback_instance *handle;
|
|
|
+ handle = (struct token_callback_instance *)malloc (sizeof (struct token_callback_instance));
|
|
|
+ if (handle == 0) {
|
|
|
+ return (-1);
|
|
|
+ }
|
|
|
+ *handle_out = (void *)handle;
|
|
|
+ list_init (&handle->list);
|
|
|
+ handle->callback_fn = callback_fn;
|
|
|
+ handle->data = data;
|
|
|
+ handle->callback_type = type;
|
|
|
+ handle->delete = delete;
|
|
|
+ switch (type) {
|
|
|
+ case TOTEMSRP_CALLBACK_TOKEN_RECEIVED:
|
|
|
+ list_add (&handle->list, &token_callback_received_listhead);
|
|
|
+ break;
|
|
|
+ case TOTEMSRP_CALLBACK_TOKEN_SENT:
|
|
|
+ list_add (&handle->list, &token_callback_sent_listhead);
|
|
|
+ break;
|
|
|
+ }
|
|
|
+
|
|
|
+ return (0);
|
|
|
+}
|
|
|
+
|
|
|
+void totemsrp_callback_token_type (void *handle)
|
|
|
+{
|
|
|
+ struct token_callback_instance *token_callback_instance = (struct token_callback_instance *)handle;
|
|
|
+
|
|
|
+ list_del (&token_callback_instance->list);
|
|
|
+ free (token_callback_instance);
|
|
|
+}
|
|
|
+
|
|
|
+void token_callbacks_execute (enum totemsrp_callback_token_type type)
|
|
|
+{
|
|
|
+ struct list_head *list;
|
|
|
+ struct list_head *list_next;
|
|
|
+ struct list_head *callback_listhead = 0;
|
|
|
+ struct token_callback_instance *token_callback_instance;
|
|
|
+ int res;
|
|
|
+
|
|
|
+ switch (type) {
|
|
|
+ case TOTEMSRP_CALLBACK_TOKEN_RECEIVED:
|
|
|
+ callback_listhead = &token_callback_received_listhead;
|
|
|
+ break;
|
|
|
+ case TOTEMSRP_CALLBACK_TOKEN_SENT:
|
|
|
+ callback_listhead = &token_callback_sent_listhead;
|
|
|
+ break;
|
|
|
+ default:
|
|
|
+ assert (0);
|
|
|
+ }
|
|
|
+
|
|
|
+ for (list = callback_listhead->next; list != callback_listhead;
|
|
|
+ list = list_next) {
|
|
|
+
|
|
|
+ token_callback_instance = list_entry (list, struct token_callback_instance, list);
|
|
|
+ list_next = list->next;
|
|
|
+ if (token_callback_instance->delete == 1) {
|
|
|
+ list_del (list);
|
|
|
+ }
|
|
|
+
|
|
|
+ res = token_callback_instance->callback_fn (
|
|
|
+ token_callback_instance->callback_type,
|
|
|
+ token_callback_instance->data);
|
|
|
+
|
|
|
+ /*
|
|
|
+ * This callback failed to execute, try it again on the next token
|
|
|
+ */
|
|
|
+ if (res == -1 && token_callback_instance->delete == 1) {
|
|
|
+ list_add (list, callback_listhead);
|
|
|
+ } else
|
|
|
+ if (token_callback_instance->delete) {
|
|
|
+ free (token_callback_instance);
|
|
|
+ }
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Message Handlers
|
|
|
+ */
|
|
|
+
|
|
|
+int my_last_seq = 0;
|
|
|
+
|
|
|
+ struct timeval tv_old;
|
|
|
+/*
|
|
|
+ * message handler called when TOKEN message type received
|
|
|
+ */
|
|
|
+static int message_handler_orf_token (
|
|
|
+ struct sockaddr_in *system_from,
|
|
|
+ struct iovec *iovec,
|
|
|
+ int iov_len,
|
|
|
+ int bytes_received,
|
|
|
+ int endian_conversion_needed)
|
|
|
+{
|
|
|
+ char token_storage[1500];
|
|
|
+ char token_convert[1500];
|
|
|
+ struct orf_token *token;
|
|
|
+ int prio = UINT_MAX;
|
|
|
+ struct pollfd ufd;
|
|
|
+ int nfds;
|
|
|
+ struct orf_token *token_ref = (struct orf_token *)iovec->iov_base;
|
|
|
+ int transmits_allowed;
|
|
|
+ int forward_token;
|
|
|
+ int mcasted;
|
|
|
+ int last_aru;
|
|
|
+#ifdef GIVEINFO
|
|
|
+ struct timeval tv_current;
|
|
|
+ struct timeval tv_diff;
|
|
|
+
|
|
|
+gettimeofday (&tv_current, NULL);
|
|
|
+timersub (&tv_current, &tv_old, &tv_diff);
|
|
|
+memcpy (&tv_old, &tv_current, sizeof (struct timeval));
|
|
|
+
|
|
|
+if ((((float)tv_diff.tv_usec) / 100.0) > 5.0) {
|
|
|
+printf ("OTHERS %0.4f ms\n", ((float)tv_diff.tv_usec) / 100.0);
|
|
|
+}
|
|
|
+#endif
|
|
|
+
|
|
|
+ my_token_held = 1;
|
|
|
+ my_do_delivery = 0;
|
|
|
+
|
|
|
+if (random () % 100 < 10) {
|
|
|
+ return (0);
|
|
|
+}
|
|
|
+ /*
|
|
|
+ * Hold onto token when there is no activity on ring and
|
|
|
+ * this processor is the ring rep
|
|
|
+ */
|
|
|
+ forward_token = 1;
|
|
|
+ if (my_ring_id.rep.s_addr == my_id.sin_addr.s_addr) {
|
|
|
+ if (my_seq_unchanged > SEQNO_UNCHANGED_CONST) {
|
|
|
+ forward_token = 0;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ if (token_ref->seq == my_last_seq) {
|
|
|
+ my_seq_unchanged++;
|
|
|
+ } else {
|
|
|
+ my_seq_unchanged = 0;
|
|
|
+ }
|
|
|
+ my_last_seq = token_ref->seq;
|
|
|
+
|
|
|
+ assert (bytes_received >= sizeof (struct orf_token));
|
|
|
+// assert (bytes_received == sizeof (struct orf_token) +
|
|
|
+// (sizeof (struct rtr_item) * token_ref->rtr_list_entries);
|
|
|
+ /*
|
|
|
+ * Make copy of token and retransmit list in case we have
|
|
|
+ * to flush incoming messages from the kernel queue
|
|
|
+ */
|
|
|
+ token = (struct orf_token *)token_storage;
|
|
|
+ memcpy (token, iovec->iov_base, sizeof (struct orf_token));
|
|
|
+ memcpy (&token->rtr_list[0], iovec->iov_base + sizeof (struct orf_token),
|
|
|
+ sizeof (struct rtr_item) * RETRANSMIT_ENTRIES_MAX);
|
|
|
+
|
|
|
+ if (endian_conversion_needed) {
|
|
|
+// printf ("Must convert endian of token message\n");
|
|
|
+ orf_token_endian_convert (token, (struct orf_token *)token_convert);
|
|
|
+ token = (struct orf_token *)token_convert;
|
|
|
+ }
|
|
|
+ /*
|
|
|
+ * flush incoming queue from kernel
|
|
|
+ */
|
|
|
+ do {
|
|
|
+ ufd.fd = totemsrp_sockets[0].mcast;
|
|
|
+ ufd.events = POLLIN;
|
|
|
+ nfds = poll (&ufd, 1, 0);
|
|
|
+ if (nfds == 1 && ufd.revents & POLLIN) {
|
|
|
+ totemsrp_iov_recv.iov_len = PACKET_SIZE_MAX;
|
|
|
+ recv_handler (0, totemsrp_sockets[0].mcast, ufd.revents, 0,
|
|
|
+ &prio);
|
|
|
+ }
|
|
|
+ } while (nfds == 1);
|
|
|
+
|
|
|
+
|
|
|
+ token_callbacks_execute (TOTEMSRP_CALLBACK_TOKEN_RECEIVED);
|
|
|
+
|
|
|
+ switch (memb_state) {
|
|
|
+ case MEMB_STATE_COMMIT:
|
|
|
+ /* Discard token */
|
|
|
+ break;
|
|
|
+
|
|
|
+ case MEMB_STATE_OPERATIONAL:
|
|
|
+ messages_free (token->aru);
|
|
|
+ case MEMB_STATE_GATHER:
|
|
|
+ /*
|
|
|
+ * DO NOT add break, we use different free mechanism in recovery state
|
|
|
+ */
|
|
|
+
|
|
|
+ case MEMB_STATE_RECOVERY:
|
|
|
+ last_aru = my_last_aru;
|
|
|
+ my_last_aru = token->aru;
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Test for a token from another configuration
|
|
|
+ */
|
|
|
+ if (memcmp (&token->ring_id, &my_ring_id,
|
|
|
+ sizeof (struct memb_ring_id)) != 0) {
|
|
|
+
|
|
|
+ totemsrp_log_printf (totemsrp_log_level_notice,
|
|
|
+ "Token from another configuration %s.\n",
|
|
|
+ inet_ntoa (system_from->sin_addr));
|
|
|
+printf ("tokens ring %lld %s\n", token->ring_id.seq, inet_ntoa (token->ring_id.rep));
|
|
|
+printf ("my ring %lld %s %d\n", my_ring_id.seq, inet_ntoa (my_ring_id.rep), memb_state);
|
|
|
+ my_token_held = 0;
|
|
|
+ return (0); /* discard token */
|
|
|
+ }
|
|
|
+
|
|
|
+ if (my_token_seq >= token->token_seq) {
|
|
|
+ my_token_held = 0;
|
|
|
+ reset_token_retransmit_timeout ();
|
|
|
+ reset_token_timeout ();
|
|
|
+ return (0); /* discard token */
|
|
|
+ }
|
|
|
+ transmits_allowed = 30;
|
|
|
+ mcasted = orf_token_rtr (token, &transmits_allowed);
|
|
|
+ if (mcasted) {
|
|
|
+ forward_token = 1;
|
|
|
+ my_seq_unchanged = 0;
|
|
|
+ }
|
|
|
+
|
|
|
+ if ((last_aru + MISSING_MCAST_WINDOW) < token->seq) {
|
|
|
+ transmits_allowed = 0;
|
|
|
+ }
|
|
|
+ mcasted = orf_token_mcast (token, transmits_allowed, system_from);
|
|
|
+ if (mcasted) {
|
|
|
+ forward_token = 1;
|
|
|
+ my_seq_unchanged = 0;
|
|
|
+ }
|
|
|
+ if (my_aru < token->aru ||
|
|
|
+ my_id.sin_addr.s_addr == token->aru_addr.s_addr ||
|
|
|
+ token->aru_addr.s_addr == 0) {
|
|
|
+
|
|
|
+ token->aru = my_aru;
|
|
|
+ if (token->aru == token->seq) {
|
|
|
+ token->aru_addr.s_addr = 0;
|
|
|
+ } else {
|
|
|
+ token->aru_addr.s_addr = my_id.sin_addr.s_addr;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ if (token->aru == my_last_aru && token->aru_addr.s_addr != 0) {
|
|
|
+ my_aru_count += 1;
|
|
|
+ } else {
|
|
|
+ my_aru_count = 0;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (my_aru_count > FAIL_TO_RECV_CONST &&
|
|
|
+ token->aru_addr.s_addr == my_id.sin_addr.s_addr) {
|
|
|
+
|
|
|
+ memb_set_merge (&token->aru_addr, 1,
|
|
|
+ my_failed_list, &my_failed_list_entries);
|
|
|
+ memb_state_gather_enter ();
|
|
|
+ } else {
|
|
|
+ my_token_seq = token->token_seq;
|
|
|
+ token->token_seq += 1;
|
|
|
+
|
|
|
+ if (memb_state == MEMB_STATE_RECOVERY) {
|
|
|
+ /*
|
|
|
+ * my_aru == my_high_seq_received means this processor
|
|
|
+ * has recovered all messages it can recover
|
|
|
+ * (ie: its retrans queue is empty)
|
|
|
+ */
|
|
|
+ if (queue_is_empty (&retrans_message_queue) == 0 ||
|
|
|
+ my_aru != my_high_seq_received) {
|
|
|
+
|
|
|
+ if (token->retrans_flg == 0) {
|
|
|
+ token->retrans_flg = 1;
|
|
|
+ my_set_retrans_flg = 1;
|
|
|
+ }
|
|
|
+ } else
|
|
|
+ if (token->retrans_flg == 1 && my_set_retrans_flg) {
|
|
|
+ token->retrans_flg = 0;
|
|
|
+ }
|
|
|
+printf ("token retrans flag is %d my set retrans flag%d retrans queue empty %d count %d\n",
|
|
|
+ token->retrans_flg, my_set_retrans_flg, queue_is_empty (&retrans_message_queue), my_retrans_flg_count);
|
|
|
+ if (token->retrans_flg == 0) {
|
|
|
+ my_retrans_flg_count += 1;
|
|
|
+ }
|
|
|
+ if (my_retrans_flg_count == 2) {
|
|
|
+ my_install_seq = token->seq;
|
|
|
+ }
|
|
|
+printf ("install seq %d aru %d high seq received %d\n", my_install_seq, my_aru,
|
|
|
+my_high_seq_received);
|
|
|
+ if (my_retrans_flg_count >= 2 && my_aru >= my_install_seq && my_received_flg == 0) {
|
|
|
+ my_received_flg = 1;
|
|
|
+ my_deliver_memb_entries = my_trans_memb_entries;
|
|
|
+ memcpy (my_deliver_memb_list, my_trans_memb_list,
|
|
|
+ sizeof (struct in_addr) * my_trans_memb_entries);
|
|
|
+ }
|
|
|
+ if (my_retrans_flg_count >= 3 && token->aru >= my_install_seq) {
|
|
|
+ my_rotation_counter += 1;
|
|
|
+ }
|
|
|
+ if (my_rotation_counter == 2) {
|
|
|
+printf ("retrans flag count %d token aru %d install seq %d aru %d %d\n", my_retrans_flg_count,
|
|
|
+ token->aru, my_install_seq, my_aru, token->seq);
|
|
|
+ memb_state_operational_enter ();
|
|
|
+ my_rotation_counter = 0;
|
|
|
+ my_retrans_flg_count = 0;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ token_send (token, 1 /* forward_token */);
|
|
|
+
|
|
|
+#ifdef GIVEINFO
|
|
|
+gettimeofday (&tv_current, NULL);
|
|
|
+timersub (&tv_current, &tv_old, &tv_diff);
|
|
|
+memcpy (&tv_old, &tv_current, sizeof (struct timeval));
|
|
|
+if ((((float)tv_diff.tv_usec) / 100.0) > 5.0) {
|
|
|
+printf ("I held %0.4f ms\n", ((float)tv_diff.tv_usec) / 100.0);
|
|
|
+}
|
|
|
+#endif
|
|
|
+ if (my_do_delivery) {
|
|
|
+ if (memb_state != MEMB_STATE_RECOVERY) {
|
|
|
+ messages_deliver_to_app (0, &my_high_seq_delivered, my_high_seq_received);
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Deliver messages after token has been transmitted
|
|
|
+ * to improve performance
|
|
|
+ */
|
|
|
+ reset_token_timeout (); // REVIEWED
|
|
|
+ if (forward_token == 0) {
|
|
|
+ reset_token_retransmit_timeout (); // REVIEWED
|
|
|
+ }
|
|
|
+
|
|
|
+ token_callbacks_execute (TOTEMSRP_CALLBACK_TOKEN_SENT);
|
|
|
+ }
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ my_token_held = 0;
|
|
|
+ return (0);
|
|
|
+}
|
|
|
+
|
|
|
+static void messages_deliver_to_app (int skip, int *start_point, int end_point)
|
|
|
+{
|
|
|
+ struct sort_queue_item *sort_queue_item_p;
|
|
|
+ int i;
|
|
|
+ int res;
|
|
|
+ struct mcast *mcast;
|
|
|
+
|
|
|
+ totemsrp_log_printf (totemsrp_log_level_debug,
|
|
|
+ "Delivering %d to %d\n", *start_point + 1, my_high_seq_received);
|
|
|
+ /*
|
|
|
+ * Deliver messages in order from rtr queue to pending delivery queue
|
|
|
+ */
|
|
|
+ for (i = *start_point + 1; i <= end_point; i++) {
|
|
|
+ void *ptr;
|
|
|
+
|
|
|
+ res = sq_item_get (®ular_sort_queue, i, &ptr);
|
|
|
+ if (res != 0 && skip) {
|
|
|
+ *start_point = i;
|
|
|
+ continue;
|
|
|
+ }
|
|
|
+ /*
|
|
|
+ * If hole, stop assembly
|
|
|
+ */
|
|
|
+ if (res != 0) {
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ sort_queue_item_p = ptr;
|
|
|
+
|
|
|
+ mcast = sort_queue_item_p->iovec[0].iov_base;
|
|
|
+ if (mcast == (struct mcast *)0xdeadbeef) {
|
|
|
+ printf ("seq %d\n", sort_queue_item_p->iovec[0].iov_len);
|
|
|
+ }
|
|
|
+ assert (mcast != (struct mcast *)0xdeadbeef);
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Message found
|
|
|
+ */
|
|
|
+ totemsrp_log_printf (totemsrp_log_level_debug,
|
|
|
+ "Delivering MCAST message with seq %d to pending delivery queue\n",
|
|
|
+ mcast->seq);
|
|
|
+
|
|
|
+ *start_point = i;
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Message is locally originated multicasat
|
|
|
+ */
|
|
|
+ if (sort_queue_item_p->iov_len > 1 &&
|
|
|
+ sort_queue_item_p->iovec[0].iov_len == sizeof (struct mcast)) {
|
|
|
+ totemsrp_deliver_fn (
|
|
|
+ mcast->source,
|
|
|
+ &sort_queue_item_p->iovec[1],
|
|
|
+ sort_queue_item_p->iov_len - 1,
|
|
|
+ mcast->header.endian_detector != ENDIAN_LOCAL);
|
|
|
+ } else {
|
|
|
+ sort_queue_item_p->iovec[0].iov_len -= sizeof (struct mcast);
|
|
|
+ sort_queue_item_p->iovec[0].iov_base += sizeof (struct mcast);
|
|
|
+
|
|
|
+ totemsrp_deliver_fn (
|
|
|
+ mcast->source,
|
|
|
+ sort_queue_item_p->iovec,
|
|
|
+ sort_queue_item_p->iov_len,
|
|
|
+ mcast->header.endian_detector != ENDIAN_LOCAL);
|
|
|
+
|
|
|
+ sort_queue_item_p->iovec[0].iov_len += sizeof (struct mcast);
|
|
|
+ sort_queue_item_p->iovec[0].iov_base -= sizeof (struct mcast);
|
|
|
+ }
|
|
|
+ stats_delv += 1;
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * recv message handler called when MCAST message type received
|
|
|
+ */
|
|
|
+static int message_handler_mcast (
|
|
|
+ struct sockaddr_in *system_from,
|
|
|
+ struct iovec *iovec,
|
|
|
+ int iov_len,
|
|
|
+ int bytes_received,
|
|
|
+ int endian_conversion_needed)
|
|
|
+{
|
|
|
+ struct sort_queue_item sort_queue_item;
|
|
|
+ struct sq *sort_queue;
|
|
|
+ struct mcast mcast_header;
|
|
|
+
|
|
|
+ if (memb_state == MEMB_STATE_RECOVERY) {
|
|
|
+ sort_queue = &recovery_sort_queue;
|
|
|
+ } else {
|
|
|
+ sort_queue = ®ular_sort_queue;
|
|
|
+ }
|
|
|
+ if (endian_conversion_needed) {
|
|
|
+ mcast_endian_convert (iovec[0].iov_base, &mcast_header);
|
|
|
+ } else {
|
|
|
+ memcpy (&mcast_header, iovec[0].iov_base, sizeof (struct mcast));
|
|
|
+ }
|
|
|
+
|
|
|
+ assert (bytes_received < PACKET_SIZE_MAX);
|
|
|
+if (random()%100 < 20) {
|
|
|
+ return (0);
|
|
|
+}
|
|
|
+ cancel_token_retransmit_timeout (); // REVIEWED
|
|
|
+
|
|
|
+ /*
|
|
|
+ * If the message is foriegn execute the switch below
|
|
|
+ */
|
|
|
+// TODO this detection of foreign messages isn't correct
|
|
|
+// it doesn't work in the recovery state for the new processors
|
|
|
+// my_memb_list is the wrong list to use I think we should use my_new_memb_list
|
|
|
+ if (!memb_set_subset (&system_from->sin_addr,
|
|
|
+ 1,
|
|
|
+ my_new_memb_list,
|
|
|
+ my_new_memb_entries)) {
|
|
|
+
|
|
|
+printf ("got foreign message\n");
|
|
|
+
|
|
|
+ switch (memb_state) {
|
|
|
+ case MEMB_STATE_OPERATIONAL:
|
|
|
+ memb_set_merge (&system_from->sin_addr, 1,
|
|
|
+ my_proc_list, &my_proc_list_entries);
|
|
|
+ memb_state_gather_enter ();
|
|
|
+ break;
|
|
|
+
|
|
|
+ case MEMB_STATE_GATHER:
|
|
|
+ if (!memb_set_subset (&system_from->sin_addr,
|
|
|
+ 1,
|
|
|
+ my_proc_list,
|
|
|
+ my_proc_list_entries)) {
|
|
|
+
|
|
|
+ memb_set_merge (&system_from->sin_addr, 1,
|
|
|
+ my_proc_list, &my_proc_list_entries);
|
|
|
+ memb_state_gather_enter ();
|
|
|
+ return (0);
|
|
|
+ }
|
|
|
+ break;
|
|
|
+
|
|
|
+ case MEMB_STATE_COMMIT:
|
|
|
+ /* discard message */
|
|
|
+ break;
|
|
|
+
|
|
|
+ case MEMB_STATE_RECOVERY:
|
|
|
+ /* discard message */
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ return (0); /* discard all foreign messages */
|
|
|
+ }
|
|
|
+ /*
|
|
|
+ * Add mcast message to rtr queue if not already in rtr queue
|
|
|
+ * otherwise free io vectors
|
|
|
+ */
|
|
|
+ if (bytes_received > 0 && bytes_received < PACKET_SIZE_MAX &&
|
|
|
+ sq_item_inuse (sort_queue, mcast_header.seq) == 0) {
|
|
|
+//printf ("adding message %d\n", mcast->seq);
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Allocate new multicast memory block
|
|
|
+ */
|
|
|
+ sort_queue_item.iovec[0].iov_base = malloc (bytes_received);
|
|
|
+ if (sort_queue_item.iovec[0].iov_base == 0) {
|
|
|
+ return (-1); /* error here is corrected by the algorithm */
|
|
|
+ }
|
|
|
+ memcpy (sort_queue_item.iovec[0].iov_base, iovec[0].iov_base,
|
|
|
+ bytes_received);
|
|
|
+ sort_queue_item.iovec[0].iov_len = bytes_received;
|
|
|
+ assert (sort_queue_item.iovec[0].iov_len > 0);
|
|
|
+ assert (sort_queue_item.iovec[0].iov_len < PACKET_SIZE_MAX);
|
|
|
+ sort_queue_item.iov_len = 1;
|
|
|
+
|
|
|
+ if (mcast_header.seq > my_high_seq_received) {
|
|
|
+ my_high_seq_received = mcast_header.seq;
|
|
|
+ }
|
|
|
+
|
|
|
+ sq_item_add (sort_queue, &sort_queue_item, mcast_header.seq);
|
|
|
+ }
|
|
|
+
|
|
|
+ update_aru ();
|
|
|
+ if (my_token_held) {
|
|
|
+ my_do_delivery = 1;
|
|
|
+ } else {
|
|
|
+ if (memb_state != MEMB_STATE_RECOVERY) {
|
|
|
+ messages_deliver_to_app (0, &my_high_seq_delivered, my_high_seq_received);
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+/* TODO remove from retrans message queue for old ring in recovery state */
|
|
|
+ return (0);
|
|
|
+}
|
|
|
+
|
|
|
+int memb_join_process (struct memb_join *memb_join, struct sockaddr_in *system_from)
|
|
|
+{
|
|
|
+ struct memb_commit_token my_commit_token;
|
|
|
+
|
|
|
+ if (memb_set_equal (memb_join->proc_list,
|
|
|
+ memb_join->proc_list_entries,
|
|
|
+ my_proc_list,
|
|
|
+ my_proc_list_entries) &&
|
|
|
+
|
|
|
+ memb_set_equal (memb_join->failed_list,
|
|
|
+ memb_join->failed_list_entries,
|
|
|
+ my_failed_list,
|
|
|
+ my_failed_list_entries)) {
|
|
|
+
|
|
|
+ memb_consensus_set (&system_from->sin_addr);
|
|
|
+
|
|
|
+ if (memb_consensus_agreed () &&
|
|
|
+ memb_lowest_in_config ()) {
|
|
|
+
|
|
|
+ memb_state_commit_token_create (&my_commit_token);
|
|
|
+
|
|
|
+ memb_state_commit_enter (&my_commit_token);
|
|
|
+ } else {
|
|
|
+ return (0); // TODO added to match spec
|
|
|
+ }
|
|
|
+ } else
|
|
|
+ if (memb_set_subset (memb_join->proc_list,
|
|
|
+ memb_join->proc_list_entries,
|
|
|
+ my_proc_list,
|
|
|
+ my_proc_list_entries) &&
|
|
|
+
|
|
|
+ memb_set_subset (memb_join->failed_list,
|
|
|
+ memb_join->failed_list_entries,
|
|
|
+ my_failed_list, // TODO changed proc to failed to match spec
|
|
|
+ my_failed_list_entries)) {
|
|
|
+
|
|
|
+ return (0);
|
|
|
+ } else
|
|
|
+ if (memb_set_subset (&system_from->sin_addr, 1, // TODO changed proc to failed to match spec
|
|
|
+ my_failed_list, my_failed_list_entries)) {
|
|
|
+
|
|
|
+ return (0);
|
|
|
+ } else {
|
|
|
+ memb_set_merge (memb_join->proc_list,
|
|
|
+ memb_join->proc_list_entries,
|
|
|
+ my_proc_list, &my_proc_list_entries);
|
|
|
+
|
|
|
+ if (memb_set_subset (&my_id.sin_addr, 1,
|
|
|
+ memb_join->failed_list, memb_join->failed_list_entries)) {
|
|
|
+
|
|
|
+ memb_set_merge (&system_from->sin_addr, 1,
|
|
|
+ my_failed_list, &my_failed_list_entries);
|
|
|
+ } else {
|
|
|
+ memb_set_merge (memb_join->failed_list,
|
|
|
+ memb_join->failed_list_entries,
|
|
|
+ my_failed_list, &my_failed_list_entries);
|
|
|
+ }
|
|
|
+ memb_state_gather_enter ();
|
|
|
+ return (1); /* gather entered */
|
|
|
+ }
|
|
|
+ return (0); /* gather not entered */
|
|
|
+}
|
|
|
+
|
|
|
+static void memb_join_endian_convert (struct memb_join *in, struct memb_join *out)
|
|
|
+{
|
|
|
+ int i;
|
|
|
+
|
|
|
+ out->header.type = in->header.type;
|
|
|
+ out->header.endian_detector = ENDIAN_LOCAL;
|
|
|
+ out->proc_list_entries = swab32 (in->proc_list_entries);
|
|
|
+ out->failed_list_entries = swab32 (in->failed_list_entries);
|
|
|
+ out->ring_seq = swab64 (in->ring_seq);
|
|
|
+ for (i = 0; i < out->proc_list_entries; i++) {
|
|
|
+ out->proc_list[i].s_addr = in->proc_list[i].s_addr;
|
|
|
+ }
|
|
|
+ for (i = 0; i < out->failed_list_entries; i++) {
|
|
|
+ out->failed_list[i].s_addr = in->failed_list[i].s_addr;
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+static void memb_commit_token_endian_convert (struct memb_commit_token *in, struct memb_commit_token *out)
|
|
|
+{
|
|
|
+ int i;
|
|
|
+
|
|
|
+ out->header.type = in->header.type;
|
|
|
+ out->header.endian_detector = ENDIAN_LOCAL;
|
|
|
+ out->token_seq = swab32 (in->token_seq);
|
|
|
+ out->ring_id.rep.s_addr = in->ring_id.rep.s_addr;
|
|
|
+ out->ring_id.seq = swab64 (in->ring_id.seq);
|
|
|
+ out->retrans_flg = swab32 (in->retrans_flg);
|
|
|
+ out->memb_index = swab32 (in->memb_index);
|
|
|
+ out->addr_entries = swab32 (in->addr_entries);
|
|
|
+ for (i = 0; i < out->addr_entries; i++) {
|
|
|
+ out->addr[i].s_addr = in->addr[i].s_addr;
|
|
|
+ out->memb_list[i].ring_id.rep.s_addr =
|
|
|
+ in->memb_list[i].ring_id.rep.s_addr;
|
|
|
+ out->memb_list[i].ring_id.seq =
|
|
|
+ swab64 (in->memb_list[i].ring_id.seq);
|
|
|
+ out->memb_list[i].aru = swab32 (in->memb_list[i].aru);
|
|
|
+ out->memb_list[i].high_delivered = swab32 (in->memb_list[i].high_delivered);
|
|
|
+ out->memb_list[i].received_flg = swab32 (in->memb_list[i].received_flg);
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+static void orf_token_endian_convert (struct orf_token *in, struct orf_token *out)
|
|
|
+{
|
|
|
+ int i;
|
|
|
+
|
|
|
+ out->header.type = in->header.type;
|
|
|
+ out->header.endian_detector = ENDIAN_LOCAL;
|
|
|
+ out->seq = swab32 (in->seq);
|
|
|
+ out->token_seq = swab32 (in->token_seq);
|
|
|
+ out->aru = swab32 (in->aru);
|
|
|
+ out->ring_id.rep.s_addr = in->ring_id.rep.s_addr;
|
|
|
+ out->ring_id.seq = swab64 (in->ring_id.seq);
|
|
|
+ out->fcc = swab32 (in->fcc);
|
|
|
+ out->retrans_flg = swab32 (in->retrans_flg);
|
|
|
+ out->rtr_list_entries = swab32 (in->rtr_list_entries);
|
|
|
+ for (i = 0; i < out->rtr_list_entries; i++) {
|
|
|
+ out->rtr_list[i].ring_id.rep.s_addr = in->rtr_list[i].ring_id.rep.s_addr;
|
|
|
+ out->rtr_list[i].ring_id.seq = swab64 (in->rtr_list[i].ring_id.seq);
|
|
|
+ out->rtr_list[i].seq = swab32 (in->rtr_list[i].seq);
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+static void mcast_endian_convert (struct mcast *in, struct mcast *out)
|
|
|
+{
|
|
|
+ out->header.type = in->header.type;
|
|
|
+ out->header.endian_detector = ENDIAN_LOCAL;
|
|
|
+ out->seq = swab32 (in->seq);
|
|
|
+ out->ring_id.rep.s_addr = in->ring_id.rep.s_addr;
|
|
|
+ out->ring_id.seq = swab64 (in->ring_id.seq);
|
|
|
+ out->source = in->source;
|
|
|
+ out->guarantee = in->guarantee;
|
|
|
+}
|
|
|
+
|
|
|
+static int message_handler_memb_join (
|
|
|
+ struct sockaddr_in *system_from,
|
|
|
+ struct iovec *iovec,
|
|
|
+ int iov_len,
|
|
|
+ int bytes_received,
|
|
|
+ int endian_conversion_needed)
|
|
|
+{
|
|
|
+ struct memb_join *memb_join;
|
|
|
+ struct memb_join memb_join_convert;
|
|
|
+
|
|
|
+ int gather_entered;
|
|
|
+
|
|
|
+ if (endian_conversion_needed) {
|
|
|
+ memb_join = &memb_join_convert;
|
|
|
+ memb_join_endian_convert (iovec->iov_base, &memb_join_convert);
|
|
|
+ } else {
|
|
|
+ memb_join = (struct memb_join *)iovec->iov_base;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (token_ring_id_seq < memb_join->ring_seq) {
|
|
|
+ token_ring_id_seq = memb_join->ring_seq;
|
|
|
+ }
|
|
|
+ switch (memb_state) {
|
|
|
+ case MEMB_STATE_OPERATIONAL:
|
|
|
+ gather_entered = memb_join_process (memb_join, system_from);
|
|
|
+ if (gather_entered == 0) {
|
|
|
+ memb_state_gather_enter ();
|
|
|
+ }
|
|
|
+ break;
|
|
|
+
|
|
|
+ case MEMB_STATE_GATHER:
|
|
|
+ memb_join_process (memb_join, system_from);
|
|
|
+ break;
|
|
|
+
|
|
|
+ case MEMB_STATE_COMMIT:
|
|
|
+ if (memb_set_subset (&system_from->sin_addr,
|
|
|
+ 1,
|
|
|
+ my_new_memb_list,
|
|
|
+ my_new_memb_entries) &&
|
|
|
+
|
|
|
+ memb_join->ring_seq >= my_ring_id.seq) {
|
|
|
+
|
|
|
+ memb_join_process (memb_join, system_from);
|
|
|
+ memb_state_gather_enter ();
|
|
|
+ }
|
|
|
+ break;
|
|
|
+
|
|
|
+ case MEMB_STATE_RECOVERY:
|
|
|
+ if (memb_set_subset (&system_from->sin_addr,
|
|
|
+ 1,
|
|
|
+ my_new_memb_list,
|
|
|
+ my_new_memb_entries) &&
|
|
|
+
|
|
|
+ memb_join->ring_seq >= my_ring_id.seq) {
|
|
|
+
|
|
|
+ memb_join_process (memb_join, system_from);
|
|
|
+ memb_state_gather_enter ();
|
|
|
+ my_aru = my_aru_save;
|
|
|
+ my_high_seq_received = my_high_seq_received_save;
|
|
|
+ sq_reinit (&recovery_sort_queue, 0);
|
|
|
+ queue_reinit (&retrans_message_queue);
|
|
|
+
|
|
|
+ // TODO calculate current old ring aru
|
|
|
+ }
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ return (0);
|
|
|
+}
|
|
|
+
|
|
|
+static int message_handler_memb_commit_token (
|
|
|
+ struct sockaddr_in *system_from,
|
|
|
+ struct iovec *iovec,
|
|
|
+ int iov_len,
|
|
|
+ int bytes_received,
|
|
|
+ int endian_conversion_needed)
|
|
|
+{
|
|
|
+ struct memb_commit_token memb_commit_token_convert;
|
|
|
+ struct memb_commit_token *memb_commit_token;
|
|
|
+ struct in_addr sub[MAX_MEMBERS];
|
|
|
+ int sub_entries;
|
|
|
+
|
|
|
+
|
|
|
+ if (endian_conversion_needed) {
|
|
|
+ memb_commit_token = &memb_commit_token_convert;
|
|
|
+ memb_commit_token_endian_convert (iovec->iov_base, memb_commit_token);
|
|
|
+ } else {
|
|
|
+ memb_commit_token = (struct memb_commit_token *)iovec->iov_base;
|
|
|
+ }
|
|
|
+
|
|
|
+/* TODO do we need to check for a duplicate token?
|
|
|
+ if (memb_commit_token->token_seq > 0 &&
|
|
|
+ my_token_seq >= memb_commit_token->token_seq) {
|
|
|
+
|
|
|
+ printf ("already received commit token %d %d\n",
|
|
|
+ memb_commit_token->token_seq, my_token_seq);
|
|
|
+ return (0);
|
|
|
+ }
|
|
|
+*/
|
|
|
+ switch (memb_state) {
|
|
|
+ case MEMB_STATE_OPERATIONAL:
|
|
|
+ /* discard token */
|
|
|
+ break;
|
|
|
+
|
|
|
+ case MEMB_STATE_GATHER:
|
|
|
+ memb_set_subtract (sub, &sub_entries,
|
|
|
+ my_proc_list, my_proc_list_entries,
|
|
|
+ my_failed_list, my_failed_list_entries);
|
|
|
+
|
|
|
+ if (memb_set_equal (memb_commit_token->addr,
|
|
|
+ memb_commit_token->addr_entries,
|
|
|
+ sub,
|
|
|
+ sub_entries) &&
|
|
|
+
|
|
|
+ memb_commit_token->ring_id.seq > my_ring_id.seq) {
|
|
|
+
|
|
|
+ memb_state_commit_enter (memb_commit_token);
|
|
|
+ }
|
|
|
+ break;
|
|
|
+
|
|
|
+ case MEMB_STATE_COMMIT:
|
|
|
+ // TODO add if to match spec
|
|
|
+// if (memb_commit_token->ring_seq == my_ring_id.seq) {
|
|
|
+ memb_state_recovery_enter (memb_commit_token);
|
|
|
+// }
|
|
|
+ break;
|
|
|
+
|
|
|
+ case MEMB_STATE_RECOVERY:
|
|
|
+ totemsrp_log_printf (totemsrp_log_level_notice,
|
|
|
+ "Sending initial ORF token\n");
|
|
|
+
|
|
|
+ if (my_id.sin_addr.s_addr == my_ring_id.rep.s_addr) {
|
|
|
+ // TODO convert instead of initiate
|
|
|
+ orf_token_send_initial ();
|
|
|
+ reset_token_timeout (); // REVIEWED
|
|
|
+ reset_token_retransmit_timeout (); // REVIEWED
|
|
|
+ }
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ return (0);
|
|
|
+}
|
|
|
+
|
|
|
+static int recv_handler (poll_handle handle, int fd, int revents,
|
|
|
+ void *data, unsigned int *prio)
|
|
|
+{
|
|
|
+ struct msghdr msg_recv;
|
|
|
+ struct message_header *message_header;
|
|
|
+ struct sockaddr_in system_from;
|
|
|
+ int res = 0;
|
|
|
+ int bytes_received;
|
|
|
+
|
|
|
+ *prio = UINT_MAX;
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Receive datagram
|
|
|
+ */
|
|
|
+ msg_recv.msg_name = &system_from;
|
|
|
+ msg_recv.msg_namelen = sizeof (struct sockaddr_in);
|
|
|
+ msg_recv.msg_iov = &totemsrp_iov_recv;
|
|
|
+ msg_recv.msg_iovlen = 1;
|
|
|
+ msg_recv.msg_control = 0;
|
|
|
+ msg_recv.msg_controllen = 0;
|
|
|
+ msg_recv.msg_flags = 0;
|
|
|
+
|
|
|
+ bytes_received = recvmsg (fd, &msg_recv, MSG_NOSIGNAL | MSG_DONTWAIT);
|
|
|
+ if (bytes_received == -1) {
|
|
|
+ return (0);
|
|
|
+ } else {
|
|
|
+ stats_recv += bytes_received;
|
|
|
+ }
|
|
|
+ if (bytes_received < sizeof (struct message_header)) {
|
|
|
+ totemsrp_log_printf (totemsrp_log_level_security, "Received message is too short... ignoring %d %d.\n", bytes_received);
|
|
|
+ return (0);
|
|
|
+ }
|
|
|
+
|
|
|
+ message_header = (struct message_header *)msg_recv.msg_iov->iov_base;
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Authenticate and if authenticated, decrypt datagram
|
|
|
+ */
|
|
|
+ totemsrp_iov_recv.iov_len = bytes_received;
|
|
|
+ res = authenticate_and_decrypt (&totemsrp_iov_recv);
|
|
|
+ log_digest = 0;
|
|
|
+ if (res == -1) {
|
|
|
+printf ("message header type %d %d\n", message_header->type, bytes_received);
|
|
|
+ totemsrp_iov_recv.iov_len = PACKET_SIZE_MAX;
|
|
|
+//exit (1);
|
|
|
+ return 0;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (stats_tv_start.tv_usec == 0) {
|
|
|
+ gettimeofday (&stats_tv_start, NULL);
|
|
|
+ }
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Handle incoming message
|
|
|
+ */
|
|
|
+ message_header = (struct message_header *)msg_recv.msg_iov[0].iov_base;
|
|
|
+ totemsrp_message_handlers.handler_functions[(int)message_header->type] (
|
|
|
+ &system_from,
|
|
|
+ msg_recv.msg_iov,
|
|
|
+ msg_recv.msg_iovlen,
|
|
|
+ bytes_received,
|
|
|
+ message_header->endian_detector != ENDIAN_LOCAL);
|
|
|
+
|
|
|
+ totemsrp_iov_recv.iov_len = PACKET_SIZE_MAX;
|
|
|
+ return (0);
|
|
|
+}
|