totemsrp.c 86 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413241424152416241724182419242024212422242324242425242624272428242924302431243224332434243524362437243824392440244124422443244424452446244724482449245024512452245324542455245624572458245924602461246224632464246524662467246824692470247124722473247424752476247724782479248024812482248324842485248624872488248924902491249224932494249524962497249824992500250125022503250425052506250725082509251025112512251325142515251625172518251925202521252225232524252525262527252825292530253125322533253425352536253725382539254025412542254325442545254625472548254925502551255225532554255525562557255825592560256125622563256425652566256725682569257025712572257325742575257625772578257925802581258225832584258525862587258825892590259125922593259425952596259725982599260026012602260326042605260626072608260926102611261226132614261526162617261826192620262126222623262426252626262726282629263026312632263326342635263626372638263926402641264226432644264526462647264826492650265126522653265426552656265726582659266026612662266326642665266626672668266926702671267226732674267526762677267826792680268126822683268426852686268726882689269026912692269326942695269626972698269927002701270227032704270527062707270827092710271127122713271427152716271727182719272027212722272327242725272627272728272927302731273227332734273527362737273827392740274127422743274427452746274727482749275027512752275327542755275627572758275927602761276227632764276527662767276827692770277127722773277427752776277727782779278027812782278327842785278627872788278927902791279227932794279527962797279827992800280128022803280428052806280728082809281028112812281328142815281628172818281928202821282228232824282528262827282828292830283128322833283428352836283728382839284028412842284328442845284628472848284928502851285228532854285528562857285828592860286128622863286428652866286728682869287028712872287328742875287628772878287928802881288228832884288528862887288828892890289128922893289428952896289728982899290029012902290329042905290629072908290929102911291229132914291529162917291829192920292129222923292429252926292729282929293029312932293329342935293629372938293929402941294229432944294529462947294829492950295129522953295429552956295729582959296029612962296329642965296629672968296929702971297229732974297529762977297829792980298129822983298429852986298729882989299029912992299329942995299629972998299930003001300230033004300530063007300830093010301130123013301430153016301730183019302030213022302330243025302630273028302930303031303230333034303530363037303830393040304130423043304430453046304730483049305030513052305330543055305630573058305930603061306230633064306530663067306830693070307130723073307430753076307730783079308030813082308330843085308630873088308930903091309230933094309530963097309830993100310131023103310431053106310731083109311031113112311331143115311631173118311931203121312231233124312531263127312831293130313131323133313431353136313731383139314031413142314331443145314631473148314931503151315231533154315531563157315831593160316131623163316431653166316731683169317031713172317331743175317631773178317931803181318231833184318531863187318831893190319131923193319431953196319731983199320032013202320332043205320632073208320932103211321232133214321532163217321832193220322132223223322432253226322732283229323032313232323332343235323632373238323932403241324232433244324532463247324832493250325132523253325432553256325732583259326032613262326332643265326632673268326932703271327232733274327532763277327832793280328132823283328432853286328732883289329032913292329332943295329632973298329933003301330233033304330533063307330833093310331133123313331433153316331733183319332033213322
  1. int my_token_held = 0;
  2. int my_do_delivery = 0;
  3. unsigned long long token_ring_id_seq = 0;
  4. int log_digest = 0;
  5. int last_released = 0;
  6. int set_aru = -1;
  7. int totemsrp_brake;
  8. /*
  9. * Copyright (c) 2003-2004 MontaVista Software, Inc.
  10. *
  11. * All rights reserved.
  12. *
  13. * Author: Steven Dake (sdake@mvista.com)
  14. *
  15. * This software licensed under BSD license, the text of which follows:
  16. *
  17. * Redistribution and use in source and binary forms, with or without
  18. * modification, are permitted provided that the following conditions are met:
  19. *
  20. * - Redistributions of source code must retain the above copyright notice,
  21. * this list of conditions and the following disclaimer.
  22. * - Redistributions in binary form must reproduce the above copyright notice,
  23. * this list of conditions and the following disclaimer in the documentation
  24. * and/or other materials provided with the distribution.
  25. * - Neither the name of the MontaVista Software, Inc. nor the names of its
  26. * contributors may be used to endorse or promote products derived from this
  27. * software without specific prior written permission.
  28. *
  29. * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
  30. * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  31. * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  32. * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
  33. * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
  34. * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
  35. * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
  36. * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
  37. * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
  38. * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
  39. * THE POSSIBILITY OF SUCH DAMAGE.
  40. */
  41. /*
  42. * The first version of this code was based upon Yair Amir's PhD thesis:
  43. * http://www.cs.jhu.edu/~yairamir/phd.ps) (ch4,5).
  44. *
  45. * The current version of totemsrp implements the Totem protocol specified in:
  46. * http://citeseer.ist.psu.edu/amir95totem.html
  47. *
  48. * The deviations from the above published protocols are:
  49. * - encryption of message contents with SOBER128
  50. * - authentication of meessage contents with SHA1/HMAC
  51. * - token hold mode where token doesn't rotate on unused ring - reduces cpu
  52. * usage on 1.6ghz xeon from 35% to less then .1 % as measured by top
  53. */
  54. #include <assert.h>
  55. #include <sys/mman.h>
  56. #include <sys/types.h>
  57. #include <sys/stat.h>
  58. #include <sys/socket.h>
  59. #include <netdb.h>
  60. #include <sys/un.h>
  61. #include <sys/sysinfo.h>
  62. #include <sys/ioctl.h>
  63. #include <netinet/in.h>
  64. #include <arpa/inet.h>
  65. #include <linux/if.h>
  66. #include <linux/sockios.h>
  67. #include <unistd.h>
  68. #include <fcntl.h>
  69. #include <stdlib.h>
  70. #include <stdio.h>
  71. #include <errno.h>
  72. #include <signal.h>
  73. #include <sched.h>
  74. #include <time.h>
  75. #include <sys/time.h>
  76. #include <sys/poll.h>
  77. #include "aispoll.h"
  78. #include "totemsrp.h"
  79. #include "../include/queue.h"
  80. #include "../include/sq.h"
  81. #include "../include/list.h"
  82. #include "hdb.h"
  83. #include "swab.h"
  84. #include "crypto.h"
  85. #define AUTHENTICATION 1 /* use authentication */
  86. #define ENCRYPTION 1 /* use encryption */
  87. #define LOCALHOST_IP inet_addr("127.0.0.1")
  88. #define QUEUE_RTR_ITEMS_SIZE_MAX 2000 /* allow 512 retransmit items */
  89. #define NEW_MESSAGE_QUEUE_SIZE_MAX 2000 /* allow 500 messages to be queued */
  90. #define RETRANS_MESSAGE_QUEUE_SIZE_MAX 2000 /* allow 500 messages to be queued */
  91. #define RECEIVED_MESSAGE_QUEUE_SIZE_MAX 2000 /* allow 500 messages to be queued */
  92. #define MAXIOVS 5
  93. #define RETRANSMIT_ENTRIES_MAX 30
  94. #define MISSING_MCAST_WINDOW 128
  95. #define TIMEOUT_STATE_GATHER_JOIN 100
  96. #define TIMEOUT_STATE_GATHER_CONSENSUS 200
  97. #define TIMEOUT_TOKEN 1000
  98. #define TIMEOUT_TOKEN_RETRANSMIT 200
  99. #define MAX_MEMBERS 16
  100. #define PACKET_SIZE_MAX 2000
  101. #define FAIL_TO_RECV_CONST 250
  102. #define SEQNO_UNCHANGED_CONST 20
  103. /*
  104. * we compare incoming messages to determine if their endian is
  105. * different - if so convert them
  106. *
  107. * do not change
  108. */
  109. #define ENDIAN_LOCAL 0xff22
  110. /*
  111. * Authentication of messages
  112. */
  113. hmac_state totemsrp_hmac_state;
  114. prng_state totemsrp_prng_state;
  115. unsigned char totemsrp_private_key[1024];
  116. unsigned int totemsrp_private_key_len;
  117. int stats_sent = 0;
  118. int stats_recv = 0;
  119. int stats_delv = 0;
  120. int stats_remcasts = 0;
  121. int stats_orf_token = 0;
  122. struct timeval stats_tv_start = { 0, 0 };
  123. /*
  124. * Flow control mcasts and remcasts on last and current orf_token
  125. */
  126. int fcc_remcast_last = 0;
  127. int fcc_mcast_last = 0;
  128. int fcc_mcast_current = 0;
  129. int fcc_remcast_current = 0;
  130. enum message_type {
  131. MESSAGE_TYPE_ORF_TOKEN = 0, /* Ordering, Reliability, Flow (ORF) control Token */
  132. MESSAGE_TYPE_MCAST = 1, /* ring ordered multicast message */
  133. MESSAGE_TYPE_MEMB_JOIN = 2, /* membership join message */
  134. MESSAGE_TYPE_MEMB_COMMIT_TOKEN = 3, /* membership commit token */
  135. };
  136. /*
  137. * New membership algorithm local variables
  138. */
  139. struct consensus_list_item {
  140. struct in_addr addr;
  141. int set;
  142. };
  143. static struct consensus_list_item consensus_list[MAX_MEMBERS];
  144. static int consensus_list_entries;
  145. static struct in_addr my_proc_list[MAX_MEMBERS];
  146. static struct in_addr my_failed_list[MAX_MEMBERS];
  147. static struct in_addr my_new_memb_list[MAX_MEMBERS];
  148. static struct in_addr my_trans_memb_list[MAX_MEMBERS];
  149. static struct in_addr my_memb_list[MAX_MEMBERS];
  150. static struct in_addr my_deliver_memb_list[MAX_MEMBERS];
  151. static int my_proc_list_entries = 0;
  152. static int my_failed_list_entries = 0;
  153. static int my_new_memb_entries = 0;
  154. static int my_trans_memb_entries = 0;
  155. static int my_memb_entries = 0;
  156. static int my_deliver_memb_entries = 0;
  157. static struct memb_ring_id my_ring_id;
  158. static int my_aru_count = 0;
  159. static int my_last_aru = 0;
  160. static int my_seq_unchanged = 0;
  161. static int my_received_flg = 1;
  162. static int my_high_seq_received;
  163. static int my_install_seq = 0;
  164. static int my_rotation_counter = 0;
  165. static int my_set_retrans_flg = 0;
  166. static int my_retrans_flg_count = 0;
  167. static unsigned int my_high_ring_delivered = 0;
  168. static unsigned int my_high_seq_delivered = 0;
  169. static unsigned int my_old_high_seq_delivered = 0;
  170. struct token_callback_instance {
  171. struct list_head list;
  172. int (*callback_fn) (enum totemsrp_callback_token_type type, void *);
  173. enum totemsrp_callback_token_type callback_type;
  174. int delete;
  175. void *data;
  176. };
  177. /*
  178. * Queues used to order, deliver, and recover messages
  179. */
  180. struct queue new_message_queue;
  181. struct queue retrans_message_queue;
  182. struct sq regular_sort_queue;
  183. struct sq recovery_sort_queue;
  184. /*
  185. * Multicast address
  186. */
  187. struct sockaddr_in sockaddr_in_mcast;
  188. struct totemsrp_socket {
  189. int mcast;
  190. int token;
  191. };
  192. /*
  193. * File descriptors in use by TOTEMSRP
  194. */
  195. struct totemsrp_socket totemsrp_sockets[2];
  196. /*
  197. * Received up to and including
  198. */
  199. int my_aru = 0;
  200. int my_aru_save = 0;
  201. int my_high_seq_received_save = 0;
  202. DECLARE_LIST_INIT (token_callback_received_listhead);
  203. DECLARE_LIST_INIT (token_callback_sent_listhead);
  204. char orf_token_retransmit[15000]; // sizeof (struct orf_token) + sizeof (struct rtr_item) * RETRANSMIT_ENTRIES_MAX];
  205. int orf_token_retransmit_size;
  206. int my_token_seq = -1;
  207. /*
  208. * Timers
  209. */
  210. poll_timer_handle timer_orf_token_timeout = 0;
  211. poll_timer_handle timer_orf_token_retransmit_timeout = 0;
  212. poll_timer_handle memb_timer_state_gather_join_timeout = 0;
  213. poll_timer_handle memb_timer_state_gather_consensus_timeout = 0;
  214. poll_timer_handle memb_timer_state_commit_timeout = 0;
  215. /*
  216. * Function called when new message received
  217. */
  218. int (*totemsrp_recv) (char *group, struct iovec *iovec, int iov_len);
  219. /*
  220. * Function and data used to log messages
  221. */
  222. static void (*totemsrp_log_printf) (int level, char *format, ...);
  223. int totemsrp_log_level_security;
  224. int totemsrp_log_level_error;
  225. int totemsrp_log_level_warning;
  226. int totemsrp_log_level_notice;
  227. int totemsrp_log_level_debug;
  228. #define HMAC_HASH_SIZE 20
  229. struct security_header {
  230. unsigned char hash_digest[HMAC_HASH_SIZE]; /* The hash *MUST* be first in the data structure */
  231. unsigned char salt[16]; /* random number */
  232. } __attribute__((packed));
  233. struct message_header {
  234. struct security_header security_header;
  235. char type;
  236. char encapsulated;
  237. // unsigned short filler;
  238. unsigned short endian_detector;
  239. } __attribute__((packed));
  240. struct memb_ring_id {
  241. struct in_addr rep;
  242. unsigned long long seq;
  243. } __attribute__((packed));
  244. struct mcast {
  245. struct message_header header;
  246. int seq;
  247. struct memb_ring_id ring_id;
  248. struct in_addr source;
  249. int guarantee;
  250. } __attribute__((packed));
  251. /*
  252. * MTU - multicast message header - IP header - UDP header
  253. *
  254. * On lossy switches, making use of the DF UDP flag can lead to loss of
  255. * forward progress. So the packets must be fragmented by a higher layer
  256. *
  257. * This layer can only handle packets of MTU size.
  258. */
  259. #define FRAGMENT_SIZE (PACKET_SIZE_MAX - sizeof (struct mcast) - 20 - 8)
  260. struct rtr_item {
  261. struct memb_ring_id ring_id;
  262. int seq;
  263. }__attribute__((packed));
  264. struct orf_token {
  265. struct message_header header;
  266. int seq;
  267. int token_seq;
  268. int aru;
  269. struct in_addr aru_addr;
  270. struct memb_ring_id ring_id;
  271. short int fcc;
  272. int retrans_flg;
  273. int rtr_list_entries;
  274. struct rtr_item rtr_list[0];
  275. }__attribute__((packed));
  276. struct memb_join {
  277. struct message_header header;
  278. struct in_addr proc_list[MAX_MEMBERS];
  279. int proc_list_entries;
  280. struct in_addr failed_list[MAX_MEMBERS];
  281. int failed_list_entries;
  282. unsigned long long ring_seq;
  283. } __attribute__((packed));
  284. struct memb_commit_token_memb_entry {
  285. struct memb_ring_id ring_id;
  286. int aru;
  287. int high_delivered;
  288. int received_flg;
  289. }__attribute__((packed));
  290. struct memb_commit_token {
  291. struct message_header header;
  292. int token_seq;
  293. struct memb_ring_id ring_id;
  294. unsigned int retrans_flg;
  295. int memb_index;
  296. int addr_entries;
  297. struct in_addr addr[MAX_MEMBERS];
  298. struct memb_commit_token_memb_entry memb_list[MAX_MEMBERS];
  299. }__attribute__((packed));
  300. struct message_item {
  301. struct mcast *mcast;
  302. struct iovec iovec[MAXIOVS];
  303. int iov_len;
  304. };
  305. struct sort_queue_item {
  306. struct iovec iovec[MAXIOVS];
  307. int iov_len;
  308. };
  309. enum memb_state {
  310. MEMB_STATE_OPERATIONAL = 1,
  311. MEMB_STATE_GATHER = 2,
  312. MEMB_STATE_COMMIT = 3,
  313. MEMB_STATE_RECOVERY = 4
  314. };
  315. static enum memb_state memb_state = MEMB_STATE_OPERATIONAL;
  316. static struct sockaddr_in my_id;
  317. struct sockaddr_in next_memb;
  318. static struct sockaddr_in memb_local_sockaddr_in;
  319. static char iov_buffer[15000]; //PACKET_SIZE_MAX];
  320. static struct iovec totemsrp_iov_recv = {
  321. .iov_base = iov_buffer,
  322. .iov_len = sizeof (iov_buffer)
  323. };
  324. static char iov_encrypted_buffer[15000]; //char orf_token_retransmit[15000]; // sizeof (struct orf_token) + sizeof (struct rtr_item) * RETRANSMIT_ENTRIES_MAX];
  325. static struct iovec iov_encrypted = {
  326. .iov_base = iov_encrypted_buffer,
  327. .iov_len = sizeof (iov_encrypted_buffer)
  328. };
  329. struct message_handlers {
  330. int count;
  331. int (*handler_functions[4]) (struct sockaddr_in *, struct iovec *, int, int, int);
  332. };
  333. poll_handle *totemsrp_poll_handle;
  334. void (*totemsrp_deliver_fn) (
  335. struct in_addr source_addr,
  336. struct iovec *iovec,
  337. int iov_len,
  338. int endian_conversion_required) = 0;
  339. void (*totemsrp_confchg_fn) (
  340. enum totemsrp_configuration_type configuration_type,
  341. struct in_addr *member_list, void *member_list_private,
  342. int member_list_entries,
  343. struct in_addr *left_list, void *left_list_private,
  344. int left_list_entries,
  345. struct in_addr *joined_list, void *joined_list_private,
  346. int joined_list_entries) = 0;
  347. /*
  348. * forward decls
  349. */
  350. static int message_handler_orf_token (struct sockaddr_in *, struct iovec *, int, int, int);
  351. static int message_handler_mcast (struct sockaddr_in *, struct iovec *, int, int, int);
  352. static int message_handler_memb_join (struct sockaddr_in *, struct iovec *, int, int, int);
  353. static int message_handler_memb_commit_token (struct sockaddr_in *, struct iovec *, int, int, int);
  354. static void memb_ring_id_create_or_load (struct memb_ring_id *);
  355. static int recv_handler (poll_handle handle, int fd, int revents, void *data, unsigned int *prio);
  356. static int netif_determine (struct sockaddr_in *bindnet, struct sockaddr_in *bound_to);
  357. static int totemsrp_build_sockets (struct sockaddr_in *sockaddr_mcast,
  358. struct sockaddr_in *sockaddr_bindnet,
  359. struct totemsrp_socket *sockets,
  360. struct sockaddr_in *bound_to);
  361. static void memb_state_gather_enter (void);
  362. static void messages_deliver_to_app (int skip, int *start_point, int end_point);
  363. static int orf_token_mcast (struct orf_token *oken,
  364. int fcc_mcasts_allowed, struct sockaddr_in *system_from);
  365. static int messages_free (int token_aru);
  366. static void encrypt_and_sign (struct iovec *iovec, int iov_len);
  367. static int authenticate_and_decrypt (struct iovec *iov);
  368. static int recv_handler (poll_handle handle, int fd, int revents, void *data, unsigned int *prio);
  369. static void memb_ring_id_store (struct memb_commit_token *commit_token);
  370. static void memb_state_commit_token_update (struct memb_commit_token *memb_commit_token);
  371. static int memb_state_commit_token_send (struct memb_commit_token *memb_commit_token);
  372. static void memb_state_commit_token_create (struct memb_commit_token *commit_token);
  373. static void orf_token_endian_convert (struct orf_token *in, struct orf_token *out);
  374. static void memb_commit_token_endian_convert (struct memb_commit_token *in, struct memb_commit_token *out);
  375. static void memb_join_endian_convert (struct memb_join *in, struct memb_join *out);
  376. static void mcast_endian_convert (struct mcast *in, struct mcast *out);
  377. struct message_handlers totemsrp_message_handlers = {
  378. 4,
  379. {
  380. message_handler_orf_token,
  381. message_handler_mcast,
  382. message_handler_memb_join,
  383. message_handler_memb_commit_token
  384. }
  385. };
  386. void totemsrp_log_printf_init (
  387. void (*log_printf) (int , char *, ...),
  388. int log_level_security,
  389. int log_level_error,
  390. int log_level_warning,
  391. int log_level_notice,
  392. int log_level_debug)
  393. {
  394. totemsrp_log_level_security = log_level_security;
  395. totemsrp_log_level_error = log_level_error;
  396. totemsrp_log_level_warning = log_level_warning;
  397. totemsrp_log_level_notice = log_level_notice;
  398. totemsrp_log_level_debug = log_level_debug;
  399. totemsrp_log_printf = log_printf;
  400. }
  401. void print_digest (char *where, unsigned char *digest)
  402. {
  403. int i;
  404. printf ("DIGEST %s:\n", where);
  405. for (i = 0; i < 16; i++) {
  406. printf ("%x ", digest[i]);
  407. }
  408. printf ("\n");
  409. }
  410. void print_msg (unsigned char *msg, int size)
  411. {
  412. int i;
  413. printf ("MSG CONTENTS START\n");
  414. for (i = 0; i < size; i++) {
  415. printf ("%x ", msg[i]);
  416. if ((i % 16) == 15) {
  417. printf ("\n");
  418. }
  419. }
  420. printf ("MSG CONTENTS DONE\n");
  421. }
  422. /*
  423. * Exported interfaces
  424. */
  425. int totemsrp_initialize (
  426. struct sockaddr_in *sockaddr_mcast,
  427. struct totemsrp_interface *interfaces,
  428. int interface_count,
  429. poll_handle *poll_handle,
  430. unsigned char *private_key,
  431. int private_key_len,
  432. void *member_private,
  433. int member_private_len,
  434. void (*deliver_fn) (
  435. struct in_addr source_addr,
  436. struct iovec *iovec,
  437. int iov_len,
  438. int endian_conversion_required),
  439. void (*confchg_fn) (
  440. enum totemsrp_configuration_type configuration_type,
  441. struct in_addr *member_list, void *member_list_private,
  442. int member_list_entries,
  443. struct in_addr *left_list, void *left_list_private,
  444. int left_list_entries,
  445. struct in_addr *joined_list, void *joined_list_private,
  446. int joined_list_entries))
  447. {
  448. int res;
  449. int interface_no;
  450. /*
  451. * Initialize random number generator for later use to generate salt
  452. */
  453. memcpy (totemsrp_private_key, private_key, private_key_len);
  454. totemsrp_private_key_len = private_key_len;
  455. rng_make_prng (128, PRNG_SOBER, &totemsrp_prng_state, NULL);
  456. /*
  457. * Initialize local variables for totemsrp
  458. */
  459. memcpy (&sockaddr_in_mcast, sockaddr_mcast, sizeof (struct sockaddr_in));
  460. memset (&next_memb, 0, sizeof (struct sockaddr_in));
  461. memset (iov_buffer, 0, PACKET_SIZE_MAX);
  462. queue_init (&new_message_queue, NEW_MESSAGE_QUEUE_SIZE_MAX,
  463. sizeof (struct message_item));
  464. queue_init (&retrans_message_queue, RETRANS_MESSAGE_QUEUE_SIZE_MAX,
  465. sizeof (struct message_item));
  466. sq_init (&regular_sort_queue,
  467. QUEUE_RTR_ITEMS_SIZE_MAX, sizeof (struct sort_queue_item), 0);
  468. sq_init (&recovery_sort_queue,
  469. QUEUE_RTR_ITEMS_SIZE_MAX, sizeof (struct sort_queue_item), 0);
  470. /*
  471. * Build sockets for every interface
  472. */
  473. for (interface_no = 0; interface_no < interface_count; interface_no++) {
  474. /*
  475. * Create and bind the multicast and unicast sockets
  476. */
  477. res = totemsrp_build_sockets (sockaddr_mcast,
  478. &interfaces[interface_no].bindnet,
  479. &totemsrp_sockets[interface_no],
  480. &interfaces[interface_no].boundto);
  481. if (res == -1) {
  482. return (res);
  483. }
  484. totemsrp_poll_handle = poll_handle;
  485. poll_dispatch_add (*totemsrp_poll_handle, totemsrp_sockets[interface_no].mcast,
  486. POLLIN, 0, recv_handler, UINT_MAX);
  487. poll_dispatch_add (*totemsrp_poll_handle, totemsrp_sockets[interface_no].token,
  488. POLLIN, 0, recv_handler, UINT_MAX);
  489. }
  490. memcpy (&my_id, &interfaces->boundto, sizeof (struct sockaddr_in));
  491. /*
  492. * This stuff depends on totemsrp_build_sockets
  493. */
  494. my_memb_list[0].s_addr = interfaces->boundto.sin_addr.s_addr;
  495. memb_ring_id_create_or_load (&my_ring_id);
  496. totemsrp_log_printf (totemsrp_log_level_notice, "Created or loaded sequence id %lld.%s for this ring.\n",
  497. my_ring_id.seq, inet_ntoa (my_ring_id.rep));
  498. memb_state_gather_enter ();
  499. totemsrp_deliver_fn = deliver_fn;
  500. totemsrp_confchg_fn = confchg_fn;
  501. return (0);
  502. }
  503. /*
  504. * Set operations for use by the membership algorithm
  505. */
  506. static void memb_consensus_reset (void)
  507. {
  508. consensus_list_entries = 0;
  509. }
  510. void
  511. memb_set_subtract (struct in_addr *out_list, int *out_list_entries,
  512. struct in_addr *one_list, int one_list_entries,
  513. struct in_addr *two_list, int two_list_entries)
  514. {
  515. int found = 0;
  516. int i;
  517. int j;
  518. *out_list_entries = 0;
  519. for (i = 0; i < one_list_entries; i++) {
  520. for (j = 0; j < two_list_entries; j++) {
  521. if (one_list[i].s_addr == two_list[j].s_addr) {
  522. found = 1;
  523. break;
  524. }
  525. }
  526. if (found == 0) {
  527. out_list[*out_list_entries].s_addr = one_list[i].s_addr;
  528. *out_list_entries = *out_list_entries + 1;
  529. }
  530. found = 0;
  531. }
  532. }
  533. /*
  534. * Set consensus for a specific processor
  535. */
  536. static void memb_consensus_set (struct in_addr *addr)
  537. {
  538. int found = 0;
  539. int i;
  540. for (i = 0; i < consensus_list_entries; i++) {
  541. if (addr->s_addr == consensus_list[i].addr.s_addr) {
  542. found = 1;
  543. break; /* found entry */
  544. }
  545. }
  546. consensus_list[i].addr.s_addr = addr->s_addr;
  547. consensus_list[i].set = 1;
  548. if (found == 0) {
  549. consensus_list_entries++;
  550. }
  551. return;
  552. }
  553. /*
  554. * Is consensus set for a specific processor
  555. */
  556. static int memb_consensus_isset (struct in_addr *addr)
  557. {
  558. int i;
  559. for (i = 0; i < consensus_list_entries; i++) {
  560. if (addr->s_addr == consensus_list[i].addr.s_addr) {
  561. return (consensus_list[i].set);
  562. }
  563. }
  564. return (0);
  565. }
  566. /*
  567. * Is consensus agreed upon based upon consensus database
  568. */
  569. static int memb_consensus_agreed (void)
  570. {
  571. struct in_addr token_memb[MAX_MEMBERS];
  572. int token_memb_entries = 0;
  573. int agreed = 1;
  574. int i;
  575. memb_set_subtract (token_memb, &token_memb_entries,
  576. my_proc_list, my_proc_list_entries,
  577. my_failed_list, my_failed_list_entries);
  578. for (i = 0; i < token_memb_entries; i++) {
  579. if (memb_consensus_isset (&token_memb[i]) == 0) {
  580. agreed = 0;
  581. break;
  582. }
  583. }
  584. return (agreed);
  585. }
  586. void memb_consensus_notset (struct in_addr *no_consensus_list,
  587. int *no_consensus_list_entries,
  588. struct in_addr *comparison_list,
  589. int comparison_list_entries)
  590. {
  591. int i;
  592. *no_consensus_list_entries = 0;
  593. for (i = 0; i < my_proc_list_entries; i++) {
  594. if (memb_consensus_isset (&my_proc_list[i]) == 0) {
  595. no_consensus_list[*no_consensus_list_entries].s_addr = my_proc_list[i].s_addr;
  596. *no_consensus_list_entries = *no_consensus_list_entries + 1;
  597. }
  598. }
  599. }
  600. /*
  601. * Is set1 equal to set2 Entries can be in different orders
  602. */
  603. int memb_set_equal (struct in_addr *set1, int set1_entries,
  604. struct in_addr *set2, int set2_entries)
  605. {
  606. int i;
  607. int j;
  608. int found = 0;
  609. if (set1_entries != set2_entries) {
  610. return (0);
  611. }
  612. for (i = 0; i < set2_entries; i++) {
  613. for (j = 0; j < set1_entries; j++) {
  614. if (set1[j].s_addr == set2[i].s_addr) {
  615. found = 1;
  616. break;
  617. }
  618. }
  619. if (found == 0) {
  620. return (0);
  621. }
  622. found = 0;
  623. }
  624. return (1);
  625. }
  626. /*
  627. * Is subset fully contained in fullset
  628. */
  629. int memb_set_subset (struct in_addr *subset, int subset_entries,
  630. struct in_addr *fullset, int fullset_entries)
  631. {
  632. int i;
  633. int j;
  634. int found = 0;
  635. if (subset_entries > fullset_entries) {
  636. return (0);
  637. }
  638. for (i = 0; i < subset_entries; i++) {
  639. for (j = 0; j < fullset_entries; j++) {
  640. if (subset[i].s_addr == fullset[j].s_addr) {
  641. found = 1;
  642. }
  643. }
  644. if (found == 0) {
  645. return (0);
  646. }
  647. found = 1;
  648. }
  649. return (1);
  650. }
  651. /*
  652. * merge subset into fullset taking care not to add duplicates
  653. */
  654. void memb_set_merge (struct in_addr *subset, int subset_entries,
  655. struct in_addr *fullset, int *fullset_entries)
  656. {
  657. int found = 0;
  658. int i;
  659. int j;
  660. for (i = 0; i < subset_entries; i++) {
  661. for (j = 0; j < *fullset_entries; j++) {
  662. if (fullset[j].s_addr == subset[i].s_addr) {
  663. found = 1;
  664. break;
  665. }
  666. }
  667. if (found == 0) {
  668. fullset[j].s_addr = subset[i].s_addr;
  669. *fullset_entries = *fullset_entries + 1;
  670. }
  671. found = 0;
  672. }
  673. return;
  674. }
  675. void memb_set_and (struct in_addr *set1, int set1_entries,
  676. struct in_addr *set2, int set2_entries,
  677. struct in_addr *and, int *and_entries)
  678. {
  679. int i;
  680. int j;
  681. int found = 0;
  682. *and_entries = 0;
  683. for (i = 0; i < set2_entries; i++) {
  684. for (j = 0; j < set1_entries; j++) {
  685. if (set1[j].s_addr == set2[i].s_addr) {
  686. found = 1;
  687. break;
  688. }
  689. }
  690. if (found) {
  691. and[*and_entries].s_addr = set1[j].s_addr;
  692. *and_entries = *and_entries + 1;
  693. }
  694. found = 0;
  695. }
  696. return;
  697. }
  698. void memb_set_print (char *string,
  699. struct in_addr *list, int list_entries)
  700. {
  701. int i;
  702. printf ("List '%s' contains %d entries:\n", string, list_entries);
  703. for (i = 0; i < list_entries; i++) {
  704. printf ("addr %s\n", inet_ntoa (list[i]));
  705. }
  706. }
  707. static void timer_function_orf_token_timeout (void *data);
  708. static void timer_function_token_retransmit_timeout (void *data);
  709. void reset_token_retransmit_timeout (void) {
  710. poll_timer_delete (*totemsrp_poll_handle,
  711. timer_orf_token_retransmit_timeout);
  712. poll_timer_add (*totemsrp_poll_handle, TIMEOUT_TOKEN_RETRANSMIT, 0,
  713. timer_function_token_retransmit_timeout,
  714. &timer_orf_token_retransmit_timeout);
  715. }
  716. void reset_token_timeout (void) {
  717. poll_timer_delete (*totemsrp_poll_handle, timer_orf_token_timeout);
  718. poll_timer_add (*totemsrp_poll_handle, TIMEOUT_TOKEN, (void *)9999,
  719. timer_function_orf_token_timeout, &timer_orf_token_timeout);
  720. }
  721. void cancel_token_timeout (void) {
  722. poll_timer_delete (*totemsrp_poll_handle, timer_orf_token_timeout);
  723. }
  724. void cancel_token_retransmit_timeout (void) {
  725. poll_timer_delete (*totemsrp_poll_handle, timer_orf_token_retransmit_timeout);
  726. }
  727. static void memb_state_consensus_timeout_expired (void)
  728. {
  729. struct in_addr no_consensus_list[MAX_MEMBERS];
  730. int no_consensus_list_entries;
  731. if (memb_consensus_agreed ()) {
  732. memb_consensus_reset ();
  733. memb_consensus_set (&my_id.sin_addr);
  734. reset_token_timeout (); // REVIEWED
  735. } else {
  736. memb_consensus_notset (no_consensus_list,
  737. &no_consensus_list_entries,
  738. my_proc_list, my_proc_list_entries);
  739. memb_set_merge (no_consensus_list, no_consensus_list_entries,
  740. my_failed_list, &my_failed_list_entries);
  741. memb_state_gather_enter ();
  742. }
  743. }
  744. static int memb_join_message_send (void);
  745. /*
  746. * Timers used for various states of the membership algorithm
  747. */
  748. static void timer_function_orf_token_timeout (void *data)
  749. {
  750. totemsrp_log_printf (totemsrp_log_level_notice,
  751. "The token was lost in state %d from timer %x\n", memb_state, data);
  752. switch (memb_state) {
  753. case MEMB_STATE_OPERATIONAL:
  754. memb_state_gather_enter ();
  755. break;
  756. case MEMB_STATE_GATHER:
  757. memb_state_consensus_timeout_expired ();
  758. memb_state_gather_enter ();
  759. break;
  760. case MEMB_STATE_COMMIT:
  761. memb_state_gather_enter ();
  762. break;
  763. case MEMB_STATE_RECOVERY:
  764. printf ("setting my_aru %d to %d\n", my_aru, my_aru_save);
  765. my_aru = my_aru_save;
  766. my_high_seq_received = my_high_seq_received_save;
  767. sq_reinit (&recovery_sort_queue, 0);
  768. queue_reinit (&retrans_message_queue);
  769. // TODO calculate current old ring aru
  770. memb_state_gather_enter();
  771. break;
  772. }
  773. }
  774. static void memb_timer_function_state_gather (void *data)
  775. {
  776. switch (memb_state) {
  777. case MEMB_STATE_OPERATIONAL:
  778. case MEMB_STATE_RECOVERY:
  779. assert (0); /* this should never happen */
  780. break;
  781. case MEMB_STATE_GATHER:
  782. case MEMB_STATE_COMMIT:
  783. memb_join_message_send ();
  784. /*
  785. * Restart the join timeout
  786. `*/
  787. poll_timer_delete (*totemsrp_poll_handle, memb_timer_state_gather_join_timeout);
  788. poll_timer_add (*totemsrp_poll_handle, TIMEOUT_STATE_GATHER_JOIN, 0,
  789. memb_timer_function_state_gather, &memb_timer_state_gather_join_timeout);
  790. break;
  791. }
  792. }
  793. static void memb_timer_function_gather_consensus_timeout (void *data)
  794. {
  795. memb_state_consensus_timeout_expired ();
  796. }
  797. void deliver_messages_from_recovery_to_regular (void)
  798. {
  799. int i;
  800. struct sort_queue_item *recovery_message_item;
  801. struct sort_queue_item regular_message_item;
  802. int res;
  803. void *ptr;
  804. struct mcast *mcast;
  805. /*
  806. * Move messages from recovery to regular sort queue
  807. */
  808. for (i = 1; i <= my_aru; i++) {
  809. res = sq_item_get (&recovery_sort_queue, i, &ptr);
  810. if (res != 0) {
  811. printf ("item not present in recovery sort queue\n");
  812. continue;
  813. }
  814. recovery_message_item = (struct sort_queue_item *)ptr;
  815. /*
  816. * Convert recovery message into regular message
  817. */
  818. if (recovery_message_item->iov_len > 1) {
  819. mcast = recovery_message_item->iovec[1].iov_base;
  820. memcpy (&regular_message_item.iovec[0],
  821. &recovery_message_item->iovec[1],
  822. sizeof (struct iovec) * recovery_message_item->iov_len);
  823. } else {
  824. regular_message_item.iovec[0].iov_base =
  825. recovery_message_item->iovec[0].iov_base + sizeof (struct mcast);
  826. regular_message_item.iovec[0].iov_len =
  827. recovery_message_item->iovec[0].iov_len - sizeof (struct mcast);
  828. mcast = regular_message_item.iovec[0].iov_base;
  829. }
  830. regular_message_item.iov_len = recovery_message_item->iov_len;
  831. res = sq_item_inuse (&regular_sort_queue, mcast->seq);
  832. if (res == 0) {
  833. sq_item_add (&regular_sort_queue,
  834. &regular_message_item, mcast->seq);
  835. }
  836. }
  837. }
  838. /*
  839. * Change states in the state machine of the membership algorithm
  840. */
  841. static void memb_state_operational_enter (void)
  842. {
  843. my_failed_list_entries = 0;
  844. struct in_addr joined_list[MAX_MEMBERS];
  845. int joined_list_entries = 0;
  846. struct in_addr left_list[MAX_MEMBERS];
  847. int left_list_entries = 0;
  848. deliver_messages_from_recovery_to_regular ();
  849. messages_deliver_to_app (0, &my_old_high_seq_delivered, my_high_ring_delivered);
  850. /*
  851. * Calculate joined and left list
  852. */
  853. memb_set_subtract (left_list, &left_list_entries,
  854. my_memb_list, my_memb_entries,
  855. my_trans_memb_list, my_trans_memb_entries);
  856. memb_set_subtract (joined_list, &joined_list_entries,
  857. my_new_memb_list, my_new_memb_entries,
  858. my_trans_memb_list, my_trans_memb_entries);
  859. /*
  860. * Deliver transitional configuration to application
  861. */
  862. totemsrp_confchg_fn (TOTEMSRP_CONFIGURATION_TRANSITIONAL,
  863. my_trans_memb_list, 0, my_trans_memb_entries,
  864. left_list, 0, left_list_entries,
  865. 0, 0, 0);
  866. // TODO we need to filter to ensure we only deliver those
  867. // messages which are part of my_deliver_memb
  868. messages_deliver_to_app (1, &my_old_high_seq_delivered, my_high_ring_delivered);
  869. /*
  870. * Deliver regular configuration to application
  871. */
  872. totemsrp_confchg_fn (TOTEMSRP_CONFIGURATION_REGULAR,
  873. my_new_memb_list, 0, my_new_memb_entries,
  874. 0, 0, 0,
  875. joined_list, 0, joined_list_entries);
  876. /*
  877. * Install new membership
  878. */
  879. my_memb_entries = my_new_memb_entries;
  880. memcpy (my_memb_list, my_new_memb_list,
  881. sizeof (struct in_addr) * my_memb_entries);
  882. last_released = my_aru;
  883. my_set_retrans_flg = 0;
  884. sq_reinit (&regular_sort_queue, my_aru);
  885. sq_reinit (&recovery_sort_queue, 0);
  886. my_high_seq_delivered = my_aru;
  887. my_aru_save = my_aru;
  888. my_high_seq_received_save = my_aru;
  889. my_last_aru = 0;
  890. // TODO the recovery messages are leaked
  891. totemsrp_log_printf (totemsrp_log_level_notice, "entering OPERATIONAL state.\n");
  892. memb_state = MEMB_STATE_OPERATIONAL;
  893. return;
  894. }
  895. static void memb_state_gather_enter (void)
  896. {
  897. // TODO this isn't part of spec but i think its needed
  898. memb_set_merge (&my_id.sin_addr, 1,
  899. my_proc_list, &my_proc_list_entries);
  900. memb_join_message_send ();
  901. /*
  902. * Restart the join timeout
  903. */
  904. poll_timer_delete (*totemsrp_poll_handle, memb_timer_state_gather_join_timeout);
  905. poll_timer_add (*totemsrp_poll_handle, TIMEOUT_STATE_GATHER_JOIN, 0,
  906. memb_timer_function_state_gather, &memb_timer_state_gather_join_timeout);
  907. /*
  908. * Restart the consensus timeout
  909. */
  910. poll_timer_delete (*totemsrp_poll_handle,
  911. memb_timer_state_gather_consensus_timeout);
  912. poll_timer_add (*totemsrp_poll_handle, TIMEOUT_STATE_GATHER_CONSENSUS, 0,
  913. memb_timer_function_gather_consensus_timeout,
  914. &memb_timer_state_gather_consensus_timeout);
  915. /*
  916. * Cancel the token loss and token retransmission timeouts
  917. */
  918. cancel_token_retransmit_timeout (); // REVIEWED
  919. cancel_token_timeout (); // REVIEWED
  920. memb_consensus_reset ();
  921. memb_consensus_set (&my_id.sin_addr);
  922. totemsrp_log_printf (totemsrp_log_level_notice, "entering GATHER state.\n");
  923. memb_state = MEMB_STATE_GATHER;
  924. return;
  925. }
  926. void timer_function_token_retransmit_timeout (void *data);
  927. static void memb_state_commit_enter (struct memb_commit_token *commit_token)
  928. {
  929. memb_state_commit_token_update (commit_token);
  930. memb_state_commit_token_send (commit_token);
  931. memb_ring_id_store (commit_token);
  932. poll_timer_delete (*totemsrp_poll_handle, memb_timer_state_gather_join_timeout);
  933. memb_timer_state_gather_join_timeout = 0;
  934. poll_timer_delete (*totemsrp_poll_handle, memb_timer_state_gather_consensus_timeout);
  935. memb_timer_state_gather_consensus_timeout = 0;
  936. reset_token_timeout (); // REVIEWED
  937. reset_token_retransmit_timeout (); // REVIEWED
  938. totemsrp_log_printf (totemsrp_log_level_notice, "entering COMMIT state.\n");
  939. memb_state = MEMB_STATE_COMMIT;
  940. return;
  941. }
  942. void memb_state_recovery_enter (struct memb_commit_token *commit_token)
  943. {
  944. int i;
  945. unsigned int low_ring_aru = 0xFFFFFFFF;
  946. int local_received_flg = 1;
  947. my_high_ring_delivered = 0;
  948. int copy_min;
  949. int copy_max;
  950. memb_state_commit_token_send (commit_token);
  951. my_token_seq = -1;
  952. /*
  953. * Build regular configuration
  954. */
  955. my_new_memb_entries = commit_token->addr_entries;
  956. memcpy (my_new_memb_list, commit_token->addr,
  957. sizeof (struct in_addr) * my_new_memb_entries);
  958. /*
  959. * Build transitional configuration
  960. */
  961. memb_set_and (my_new_memb_list, my_new_memb_entries,
  962. my_memb_list, my_memb_entries,
  963. my_trans_memb_list, &my_trans_memb_entries);
  964. for (i = 0; i < my_new_memb_entries; i++) {
  965. printf ("position [%d] member %s:\n", i, inet_ntoa (commit_token->addr[i]));
  966. printf ("previous ring seq %lld rep %s\n",
  967. commit_token->memb_list[i].ring_id.seq,
  968. inet_ntoa (commit_token->memb_list[i].ring_id.rep));
  969. //assert (commit_token->memb_list[i].ring_id.rep.s_addr);
  970. printf ("aru %d high delivered %d received flag %d\n",
  971. commit_token->memb_list[i].aru,
  972. commit_token->memb_list[i].high_delivered,
  973. commit_token->memb_list[i].received_flg);
  974. assert (commit_token->memb_list[i].ring_id.rep.s_addr);
  975. }
  976. /*
  977. * Determine if any received flag is false
  978. */
  979. for (i = 0; i < commit_token->addr_entries; i++) {
  980. if (memb_set_subset (&my_new_memb_list[i], 1,
  981. my_trans_memb_list, my_trans_memb_entries) &&
  982. commit_token->memb_list[i].received_flg == 0) {
  983. my_deliver_memb_entries = my_trans_memb_entries;
  984. memcpy (my_deliver_memb_list, my_trans_memb_list,
  985. sizeof (struct in_addr) * my_trans_memb_entries);
  986. local_received_flg = 0;
  987. break;
  988. }
  989. }
  990. if (local_received_flg == 0) {
  991. /*
  992. * Calculate low ring_aru, my_high_ring_delivered for the transitional membership
  993. */
  994. for (i = 0; i < commit_token->addr_entries; i++) {
  995. if (memb_set_subset (&my_new_memb_list[i], 1,
  996. my_deliver_memb_list, my_deliver_memb_entries)) {
  997. if (low_ring_aru > commit_token->memb_list[i].aru) {
  998. low_ring_aru = commit_token->memb_list[i].aru;
  999. }
  1000. if (my_high_ring_delivered < commit_token->memb_list[i].high_delivered) {
  1001. my_high_ring_delivered = commit_token->memb_list[i].high_delivered;
  1002. }
  1003. }
  1004. }
  1005. /*
  1006. * Copy all old ring messages to retrans_message_queue
  1007. */
  1008. { int j = 0;
  1009. // TODO this shouldn't be needed
  1010. copy_min = low_ring_aru;
  1011. if ((last_released - 1) > copy_min) {
  1012. copy_min = (last_released - 1);
  1013. }
  1014. copy_max = my_high_ring_delivered;
  1015. if (copy_max > my_high_seq_received) {
  1016. copy_max = my_high_seq_received;
  1017. }
  1018. totemsrp_log_printf (totemsrp_log_level_notice,
  1019. "copying all old messages from %d to %d, range %d-%d.\n",
  1020. low_ring_aru, my_high_ring_delivered, copy_min, copy_max);
  1021. for (i = copy_min + 1; i <= copy_max; i++) {
  1022. struct sort_queue_item *sort_queue_item;
  1023. struct message_item message_item;
  1024. void *ptr;
  1025. int res;
  1026. res = sq_item_get (&regular_sort_queue, i, &ptr);
  1027. if (res != 0) {
  1028. continue;
  1029. }
  1030. j++;
  1031. sort_queue_item = ptr;
  1032. memset (&message_item, 0, sizeof (struct message_item));
  1033. message_item.mcast = malloc (sizeof (struct mcast));
  1034. assert (message_item.mcast);
  1035. memcpy (message_item.mcast, sort_queue_item->iovec[0].iov_base,
  1036. sizeof (struct mcast));
  1037. message_item.iov_len = sort_queue_item->iov_len;
  1038. message_item.iov_len = sort_queue_item->iov_len;
  1039. memcpy (&message_item.iovec, &sort_queue_item->iovec, sizeof (struct iovec) *
  1040. sort_queue_item->iov_len);
  1041. queue_item_add (&retrans_message_queue, &message_item);
  1042. }
  1043. totemsrp_log_printf (totemsrp_log_level_notice,
  1044. "Originated %d messages in RECOVERY.\n", j);
  1045. }
  1046. }
  1047. my_aru_save = my_aru;
  1048. my_high_seq_received_save = my_high_seq_received;
  1049. my_aru = 0;
  1050. my_aru_count = 0;
  1051. my_seq_unchanged = 0;
  1052. my_high_seq_received = 0;
  1053. my_install_seq = 0;
  1054. my_old_high_seq_delivered = my_high_seq_delivered;
  1055. totemsrp_log_printf (totemsrp_log_level_notice, "entering RECOVERY state.\n");
  1056. reset_token_timeout (); // REVIEWED
  1057. reset_token_retransmit_timeout (); // REVIEWED
  1058. memb_state = MEMB_STATE_RECOVERY;
  1059. return;
  1060. }
  1061. static void encrypt_and_sign (struct iovec *iovec, int iov_len)
  1062. {
  1063. char *addr = iov_encrypted.iov_base + sizeof (struct security_header);
  1064. int i;
  1065. char keys[48];
  1066. struct security_header *header = iov_encrypted.iov_base;
  1067. prng_state keygen_prng_state;
  1068. prng_state stream_prng_state;
  1069. char *hmac_key = &keys[32];
  1070. char *cipher_key = &keys[16];
  1071. char *initial_vector = &keys[0];
  1072. unsigned long len;
  1073. iov_encrypted.iov_len = 0;
  1074. memset (keys, 0, sizeof (keys));
  1075. memset (header->salt, 0, sizeof (header->salt));
  1076. #if (defined(ENCRYPTION) || defined(AUTHENITCATION))
  1077. /*
  1078. * Generate MAC, CIPHER, IV keys from private key
  1079. */
  1080. sober128_read (header->salt, sizeof (header->salt), &totemsrp_prng_state);
  1081. sober128_start (&keygen_prng_state);
  1082. sober128_add_entropy (totemsrp_private_key, totemsrp_private_key_len, &keygen_prng_state);
  1083. sober128_add_entropy (header->salt, sizeof (header->salt), &keygen_prng_state);
  1084. sober128_read (keys, sizeof (keys), &keygen_prng_state);
  1085. #endif
  1086. #ifdef ENCRYPTION
  1087. /*
  1088. * Setup stream cipher
  1089. */
  1090. sober128_start (&stream_prng_state);
  1091. sober128_add_entropy (cipher_key, 16, &stream_prng_state);
  1092. sober128_add_entropy (initial_vector, 16, &stream_prng_state);
  1093. #endif
  1094. if (log_digest) {
  1095. printf ("new encryption\n");
  1096. print_digest ("salt", header->salt);
  1097. print_digest ("initial_vector", initial_vector);
  1098. print_digest ("cipher_key", cipher_key);
  1099. print_digest ("hmac_key", hmac_key);
  1100. }
  1101. /*
  1102. * Copy header of message, then remainder of message, then encrypt it
  1103. */
  1104. memcpy (addr, iovec[0].iov_base + sizeof (struct security_header),
  1105. iovec[0].iov_len - sizeof (struct security_header));
  1106. addr += iovec[0].iov_len - sizeof (struct security_header);
  1107. iov_encrypted.iov_len += iovec[0].iov_len;
  1108. for (i = 1; i < iov_len; i++) {
  1109. memcpy (addr, iovec[i].iov_base, iovec[i].iov_len);
  1110. addr += iovec[i].iov_len;
  1111. iov_encrypted.iov_len += iovec[i].iov_len;
  1112. }
  1113. /*
  1114. * Encrypt message by XORing stream cipher data
  1115. */
  1116. #ifdef ENCRYPTION
  1117. sober128_read (iov_encrypted.iov_base + sizeof (struct security_header),
  1118. iov_encrypted.iov_len - sizeof (struct security_header),
  1119. &stream_prng_state);
  1120. #endif
  1121. #ifdef AUTHENTICATION
  1122. memset (&totemsrp_hmac_state, 0, sizeof (hmac_state));
  1123. /*
  1124. * Sign the contents of the message with the hmac key and store signature in message
  1125. */
  1126. hmac_init (&totemsrp_hmac_state, DIGEST_SHA1, hmac_key, 16);
  1127. hmac_process (&totemsrp_hmac_state,
  1128. iov_encrypted.iov_base + HMAC_HASH_SIZE,
  1129. iov_encrypted.iov_len - HMAC_HASH_SIZE);
  1130. len = hash_descriptor[DIGEST_SHA1]->hashsize;
  1131. hmac_done (&totemsrp_hmac_state, header->hash_digest, &len);
  1132. #endif
  1133. #ifdef COMPILE_OUT
  1134. print_digest ("initial_vector", initial_vector);
  1135. print_digest ("cipher_key", cipher_key);
  1136. print_digest ("hmac_key", hmac_key);
  1137. print_digest ("salt", header->salt);
  1138. print_digest ("sent digest", header->hash_digest);
  1139. #endif
  1140. }
  1141. /*
  1142. * Only designed to work with a message with one iov
  1143. */
  1144. static int authenticate_and_decrypt (struct iovec *iov)
  1145. {
  1146. char keys[48];
  1147. struct security_header *header = iov[0].iov_base;
  1148. prng_state keygen_prng_state;
  1149. prng_state stream_prng_state;
  1150. char *hmac_key = &keys[32];
  1151. char *cipher_key = &keys[16];
  1152. char *initial_vector = &keys[0];
  1153. char digest_comparison[HMAC_HASH_SIZE];
  1154. unsigned long len;
  1155. int res = 0;
  1156. iov_encrypted.iov_len = 0;
  1157. #ifdef COMPILE_OUT
  1158. printf ("Decryption message\n");
  1159. print_msg (header, iov[0].iov_len);
  1160. #endif
  1161. #if (defined(ENCRYPTION) || defined(AUTHENITCATION))
  1162. /*
  1163. * Generate MAC, CIPHER, IV keys from private key
  1164. */
  1165. memset (keys, 0, sizeof (keys));
  1166. sober128_start (&keygen_prng_state);
  1167. sober128_add_entropy (totemsrp_private_key, totemsrp_private_key_len, &keygen_prng_state);
  1168. sober128_add_entropy (header->salt, sizeof (header->salt), &keygen_prng_state);
  1169. sober128_read (keys, sizeof (keys), &keygen_prng_state);
  1170. #endif
  1171. #ifdef ENCRYPTION
  1172. /*
  1173. * Setup stream cipher
  1174. */
  1175. sober128_start (&stream_prng_state);
  1176. sober128_add_entropy (cipher_key, 16, &stream_prng_state);
  1177. sober128_add_entropy (initial_vector, 16, &stream_prng_state);
  1178. #endif
  1179. if (log_digest) {
  1180. printf ("New decryption\n");
  1181. print_digest ("salt", header->salt);
  1182. print_digest ("initial_vector", initial_vector);
  1183. print_digest ("cipher_key", cipher_key);
  1184. print_digest ("hmac_key", hmac_key);
  1185. }
  1186. #ifdef AUTHENTICATION
  1187. /*
  1188. * Authenticate contents of message
  1189. */
  1190. hmac_init (&totemsrp_hmac_state, DIGEST_SHA1, hmac_key, 16);
  1191. hmac_process (&totemsrp_hmac_state,
  1192. iov->iov_base + HMAC_HASH_SIZE,
  1193. iov->iov_len - HMAC_HASH_SIZE);
  1194. len = hash_descriptor[DIGEST_SHA1]->hashsize;
  1195. assert (HMAC_HASH_SIZE >= len);
  1196. hmac_done (&totemsrp_hmac_state, digest_comparison, &len);
  1197. #ifdef PRINTDIGESTS
  1198. print_digest ("received digest", header->hash_digest);
  1199. print_digest ("calculated digest", digest_comparison);
  1200. #endif
  1201. if (memcmp (digest_comparison, header->hash_digest, len) != 0) {
  1202. print_digest ("initial_vector", initial_vector);
  1203. print_digest ("cipher_key", cipher_key);
  1204. print_digest ("hmac_key", hmac_key);
  1205. print_digest ("salt", header->salt);
  1206. print_digest ("sent digest", header->hash_digest);
  1207. print_digest ("calculated digest", digest_comparison);
  1208. printf ("received message size %d\n", iov->iov_len);
  1209. totemsrp_log_printf (totemsrp_log_level_security, "Received message has invalid digest... ignoring.\n");
  1210. res = -1;
  1211. exit (1); // TODO this shouldn't be an exit but I want to catch invalid digests
  1212. return (-1);
  1213. }
  1214. #endif /* AUTHENTICATION */
  1215. /*
  1216. * Decrypt the contents of the message with the cipher key
  1217. */
  1218. #ifdef ENCRYPTION
  1219. sober128_read (iov->iov_base + sizeof (struct security_header),
  1220. iov->iov_len - sizeof (struct security_header),
  1221. &stream_prng_state);
  1222. #endif
  1223. return (res);
  1224. return (0);
  1225. }
  1226. int totemsrp_mcast (
  1227. struct iovec *iovec,
  1228. int iov_len,
  1229. int guarantee)
  1230. {
  1231. int i;
  1232. int j;
  1233. struct message_item message_item;
  1234. if (queue_is_full (&new_message_queue)) {
  1235. assert (0);
  1236. return (-1);
  1237. }
  1238. for (j = 0, i = 0; i < iov_len; i++) {
  1239. j+= iovec[i].iov_len;
  1240. }
  1241. // assert (j == FRAGMENT_SIZE || j == (FRAGMENT_SIZE - 2)); /* ensure we use the maximum badnwidth available for now */
  1242. // printf ("j is %d fragment size is %d\n", j, FRAGMENT_SIZE);
  1243. // assert (j <= FRAGMENT_SIZE);
  1244. totemsrp_log_printf (totemsrp_log_level_debug, "Multicasting message.\n");
  1245. memset (&message_item, 0, sizeof (struct message_item));
  1246. /*
  1247. * Allocate pending item
  1248. */
  1249. message_item.mcast = malloc (sizeof (struct mcast));
  1250. if (message_item.mcast == 0) {
  1251. goto error_mcast;
  1252. }
  1253. /*
  1254. * Set mcast header
  1255. */
  1256. message_item.mcast->header.type = MESSAGE_TYPE_MCAST;
  1257. message_item.mcast->header.endian_detector = ENDIAN_LOCAL;
  1258. message_item.mcast->header.encapsulated = 0;
  1259. message_item.mcast->guarantee = guarantee;
  1260. message_item.mcast->source.s_addr = my_id.sin_addr.s_addr;
  1261. for (i = 0; i < iov_len; i++) {
  1262. message_item.iovec[i].iov_base = malloc (iovec[i].iov_len);
  1263. if (message_item.iovec[i].iov_base == 0) {
  1264. goto error_iovec;
  1265. }
  1266. memcpy (message_item.iovec[i].iov_base, iovec[i].iov_base,
  1267. iovec[i].iov_len);
  1268. message_item.iovec[i].iov_len = iovec[i].iov_len;
  1269. }
  1270. message_item.iov_len = iov_len;
  1271. totemsrp_log_printf (totemsrp_log_level_debug, "mcasted message added to pending queue\n");
  1272. queue_item_add (&new_message_queue, &message_item);
  1273. return (0);
  1274. error_iovec:
  1275. for (j = 0; j < i; j++) {
  1276. free (message_item.iovec[j].iov_base);
  1277. }
  1278. return (-1);
  1279. error_mcast:
  1280. return (0);
  1281. }
  1282. /*
  1283. * Determine if there is room to queue a new message
  1284. */
  1285. int totemsrp_avail (void)
  1286. {
  1287. int avail;
  1288. queue_avail (&new_message_queue, &avail);
  1289. return (avail);
  1290. }
  1291. static int netif_determine (struct sockaddr_in *bindnet,
  1292. struct sockaddr_in *bound_to)
  1293. {
  1294. struct sockaddr_in *sockaddr_in;
  1295. int id_fd;
  1296. struct ifconf ifc;
  1297. int numreqs = 0;
  1298. int res;
  1299. int i;
  1300. in_addr_t mask_addr;
  1301. /*
  1302. * Generate list of local interfaces in ifc.ifc_req structure
  1303. */
  1304. id_fd = socket (AF_INET, SOCK_STREAM, 0);
  1305. ifc.ifc_buf = 0;
  1306. do {
  1307. numreqs += 32;
  1308. ifc.ifc_len = sizeof (struct ifreq) * numreqs;
  1309. ifc.ifc_buf = (void *)realloc(ifc.ifc_buf, ifc.ifc_len);
  1310. res = ioctl (id_fd, SIOCGIFCONF, &ifc);
  1311. if (res < 0) {
  1312. close (id_fd);
  1313. return -1;
  1314. }
  1315. } while (ifc.ifc_len == sizeof (struct ifreq) * numreqs);
  1316. res = -1;
  1317. /*
  1318. * Find interface address to bind to
  1319. */
  1320. for (i = 0; i < ifc.ifc_len / sizeof (struct ifreq); i++) {
  1321. sockaddr_in = (struct sockaddr_in *)&ifc.ifc_ifcu.ifcu_req[i].ifr_ifru.ifru_addr;
  1322. mask_addr = inet_addr ("255.255.255.0");
  1323. if ((sockaddr_in->sin_family == AF_INET) &&
  1324. (sockaddr_in->sin_addr.s_addr & mask_addr) ==
  1325. (bindnet->sin_addr.s_addr & mask_addr)) {
  1326. bound_to->sin_addr.s_addr = sockaddr_in->sin_addr.s_addr;
  1327. res = i;
  1328. break; /* for */
  1329. }
  1330. }
  1331. free (ifc.ifc_buf);
  1332. close (id_fd);
  1333. return (res);
  1334. }
  1335. static int totemsrp_build_sockets (struct sockaddr_in *sockaddr_mcast,
  1336. struct sockaddr_in *sockaddr_bindnet,
  1337. struct totemsrp_socket *sockets,
  1338. struct sockaddr_in *bound_to)
  1339. {
  1340. struct ip_mreq mreq;
  1341. struct sockaddr_in sockaddr_in;
  1342. char flag;
  1343. int res;
  1344. memset (&mreq, 0, sizeof (struct ip_mreq));
  1345. /*
  1346. * Determine the ip address bound to and the interface name
  1347. */
  1348. res = netif_determine (sockaddr_bindnet,
  1349. bound_to);
  1350. if (res == -1) {
  1351. return (-1);
  1352. }
  1353. /* TODO this should be somewhere else */
  1354. memb_local_sockaddr_in.sin_addr.s_addr = bound_to->sin_addr.s_addr;
  1355. memb_local_sockaddr_in.sin_family = AF_INET;
  1356. memb_local_sockaddr_in.sin_port = sockaddr_mcast->sin_port;
  1357. /*
  1358. * Create multicast socket
  1359. */
  1360. sockets->mcast = socket (AF_INET, SOCK_DGRAM, 0);
  1361. if (sockets->mcast == -1) {
  1362. perror ("socket");
  1363. return (-1);
  1364. }
  1365. if (setsockopt (sockets->mcast, SOL_IP, IP_MULTICAST_IF,
  1366. &bound_to->sin_addr, sizeof (struct in_addr)) < 0) {
  1367. totemsrp_log_printf (totemsrp_log_level_warning, "Could not bind to device for multicast, group messaging may not work properly. (%s)\n", strerror (errno));
  1368. }
  1369. /*
  1370. * Bind to multicast socket used for multicast send/receives
  1371. */
  1372. sockaddr_in.sin_family = AF_INET;
  1373. sockaddr_in.sin_addr.s_addr = sockaddr_mcast->sin_addr.s_addr;
  1374. sockaddr_in.sin_port = sockaddr_mcast->sin_port;
  1375. res = bind (sockets->mcast, (struct sockaddr *)&sockaddr_in,
  1376. sizeof (struct sockaddr_in));
  1377. if (res == -1) {
  1378. perror ("bind failed");
  1379. return (-1);
  1380. }
  1381. /*
  1382. * Setup unicast socket
  1383. */
  1384. sockets->token = socket (AF_INET, SOCK_DGRAM, 0);
  1385. if (sockets->token == -1) {
  1386. perror ("socket2");
  1387. return (-1);
  1388. }
  1389. /*
  1390. * Bind to unicast socket used for token send/receives
  1391. * This has the side effect of binding to the correct interface
  1392. */
  1393. sockaddr_in.sin_addr.s_addr = bound_to->sin_addr.s_addr;
  1394. res = bind (sockets->token, (struct sockaddr *)&sockaddr_in,
  1395. sizeof (struct sockaddr_in));
  1396. if (res == -1) {
  1397. perror ("bind2 failed");
  1398. return (-1);
  1399. }
  1400. #ifdef CONFIG_USE_BROADCAST
  1401. /* This config option doesn't work */
  1402. {
  1403. int on = 1;
  1404. setsockopt (sockets->mcast, SOL_SOCKET, SO_BROADCAST, (char *)&on, sizeof (on));
  1405. }
  1406. #else
  1407. /*
  1408. * Join group membership on socket
  1409. */
  1410. mreq.imr_multiaddr.s_addr = sockaddr_mcast->sin_addr.s_addr;
  1411. mreq.imr_interface.s_addr = bound_to->sin_addr.s_addr;
  1412. res = setsockopt (sockets->mcast, IPPROTO_IP, IP_ADD_MEMBERSHIP,
  1413. &mreq, sizeof (mreq));
  1414. if (res == -1) {
  1415. perror ("join multicast group failed");
  1416. return (-1);
  1417. }
  1418. #endif
  1419. /*
  1420. * Turn on multicast loopback
  1421. */
  1422. flag = 1;
  1423. res = setsockopt (sockets->mcast, IPPROTO_IP, IP_MULTICAST_LOOP,
  1424. &flag, sizeof (flag));
  1425. if (res == -1) {
  1426. perror ("turn off loopback");
  1427. return (-1);
  1428. }
  1429. return (0);
  1430. }
  1431. /*
  1432. * Misc Management
  1433. */
  1434. int in_addr_compare (const void *a, const void *b) {
  1435. struct in_addr *in_addr_a = (struct in_addr *)a;
  1436. struct in_addr *in_addr_b = (struct in_addr *)b;
  1437. return (in_addr_a->s_addr > in_addr_b->s_addr);
  1438. }
  1439. /*
  1440. * ORF Token Management
  1441. */
  1442. /*
  1443. * Recast message to mcast group if it is available
  1444. */
  1445. int orf_token_remcast (int seq) {
  1446. struct msghdr msg_mcast;
  1447. struct sort_queue_item *sort_queue_item;
  1448. int res;
  1449. struct mcast *mcast;
  1450. void *ptr;
  1451. struct sq *sort_queue;
  1452. if (memb_state == MEMB_STATE_RECOVERY) {
  1453. sort_queue = &recovery_sort_queue;
  1454. } else {
  1455. sort_queue = &regular_sort_queue;
  1456. }
  1457. /*
  1458. * Get RTR item at seq, if not available, return
  1459. */
  1460. res = sq_item_get (sort_queue, seq, &ptr);
  1461. if (res != 0) {
  1462. return -1;
  1463. }
  1464. sort_queue_item = ptr;
  1465. mcast = (struct mcast *)sort_queue_item->iovec[0].iov_base;
  1466. encrypt_and_sign (sort_queue_item->iovec, sort_queue_item->iov_len);
  1467. /*
  1468. * Build multicast message
  1469. */
  1470. msg_mcast.msg_name = (caddr_t)&sockaddr_in_mcast;
  1471. msg_mcast.msg_namelen = sizeof (struct sockaddr_in);
  1472. msg_mcast.msg_iov = &iov_encrypted;
  1473. msg_mcast.msg_iovlen = 1;
  1474. msg_mcast.msg_control = 0;
  1475. msg_mcast.msg_controllen = 0;
  1476. msg_mcast.msg_flags = 0;
  1477. /*
  1478. * Multicast message
  1479. */
  1480. res = sendmsg (totemsrp_sockets[0].mcast, &msg_mcast, MSG_NOSIGNAL | MSG_DONTWAIT);
  1481. if (res == -1) {
  1482. printf ("error during remulticast %d %d %d\n", seq, errno, sort_queue_item->iov_len);
  1483. return (-1);
  1484. }
  1485. stats_sent += res;
  1486. return (0);
  1487. }
  1488. /*
  1489. * Free all freeable messages from ring
  1490. */
  1491. static int messages_free (int token_aru)
  1492. {
  1493. struct sort_queue_item *regular_message;
  1494. int i, j;
  1495. int res;
  1496. int log_release = 0;
  1497. int release_to;
  1498. release_to = token_aru;
  1499. if (release_to > my_last_aru) {
  1500. release_to = my_last_aru;
  1501. }
  1502. /*
  1503. * Release retransmit list items if group aru indicates they are transmitted
  1504. */
  1505. for (i = last_released; i <= release_to; i++) {
  1506. void *ptr;
  1507. res = sq_item_get (&regular_sort_queue, i, &ptr);
  1508. if (res == 0) {
  1509. regular_message = ptr;
  1510. for (j = 0; j < regular_message->iov_len; j++) {
  1511. free (regular_message->iovec[j].iov_base);
  1512. }
  1513. }
  1514. sq_items_release (&regular_sort_queue, i);
  1515. last_released = i + 1;
  1516. log_release = 1;
  1517. }
  1518. log_release=1;
  1519. if (log_release) {
  1520. //TODprintf ("%d\n", lesser);
  1521. // totemsrp_log_printf (totemsrp_log_level_notice,
  1522. // "releasing messages up to and including %d\n", lesser);
  1523. }
  1524. return (0);
  1525. }
  1526. void update_aru (void)
  1527. {
  1528. int i;
  1529. int res;
  1530. struct sq *sort_queue;
  1531. if (memb_state == MEMB_STATE_RECOVERY) {
  1532. sort_queue = &recovery_sort_queue;
  1533. } else {
  1534. sort_queue = &regular_sort_queue;
  1535. }
  1536. for (i = my_aru + 1; i <= my_high_seq_received; i++) {
  1537. void *ptr;
  1538. res = sq_item_get (sort_queue, i, &ptr);
  1539. /*
  1540. * If hole, stop assembly
  1541. */
  1542. if (res != 0) {
  1543. break;
  1544. }
  1545. my_aru = i;
  1546. }
  1547. //printf ("setting received flag to false %d %d\n", my_aru, my_high_seq_received);
  1548. my_received_flg = 0;
  1549. if (my_aru == my_high_seq_received) {
  1550. //TODOprintf ("setting received flag to TRUE %d %d\n", my_aru, my_high_seq_received);
  1551. my_received_flg = 1;
  1552. }
  1553. }
  1554. /*
  1555. * Multicasts pending messages onto the ring (requires orf_token possession)
  1556. */
  1557. static int orf_token_mcast (
  1558. struct orf_token *token,
  1559. int fcc_mcasts_allowed,
  1560. struct sockaddr_in *system_from)
  1561. {
  1562. struct msghdr msg_mcast;
  1563. struct sort_queue_item sort_queue_item;
  1564. struct message_item *message_item = 0;
  1565. int res = 0;
  1566. struct mcast *mcast;
  1567. struct queue *mcast_queue;
  1568. struct sq *sort_queue;
  1569. if (memb_state == MEMB_STATE_RECOVERY) {
  1570. mcast_queue = &retrans_message_queue;
  1571. sort_queue = &recovery_sort_queue;
  1572. reset_token_retransmit_timeout (); // REVIEWED
  1573. } else {
  1574. mcast_queue = &new_message_queue;
  1575. sort_queue = &regular_sort_queue;
  1576. }
  1577. for (fcc_mcast_current = 0; fcc_mcast_current < fcc_mcasts_allowed; fcc_mcast_current++) {
  1578. if (queue_is_empty (mcast_queue)) {
  1579. break;
  1580. }
  1581. message_item = (struct message_item *)queue_item_get (mcast_queue);
  1582. /* preincrement required by algo */
  1583. message_item->mcast->seq = ++token->seq;
  1584. /*
  1585. * Build IO vector
  1586. */
  1587. memset (&sort_queue_item, 0, sizeof (struct sort_queue_item));
  1588. sort_queue_item.iovec[0].iov_base = message_item->mcast;
  1589. sort_queue_item.iovec[0].iov_len = sizeof (struct mcast);
  1590. mcast = sort_queue_item.iovec[0].iov_base;
  1591. memcpy (&sort_queue_item.iovec[1], message_item->iovec,
  1592. message_item->iov_len * sizeof (struct iovec));
  1593. sort_queue_item.iov_len = message_item->iov_len + 1;
  1594. assert (sort_queue_item.iov_len < 16);
  1595. /*
  1596. * Add message to retransmit queue
  1597. */
  1598. sq_item_add (sort_queue,
  1599. &sort_queue_item, message_item->mcast->seq);
  1600. /*
  1601. * Delete item from pending queue
  1602. */
  1603. queue_item_remove (mcast_queue);
  1604. /*
  1605. * Encrypt and digest the message
  1606. */
  1607. encrypt_and_sign (sort_queue_item.iovec, sort_queue_item.iov_len);
  1608. /*
  1609. * Build multicast message
  1610. */
  1611. msg_mcast.msg_name = &sockaddr_in_mcast;
  1612. msg_mcast.msg_namelen = sizeof (struct sockaddr_in);
  1613. msg_mcast.msg_iov = &iov_encrypted;
  1614. msg_mcast.msg_iovlen = 1;
  1615. msg_mcast.msg_control = 0;
  1616. msg_mcast.msg_controllen = 0;
  1617. msg_mcast.msg_flags = 0;
  1618. /*
  1619. * Multicast message
  1620. * An error here is recovered by the multicast algorithm
  1621. */
  1622. res = sendmsg (totemsrp_sockets[0].mcast, &msg_mcast, MSG_NOSIGNAL | MSG_DONTWAIT);
  1623. //printf ("multicasting %d bytes\n", res);
  1624. //f (res != iov_encrypted.iov_len) {
  1625. //printf ("res %d errno is %d\n", res, errno);
  1626. //}
  1627. // assert (res == iov_encrypted.iov_len);
  1628. iov_encrypted.iov_len = PACKET_SIZE_MAX;
  1629. if (res > 0) {
  1630. stats_sent += res;
  1631. }
  1632. }
  1633. assert (fcc_mcast_current < 100);
  1634. /*
  1635. * If messages mcasted, deliver any new messages to totemg
  1636. */
  1637. if (fcc_mcast_current) {
  1638. my_do_delivery = 1;
  1639. }
  1640. my_high_seq_received = token->seq;
  1641. update_aru ();
  1642. /*
  1643. * Return 1 if more messages are available for single node clusters
  1644. */
  1645. return (fcc_mcast_current);
  1646. }
  1647. /*
  1648. * Remulticasts messages in orf_token's retransmit list (requires orf_token)
  1649. * Modify's orf_token's rtr to include retransmits required by this process
  1650. */
  1651. static int orf_token_rtr (
  1652. struct orf_token *orf_token,
  1653. int *fcc_allowed)
  1654. {
  1655. int res;
  1656. int i, j;
  1657. int found;
  1658. int total_entries;
  1659. struct sq *sort_queue;
  1660. struct rtr_item *rtr_list;
  1661. if (memb_state == MEMB_STATE_RECOVERY) {
  1662. sort_queue = &recovery_sort_queue;
  1663. } else {
  1664. sort_queue = &regular_sort_queue;
  1665. }
  1666. rtr_list = &orf_token->rtr_list[0];
  1667. if (orf_token->rtr_list_entries) {
  1668. printf ("Retransmit List %d\n", orf_token->rtr_list_entries);
  1669. for (i = 0; i < orf_token->rtr_list_entries; i++) {
  1670. printf ("%d ", rtr_list[i].seq);
  1671. }
  1672. printf ("\n");
  1673. }
  1674. total_entries = orf_token->rtr_list_entries;
  1675. /*
  1676. * Retransmit messages on orf_token's RTR list from RTR queue
  1677. */
  1678. for (fcc_remcast_current = 0, i = 0;
  1679. fcc_remcast_current <= *fcc_allowed && i < orf_token->rtr_list_entries;) {
  1680. /*
  1681. * If this retransmit request isn't from this configuration,
  1682. * try next rtr entry
  1683. */
  1684. if (memcmp (&rtr_list[i].ring_id, &my_ring_id,
  1685. sizeof (struct memb_ring_id)) != 0) {
  1686. printf ("retransmit for a different config %d\n", rtr_list[i].seq);
  1687. i += 1;
  1688. continue;
  1689. }
  1690. assert (rtr_list[i].seq > 0);
  1691. res = orf_token_remcast (rtr_list[i].seq);
  1692. if (res == 0) {
  1693. /*
  1694. * Multicasted message, so no need to copy to new retransmit list
  1695. */
  1696. orf_token->rtr_list_entries -= 1;
  1697. assert (orf_token->rtr_list_entries >= 0);
  1698. memmove (&rtr_list[i], &rtr_list[i + 1],
  1699. sizeof (struct rtr_item) * (orf_token->rtr_list_entries));
  1700. fcc_remcast_current++;
  1701. stats_remcasts++;
  1702. } else {
  1703. i += 1;
  1704. }
  1705. }
  1706. *fcc_allowed = *fcc_allowed - fcc_remcast_current - 1;
  1707. #ifdef COMPILE_OUT
  1708. for (i = 0; i < orf_token->rtr_list_entries; i++) {
  1709. assert (rtr_list_old[index_old].seq != -1);
  1710. }
  1711. #endif
  1712. /*
  1713. * Add messages to retransmit to RTR list
  1714. * but only retry if there is room in the retransmit list
  1715. */
  1716. for (i = my_aru + 1;
  1717. orf_token->rtr_list_entries < RETRANSMIT_ENTRIES_MAX &&
  1718. i <= my_high_seq_received;
  1719. i++) {
  1720. /*
  1721. * Find if a message is missing from this processor
  1722. */
  1723. res = sq_item_inuse (sort_queue, i);
  1724. if (res == 0) {
  1725. /*
  1726. * Determine if missing message is already in retransmit list
  1727. */
  1728. found = 0;
  1729. for (j = 0; j < orf_token->rtr_list_entries; j++) {
  1730. if (i == rtr_list[j].seq) {
  1731. found = 1;
  1732. }
  1733. }
  1734. if (found == 0) {
  1735. /*
  1736. * Missing message not found in current retransmit list so add it
  1737. */
  1738. memcpy (&rtr_list[orf_token->rtr_list_entries].ring_id,
  1739. &my_ring_id, sizeof (struct memb_ring_id));
  1740. rtr_list[orf_token->rtr_list_entries].seq = i;
  1741. orf_token->rtr_list_entries++;
  1742. }
  1743. }
  1744. }
  1745. return (fcc_remcast_current);
  1746. }
  1747. void token_retransmit (void) {
  1748. struct iovec iovec;
  1749. struct msghdr msg_orf_token;
  1750. int res;
  1751. iovec.iov_base = orf_token_retransmit;
  1752. iovec.iov_len = orf_token_retransmit_size;
  1753. msg_orf_token.msg_name = &next_memb;
  1754. msg_orf_token.msg_namelen = sizeof (struct sockaddr_in);
  1755. msg_orf_token.msg_iov = &iovec;
  1756. msg_orf_token.msg_iovlen = 1;
  1757. msg_orf_token.msg_control = 0;
  1758. msg_orf_token.msg_controllen = 0;
  1759. msg_orf_token.msg_flags = 0;
  1760. res = sendmsg (totemsrp_sockets[0].token, &msg_orf_token, MSG_NOSIGNAL);
  1761. assert (res != -1);
  1762. assert (res == orf_token_retransmit_size);
  1763. }
  1764. /*
  1765. * Retransmit the regular token if no mcast or token has
  1766. * been received in retransmit token period retransmit
  1767. * the token to the next processor
  1768. */
  1769. void timer_function_token_retransmit_timeout (void *data)
  1770. {
  1771. struct timeval timeval;
  1772. gettimeofday (&timeval, 0);
  1773. switch (memb_state) {
  1774. case MEMB_STATE_GATHER:
  1775. break;
  1776. case MEMB_STATE_COMMIT:
  1777. break;
  1778. case MEMB_STATE_OPERATIONAL:
  1779. case MEMB_STATE_RECOVERY:
  1780. token_retransmit ();
  1781. reset_token_retransmit_timeout (); // REVIEWED
  1782. break;
  1783. }
  1784. }
  1785. /*
  1786. * Send orf_token to next member (requires orf_token)
  1787. */
  1788. static int token_send (
  1789. struct orf_token *orf_token,
  1790. int forward_token)
  1791. {
  1792. struct msghdr msg_orf_token;
  1793. struct iovec iovec;
  1794. int res;
  1795. iovec.iov_base = (char *)orf_token;
  1796. iovec.iov_len = sizeof (struct orf_token) +
  1797. (orf_token->rtr_list_entries * sizeof (struct rtr_item));
  1798. #ifdef COMPILE_OUT
  1799. { int i;
  1800. if (orf_token->rtr_list_entries) {
  1801. printf ("Retransmit List Sending %d\n", orf_token->rtr_list_entries);
  1802. for (i = 0; i < orf_token->rtr_list_entries; i++) {
  1803. printf ("%d ", rtr_list[i].seq);
  1804. assert (rtr_list[i].seq != 0);
  1805. }
  1806. printf ("\n");
  1807. }
  1808. }
  1809. #endif
  1810. encrypt_and_sign (&iovec, 1);
  1811. /*
  1812. * Keep an encrypted copy in case the token retransmit timer expires
  1813. */
  1814. memcpy (orf_token_retransmit, iov_encrypted.iov_base, iov_encrypted.iov_len);
  1815. orf_token_retransmit_size = iov_encrypted.iov_len;
  1816. /*
  1817. * IF the user doesn't want the token forwarded, then dont send
  1818. * it but keep an encrypted copy for the retransmit timeout
  1819. */
  1820. if (forward_token == 0) {
  1821. return (0);
  1822. }
  1823. /*
  1824. * Send the message
  1825. */
  1826. msg_orf_token.msg_name = &next_memb;
  1827. msg_orf_token.msg_namelen = sizeof (struct sockaddr_in);
  1828. msg_orf_token.msg_iov = &iov_encrypted;
  1829. msg_orf_token.msg_iovlen = 1;
  1830. msg_orf_token.msg_control = 0;
  1831. msg_orf_token.msg_controllen = 0;
  1832. msg_orf_token.msg_flags = 0;
  1833. res = sendmsg (totemsrp_sockets[0].token, &msg_orf_token, MSG_NOSIGNAL);
  1834. if (res == -1) {
  1835. printf ("Couldn't send token to addr %s %s %d\n",
  1836. inet_ntoa (next_memb.sin_addr),
  1837. strerror (errno), totemsrp_sockets[0].token);
  1838. }
  1839. assert (res != -1);
  1840. assert (res == iov_encrypted.iov_len);
  1841. /*
  1842. * res not used here errors are handled by algorithm
  1843. */
  1844. if (res > 0) {
  1845. stats_sent += res;
  1846. }
  1847. return (res);
  1848. }
  1849. int orf_token_send_initial (void)
  1850. {
  1851. struct orf_token orf_token;
  1852. int res;
  1853. orf_token.header.type = MESSAGE_TYPE_ORF_TOKEN;
  1854. orf_token.header.endian_detector = ENDIAN_LOCAL;
  1855. orf_token.header.encapsulated = 0;
  1856. orf_token.seq = 0;
  1857. orf_token.token_seq = 0;
  1858. orf_token.retrans_flg = 1;
  1859. my_set_retrans_flg = 1;
  1860. /*
  1861. if (queue_is_empty (&retrans_message_queue) == 1) {
  1862. orf_token.retrans_flg = 0;
  1863. } else {
  1864. orf_token.retrans_flg = 1;
  1865. my_set_retrans_flg = 1;
  1866. }
  1867. */
  1868. orf_token.aru = 0;
  1869. orf_token.aru_addr.s_addr = my_id.sin_addr.s_addr;
  1870. memcpy (&orf_token.ring_id, &my_ring_id, sizeof (struct memb_ring_id));
  1871. orf_token.fcc = 0;
  1872. orf_token.rtr_list_entries = 0;
  1873. res = token_send (&orf_token, 1);
  1874. return (res);
  1875. }
  1876. static void memb_state_commit_token_update (struct memb_commit_token *memb_commit_token)
  1877. {
  1878. int memb_index_this;
  1879. printf ("Commit token update\n");
  1880. memb_index_this = (memb_commit_token->memb_index + 1) % memb_commit_token->addr_entries;
  1881. printf ("memb index is %d\n", memb_index_this);
  1882. memcpy (&memb_commit_token->memb_list[memb_index_this].ring_id, &my_ring_id,
  1883. sizeof (struct memb_ring_id));
  1884. assert (my_ring_id.rep.s_addr != 0);
  1885. memb_commit_token->memb_list[memb_index_this].aru = my_aru;
  1886. memb_commit_token->memb_list[memb_index_this].high_delivered = my_aru; /* no safe, for now this is my_aru */
  1887. memb_commit_token->memb_list[memb_index_this].received_flg = my_received_flg;
  1888. }
  1889. static int memb_state_commit_token_send (struct memb_commit_token *memb_commit_token)
  1890. {
  1891. struct msghdr msghdr;
  1892. struct iovec iovec;
  1893. int res;
  1894. int memb_index_this;
  1895. int memb_index_next;
  1896. memb_commit_token->token_seq++;
  1897. memb_index_this = (memb_commit_token->memb_index + 1) % memb_commit_token->addr_entries;
  1898. memb_index_next = (memb_index_this + 1) % memb_commit_token->addr_entries;
  1899. memb_commit_token->memb_index = memb_index_this;
  1900. #ifdef DEBUG
  1901. for (i = 0; i < memb_commit_token->addr_entries; i++) {
  1902. printf ("commit token addresses[%d] %s\n", i, inet_ntoa (memb_commit_token->addr[i]));
  1903. }
  1904. #endif
  1905. iovec.iov_base = memb_commit_token;
  1906. iovec.iov_len = sizeof (struct memb_commit_token);
  1907. encrypt_and_sign (&iovec, 1);
  1908. // TODO do we store the commit token for retransmit don't think so
  1909. // memcpy (orf_token_retransmit, memb_commit_token,
  1910. // sizeof (struct memb_commit_token));
  1911. // orf_token_retransmit_size = sizeof (struct memb_commit_token);
  1912. next_memb.sin_addr.s_addr = memb_commit_token->addr[memb_index_next].s_addr;
  1913. next_memb.sin_family = AF_INET;
  1914. next_memb.sin_port = sockaddr_in_mcast.sin_port;
  1915. msghdr.msg_name = &next_memb;
  1916. msghdr.msg_namelen = sizeof (struct sockaddr_in);
  1917. msghdr.msg_iov = &iov_encrypted;
  1918. msghdr.msg_iovlen = 1;
  1919. msghdr.msg_control = 0;
  1920. msghdr.msg_controllen = 0;
  1921. msghdr.msg_flags = 0;
  1922. res = sendmsg (totemsrp_sockets[0].token, &msghdr, MSG_NOSIGNAL | MSG_DONTWAIT);
  1923. assert (res != -1);
  1924. return (res);
  1925. }
  1926. int memb_lowest_in_config (void)
  1927. {
  1928. struct in_addr token_memb[MAX_MEMBERS];
  1929. int token_memb_entries = 0;
  1930. struct in_addr lowest_addr;
  1931. int i;
  1932. lowest_addr.s_addr = 0xFFFFFFFF;
  1933. memb_set_subtract (token_memb, &token_memb_entries,
  1934. my_proc_list, my_proc_list_entries,
  1935. my_failed_list, my_failed_list_entries);
  1936. /*
  1937. * find representative by searching for smallest identifier
  1938. */
  1939. for (i = 0; i < token_memb_entries; i++) {
  1940. if (lowest_addr.s_addr > token_memb[i].s_addr) {
  1941. lowest_addr.s_addr = token_memb[i].s_addr;
  1942. }
  1943. }
  1944. return (my_id.sin_addr.s_addr == lowest_addr.s_addr);
  1945. }
  1946. static void memb_state_commit_token_create (struct memb_commit_token *commit_token)
  1947. {
  1948. struct in_addr token_memb[MAX_MEMBERS];
  1949. int token_memb_entries = 0;
  1950. totemsrp_log_printf (totemsrp_log_level_notice,
  1951. "Creating commit token because I am the rep.\n");
  1952. memb_set_subtract (token_memb, &token_memb_entries,
  1953. my_proc_list, my_proc_list_entries,
  1954. my_failed_list, my_failed_list_entries);
  1955. memset (commit_token, 0, sizeof (struct memb_commit_token));
  1956. commit_token->header.type = MESSAGE_TYPE_MEMB_COMMIT_TOKEN;
  1957. commit_token->header.endian_detector = ENDIAN_LOCAL;
  1958. commit_token->header.encapsulated = 0;
  1959. commit_token->ring_id.rep.s_addr = my_id.sin_addr.s_addr;
  1960. commit_token->ring_id.seq = token_ring_id_seq + 4;
  1961. qsort (token_memb, token_memb_entries,
  1962. sizeof (struct in_addr), in_addr_compare);
  1963. memcpy (commit_token->addr, token_memb,
  1964. token_memb_entries * sizeof (struct in_addr));
  1965. memset (commit_token->memb_list, 0,
  1966. sizeof (struct memb_commit_token_memb_entry) * MAX_MEMBERS);
  1967. commit_token->memb_index = token_memb_entries - 1;
  1968. commit_token->addr_entries = token_memb_entries;
  1969. }
  1970. int memb_join_message_send (void)
  1971. {
  1972. struct msghdr msghdr;
  1973. struct iovec iovec;
  1974. struct memb_join memb_join;
  1975. int res;
  1976. memb_join.header.type = MESSAGE_TYPE_MEMB_JOIN;
  1977. memb_join.header.endian_detector = ENDIAN_LOCAL;
  1978. memb_join.header.encapsulated = 0;
  1979. memb_join.ring_seq = my_ring_id.seq;
  1980. memcpy (memb_join.proc_list, my_proc_list,
  1981. my_proc_list_entries * sizeof (struct in_addr));
  1982. memb_join.proc_list_entries = my_proc_list_entries;
  1983. memcpy (memb_join.failed_list, my_failed_list,
  1984. my_failed_list_entries * sizeof (struct in_addr));
  1985. memb_join.failed_list_entries = my_failed_list_entries;
  1986. iovec.iov_base = &memb_join;
  1987. iovec.iov_len = sizeof (struct memb_join);
  1988. encrypt_and_sign (&iovec, 1);
  1989. msghdr.msg_name = &sockaddr_in_mcast;
  1990. msghdr.msg_namelen = sizeof (struct sockaddr_in);
  1991. msghdr.msg_iov = &iov_encrypted;
  1992. msghdr.msg_iovlen = 1;
  1993. msghdr.msg_control = 0;
  1994. msghdr.msg_controllen = 0;
  1995. msghdr.msg_flags = 0;
  1996. res = sendmsg (totemsrp_sockets[0].mcast, &msghdr, MSG_NOSIGNAL | MSG_DONTWAIT);
  1997. return (res);
  1998. }
  1999. static void memb_ring_id_create_or_load (
  2000. struct memb_ring_id *memb_ring_id)
  2001. {
  2002. int fd;
  2003. int res;
  2004. char filename[256];
  2005. sprintf (filename, "/tmp/ringid_%s",
  2006. inet_ntoa (my_id.sin_addr));
  2007. fd = open (filename, O_RDONLY, 0777);
  2008. if (fd > 0) {
  2009. res = read (fd, &memb_ring_id->seq, sizeof (unsigned long long));
  2010. assert (res == sizeof (unsigned long long));
  2011. close (fd);
  2012. } else
  2013. if (fd == -1 && errno == ENOENT) {
  2014. memb_ring_id->seq = 0;
  2015. umask(0);
  2016. fd = open (filename, O_CREAT|O_RDWR, 0777);
  2017. if (fd == -1) {
  2018. printf ("couldn't create file %d %s\n", fd, strerror(errno));
  2019. }
  2020. res = write (fd, &memb_ring_id->seq, sizeof (unsigned long long));
  2021. assert (res == sizeof (unsigned long long));
  2022. close (fd);
  2023. } else {
  2024. printf ("Couldn't open %s %s\n", filename, strerror (errno));
  2025. }
  2026. memb_ring_id->rep.s_addr = my_id.sin_addr.s_addr;
  2027. assert (memb_ring_id->rep.s_addr);
  2028. token_ring_id_seq = memb_ring_id->seq;
  2029. }
  2030. static void memb_ring_id_store (
  2031. struct memb_commit_token *commit_token)
  2032. {
  2033. char filename[256];
  2034. int fd;
  2035. int res;
  2036. sprintf (filename, "/tmp/ringid_%s",
  2037. inet_ntoa (my_id.sin_addr));
  2038. fd = open (filename, O_WRONLY, 0777);
  2039. if (fd == -1) {
  2040. printf ("Couldn't store the ring id %s\n", strerror (errno));
  2041. }
  2042. totemsrp_log_printf (totemsrp_log_level_notice,
  2043. "Storing new sequence id for ring %d\n", commit_token->ring_id.seq);
  2044. assert (fd > 0);
  2045. res = write (fd, &commit_token->ring_id.seq, sizeof (unsigned long long));
  2046. assert (res == sizeof (unsigned long long));
  2047. close (fd);
  2048. memcpy (&my_ring_id, &commit_token->ring_id, sizeof (struct memb_ring_id));
  2049. }
  2050. void print_stats (void)
  2051. {
  2052. struct timeval tv_end;
  2053. gettimeofday (&tv_end, NULL);
  2054. totemsrp_log_printf (totemsrp_log_level_notice, "Bytes recv %d\n", stats_recv);
  2055. totemsrp_log_printf (totemsrp_log_level_notice, "Bytes sent %d\n", stats_sent);
  2056. totemsrp_log_printf (totemsrp_log_level_notice, "Messages delivered %d\n", stats_delv);
  2057. totemsrp_log_printf (totemsrp_log_level_notice, "Re-Mcasts %d\n", stats_remcasts);
  2058. totemsrp_log_printf (totemsrp_log_level_notice, "Tokens process %d\n", stats_orf_token);
  2059. }
  2060. int totemsrp_callback_token_create (void **handle_out,
  2061. enum totemsrp_callback_token_type type,
  2062. int delete,
  2063. int (*callback_fn) (enum totemsrp_callback_token_type type, void *),
  2064. void *data)
  2065. {
  2066. struct token_callback_instance *handle;
  2067. handle = (struct token_callback_instance *)malloc (sizeof (struct token_callback_instance));
  2068. if (handle == 0) {
  2069. return (-1);
  2070. }
  2071. *handle_out = (void *)handle;
  2072. list_init (&handle->list);
  2073. handle->callback_fn = callback_fn;
  2074. handle->data = data;
  2075. handle->callback_type = type;
  2076. handle->delete = delete;
  2077. switch (type) {
  2078. case TOTEMSRP_CALLBACK_TOKEN_RECEIVED:
  2079. list_add (&handle->list, &token_callback_received_listhead);
  2080. break;
  2081. case TOTEMSRP_CALLBACK_TOKEN_SENT:
  2082. list_add (&handle->list, &token_callback_sent_listhead);
  2083. break;
  2084. }
  2085. return (0);
  2086. }
  2087. void totemsrp_callback_token_type (void *handle)
  2088. {
  2089. struct token_callback_instance *token_callback_instance = (struct token_callback_instance *)handle;
  2090. list_del (&token_callback_instance->list);
  2091. free (token_callback_instance);
  2092. }
  2093. void token_callbacks_execute (enum totemsrp_callback_token_type type)
  2094. {
  2095. struct list_head *list;
  2096. struct list_head *list_next;
  2097. struct list_head *callback_listhead = 0;
  2098. struct token_callback_instance *token_callback_instance;
  2099. int res;
  2100. switch (type) {
  2101. case TOTEMSRP_CALLBACK_TOKEN_RECEIVED:
  2102. callback_listhead = &token_callback_received_listhead;
  2103. break;
  2104. case TOTEMSRP_CALLBACK_TOKEN_SENT:
  2105. callback_listhead = &token_callback_sent_listhead;
  2106. break;
  2107. default:
  2108. assert (0);
  2109. }
  2110. for (list = callback_listhead->next; list != callback_listhead;
  2111. list = list_next) {
  2112. token_callback_instance = list_entry (list, struct token_callback_instance, list);
  2113. list_next = list->next;
  2114. if (token_callback_instance->delete == 1) {
  2115. list_del (list);
  2116. }
  2117. res = token_callback_instance->callback_fn (
  2118. token_callback_instance->callback_type,
  2119. token_callback_instance->data);
  2120. /*
  2121. * This callback failed to execute, try it again on the next token
  2122. */
  2123. if (res == -1 && token_callback_instance->delete == 1) {
  2124. list_add (list, callback_listhead);
  2125. } else
  2126. if (token_callback_instance->delete) {
  2127. free (token_callback_instance);
  2128. }
  2129. }
  2130. }
  2131. /*
  2132. * Message Handlers
  2133. */
  2134. int my_last_seq = 0;
  2135. struct timeval tv_old;
  2136. /*
  2137. * message handler called when TOKEN message type received
  2138. */
  2139. static int message_handler_orf_token (
  2140. struct sockaddr_in *system_from,
  2141. struct iovec *iovec,
  2142. int iov_len,
  2143. int bytes_received,
  2144. int endian_conversion_needed)
  2145. {
  2146. char token_storage[1500];
  2147. char token_convert[1500];
  2148. struct orf_token *token;
  2149. int prio = UINT_MAX;
  2150. struct pollfd ufd;
  2151. int nfds;
  2152. struct orf_token *token_ref = (struct orf_token *)iovec->iov_base;
  2153. int transmits_allowed;
  2154. int forward_token;
  2155. int mcasted;
  2156. int last_aru;
  2157. #ifdef GIVEINFO
  2158. struct timeval tv_current;
  2159. struct timeval tv_diff;
  2160. gettimeofday (&tv_current, NULL);
  2161. timersub (&tv_current, &tv_old, &tv_diff);
  2162. memcpy (&tv_old, &tv_current, sizeof (struct timeval));
  2163. if ((((float)tv_diff.tv_usec) / 100.0) > 5.0) {
  2164. printf ("OTHERS %0.4f ms\n", ((float)tv_diff.tv_usec) / 100.0);
  2165. }
  2166. #endif
  2167. my_token_held = 1;
  2168. my_do_delivery = 0;
  2169. if (random () % 100 < 10) {
  2170. return (0);
  2171. }
  2172. /*
  2173. * Hold onto token when there is no activity on ring and
  2174. * this processor is the ring rep
  2175. */
  2176. forward_token = 1;
  2177. if (my_ring_id.rep.s_addr == my_id.sin_addr.s_addr) {
  2178. if (my_seq_unchanged > SEQNO_UNCHANGED_CONST) {
  2179. forward_token = 0;
  2180. }
  2181. }
  2182. if (token_ref->seq == my_last_seq) {
  2183. my_seq_unchanged++;
  2184. } else {
  2185. my_seq_unchanged = 0;
  2186. }
  2187. my_last_seq = token_ref->seq;
  2188. assert (bytes_received >= sizeof (struct orf_token));
  2189. // assert (bytes_received == sizeof (struct orf_token) +
  2190. // (sizeof (struct rtr_item) * token_ref->rtr_list_entries);
  2191. /*
  2192. * Make copy of token and retransmit list in case we have
  2193. * to flush incoming messages from the kernel queue
  2194. */
  2195. token = (struct orf_token *)token_storage;
  2196. memcpy (token, iovec->iov_base, sizeof (struct orf_token));
  2197. memcpy (&token->rtr_list[0], iovec->iov_base + sizeof (struct orf_token),
  2198. sizeof (struct rtr_item) * RETRANSMIT_ENTRIES_MAX);
  2199. if (endian_conversion_needed) {
  2200. // printf ("Must convert endian of token message\n");
  2201. orf_token_endian_convert (token, (struct orf_token *)token_convert);
  2202. token = (struct orf_token *)token_convert;
  2203. }
  2204. /*
  2205. * flush incoming queue from kernel
  2206. */
  2207. do {
  2208. ufd.fd = totemsrp_sockets[0].mcast;
  2209. ufd.events = POLLIN;
  2210. nfds = poll (&ufd, 1, 0);
  2211. if (nfds == 1 && ufd.revents & POLLIN) {
  2212. totemsrp_iov_recv.iov_len = PACKET_SIZE_MAX;
  2213. recv_handler (0, totemsrp_sockets[0].mcast, ufd.revents, 0,
  2214. &prio);
  2215. }
  2216. } while (nfds == 1);
  2217. token_callbacks_execute (TOTEMSRP_CALLBACK_TOKEN_RECEIVED);
  2218. switch (memb_state) {
  2219. case MEMB_STATE_COMMIT:
  2220. /* Discard token */
  2221. break;
  2222. case MEMB_STATE_OPERATIONAL:
  2223. messages_free (token->aru);
  2224. case MEMB_STATE_GATHER:
  2225. /*
  2226. * DO NOT add break, we use different free mechanism in recovery state
  2227. */
  2228. case MEMB_STATE_RECOVERY:
  2229. last_aru = my_last_aru;
  2230. my_last_aru = token->aru;
  2231. /*
  2232. * Test for a token from another configuration
  2233. */
  2234. if (memcmp (&token->ring_id, &my_ring_id,
  2235. sizeof (struct memb_ring_id)) != 0) {
  2236. totemsrp_log_printf (totemsrp_log_level_notice,
  2237. "Token from another configuration %s.\n",
  2238. inet_ntoa (system_from->sin_addr));
  2239. printf ("tokens ring %lld %s\n", token->ring_id.seq, inet_ntoa (token->ring_id.rep));
  2240. printf ("my ring %lld %s %d\n", my_ring_id.seq, inet_ntoa (my_ring_id.rep), memb_state);
  2241. my_token_held = 0;
  2242. return (0); /* discard token */
  2243. }
  2244. if (my_token_seq >= token->token_seq) {
  2245. my_token_held = 0;
  2246. reset_token_retransmit_timeout ();
  2247. reset_token_timeout ();
  2248. return (0); /* discard token */
  2249. }
  2250. transmits_allowed = 30;
  2251. mcasted = orf_token_rtr (token, &transmits_allowed);
  2252. if (mcasted) {
  2253. forward_token = 1;
  2254. my_seq_unchanged = 0;
  2255. }
  2256. if ((last_aru + MISSING_MCAST_WINDOW) < token->seq) {
  2257. transmits_allowed = 0;
  2258. }
  2259. mcasted = orf_token_mcast (token, transmits_allowed, system_from);
  2260. if (mcasted) {
  2261. forward_token = 1;
  2262. my_seq_unchanged = 0;
  2263. }
  2264. if (my_aru < token->aru ||
  2265. my_id.sin_addr.s_addr == token->aru_addr.s_addr ||
  2266. token->aru_addr.s_addr == 0) {
  2267. token->aru = my_aru;
  2268. if (token->aru == token->seq) {
  2269. token->aru_addr.s_addr = 0;
  2270. } else {
  2271. token->aru_addr.s_addr = my_id.sin_addr.s_addr;
  2272. }
  2273. }
  2274. if (token->aru == my_last_aru && token->aru_addr.s_addr != 0) {
  2275. my_aru_count += 1;
  2276. } else {
  2277. my_aru_count = 0;
  2278. }
  2279. if (my_aru_count > FAIL_TO_RECV_CONST &&
  2280. token->aru_addr.s_addr == my_id.sin_addr.s_addr) {
  2281. memb_set_merge (&token->aru_addr, 1,
  2282. my_failed_list, &my_failed_list_entries);
  2283. memb_state_gather_enter ();
  2284. } else {
  2285. my_token_seq = token->token_seq;
  2286. token->token_seq += 1;
  2287. if (memb_state == MEMB_STATE_RECOVERY) {
  2288. /*
  2289. * my_aru == my_high_seq_received means this processor
  2290. * has recovered all messages it can recover
  2291. * (ie: its retrans queue is empty)
  2292. */
  2293. if (queue_is_empty (&retrans_message_queue) == 0 ||
  2294. my_aru != my_high_seq_received) {
  2295. if (token->retrans_flg == 0) {
  2296. token->retrans_flg = 1;
  2297. my_set_retrans_flg = 1;
  2298. }
  2299. } else
  2300. if (token->retrans_flg == 1 && my_set_retrans_flg) {
  2301. token->retrans_flg = 0;
  2302. }
  2303. printf ("token retrans flag is %d my set retrans flag%d retrans queue empty %d count %d\n",
  2304. token->retrans_flg, my_set_retrans_flg, queue_is_empty (&retrans_message_queue), my_retrans_flg_count);
  2305. if (token->retrans_flg == 0) {
  2306. my_retrans_flg_count += 1;
  2307. }
  2308. if (my_retrans_flg_count == 2) {
  2309. my_install_seq = token->seq;
  2310. }
  2311. printf ("install seq %d aru %d high seq received %d\n", my_install_seq, my_aru,
  2312. my_high_seq_received);
  2313. if (my_retrans_flg_count >= 2 && my_aru >= my_install_seq && my_received_flg == 0) {
  2314. my_received_flg = 1;
  2315. my_deliver_memb_entries = my_trans_memb_entries;
  2316. memcpy (my_deliver_memb_list, my_trans_memb_list,
  2317. sizeof (struct in_addr) * my_trans_memb_entries);
  2318. }
  2319. if (my_retrans_flg_count >= 3 && token->aru >= my_install_seq) {
  2320. my_rotation_counter += 1;
  2321. }
  2322. if (my_rotation_counter == 2) {
  2323. printf ("retrans flag count %d token aru %d install seq %d aru %d %d\n", my_retrans_flg_count,
  2324. token->aru, my_install_seq, my_aru, token->seq);
  2325. memb_state_operational_enter ();
  2326. my_rotation_counter = 0;
  2327. my_retrans_flg_count = 0;
  2328. }
  2329. }
  2330. token_send (token, 1 /* forward_token */);
  2331. #ifdef GIVEINFO
  2332. gettimeofday (&tv_current, NULL);
  2333. timersub (&tv_current, &tv_old, &tv_diff);
  2334. memcpy (&tv_old, &tv_current, sizeof (struct timeval));
  2335. if ((((float)tv_diff.tv_usec) / 100.0) > 5.0) {
  2336. printf ("I held %0.4f ms\n", ((float)tv_diff.tv_usec) / 100.0);
  2337. }
  2338. #endif
  2339. if (my_do_delivery) {
  2340. if (memb_state != MEMB_STATE_RECOVERY) {
  2341. messages_deliver_to_app (0, &my_high_seq_delivered, my_high_seq_received);
  2342. }
  2343. }
  2344. /*
  2345. * Deliver messages after token has been transmitted
  2346. * to improve performance
  2347. */
  2348. reset_token_timeout (); // REVIEWED
  2349. if (forward_token == 0) {
  2350. reset_token_retransmit_timeout (); // REVIEWED
  2351. }
  2352. token_callbacks_execute (TOTEMSRP_CALLBACK_TOKEN_SENT);
  2353. }
  2354. break;
  2355. }
  2356. my_token_held = 0;
  2357. return (0);
  2358. }
  2359. static void messages_deliver_to_app (int skip, int *start_point, int end_point)
  2360. {
  2361. struct sort_queue_item *sort_queue_item_p;
  2362. int i;
  2363. int res;
  2364. struct mcast *mcast;
  2365. totemsrp_log_printf (totemsrp_log_level_debug,
  2366. "Delivering %d to %d\n", *start_point + 1, my_high_seq_received);
  2367. /*
  2368. * Deliver messages in order from rtr queue to pending delivery queue
  2369. */
  2370. for (i = *start_point + 1; i <= end_point; i++) {
  2371. void *ptr;
  2372. res = sq_item_get (&regular_sort_queue, i, &ptr);
  2373. if (res != 0 && skip) {
  2374. *start_point = i;
  2375. continue;
  2376. }
  2377. /*
  2378. * If hole, stop assembly
  2379. */
  2380. if (res != 0) {
  2381. break;
  2382. }
  2383. sort_queue_item_p = ptr;
  2384. mcast = sort_queue_item_p->iovec[0].iov_base;
  2385. if (mcast == (struct mcast *)0xdeadbeef) {
  2386. printf ("seq %d\n", sort_queue_item_p->iovec[0].iov_len);
  2387. }
  2388. assert (mcast != (struct mcast *)0xdeadbeef);
  2389. /*
  2390. * Message found
  2391. */
  2392. totemsrp_log_printf (totemsrp_log_level_debug,
  2393. "Delivering MCAST message with seq %d to pending delivery queue\n",
  2394. mcast->seq);
  2395. *start_point = i;
  2396. /*
  2397. * Message is locally originated multicasat
  2398. */
  2399. if (sort_queue_item_p->iov_len > 1 &&
  2400. sort_queue_item_p->iovec[0].iov_len == sizeof (struct mcast)) {
  2401. totemsrp_deliver_fn (
  2402. mcast->source,
  2403. &sort_queue_item_p->iovec[1],
  2404. sort_queue_item_p->iov_len - 1,
  2405. mcast->header.endian_detector != ENDIAN_LOCAL);
  2406. } else {
  2407. sort_queue_item_p->iovec[0].iov_len -= sizeof (struct mcast);
  2408. sort_queue_item_p->iovec[0].iov_base += sizeof (struct mcast);
  2409. totemsrp_deliver_fn (
  2410. mcast->source,
  2411. sort_queue_item_p->iovec,
  2412. sort_queue_item_p->iov_len,
  2413. mcast->header.endian_detector != ENDIAN_LOCAL);
  2414. sort_queue_item_p->iovec[0].iov_len += sizeof (struct mcast);
  2415. sort_queue_item_p->iovec[0].iov_base -= sizeof (struct mcast);
  2416. }
  2417. stats_delv += 1;
  2418. }
  2419. }
  2420. /*
  2421. * recv message handler called when MCAST message type received
  2422. */
  2423. static int message_handler_mcast (
  2424. struct sockaddr_in *system_from,
  2425. struct iovec *iovec,
  2426. int iov_len,
  2427. int bytes_received,
  2428. int endian_conversion_needed)
  2429. {
  2430. struct sort_queue_item sort_queue_item;
  2431. struct sq *sort_queue;
  2432. struct mcast mcast_header;
  2433. if (memb_state == MEMB_STATE_RECOVERY) {
  2434. sort_queue = &recovery_sort_queue;
  2435. } else {
  2436. sort_queue = &regular_sort_queue;
  2437. }
  2438. if (endian_conversion_needed) {
  2439. mcast_endian_convert (iovec[0].iov_base, &mcast_header);
  2440. } else {
  2441. memcpy (&mcast_header, iovec[0].iov_base, sizeof (struct mcast));
  2442. }
  2443. assert (bytes_received < PACKET_SIZE_MAX);
  2444. if (random()%100 < 20) {
  2445. return (0);
  2446. }
  2447. cancel_token_retransmit_timeout (); // REVIEWED
  2448. /*
  2449. * If the message is foriegn execute the switch below
  2450. */
  2451. // TODO this detection of foreign messages isn't correct
  2452. // it doesn't work in the recovery state for the new processors
  2453. // my_memb_list is the wrong list to use I think we should use my_new_memb_list
  2454. if (!memb_set_subset (&system_from->sin_addr,
  2455. 1,
  2456. my_new_memb_list,
  2457. my_new_memb_entries)) {
  2458. printf ("got foreign message\n");
  2459. switch (memb_state) {
  2460. case MEMB_STATE_OPERATIONAL:
  2461. memb_set_merge (&system_from->sin_addr, 1,
  2462. my_proc_list, &my_proc_list_entries);
  2463. memb_state_gather_enter ();
  2464. break;
  2465. case MEMB_STATE_GATHER:
  2466. if (!memb_set_subset (&system_from->sin_addr,
  2467. 1,
  2468. my_proc_list,
  2469. my_proc_list_entries)) {
  2470. memb_set_merge (&system_from->sin_addr, 1,
  2471. my_proc_list, &my_proc_list_entries);
  2472. memb_state_gather_enter ();
  2473. return (0);
  2474. }
  2475. break;
  2476. case MEMB_STATE_COMMIT:
  2477. /* discard message */
  2478. break;
  2479. case MEMB_STATE_RECOVERY:
  2480. /* discard message */
  2481. break;
  2482. }
  2483. return (0); /* discard all foreign messages */
  2484. }
  2485. /*
  2486. * Add mcast message to rtr queue if not already in rtr queue
  2487. * otherwise free io vectors
  2488. */
  2489. if (bytes_received > 0 && bytes_received < PACKET_SIZE_MAX &&
  2490. sq_item_inuse (sort_queue, mcast_header.seq) == 0) {
  2491. //printf ("adding message %d\n", mcast->seq);
  2492. /*
  2493. * Allocate new multicast memory block
  2494. */
  2495. sort_queue_item.iovec[0].iov_base = malloc (bytes_received);
  2496. if (sort_queue_item.iovec[0].iov_base == 0) {
  2497. return (-1); /* error here is corrected by the algorithm */
  2498. }
  2499. memcpy (sort_queue_item.iovec[0].iov_base, iovec[0].iov_base,
  2500. bytes_received);
  2501. sort_queue_item.iovec[0].iov_len = bytes_received;
  2502. assert (sort_queue_item.iovec[0].iov_len > 0);
  2503. assert (sort_queue_item.iovec[0].iov_len < PACKET_SIZE_MAX);
  2504. sort_queue_item.iov_len = 1;
  2505. if (mcast_header.seq > my_high_seq_received) {
  2506. my_high_seq_received = mcast_header.seq;
  2507. }
  2508. sq_item_add (sort_queue, &sort_queue_item, mcast_header.seq);
  2509. }
  2510. update_aru ();
  2511. if (my_token_held) {
  2512. my_do_delivery = 1;
  2513. } else {
  2514. if (memb_state != MEMB_STATE_RECOVERY) {
  2515. messages_deliver_to_app (0, &my_high_seq_delivered, my_high_seq_received);
  2516. }
  2517. }
  2518. /* TODO remove from retrans message queue for old ring in recovery state */
  2519. return (0);
  2520. }
  2521. int memb_join_process (struct memb_join *memb_join, struct sockaddr_in *system_from)
  2522. {
  2523. struct memb_commit_token my_commit_token;
  2524. if (memb_set_equal (memb_join->proc_list,
  2525. memb_join->proc_list_entries,
  2526. my_proc_list,
  2527. my_proc_list_entries) &&
  2528. memb_set_equal (memb_join->failed_list,
  2529. memb_join->failed_list_entries,
  2530. my_failed_list,
  2531. my_failed_list_entries)) {
  2532. memb_consensus_set (&system_from->sin_addr);
  2533. if (memb_consensus_agreed () &&
  2534. memb_lowest_in_config ()) {
  2535. memb_state_commit_token_create (&my_commit_token);
  2536. memb_state_commit_enter (&my_commit_token);
  2537. } else {
  2538. return (0); // TODO added to match spec
  2539. }
  2540. } else
  2541. if (memb_set_subset (memb_join->proc_list,
  2542. memb_join->proc_list_entries,
  2543. my_proc_list,
  2544. my_proc_list_entries) &&
  2545. memb_set_subset (memb_join->failed_list,
  2546. memb_join->failed_list_entries,
  2547. my_failed_list, // TODO changed proc to failed to match spec
  2548. my_failed_list_entries)) {
  2549. return (0);
  2550. } else
  2551. if (memb_set_subset (&system_from->sin_addr, 1, // TODO changed proc to failed to match spec
  2552. my_failed_list, my_failed_list_entries)) {
  2553. return (0);
  2554. } else {
  2555. memb_set_merge (memb_join->proc_list,
  2556. memb_join->proc_list_entries,
  2557. my_proc_list, &my_proc_list_entries);
  2558. if (memb_set_subset (&my_id.sin_addr, 1,
  2559. memb_join->failed_list, memb_join->failed_list_entries)) {
  2560. memb_set_merge (&system_from->sin_addr, 1,
  2561. my_failed_list, &my_failed_list_entries);
  2562. } else {
  2563. memb_set_merge (memb_join->failed_list,
  2564. memb_join->failed_list_entries,
  2565. my_failed_list, &my_failed_list_entries);
  2566. }
  2567. memb_state_gather_enter ();
  2568. return (1); /* gather entered */
  2569. }
  2570. return (0); /* gather not entered */
  2571. }
  2572. static void memb_join_endian_convert (struct memb_join *in, struct memb_join *out)
  2573. {
  2574. int i;
  2575. out->header.type = in->header.type;
  2576. out->header.endian_detector = ENDIAN_LOCAL;
  2577. out->proc_list_entries = swab32 (in->proc_list_entries);
  2578. out->failed_list_entries = swab32 (in->failed_list_entries);
  2579. out->ring_seq = swab64 (in->ring_seq);
  2580. for (i = 0; i < out->proc_list_entries; i++) {
  2581. out->proc_list[i].s_addr = in->proc_list[i].s_addr;
  2582. }
  2583. for (i = 0; i < out->failed_list_entries; i++) {
  2584. out->failed_list[i].s_addr = in->failed_list[i].s_addr;
  2585. }
  2586. }
  2587. static void memb_commit_token_endian_convert (struct memb_commit_token *in, struct memb_commit_token *out)
  2588. {
  2589. int i;
  2590. out->header.type = in->header.type;
  2591. out->header.endian_detector = ENDIAN_LOCAL;
  2592. out->token_seq = swab32 (in->token_seq);
  2593. out->ring_id.rep.s_addr = in->ring_id.rep.s_addr;
  2594. out->ring_id.seq = swab64 (in->ring_id.seq);
  2595. out->retrans_flg = swab32 (in->retrans_flg);
  2596. out->memb_index = swab32 (in->memb_index);
  2597. out->addr_entries = swab32 (in->addr_entries);
  2598. for (i = 0; i < out->addr_entries; i++) {
  2599. out->addr[i].s_addr = in->addr[i].s_addr;
  2600. out->memb_list[i].ring_id.rep.s_addr =
  2601. in->memb_list[i].ring_id.rep.s_addr;
  2602. out->memb_list[i].ring_id.seq =
  2603. swab64 (in->memb_list[i].ring_id.seq);
  2604. out->memb_list[i].aru = swab32 (in->memb_list[i].aru);
  2605. out->memb_list[i].high_delivered = swab32 (in->memb_list[i].high_delivered);
  2606. out->memb_list[i].received_flg = swab32 (in->memb_list[i].received_flg);
  2607. }
  2608. }
  2609. static void orf_token_endian_convert (struct orf_token *in, struct orf_token *out)
  2610. {
  2611. int i;
  2612. out->header.type = in->header.type;
  2613. out->header.endian_detector = ENDIAN_LOCAL;
  2614. out->seq = swab32 (in->seq);
  2615. out->token_seq = swab32 (in->token_seq);
  2616. out->aru = swab32 (in->aru);
  2617. out->ring_id.rep.s_addr = in->ring_id.rep.s_addr;
  2618. out->ring_id.seq = swab64 (in->ring_id.seq);
  2619. out->fcc = swab32 (in->fcc);
  2620. out->retrans_flg = swab32 (in->retrans_flg);
  2621. out->rtr_list_entries = swab32 (in->rtr_list_entries);
  2622. for (i = 0; i < out->rtr_list_entries; i++) {
  2623. out->rtr_list[i].ring_id.rep.s_addr = in->rtr_list[i].ring_id.rep.s_addr;
  2624. out->rtr_list[i].ring_id.seq = swab64 (in->rtr_list[i].ring_id.seq);
  2625. out->rtr_list[i].seq = swab32 (in->rtr_list[i].seq);
  2626. }
  2627. }
  2628. static void mcast_endian_convert (struct mcast *in, struct mcast *out)
  2629. {
  2630. out->header.type = in->header.type;
  2631. out->header.endian_detector = ENDIAN_LOCAL;
  2632. out->seq = swab32 (in->seq);
  2633. out->ring_id.rep.s_addr = in->ring_id.rep.s_addr;
  2634. out->ring_id.seq = swab64 (in->ring_id.seq);
  2635. out->source = in->source;
  2636. out->guarantee = in->guarantee;
  2637. }
  2638. static int message_handler_memb_join (
  2639. struct sockaddr_in *system_from,
  2640. struct iovec *iovec,
  2641. int iov_len,
  2642. int bytes_received,
  2643. int endian_conversion_needed)
  2644. {
  2645. struct memb_join *memb_join;
  2646. struct memb_join memb_join_convert;
  2647. int gather_entered;
  2648. if (endian_conversion_needed) {
  2649. memb_join = &memb_join_convert;
  2650. memb_join_endian_convert (iovec->iov_base, &memb_join_convert);
  2651. } else {
  2652. memb_join = (struct memb_join *)iovec->iov_base;
  2653. }
  2654. if (token_ring_id_seq < memb_join->ring_seq) {
  2655. token_ring_id_seq = memb_join->ring_seq;
  2656. }
  2657. switch (memb_state) {
  2658. case MEMB_STATE_OPERATIONAL:
  2659. gather_entered = memb_join_process (memb_join, system_from);
  2660. if (gather_entered == 0) {
  2661. memb_state_gather_enter ();
  2662. }
  2663. break;
  2664. case MEMB_STATE_GATHER:
  2665. memb_join_process (memb_join, system_from);
  2666. break;
  2667. case MEMB_STATE_COMMIT:
  2668. if (memb_set_subset (&system_from->sin_addr,
  2669. 1,
  2670. my_new_memb_list,
  2671. my_new_memb_entries) &&
  2672. memb_join->ring_seq >= my_ring_id.seq) {
  2673. memb_join_process (memb_join, system_from);
  2674. memb_state_gather_enter ();
  2675. }
  2676. break;
  2677. case MEMB_STATE_RECOVERY:
  2678. if (memb_set_subset (&system_from->sin_addr,
  2679. 1,
  2680. my_new_memb_list,
  2681. my_new_memb_entries) &&
  2682. memb_join->ring_seq >= my_ring_id.seq) {
  2683. memb_join_process (memb_join, system_from);
  2684. memb_state_gather_enter ();
  2685. my_aru = my_aru_save;
  2686. my_high_seq_received = my_high_seq_received_save;
  2687. sq_reinit (&recovery_sort_queue, 0);
  2688. queue_reinit (&retrans_message_queue);
  2689. // TODO calculate current old ring aru
  2690. }
  2691. break;
  2692. }
  2693. return (0);
  2694. }
  2695. static int message_handler_memb_commit_token (
  2696. struct sockaddr_in *system_from,
  2697. struct iovec *iovec,
  2698. int iov_len,
  2699. int bytes_received,
  2700. int endian_conversion_needed)
  2701. {
  2702. struct memb_commit_token memb_commit_token_convert;
  2703. struct memb_commit_token *memb_commit_token;
  2704. struct in_addr sub[MAX_MEMBERS];
  2705. int sub_entries;
  2706. if (endian_conversion_needed) {
  2707. memb_commit_token = &memb_commit_token_convert;
  2708. memb_commit_token_endian_convert (iovec->iov_base, memb_commit_token);
  2709. } else {
  2710. memb_commit_token = (struct memb_commit_token *)iovec->iov_base;
  2711. }
  2712. /* TODO do we need to check for a duplicate token?
  2713. if (memb_commit_token->token_seq > 0 &&
  2714. my_token_seq >= memb_commit_token->token_seq) {
  2715. printf ("already received commit token %d %d\n",
  2716. memb_commit_token->token_seq, my_token_seq);
  2717. return (0);
  2718. }
  2719. */
  2720. switch (memb_state) {
  2721. case MEMB_STATE_OPERATIONAL:
  2722. /* discard token */
  2723. break;
  2724. case MEMB_STATE_GATHER:
  2725. memb_set_subtract (sub, &sub_entries,
  2726. my_proc_list, my_proc_list_entries,
  2727. my_failed_list, my_failed_list_entries);
  2728. if (memb_set_equal (memb_commit_token->addr,
  2729. memb_commit_token->addr_entries,
  2730. sub,
  2731. sub_entries) &&
  2732. memb_commit_token->ring_id.seq > my_ring_id.seq) {
  2733. memb_state_commit_enter (memb_commit_token);
  2734. }
  2735. break;
  2736. case MEMB_STATE_COMMIT:
  2737. // TODO add if to match spec
  2738. // if (memb_commit_token->ring_seq == my_ring_id.seq) {
  2739. memb_state_recovery_enter (memb_commit_token);
  2740. // }
  2741. break;
  2742. case MEMB_STATE_RECOVERY:
  2743. totemsrp_log_printf (totemsrp_log_level_notice,
  2744. "Sending initial ORF token\n");
  2745. if (my_id.sin_addr.s_addr == my_ring_id.rep.s_addr) {
  2746. // TODO convert instead of initiate
  2747. orf_token_send_initial ();
  2748. reset_token_timeout (); // REVIEWED
  2749. reset_token_retransmit_timeout (); // REVIEWED
  2750. }
  2751. break;
  2752. }
  2753. return (0);
  2754. }
  2755. static int recv_handler (poll_handle handle, int fd, int revents,
  2756. void *data, unsigned int *prio)
  2757. {
  2758. struct msghdr msg_recv;
  2759. struct message_header *message_header;
  2760. struct sockaddr_in system_from;
  2761. int res = 0;
  2762. int bytes_received;
  2763. *prio = UINT_MAX;
  2764. /*
  2765. * Receive datagram
  2766. */
  2767. msg_recv.msg_name = &system_from;
  2768. msg_recv.msg_namelen = sizeof (struct sockaddr_in);
  2769. msg_recv.msg_iov = &totemsrp_iov_recv;
  2770. msg_recv.msg_iovlen = 1;
  2771. msg_recv.msg_control = 0;
  2772. msg_recv.msg_controllen = 0;
  2773. msg_recv.msg_flags = 0;
  2774. bytes_received = recvmsg (fd, &msg_recv, MSG_NOSIGNAL | MSG_DONTWAIT);
  2775. if (bytes_received == -1) {
  2776. return (0);
  2777. } else {
  2778. stats_recv += bytes_received;
  2779. }
  2780. if (bytes_received < sizeof (struct message_header)) {
  2781. totemsrp_log_printf (totemsrp_log_level_security, "Received message is too short... ignoring %d %d.\n", bytes_received);
  2782. return (0);
  2783. }
  2784. message_header = (struct message_header *)msg_recv.msg_iov->iov_base;
  2785. /*
  2786. * Authenticate and if authenticated, decrypt datagram
  2787. */
  2788. totemsrp_iov_recv.iov_len = bytes_received;
  2789. res = authenticate_and_decrypt (&totemsrp_iov_recv);
  2790. log_digest = 0;
  2791. if (res == -1) {
  2792. printf ("message header type %d %d\n", message_header->type, bytes_received);
  2793. totemsrp_iov_recv.iov_len = PACKET_SIZE_MAX;
  2794. //exit (1);
  2795. return 0;
  2796. }
  2797. if (stats_tv_start.tv_usec == 0) {
  2798. gettimeofday (&stats_tv_start, NULL);
  2799. }
  2800. /*
  2801. * Handle incoming message
  2802. */
  2803. message_header = (struct message_header *)msg_recv.msg_iov[0].iov_base;
  2804. totemsrp_message_handlers.handler_functions[(int)message_header->type] (
  2805. &system_from,
  2806. msg_recv.msg_iov,
  2807. msg_recv.msg_iovlen,
  2808. bytes_received,
  2809. message_header->endian_detector != ENDIAN_LOCAL);
  2810. totemsrp_iov_recv.iov_len = PACKET_SIZE_MAX;
  2811. return (0);
  2812. }