totemsrp.c 86 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264226522662267226822692270227122722273227422752276227722782279228022812282228322842285228622872288228922902291229222932294229522962297229822992300230123022303230423052306230723082309231023112312231323142315231623172318231923202321232223232324232523262327232823292330233123322333233423352336233723382339234023412342234323442345234623472348234923502351235223532354235523562357235823592360236123622363236423652366236723682369237023712372237323742375237623772378237923802381238223832384238523862387238823892390239123922393239423952396239723982399240024012402240324042405240624072408240924102411241224132414241524162417241824192420242124222423242424252426242724282429243024312432243324342435243624372438243924402441244224432444244524462447244824492450245124522453245424552456245724582459246024612462246324642465246624672468246924702471247224732474247524762477247824792480248124822483248424852486248724882489249024912492249324942495249624972498249925002501250225032504250525062507250825092510251125122513251425152516251725182519252025212522252325242525252625272528252925302531253225332534253525362537253825392540254125422543254425452546254725482549255025512552255325542555255625572558255925602561256225632564256525662567256825692570257125722573257425752576257725782579258025812582258325842585258625872588258925902591259225932594259525962597259825992600260126022603260426052606260726082609261026112612261326142615261626172618261926202621262226232624262526262627262826292630263126322633263426352636263726382639264026412642264326442645264626472648264926502651265226532654265526562657265826592660266126622663266426652666266726682669267026712672267326742675267626772678267926802681268226832684268526862687268826892690269126922693269426952696269726982699270027012702270327042705270627072708270927102711271227132714271527162717271827192720272127222723272427252726272727282729273027312732273327342735273627372738273927402741274227432744274527462747274827492750275127522753275427552756275727582759276027612762276327642765276627672768276927702771277227732774277527762777277827792780278127822783278427852786278727882789279027912792279327942795279627972798279928002801280228032804280528062807280828092810281128122813281428152816281728182819282028212822282328242825282628272828282928302831283228332834283528362837283828392840284128422843284428452846284728482849285028512852285328542855285628572858285928602861286228632864286528662867286828692870287128722873287428752876287728782879288028812882288328842885288628872888288928902891289228932894289528962897289828992900290129022903290429052906290729082909291029112912291329142915291629172918291929202921292229232924292529262927292829292930293129322933293429352936293729382939294029412942294329442945294629472948294929502951295229532954295529562957295829592960296129622963296429652966296729682969297029712972297329742975297629772978297929802981298229832984298529862987298829892990299129922993299429952996299729982999300030013002300330043005300630073008300930103011301230133014301530163017301830193020302130223023302430253026302730283029303030313032303330343035303630373038303930403041304230433044304530463047304830493050305130523053305430553056305730583059306030613062306330643065306630673068306930703071307230733074307530763077307830793080308130823083308430853086308730883089309030913092309330943095309630973098309931003101310231033104310531063107310831093110311131123113311431153116311731183119312031213122312331243125312631273128312931303131313231333134313531363137313831393140314131423143314431453146314731483149315031513152315331543155315631573158315931603161316231633164316531663167316831693170317131723173317431753176317731783179318031813182318331843185318631873188318931903191319231933194319531963197319831993200320132023203320432053206320732083209321032113212321332143215321632173218321932203221322232233224322532263227322832293230323132323233323432353236323732383239324032413242324332443245324632473248324932503251325232533254325532563257325832593260326132623263326432653266326732683269327032713272327332743275327632773278327932803281328232833284328532863287328832893290329132923293329432953296329732983299330033013302330333043305330633073308330933103311331233133314331533163317331833193320332133223323332433253326
  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. #ifdef DROP_RANDOM
  2170. if (random () % 100 < 10) {
  2171. return (0);
  2172. }
  2173. #endif
  2174. /*
  2175. * Hold onto token when there is no activity on ring and
  2176. * this processor is the ring rep
  2177. */
  2178. forward_token = 1;
  2179. if (my_ring_id.rep.s_addr == my_id.sin_addr.s_addr) {
  2180. if (my_seq_unchanged > SEQNO_UNCHANGED_CONST) {
  2181. forward_token = 0;
  2182. }
  2183. }
  2184. if (token_ref->seq == my_last_seq) {
  2185. my_seq_unchanged++;
  2186. } else {
  2187. my_seq_unchanged = 0;
  2188. }
  2189. my_last_seq = token_ref->seq;
  2190. assert (bytes_received >= sizeof (struct orf_token));
  2191. // assert (bytes_received == sizeof (struct orf_token) +
  2192. // (sizeof (struct rtr_item) * token_ref->rtr_list_entries);
  2193. /*
  2194. * Make copy of token and retransmit list in case we have
  2195. * to flush incoming messages from the kernel queue
  2196. */
  2197. token = (struct orf_token *)token_storage;
  2198. memcpy (token, iovec->iov_base, sizeof (struct orf_token));
  2199. memcpy (&token->rtr_list[0], iovec->iov_base + sizeof (struct orf_token),
  2200. sizeof (struct rtr_item) * RETRANSMIT_ENTRIES_MAX);
  2201. if (endian_conversion_needed) {
  2202. // printf ("Must convert endian of token message\n");
  2203. orf_token_endian_convert (token, (struct orf_token *)token_convert);
  2204. token = (struct orf_token *)token_convert;
  2205. }
  2206. /*
  2207. * flush incoming queue from kernel
  2208. */
  2209. do {
  2210. ufd.fd = totemsrp_sockets[0].mcast;
  2211. ufd.events = POLLIN;
  2212. nfds = poll (&ufd, 1, 0);
  2213. if (nfds == 1 && ufd.revents & POLLIN) {
  2214. totemsrp_iov_recv.iov_len = PACKET_SIZE_MAX;
  2215. recv_handler (0, totemsrp_sockets[0].mcast, ufd.revents, 0,
  2216. &prio);
  2217. }
  2218. } while (nfds == 1);
  2219. token_callbacks_execute (TOTEMSRP_CALLBACK_TOKEN_RECEIVED);
  2220. switch (memb_state) {
  2221. case MEMB_STATE_COMMIT:
  2222. /* Discard token */
  2223. break;
  2224. case MEMB_STATE_OPERATIONAL:
  2225. messages_free (token->aru);
  2226. case MEMB_STATE_GATHER:
  2227. /*
  2228. * DO NOT add break, we use different free mechanism in recovery state
  2229. */
  2230. case MEMB_STATE_RECOVERY:
  2231. last_aru = my_last_aru;
  2232. my_last_aru = token->aru;
  2233. /*
  2234. * Test for a token from another configuration
  2235. */
  2236. if (memcmp (&token->ring_id, &my_ring_id,
  2237. sizeof (struct memb_ring_id)) != 0) {
  2238. totemsrp_log_printf (totemsrp_log_level_notice,
  2239. "Token from another configuration %s.\n",
  2240. inet_ntoa (system_from->sin_addr));
  2241. printf ("tokens ring %lld %s\n", token->ring_id.seq, inet_ntoa (token->ring_id.rep));
  2242. printf ("my ring %lld %s %d\n", my_ring_id.seq, inet_ntoa (my_ring_id.rep), memb_state);
  2243. my_token_held = 0;
  2244. return (0); /* discard token */
  2245. }
  2246. if (my_token_seq >= token->token_seq) {
  2247. my_token_held = 0;
  2248. reset_token_retransmit_timeout ();
  2249. reset_token_timeout ();
  2250. return (0); /* discard token */
  2251. }
  2252. transmits_allowed = 30;
  2253. mcasted = orf_token_rtr (token, &transmits_allowed);
  2254. if (mcasted) {
  2255. forward_token = 1;
  2256. my_seq_unchanged = 0;
  2257. }
  2258. if ((last_aru + MISSING_MCAST_WINDOW) < token->seq) {
  2259. transmits_allowed = 0;
  2260. }
  2261. mcasted = orf_token_mcast (token, transmits_allowed, system_from);
  2262. if (mcasted) {
  2263. forward_token = 1;
  2264. my_seq_unchanged = 0;
  2265. }
  2266. if (my_aru < token->aru ||
  2267. my_id.sin_addr.s_addr == token->aru_addr.s_addr ||
  2268. token->aru_addr.s_addr == 0) {
  2269. token->aru = my_aru;
  2270. if (token->aru == token->seq) {
  2271. token->aru_addr.s_addr = 0;
  2272. } else {
  2273. token->aru_addr.s_addr = my_id.sin_addr.s_addr;
  2274. }
  2275. }
  2276. if (token->aru == my_last_aru && token->aru_addr.s_addr != 0) {
  2277. my_aru_count += 1;
  2278. } else {
  2279. my_aru_count = 0;
  2280. }
  2281. if (my_aru_count > FAIL_TO_RECV_CONST &&
  2282. token->aru_addr.s_addr == my_id.sin_addr.s_addr) {
  2283. memb_set_merge (&token->aru_addr, 1,
  2284. my_failed_list, &my_failed_list_entries);
  2285. memb_state_gather_enter ();
  2286. } else {
  2287. my_token_seq = token->token_seq;
  2288. token->token_seq += 1;
  2289. if (memb_state == MEMB_STATE_RECOVERY) {
  2290. /*
  2291. * my_aru == my_high_seq_received means this processor
  2292. * has recovered all messages it can recover
  2293. * (ie: its retrans queue is empty)
  2294. */
  2295. if (queue_is_empty (&retrans_message_queue) == 0 ||
  2296. my_aru != my_high_seq_received) {
  2297. if (token->retrans_flg == 0) {
  2298. token->retrans_flg = 1;
  2299. my_set_retrans_flg = 1;
  2300. }
  2301. } else
  2302. if (token->retrans_flg == 1 && my_set_retrans_flg) {
  2303. token->retrans_flg = 0;
  2304. }
  2305. printf ("token retrans flag is %d my set retrans flag%d retrans queue empty %d count %d\n",
  2306. token->retrans_flg, my_set_retrans_flg, queue_is_empty (&retrans_message_queue), my_retrans_flg_count);
  2307. if (token->retrans_flg == 0) {
  2308. my_retrans_flg_count += 1;
  2309. }
  2310. if (my_retrans_flg_count == 2) {
  2311. my_install_seq = token->seq;
  2312. }
  2313. printf ("install seq %d aru %d high seq received %d\n", my_install_seq, my_aru,
  2314. my_high_seq_received);
  2315. if (my_retrans_flg_count >= 2 && my_aru >= my_install_seq && my_received_flg == 0) {
  2316. my_received_flg = 1;
  2317. my_deliver_memb_entries = my_trans_memb_entries;
  2318. memcpy (my_deliver_memb_list, my_trans_memb_list,
  2319. sizeof (struct in_addr) * my_trans_memb_entries);
  2320. }
  2321. if (my_retrans_flg_count >= 3 && token->aru >= my_install_seq) {
  2322. my_rotation_counter += 1;
  2323. }
  2324. if (my_rotation_counter == 2) {
  2325. printf ("retrans flag count %d token aru %d install seq %d aru %d %d\n", my_retrans_flg_count,
  2326. token->aru, my_install_seq, my_aru, token->seq);
  2327. memb_state_operational_enter ();
  2328. my_rotation_counter = 0;
  2329. my_retrans_flg_count = 0;
  2330. }
  2331. }
  2332. token_send (token, 1 /* forward_token */);
  2333. #ifdef GIVEINFO
  2334. gettimeofday (&tv_current, NULL);
  2335. timersub (&tv_current, &tv_old, &tv_diff);
  2336. memcpy (&tv_old, &tv_current, sizeof (struct timeval));
  2337. if ((((float)tv_diff.tv_usec) / 100.0) > 5.0) {
  2338. printf ("I held %0.4f ms\n", ((float)tv_diff.tv_usec) / 100.0);
  2339. }
  2340. #endif
  2341. if (my_do_delivery) {
  2342. if (memb_state != MEMB_STATE_RECOVERY) {
  2343. messages_deliver_to_app (0, &my_high_seq_delivered, my_high_seq_received);
  2344. }
  2345. }
  2346. /*
  2347. * Deliver messages after token has been transmitted
  2348. * to improve performance
  2349. */
  2350. reset_token_timeout (); // REVIEWED
  2351. if (forward_token == 0) {
  2352. reset_token_retransmit_timeout (); // REVIEWED
  2353. }
  2354. token_callbacks_execute (TOTEMSRP_CALLBACK_TOKEN_SENT);
  2355. }
  2356. break;
  2357. }
  2358. my_token_held = 0;
  2359. return (0);
  2360. }
  2361. static void messages_deliver_to_app (int skip, int *start_point, int end_point)
  2362. {
  2363. struct sort_queue_item *sort_queue_item_p;
  2364. int i;
  2365. int res;
  2366. struct mcast *mcast;
  2367. totemsrp_log_printf (totemsrp_log_level_debug,
  2368. "Delivering %d to %d\n", *start_point + 1, my_high_seq_received);
  2369. /*
  2370. * Deliver messages in order from rtr queue to pending delivery queue
  2371. */
  2372. for (i = *start_point + 1; i <= end_point; i++) {
  2373. void *ptr;
  2374. res = sq_item_get (&regular_sort_queue, i, &ptr);
  2375. if (res != 0 && skip) {
  2376. *start_point = i;
  2377. continue;
  2378. }
  2379. /*
  2380. * If hole, stop assembly
  2381. */
  2382. if (res != 0) {
  2383. break;
  2384. }
  2385. sort_queue_item_p = ptr;
  2386. mcast = sort_queue_item_p->iovec[0].iov_base;
  2387. if (mcast == (struct mcast *)0xdeadbeef) {
  2388. printf ("seq %d\n", sort_queue_item_p->iovec[0].iov_len);
  2389. }
  2390. assert (mcast != (struct mcast *)0xdeadbeef);
  2391. /*
  2392. * Message found
  2393. */
  2394. totemsrp_log_printf (totemsrp_log_level_debug,
  2395. "Delivering MCAST message with seq %d to pending delivery queue\n",
  2396. mcast->seq);
  2397. *start_point = i;
  2398. /*
  2399. * Message is locally originated multicasat
  2400. */
  2401. if (sort_queue_item_p->iov_len > 1 &&
  2402. sort_queue_item_p->iovec[0].iov_len == sizeof (struct mcast)) {
  2403. totemsrp_deliver_fn (
  2404. mcast->source,
  2405. &sort_queue_item_p->iovec[1],
  2406. sort_queue_item_p->iov_len - 1,
  2407. mcast->header.endian_detector != ENDIAN_LOCAL);
  2408. } else {
  2409. sort_queue_item_p->iovec[0].iov_len -= sizeof (struct mcast);
  2410. sort_queue_item_p->iovec[0].iov_base += sizeof (struct mcast);
  2411. totemsrp_deliver_fn (
  2412. mcast->source,
  2413. sort_queue_item_p->iovec,
  2414. sort_queue_item_p->iov_len,
  2415. mcast->header.endian_detector != ENDIAN_LOCAL);
  2416. sort_queue_item_p->iovec[0].iov_len += sizeof (struct mcast);
  2417. sort_queue_item_p->iovec[0].iov_base -= sizeof (struct mcast);
  2418. }
  2419. stats_delv += 1;
  2420. }
  2421. }
  2422. /*
  2423. * recv message handler called when MCAST message type received
  2424. */
  2425. static int message_handler_mcast (
  2426. struct sockaddr_in *system_from,
  2427. struct iovec *iovec,
  2428. int iov_len,
  2429. int bytes_received,
  2430. int endian_conversion_needed)
  2431. {
  2432. struct sort_queue_item sort_queue_item;
  2433. struct sq *sort_queue;
  2434. struct mcast mcast_header;
  2435. if (memb_state == MEMB_STATE_RECOVERY) {
  2436. sort_queue = &recovery_sort_queue;
  2437. } else {
  2438. sort_queue = &regular_sort_queue;
  2439. }
  2440. if (endian_conversion_needed) {
  2441. mcast_endian_convert (iovec[0].iov_base, &mcast_header);
  2442. } else {
  2443. memcpy (&mcast_header, iovec[0].iov_base, sizeof (struct mcast));
  2444. }
  2445. assert (bytes_received < PACKET_SIZE_MAX);
  2446. #ifdef DROP_RANDOM
  2447. if (random()%100 < 20) {
  2448. return (0);
  2449. }
  2450. #endif
  2451. cancel_token_retransmit_timeout (); // REVIEWED
  2452. /*
  2453. * If the message is foriegn execute the switch below
  2454. */
  2455. // TODO this detection of foreign messages isn't correct
  2456. // it doesn't work in the recovery state for the new processors
  2457. // my_memb_list is the wrong list to use I think we should use my_new_memb_list
  2458. if (!memb_set_subset (&system_from->sin_addr,
  2459. 1,
  2460. my_new_memb_list,
  2461. my_new_memb_entries)) {
  2462. printf ("got foreign message\n");
  2463. switch (memb_state) {
  2464. case MEMB_STATE_OPERATIONAL:
  2465. memb_set_merge (&system_from->sin_addr, 1,
  2466. my_proc_list, &my_proc_list_entries);
  2467. memb_state_gather_enter ();
  2468. break;
  2469. case MEMB_STATE_GATHER:
  2470. if (!memb_set_subset (&system_from->sin_addr,
  2471. 1,
  2472. my_proc_list,
  2473. my_proc_list_entries)) {
  2474. memb_set_merge (&system_from->sin_addr, 1,
  2475. my_proc_list, &my_proc_list_entries);
  2476. memb_state_gather_enter ();
  2477. return (0);
  2478. }
  2479. break;
  2480. case MEMB_STATE_COMMIT:
  2481. /* discard message */
  2482. break;
  2483. case MEMB_STATE_RECOVERY:
  2484. /* discard message */
  2485. break;
  2486. }
  2487. return (0); /* discard all foreign messages */
  2488. }
  2489. /*
  2490. * Add mcast message to rtr queue if not already in rtr queue
  2491. * otherwise free io vectors
  2492. */
  2493. if (bytes_received > 0 && bytes_received < PACKET_SIZE_MAX &&
  2494. sq_item_inuse (sort_queue, mcast_header.seq) == 0) {
  2495. //printf ("adding message %d\n", mcast->seq);
  2496. /*
  2497. * Allocate new multicast memory block
  2498. */
  2499. sort_queue_item.iovec[0].iov_base = malloc (bytes_received);
  2500. if (sort_queue_item.iovec[0].iov_base == 0) {
  2501. return (-1); /* error here is corrected by the algorithm */
  2502. }
  2503. memcpy (sort_queue_item.iovec[0].iov_base, iovec[0].iov_base,
  2504. bytes_received);
  2505. sort_queue_item.iovec[0].iov_len = bytes_received;
  2506. assert (sort_queue_item.iovec[0].iov_len > 0);
  2507. assert (sort_queue_item.iovec[0].iov_len < PACKET_SIZE_MAX);
  2508. sort_queue_item.iov_len = 1;
  2509. if (mcast_header.seq > my_high_seq_received) {
  2510. my_high_seq_received = mcast_header.seq;
  2511. }
  2512. sq_item_add (sort_queue, &sort_queue_item, mcast_header.seq);
  2513. }
  2514. update_aru ();
  2515. if (my_token_held) {
  2516. my_do_delivery = 1;
  2517. } else {
  2518. if (memb_state != MEMB_STATE_RECOVERY) {
  2519. messages_deliver_to_app (0, &my_high_seq_delivered, my_high_seq_received);
  2520. }
  2521. }
  2522. /* TODO remove from retrans message queue for old ring in recovery state */
  2523. return (0);
  2524. }
  2525. int memb_join_process (struct memb_join *memb_join, struct sockaddr_in *system_from)
  2526. {
  2527. struct memb_commit_token my_commit_token;
  2528. if (memb_set_equal (memb_join->proc_list,
  2529. memb_join->proc_list_entries,
  2530. my_proc_list,
  2531. my_proc_list_entries) &&
  2532. memb_set_equal (memb_join->failed_list,
  2533. memb_join->failed_list_entries,
  2534. my_failed_list,
  2535. my_failed_list_entries)) {
  2536. memb_consensus_set (&system_from->sin_addr);
  2537. if (memb_consensus_agreed () &&
  2538. memb_lowest_in_config ()) {
  2539. memb_state_commit_token_create (&my_commit_token);
  2540. memb_state_commit_enter (&my_commit_token);
  2541. } else {
  2542. return (0); // TODO added to match spec
  2543. }
  2544. } else
  2545. if (memb_set_subset (memb_join->proc_list,
  2546. memb_join->proc_list_entries,
  2547. my_proc_list,
  2548. my_proc_list_entries) &&
  2549. memb_set_subset (memb_join->failed_list,
  2550. memb_join->failed_list_entries,
  2551. my_failed_list, // TODO changed proc to failed to match spec
  2552. my_failed_list_entries)) {
  2553. return (0);
  2554. } else
  2555. if (memb_set_subset (&system_from->sin_addr, 1, // TODO changed proc to failed to match spec
  2556. my_failed_list, my_failed_list_entries)) {
  2557. return (0);
  2558. } else {
  2559. memb_set_merge (memb_join->proc_list,
  2560. memb_join->proc_list_entries,
  2561. my_proc_list, &my_proc_list_entries);
  2562. if (memb_set_subset (&my_id.sin_addr, 1,
  2563. memb_join->failed_list, memb_join->failed_list_entries)) {
  2564. memb_set_merge (&system_from->sin_addr, 1,
  2565. my_failed_list, &my_failed_list_entries);
  2566. } else {
  2567. memb_set_merge (memb_join->failed_list,
  2568. memb_join->failed_list_entries,
  2569. my_failed_list, &my_failed_list_entries);
  2570. }
  2571. memb_state_gather_enter ();
  2572. return (1); /* gather entered */
  2573. }
  2574. return (0); /* gather not entered */
  2575. }
  2576. static void memb_join_endian_convert (struct memb_join *in, struct memb_join *out)
  2577. {
  2578. int i;
  2579. out->header.type = in->header.type;
  2580. out->header.endian_detector = ENDIAN_LOCAL;
  2581. out->proc_list_entries = swab32 (in->proc_list_entries);
  2582. out->failed_list_entries = swab32 (in->failed_list_entries);
  2583. out->ring_seq = swab64 (in->ring_seq);
  2584. for (i = 0; i < out->proc_list_entries; i++) {
  2585. out->proc_list[i].s_addr = in->proc_list[i].s_addr;
  2586. }
  2587. for (i = 0; i < out->failed_list_entries; i++) {
  2588. out->failed_list[i].s_addr = in->failed_list[i].s_addr;
  2589. }
  2590. }
  2591. static void memb_commit_token_endian_convert (struct memb_commit_token *in, struct memb_commit_token *out)
  2592. {
  2593. int i;
  2594. out->header.type = in->header.type;
  2595. out->header.endian_detector = ENDIAN_LOCAL;
  2596. out->token_seq = swab32 (in->token_seq);
  2597. out->ring_id.rep.s_addr = in->ring_id.rep.s_addr;
  2598. out->ring_id.seq = swab64 (in->ring_id.seq);
  2599. out->retrans_flg = swab32 (in->retrans_flg);
  2600. out->memb_index = swab32 (in->memb_index);
  2601. out->addr_entries = swab32 (in->addr_entries);
  2602. for (i = 0; i < out->addr_entries; i++) {
  2603. out->addr[i].s_addr = in->addr[i].s_addr;
  2604. out->memb_list[i].ring_id.rep.s_addr =
  2605. in->memb_list[i].ring_id.rep.s_addr;
  2606. out->memb_list[i].ring_id.seq =
  2607. swab64 (in->memb_list[i].ring_id.seq);
  2608. out->memb_list[i].aru = swab32 (in->memb_list[i].aru);
  2609. out->memb_list[i].high_delivered = swab32 (in->memb_list[i].high_delivered);
  2610. out->memb_list[i].received_flg = swab32 (in->memb_list[i].received_flg);
  2611. }
  2612. }
  2613. static void orf_token_endian_convert (struct orf_token *in, struct orf_token *out)
  2614. {
  2615. int i;
  2616. out->header.type = in->header.type;
  2617. out->header.endian_detector = ENDIAN_LOCAL;
  2618. out->seq = swab32 (in->seq);
  2619. out->token_seq = swab32 (in->token_seq);
  2620. out->aru = swab32 (in->aru);
  2621. out->ring_id.rep.s_addr = in->ring_id.rep.s_addr;
  2622. out->ring_id.seq = swab64 (in->ring_id.seq);
  2623. out->fcc = swab32 (in->fcc);
  2624. out->retrans_flg = swab32 (in->retrans_flg);
  2625. out->rtr_list_entries = swab32 (in->rtr_list_entries);
  2626. for (i = 0; i < out->rtr_list_entries; i++) {
  2627. out->rtr_list[i].ring_id.rep.s_addr = in->rtr_list[i].ring_id.rep.s_addr;
  2628. out->rtr_list[i].ring_id.seq = swab64 (in->rtr_list[i].ring_id.seq);
  2629. out->rtr_list[i].seq = swab32 (in->rtr_list[i].seq);
  2630. }
  2631. }
  2632. static void mcast_endian_convert (struct mcast *in, struct mcast *out)
  2633. {
  2634. out->header.type = in->header.type;
  2635. out->header.endian_detector = ENDIAN_LOCAL;
  2636. out->seq = swab32 (in->seq);
  2637. out->ring_id.rep.s_addr = in->ring_id.rep.s_addr;
  2638. out->ring_id.seq = swab64 (in->ring_id.seq);
  2639. out->source = in->source;
  2640. out->guarantee = in->guarantee;
  2641. }
  2642. static int message_handler_memb_join (
  2643. struct sockaddr_in *system_from,
  2644. struct iovec *iovec,
  2645. int iov_len,
  2646. int bytes_received,
  2647. int endian_conversion_needed)
  2648. {
  2649. struct memb_join *memb_join;
  2650. struct memb_join memb_join_convert;
  2651. int gather_entered;
  2652. if (endian_conversion_needed) {
  2653. memb_join = &memb_join_convert;
  2654. memb_join_endian_convert (iovec->iov_base, &memb_join_convert);
  2655. } else {
  2656. memb_join = (struct memb_join *)iovec->iov_base;
  2657. }
  2658. if (token_ring_id_seq < memb_join->ring_seq) {
  2659. token_ring_id_seq = memb_join->ring_seq;
  2660. }
  2661. switch (memb_state) {
  2662. case MEMB_STATE_OPERATIONAL:
  2663. gather_entered = memb_join_process (memb_join, system_from);
  2664. if (gather_entered == 0) {
  2665. memb_state_gather_enter ();
  2666. }
  2667. break;
  2668. case MEMB_STATE_GATHER:
  2669. memb_join_process (memb_join, system_from);
  2670. break;
  2671. case MEMB_STATE_COMMIT:
  2672. if (memb_set_subset (&system_from->sin_addr,
  2673. 1,
  2674. my_new_memb_list,
  2675. my_new_memb_entries) &&
  2676. memb_join->ring_seq >= my_ring_id.seq) {
  2677. memb_join_process (memb_join, system_from);
  2678. memb_state_gather_enter ();
  2679. }
  2680. break;
  2681. case MEMB_STATE_RECOVERY:
  2682. if (memb_set_subset (&system_from->sin_addr,
  2683. 1,
  2684. my_new_memb_list,
  2685. my_new_memb_entries) &&
  2686. memb_join->ring_seq >= my_ring_id.seq) {
  2687. memb_join_process (memb_join, system_from);
  2688. memb_state_gather_enter ();
  2689. my_aru = my_aru_save;
  2690. my_high_seq_received = my_high_seq_received_save;
  2691. sq_reinit (&recovery_sort_queue, 0);
  2692. queue_reinit (&retrans_message_queue);
  2693. // TODO calculate current old ring aru
  2694. }
  2695. break;
  2696. }
  2697. return (0);
  2698. }
  2699. static int message_handler_memb_commit_token (
  2700. struct sockaddr_in *system_from,
  2701. struct iovec *iovec,
  2702. int iov_len,
  2703. int bytes_received,
  2704. int endian_conversion_needed)
  2705. {
  2706. struct memb_commit_token memb_commit_token_convert;
  2707. struct memb_commit_token *memb_commit_token;
  2708. struct in_addr sub[MAX_MEMBERS];
  2709. int sub_entries;
  2710. if (endian_conversion_needed) {
  2711. memb_commit_token = &memb_commit_token_convert;
  2712. memb_commit_token_endian_convert (iovec->iov_base, memb_commit_token);
  2713. } else {
  2714. memb_commit_token = (struct memb_commit_token *)iovec->iov_base;
  2715. }
  2716. /* TODO do we need to check for a duplicate token?
  2717. if (memb_commit_token->token_seq > 0 &&
  2718. my_token_seq >= memb_commit_token->token_seq) {
  2719. printf ("already received commit token %d %d\n",
  2720. memb_commit_token->token_seq, my_token_seq);
  2721. return (0);
  2722. }
  2723. */
  2724. switch (memb_state) {
  2725. case MEMB_STATE_OPERATIONAL:
  2726. /* discard token */
  2727. break;
  2728. case MEMB_STATE_GATHER:
  2729. memb_set_subtract (sub, &sub_entries,
  2730. my_proc_list, my_proc_list_entries,
  2731. my_failed_list, my_failed_list_entries);
  2732. if (memb_set_equal (memb_commit_token->addr,
  2733. memb_commit_token->addr_entries,
  2734. sub,
  2735. sub_entries) &&
  2736. memb_commit_token->ring_id.seq > my_ring_id.seq) {
  2737. memb_state_commit_enter (memb_commit_token);
  2738. }
  2739. break;
  2740. case MEMB_STATE_COMMIT:
  2741. // TODO add if to match spec
  2742. // if (memb_commit_token->ring_seq == my_ring_id.seq) {
  2743. memb_state_recovery_enter (memb_commit_token);
  2744. // }
  2745. break;
  2746. case MEMB_STATE_RECOVERY:
  2747. totemsrp_log_printf (totemsrp_log_level_notice,
  2748. "Sending initial ORF token\n");
  2749. if (my_id.sin_addr.s_addr == my_ring_id.rep.s_addr) {
  2750. // TODO convert instead of initiate
  2751. orf_token_send_initial ();
  2752. reset_token_timeout (); // REVIEWED
  2753. reset_token_retransmit_timeout (); // REVIEWED
  2754. }
  2755. break;
  2756. }
  2757. return (0);
  2758. }
  2759. static int recv_handler (poll_handle handle, int fd, int revents,
  2760. void *data, unsigned int *prio)
  2761. {
  2762. struct msghdr msg_recv;
  2763. struct message_header *message_header;
  2764. struct sockaddr_in system_from;
  2765. int res = 0;
  2766. int bytes_received;
  2767. *prio = UINT_MAX;
  2768. /*
  2769. * Receive datagram
  2770. */
  2771. msg_recv.msg_name = &system_from;
  2772. msg_recv.msg_namelen = sizeof (struct sockaddr_in);
  2773. msg_recv.msg_iov = &totemsrp_iov_recv;
  2774. msg_recv.msg_iovlen = 1;
  2775. msg_recv.msg_control = 0;
  2776. msg_recv.msg_controllen = 0;
  2777. msg_recv.msg_flags = 0;
  2778. bytes_received = recvmsg (fd, &msg_recv, MSG_NOSIGNAL | MSG_DONTWAIT);
  2779. if (bytes_received == -1) {
  2780. return (0);
  2781. } else {
  2782. stats_recv += bytes_received;
  2783. }
  2784. if (bytes_received < sizeof (struct message_header)) {
  2785. totemsrp_log_printf (totemsrp_log_level_security, "Received message is too short... ignoring %d %d.\n", bytes_received);
  2786. return (0);
  2787. }
  2788. message_header = (struct message_header *)msg_recv.msg_iov->iov_base;
  2789. /*
  2790. * Authenticate and if authenticated, decrypt datagram
  2791. */
  2792. totemsrp_iov_recv.iov_len = bytes_received;
  2793. res = authenticate_and_decrypt (&totemsrp_iov_recv);
  2794. log_digest = 0;
  2795. if (res == -1) {
  2796. printf ("message header type %d %d\n", message_header->type, bytes_received);
  2797. totemsrp_iov_recv.iov_len = PACKET_SIZE_MAX;
  2798. //exit (1);
  2799. return 0;
  2800. }
  2801. if (stats_tv_start.tv_usec == 0) {
  2802. gettimeofday (&stats_tv_start, NULL);
  2803. }
  2804. /*
  2805. * Handle incoming message
  2806. */
  2807. message_header = (struct message_header *)msg_recv.msg_iov[0].iov_base;
  2808. totemsrp_message_handlers.handler_functions[(int)message_header->type] (
  2809. &system_from,
  2810. msg_recv.msg_iov,
  2811. msg_recv.msg_iovlen,
  2812. bytes_received,
  2813. message_header->endian_detector != ENDIAN_LOCAL);
  2814. totemsrp_iov_recv.iov_len = PACKET_SIZE_MAX;
  2815. return (0);
  2816. }