| 1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942 |
- /*
- * Copyright (c) 2016-2019 Red Hat, Inc.
- *
- * All rights reserved.
- *
- * Author: Christine Caulfield (ccaulfie@redhat.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.
- */
- #include <config.h>
- #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/ioctl.h>
- #include <sys/param.h>
- #include <netinet/in.h>
- #include <net/ethernet.h>
- #include <arpa/inet.h>
- #include <unistd.h>
- #include <fcntl.h>
- #include <stdlib.h>
- #include <stdio.h>
- #include <errno.h>
- #include <pthread.h>
- #include <sched.h>
- #include <time.h>
- #include <sys/time.h>
- #include <sys/poll.h>
- #include <sys/uio.h>
- #include <limits.h>
- #include <qb/qbdefs.h>
- #include <qb/qbloop.h>
- #ifdef HAVE_LIBNOZZLE
- #include <libgen.h>
- #include <libnozzle.h>
- #endif
- #include <corosync/sq.h>
- #include <corosync/swab.h>
- #include <corosync/logsys.h>
- #include <corosync/icmap.h>
- #include <corosync/totem/totemip.h>
- #include "totemknet.h"
- #include "main.h"
- #include "util.h"
- #include <libknet.h>
- #include <corosync/totem/totemstats.h>
- #ifndef MSG_NOSIGNAL
- #define MSG_NOSIGNAL 0
- #endif
- #ifdef HAVE_LIBNOZZLE
- static int setup_nozzle(void *knet_context);
- #endif
- /* Should match that used by cfg */
- #define CFG_INTERFACE_STATUS_MAX_LEN 512
- struct totemknet_instance {
- struct crypto_instance *crypto_inst;
- qb_loop_t *poll_handle;
- knet_handle_t knet_handle;
- int link_mode;
- void *context;
- void (*totemknet_deliver_fn) (
- void *context,
- const void *msg,
- unsigned int msg_len,
- const struct sockaddr_storage *system_from);
- void (*totemknet_iface_change_fn) (
- void *context,
- const struct totem_ip_address *iface_address,
- unsigned int link_no);
- void (*totemknet_mtu_changed) (
- void *context,
- int net_mtu);
- void (*totemknet_target_set_completed) (void *context);
- /*
- * Function and data used to log messages
- */
- int totemknet_log_level_security;
- int totemknet_log_level_error;
- int totemknet_log_level_warning;
- int totemknet_log_level_notice;
- int totemknet_log_level_debug;
- int totemknet_subsys_id;
- int knet_subsys_id;
- void (*totemknet_log_printf) (
- int level,
- int subsys,
- const char *function,
- const char *file,
- int line,
- const char *format,
- ...)__attribute__((format(printf, 6, 7)));
- void *knet_context;
- char iov_buffer[KNET_MAX_PACKET_SIZE];
- char *link_status[INTERFACE_MAX];
- struct totem_ip_address my_ids[INTERFACE_MAX];
- uint16_t ip_port[INTERFACE_MAX];
- int our_nodeid;
- int loopback_link;
- struct totem_config *totem_config;
- struct totem_ip_address token_target;
- qb_loop_timer_handle timer_netif_check_timeout;
- qb_loop_timer_handle timer_merge_detect_timeout;
- int send_merge_detect_message;
- unsigned int merge_detect_messages_sent_before_timeout;
- int logpipes[2];
- int knet_fd;
- pthread_mutex_t log_mutex;
- #ifdef HAVE_LIBNOZZLE
- char *nozzle_name;
- char *nozzle_ipaddr;
- char *nozzle_prefix;
- char *nozzle_macaddr;
- nozzle_t nozzle_handle;
- #endif
- };
- /* Awkward. But needed to get stats from knet */
- struct totemknet_instance *global_instance;
- struct work_item {
- const void *msg;
- unsigned int msg_len;
- struct totemknet_instance *instance;
- };
- int totemknet_member_list_rebind_ip (
- void *knet_context);
- static void totemknet_start_merge_detect_timeout(
- void *knet_context);
- static void totemknet_stop_merge_detect_timeout(
- void *knet_context);
- static void log_flush_messages (
- void *knet_context);
- static void totemknet_instance_initialize (struct totemknet_instance *instance)
- {
- int res;
- memset (instance, 0, sizeof (struct totemknet_instance));
- res = pthread_mutex_init(&instance->log_mutex, NULL);
- /*
- * There is not too much else what can be done.
- */
- assert(res == 0);
- }
- #define knet_log_printf_lock(level, subsys, function, file, line, format, args...) \
- do { \
- (void)pthread_mutex_lock(&instance->log_mutex); \
- instance->totemknet_log_printf ( \
- level, subsys, function, file, line, \
- (const char *)format, ##args); \
- (void)pthread_mutex_unlock(&instance->log_mutex); \
- } while (0);
- #define knet_log_printf(level, format, args...) \
- do { \
- knet_log_printf_lock ( \
- level, instance->totemknet_subsys_id, \
- __FUNCTION__, __FILE__, __LINE__, \
- (const char *)format, ##args); \
- } while (0);
- #define libknet_log_printf(level, format, args...) \
- do { \
- knet_log_printf_lock ( \
- level, instance->knet_subsys_id, \
- __FUNCTION__, "libknet.h", __LINE__, \
- (const char *)format, ##args); \
- } while (0);
- #define KNET_LOGSYS_PERROR(err_num, level, fmt, args...) \
- do { \
- char _error_str[LOGSYS_MAX_PERROR_MSG_LEN]; \
- const char *_error_ptr = qb_strerror_r(err_num, _error_str, sizeof(_error_str)); \
- instance->totemknet_log_printf ( \
- level, instance->totemknet_subsys_id, \
- __FUNCTION__, __FILE__, __LINE__, \
- fmt ": %s (%d)", ##args, _error_ptr, err_num); \
- } while(0)
- #ifdef HAVE_LIBNOZZLE
- static inline int is_ether_addr_multicast(const uint8_t *addr)
- {
- return (addr[0] & 0x01);
- }
- static inline int is_ether_addr_zero(const uint8_t *addr)
- {
- return (!addr[0] && !addr[1] && !addr[2] && !addr[3] && !addr[4] && !addr[5]);
- }
- static int ether_host_filter_fn(void *private_data,
- const unsigned char *outdata,
- ssize_t outdata_len,
- uint8_t tx_rx,
- knet_node_id_t this_host_id,
- knet_node_id_t src_host_id,
- int8_t *channel,
- knet_node_id_t *dst_host_ids,
- size_t *dst_host_ids_entries)
- {
- struct ether_header *eth_h = (struct ether_header *)outdata;
- uint8_t *dst_mac = (uint8_t *)eth_h->ether_dhost;
- uint16_t dst_host_id;
- if (is_ether_addr_zero(dst_mac))
- return -1;
- if (is_ether_addr_multicast(dst_mac)) {
- return 1;
- }
- memmove(&dst_host_id, &dst_mac[4], 2);
- dst_host_ids[0] = ntohs(dst_host_id);
- *dst_host_ids_entries = 1;
- return 0;
- }
- #endif
- static int dst_host_filter_callback_fn(void *private_data,
- const unsigned char *outdata,
- ssize_t outdata_len,
- uint8_t tx_rx,
- knet_node_id_t this_host_id,
- knet_node_id_t src_host_id,
- int8_t *channel,
- knet_node_id_t *dst_host_ids,
- size_t *dst_host_ids_entries)
- {
- struct totem_message_header *header = (struct totem_message_header *)outdata;
- int res;
- #ifdef HAVE_LIBNOZZLE
- if (*channel != 0) {
- return ether_host_filter_fn(private_data,
- outdata, outdata_len,
- tx_rx,
- this_host_id, src_host_id,
- channel,
- dst_host_ids,
- dst_host_ids_entries);
- }
- #endif
- if (header->target_nodeid) {
- dst_host_ids[0] = header->target_nodeid;
- *dst_host_ids_entries = 1;
- res = 0; /* unicast message */
- }
- else {
- *dst_host_ids_entries = 0;
- res = 1; /* multicast message */
- }
- return res;
- }
- static void socket_error_callback_fn(void *private_data, int datafd, int8_t channel, uint8_t tx_rx, int error, int errorno)
- {
- struct totemknet_instance *instance = (struct totemknet_instance *)private_data;
- knet_log_printf (LOGSYS_LEVEL_DEBUG, "Knet socket ERROR notification called: txrx=%d, error=%d, errorno=%d", tx_rx, error, errorno);
- if ((error == -1 && errorno != EAGAIN) || (error == 0)) {
- knet_handle_remove_datafd(instance->knet_handle, datafd);
- }
- }
- static void host_change_callback_fn(void *private_data, knet_node_id_t host_id, uint8_t reachable, uint8_t remote, uint8_t external)
- {
- struct totemknet_instance *instance = (struct totemknet_instance *)private_data;
- // TODO: what? if anything.
- knet_log_printf (LOGSYS_LEVEL_DEBUG, "Knet host change callback. nodeid: " CS_PRI_NODE_ID " reachable: %d", host_id, reachable);
- }
- static void pmtu_change_callback_fn(void *private_data, unsigned int data_mtu)
- {
- struct totemknet_instance *instance = (struct totemknet_instance *)private_data;
- knet_log_printf (LOGSYS_LEVEL_DEBUG, "Knet pMTU change: %d", data_mtu);
- /* We don't need to tell corosync the actual knet MTU */
- // instance->totemknet_mtu_changed(instance->context, data_mtu);
- }
- int totemknet_crypto_set (
- void *knet_context,
- const char *cipher_type,
- const char *hash_type)
- {
- return (0);
- }
- static inline void ucast_sendmsg (
- struct totemknet_instance *instance,
- struct totem_ip_address *system_to,
- const void *msg,
- unsigned int msg_len)
- {
- int res = 0;
- struct totem_message_header *header = (struct totem_message_header *)msg;
- struct msghdr msg_ucast;
- struct iovec iovec;
- header->target_nodeid = system_to->nodeid;
- iovec.iov_base = (void *)msg;
- iovec.iov_len = msg_len;
- /*
- * Build unicast message
- */
- memset(&msg_ucast, 0, sizeof(msg_ucast));
- msg_ucast.msg_iov = (void *)&iovec;
- msg_ucast.msg_iovlen = 1;
- #ifdef HAVE_MSGHDR_CONTROL
- msg_ucast.msg_control = 0;
- #endif
- #ifdef HAVE_MSGHDR_CONTROLLEN
- msg_ucast.msg_controllen = 0;
- #endif
- #ifdef HAVE_MSGHDR_FLAGS
- msg_ucast.msg_flags = 0;
- #endif
- #ifdef HAVE_MSGHDR_ACCRIGHTS
- msg_ucast.msg_accrights = NULL;
- #endif
- #ifdef HAVE_MSGHDR_ACCRIGHTSLEN
- msg_ucast.msg_accrightslen = 0;
- #endif
- /*
- * Transmit unicast message
- * An error here is recovered by totemsrp
- */
- res = sendmsg (instance->knet_fd, &msg_ucast, MSG_NOSIGNAL);
- if (res < 0) {
- KNET_LOGSYS_PERROR (errno, instance->totemknet_log_level_debug,
- "sendmsg(ucast) failed (non-critical)");
- }
- }
- static inline void mcast_sendmsg (
- struct totemknet_instance *instance,
- const void *msg,
- unsigned int msg_len,
- int only_active)
- {
- int res;
- struct totem_message_header *header = (struct totem_message_header *)msg;
- struct msghdr msg_mcast;
- struct iovec iovec;
- iovec.iov_base = (void *)msg;
- iovec.iov_len = msg_len;
- header->target_nodeid = 0;
- /*
- * Build multicast message
- */
- memset(&msg_mcast, 0, sizeof(msg_mcast));
- msg_mcast.msg_iov = (void *)&iovec;
- msg_mcast.msg_iovlen = 1;
- #ifdef HAVE_MSGHDR_CONTROL
- msg_mcast.msg_control = 0;
- #endif
- #ifdef HAVE_MSGHDR_CONTROLLEN
- msg_mcast.msg_controllen = 0;
- #endif
- #ifdef HAVE_MSGHDR_FLAGS
- msg_mcast.msg_flags = 0;
- #endif
- #ifdef HAVE_MSGHDR_ACCRIGHTS
- msg_mcast.msg_accrights = NULL;
- #endif
- #ifdef HAVE_MSGHDR_ACCRIGHTSLEN
- msg_mcast.msg_accrightslen = 0;
- #endif
- // log_printf (LOGSYS_LEVEL_DEBUG, "totemknet: mcast_sendmsg. only_active=%d, len=%d", only_active, msg_len);
- res = sendmsg (instance->knet_fd, &msg_mcast, MSG_NOSIGNAL);
- if (res < msg_len) {
- knet_log_printf (LOGSYS_LEVEL_DEBUG, "totemknet: mcast_send sendmsg returned %d", res);
- }
- if (!only_active || instance->send_merge_detect_message) {
- /*
- * Current message was sent to all nodes
- */
- instance->merge_detect_messages_sent_before_timeout++;
- instance->send_merge_detect_message = 0;
- }
- }
- static int node_compare(const void *aptr, const void *bptr)
- {
- uint16_t a,b;
- a = *(uint16_t *)aptr;
- b = *(uint16_t *)bptr;
- return a > b;
- }
- int totemknet_ifaces_get (void *knet_context,
- char ***status,
- unsigned int *iface_count)
- {
- struct totemknet_instance *instance = (struct totemknet_instance *)knet_context;
- struct knet_link_status link_status;
- knet_node_id_t host_list[KNET_MAX_HOST];
- uint8_t link_list[KNET_MAX_LINK];
- size_t num_hosts;
- size_t num_links;
- size_t link_idx;
- int i,j;
- char *ptr;
- int res = 0;
- /*
- * Don't do the whole 'link_info' bit if the caller just wants
- * a count of interfaces.
- */
- if (status) {
- res = knet_host_get_host_list(instance->knet_handle,
- host_list, &num_hosts);
- if (res) {
- return (-1);
- }
- qsort(host_list, num_hosts, sizeof(uint16_t), node_compare);
- for (i=0; i<INTERFACE_MAX; i++) {
- memset(instance->link_status[i], 'n', CFG_INTERFACE_STATUS_MAX_LEN-1);
- instance->link_status[i][num_hosts] = '\0';
- }
- /* This is all a bit "inside-out" because "status" is a set of strings per link
- * and knet orders things by host
- */
- for (j=0; j<num_hosts; j++) {
- res = knet_link_get_link_list(instance->knet_handle,
- host_list[j], link_list, &num_links);
- if (res) {
- return (-1);
- }
- link_idx = 0;
- for (i=0; i < num_links; i++) {
- /*
- * Skip over links that are unconfigured to corosync. This is basically
- * link0 if corosync isn't using it for comms, as we will still
- * have it set up for loopback.
- */
- if (!instance->totem_config->interfaces[link_list[i]].configured) {
- continue;
- }
- ptr = instance->link_status[link_idx++];
- res = knet_link_get_status(instance->knet_handle,
- host_list[j],
- link_list[i],
- &link_status,
- sizeof(link_status));
- if (res == 0) {
- ptr[j] = '0' + (link_status.enabled |
- link_status.connected<<1 |
- link_status.dynconnected<<2);
- }
- else {
- ptr[j] = '?';
- }
- }
- }
- *status = instance->link_status;
- }
- *iface_count = INTERFACE_MAX;
- return (res);
- }
- int totemknet_finalize (
- void *knet_context)
- {
- struct totemknet_instance *instance = (struct totemknet_instance *)knet_context;
- int res = 0;
- int i,j;
- static knet_node_id_t nodes[KNET_MAX_HOST]; /* static to save stack */
- uint8_t links[KNET_MAX_LINK];
- size_t num_nodes;
- size_t num_links;
- knet_log_printf(LOG_DEBUG, "totemknet: finalize");
- qb_loop_poll_del (instance->poll_handle, instance->logpipes[0]);
- qb_loop_poll_del (instance->poll_handle, instance->knet_fd);
- /*
- * Disable forwarding to make knet flush send queue. This ensures that the LEAVE message will be sent.
- */
- res = knet_handle_setfwd(instance->knet_handle, 0);
- if (res) {
- knet_log_printf (LOGSYS_LEVEL_CRIT, "totemknet: knet_handle_setfwd failed: %s", strerror(errno));
- }
- res = knet_host_get_host_list(instance->knet_handle, nodes, &num_nodes);
- if (res) {
- knet_log_printf (LOGSYS_LEVEL_ERROR, "Cannot get knet node list for shutdown: %s", strerror(errno));
- /* Crash out anyway */
- goto finalise_error;
- }
- /* Tidily shut down all nodes & links. */
- for (i=0; i<num_nodes; i++) {
- res = knet_link_get_link_list(instance->knet_handle, nodes[i], links, &num_links);
- if (res) {
- knet_log_printf (LOGSYS_LEVEL_ERROR, "Cannot get knet link list for node " CS_PRI_NODE_ID ": %s", nodes[i], strerror(errno));
- goto finalise_error;
- }
- for (j=0; j<num_links; j++) {
- res = knet_link_set_enable(instance->knet_handle, nodes[i], links[j], 0);
- if (res) {
- knet_log_printf (LOGSYS_LEVEL_ERROR, "totemknet: knet_link_set_enable(node " CS_PRI_NODE_ID ", link %d) failed: %s", nodes[i], links[j], strerror(errno));
- }
- res = knet_link_clear_config(instance->knet_handle, nodes[i], links[j]);
- if (res) {
- knet_log_printf (LOGSYS_LEVEL_ERROR, "totemknet: knet_link_clear_config(node " CS_PRI_NODE_ID ", link %d) failed: %s", nodes[i], links[j], strerror(errno));
- }
- }
- res = knet_host_remove(instance->knet_handle, nodes[i]);
- if (res) {
- knet_log_printf (LOGSYS_LEVEL_ERROR, "totemknet: knet_host_remove(node " CS_PRI_NODE_ID ") failed: %s", nodes[i], strerror(errno));
- }
- }
- finalise_error:
- res = knet_handle_free(instance->knet_handle);
- if (res) {
- knet_log_printf (LOGSYS_LEVEL_CRIT, "totemknet: knet_handle_free failed: %s", strerror(errno));
- }
- totemknet_stop_merge_detect_timeout(instance);
- log_flush_messages(instance);
- /*
- * Error is deliberately ignored
- */
- (void)pthread_mutex_destroy(&instance->log_mutex);
- return (res);
- }
- static int log_deliver_fn (
- int fd,
- int revents,
- void *data)
- {
- struct totemknet_instance *instance = (struct totemknet_instance *)data;
- char buffer[sizeof(struct knet_log_msg)*4];
- char *bufptr = buffer;
- int done = 0;
- int len;
- len = read(fd, buffer, sizeof(buffer));
- while (done < len) {
- struct knet_log_msg *msg = (struct knet_log_msg *)bufptr;
- switch (msg->msglevel) {
- case KNET_LOG_ERR:
- libknet_log_printf (LOGSYS_LEVEL_ERROR, "%s: %s",
- knet_log_get_subsystem_name(msg->subsystem),
- msg->msg);
- break;
- case KNET_LOG_WARN:
- libknet_log_printf (LOGSYS_LEVEL_WARNING, "%s: %s",
- knet_log_get_subsystem_name(msg->subsystem),
- msg->msg);
- break;
- case KNET_LOG_INFO:
- libknet_log_printf (LOGSYS_LEVEL_INFO, "%s: %s",
- knet_log_get_subsystem_name(msg->subsystem),
- msg->msg);
- break;
- case KNET_LOG_DEBUG:
- libknet_log_printf (LOGSYS_LEVEL_DEBUG, "%s: %s",
- knet_log_get_subsystem_name(msg->subsystem),
- msg->msg);
- break;
- }
- bufptr += sizeof(struct knet_log_msg);
- done += sizeof(struct knet_log_msg);
- }
- return 0;
- }
- static int data_deliver_fn (
- int fd,
- int revents,
- void *data)
- {
- struct totemknet_instance *instance = (struct totemknet_instance *)data;
- struct msghdr msg_hdr;
- struct iovec iov_recv;
- struct sockaddr_storage system_from;
- ssize_t msg_len;
- int truncated_packet;
- iov_recv.iov_base = instance->iov_buffer;
- iov_recv.iov_len = KNET_MAX_PACKET_SIZE;
- msg_hdr.msg_name = &system_from;
- msg_hdr.msg_namelen = sizeof (struct sockaddr_storage);
- msg_hdr.msg_iov = &iov_recv;
- msg_hdr.msg_iovlen = 1;
- #ifdef HAVE_MSGHDR_CONTROL
- msg_hdr.msg_control = 0;
- #endif
- #ifdef HAVE_MSGHDR_CONTROLLEN
- msg_hdr.msg_controllen = 0;
- #endif
- #ifdef HAVE_MSGHDR_FLAGS
- msg_hdr.msg_flags = 0;
- #endif
- #ifdef HAVE_MSGHDR_ACCRIGHTS
- msg_hdr.msg_accrights = NULL;
- #endif
- #ifdef HAVE_MSGHDR_ACCRIGHTSLEN
- msg_hdr.msg_accrightslen = 0;
- #endif
- msg_len = recvmsg (fd, &msg_hdr, MSG_NOSIGNAL | MSG_DONTWAIT);
- if (msg_len <= 0) {
- return (0);
- }
- truncated_packet = 0;
- #ifdef HAVE_MSGHDR_FLAGS
- if (msg_hdr.msg_flags & MSG_TRUNC) {
- truncated_packet = 1;
- }
- #else
- /*
- * We don't have MSGHDR_FLAGS, but we can (hopefully) safely make assumption that
- * if bytes_received == KNET_MAX_PACKET_SIZE then packet is truncated
- */
- if (bytes_received == KNET_MAX_PACKET_SIZE) {
- truncated_packet = 1;
- }
- #endif
- if (truncated_packet) {
- knet_log_printf(instance->totemknet_log_level_error,
- "Received too big message. This may be because something bad is happening"
- "on the network (attack?), or you tried join more nodes than corosync is"
- "compiled with (%u) or bug in the code (bad estimation of "
- "the KNET_MAX_PACKET_SIZE). Dropping packet.", PROCESSOR_COUNT_MAX);
- return (0);
- }
- /*
- * Handle incoming message
- */
- instance->totemknet_deliver_fn (
- instance->context,
- instance->iov_buffer,
- msg_len,
- &system_from);
- return (0);
- }
- static void timer_function_netif_check_timeout (
- void *data)
- {
- struct totemknet_instance *instance = (struct totemknet_instance *)data;
- int i;
- for (i=0; i < INTERFACE_MAX; i++) {
- if (!instance->totem_config->interfaces[i].configured) {
- continue;
- }
- instance->totemknet_iface_change_fn (instance->context,
- &instance->my_ids[i],
- i);
- }
- }
- static void knet_set_access_list_config(struct totemknet_instance *instance)
- {
- #ifdef HAVE_KNET_ACCESS_LIST
- uint32_t value;
- cs_error_t err;
- value = instance->totem_config->block_unlisted_ips;
- knet_log_printf (LOGSYS_LEVEL_DEBUG, "knet_enable access list: %d", value);
- err = knet_handle_enable_access_lists(instance->knet_handle, value);
- if (err) {
- KNET_LOGSYS_PERROR(errno, LOGSYS_LEVEL_WARNING, "knet_handle_enable_access_lists failed");
- }
- #endif
- }
- /* NOTE: this relies on the fact that totem_reload_notify() is called first */
- static void totemknet_refresh_config(
- int32_t event,
- const char *key_name,
- struct icmap_notify_value new_val,
- struct icmap_notify_value old_val,
- void *user_data)
- {
- uint8_t reloading;
- uint32_t value;
- uint32_t link_no;
- size_t num_nodes;
- knet_node_id_t host_ids[KNET_MAX_HOST];
- int i;
- int err;
- struct totemknet_instance *instance = (struct totemknet_instance *)user_data;
- ENTER();
- /*
- * If a full reload is in progress then don't do anything until it's done and
- * can reconfigure it all atomically
- */
- if (icmap_get_uint8("config.totemconfig_reload_in_progress", &reloading) == CS_OK && reloading) {
- return;
- }
- knet_set_access_list_config(instance);
- if (icmap_get_uint32("totem.knet_pmtud_interval", &value) == CS_OK) {
- instance->totem_config->knet_pmtud_interval = value;
- knet_log_printf (LOGSYS_LEVEL_DEBUG, "knet_pmtud_interval now %d", value);
- err = knet_handle_pmtud_setfreq(instance->knet_handle, instance->totem_config->knet_pmtud_interval);
- if (err) {
- KNET_LOGSYS_PERROR(errno, LOGSYS_LEVEL_WARNING, "knet_handle_pmtud_setfreq failed");
- }
- }
- /* Configure link parameters for each node */
- err = knet_host_get_host_list(instance->knet_handle, host_ids, &num_nodes);
- if (err != 0) {
- KNET_LOGSYS_PERROR(errno, LOGSYS_LEVEL_ERROR, "knet_host_get_host_list failed");
- }
- for (i=0; i<num_nodes; i++) {
- for (link_no = 0; link_no < INTERFACE_MAX; link_no++) {
- if (host_ids[i] == instance->our_nodeid || !instance->totem_config->interfaces[link_no].configured) {
- continue;
- }
- err = knet_link_set_ping_timers(instance->knet_handle, host_ids[i], link_no,
- instance->totem_config->interfaces[link_no].knet_ping_interval,
- instance->totem_config->interfaces[link_no].knet_ping_timeout,
- instance->totem_config->interfaces[link_no].knet_ping_precision);
- if (err) {
- KNET_LOGSYS_PERROR(errno, LOGSYS_LEVEL_ERROR, "knet_link_set_ping_timers for node " CS_PRI_NODE_ID " link %d failed", host_ids[i], link_no);
- }
- err = knet_link_set_pong_count(instance->knet_handle, host_ids[i], link_no,
- instance->totem_config->interfaces[link_no].knet_pong_count);
- if (err) {
- KNET_LOGSYS_PERROR(errno, LOGSYS_LEVEL_ERROR, "knet_link_set_pong_count for node " CS_PRI_NODE_ID " link %d failed",host_ids[i], link_no);
- }
- err = knet_link_set_priority(instance->knet_handle, host_ids[i], link_no,
- instance->totem_config->interfaces[link_no].knet_link_priority);
- if (err) {
- KNET_LOGSYS_PERROR(errno, LOGSYS_LEVEL_ERROR, "knet_link_set_priority for node " CS_PRI_NODE_ID " link %d failed", host_ids[i], link_no);
- }
- }
- }
- LEAVE();
- }
- static void totemknet_add_config_notifications(struct totemknet_instance *instance)
- {
- icmap_track_t icmap_track_totem = NULL;
- icmap_track_t icmap_track_reload = NULL;
- ENTER();
- icmap_track_add("totem.",
- ICMAP_TRACK_ADD | ICMAP_TRACK_DELETE | ICMAP_TRACK_MODIFY | ICMAP_TRACK_PREFIX,
- totemknet_refresh_config,
- instance,
- &icmap_track_totem);
- icmap_track_add("config.totemconfig_reload_in_progress",
- ICMAP_TRACK_ADD | ICMAP_TRACK_MODIFY,
- totemknet_refresh_config,
- instance,
- &icmap_track_reload);
- LEAVE();
- }
- /*
- * Create an instance
- */
- int totemknet_initialize (
- qb_loop_t *poll_handle,
- void **knet_context,
- struct totem_config *totem_config,
- totemsrp_stats_t *stats,
- void *context,
- void (*deliver_fn) (
- void *context,
- const void *msg,
- unsigned int msg_len,
- const struct sockaddr_storage *system_from),
- void (*iface_change_fn) (
- void *context,
- const struct totem_ip_address *iface_address,
- unsigned int link_no),
- void (*mtu_changed) (
- void *context,
- int net_mtu),
- void (*target_set_completed) (
- void *context))
- {
- struct totemknet_instance *instance;
- int8_t channel=0;
- int res;
- int i;
- instance = malloc (sizeof (struct totemknet_instance));
- if (instance == NULL) {
- return (-1);
- }
- totemknet_instance_initialize (instance);
- instance->totem_config = totem_config;
- /*
- * Configure logging
- */
- instance->totemknet_log_level_security = 1; //totem_config->totem_logging_configuration.log_level_security;
- instance->totemknet_log_level_error = totem_config->totem_logging_configuration.log_level_error;
- instance->totemknet_log_level_warning = totem_config->totem_logging_configuration.log_level_warning;
- instance->totemknet_log_level_notice = totem_config->totem_logging_configuration.log_level_notice;
- instance->totemknet_log_level_debug = totem_config->totem_logging_configuration.log_level_debug;
- instance->totemknet_subsys_id = totem_config->totem_logging_configuration.log_subsys_id;
- instance->totemknet_log_printf = totem_config->totem_logging_configuration.log_printf;
- instance->knet_subsys_id = _logsys_subsys_create("KNET", "libknet.h");
- /*
- * Initialize local variables for totemknet
- */
- instance->our_nodeid = instance->totem_config->node_id;
- for (i=0; i< INTERFACE_MAX; i++) {
- totemip_copy(&instance->my_ids[i], &totem_config->interfaces[i].bindnet);
- instance->my_ids[i].nodeid = instance->our_nodeid;
- instance->ip_port[i] = totem_config->interfaces[i].ip_port;
- /* Needed for totemsrp */
- totem_config->interfaces[i].boundto.nodeid = instance->our_nodeid;
- }
- instance->poll_handle = poll_handle;
- instance->context = context;
- instance->totemknet_deliver_fn = deliver_fn;
- instance->totemknet_iface_change_fn = iface_change_fn;
- instance->totemknet_mtu_changed = mtu_changed;
- instance->totemknet_target_set_completed = target_set_completed;
- instance->loopback_link = 0;
- res = pipe(instance->logpipes);
- if (res == -1) {
- KNET_LOGSYS_PERROR(errno, LOGSYS_LEVEL_CRIT, "failed to create pipe for instance->logpipes");
- goto exit_error;
- }
- if (fcntl(instance->logpipes[0], F_SETFL, O_NONBLOCK) == -1 ||
- fcntl(instance->logpipes[1], F_SETFL, O_NONBLOCK) == -1) {
- KNET_LOGSYS_PERROR(errno, LOGSYS_LEVEL_CRIT, "failed to set O_NONBLOCK flag for instance->logpipes");
- goto exit_error;
- }
- #if !defined(KNET_API_VER) || (KNET_API_VER == 1)
- instance->knet_handle = knet_handle_new(instance->totem_config->node_id, instance->logpipes[1], KNET_LOG_DEBUG);
- #endif
- #if KNET_API_VER == 2
- instance->knet_handle = knet_handle_new(instance->totem_config->node_id, instance->logpipes[1], KNET_LOG_DEBUG, KNET_HANDLE_FLAG_PRIVILEGED);
- #endif
- if (!instance->knet_handle) {
- KNET_LOGSYS_PERROR(errno, LOGSYS_LEVEL_CRIT, "knet_handle_new failed");
- goto exit_error;
- }
- knet_set_access_list_config(instance);
- res = knet_handle_pmtud_setfreq(instance->knet_handle, instance->totem_config->knet_pmtud_interval);
- if (res) {
- KNET_LOGSYS_PERROR(errno, LOGSYS_LEVEL_WARNING, "knet_handle_pmtud_setfreq failed");
- }
- res = knet_handle_enable_filter(instance->knet_handle, instance, dst_host_filter_callback_fn);
- if (res) {
- KNET_LOGSYS_PERROR(errno, LOGSYS_LEVEL_WARNING, "knet_handle_enable_filter failed");
- }
- res = knet_handle_enable_sock_notify(instance->knet_handle, instance, socket_error_callback_fn);
- if (res) {
- KNET_LOGSYS_PERROR(errno, LOGSYS_LEVEL_WARNING, "knet_handle_enable_sock_notify failed");
- }
- res = knet_host_enable_status_change_notify(instance->knet_handle, instance, host_change_callback_fn);
- if (res) {
- KNET_LOGSYS_PERROR(errno, LOGSYS_LEVEL_WARNING, "knet_host_enable_status_change_notify failed");
- }
- res = knet_handle_enable_pmtud_notify(instance->knet_handle, instance, pmtu_change_callback_fn);
- if (res) {
- KNET_LOGSYS_PERROR(errno, LOGSYS_LEVEL_WARNING, "knet_handle_enable_pmtud_notify failed");
- }
- global_instance = instance;
- /* Get an fd into knet */
- instance->knet_fd = 0;
- res = knet_handle_add_datafd(instance->knet_handle, &instance->knet_fd, &channel);
- if (res) {
- knet_log_printf(LOG_DEBUG, "knet_handle_add_datafd failed: %s", strerror(errno));
- goto exit_error;
- }
- /* Enable crypto if requested */
- if (strcmp(instance->totem_config->crypto_cipher_type, "none") != 0) {
- struct knet_handle_crypto_cfg crypto_cfg;
- assert(strlen(instance->totem_config->crypto_model) < sizeof(crypto_cfg.crypto_model));
- strcpy(crypto_cfg.crypto_model, instance->totem_config->crypto_model);
- assert(strlen(instance->totem_config->crypto_cipher_type) < sizeof(crypto_cfg.crypto_cipher_type));
- strcpy(crypto_cfg.crypto_cipher_type, instance->totem_config->crypto_cipher_type);
- assert(strlen(instance->totem_config->crypto_hash_type) < sizeof(crypto_cfg.crypto_hash_type));
- strcpy(crypto_cfg.crypto_hash_type, instance->totem_config->crypto_hash_type);
- assert(instance->totem_config->private_key_len <= sizeof(crypto_cfg.private_key));
- memcpy(crypto_cfg.private_key, instance->totem_config->private_key, instance->totem_config->private_key_len);
- crypto_cfg.private_key_len = instance->totem_config->private_key_len;
- res = knet_handle_crypto(instance->knet_handle, &crypto_cfg);
- if (res == -1) {
- knet_log_printf(LOGSYS_LEVEL_ERROR, "knet_handle_crypto failed: %s", strerror(errno));
- goto exit_error;
- }
- if (res == -2) {
- knet_log_printf(LOGSYS_LEVEL_ERROR, "knet_handle_crypto failed: -2");
- goto exit_error;
- }
- knet_log_printf(LOG_INFO, "kronosnet crypto initialized: %s/%s", crypto_cfg.crypto_cipher_type, crypto_cfg.crypto_hash_type);
- }
- /* Set up compression */
- totemknet_reconfigure(instance, instance->totem_config);
- knet_handle_setfwd(instance->knet_handle, 1);
- instance->link_mode = KNET_LINK_POLICY_PASSIVE;
- if (strcmp(instance->totem_config->link_mode, "active")==0) {
- instance->link_mode = KNET_LINK_POLICY_ACTIVE;
- }
- if (strcmp(instance->totem_config->link_mode, "rr")==0) {
- instance->link_mode = KNET_LINK_POLICY_RR;
- }
- for (i=0; i<INTERFACE_MAX; i++) {
- instance->link_status[i] = malloc(CFG_INTERFACE_STATUS_MAX_LEN);
- if (!instance->link_status[i]) {
- goto exit_error;
- }
- }
- qb_loop_poll_add (instance->poll_handle,
- QB_LOOP_MED,
- instance->logpipes[0],
- POLLIN, instance, log_deliver_fn);
- qb_loop_poll_add (instance->poll_handle,
- QB_LOOP_HIGH,
- instance->knet_fd,
- POLLIN, instance, data_deliver_fn);
- /*
- * Upper layer isn't ready to receive message because it hasn't
- * initialized yet. Add short timer to check the interfaces.
- */
- qb_loop_timer_add (instance->poll_handle,
- QB_LOOP_MED,
- 100*QB_TIME_NS_IN_MSEC,
- (void *)instance,
- timer_function_netif_check_timeout,
- &instance->timer_netif_check_timeout);
- totemknet_start_merge_detect_timeout(instance);
- /* Start listening for config changes */
- totemknet_add_config_notifications(instance);
- /* Add stats keys to icmap */
- stats_knet_add_handle();
- knet_log_printf (LOGSYS_LEVEL_INFO, "totemknet initialized");
- *knet_context = instance;
- return (0);
- exit_error:
- log_flush_messages(instance);
- free(instance);
- return (-1);
- }
- void *totemknet_buffer_alloc (void)
- {
- /* Need to have space for a message AND a struct mcast in case of encapsulated messages */
- return malloc(KNET_MAX_PACKET_SIZE + 512);
- }
- void totemknet_buffer_release (void *ptr)
- {
- return free (ptr);
- }
- int totemknet_processor_count_set (
- void *knet_context,
- int processor_count)
- {
- return (0);
- }
- int totemknet_recv_flush (void *knet_context)
- {
- return (0);
- }
- int totemknet_send_flush (void *knet_context)
- {
- return (0);
- }
- int totemknet_token_send (
- void *knet_context,
- const void *msg,
- unsigned int msg_len)
- {
- struct totemknet_instance *instance = (struct totemknet_instance *)knet_context;
- int res = 0;
- ucast_sendmsg (instance, &instance->token_target, msg, msg_len);
- return (res);
- }
- int totemknet_mcast_flush_send (
- void *knet_context,
- const void *msg,
- unsigned int msg_len)
- {
- struct totemknet_instance *instance = (struct totemknet_instance *)knet_context;
- int res = 0;
- mcast_sendmsg (instance, msg, msg_len, 0);
- return (res);
- }
- int totemknet_mcast_noflush_send (
- void *knet_context,
- const void *msg,
- unsigned int msg_len)
- {
- struct totemknet_instance *instance = (struct totemknet_instance *)knet_context;
- int res = 0;
- mcast_sendmsg (instance, msg, msg_len, 1);
- return (res);
- }
- extern int totemknet_iface_check (void *knet_context)
- {
- struct totemknet_instance *instance = (struct totemknet_instance *)knet_context;
- int res = 0;
- knet_log_printf(LOG_DEBUG, "totemknet: iface_check");
- return (res);
- }
- extern void totemknet_net_mtu_adjust (void *knet_context, struct totem_config *totem_config)
- {
- struct totemknet_instance *instance = (struct totemknet_instance *)knet_context;
- knet_log_printf(LOG_DEBUG, "totemknet: Returning MTU of %d", totem_config->net_mtu);
- }
- int totemknet_token_target_set (
- void *knet_context,
- unsigned int nodeid)
- {
- struct totemknet_instance *instance = (struct totemknet_instance *)knet_context;
- int res = 0;
- instance->token_target.nodeid = nodeid;
- instance->totemknet_target_set_completed (instance->context);
- return (res);
- }
- extern int totemknet_recv_mcast_empty (
- void *knet_context)
- {
- struct totemknet_instance *instance = (struct totemknet_instance *)knet_context;
- unsigned int res;
- struct sockaddr_storage system_from;
- struct msghdr msg_hdr;
- struct iovec iov_recv;
- struct pollfd ufd;
- int nfds;
- int msg_processed = 0;
- iov_recv.iov_base = instance->iov_buffer;
- iov_recv.iov_len = KNET_MAX_PACKET_SIZE;
- msg_hdr.msg_name = &system_from;
- msg_hdr.msg_namelen = sizeof (struct sockaddr_storage);
- msg_hdr.msg_iov = &iov_recv;
- msg_hdr.msg_iovlen = 1;
- #ifdef HAVE_MSGHDR_CONTROL
- msg_hdr.msg_control = 0;
- #endif
- #ifdef HAVE_MSGHDR_CONTROLLEN
- msg_hdr.msg_controllen = 0;
- #endif
- #ifdef HAVE_MSGHDR_FLAGS
- msg_hdr.msg_flags = 0;
- #endif
- #ifdef HAVE_MSGHDR_ACCRIGHTS
- msg_msg_hdr.msg_accrights = NULL;
- #endif
- #ifdef HAVE_MSGHDR_ACCRIGHTSLEN
- msg_msg_hdr.msg_accrightslen = 0;
- #endif
- do {
- ufd.fd = instance->knet_fd;
- ufd.events = POLLIN;
- nfds = poll (&ufd, 1, 0);
- if (nfds == 1 && ufd.revents & POLLIN) {
- res = recvmsg (instance->knet_fd, &msg_hdr, MSG_NOSIGNAL | MSG_DONTWAIT);
- if (res != -1) {
- msg_processed = 1;
- } else {
- msg_processed = -1;
- }
- }
- } while (nfds == 1);
- return (msg_processed);
- }
- int totemknet_iface_set (void *knet_context,
- const struct totem_ip_address *local_addr,
- unsigned short ip_port,
- unsigned int iface_no)
- {
- struct totemknet_instance *instance = (struct totemknet_instance *)knet_context;
- totemip_copy(&instance->my_ids[iface_no], local_addr);
- knet_log_printf(LOG_INFO, "Configured link number %d: local addr: %s, port=%d", iface_no, totemip_print(local_addr), ip_port);
- instance->ip_port[iface_no] = ip_port;
- return 0;
- }
- int totemknet_member_add (
- void *knet_context,
- const struct totem_ip_address *local,
- const struct totem_ip_address *member,
- int link_no)
- {
- struct totemknet_instance *instance = (struct totemknet_instance *)knet_context;
- int err;
- int port = instance->ip_port[link_no];
- struct sockaddr_storage remote_ss;
- struct sockaddr_storage local_ss;
- int addrlen;
- int i;
- int host_found = 0;
- knet_node_id_t host_ids[KNET_MAX_HOST];
- size_t num_host_ids;
- /* Only create 1 loopback link and use link 0 */
- if (member->nodeid == instance->our_nodeid) {
- if (!instance->loopback_link) {
- link_no = 0;
- instance->loopback_link = 1;
- } else {
- /* Already done */
- return 0;
- }
- }
- knet_log_printf (LOGSYS_LEVEL_DEBUG, "knet: member_add: " CS_PRI_NODE_ID " (%s), link=%d", member->nodeid, totemip_print(member), link_no);
- knet_log_printf (LOGSYS_LEVEL_DEBUG, "knet: local: " CS_PRI_NODE_ID " (%s)", local->nodeid, totemip_print(local));
- /* Only add the host if it doesn't already exist in knet */
- err = knet_host_get_host_list(instance->knet_handle, host_ids, &num_host_ids);
- if (err) {
- KNET_LOGSYS_PERROR(errno, LOGSYS_LEVEL_ERROR, "knet_host_get_host_list");
- return -1;
- }
- for (i=0; i<num_host_ids; i++) {
- if (host_ids[i] == member->nodeid) {
- host_found = 1;
- }
- }
- if (!host_found) {
- err = knet_host_add(instance->knet_handle, member->nodeid);
- if (err != 0 && errno != EEXIST) {
- KNET_LOGSYS_PERROR(errno, LOGSYS_LEVEL_ERROR, "knet_host_add");
- return -1;
- }
- } else {
- knet_log_printf (LOGSYS_LEVEL_DEBUG, "nodeid " CS_PRI_NODE_ID " already added", member->nodeid);
- }
- if (err == 0) {
- if (knet_host_set_policy(instance->knet_handle, member->nodeid, instance->link_mode)) {
- KNET_LOGSYS_PERROR(errno, LOGSYS_LEVEL_ERROR, "knet_set_policy failed");
- return -1;
- }
- }
- memset(&local_ss, 0, sizeof(local_ss));
- memset(&remote_ss, 0, sizeof(remote_ss));
- /* Casts to remove const */
- totemip_totemip_to_sockaddr_convert((struct totem_ip_address *)member, port, &remote_ss, &addrlen);
- totemip_totemip_to_sockaddr_convert((struct totem_ip_address *)local, port, &local_ss, &addrlen);
- if (member->nodeid == instance->our_nodeid) {
- knet_log_printf (LOGSYS_LEVEL_DEBUG, "knet: loopback link is %d\n", link_no);
- err = knet_link_set_config(instance->knet_handle, member->nodeid, link_no,
- KNET_TRANSPORT_LOOPBACK,
- &local_ss, &remote_ss, KNET_LINK_FLAG_TRAFFICHIPRIO);
- }
- else {
- err = knet_link_set_config(instance->knet_handle, member->nodeid, link_no,
- instance->totem_config->interfaces[link_no].knet_transport,
- &local_ss, &remote_ss, KNET_LINK_FLAG_TRAFFICHIPRIO);
- }
- if (err) {
- KNET_LOGSYS_PERROR(errno, LOGSYS_LEVEL_ERROR, "knet_link_set_config failed");
- return -1;
- }
- knet_log_printf (LOGSYS_LEVEL_DEBUG, "knet: member_add: Setting link prio to %d",
- instance->totem_config->interfaces[link_no].knet_link_priority);
- err = knet_link_set_priority(instance->knet_handle, member->nodeid, link_no,
- instance->totem_config->interfaces[link_no].knet_link_priority);
- if (err) {
- KNET_LOGSYS_PERROR(errno, LOGSYS_LEVEL_ERROR, "knet_link_set_priority for nodeid " CS_PRI_NODE_ID ", link %d failed", member->nodeid, link_no);
- }
- /* ping timeouts maybe 0 here for a newly added interface so we leave this till later, it will
- get done in totemknet_refresh_config */
- if (instance->totem_config->interfaces[link_no].knet_ping_interval != 0) {
- err = knet_link_set_ping_timers(instance->knet_handle, member->nodeid, link_no,
- instance->totem_config->interfaces[link_no].knet_ping_interval,
- instance->totem_config->interfaces[link_no].knet_ping_timeout,
- instance->totem_config->interfaces[link_no].knet_ping_precision);
- if (err) {
- KNET_LOGSYS_PERROR(errno, LOGSYS_LEVEL_ERROR, "knet_link_set_ping_timers for nodeid " CS_PRI_NODE_ID ", link %d failed", member->nodeid, link_no);
- }
- err = knet_link_set_pong_count(instance->knet_handle, member->nodeid, link_no,
- instance->totem_config->interfaces[link_no].knet_pong_count);
- if (err) {
- KNET_LOGSYS_PERROR(errno, LOGSYS_LEVEL_ERROR, "knet_link_set_pong_count for nodeid " CS_PRI_NODE_ID ", link %d failed", member->nodeid, link_no);
- }
- }
- err = knet_link_set_enable(instance->knet_handle, member->nodeid, link_no, 1);
- if (err) {
- KNET_LOGSYS_PERROR(errno, LOGSYS_LEVEL_ERROR, "knet_link_set_enable for nodeid " CS_PRI_NODE_ID ", link %d failed", member->nodeid, link_no);
- return -1;
- }
- /* register stats */
- stats_knet_add_member(member->nodeid, link_no);
- return (0);
- }
- int totemknet_member_remove (
- void *knet_context,
- const struct totem_ip_address *token_target,
- int link_no)
- {
- struct totemknet_instance *instance = (struct totemknet_instance *)knet_context;
- int res;
- uint8_t link_list[KNET_MAX_LINK];
- size_t num_links;
- knet_log_printf (LOGSYS_LEVEL_DEBUG, "knet: member_remove: " CS_PRI_NODE_ID ", link=%d", token_target->nodeid, link_no);
- /* Don't remove the link with the loopback on it until we shut down */
- if (token_target->nodeid == instance->our_nodeid) {
- return 0;
- }
- /* Tidy stats */
- stats_knet_del_member(token_target->nodeid, link_no);
- /* Remove the link first */
- res = knet_link_set_enable(instance->knet_handle, token_target->nodeid, link_no, 0);
- if (res != 0) {
- KNET_LOGSYS_PERROR(errno, LOGSYS_LEVEL_ERROR, "knet_link_set enable(off) for nodeid " CS_PRI_NODE_ID ", link %d failed", token_target->nodeid, link_no);
- return res;
- }
- res = knet_link_clear_config(instance->knet_handle, token_target->nodeid, link_no);
- if (res != 0) {
- KNET_LOGSYS_PERROR(errno, LOGSYS_LEVEL_ERROR, "knet_link_clear_config for nodeid " CS_PRI_NODE_ID ", link %d failed", token_target->nodeid, link_no);
- return res;
- }
- /* If this is the last link, then remove the node */
- res = knet_link_get_link_list(instance->knet_handle,
- token_target->nodeid, link_list, &num_links);
- if (res) {
- return (0); /* not really failure */
- }
- if (num_links == 0) {
- res = knet_host_remove(instance->knet_handle, token_target->nodeid);
- }
- return res;
- }
- int totemknet_member_list_rebind_ip (
- void *knet_context)
- {
- return (0);
- }
- int totemknet_reconfigure (
- void *knet_context,
- struct totem_config *totem_config)
- {
- struct totemknet_instance *instance = (struct totemknet_instance *)knet_context;
- struct knet_handle_compress_cfg compress_cfg;
- int res = 0;
- if (totem_config->knet_compression_model) {
- assert(strlen(totem_config->knet_compression_model) < sizeof(compress_cfg.compress_model));
- strcpy(compress_cfg.compress_model, totem_config->knet_compression_model);
- compress_cfg.compress_threshold = totem_config->knet_compression_threshold;
- compress_cfg.compress_level = totem_config->knet_compression_level;
- res = knet_handle_compress(instance->knet_handle, &compress_cfg);
- if (res) {
- KNET_LOGSYS_PERROR(errno, LOGSYS_LEVEL_ERROR, "knet_handle_compress failed");
- }
- }
- #ifdef HAVE_LIBNOZZLE
- /* Set up nozzle device(s). Return code is ignored, because unability
- * configure nozzle is not fatal problem, errors are logged and
- * there is not much else we can do */
- (void)setup_nozzle(instance);
- #endif
- return (res);
- }
- void totemknet_stats_clear (
- void *knet_context)
- {
- struct totemknet_instance *instance = (struct totemknet_instance *)knet_context;
- (void) knet_handle_clear_stats(instance->knet_handle, KNET_CLEARSTATS_HANDLE_AND_LINK);
- }
- /* For the stats module */
- int totemknet_link_get_status (
- knet_node_id_t node, uint8_t link_no,
- struct knet_link_status *status)
- {
- int res;
- int ret = CS_OK;
- /* We are probably not using knet */
- if (!global_instance) {
- return CS_ERR_NOT_EXIST;
- }
- if (link_no >= INTERFACE_MAX) {
- return CS_ERR_NOT_EXIST; /* Invalid link number */
- }
- res = knet_link_get_status(global_instance->knet_handle, node, link_no, status, sizeof(struct knet_link_status));
- if (res) {
- switch (errno) {
- case EINVAL:
- ret = CS_ERR_INVALID_PARAM;
- break;
- case EBUSY:
- ret = CS_ERR_BUSY;
- break;
- case EDEADLK:
- ret = CS_ERR_TRY_AGAIN;
- break;
- default:
- ret = CS_ERR_LIBRARY;
- break;
- }
- }
- return (ret);
- }
- int totemknet_handle_get_stats (
- struct knet_handle_stats *stats)
- {
- int res;
- /* We are probably not using knet */
- if (!global_instance) {
- return CS_ERR_NOT_EXIST;
- }
- res = knet_handle_get_stats(global_instance->knet_handle, stats, sizeof(struct knet_handle_stats));
- if (res != 0) {
- return (qb_to_cs_error(-errno));
- }
- return CS_OK;
- }
- static void timer_function_merge_detect_timeout (
- void *data)
- {
- struct totemknet_instance *instance = (struct totemknet_instance *)data;
- if (instance->merge_detect_messages_sent_before_timeout == 0) {
- instance->send_merge_detect_message = 1;
- }
- instance->merge_detect_messages_sent_before_timeout = 0;
- totemknet_start_merge_detect_timeout(instance);
- }
- static void totemknet_start_merge_detect_timeout(
- void *knet_context)
- {
- struct totemknet_instance *instance = (struct totemknet_instance *)knet_context;
- qb_loop_timer_add(instance->poll_handle,
- QB_LOOP_MED,
- instance->totem_config->merge_timeout * 2 * QB_TIME_NS_IN_MSEC,
- (void *)instance,
- timer_function_merge_detect_timeout,
- &instance->timer_merge_detect_timeout);
- }
- static void totemknet_stop_merge_detect_timeout(
- void *knet_context)
- {
- struct totemknet_instance *instance = (struct totemknet_instance *)knet_context;
- qb_loop_timer_del(instance->poll_handle,
- instance->timer_merge_detect_timeout);
- }
- static void log_flush_messages (void *knet_context)
- {
- struct pollfd pfd;
- struct totemknet_instance *instance = (struct totemknet_instance *)knet_context;
- int cont;
- cont = 1;
- while (cont) {
- pfd.fd = instance->logpipes[0];
- pfd.events = POLLIN;
- pfd.revents = 0;
- if ((poll(&pfd, 1, 0) > 0) &&
- (pfd.revents & POLLIN) &&
- (log_deliver_fn(instance->logpipes[0], POLLIN, instance) == 0)) {
- cont = 1;
- } else {
- cont = 0;
- }
- }
- }
- #ifdef HAVE_LIBNOZZLE
- #define NOZZLE_NAME "nozzle.name"
- #define NOZZLE_IPADDR "nozzle.ipaddr"
- #define NOZZLE_PREFIX "nozzle.ipprefix"
- #define NOZZLE_MACADDR "nozzle.macaddr"
- #define NOZZLE_CHANNEL 1
- static char *get_nozzle_script_dir(void *knet_context)
- {
- struct totemknet_instance *instance = (struct totemknet_instance *)knet_context;
- char filename[PATH_MAX + FILENAME_MAX + 1];
- static char updown_dirname[PATH_MAX + FILENAME_MAX + 1];
- int res;
- const char *dirname_res;
- /*
- * Build script directory based on corosync.conf file location
- */
- res = snprintf(filename, sizeof(filename), "%s",
- corosync_get_config_file());
- if (res >= sizeof(filename)) {
- knet_log_printf (LOGSYS_LEVEL_DEBUG, "nozzle up/down path too long");
- return NULL;
- }
- dirname_res = dirname(filename);
- res = snprintf(updown_dirname, sizeof(updown_dirname), "%s/%s",
- dirname_res, "updown.d");
- if (res >= sizeof(updown_dirname)) {
- knet_log_printf (LOGSYS_LEVEL_DEBUG, "nozzle up/down path too long");
- return NULL;
- }
- return updown_dirname;
- }
- /*
- * Deliberately doesn't return the status as caller doesn't care.
- * The result will be logged though
- */
- static void run_nozzle_script(struct totemknet_instance *instance, int type, const char *typename)
- {
- int res;
- char *exec_string;
- res = nozzle_run_updown(instance->nozzle_handle, type, &exec_string);
- if (res == -1 && errno != ENOENT) {
- knet_log_printf (LOGSYS_LEVEL_INFO, "exec nozzle %s script failed: %s", typename, strerror(errno));
- } else if (res == -2) {
- knet_log_printf (LOGSYS_LEVEL_INFO, "nozzle %s script failed", typename);
- knet_log_printf (LOGSYS_LEVEL_INFO, "%s", exec_string);
- }
- }
- /*
- * Reparse IP address to add in our node ID
- * IPv6 addresses must end in '::'
- * IPv4 addresses must just be valid
- * '/xx' lengths are optional for IPv6, mandatory for IPv4
- *
- * Returns the modified IP address as a string to pass into libnozzle
- */
- static int reparse_nozzle_ip_address(struct totemknet_instance *instance,
- const char *input_addr,
- const char *prefix, int nodeid,
- char *output_addr, size_t output_len)
- {
- char *coloncolon;
- int bits;
- int max_prefix = 64;
- uint32_t nodeid_mask;
- uint32_t addr_mask;
- uint32_t masked_nodeid;
- struct in_addr *addr;
- struct totem_ip_address totemip;
- coloncolon = strstr(input_addr, "::");
- if (!coloncolon) {
- max_prefix = 30;
- }
- bits = atoi(prefix);
- if (bits < 8 || bits > max_prefix) {
- knet_log_printf(LOGSYS_LEVEL_ERROR, "nozzle IP address prefix must be >= 8 and <= %d (got %d)", max_prefix, bits);
- return -1;
- }
- /* IPv6 is easy */
- if (coloncolon) {
- memcpy(output_addr, input_addr, coloncolon-input_addr);
- sprintf(output_addr + (coloncolon-input_addr), "::%x", nodeid);
- return 0;
- }
- /* For IPv4 we need to parse the address into binary, mask off the required bits,
- * add in the masked_nodeid and 'print' it out again
- */
- nodeid_mask = UINT32_MAX & ((1<<(32 - bits)) - 1);
- addr_mask = UINT32_MAX ^ nodeid_mask;
- masked_nodeid = nodeid & nodeid_mask;
- if (totemip_parse(&totemip, input_addr, AF_INET)) {
- knet_log_printf(LOGSYS_LEVEL_ERROR, "Failed to parse IPv4 nozzle IP address");
- return -1;
- }
- addr = (struct in_addr *)&totemip.addr;
- addr->s_addr &= htonl(addr_mask);
- addr->s_addr |= htonl(masked_nodeid);
- inet_ntop(AF_INET, addr, output_addr, output_len);
- return 0;
- }
- static int create_nozzle_device(void *knet_context, const char *name,
- const char *ipaddr, const char *prefix,
- const char *macaddr)
- {
- struct totemknet_instance *instance = (struct totemknet_instance *)knet_context;
- char device_name[IFNAMSIZ+1];
- size_t size = IFNAMSIZ;
- int8_t channel = NOZZLE_CHANNEL;
- nozzle_t nozzle_dev;
- int nozzle_fd;
- int res;
- char *updown_dir;
- char parsed_ipaddr[INET6_ADDRSTRLEN];
- char mac[19];
- memset(device_name, 0, size);
- memset(&mac, 0, sizeof(mac));
- strncpy(device_name, name, size);
- updown_dir = get_nozzle_script_dir(knet_context);
- knet_log_printf (LOGSYS_LEVEL_INFO, "nozzle script dir is %s", updown_dir);
- nozzle_dev = nozzle_open(device_name, size, updown_dir);
- if (!nozzle_dev) {
- knet_log_printf (LOGSYS_LEVEL_ERROR, "Unable to init nozzle device %s: %s", device_name, strerror(errno));
- return -1;
- }
- instance->nozzle_handle = nozzle_dev;
- if (nozzle_set_mac(nozzle_dev, macaddr) < 0) {
- knet_log_printf (LOGSYS_LEVEL_ERROR, "Unable to add set nozzle MAC to %s: %s", mac, strerror(errno));
- goto out_clean;
- }
- if (reparse_nozzle_ip_address(instance, ipaddr, prefix, instance->our_nodeid, parsed_ipaddr, sizeof(parsed_ipaddr))) {
- /* Prints its own errors */
- goto out_clean;
- }
- knet_log_printf (LOGSYS_LEVEL_INFO, "Local nozzle IP address is %s / %d", parsed_ipaddr, atoi(prefix));
- if (nozzle_add_ip(nozzle_dev, parsed_ipaddr, prefix) < 0) {
- knet_log_printf (LOGSYS_LEVEL_ERROR, "Unable to add set nozzle IP addr to %s/%s: %s", parsed_ipaddr, prefix, strerror(errno));
- goto out_clean;
- }
- nozzle_fd = nozzle_get_fd(nozzle_dev);
- knet_log_printf (LOGSYS_LEVEL_INFO, "Opened '%s' on fd %d", device_name, nozzle_fd);
- res = knet_handle_add_datafd(instance->knet_handle, &nozzle_fd, &channel);
- if (res != 0) {
- knet_log_printf (LOGSYS_LEVEL_ERROR, "Unable to add nozzle FD to knet: %s", strerror(errno));
- goto out_clean;
- }
- run_nozzle_script(instance, NOZZLE_PREUP, "pre-up");
- res = nozzle_set_up(nozzle_dev);
- if (res != 0) {
- knet_log_printf (LOGSYS_LEVEL_ERROR, "Unable to set nozzle interface UP: %s", strerror(errno));
- goto out_clean;
- }
- run_nozzle_script(instance, NOZZLE_UP, "up");
- return 0;
- out_clean:
- nozzle_close(nozzle_dev);
- return -1;
- }
- static int remove_nozzle_device(void *knet_context)
- {
- struct totemknet_instance *instance = (struct totemknet_instance *)knet_context;
- int res;
- int datafd;
- res = knet_handle_get_datafd(instance->knet_handle, NOZZLE_CHANNEL, &datafd);
- if (res != 0) {
- knet_log_printf (LOGSYS_LEVEL_ERROR, "Can't find datafd for channel %d: %s", NOZZLE_CHANNEL, strerror(errno));
- return -1;
- }
- res = knet_handle_remove_datafd(instance->knet_handle, datafd);
- if (res != 0) {
- knet_log_printf (LOGSYS_LEVEL_ERROR, "Can't remove datafd for nozzle channel %d: %s", NOZZLE_CHANNEL, strerror(errno));
- return -1;
- }
- run_nozzle_script(instance, NOZZLE_DOWN, "pre-down");
- res = nozzle_set_down(instance->nozzle_handle);
- if (res != 0) {
- knet_log_printf (LOGSYS_LEVEL_ERROR, "Can't set nozzle device down: %s", strerror(errno));
- return -1;
- }
- run_nozzle_script(instance, NOZZLE_POSTDOWN, "post-down");
- res = nozzle_close(instance->nozzle_handle);
- if (res != 0) {
- knet_log_printf (LOGSYS_LEVEL_ERROR, "Can't close nozzle device: %s", strerror(errno));
- return -1;
- }
- knet_log_printf (LOGSYS_LEVEL_INFO, "Removed nozzle device");
- return 0;
- }
- static void free_nozzle(struct totemknet_instance *instance)
- {
- free(instance->nozzle_name);
- free(instance->nozzle_ipaddr);
- free(instance->nozzle_prefix);
- free(instance->nozzle_macaddr);
- instance->nozzle_name = instance->nozzle_ipaddr = instance->nozzle_prefix =
- instance->nozzle_macaddr = NULL;
- }
- static int setup_nozzle(void *knet_context)
- {
- struct totemknet_instance *instance = (struct totemknet_instance *)knet_context;
- char *ipaddr_str = NULL;
- char *name_str = NULL;
- char *prefix_str = NULL;
- char *macaddr_str = NULL;
- char mac[32];
- int name_res;
- int macaddr_res;
- int res = -1;
- /*
- * Return value ignored on purpose. icmap_get_string changes
- * ipaddr_str/prefix_str only on success.
- */
- (void)icmap_get_string(NOZZLE_IPADDR, &ipaddr_str);
- (void)icmap_get_string(NOZZLE_PREFIX, &prefix_str);
- macaddr_res = icmap_get_string(NOZZLE_MACADDR, &macaddr_str);
- name_res = icmap_get_string(NOZZLE_NAME, &name_str);
- /* Is is being removed? */
- if (name_res == CS_ERR_NOT_EXIST && instance->nozzle_handle) {
- remove_nozzle_device(instance);
- free_nozzle(instance);
- goto out_free;
- }
- if (!name_str) {
- /* no nozzle */
- goto out_free;
- }
- if (!ipaddr_str) {
- knet_log_printf (LOGSYS_LEVEL_ERROR, "No IP address supplied for Nozzle device");
- goto out_free;
- }
- if (!prefix_str) {
- knet_log_printf (LOGSYS_LEVEL_ERROR, "No prefix supplied for Nozzle IP address");
- goto out_free;
- }
- if (macaddr_str && strlen(macaddr_str) != 17) {
- knet_log_printf (LOGSYS_LEVEL_ERROR, "macaddr for nozzle device is not in the correct format '%s'", macaddr_str);
- goto out_free;
- }
- if (!macaddr_str) {
- macaddr_str = (char*)"54:54:01:00:00:00";
- }
- if (instance->nozzle_name &&
- (strcmp(name_str, instance->nozzle_name) == 0) &&
- (strcmp(ipaddr_str, instance->nozzle_ipaddr) == 0) &&
- (strcmp(prefix_str, instance->nozzle_prefix) == 0) &&
- (instance->nozzle_macaddr == NULL ||
- strcmp(macaddr_str, instance->nozzle_macaddr) == 0)) {
- /* Nothing has changed */
- knet_log_printf (LOGSYS_LEVEL_DEBUG, "Nozzle device info not changed");
- goto out_free;
- }
- /* Add nodeid into MAC address */
- memcpy(mac, macaddr_str, 12);
- snprintf(mac+12, sizeof(mac) - 13, "%02x:%02x",
- instance->our_nodeid >> 8,
- instance->our_nodeid & 0xFF);
- knet_log_printf (LOGSYS_LEVEL_INFO, "Local nozzle MAC address is %s", mac);
- if (name_res == CS_OK && name_str) {
- /* Reconfigure */
- if (instance->nozzle_name) {
- remove_nozzle_device(instance);
- free_nozzle(instance);
- }
- res = create_nozzle_device(knet_context, name_str, ipaddr_str, prefix_str,
- mac);
- instance->nozzle_name = strdup(name_str);
- instance->nozzle_ipaddr = strdup(ipaddr_str);
- instance->nozzle_prefix = strdup(prefix_str);
- instance->nozzle_macaddr = strdup(macaddr_str);
- if (!instance->nozzle_name || !instance->nozzle_ipaddr ||
- !instance->nozzle_prefix) {
- knet_log_printf (LOGSYS_LEVEL_ERROR, "strdup failed in nozzle allocation");
- /*
- * This 'free' will cause a complete reconfigure of the device next time we reload
- * but will also let the the current device keep working until then.
- * remove_nozzle() only needs the, statically-allocated, nozzle_handle
- */
- free_nozzle(instance);
- }
- }
- out_free:
- free(name_str);
- free(ipaddr_str);
- free(prefix_str);
- if (macaddr_res == CS_OK) {
- free(macaddr_str);
- }
- return res;
- }
- #endif // HAVE_LIBNOZZLE
|