totemsrp.c 132 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412241324142415241624172418241924202421242224232424242524262427242824292430243124322433243424352436243724382439244024412442244324442445244624472448244924502451245224532454245524562457245824592460246124622463246424652466246724682469247024712472247324742475247624772478247924802481248224832484248524862487248824892490249124922493249424952496249724982499250025012502250325042505250625072508250925102511251225132514251525162517251825192520252125222523252425252526252725282529253025312532253325342535253625372538253925402541254225432544254525462547254825492550255125522553255425552556255725582559256025612562256325642565256625672568256925702571257225732574257525762577257825792580258125822583258425852586258725882589259025912592259325942595259625972598259926002601260226032604260526062607260826092610261126122613261426152616261726182619262026212622262326242625262626272628262926302631263226332634263526362637263826392640264126422643264426452646264726482649265026512652265326542655265626572658265926602661266226632664266526662667266826692670267126722673267426752676267726782679268026812682268326842685268626872688268926902691269226932694269526962697269826992700270127022703270427052706270727082709271027112712271327142715271627172718271927202721272227232724272527262727272827292730273127322733273427352736273727382739274027412742274327442745274627472748274927502751275227532754275527562757275827592760276127622763276427652766276727682769277027712772277327742775277627772778277927802781278227832784278527862787278827892790279127922793279427952796279727982799280028012802280328042805280628072808280928102811281228132814281528162817281828192820282128222823282428252826282728282829283028312832283328342835283628372838283928402841284228432844284528462847284828492850285128522853285428552856285728582859286028612862286328642865286628672868286928702871287228732874287528762877287828792880288128822883288428852886288728882889289028912892289328942895289628972898289929002901290229032904290529062907290829092910291129122913291429152916291729182919292029212922292329242925292629272928292929302931293229332934293529362937293829392940294129422943294429452946294729482949295029512952295329542955295629572958295929602961296229632964296529662967296829692970297129722973297429752976297729782979298029812982298329842985298629872988298929902991299229932994299529962997299829993000300130023003300430053006300730083009301030113012301330143015301630173018301930203021302230233024302530263027302830293030303130323033303430353036303730383039304030413042304330443045304630473048304930503051305230533054305530563057305830593060306130623063306430653066306730683069307030713072307330743075307630773078307930803081308230833084308530863087308830893090309130923093309430953096309730983099310031013102310331043105310631073108310931103111311231133114311531163117311831193120312131223123312431253126312731283129313031313132313331343135313631373138313931403141314231433144314531463147314831493150315131523153315431553156315731583159316031613162316331643165316631673168316931703171317231733174317531763177317831793180318131823183318431853186318731883189319031913192319331943195319631973198319932003201320232033204320532063207320832093210321132123213321432153216321732183219322032213222322332243225322632273228322932303231323232333234323532363237323832393240324132423243324432453246324732483249325032513252325332543255325632573258325932603261326232633264326532663267326832693270327132723273327432753276327732783279328032813282328332843285328632873288328932903291329232933294329532963297329832993300330133023303330433053306330733083309331033113312331333143315331633173318331933203321332233233324332533263327332833293330333133323333333433353336333733383339334033413342334333443345334633473348334933503351335233533354335533563357335833593360336133623363336433653366336733683369337033713372337333743375337633773378337933803381338233833384338533863387338833893390339133923393339433953396339733983399340034013402340334043405340634073408340934103411341234133414341534163417341834193420342134223423342434253426342734283429343034313432343334343435343634373438343934403441344234433444344534463447344834493450345134523453345434553456345734583459346034613462346334643465346634673468346934703471347234733474347534763477347834793480348134823483348434853486348734883489349034913492349334943495349634973498349935003501350235033504350535063507350835093510351135123513351435153516351735183519352035213522352335243525352635273528352935303531353235333534353535363537353835393540354135423543354435453546354735483549355035513552355335543555355635573558355935603561356235633564356535663567356835693570357135723573357435753576357735783579358035813582358335843585358635873588358935903591359235933594359535963597359835993600360136023603360436053606360736083609361036113612361336143615361636173618361936203621362236233624362536263627362836293630363136323633363436353636363736383639364036413642364336443645364636473648364936503651365236533654365536563657365836593660366136623663366436653666366736683669367036713672367336743675367636773678367936803681368236833684368536863687368836893690369136923693369436953696369736983699370037013702370337043705370637073708370937103711371237133714371537163717371837193720372137223723372437253726372737283729373037313732373337343735373637373738373937403741374237433744374537463747374837493750375137523753375437553756375737583759376037613762376337643765376637673768376937703771377237733774377537763777377837793780378137823783378437853786378737883789379037913792379337943795379637973798379938003801380238033804380538063807380838093810381138123813381438153816381738183819382038213822382338243825382638273828382938303831383238333834383538363837383838393840384138423843384438453846384738483849385038513852385338543855385638573858385938603861386238633864386538663867386838693870387138723873387438753876387738783879388038813882388338843885388638873888388938903891389238933894389538963897389838993900390139023903390439053906390739083909391039113912391339143915391639173918391939203921392239233924392539263927392839293930393139323933393439353936393739383939394039413942394339443945394639473948394939503951395239533954395539563957395839593960396139623963396439653966396739683969397039713972397339743975397639773978397939803981398239833984398539863987398839893990399139923993399439953996399739983999400040014002400340044005400640074008400940104011401240134014401540164017401840194020402140224023402440254026402740284029403040314032403340344035403640374038403940404041404240434044404540464047404840494050405140524053405440554056405740584059406040614062406340644065406640674068406940704071407240734074407540764077407840794080408140824083408440854086408740884089409040914092409340944095409640974098409941004101410241034104410541064107410841094110411141124113411441154116411741184119412041214122412341244125412641274128412941304131413241334134413541364137413841394140414141424143414441454146414741484149415041514152415341544155415641574158415941604161416241634164416541664167416841694170417141724173417441754176417741784179418041814182418341844185418641874188418941904191419241934194419541964197419841994200420142024203420442054206420742084209421042114212421342144215421642174218421942204221422242234224422542264227422842294230423142324233423442354236423742384239424042414242424342444245424642474248424942504251425242534254425542564257425842594260426142624263426442654266426742684269427042714272427342744275427642774278427942804281428242834284428542864287428842894290429142924293429442954296429742984299430043014302430343044305430643074308430943104311431243134314431543164317431843194320432143224323432443254326432743284329433043314332433343344335433643374338433943404341434243434344434543464347434843494350435143524353435443554356435743584359436043614362436343644365436643674368436943704371437243734374437543764377437843794380438143824383438443854386438743884389439043914392439343944395439643974398439944004401440244034404440544064407440844094410441144124413441444154416441744184419442044214422442344244425442644274428442944304431443244334434443544364437443844394440444144424443444444454446444744484449445044514452445344544455445644574458445944604461446244634464446544664467446844694470447144724473447444754476447744784479448044814482448344844485448644874488448944904491449244934494449544964497449844994500450145024503450445054506450745084509451045114512451345144515451645174518451945204521452245234524452545264527452845294530453145324533453445354536453745384539454045414542454345444545454645474548454945504551455245534554455545564557455845594560456145624563456445654566456745684569457045714572457345744575457645774578457945804581458245834584458545864587458845894590459145924593459445954596459745984599460046014602460346044605460646074608460946104611461246134614461546164617461846194620462146224623462446254626462746284629463046314632463346344635463646374638463946404641464246434644464546464647464846494650465146524653465446554656465746584659466046614662466346644665466646674668466946704671467246734674467546764677467846794680468146824683468446854686468746884689469046914692469346944695469646974698469947004701470247034704470547064707470847094710471147124713471447154716471747184719472047214722472347244725472647274728472947304731473247334734473547364737473847394740474147424743474447454746474747484749475047514752475347544755475647574758475947604761476247634764476547664767476847694770477147724773477447754776477747784779478047814782
  1. /*
  2. * Copyright (c) 2003-2006 MontaVista Software, Inc.
  3. * Copyright (c) 2006-2009 Red Hat, Inc.
  4. *
  5. * All rights reserved.
  6. *
  7. * Author: Steven Dake (sdake@redhat.com)
  8. *
  9. * This software licensed under BSD license, the text of which follows:
  10. *
  11. * Redistribution and use in source and binary forms, with or without
  12. * modification, are permitted provided that the following conditions are met:
  13. *
  14. * - Redistributions of source code must retain the above copyright notice,
  15. * this list of conditions and the following disclaimer.
  16. * - Redistributions in binary form must reproduce the above copyright notice,
  17. * this list of conditions and the following disclaimer in the documentation
  18. * and/or other materials provided with the distribution.
  19. * - Neither the name of the MontaVista Software, Inc. nor the names of its
  20. * contributors may be used to endorse or promote products derived from this
  21. * software without specific prior written permission.
  22. *
  23. * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
  24. * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  25. * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  26. * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
  27. * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
  28. * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
  29. * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
  30. * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
  31. * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
  32. * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
  33. * THE POSSIBILITY OF SUCH DAMAGE.
  34. */
  35. /*
  36. * The first version of this code was based upon Yair Amir's PhD thesis:
  37. * http://www.cs.jhu.edu/~yairamir/phd.ps) (ch4,5).
  38. *
  39. * The current version of totemsrp implements the Totem protocol specified in:
  40. * http://citeseer.ist.psu.edu/amir95totem.html
  41. *
  42. * The deviations from the above published protocols are:
  43. * - encryption of message contents with nss
  44. * - authentication of meessage contents with SHA1/HMAC
  45. * - token hold mode where token doesn't rotate on unused ring - reduces cpu
  46. * usage on 1.6ghz xeon from 35% to less then .1 % as measured by top
  47. */
  48. #include <config.h>
  49. #include <assert.h>
  50. #ifdef HAVE_ALLOCA_H
  51. #include <alloca.h>
  52. #endif
  53. #include <sys/mman.h>
  54. #include <sys/types.h>
  55. #include <sys/stat.h>
  56. #include <sys/socket.h>
  57. #include <netdb.h>
  58. #include <sys/un.h>
  59. #include <sys/ioctl.h>
  60. #include <sys/param.h>
  61. #include <netinet/in.h>
  62. #include <arpa/inet.h>
  63. #include <unistd.h>
  64. #include <fcntl.h>
  65. #include <stdlib.h>
  66. #include <stdio.h>
  67. #include <errno.h>
  68. #include <sched.h>
  69. #include <time.h>
  70. #include <sys/time.h>
  71. #include <sys/poll.h>
  72. #include <sys/uio.h>
  73. #include <limits.h>
  74. #include <qb/qblist.h>
  75. #include <qb/qbdefs.h>
  76. #include <qb/qbutil.h>
  77. #include <qb/qbloop.h>
  78. #include <corosync/swab.h>
  79. #include <corosync/sq.h>
  80. #define LOGSYS_UTILS_ONLY 1
  81. #include <corosync/logsys.h>
  82. #include "totemsrp.h"
  83. #include "totemnet.h"
  84. #include "cs_queue.h"
  85. #define LOCALHOST_IP inet_addr("127.0.0.1")
  86. #define QUEUE_RTR_ITEMS_SIZE_MAX 16384 /* allow 16384 retransmit items */
  87. #define RETRANS_MESSAGE_QUEUE_SIZE_MAX 16384 /* allow 500 messages to be queued */
  88. #define RECEIVED_MESSAGE_QUEUE_SIZE_MAX 500 /* allow 500 messages to be queued */
  89. #define MAXIOVS 5
  90. #define RETRANSMIT_ENTRIES_MAX 30
  91. #define TOKEN_SIZE_MAX 64000 /* bytes */
  92. #define LEAVE_DUMMY_NODEID 0
  93. /*
  94. * SRP address.
  95. */
  96. struct srp_addr {
  97. unsigned int nodeid;
  98. };
  99. /*
  100. * Rollover handling:
  101. * SEQNO_START_MSG is the starting sequence number after a new configuration
  102. * This should remain zero, unless testing overflow in which case
  103. * 0x7ffff000 and 0xfffff000 are good starting values.
  104. *
  105. * SEQNO_START_TOKEN is the starting sequence number after a new configuration
  106. * for a token. This should remain zero, unless testing overflow in which
  107. * case 07fffff00 or 0xffffff00 are good starting values.
  108. */
  109. #define SEQNO_START_MSG 0x0
  110. #define SEQNO_START_TOKEN 0x0
  111. /*
  112. * These can be used ot test different rollover points
  113. * #define SEQNO_START_MSG 0xfffffe00
  114. * #define SEQNO_START_TOKEN 0xfffffe00
  115. */
  116. /*
  117. * These can be used to test the error recovery algorithms
  118. * #define TEST_DROP_ORF_TOKEN_PERCENTAGE 30
  119. * #define TEST_DROP_COMMIT_TOKEN_PERCENTAGE 30
  120. * #define TEST_DROP_MCAST_PERCENTAGE 50
  121. * #define TEST_RECOVERY_MSG_COUNT 300
  122. */
  123. /*
  124. * we compare incoming messages to determine if their endian is
  125. * different - if so convert them
  126. *
  127. * do not change
  128. */
  129. #define ENDIAN_LOCAL 0xff22
  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_MERGE_DETECT = 2, /* merge rings if there are available rings */
  134. MESSAGE_TYPE_MEMB_JOIN = 3, /* membership join message */
  135. MESSAGE_TYPE_MEMB_COMMIT_TOKEN = 4, /* membership commit token */
  136. MESSAGE_TYPE_TOKEN_HOLD_CANCEL = 5, /* cancel the holding of the token */
  137. };
  138. enum encapsulation_type {
  139. MESSAGE_ENCAPSULATED = 1,
  140. MESSAGE_NOT_ENCAPSULATED = 2
  141. };
  142. /*
  143. * New membership algorithm local variables
  144. */
  145. struct consensus_list_item {
  146. struct srp_addr addr;
  147. int set;
  148. };
  149. struct token_callback_instance {
  150. struct qb_list_head list;
  151. int (*callback_fn) (enum totem_callback_token_type type, const void *);
  152. enum totem_callback_token_type callback_type;
  153. int delete;
  154. void *data;
  155. };
  156. struct totemsrp_socket {
  157. int mcast;
  158. int token;
  159. };
  160. struct mcast {
  161. struct totem_message_header header;
  162. struct srp_addr system_from;
  163. unsigned int seq;
  164. int this_seqno;
  165. struct memb_ring_id ring_id;
  166. unsigned int node_id;
  167. int guarantee;
  168. } __attribute__((packed));
  169. struct rtr_item {
  170. struct memb_ring_id ring_id;
  171. unsigned int seq;
  172. }__attribute__((packed));
  173. struct orf_token {
  174. struct totem_message_header header;
  175. unsigned int seq;
  176. unsigned int token_seq;
  177. unsigned int aru;
  178. unsigned int aru_addr;
  179. struct memb_ring_id ring_id;
  180. unsigned int backlog;
  181. unsigned int fcc;
  182. int retrans_flg;
  183. int rtr_list_entries;
  184. struct rtr_item rtr_list[0];
  185. }__attribute__((packed));
  186. struct memb_join {
  187. struct totem_message_header header;
  188. struct srp_addr system_from;
  189. unsigned int proc_list_entries;
  190. unsigned int failed_list_entries;
  191. unsigned long long ring_seq;
  192. unsigned char end_of_memb_join[0];
  193. /*
  194. * These parts of the data structure are dynamic:
  195. * struct srp_addr proc_list[];
  196. * struct srp_addr failed_list[];
  197. */
  198. } __attribute__((packed));
  199. struct memb_merge_detect {
  200. struct totem_message_header header;
  201. struct srp_addr system_from;
  202. struct memb_ring_id ring_id;
  203. } __attribute__((packed));
  204. struct token_hold_cancel {
  205. struct totem_message_header header;
  206. struct memb_ring_id ring_id;
  207. } __attribute__((packed));
  208. struct memb_commit_token_memb_entry {
  209. struct memb_ring_id ring_id;
  210. unsigned int aru;
  211. unsigned int high_delivered;
  212. unsigned int received_flg;
  213. }__attribute__((packed));
  214. struct memb_commit_token {
  215. struct totem_message_header header;
  216. unsigned int token_seq;
  217. struct memb_ring_id ring_id;
  218. unsigned int retrans_flg;
  219. int memb_index;
  220. int addr_entries;
  221. unsigned char end_of_commit_token[0];
  222. /*
  223. * These parts of the data structure are dynamic:
  224. *
  225. * struct srp_addr addr[PROCESSOR_COUNT_MAX];
  226. * struct memb_commit_token_memb_entry memb_list[PROCESSOR_COUNT_MAX];
  227. */
  228. }__attribute__((packed));
  229. struct message_item {
  230. struct mcast *mcast;
  231. unsigned int msg_len;
  232. };
  233. struct sort_queue_item {
  234. struct mcast *mcast;
  235. unsigned int msg_len;
  236. };
  237. enum memb_state {
  238. MEMB_STATE_OPERATIONAL = 1,
  239. MEMB_STATE_GATHER = 2,
  240. MEMB_STATE_COMMIT = 3,
  241. MEMB_STATE_RECOVERY = 4
  242. };
  243. struct totemsrp_instance {
  244. int iface_changes;
  245. int failed_to_recv;
  246. /*
  247. * Flow control mcasts and remcasts on last and current orf_token
  248. */
  249. int fcc_remcast_last;
  250. int fcc_mcast_last;
  251. int fcc_remcast_current;
  252. struct consensus_list_item consensus_list[PROCESSOR_COUNT_MAX];
  253. int consensus_list_entries;
  254. int lowest_active_if;
  255. struct srp_addr my_id;
  256. struct totem_ip_address my_addrs[INTERFACE_MAX];
  257. struct srp_addr my_proc_list[PROCESSOR_COUNT_MAX];
  258. struct srp_addr my_failed_list[PROCESSOR_COUNT_MAX];
  259. struct srp_addr my_new_memb_list[PROCESSOR_COUNT_MAX];
  260. struct srp_addr my_trans_memb_list[PROCESSOR_COUNT_MAX];
  261. struct srp_addr my_memb_list[PROCESSOR_COUNT_MAX];
  262. struct srp_addr my_deliver_memb_list[PROCESSOR_COUNT_MAX];
  263. struct srp_addr my_left_memb_list[PROCESSOR_COUNT_MAX];
  264. unsigned int my_leave_memb_list[PROCESSOR_COUNT_MAX];
  265. int my_proc_list_entries;
  266. int my_failed_list_entries;
  267. int my_new_memb_entries;
  268. int my_trans_memb_entries;
  269. int my_memb_entries;
  270. int my_deliver_memb_entries;
  271. int my_left_memb_entries;
  272. int my_leave_memb_entries;
  273. struct memb_ring_id my_ring_id;
  274. struct memb_ring_id my_old_ring_id;
  275. int my_aru_count;
  276. int my_merge_detect_timeout_outstanding;
  277. unsigned int my_last_aru;
  278. int my_seq_unchanged;
  279. int my_received_flg;
  280. unsigned int my_high_seq_received;
  281. unsigned int my_install_seq;
  282. int my_rotation_counter;
  283. int my_set_retrans_flg;
  284. int my_retrans_flg_count;
  285. unsigned int my_high_ring_delivered;
  286. int heartbeat_timeout;
  287. /*
  288. * Queues used to order, deliver, and recover messages
  289. */
  290. struct cs_queue new_message_queue;
  291. struct cs_queue new_message_queue_trans;
  292. struct cs_queue retrans_message_queue;
  293. struct sq regular_sort_queue;
  294. struct sq recovery_sort_queue;
  295. /*
  296. * Received up to and including
  297. */
  298. unsigned int my_aru;
  299. unsigned int my_high_delivered;
  300. struct qb_list_head token_callback_received_listhead;
  301. struct qb_list_head token_callback_sent_listhead;
  302. char orf_token_retransmit[TOKEN_SIZE_MAX];
  303. int orf_token_retransmit_size;
  304. unsigned int my_token_seq;
  305. /*
  306. * Timers
  307. */
  308. qb_loop_timer_handle timer_pause_timeout;
  309. qb_loop_timer_handle timer_orf_token_timeout;
  310. qb_loop_timer_handle timer_orf_token_retransmit_timeout;
  311. qb_loop_timer_handle timer_orf_token_hold_retransmit_timeout;
  312. qb_loop_timer_handle timer_merge_detect_timeout;
  313. qb_loop_timer_handle memb_timer_state_gather_join_timeout;
  314. qb_loop_timer_handle memb_timer_state_gather_consensus_timeout;
  315. qb_loop_timer_handle memb_timer_state_commit_timeout;
  316. qb_loop_timer_handle timer_heartbeat_timeout;
  317. /*
  318. * Function and data used to log messages
  319. */
  320. int totemsrp_log_level_security;
  321. int totemsrp_log_level_error;
  322. int totemsrp_log_level_warning;
  323. int totemsrp_log_level_notice;
  324. int totemsrp_log_level_debug;
  325. int totemsrp_log_level_trace;
  326. int totemsrp_subsys_id;
  327. void (*totemsrp_log_printf) (
  328. int level,
  329. int sybsys,
  330. const char *function,
  331. const char *file,
  332. int line,
  333. const char *format, ...)__attribute__((format(printf, 6, 7)));;
  334. enum memb_state memb_state;
  335. //TODO struct srp_addr next_memb;
  336. qb_loop_t *totemsrp_poll_handle;
  337. struct totem_ip_address mcast_address;
  338. void (*totemsrp_deliver_fn) (
  339. unsigned int nodeid,
  340. const void *msg,
  341. unsigned int msg_len,
  342. int endian_conversion_required);
  343. void (*totemsrp_confchg_fn) (
  344. enum totem_configuration_type configuration_type,
  345. const unsigned int *member_list, size_t member_list_entries,
  346. const unsigned int *left_list, size_t left_list_entries,
  347. const unsigned int *joined_list, size_t joined_list_entries,
  348. const struct memb_ring_id *ring_id);
  349. void (*totemsrp_service_ready_fn) (void);
  350. void (*totemsrp_waiting_trans_ack_cb_fn) (
  351. int waiting_trans_ack);
  352. void (*memb_ring_id_create_or_load) (
  353. struct memb_ring_id *memb_ring_id,
  354. unsigned int nodeid);
  355. void (*memb_ring_id_store) (
  356. const struct memb_ring_id *memb_ring_id,
  357. unsigned int nodeid);
  358. int global_seqno;
  359. int my_token_held;
  360. unsigned long long token_ring_id_seq;
  361. unsigned int last_released;
  362. unsigned int set_aru;
  363. int old_ring_state_saved;
  364. int old_ring_state_aru;
  365. unsigned int old_ring_state_high_seq_received;
  366. unsigned int my_last_seq;
  367. struct timeval tv_old;
  368. void *totemnet_context;
  369. struct totem_config *totem_config;
  370. unsigned int use_heartbeat;
  371. unsigned int my_trc;
  372. unsigned int my_pbl;
  373. unsigned int my_cbl;
  374. uint64_t pause_timestamp;
  375. struct memb_commit_token *commit_token;
  376. totemsrp_stats_t stats;
  377. uint32_t orf_token_discard;
  378. uint32_t originated_orf_token;
  379. uint32_t threaded_mode_enabled;
  380. uint32_t waiting_trans_ack;
  381. int flushing;
  382. void * token_recv_event_handle;
  383. void * token_sent_event_handle;
  384. char commit_token_storage[40000];
  385. };
  386. struct message_handlers {
  387. int count;
  388. int (*handler_functions[6]) (
  389. struct totemsrp_instance *instance,
  390. const void *msg,
  391. size_t msg_len,
  392. int endian_conversion_needed);
  393. };
  394. enum gather_state_from {
  395. TOTEMSRP_GSFROM_CONSENSUS_TIMEOUT = 0,
  396. TOTEMSRP_GSFROM_GATHER_MISSING1 = 1,
  397. TOTEMSRP_GSFROM_THE_TOKEN_WAS_LOST_IN_THE_OPERATIONAL_STATE = 2,
  398. TOTEMSRP_GSFROM_THE_CONSENSUS_TIMEOUT_EXPIRED = 3,
  399. TOTEMSRP_GSFROM_THE_TOKEN_WAS_LOST_IN_THE_COMMIT_STATE = 4,
  400. TOTEMSRP_GSFROM_THE_TOKEN_WAS_LOST_IN_THE_RECOVERY_STATE = 5,
  401. TOTEMSRP_GSFROM_FAILED_TO_RECEIVE = 6,
  402. TOTEMSRP_GSFROM_FOREIGN_MESSAGE_IN_OPERATIONAL_STATE = 7,
  403. TOTEMSRP_GSFROM_FOREIGN_MESSAGE_IN_GATHER_STATE = 8,
  404. TOTEMSRP_GSFROM_MERGE_DURING_OPERATIONAL_STATE = 9,
  405. TOTEMSRP_GSFROM_MERGE_DURING_GATHER_STATE = 10,
  406. TOTEMSRP_GSFROM_MERGE_DURING_JOIN = 11,
  407. TOTEMSRP_GSFROM_JOIN_DURING_OPERATIONAL_STATE = 12,
  408. TOTEMSRP_GSFROM_JOIN_DURING_COMMIT_STATE = 13,
  409. TOTEMSRP_GSFROM_JOIN_DURING_RECOVERY = 14,
  410. TOTEMSRP_GSFROM_INTERFACE_CHANGE = 15,
  411. TOTEMSRP_GSFROM_MAX = TOTEMSRP_GSFROM_INTERFACE_CHANGE,
  412. };
  413. const char* gather_state_from_desc [] = {
  414. [TOTEMSRP_GSFROM_CONSENSUS_TIMEOUT] = "consensus timeout",
  415. [TOTEMSRP_GSFROM_GATHER_MISSING1] = "MISSING",
  416. [TOTEMSRP_GSFROM_THE_TOKEN_WAS_LOST_IN_THE_OPERATIONAL_STATE] = "The token was lost in the OPERATIONAL state.",
  417. [TOTEMSRP_GSFROM_THE_CONSENSUS_TIMEOUT_EXPIRED] = "The consensus timeout expired.",
  418. [TOTEMSRP_GSFROM_THE_TOKEN_WAS_LOST_IN_THE_COMMIT_STATE] = "The token was lost in the COMMIT state.",
  419. [TOTEMSRP_GSFROM_THE_TOKEN_WAS_LOST_IN_THE_RECOVERY_STATE] = "The token was lost in the RECOVERY state.",
  420. [TOTEMSRP_GSFROM_FAILED_TO_RECEIVE] = "failed to receive",
  421. [TOTEMSRP_GSFROM_FOREIGN_MESSAGE_IN_OPERATIONAL_STATE] = "foreign message in operational state",
  422. [TOTEMSRP_GSFROM_FOREIGN_MESSAGE_IN_GATHER_STATE] = "foreign message in gather state",
  423. [TOTEMSRP_GSFROM_MERGE_DURING_OPERATIONAL_STATE] = "merge during operational state",
  424. [TOTEMSRP_GSFROM_MERGE_DURING_GATHER_STATE] = "merge during gather state",
  425. [TOTEMSRP_GSFROM_MERGE_DURING_JOIN] = "merge during join",
  426. [TOTEMSRP_GSFROM_JOIN_DURING_OPERATIONAL_STATE] = "join during operational state",
  427. [TOTEMSRP_GSFROM_JOIN_DURING_COMMIT_STATE] = "join during commit state",
  428. [TOTEMSRP_GSFROM_JOIN_DURING_RECOVERY] = "join during recovery",
  429. [TOTEMSRP_GSFROM_INTERFACE_CHANGE] = "interface change",
  430. };
  431. /*
  432. * forward decls
  433. */
  434. static int message_handler_orf_token (
  435. struct totemsrp_instance *instance,
  436. const void *msg,
  437. size_t msg_len,
  438. int endian_conversion_needed);
  439. static int message_handler_mcast (
  440. struct totemsrp_instance *instance,
  441. const void *msg,
  442. size_t msg_len,
  443. int endian_conversion_needed);
  444. static int message_handler_memb_merge_detect (
  445. struct totemsrp_instance *instance,
  446. const void *msg,
  447. size_t msg_len,
  448. int endian_conversion_needed);
  449. static int message_handler_memb_join (
  450. struct totemsrp_instance *instance,
  451. const void *msg,
  452. size_t msg_len,
  453. int endian_conversion_needed);
  454. static int message_handler_memb_commit_token (
  455. struct totemsrp_instance *instance,
  456. const void *msg,
  457. size_t msg_len,
  458. int endian_conversion_needed);
  459. static int message_handler_token_hold_cancel (
  460. struct totemsrp_instance *instance,
  461. const void *msg,
  462. size_t msg_len,
  463. int endian_conversion_needed);
  464. static void totemsrp_instance_initialize (struct totemsrp_instance *instance);
  465. static void srp_addr_copy (struct srp_addr *dest, const struct srp_addr *src);
  466. static void srp_addr_to_nodeid (
  467. struct totemsrp_instance *instance,
  468. unsigned int *nodeid_out,
  469. struct srp_addr *srp_addr_in,
  470. unsigned int entries);
  471. static int srp_addr_equal (const struct srp_addr *a, const struct srp_addr *b);
  472. static void memb_leave_message_send (struct totemsrp_instance *instance);
  473. static void token_callbacks_execute (struct totemsrp_instance *instance, enum totem_callback_token_type type);
  474. static void memb_state_gather_enter (struct totemsrp_instance *instance, enum gather_state_from gather_from);
  475. static void messages_deliver_to_app (struct totemsrp_instance *instance, int skip, unsigned int end_point);
  476. static int orf_token_mcast (struct totemsrp_instance *instance, struct orf_token *oken,
  477. int fcc_mcasts_allowed);
  478. static void messages_free (struct totemsrp_instance *instance, unsigned int token_aru);
  479. static void memb_ring_id_set (struct totemsrp_instance *instance,
  480. const struct memb_ring_id *ring_id);
  481. static void target_set_completed (void *context);
  482. static void memb_state_commit_token_update (struct totemsrp_instance *instance);
  483. static void memb_state_commit_token_target_set (struct totemsrp_instance *instance);
  484. static int memb_state_commit_token_send (struct totemsrp_instance *instance);
  485. static int memb_state_commit_token_send_recovery (struct totemsrp_instance *instance, struct memb_commit_token *memb_commit_token);
  486. static void memb_state_commit_token_create (struct totemsrp_instance *instance);
  487. static int token_hold_cancel_send (struct totemsrp_instance *instance);
  488. static void orf_token_endian_convert (const struct orf_token *in, struct orf_token *out);
  489. static void memb_commit_token_endian_convert (const struct memb_commit_token *in, struct memb_commit_token *out);
  490. static void memb_join_endian_convert (const struct memb_join *in, struct memb_join *out);
  491. static void mcast_endian_convert (const struct mcast *in, struct mcast *out);
  492. static void memb_merge_detect_endian_convert (
  493. const struct memb_merge_detect *in,
  494. struct memb_merge_detect *out);
  495. static void srp_addr_copy_endian_convert (struct srp_addr *out, const struct srp_addr *in);
  496. static void timer_function_orf_token_timeout (void *data);
  497. static void timer_function_pause_timeout (void *data);
  498. static void timer_function_heartbeat_timeout (void *data);
  499. static void timer_function_token_retransmit_timeout (void *data);
  500. static void timer_function_token_hold_retransmit_timeout (void *data);
  501. static void timer_function_merge_detect_timeout (void *data);
  502. static void *totemsrp_buffer_alloc (struct totemsrp_instance *instance);
  503. static void totemsrp_buffer_release (struct totemsrp_instance *instance, void *ptr);
  504. static const char* gsfrom_to_msg(enum gather_state_from gsfrom);
  505. void main_deliver_fn (
  506. void *context,
  507. const void *msg,
  508. unsigned int msg_len);
  509. void main_iface_change_fn (
  510. void *context,
  511. const struct totem_ip_address *iface_address,
  512. unsigned int iface_no);
  513. struct message_handlers totemsrp_message_handlers = {
  514. 6,
  515. {
  516. message_handler_orf_token, /* MESSAGE_TYPE_ORF_TOKEN */
  517. message_handler_mcast, /* MESSAGE_TYPE_MCAST */
  518. message_handler_memb_merge_detect, /* MESSAGE_TYPE_MEMB_MERGE_DETECT */
  519. message_handler_memb_join, /* MESSAGE_TYPE_MEMB_JOIN */
  520. message_handler_memb_commit_token, /* MESSAGE_TYPE_MEMB_COMMIT_TOKEN */
  521. message_handler_token_hold_cancel /* MESSAGE_TYPE_TOKEN_HOLD_CANCEL */
  522. }
  523. };
  524. #define log_printf(level, format, args...) \
  525. do { \
  526. instance->totemsrp_log_printf ( \
  527. level, instance->totemsrp_subsys_id, \
  528. __FUNCTION__, __FILE__, __LINE__, \
  529. format, ##args); \
  530. } while (0);
  531. #define LOGSYS_PERROR(err_num, level, fmt, args...) \
  532. do { \
  533. char _error_str[LOGSYS_MAX_PERROR_MSG_LEN]; \
  534. const char *_error_ptr = qb_strerror_r(err_num, _error_str, sizeof(_error_str)); \
  535. instance->totemsrp_log_printf ( \
  536. level, instance->totemsrp_subsys_id, \
  537. __FUNCTION__, __FILE__, __LINE__, \
  538. fmt ": %s (%d)\n", ##args, _error_ptr, err_num); \
  539. } while(0)
  540. static const char* gsfrom_to_msg(enum gather_state_from gsfrom)
  541. {
  542. if (gsfrom <= TOTEMSRP_GSFROM_MAX) {
  543. return gather_state_from_desc[gsfrom];
  544. }
  545. else {
  546. return "UNKNOWN";
  547. }
  548. }
  549. static void totemsrp_instance_initialize (struct totemsrp_instance *instance)
  550. {
  551. memset (instance, 0, sizeof (struct totemsrp_instance));
  552. qb_list_init (&instance->token_callback_received_listhead);
  553. qb_list_init (&instance->token_callback_sent_listhead);
  554. instance->my_received_flg = 1;
  555. instance->my_token_seq = SEQNO_START_TOKEN - 1;
  556. instance->memb_state = MEMB_STATE_OPERATIONAL;
  557. instance->set_aru = -1;
  558. instance->my_aru = SEQNO_START_MSG;
  559. instance->my_high_seq_received = SEQNO_START_MSG;
  560. instance->my_high_delivered = SEQNO_START_MSG;
  561. instance->orf_token_discard = 0;
  562. instance->originated_orf_token = 0;
  563. instance->commit_token = (struct memb_commit_token *)instance->commit_token_storage;
  564. instance->waiting_trans_ack = 1;
  565. }
  566. static int pause_flush (struct totemsrp_instance *instance)
  567. {
  568. uint64_t now_msec;
  569. uint64_t timestamp_msec;
  570. int res = 0;
  571. now_msec = (qb_util_nano_current_get () / QB_TIME_NS_IN_MSEC);
  572. timestamp_msec = instance->pause_timestamp / QB_TIME_NS_IN_MSEC;
  573. if ((now_msec - timestamp_msec) > (instance->totem_config->token_timeout / 2)) {
  574. log_printf (instance->totemsrp_log_level_notice,
  575. "Process pause detected for %d ms, flushing membership messages.", (unsigned int)(now_msec - timestamp_msec));
  576. /*
  577. * -1 indicates an error from recvmsg
  578. */
  579. do {
  580. res = totemnet_recv_mcast_empty (instance->totemnet_context);
  581. } while (res == -1);
  582. }
  583. return (res);
  584. }
  585. static int token_event_stats_collector (enum totem_callback_token_type type, const void *void_instance)
  586. {
  587. struct totemsrp_instance *instance = (struct totemsrp_instance *)void_instance;
  588. uint32_t time_now;
  589. unsigned long long nano_secs = qb_util_nano_current_get ();
  590. time_now = (nano_secs / QB_TIME_NS_IN_MSEC);
  591. if (type == TOTEM_CALLBACK_TOKEN_RECEIVED) {
  592. /* incr latest token the index */
  593. if (instance->stats.latest_token == (TOTEM_TOKEN_STATS_MAX - 1))
  594. instance->stats.latest_token = 0;
  595. else
  596. instance->stats.latest_token++;
  597. if (instance->stats.earliest_token == instance->stats.latest_token) {
  598. /* we have filled up the array, start overwriting */
  599. if (instance->stats.earliest_token == (TOTEM_TOKEN_STATS_MAX - 1))
  600. instance->stats.earliest_token = 0;
  601. else
  602. instance->stats.earliest_token++;
  603. instance->stats.token[instance->stats.earliest_token].rx = 0;
  604. instance->stats.token[instance->stats.earliest_token].tx = 0;
  605. instance->stats.token[instance->stats.earliest_token].backlog_calc = 0;
  606. }
  607. instance->stats.token[instance->stats.latest_token].rx = time_now;
  608. instance->stats.token[instance->stats.latest_token].tx = 0; /* in case we drop the token */
  609. } else {
  610. instance->stats.token[instance->stats.latest_token].tx = time_now;
  611. }
  612. return 0;
  613. }
  614. static void totempg_mtu_changed(void *context, int net_mtu)
  615. {
  616. struct totemsrp_instance *instance = context;
  617. instance->totem_config->net_mtu = net_mtu - sizeof (struct mcast);
  618. log_printf (instance->totemsrp_log_level_debug,
  619. "Net MTU changed to %d, new value is %d",
  620. net_mtu, instance->totem_config->net_mtu);
  621. }
  622. /*
  623. * Exported interfaces
  624. */
  625. int totemsrp_initialize (
  626. qb_loop_t *poll_handle,
  627. void **srp_context,
  628. struct totem_config *totem_config,
  629. totempg_stats_t *stats,
  630. void (*deliver_fn) (
  631. unsigned int nodeid,
  632. const void *msg,
  633. unsigned int msg_len,
  634. int endian_conversion_required),
  635. void (*confchg_fn) (
  636. enum totem_configuration_type configuration_type,
  637. const unsigned int *member_list, size_t member_list_entries,
  638. const unsigned int *left_list, size_t left_list_entries,
  639. const unsigned int *joined_list, size_t joined_list_entries,
  640. const struct memb_ring_id *ring_id),
  641. void (*waiting_trans_ack_cb_fn) (
  642. int waiting_trans_ack))
  643. {
  644. struct totemsrp_instance *instance;
  645. int res;
  646. instance = malloc (sizeof (struct totemsrp_instance));
  647. if (instance == NULL) {
  648. goto error_exit;
  649. }
  650. totemsrp_instance_initialize (instance);
  651. instance->totemsrp_waiting_trans_ack_cb_fn = waiting_trans_ack_cb_fn;
  652. instance->totemsrp_waiting_trans_ack_cb_fn (1);
  653. stats->srp = &instance->stats;
  654. instance->stats.latest_token = 0;
  655. instance->stats.earliest_token = 0;
  656. instance->totem_config = totem_config;
  657. /*
  658. * Configure logging
  659. */
  660. instance->totemsrp_log_level_security = totem_config->totem_logging_configuration.log_level_security;
  661. instance->totemsrp_log_level_error = totem_config->totem_logging_configuration.log_level_error;
  662. instance->totemsrp_log_level_warning = totem_config->totem_logging_configuration.log_level_warning;
  663. instance->totemsrp_log_level_notice = totem_config->totem_logging_configuration.log_level_notice;
  664. instance->totemsrp_log_level_debug = totem_config->totem_logging_configuration.log_level_debug;
  665. instance->totemsrp_log_level_trace = totem_config->totem_logging_configuration.log_level_trace;
  666. instance->totemsrp_subsys_id = totem_config->totem_logging_configuration.log_subsys_id;
  667. instance->totemsrp_log_printf = totem_config->totem_logging_configuration.log_printf;
  668. /*
  669. * Configure totem store and load functions
  670. */
  671. instance->memb_ring_id_create_or_load = totem_config->totem_memb_ring_id_create_or_load;
  672. instance->memb_ring_id_store = totem_config->totem_memb_ring_id_store;
  673. /*
  674. * Initialize local variables for totemsrp
  675. */
  676. totemip_copy (&instance->mcast_address, &totem_config->interfaces[instance->lowest_active_if].mcast_addr);
  677. /*
  678. * Display totem configuration
  679. */
  680. log_printf (instance->totemsrp_log_level_debug,
  681. "Token Timeout (%d ms) retransmit timeout (%d ms)",
  682. totem_config->token_timeout, totem_config->token_retransmit_timeout);
  683. log_printf (instance->totemsrp_log_level_debug,
  684. "token hold (%d ms) retransmits before loss (%d retrans)",
  685. totem_config->token_hold_timeout, totem_config->token_retransmits_before_loss_const);
  686. log_printf (instance->totemsrp_log_level_debug,
  687. "join (%d ms) send_join (%d ms) consensus (%d ms) merge (%d ms)",
  688. totem_config->join_timeout,
  689. totem_config->send_join_timeout,
  690. totem_config->consensus_timeout,
  691. totem_config->merge_timeout);
  692. log_printf (instance->totemsrp_log_level_debug,
  693. "downcheck (%d ms) fail to recv const (%d msgs)",
  694. totem_config->downcheck_timeout, totem_config->fail_to_recv_const);
  695. log_printf (instance->totemsrp_log_level_debug,
  696. "seqno unchanged const (%d rotations) Maximum network MTU %d", totem_config->seqno_unchanged_const, totem_config->net_mtu);
  697. log_printf (instance->totemsrp_log_level_debug,
  698. "window size per rotation (%d messages) maximum messages per rotation (%d messages)",
  699. totem_config->window_size, totem_config->max_messages);
  700. log_printf (instance->totemsrp_log_level_debug,
  701. "missed count const (%d messages)",
  702. totem_config->miss_count_const);
  703. log_printf (instance->totemsrp_log_level_debug,
  704. "send threads (%d threads)", totem_config->threads);
  705. log_printf (instance->totemsrp_log_level_debug,
  706. "heartbeat_failures_allowed (%d)", totem_config->heartbeat_failures_allowed);
  707. log_printf (instance->totemsrp_log_level_debug,
  708. "max_network_delay (%d ms)", totem_config->max_network_delay);
  709. cs_queue_init (&instance->retrans_message_queue, RETRANS_MESSAGE_QUEUE_SIZE_MAX,
  710. sizeof (struct message_item), instance->threaded_mode_enabled);
  711. sq_init (&instance->regular_sort_queue,
  712. QUEUE_RTR_ITEMS_SIZE_MAX, sizeof (struct sort_queue_item), 0);
  713. sq_init (&instance->recovery_sort_queue,
  714. QUEUE_RTR_ITEMS_SIZE_MAX, sizeof (struct sort_queue_item), 0);
  715. instance->totemsrp_poll_handle = poll_handle;
  716. instance->totemsrp_deliver_fn = deliver_fn;
  717. instance->totemsrp_confchg_fn = confchg_fn;
  718. instance->use_heartbeat = 1;
  719. timer_function_pause_timeout (instance);
  720. if ( totem_config->heartbeat_failures_allowed == 0 ) {
  721. log_printf (instance->totemsrp_log_level_debug,
  722. "HeartBeat is Disabled. To enable set heartbeat_failures_allowed > 0");
  723. instance->use_heartbeat = 0;
  724. }
  725. if (instance->use_heartbeat) {
  726. instance->heartbeat_timeout
  727. = (totem_config->heartbeat_failures_allowed) * totem_config->token_retransmit_timeout
  728. + totem_config->max_network_delay;
  729. if (instance->heartbeat_timeout >= totem_config->token_timeout) {
  730. log_printf (instance->totemsrp_log_level_debug,
  731. "total heartbeat_timeout (%d ms) is not less than token timeout (%d ms)",
  732. instance->heartbeat_timeout,
  733. totem_config->token_timeout);
  734. log_printf (instance->totemsrp_log_level_debug,
  735. "heartbeat_timeout = heartbeat_failures_allowed * token_retransmit_timeout + max_network_delay");
  736. log_printf (instance->totemsrp_log_level_debug,
  737. "heartbeat timeout should be less than the token timeout. Heartbeat is disabled!!");
  738. instance->use_heartbeat = 0;
  739. }
  740. else {
  741. log_printf (instance->totemsrp_log_level_debug,
  742. "total heartbeat_timeout (%d ms)", instance->heartbeat_timeout);
  743. }
  744. }
  745. res = totemnet_initialize (
  746. poll_handle,
  747. &instance->totemnet_context,
  748. totem_config,
  749. stats->srp,
  750. instance,
  751. main_deliver_fn,
  752. main_iface_change_fn,
  753. totempg_mtu_changed,
  754. target_set_completed);
  755. if (res == -1) {
  756. goto error_exit;
  757. }
  758. instance->my_id.nodeid = instance->totem_config->interfaces[instance->lowest_active_if].boundto.nodeid;
  759. /*
  760. * Must have net_mtu adjusted by totemnet_initialize first
  761. */
  762. cs_queue_init (&instance->new_message_queue,
  763. MESSAGE_QUEUE_MAX,
  764. sizeof (struct message_item), instance->threaded_mode_enabled);
  765. cs_queue_init (&instance->new_message_queue_trans,
  766. MESSAGE_QUEUE_MAX,
  767. sizeof (struct message_item), instance->threaded_mode_enabled);
  768. totemsrp_callback_token_create (instance,
  769. &instance->token_recv_event_handle,
  770. TOTEM_CALLBACK_TOKEN_RECEIVED,
  771. 0,
  772. token_event_stats_collector,
  773. instance);
  774. totemsrp_callback_token_create (instance,
  775. &instance->token_sent_event_handle,
  776. TOTEM_CALLBACK_TOKEN_SENT,
  777. 0,
  778. token_event_stats_collector,
  779. instance);
  780. *srp_context = instance;
  781. return (0);
  782. error_exit:
  783. return (-1);
  784. }
  785. void totemsrp_finalize (
  786. void *srp_context)
  787. {
  788. struct totemsrp_instance *instance = (struct totemsrp_instance *)srp_context;
  789. memb_leave_message_send (instance);
  790. totemnet_finalize (instance->totemnet_context);
  791. cs_queue_free (&instance->new_message_queue);
  792. cs_queue_free (&instance->new_message_queue_trans);
  793. cs_queue_free (&instance->retrans_message_queue);
  794. sq_free (&instance->regular_sort_queue);
  795. sq_free (&instance->recovery_sort_queue);
  796. free (instance);
  797. }
  798. /*
  799. * Return configured interfaces. interfaces is array of totem_ip addresses allocated by caller,
  800. * with interaces_size number of items. iface_count is final number of interfaces filled by this
  801. * function.
  802. *
  803. * Function returns 0 on success, otherwise if interfaces array is not big enough, -2 is returned,
  804. * and if interface was not found, -1 is returned.
  805. */
  806. int totemsrp_ifaces_get (
  807. void *srp_context,
  808. unsigned int nodeid,
  809. struct totem_ip_address *interfaces,
  810. unsigned int interfaces_size,
  811. char ***status,
  812. unsigned int *iface_count)
  813. {
  814. struct totemsrp_instance *instance = (struct totemsrp_instance *)srp_context;
  815. int res = 0;
  816. memset(interfaces, 0, sizeof(struct totem_ip_address) * interfaces_size);
  817. *iface_count = INTERFACE_MAX;
  818. if (interfaces_size >= *iface_count) {
  819. memcpy (interfaces, instance->my_addrs,
  820. sizeof (struct totem_ip_address) * *iface_count);
  821. } else {
  822. res = -2;
  823. }
  824. totemnet_ifaces_get(instance->totemnet_context, status, iface_count);
  825. return (res);
  826. }
  827. int totemsrp_crypto_set (
  828. void *srp_context,
  829. const char *cipher_type,
  830. const char *hash_type)
  831. {
  832. struct totemsrp_instance *instance = (struct totemsrp_instance *)srp_context;
  833. int res;
  834. res = totemnet_crypto_set(instance->totemnet_context, cipher_type, hash_type);
  835. return (res);
  836. }
  837. unsigned int totemsrp_my_nodeid_get (
  838. void *srp_context)
  839. {
  840. struct totemsrp_instance *instance = (struct totemsrp_instance *)srp_context;
  841. unsigned int res;
  842. res = instance->my_id.nodeid;
  843. return (res);
  844. }
  845. int totemsrp_my_family_get (
  846. void *srp_context)
  847. {
  848. struct totemsrp_instance *instance = (struct totemsrp_instance *)srp_context;
  849. int res;
  850. res = instance->totem_config->interfaces[instance->lowest_active_if].boundto.family;
  851. return (res);
  852. }
  853. /*
  854. * Set operations for use by the membership algorithm
  855. */
  856. static int srp_addr_equal (const struct srp_addr *a, const struct srp_addr *b)
  857. {
  858. if (a->nodeid == b->nodeid) {
  859. return 1;
  860. }
  861. return 0;
  862. }
  863. static void srp_addr_copy (struct srp_addr *dest, const struct srp_addr *src)
  864. {
  865. dest->nodeid = src->nodeid;
  866. }
  867. static void srp_addr_to_nodeid (
  868. struct totemsrp_instance *instance,
  869. unsigned int *nodeid_out,
  870. struct srp_addr *srp_addr_in,
  871. unsigned int entries)
  872. {
  873. unsigned int i;
  874. for (i = 0; i < entries; i++) {
  875. nodeid_out[i] = srp_addr_in[i].nodeid;
  876. }
  877. }
  878. static void srp_addr_copy_endian_convert (struct srp_addr *out, const struct srp_addr *in)
  879. {
  880. out->nodeid = swab32 (in->nodeid);
  881. }
  882. static void memb_consensus_reset (struct totemsrp_instance *instance)
  883. {
  884. instance->consensus_list_entries = 0;
  885. }
  886. static void memb_set_subtract (
  887. struct srp_addr *out_list, int *out_list_entries,
  888. struct srp_addr *one_list, int one_list_entries,
  889. struct srp_addr *two_list, int two_list_entries)
  890. {
  891. int found = 0;
  892. int i;
  893. int j;
  894. *out_list_entries = 0;
  895. for (i = 0; i < one_list_entries; i++) {
  896. for (j = 0; j < two_list_entries; j++) {
  897. if (srp_addr_equal (&one_list[i], &two_list[j])) {
  898. found = 1;
  899. break;
  900. }
  901. }
  902. if (found == 0) {
  903. srp_addr_copy (&out_list[*out_list_entries], &one_list[i]);
  904. *out_list_entries = *out_list_entries + 1;
  905. }
  906. found = 0;
  907. }
  908. }
  909. /*
  910. * Set consensus for a specific processor
  911. */
  912. static void memb_consensus_set (
  913. struct totemsrp_instance *instance,
  914. const struct srp_addr *addr)
  915. {
  916. int found = 0;
  917. int i;
  918. if (addr->nodeid == LEAVE_DUMMY_NODEID)
  919. return;
  920. for (i = 0; i < instance->consensus_list_entries; i++) {
  921. if (srp_addr_equal(addr, &instance->consensus_list[i].addr)) {
  922. found = 1;
  923. break; /* found entry */
  924. }
  925. }
  926. srp_addr_copy (&instance->consensus_list[i].addr, addr);
  927. instance->consensus_list[i].set = 1;
  928. if (found == 0) {
  929. instance->consensus_list_entries++;
  930. }
  931. return;
  932. }
  933. /*
  934. * Is consensus set for a specific processor
  935. */
  936. static int memb_consensus_isset (
  937. struct totemsrp_instance *instance,
  938. const struct srp_addr *addr)
  939. {
  940. int i;
  941. for (i = 0; i < instance->consensus_list_entries; i++) {
  942. if (srp_addr_equal (addr, &instance->consensus_list[i].addr)) {
  943. return (instance->consensus_list[i].set);
  944. }
  945. }
  946. return (0);
  947. }
  948. /*
  949. * Is consensus agreed upon based upon consensus database
  950. */
  951. static int memb_consensus_agreed (
  952. struct totemsrp_instance *instance)
  953. {
  954. struct srp_addr token_memb[PROCESSOR_COUNT_MAX];
  955. int token_memb_entries = 0;
  956. int agreed = 1;
  957. int i;
  958. memb_set_subtract (token_memb, &token_memb_entries,
  959. instance->my_proc_list, instance->my_proc_list_entries,
  960. instance->my_failed_list, instance->my_failed_list_entries);
  961. for (i = 0; i < token_memb_entries; i++) {
  962. if (memb_consensus_isset (instance, &token_memb[i]) == 0) {
  963. agreed = 0;
  964. break;
  965. }
  966. }
  967. if (agreed && instance->failed_to_recv == 1) {
  968. /*
  969. * Both nodes agreed on our failure. We don't care how many proc list items left because we
  970. * will create single ring anyway.
  971. */
  972. return (agreed);
  973. }
  974. assert (token_memb_entries >= 1);
  975. return (agreed);
  976. }
  977. static void memb_consensus_notset (
  978. struct totemsrp_instance *instance,
  979. struct srp_addr *no_consensus_list,
  980. int *no_consensus_list_entries,
  981. struct srp_addr *comparison_list,
  982. int comparison_list_entries)
  983. {
  984. int i;
  985. *no_consensus_list_entries = 0;
  986. for (i = 0; i < instance->my_proc_list_entries; i++) {
  987. if (memb_consensus_isset (instance, &instance->my_proc_list[i]) == 0) {
  988. srp_addr_copy (&no_consensus_list[*no_consensus_list_entries], &instance->my_proc_list[i]);
  989. *no_consensus_list_entries = *no_consensus_list_entries + 1;
  990. }
  991. }
  992. }
  993. /*
  994. * Is set1 equal to set2 Entries can be in different orders
  995. */
  996. static int memb_set_equal (
  997. struct srp_addr *set1, int set1_entries,
  998. struct srp_addr *set2, int set2_entries)
  999. {
  1000. int i;
  1001. int j;
  1002. int found = 0;
  1003. if (set1_entries != set2_entries) {
  1004. return (0);
  1005. }
  1006. for (i = 0; i < set2_entries; i++) {
  1007. for (j = 0; j < set1_entries; j++) {
  1008. if (srp_addr_equal (&set1[j], &set2[i])) {
  1009. found = 1;
  1010. break;
  1011. }
  1012. }
  1013. if (found == 0) {
  1014. return (0);
  1015. }
  1016. found = 0;
  1017. }
  1018. return (1);
  1019. }
  1020. /*
  1021. * Is subset fully contained in fullset
  1022. */
  1023. static int memb_set_subset (
  1024. const struct srp_addr *subset, int subset_entries,
  1025. const struct srp_addr *fullset, int fullset_entries)
  1026. {
  1027. int i;
  1028. int j;
  1029. int found = 0;
  1030. if (subset_entries > fullset_entries) {
  1031. return (0);
  1032. }
  1033. for (i = 0; i < subset_entries; i++) {
  1034. for (j = 0; j < fullset_entries; j++) {
  1035. if (srp_addr_equal (&subset[i], &fullset[j])) {
  1036. found = 1;
  1037. }
  1038. }
  1039. if (found == 0) {
  1040. return (0);
  1041. }
  1042. found = 0;
  1043. }
  1044. return (1);
  1045. }
  1046. /*
  1047. * merge subset into fullset taking care not to add duplicates
  1048. */
  1049. static void memb_set_merge (
  1050. const struct srp_addr *subset, int subset_entries,
  1051. struct srp_addr *fullset, int *fullset_entries)
  1052. {
  1053. int found = 0;
  1054. int i;
  1055. int j;
  1056. for (i = 0; i < subset_entries; i++) {
  1057. for (j = 0; j < *fullset_entries; j++) {
  1058. if (srp_addr_equal (&fullset[j], &subset[i])) {
  1059. found = 1;
  1060. break;
  1061. }
  1062. }
  1063. if (found == 0) {
  1064. srp_addr_copy (&fullset[*fullset_entries], &subset[i]);
  1065. *fullset_entries = *fullset_entries + 1;
  1066. }
  1067. found = 0;
  1068. }
  1069. return;
  1070. }
  1071. static void memb_set_and_with_ring_id (
  1072. struct srp_addr *set1,
  1073. struct memb_ring_id *set1_ring_ids,
  1074. int set1_entries,
  1075. struct srp_addr *set2,
  1076. int set2_entries,
  1077. struct memb_ring_id *old_ring_id,
  1078. struct srp_addr *and,
  1079. int *and_entries)
  1080. {
  1081. int i;
  1082. int j;
  1083. int found = 0;
  1084. *and_entries = 0;
  1085. for (i = 0; i < set2_entries; i++) {
  1086. for (j = 0; j < set1_entries; j++) {
  1087. if (srp_addr_equal (&set1[j], &set2[i])) {
  1088. if (memcmp (&set1_ring_ids[j], old_ring_id, sizeof (struct memb_ring_id)) == 0) {
  1089. found = 1;
  1090. }
  1091. break;
  1092. }
  1093. }
  1094. if (found) {
  1095. srp_addr_copy (&and[*and_entries], &set1[j]);
  1096. *and_entries = *and_entries + 1;
  1097. }
  1098. found = 0;
  1099. }
  1100. return;
  1101. }
  1102. #ifdef CODE_COVERAGE
  1103. static void memb_set_print (
  1104. char *string,
  1105. struct srp_addr *list,
  1106. int list_entries)
  1107. {
  1108. int i;
  1109. int j;
  1110. printf ("List '%s' contains %d entries:\n", string, list_entries);
  1111. for (i = 0; i < list_entries; i++) {
  1112. printf ("Address %d with %d rings\n", i, list[i].no_addrs);
  1113. for (j = 0; j < list[i].no_addrs; j++) {
  1114. printf ("\tiface %d %s\n", j, totemip_print (&list[i].addr[j]));
  1115. printf ("\tfamily %d\n", list[i].addr[j].family);
  1116. }
  1117. }
  1118. }
  1119. #endif
  1120. static void my_leave_memb_clear(
  1121. struct totemsrp_instance *instance)
  1122. {
  1123. memset(instance->my_leave_memb_list, 0, sizeof(instance->my_leave_memb_list));
  1124. instance->my_leave_memb_entries = 0;
  1125. }
  1126. static unsigned int my_leave_memb_match(
  1127. struct totemsrp_instance *instance,
  1128. unsigned int nodeid)
  1129. {
  1130. int i;
  1131. unsigned int ret = 0;
  1132. for (i = 0; i < instance->my_leave_memb_entries; i++){
  1133. if (instance->my_leave_memb_list[i] == nodeid){
  1134. ret = nodeid;
  1135. break;
  1136. }
  1137. }
  1138. return ret;
  1139. }
  1140. static void my_leave_memb_set(
  1141. struct totemsrp_instance *instance,
  1142. unsigned int nodeid)
  1143. {
  1144. int i, found = 0;
  1145. for (i = 0; i < instance->my_leave_memb_entries; i++){
  1146. if (instance->my_leave_memb_list[i] == nodeid){
  1147. found = 1;
  1148. break;
  1149. }
  1150. }
  1151. if (found == 1) {
  1152. return;
  1153. }
  1154. if (instance->my_leave_memb_entries < (PROCESSOR_COUNT_MAX - 1)) {
  1155. instance->my_leave_memb_list[instance->my_leave_memb_entries] = nodeid;
  1156. instance->my_leave_memb_entries++;
  1157. } else {
  1158. log_printf (instance->totemsrp_log_level_warning,
  1159. "Cannot set LEAVE nodeid=%d", nodeid);
  1160. }
  1161. }
  1162. static void *totemsrp_buffer_alloc (struct totemsrp_instance *instance)
  1163. {
  1164. assert (instance != NULL);
  1165. return totemnet_buffer_alloc (instance->totemnet_context);
  1166. }
  1167. static void totemsrp_buffer_release (struct totemsrp_instance *instance, void *ptr)
  1168. {
  1169. assert (instance != NULL);
  1170. totemnet_buffer_release (instance->totemnet_context, ptr);
  1171. }
  1172. static void reset_token_retransmit_timeout (struct totemsrp_instance *instance)
  1173. {
  1174. int32_t res;
  1175. qb_loop_timer_del (instance->totemsrp_poll_handle,
  1176. instance->timer_orf_token_retransmit_timeout);
  1177. res = qb_loop_timer_add (instance->totemsrp_poll_handle,
  1178. QB_LOOP_MED,
  1179. instance->totem_config->token_retransmit_timeout*QB_TIME_NS_IN_MSEC,
  1180. (void *)instance,
  1181. timer_function_token_retransmit_timeout,
  1182. &instance->timer_orf_token_retransmit_timeout);
  1183. if (res != 0) {
  1184. log_printf(instance->totemsrp_log_level_error, "reset_token_retransmit_timeout - qb_loop_timer_add error : %d", res);
  1185. }
  1186. }
  1187. static void start_merge_detect_timeout (struct totemsrp_instance *instance)
  1188. {
  1189. int32_t res;
  1190. if (instance->my_merge_detect_timeout_outstanding == 0) {
  1191. res = qb_loop_timer_add (instance->totemsrp_poll_handle,
  1192. QB_LOOP_MED,
  1193. instance->totem_config->merge_timeout*QB_TIME_NS_IN_MSEC,
  1194. (void *)instance,
  1195. timer_function_merge_detect_timeout,
  1196. &instance->timer_merge_detect_timeout);
  1197. if (res != 0) {
  1198. log_printf(instance->totemsrp_log_level_error, "start_merge_detect_timeout - qb_loop_timer_add error : %d", res);
  1199. }
  1200. instance->my_merge_detect_timeout_outstanding = 1;
  1201. }
  1202. }
  1203. static void cancel_merge_detect_timeout (struct totemsrp_instance *instance)
  1204. {
  1205. qb_loop_timer_del (instance->totemsrp_poll_handle, instance->timer_merge_detect_timeout);
  1206. instance->my_merge_detect_timeout_outstanding = 0;
  1207. }
  1208. /*
  1209. * ring_state_* is used to save and restore the sort queue
  1210. * state when a recovery operation fails (and enters gather)
  1211. */
  1212. static void old_ring_state_save (struct totemsrp_instance *instance)
  1213. {
  1214. if (instance->old_ring_state_saved == 0) {
  1215. instance->old_ring_state_saved = 1;
  1216. memcpy (&instance->my_old_ring_id, &instance->my_ring_id,
  1217. sizeof (struct memb_ring_id));
  1218. instance->old_ring_state_aru = instance->my_aru;
  1219. instance->old_ring_state_high_seq_received = instance->my_high_seq_received;
  1220. log_printf (instance->totemsrp_log_level_debug,
  1221. "Saving state aru %x high seq received %x",
  1222. instance->my_aru, instance->my_high_seq_received);
  1223. }
  1224. }
  1225. static void old_ring_state_restore (struct totemsrp_instance *instance)
  1226. {
  1227. instance->my_aru = instance->old_ring_state_aru;
  1228. instance->my_high_seq_received = instance->old_ring_state_high_seq_received;
  1229. log_printf (instance->totemsrp_log_level_debug,
  1230. "Restoring instance->my_aru %x my high seq received %x",
  1231. instance->my_aru, instance->my_high_seq_received);
  1232. }
  1233. static void old_ring_state_reset (struct totemsrp_instance *instance)
  1234. {
  1235. log_printf (instance->totemsrp_log_level_debug,
  1236. "Resetting old ring state");
  1237. instance->old_ring_state_saved = 0;
  1238. }
  1239. static void reset_pause_timeout (struct totemsrp_instance *instance)
  1240. {
  1241. int32_t res;
  1242. qb_loop_timer_del (instance->totemsrp_poll_handle, instance->timer_pause_timeout);
  1243. res = qb_loop_timer_add (instance->totemsrp_poll_handle,
  1244. QB_LOOP_MED,
  1245. instance->totem_config->token_timeout * QB_TIME_NS_IN_MSEC / 5,
  1246. (void *)instance,
  1247. timer_function_pause_timeout,
  1248. &instance->timer_pause_timeout);
  1249. if (res != 0) {
  1250. log_printf(instance->totemsrp_log_level_error, "reset_pause_timeout - qb_loop_timer_add error : %d", res);
  1251. }
  1252. }
  1253. static void reset_token_timeout (struct totemsrp_instance *instance) {
  1254. int32_t res;
  1255. qb_loop_timer_del (instance->totemsrp_poll_handle, instance->timer_orf_token_timeout);
  1256. res = qb_loop_timer_add (instance->totemsrp_poll_handle,
  1257. QB_LOOP_MED,
  1258. instance->totem_config->token_timeout*QB_TIME_NS_IN_MSEC,
  1259. (void *)instance,
  1260. timer_function_orf_token_timeout,
  1261. &instance->timer_orf_token_timeout);
  1262. if (res != 0) {
  1263. log_printf(instance->totemsrp_log_level_error, "reset_token_timeout - qb_loop_timer_add error : %d", res);
  1264. }
  1265. }
  1266. static void reset_heartbeat_timeout (struct totemsrp_instance *instance) {
  1267. int32_t res;
  1268. qb_loop_timer_del (instance->totemsrp_poll_handle, instance->timer_heartbeat_timeout);
  1269. res = qb_loop_timer_add (instance->totemsrp_poll_handle,
  1270. QB_LOOP_MED,
  1271. instance->heartbeat_timeout*QB_TIME_NS_IN_MSEC,
  1272. (void *)instance,
  1273. timer_function_heartbeat_timeout,
  1274. &instance->timer_heartbeat_timeout);
  1275. if (res != 0) {
  1276. log_printf(instance->totemsrp_log_level_error, "reset_heartbeat_timeout - qb_loop_timer_add error : %d", res);
  1277. }
  1278. }
  1279. static void cancel_token_timeout (struct totemsrp_instance *instance) {
  1280. qb_loop_timer_del (instance->totemsrp_poll_handle, instance->timer_orf_token_timeout);
  1281. }
  1282. static void cancel_heartbeat_timeout (struct totemsrp_instance *instance) {
  1283. qb_loop_timer_del (instance->totemsrp_poll_handle, instance->timer_heartbeat_timeout);
  1284. }
  1285. static void cancel_token_retransmit_timeout (struct totemsrp_instance *instance)
  1286. {
  1287. qb_loop_timer_del (instance->totemsrp_poll_handle, instance->timer_orf_token_retransmit_timeout);
  1288. }
  1289. static void start_token_hold_retransmit_timeout (struct totemsrp_instance *instance)
  1290. {
  1291. int32_t res;
  1292. res = qb_loop_timer_add (instance->totemsrp_poll_handle,
  1293. QB_LOOP_MED,
  1294. instance->totem_config->token_hold_timeout*QB_TIME_NS_IN_MSEC,
  1295. (void *)instance,
  1296. timer_function_token_hold_retransmit_timeout,
  1297. &instance->timer_orf_token_hold_retransmit_timeout);
  1298. if (res != 0) {
  1299. log_printf(instance->totemsrp_log_level_error, "start_token_hold_retransmit_timeout - qb_loop_timer_add error : %d", res);
  1300. }
  1301. }
  1302. static void cancel_token_hold_retransmit_timeout (struct totemsrp_instance *instance)
  1303. {
  1304. qb_loop_timer_del (instance->totemsrp_poll_handle,
  1305. instance->timer_orf_token_hold_retransmit_timeout);
  1306. }
  1307. static void memb_state_consensus_timeout_expired (
  1308. struct totemsrp_instance *instance)
  1309. {
  1310. struct srp_addr no_consensus_list[PROCESSOR_COUNT_MAX];
  1311. int no_consensus_list_entries;
  1312. instance->stats.consensus_timeouts++;
  1313. if (memb_consensus_agreed (instance)) {
  1314. memb_consensus_reset (instance);
  1315. memb_consensus_set (instance, &instance->my_id);
  1316. reset_token_timeout (instance); // REVIEWED
  1317. } else {
  1318. memb_consensus_notset (
  1319. instance,
  1320. no_consensus_list,
  1321. &no_consensus_list_entries,
  1322. instance->my_proc_list,
  1323. instance->my_proc_list_entries);
  1324. memb_set_merge (no_consensus_list, no_consensus_list_entries,
  1325. instance->my_failed_list, &instance->my_failed_list_entries);
  1326. memb_state_gather_enter (instance, TOTEMSRP_GSFROM_CONSENSUS_TIMEOUT);
  1327. }
  1328. }
  1329. static void memb_join_message_send (struct totemsrp_instance *instance);
  1330. static void memb_merge_detect_transmit (struct totemsrp_instance *instance);
  1331. /*
  1332. * Timers used for various states of the membership algorithm
  1333. */
  1334. static void timer_function_pause_timeout (void *data)
  1335. {
  1336. struct totemsrp_instance *instance = data;
  1337. instance->pause_timestamp = qb_util_nano_current_get ();
  1338. reset_pause_timeout (instance);
  1339. }
  1340. static void memb_recovery_state_token_loss (struct totemsrp_instance *instance)
  1341. {
  1342. old_ring_state_restore (instance);
  1343. memb_state_gather_enter (instance, TOTEMSRP_GSFROM_THE_TOKEN_WAS_LOST_IN_THE_RECOVERY_STATE);
  1344. instance->stats.recovery_token_lost++;
  1345. }
  1346. static void timer_function_orf_token_timeout (void *data)
  1347. {
  1348. struct totemsrp_instance *instance = data;
  1349. switch (instance->memb_state) {
  1350. case MEMB_STATE_OPERATIONAL:
  1351. log_printf (instance->totemsrp_log_level_debug,
  1352. "The token was lost in the OPERATIONAL state.");
  1353. log_printf (instance->totemsrp_log_level_notice,
  1354. "A processor failed, forming new configuration.");
  1355. totemnet_iface_check (instance->totemnet_context);
  1356. memb_state_gather_enter (instance, TOTEMSRP_GSFROM_THE_TOKEN_WAS_LOST_IN_THE_OPERATIONAL_STATE);
  1357. instance->stats.operational_token_lost++;
  1358. break;
  1359. case MEMB_STATE_GATHER:
  1360. log_printf (instance->totemsrp_log_level_debug,
  1361. "The consensus timeout expired.");
  1362. memb_state_consensus_timeout_expired (instance);
  1363. memb_state_gather_enter (instance, TOTEMSRP_GSFROM_THE_CONSENSUS_TIMEOUT_EXPIRED);
  1364. instance->stats.gather_token_lost++;
  1365. break;
  1366. case MEMB_STATE_COMMIT:
  1367. log_printf (instance->totemsrp_log_level_debug,
  1368. "The token was lost in the COMMIT state.");
  1369. memb_state_gather_enter (instance, TOTEMSRP_GSFROM_THE_TOKEN_WAS_LOST_IN_THE_COMMIT_STATE);
  1370. instance->stats.commit_token_lost++;
  1371. break;
  1372. case MEMB_STATE_RECOVERY:
  1373. log_printf (instance->totemsrp_log_level_debug,
  1374. "The token was lost in the RECOVERY state.");
  1375. memb_recovery_state_token_loss (instance);
  1376. instance->orf_token_discard = 1;
  1377. break;
  1378. }
  1379. }
  1380. static void timer_function_heartbeat_timeout (void *data)
  1381. {
  1382. struct totemsrp_instance *instance = data;
  1383. log_printf (instance->totemsrp_log_level_debug,
  1384. "HeartBeat Timer expired Invoking token loss mechanism in state %d ", instance->memb_state);
  1385. timer_function_orf_token_timeout(data);
  1386. }
  1387. static void memb_timer_function_state_gather (void *data)
  1388. {
  1389. struct totemsrp_instance *instance = data;
  1390. int32_t res;
  1391. switch (instance->memb_state) {
  1392. case MEMB_STATE_OPERATIONAL:
  1393. case MEMB_STATE_RECOVERY:
  1394. assert (0); /* this should never happen */
  1395. break;
  1396. case MEMB_STATE_GATHER:
  1397. case MEMB_STATE_COMMIT:
  1398. memb_join_message_send (instance);
  1399. /*
  1400. * Restart the join timeout
  1401. `*/
  1402. qb_loop_timer_del (instance->totemsrp_poll_handle, instance->memb_timer_state_gather_join_timeout);
  1403. res = qb_loop_timer_add (instance->totemsrp_poll_handle,
  1404. QB_LOOP_MED,
  1405. instance->totem_config->join_timeout*QB_TIME_NS_IN_MSEC,
  1406. (void *)instance,
  1407. memb_timer_function_state_gather,
  1408. &instance->memb_timer_state_gather_join_timeout);
  1409. if (res != 0) {
  1410. log_printf(instance->totemsrp_log_level_error, "memb_timer_function_state_gather - qb_loop_timer_add error : %d", res);
  1411. }
  1412. break;
  1413. }
  1414. }
  1415. static void memb_timer_function_gather_consensus_timeout (void *data)
  1416. {
  1417. struct totemsrp_instance *instance = data;
  1418. memb_state_consensus_timeout_expired (instance);
  1419. }
  1420. static void deliver_messages_from_recovery_to_regular (struct totemsrp_instance *instance)
  1421. {
  1422. unsigned int i;
  1423. struct sort_queue_item *recovery_message_item;
  1424. struct sort_queue_item regular_message_item;
  1425. unsigned int range = 0;
  1426. int res;
  1427. void *ptr;
  1428. struct mcast *mcast;
  1429. log_printf (instance->totemsrp_log_level_debug,
  1430. "recovery to regular %x-%x", SEQNO_START_MSG + 1, instance->my_aru);
  1431. range = instance->my_aru - SEQNO_START_MSG;
  1432. /*
  1433. * Move messages from recovery to regular sort queue
  1434. */
  1435. // todo should i be initialized to 0 or 1 ?
  1436. for (i = 1; i <= range; i++) {
  1437. res = sq_item_get (&instance->recovery_sort_queue,
  1438. i + SEQNO_START_MSG, &ptr);
  1439. if (res != 0) {
  1440. continue;
  1441. }
  1442. recovery_message_item = ptr;
  1443. /*
  1444. * Convert recovery message into regular message
  1445. */
  1446. mcast = recovery_message_item->mcast;
  1447. if (mcast->header.encapsulated == MESSAGE_ENCAPSULATED) {
  1448. /*
  1449. * Message is a recovery message encapsulated
  1450. * in a new ring message
  1451. */
  1452. regular_message_item.mcast =
  1453. (struct mcast *)(((char *)recovery_message_item->mcast) + sizeof (struct mcast));
  1454. regular_message_item.msg_len =
  1455. recovery_message_item->msg_len - sizeof (struct mcast);
  1456. mcast = regular_message_item.mcast;
  1457. } else {
  1458. /*
  1459. * TODO this case shouldn't happen
  1460. */
  1461. continue;
  1462. }
  1463. log_printf (instance->totemsrp_log_level_debug,
  1464. "comparing if ring id is for this processors old ring seqno %d",
  1465. mcast->seq);
  1466. /*
  1467. * Only add this message to the regular sort
  1468. * queue if it was originated with the same ring
  1469. * id as the previous ring
  1470. */
  1471. if (memcmp (&instance->my_old_ring_id, &mcast->ring_id,
  1472. sizeof (struct memb_ring_id)) == 0) {
  1473. res = sq_item_inuse (&instance->regular_sort_queue, mcast->seq);
  1474. if (res == 0) {
  1475. sq_item_add (&instance->regular_sort_queue,
  1476. &regular_message_item, mcast->seq);
  1477. if (sq_lt_compare (instance->old_ring_state_high_seq_received, mcast->seq)) {
  1478. instance->old_ring_state_high_seq_received = mcast->seq;
  1479. }
  1480. }
  1481. } else {
  1482. log_printf (instance->totemsrp_log_level_debug,
  1483. "-not adding msg with seq no %x", mcast->seq);
  1484. }
  1485. }
  1486. }
  1487. /*
  1488. * Change states in the state machine of the membership algorithm
  1489. */
  1490. static void memb_state_operational_enter (struct totemsrp_instance *instance)
  1491. {
  1492. struct srp_addr joined_list[PROCESSOR_COUNT_MAX];
  1493. int joined_list_entries = 0;
  1494. unsigned int aru_save;
  1495. unsigned int joined_list_totemip[PROCESSOR_COUNT_MAX];
  1496. unsigned int trans_memb_list_totemip[PROCESSOR_COUNT_MAX];
  1497. unsigned int new_memb_list_totemip[PROCESSOR_COUNT_MAX];
  1498. unsigned int left_list[PROCESSOR_COUNT_MAX];
  1499. unsigned int i;
  1500. unsigned int res;
  1501. char left_node_msg[1024];
  1502. char joined_node_msg[1024];
  1503. char failed_node_msg[1024];
  1504. instance->originated_orf_token = 0;
  1505. memb_consensus_reset (instance);
  1506. old_ring_state_reset (instance);
  1507. deliver_messages_from_recovery_to_regular (instance);
  1508. log_printf (instance->totemsrp_log_level_trace,
  1509. "Delivering to app %x to %x",
  1510. instance->my_high_delivered + 1, instance->old_ring_state_high_seq_received);
  1511. aru_save = instance->my_aru;
  1512. instance->my_aru = instance->old_ring_state_aru;
  1513. messages_deliver_to_app (instance, 0, instance->old_ring_state_high_seq_received);
  1514. /*
  1515. * Calculate joined and left list
  1516. */
  1517. memb_set_subtract (instance->my_left_memb_list,
  1518. &instance->my_left_memb_entries,
  1519. instance->my_memb_list, instance->my_memb_entries,
  1520. instance->my_trans_memb_list, instance->my_trans_memb_entries);
  1521. memb_set_subtract (joined_list, &joined_list_entries,
  1522. instance->my_new_memb_list, instance->my_new_memb_entries,
  1523. instance->my_trans_memb_list, instance->my_trans_memb_entries);
  1524. /*
  1525. * Install new membership
  1526. */
  1527. instance->my_memb_entries = instance->my_new_memb_entries;
  1528. memcpy (&instance->my_memb_list, instance->my_new_memb_list,
  1529. sizeof (struct srp_addr) * instance->my_memb_entries);
  1530. instance->last_released = 0;
  1531. instance->my_set_retrans_flg = 0;
  1532. /*
  1533. * Deliver transitional configuration to application
  1534. */
  1535. srp_addr_to_nodeid (instance, left_list, instance->my_left_memb_list,
  1536. instance->my_left_memb_entries);
  1537. srp_addr_to_nodeid (instance, trans_memb_list_totemip,
  1538. instance->my_trans_memb_list, instance->my_trans_memb_entries);
  1539. instance->totemsrp_confchg_fn (TOTEM_CONFIGURATION_TRANSITIONAL,
  1540. trans_memb_list_totemip, instance->my_trans_memb_entries,
  1541. left_list, instance->my_left_memb_entries,
  1542. 0, 0, &instance->my_ring_id);
  1543. instance->waiting_trans_ack = 1;
  1544. instance->totemsrp_waiting_trans_ack_cb_fn (1);
  1545. // TODO we need to filter to ensure we only deliver those
  1546. // messages which are part of instance->my_deliver_memb
  1547. messages_deliver_to_app (instance, 1, instance->old_ring_state_high_seq_received);
  1548. instance->my_aru = aru_save;
  1549. /*
  1550. * Deliver regular configuration to application
  1551. */
  1552. srp_addr_to_nodeid (instance, new_memb_list_totemip,
  1553. instance->my_new_memb_list, instance->my_new_memb_entries);
  1554. srp_addr_to_nodeid (instance, joined_list_totemip, joined_list,
  1555. joined_list_entries);
  1556. instance->totemsrp_confchg_fn (TOTEM_CONFIGURATION_REGULAR,
  1557. new_memb_list_totemip, instance->my_new_memb_entries,
  1558. 0, 0,
  1559. joined_list_totemip, joined_list_entries, &instance->my_ring_id);
  1560. /*
  1561. * The recovery sort queue now becomes the regular
  1562. * sort queue. It is necessary to copy the state
  1563. * into the regular sort queue.
  1564. */
  1565. sq_copy (&instance->regular_sort_queue, &instance->recovery_sort_queue);
  1566. instance->my_last_aru = SEQNO_START_MSG;
  1567. /* When making my_proc_list smaller, ensure that the
  1568. * now non-used entries are zero-ed out. There are some suspect
  1569. * assert's that assume that there is always 2 entries in the list.
  1570. * These fail when my_proc_list is reduced to 1 entry (and the
  1571. * valid [0] entry is the same as the 'unused' [1] entry).
  1572. */
  1573. memset(instance->my_proc_list, 0,
  1574. sizeof (struct srp_addr) * instance->my_proc_list_entries);
  1575. instance->my_proc_list_entries = instance->my_new_memb_entries;
  1576. memcpy (instance->my_proc_list, instance->my_new_memb_list,
  1577. sizeof (struct srp_addr) * instance->my_memb_entries);
  1578. instance->my_failed_list_entries = 0;
  1579. /*
  1580. * TODO Not exactly to spec
  1581. *
  1582. * At the entry to this function all messages without a gap are
  1583. * deliered.
  1584. *
  1585. * This code throw away messages from the last gap in the sort queue
  1586. * to my_high_seq_received
  1587. *
  1588. * What should really happen is we should deliver all messages up to
  1589. * a gap, then delier the transitional configuration, then deliver
  1590. * the messages between the first gap and my_high_seq_received, then
  1591. * deliver a regular configuration, then deliver the regular
  1592. * configuration
  1593. *
  1594. * Unfortunately totempg doesn't appear to like this operating mode
  1595. * which needs more inspection
  1596. */
  1597. i = instance->my_high_seq_received + 1;
  1598. do {
  1599. void *ptr;
  1600. i -= 1;
  1601. res = sq_item_get (&instance->regular_sort_queue, i, &ptr);
  1602. if (i == 0) {
  1603. break;
  1604. }
  1605. } while (res);
  1606. instance->my_high_delivered = i;
  1607. for (i = 0; i <= instance->my_high_delivered; i++) {
  1608. void *ptr;
  1609. res = sq_item_get (&instance->regular_sort_queue, i, &ptr);
  1610. if (res == 0) {
  1611. struct sort_queue_item *regular_message;
  1612. regular_message = ptr;
  1613. free (regular_message->mcast);
  1614. }
  1615. }
  1616. sq_items_release (&instance->regular_sort_queue, instance->my_high_delivered);
  1617. instance->last_released = instance->my_high_delivered;
  1618. if (joined_list_entries) {
  1619. int sptr = 0;
  1620. sptr += snprintf(joined_node_msg, sizeof(joined_node_msg)-sptr, " joined:");
  1621. for (i=0; i< joined_list_entries; i++) {
  1622. sptr += snprintf(joined_node_msg+sptr, sizeof(joined_node_msg)-sptr, " %u", joined_list_totemip[i]);
  1623. }
  1624. }
  1625. else {
  1626. joined_node_msg[0] = '\0';
  1627. }
  1628. if (instance->my_left_memb_entries) {
  1629. int sptr = 0;
  1630. int sptr2 = 0;
  1631. sptr += snprintf(left_node_msg, sizeof(left_node_msg)-sptr, " left:");
  1632. for (i=0; i< instance->my_left_memb_entries; i++) {
  1633. sptr += snprintf(left_node_msg+sptr, sizeof(left_node_msg)-sptr, " %u", left_list[i]);
  1634. }
  1635. for (i=0; i< instance->my_left_memb_entries; i++) {
  1636. if (my_leave_memb_match(instance, left_list[i]) == 0) {
  1637. if (sptr2 == 0) {
  1638. sptr2 += snprintf(failed_node_msg, sizeof(failed_node_msg)-sptr2, " failed:");
  1639. }
  1640. sptr2 += snprintf(failed_node_msg+sptr2, sizeof(left_node_msg)-sptr2, " %u", left_list[i]);
  1641. }
  1642. }
  1643. if (sptr2 == 0) {
  1644. failed_node_msg[0] = '\0';
  1645. }
  1646. }
  1647. else {
  1648. left_node_msg[0] = '\0';
  1649. failed_node_msg[0] = '\0';
  1650. }
  1651. my_leave_memb_clear(instance);
  1652. log_printf (instance->totemsrp_log_level_debug,
  1653. "entering OPERATIONAL state.");
  1654. log_printf (instance->totemsrp_log_level_notice,
  1655. "A new membership (%u:%lld) was formed. Members%s%s",
  1656. instance->my_ring_id.rep,
  1657. instance->my_ring_id.seq,
  1658. joined_node_msg,
  1659. left_node_msg);
  1660. if (strlen(failed_node_msg)) {
  1661. log_printf (instance->totemsrp_log_level_notice,
  1662. "Failed to receive the leave message.%s",
  1663. failed_node_msg);
  1664. }
  1665. instance->memb_state = MEMB_STATE_OPERATIONAL;
  1666. instance->stats.operational_entered++;
  1667. instance->stats.continuous_gather = 0;
  1668. instance->my_received_flg = 1;
  1669. reset_pause_timeout (instance);
  1670. /*
  1671. * Save ring id information from this configuration to determine
  1672. * which processors are transitioning from old regular configuration
  1673. * in to new regular configuration on the next configuration change
  1674. */
  1675. memcpy (&instance->my_old_ring_id, &instance->my_ring_id,
  1676. sizeof (struct memb_ring_id));
  1677. return;
  1678. }
  1679. static void memb_state_gather_enter (
  1680. struct totemsrp_instance *instance,
  1681. enum gather_state_from gather_from)
  1682. {
  1683. int32_t res;
  1684. instance->orf_token_discard = 1;
  1685. instance->originated_orf_token = 0;
  1686. memb_set_merge (
  1687. &instance->my_id, 1,
  1688. instance->my_proc_list, &instance->my_proc_list_entries);
  1689. memb_join_message_send (instance);
  1690. /*
  1691. * Restart the join timeout
  1692. */
  1693. qb_loop_timer_del (instance->totemsrp_poll_handle, instance->memb_timer_state_gather_join_timeout);
  1694. res = qb_loop_timer_add (instance->totemsrp_poll_handle,
  1695. QB_LOOP_MED,
  1696. instance->totem_config->join_timeout*QB_TIME_NS_IN_MSEC,
  1697. (void *)instance,
  1698. memb_timer_function_state_gather,
  1699. &instance->memb_timer_state_gather_join_timeout);
  1700. if (res != 0) {
  1701. log_printf(instance->totemsrp_log_level_error, "memb_state_gather_enter - qb_loop_timer_add error(1) : %d", res);
  1702. }
  1703. /*
  1704. * Restart the consensus timeout
  1705. */
  1706. qb_loop_timer_del (instance->totemsrp_poll_handle,
  1707. instance->memb_timer_state_gather_consensus_timeout);
  1708. res = qb_loop_timer_add (instance->totemsrp_poll_handle,
  1709. QB_LOOP_MED,
  1710. instance->totem_config->consensus_timeout*QB_TIME_NS_IN_MSEC,
  1711. (void *)instance,
  1712. memb_timer_function_gather_consensus_timeout,
  1713. &instance->memb_timer_state_gather_consensus_timeout);
  1714. if (res != 0) {
  1715. log_printf(instance->totemsrp_log_level_error, "memb_state_gather_enter - qb_loop_timer_add error(2) : %d", res);
  1716. }
  1717. /*
  1718. * Cancel the token loss and token retransmission timeouts
  1719. */
  1720. cancel_token_retransmit_timeout (instance); // REVIEWED
  1721. cancel_token_timeout (instance); // REVIEWED
  1722. cancel_merge_detect_timeout (instance);
  1723. memb_consensus_reset (instance);
  1724. memb_consensus_set (instance, &instance->my_id);
  1725. log_printf (instance->totemsrp_log_level_debug,
  1726. "entering GATHER state from %d(%s).",
  1727. gather_from, gsfrom_to_msg(gather_from));
  1728. instance->memb_state = MEMB_STATE_GATHER;
  1729. instance->stats.gather_entered++;
  1730. if (gather_from == TOTEMSRP_GSFROM_THE_CONSENSUS_TIMEOUT_EXPIRED) {
  1731. /*
  1732. * State 3 means gather, so we are continuously gathering.
  1733. */
  1734. instance->stats.continuous_gather++;
  1735. }
  1736. return;
  1737. }
  1738. static void timer_function_token_retransmit_timeout (void *data);
  1739. static void target_set_completed (
  1740. void *context)
  1741. {
  1742. struct totemsrp_instance *instance = (struct totemsrp_instance *)context;
  1743. memb_state_commit_token_send (instance);
  1744. }
  1745. static void memb_state_commit_enter (
  1746. struct totemsrp_instance *instance)
  1747. {
  1748. old_ring_state_save (instance);
  1749. memb_state_commit_token_update (instance);
  1750. memb_state_commit_token_target_set (instance);
  1751. qb_loop_timer_del (instance->totemsrp_poll_handle, instance->memb_timer_state_gather_join_timeout);
  1752. instance->memb_timer_state_gather_join_timeout = 0;
  1753. qb_loop_timer_del (instance->totemsrp_poll_handle, instance->memb_timer_state_gather_consensus_timeout);
  1754. instance->memb_timer_state_gather_consensus_timeout = 0;
  1755. memb_ring_id_set (instance, &instance->commit_token->ring_id);
  1756. instance->memb_ring_id_store (&instance->my_ring_id, instance->my_id.nodeid);
  1757. instance->token_ring_id_seq = instance->my_ring_id.seq;
  1758. log_printf (instance->totemsrp_log_level_debug,
  1759. "entering COMMIT state.");
  1760. instance->memb_state = MEMB_STATE_COMMIT;
  1761. reset_token_retransmit_timeout (instance); // REVIEWED
  1762. reset_token_timeout (instance); // REVIEWED
  1763. instance->stats.commit_entered++;
  1764. instance->stats.continuous_gather = 0;
  1765. /*
  1766. * reset all flow control variables since we are starting a new ring
  1767. */
  1768. instance->my_trc = 0;
  1769. instance->my_pbl = 0;
  1770. instance->my_cbl = 0;
  1771. /*
  1772. * commit token sent after callback that token target has been set
  1773. */
  1774. }
  1775. static void memb_state_recovery_enter (
  1776. struct totemsrp_instance *instance,
  1777. struct memb_commit_token *commit_token)
  1778. {
  1779. int i;
  1780. int local_received_flg = 1;
  1781. unsigned int low_ring_aru;
  1782. unsigned int range = 0;
  1783. unsigned int messages_originated = 0;
  1784. const struct srp_addr *addr;
  1785. struct memb_commit_token_memb_entry *memb_list;
  1786. struct memb_ring_id my_new_memb_ring_id_list[PROCESSOR_COUNT_MAX];
  1787. addr = (const struct srp_addr *)commit_token->end_of_commit_token;
  1788. memb_list = (struct memb_commit_token_memb_entry *)(addr + commit_token->addr_entries);
  1789. log_printf (instance->totemsrp_log_level_debug,
  1790. "entering RECOVERY state.");
  1791. instance->orf_token_discard = 0;
  1792. instance->my_high_ring_delivered = 0;
  1793. sq_reinit (&instance->recovery_sort_queue, SEQNO_START_MSG);
  1794. cs_queue_reinit (&instance->retrans_message_queue);
  1795. low_ring_aru = instance->old_ring_state_high_seq_received;
  1796. memb_state_commit_token_send_recovery (instance, commit_token);
  1797. instance->my_token_seq = SEQNO_START_TOKEN - 1;
  1798. /*
  1799. * Build regular configuration
  1800. */
  1801. totemnet_processor_count_set (
  1802. instance->totemnet_context,
  1803. commit_token->addr_entries);
  1804. /*
  1805. * Build transitional configuration
  1806. */
  1807. for (i = 0; i < instance->my_new_memb_entries; i++) {
  1808. memcpy (&my_new_memb_ring_id_list[i],
  1809. &memb_list[i].ring_id,
  1810. sizeof (struct memb_ring_id));
  1811. }
  1812. memb_set_and_with_ring_id (
  1813. instance->my_new_memb_list,
  1814. my_new_memb_ring_id_list,
  1815. instance->my_new_memb_entries,
  1816. instance->my_memb_list,
  1817. instance->my_memb_entries,
  1818. &instance->my_old_ring_id,
  1819. instance->my_trans_memb_list,
  1820. &instance->my_trans_memb_entries);
  1821. for (i = 0; i < instance->my_trans_memb_entries; i++) {
  1822. log_printf (instance->totemsrp_log_level_debug,
  1823. "TRANS [%d] member %u:", i, instance->my_trans_memb_list[i].nodeid);
  1824. }
  1825. for (i = 0; i < instance->my_new_memb_entries; i++) {
  1826. log_printf (instance->totemsrp_log_level_debug,
  1827. "position [%d] member %u:", i, addr[i].nodeid);
  1828. log_printf (instance->totemsrp_log_level_debug,
  1829. "previous ring seq %llx rep %u",
  1830. memb_list[i].ring_id.seq,
  1831. memb_list[i].ring_id.rep);
  1832. log_printf (instance->totemsrp_log_level_debug,
  1833. "aru %x high delivered %x received flag %d",
  1834. memb_list[i].aru,
  1835. memb_list[i].high_delivered,
  1836. memb_list[i].received_flg);
  1837. // assert (totemip_print (&memb_list[i].ring_id.rep) != 0);
  1838. }
  1839. /*
  1840. * Determine if any received flag is false
  1841. */
  1842. for (i = 0; i < commit_token->addr_entries; i++) {
  1843. if (memb_set_subset (&instance->my_new_memb_list[i], 1,
  1844. instance->my_trans_memb_list, instance->my_trans_memb_entries) &&
  1845. memb_list[i].received_flg == 0) {
  1846. instance->my_deliver_memb_entries = instance->my_trans_memb_entries;
  1847. memcpy (instance->my_deliver_memb_list, instance->my_trans_memb_list,
  1848. sizeof (struct srp_addr) * instance->my_trans_memb_entries);
  1849. local_received_flg = 0;
  1850. break;
  1851. }
  1852. }
  1853. if (local_received_flg == 1) {
  1854. goto no_originate;
  1855. } /* Else originate messages if we should */
  1856. /*
  1857. * Calculate my_low_ring_aru, instance->my_high_ring_delivered for the transitional membership
  1858. */
  1859. for (i = 0; i < commit_token->addr_entries; i++) {
  1860. if (memb_set_subset (&instance->my_new_memb_list[i], 1,
  1861. instance->my_deliver_memb_list,
  1862. instance->my_deliver_memb_entries) &&
  1863. memcmp (&instance->my_old_ring_id,
  1864. &memb_list[i].ring_id,
  1865. sizeof (struct memb_ring_id)) == 0) {
  1866. if (sq_lt_compare (memb_list[i].aru, low_ring_aru)) {
  1867. low_ring_aru = memb_list[i].aru;
  1868. }
  1869. if (sq_lt_compare (instance->my_high_ring_delivered, memb_list[i].high_delivered)) {
  1870. instance->my_high_ring_delivered = memb_list[i].high_delivered;
  1871. }
  1872. }
  1873. }
  1874. /*
  1875. * Copy all old ring messages to instance->retrans_message_queue
  1876. */
  1877. range = instance->old_ring_state_high_seq_received - low_ring_aru;
  1878. if (range == 0) {
  1879. /*
  1880. * No messages to copy
  1881. */
  1882. goto no_originate;
  1883. }
  1884. assert (range < QUEUE_RTR_ITEMS_SIZE_MAX);
  1885. log_printf (instance->totemsrp_log_level_debug,
  1886. "copying all old ring messages from %x-%x.",
  1887. low_ring_aru + 1, instance->old_ring_state_high_seq_received);
  1888. for (i = 1; i <= range; i++) {
  1889. struct sort_queue_item *sort_queue_item;
  1890. struct message_item message_item;
  1891. void *ptr;
  1892. int res;
  1893. res = sq_item_get (&instance->regular_sort_queue,
  1894. low_ring_aru + i, &ptr);
  1895. if (res != 0) {
  1896. continue;
  1897. }
  1898. sort_queue_item = ptr;
  1899. messages_originated++;
  1900. memset (&message_item, 0, sizeof (struct message_item));
  1901. // TODO LEAK
  1902. message_item.mcast = totemsrp_buffer_alloc (instance);
  1903. assert (message_item.mcast);
  1904. message_item.mcast->header.type = MESSAGE_TYPE_MCAST;
  1905. srp_addr_copy (&message_item.mcast->system_from, &instance->my_id);
  1906. message_item.mcast->header.encapsulated = MESSAGE_ENCAPSULATED;
  1907. message_item.mcast->header.nodeid = instance->my_id.nodeid;
  1908. assert (message_item.mcast->header.nodeid);
  1909. message_item.mcast->header.endian_detector = ENDIAN_LOCAL;
  1910. memcpy (&message_item.mcast->ring_id, &instance->my_ring_id,
  1911. sizeof (struct memb_ring_id));
  1912. message_item.msg_len = sort_queue_item->msg_len + sizeof (struct mcast);
  1913. memcpy (((char *)message_item.mcast) + sizeof (struct mcast),
  1914. sort_queue_item->mcast,
  1915. sort_queue_item->msg_len);
  1916. cs_queue_item_add (&instance->retrans_message_queue, &message_item);
  1917. }
  1918. log_printf (instance->totemsrp_log_level_debug,
  1919. "Originated %d messages in RECOVERY.", messages_originated);
  1920. goto originated;
  1921. no_originate:
  1922. log_printf (instance->totemsrp_log_level_debug,
  1923. "Did not need to originate any messages in recovery.");
  1924. originated:
  1925. instance->my_aru = SEQNO_START_MSG;
  1926. instance->my_aru_count = 0;
  1927. instance->my_seq_unchanged = 0;
  1928. instance->my_high_seq_received = SEQNO_START_MSG;
  1929. instance->my_install_seq = SEQNO_START_MSG;
  1930. instance->last_released = SEQNO_START_MSG;
  1931. reset_token_timeout (instance); // REVIEWED
  1932. reset_token_retransmit_timeout (instance); // REVIEWED
  1933. instance->memb_state = MEMB_STATE_RECOVERY;
  1934. instance->stats.recovery_entered++;
  1935. instance->stats.continuous_gather = 0;
  1936. return;
  1937. }
  1938. void totemsrp_event_signal (void *srp_context, enum totem_event_type type, int value)
  1939. {
  1940. struct totemsrp_instance *instance = (struct totemsrp_instance *)srp_context;
  1941. token_hold_cancel_send (instance);
  1942. return;
  1943. }
  1944. int totemsrp_mcast (
  1945. void *srp_context,
  1946. struct iovec *iovec,
  1947. unsigned int iov_len,
  1948. int guarantee)
  1949. {
  1950. struct totemsrp_instance *instance = (struct totemsrp_instance *)srp_context;
  1951. int i;
  1952. struct message_item message_item;
  1953. char *addr;
  1954. unsigned int addr_idx;
  1955. struct cs_queue *queue_use;
  1956. if (instance->waiting_trans_ack) {
  1957. queue_use = &instance->new_message_queue_trans;
  1958. } else {
  1959. queue_use = &instance->new_message_queue;
  1960. }
  1961. if (cs_queue_is_full (queue_use)) {
  1962. log_printf (instance->totemsrp_log_level_debug, "queue full");
  1963. return (-1);
  1964. }
  1965. memset (&message_item, 0, sizeof (struct message_item));
  1966. /*
  1967. * Allocate pending item
  1968. */
  1969. message_item.mcast = totemsrp_buffer_alloc (instance);
  1970. if (message_item.mcast == 0) {
  1971. goto error_mcast;
  1972. }
  1973. /*
  1974. * Set mcast header
  1975. */
  1976. memset(message_item.mcast, 0, sizeof (struct mcast));
  1977. message_item.mcast->header.type = MESSAGE_TYPE_MCAST;
  1978. message_item.mcast->header.endian_detector = ENDIAN_LOCAL;
  1979. message_item.mcast->header.encapsulated = MESSAGE_NOT_ENCAPSULATED;
  1980. message_item.mcast->header.nodeid = instance->my_id.nodeid;
  1981. assert (message_item.mcast->header.nodeid);
  1982. message_item.mcast->guarantee = guarantee;
  1983. srp_addr_copy (&message_item.mcast->system_from, &instance->my_id);
  1984. addr = (char *)message_item.mcast;
  1985. addr_idx = sizeof (struct mcast);
  1986. for (i = 0; i < iov_len; i++) {
  1987. memcpy (&addr[addr_idx], iovec[i].iov_base, iovec[i].iov_len);
  1988. addr_idx += iovec[i].iov_len;
  1989. }
  1990. message_item.msg_len = addr_idx;
  1991. log_printf (instance->totemsrp_log_level_trace, "mcasted message added to pending queue");
  1992. instance->stats.mcast_tx++;
  1993. cs_queue_item_add (queue_use, &message_item);
  1994. return (0);
  1995. error_mcast:
  1996. return (-1);
  1997. }
  1998. /*
  1999. * Determine if there is room to queue a new message
  2000. */
  2001. int totemsrp_avail (void *srp_context)
  2002. {
  2003. struct totemsrp_instance *instance = (struct totemsrp_instance *)srp_context;
  2004. int avail;
  2005. struct cs_queue *queue_use;
  2006. if (instance->waiting_trans_ack) {
  2007. queue_use = &instance->new_message_queue_trans;
  2008. } else {
  2009. queue_use = &instance->new_message_queue;
  2010. }
  2011. cs_queue_avail (queue_use, &avail);
  2012. return (avail);
  2013. }
  2014. /*
  2015. * ORF Token Management
  2016. */
  2017. /*
  2018. * Recast message to mcast group if it is available
  2019. */
  2020. static int orf_token_remcast (
  2021. struct totemsrp_instance *instance,
  2022. int seq)
  2023. {
  2024. struct sort_queue_item *sort_queue_item;
  2025. int res;
  2026. void *ptr;
  2027. struct sq *sort_queue;
  2028. if (instance->memb_state == MEMB_STATE_RECOVERY) {
  2029. sort_queue = &instance->recovery_sort_queue;
  2030. } else {
  2031. sort_queue = &instance->regular_sort_queue;
  2032. }
  2033. res = sq_in_range (sort_queue, seq);
  2034. if (res == 0) {
  2035. log_printf (instance->totemsrp_log_level_debug, "sq not in range");
  2036. return (-1);
  2037. }
  2038. /*
  2039. * Get RTR item at seq, if not available, return
  2040. */
  2041. res = sq_item_get (sort_queue, seq, &ptr);
  2042. if (res != 0) {
  2043. return -1;
  2044. }
  2045. sort_queue_item = ptr;
  2046. totemnet_mcast_noflush_send (
  2047. instance->totemnet_context,
  2048. sort_queue_item->mcast,
  2049. sort_queue_item->msg_len);
  2050. return (0);
  2051. }
  2052. /*
  2053. * Free all freeable messages from ring
  2054. */
  2055. static void messages_free (
  2056. struct totemsrp_instance *instance,
  2057. unsigned int token_aru)
  2058. {
  2059. struct sort_queue_item *regular_message;
  2060. unsigned int i;
  2061. int res;
  2062. int log_release = 0;
  2063. unsigned int release_to;
  2064. unsigned int range = 0;
  2065. release_to = token_aru;
  2066. if (sq_lt_compare (instance->my_last_aru, release_to)) {
  2067. release_to = instance->my_last_aru;
  2068. }
  2069. if (sq_lt_compare (instance->my_high_delivered, release_to)) {
  2070. release_to = instance->my_high_delivered;
  2071. }
  2072. /*
  2073. * Ensure we dont try release before an already released point
  2074. */
  2075. if (sq_lt_compare (release_to, instance->last_released)) {
  2076. return;
  2077. }
  2078. range = release_to - instance->last_released;
  2079. assert (range < QUEUE_RTR_ITEMS_SIZE_MAX);
  2080. /*
  2081. * Release retransmit list items if group aru indicates they are transmitted
  2082. */
  2083. for (i = 1; i <= range; i++) {
  2084. void *ptr;
  2085. res = sq_item_get (&instance->regular_sort_queue,
  2086. instance->last_released + i, &ptr);
  2087. if (res == 0) {
  2088. regular_message = ptr;
  2089. totemsrp_buffer_release (instance, regular_message->mcast);
  2090. }
  2091. sq_items_release (&instance->regular_sort_queue,
  2092. instance->last_released + i);
  2093. log_release = 1;
  2094. }
  2095. instance->last_released += range;
  2096. if (log_release) {
  2097. log_printf (instance->totemsrp_log_level_trace,
  2098. "releasing messages up to and including %x", release_to);
  2099. }
  2100. }
  2101. static void update_aru (
  2102. struct totemsrp_instance *instance)
  2103. {
  2104. unsigned int i;
  2105. int res;
  2106. struct sq *sort_queue;
  2107. unsigned int range;
  2108. unsigned int my_aru_saved = 0;
  2109. if (instance->memb_state == MEMB_STATE_RECOVERY) {
  2110. sort_queue = &instance->recovery_sort_queue;
  2111. } else {
  2112. sort_queue = &instance->regular_sort_queue;
  2113. }
  2114. range = instance->my_high_seq_received - instance->my_aru;
  2115. my_aru_saved = instance->my_aru;
  2116. for (i = 1; i <= range; i++) {
  2117. void *ptr;
  2118. res = sq_item_get (sort_queue, my_aru_saved + i, &ptr);
  2119. /*
  2120. * If hole, stop updating aru
  2121. */
  2122. if (res != 0) {
  2123. break;
  2124. }
  2125. }
  2126. instance->my_aru += i - 1;
  2127. }
  2128. /*
  2129. * Multicasts pending messages onto the ring (requires orf_token possession)
  2130. */
  2131. static int orf_token_mcast (
  2132. struct totemsrp_instance *instance,
  2133. struct orf_token *token,
  2134. int fcc_mcasts_allowed)
  2135. {
  2136. struct message_item *message_item = 0;
  2137. struct cs_queue *mcast_queue;
  2138. struct sq *sort_queue;
  2139. struct sort_queue_item sort_queue_item;
  2140. struct mcast *mcast;
  2141. unsigned int fcc_mcast_current;
  2142. if (instance->memb_state == MEMB_STATE_RECOVERY) {
  2143. mcast_queue = &instance->retrans_message_queue;
  2144. sort_queue = &instance->recovery_sort_queue;
  2145. reset_token_retransmit_timeout (instance); // REVIEWED
  2146. } else {
  2147. if (instance->waiting_trans_ack) {
  2148. mcast_queue = &instance->new_message_queue_trans;
  2149. } else {
  2150. mcast_queue = &instance->new_message_queue;
  2151. }
  2152. sort_queue = &instance->regular_sort_queue;
  2153. }
  2154. for (fcc_mcast_current = 0; fcc_mcast_current < fcc_mcasts_allowed; fcc_mcast_current++) {
  2155. if (cs_queue_is_empty (mcast_queue)) {
  2156. break;
  2157. }
  2158. message_item = (struct message_item *)cs_queue_item_get (mcast_queue);
  2159. message_item->mcast->seq = ++token->seq;
  2160. message_item->mcast->this_seqno = instance->global_seqno++;
  2161. /*
  2162. * Build IO vector
  2163. */
  2164. memset (&sort_queue_item, 0, sizeof (struct sort_queue_item));
  2165. sort_queue_item.mcast = message_item->mcast;
  2166. sort_queue_item.msg_len = message_item->msg_len;
  2167. mcast = sort_queue_item.mcast;
  2168. memcpy (&mcast->ring_id, &instance->my_ring_id, sizeof (struct memb_ring_id));
  2169. /*
  2170. * Add message to retransmit queue
  2171. */
  2172. sq_item_add (sort_queue, &sort_queue_item, message_item->mcast->seq);
  2173. totemnet_mcast_noflush_send (
  2174. instance->totemnet_context,
  2175. message_item->mcast,
  2176. message_item->msg_len);
  2177. /*
  2178. * Delete item from pending queue
  2179. */
  2180. cs_queue_item_remove (mcast_queue);
  2181. /*
  2182. * If messages mcasted, deliver any new messages to totempg
  2183. */
  2184. instance->my_high_seq_received = token->seq;
  2185. }
  2186. update_aru (instance);
  2187. /*
  2188. * Return 1 if more messages are available for single node clusters
  2189. */
  2190. return (fcc_mcast_current);
  2191. }
  2192. /*
  2193. * Remulticasts messages in orf_token's retransmit list (requires orf_token)
  2194. * Modify's orf_token's rtr to include retransmits required by this process
  2195. */
  2196. static int orf_token_rtr (
  2197. struct totemsrp_instance *instance,
  2198. struct orf_token *orf_token,
  2199. unsigned int *fcc_allowed)
  2200. {
  2201. unsigned int res;
  2202. unsigned int i, j;
  2203. unsigned int found;
  2204. struct sq *sort_queue;
  2205. struct rtr_item *rtr_list;
  2206. unsigned int range = 0;
  2207. char retransmit_msg[1024];
  2208. char value[64];
  2209. if (instance->memb_state == MEMB_STATE_RECOVERY) {
  2210. sort_queue = &instance->recovery_sort_queue;
  2211. } else {
  2212. sort_queue = &instance->regular_sort_queue;
  2213. }
  2214. rtr_list = &orf_token->rtr_list[0];
  2215. strcpy (retransmit_msg, "Retransmit List: ");
  2216. if (orf_token->rtr_list_entries) {
  2217. log_printf (instance->totemsrp_log_level_debug,
  2218. "Retransmit List %d", orf_token->rtr_list_entries);
  2219. for (i = 0; i < orf_token->rtr_list_entries; i++) {
  2220. sprintf (value, "%x ", rtr_list[i].seq);
  2221. strcat (retransmit_msg, value);
  2222. }
  2223. strcat (retransmit_msg, "");
  2224. log_printf (instance->totemsrp_log_level_notice,
  2225. "%s", retransmit_msg);
  2226. }
  2227. /*
  2228. * Retransmit messages on orf_token's RTR list from RTR queue
  2229. */
  2230. for (instance->fcc_remcast_current = 0, i = 0;
  2231. instance->fcc_remcast_current < *fcc_allowed && i < orf_token->rtr_list_entries;) {
  2232. /*
  2233. * If this retransmit request isn't from this configuration,
  2234. * try next rtr entry
  2235. */
  2236. if (memcmp (&rtr_list[i].ring_id, &instance->my_ring_id,
  2237. sizeof (struct memb_ring_id)) != 0) {
  2238. i += 1;
  2239. continue;
  2240. }
  2241. res = orf_token_remcast (instance, rtr_list[i].seq);
  2242. if (res == 0) {
  2243. /*
  2244. * Multicasted message, so no need to copy to new retransmit list
  2245. */
  2246. orf_token->rtr_list_entries -= 1;
  2247. assert (orf_token->rtr_list_entries >= 0);
  2248. memmove (&rtr_list[i], &rtr_list[i + 1],
  2249. sizeof (struct rtr_item) * (orf_token->rtr_list_entries - i));
  2250. instance->stats.mcast_retx++;
  2251. instance->fcc_remcast_current++;
  2252. } else {
  2253. i += 1;
  2254. }
  2255. }
  2256. *fcc_allowed = *fcc_allowed - instance->fcc_remcast_current;
  2257. /*
  2258. * Add messages to retransmit to RTR list
  2259. * but only retry if there is room in the retransmit list
  2260. */
  2261. range = orf_token->seq - instance->my_aru;
  2262. assert (range < QUEUE_RTR_ITEMS_SIZE_MAX);
  2263. for (i = 1; (orf_token->rtr_list_entries < RETRANSMIT_ENTRIES_MAX) &&
  2264. (i <= range); i++) {
  2265. /*
  2266. * Ensure message is within the sort queue range
  2267. */
  2268. res = sq_in_range (sort_queue, instance->my_aru + i);
  2269. if (res == 0) {
  2270. break;
  2271. }
  2272. /*
  2273. * Find if a message is missing from this processor
  2274. */
  2275. res = sq_item_inuse (sort_queue, instance->my_aru + i);
  2276. if (res == 0) {
  2277. /*
  2278. * Determine how many times we have missed receiving
  2279. * this sequence number. sq_item_miss_count increments
  2280. * a counter for the sequence number. The miss count
  2281. * will be returned and compared. This allows time for
  2282. * delayed multicast messages to be received before
  2283. * declaring the message is missing and requesting a
  2284. * retransmit.
  2285. */
  2286. res = sq_item_miss_count (sort_queue, instance->my_aru + i);
  2287. if (res < instance->totem_config->miss_count_const) {
  2288. continue;
  2289. }
  2290. /*
  2291. * Determine if missing message is already in retransmit list
  2292. */
  2293. found = 0;
  2294. for (j = 0; j < orf_token->rtr_list_entries; j++) {
  2295. if (instance->my_aru + i == rtr_list[j].seq) {
  2296. found = 1;
  2297. }
  2298. }
  2299. if (found == 0) {
  2300. /*
  2301. * Missing message not found in current retransmit list so add it
  2302. */
  2303. memcpy (&rtr_list[orf_token->rtr_list_entries].ring_id,
  2304. &instance->my_ring_id, sizeof (struct memb_ring_id));
  2305. rtr_list[orf_token->rtr_list_entries].seq = instance->my_aru + i;
  2306. orf_token->rtr_list_entries++;
  2307. }
  2308. }
  2309. }
  2310. return (instance->fcc_remcast_current);
  2311. }
  2312. static void token_retransmit (struct totemsrp_instance *instance)
  2313. {
  2314. totemnet_token_send (instance->totemnet_context,
  2315. instance->orf_token_retransmit,
  2316. instance->orf_token_retransmit_size);
  2317. }
  2318. /*
  2319. * Retransmit the regular token if no mcast or token has
  2320. * been received in retransmit token period retransmit
  2321. * the token to the next processor
  2322. */
  2323. static void timer_function_token_retransmit_timeout (void *data)
  2324. {
  2325. struct totemsrp_instance *instance = data;
  2326. switch (instance->memb_state) {
  2327. case MEMB_STATE_GATHER:
  2328. break;
  2329. case MEMB_STATE_COMMIT:
  2330. case MEMB_STATE_OPERATIONAL:
  2331. case MEMB_STATE_RECOVERY:
  2332. token_retransmit (instance);
  2333. reset_token_retransmit_timeout (instance); // REVIEWED
  2334. break;
  2335. }
  2336. }
  2337. static void timer_function_token_hold_retransmit_timeout (void *data)
  2338. {
  2339. struct totemsrp_instance *instance = data;
  2340. switch (instance->memb_state) {
  2341. case MEMB_STATE_GATHER:
  2342. break;
  2343. case MEMB_STATE_COMMIT:
  2344. break;
  2345. case MEMB_STATE_OPERATIONAL:
  2346. case MEMB_STATE_RECOVERY:
  2347. token_retransmit (instance);
  2348. break;
  2349. }
  2350. }
  2351. static void timer_function_merge_detect_timeout(void *data)
  2352. {
  2353. struct totemsrp_instance *instance = data;
  2354. instance->my_merge_detect_timeout_outstanding = 0;
  2355. switch (instance->memb_state) {
  2356. case MEMB_STATE_OPERATIONAL:
  2357. if (instance->my_ring_id.rep == instance->my_id.nodeid) {
  2358. memb_merge_detect_transmit (instance);
  2359. }
  2360. break;
  2361. case MEMB_STATE_GATHER:
  2362. case MEMB_STATE_COMMIT:
  2363. case MEMB_STATE_RECOVERY:
  2364. break;
  2365. }
  2366. }
  2367. /*
  2368. * Send orf_token to next member (requires orf_token)
  2369. */
  2370. static int token_send (
  2371. struct totemsrp_instance *instance,
  2372. struct orf_token *orf_token,
  2373. int forward_token)
  2374. {
  2375. int res = 0;
  2376. unsigned int orf_token_size;
  2377. orf_token_size = sizeof (struct orf_token) +
  2378. (orf_token->rtr_list_entries * sizeof (struct rtr_item));
  2379. orf_token->header.nodeid = instance->my_id.nodeid;
  2380. memcpy (instance->orf_token_retransmit, orf_token, orf_token_size);
  2381. instance->orf_token_retransmit_size = orf_token_size;
  2382. assert (orf_token->header.nodeid);
  2383. if (forward_token == 0) {
  2384. return (0);
  2385. }
  2386. totemnet_token_send (instance->totemnet_context,
  2387. orf_token,
  2388. orf_token_size);
  2389. return (res);
  2390. }
  2391. static int token_hold_cancel_send (struct totemsrp_instance *instance)
  2392. {
  2393. struct token_hold_cancel token_hold_cancel;
  2394. /*
  2395. * Only cancel if the token is currently held
  2396. */
  2397. if (instance->my_token_held == 0) {
  2398. return (0);
  2399. }
  2400. instance->my_token_held = 0;
  2401. /*
  2402. * Build message
  2403. */
  2404. token_hold_cancel.header.type = MESSAGE_TYPE_TOKEN_HOLD_CANCEL;
  2405. token_hold_cancel.header.endian_detector = ENDIAN_LOCAL;
  2406. token_hold_cancel.header.encapsulated = 0;
  2407. token_hold_cancel.header.nodeid = instance->my_id.nodeid;
  2408. memcpy (&token_hold_cancel.ring_id, &instance->my_ring_id,
  2409. sizeof (struct memb_ring_id));
  2410. assert (token_hold_cancel.header.nodeid);
  2411. instance->stats.token_hold_cancel_tx++;
  2412. totemnet_mcast_flush_send (instance->totemnet_context, &token_hold_cancel,
  2413. sizeof (struct token_hold_cancel));
  2414. return (0);
  2415. }
  2416. static int orf_token_send_initial (struct totemsrp_instance *instance)
  2417. {
  2418. struct orf_token orf_token;
  2419. int res;
  2420. orf_token.header.type = MESSAGE_TYPE_ORF_TOKEN;
  2421. orf_token.header.endian_detector = ENDIAN_LOCAL;
  2422. orf_token.header.encapsulated = 0;
  2423. orf_token.header.nodeid = instance->my_id.nodeid;
  2424. assert (orf_token.header.nodeid);
  2425. orf_token.seq = SEQNO_START_MSG;
  2426. orf_token.token_seq = SEQNO_START_TOKEN;
  2427. orf_token.retrans_flg = 1;
  2428. instance->my_set_retrans_flg = 1;
  2429. instance->stats.orf_token_tx++;
  2430. if (cs_queue_is_empty (&instance->retrans_message_queue) == 1) {
  2431. orf_token.retrans_flg = 0;
  2432. instance->my_set_retrans_flg = 0;
  2433. } else {
  2434. orf_token.retrans_flg = 1;
  2435. instance->my_set_retrans_flg = 1;
  2436. }
  2437. orf_token.aru = 0;
  2438. orf_token.aru = SEQNO_START_MSG - 1;
  2439. orf_token.aru_addr = instance->my_id.nodeid;
  2440. memcpy (&orf_token.ring_id, &instance->my_ring_id, sizeof (struct memb_ring_id));
  2441. orf_token.fcc = 0;
  2442. orf_token.backlog = 0;
  2443. orf_token.rtr_list_entries = 0;
  2444. res = token_send (instance, &orf_token, 1);
  2445. return (res);
  2446. }
  2447. static void memb_state_commit_token_update (
  2448. struct totemsrp_instance *instance)
  2449. {
  2450. struct srp_addr *addr;
  2451. struct memb_commit_token_memb_entry *memb_list;
  2452. unsigned int high_aru;
  2453. unsigned int i;
  2454. addr = (struct srp_addr *)instance->commit_token->end_of_commit_token;
  2455. memb_list = (struct memb_commit_token_memb_entry *)(addr + instance->commit_token->addr_entries);
  2456. memcpy (instance->my_new_memb_list, addr,
  2457. sizeof (struct srp_addr) * instance->commit_token->addr_entries);
  2458. instance->my_new_memb_entries = instance->commit_token->addr_entries;
  2459. memcpy (&memb_list[instance->commit_token->memb_index].ring_id,
  2460. &instance->my_old_ring_id, sizeof (struct memb_ring_id));
  2461. memb_list[instance->commit_token->memb_index].aru = instance->old_ring_state_aru;
  2462. /*
  2463. * TODO high delivered is really instance->my_aru, but with safe this
  2464. * could change?
  2465. */
  2466. instance->my_received_flg =
  2467. (instance->my_aru == instance->my_high_seq_received);
  2468. memb_list[instance->commit_token->memb_index].received_flg = instance->my_received_flg;
  2469. memb_list[instance->commit_token->memb_index].high_delivered = instance->my_high_delivered;
  2470. /*
  2471. * find high aru up to current memb_index for all matching ring ids
  2472. * if any ring id matching memb_index has aru less then high aru set
  2473. * received flag for that entry to false
  2474. */
  2475. high_aru = memb_list[instance->commit_token->memb_index].aru;
  2476. for (i = 0; i <= instance->commit_token->memb_index; i++) {
  2477. if (memcmp (&memb_list[instance->commit_token->memb_index].ring_id,
  2478. &memb_list[i].ring_id,
  2479. sizeof (struct memb_ring_id)) == 0) {
  2480. if (sq_lt_compare (high_aru, memb_list[i].aru)) {
  2481. high_aru = memb_list[i].aru;
  2482. }
  2483. }
  2484. }
  2485. for (i = 0; i <= instance->commit_token->memb_index; i++) {
  2486. if (memcmp (&memb_list[instance->commit_token->memb_index].ring_id,
  2487. &memb_list[i].ring_id,
  2488. sizeof (struct memb_ring_id)) == 0) {
  2489. if (sq_lt_compare (memb_list[i].aru, high_aru)) {
  2490. memb_list[i].received_flg = 0;
  2491. if (i == instance->commit_token->memb_index) {
  2492. instance->my_received_flg = 0;
  2493. }
  2494. }
  2495. }
  2496. }
  2497. instance->commit_token->header.nodeid = instance->my_id.nodeid;
  2498. instance->commit_token->memb_index += 1;
  2499. assert (instance->commit_token->memb_index <= instance->commit_token->addr_entries);
  2500. assert (instance->commit_token->header.nodeid);
  2501. }
  2502. static void memb_state_commit_token_target_set (
  2503. struct totemsrp_instance *instance)
  2504. {
  2505. struct srp_addr *addr;
  2506. addr = (struct srp_addr *)instance->commit_token->end_of_commit_token;
  2507. /* Totemnet just looks at the node id */
  2508. totemnet_token_target_set (
  2509. instance->totemnet_context,
  2510. addr[instance->commit_token->memb_index %
  2511. instance->commit_token->addr_entries].nodeid);
  2512. }
  2513. static int memb_state_commit_token_send_recovery (
  2514. struct totemsrp_instance *instance,
  2515. struct memb_commit_token *commit_token)
  2516. {
  2517. unsigned int commit_token_size;
  2518. commit_token->token_seq++;
  2519. commit_token->header.nodeid = instance->my_id.nodeid;
  2520. commit_token_size = sizeof (struct memb_commit_token) +
  2521. ((sizeof (struct srp_addr) +
  2522. sizeof (struct memb_commit_token_memb_entry)) * commit_token->addr_entries);
  2523. /*
  2524. * Make a copy for retransmission if necessary
  2525. */
  2526. memcpy (instance->orf_token_retransmit, commit_token, commit_token_size);
  2527. instance->orf_token_retransmit_size = commit_token_size;
  2528. instance->stats.memb_commit_token_tx++;
  2529. totemnet_token_send (instance->totemnet_context,
  2530. commit_token,
  2531. commit_token_size);
  2532. /*
  2533. * Request retransmission of the commit token in case it is lost
  2534. */
  2535. reset_token_retransmit_timeout (instance);
  2536. return (0);
  2537. }
  2538. static int memb_state_commit_token_send (
  2539. struct totemsrp_instance *instance)
  2540. {
  2541. unsigned int commit_token_size;
  2542. instance->commit_token->token_seq++;
  2543. instance->commit_token->header.nodeid = instance->my_id.nodeid;
  2544. commit_token_size = sizeof (struct memb_commit_token) +
  2545. ((sizeof (struct srp_addr) +
  2546. sizeof (struct memb_commit_token_memb_entry)) * instance->commit_token->addr_entries);
  2547. /*
  2548. * Make a copy for retransmission if necessary
  2549. */
  2550. memcpy (instance->orf_token_retransmit, instance->commit_token, commit_token_size);
  2551. instance->orf_token_retransmit_size = commit_token_size;
  2552. instance->stats.memb_commit_token_tx++;
  2553. totemnet_token_send (instance->totemnet_context,
  2554. instance->commit_token,
  2555. commit_token_size);
  2556. /*
  2557. * Request retransmission of the commit token in case it is lost
  2558. */
  2559. reset_token_retransmit_timeout (instance);
  2560. return (0);
  2561. }
  2562. static int memb_lowest_in_config (struct totemsrp_instance *instance)
  2563. {
  2564. struct srp_addr token_memb[PROCESSOR_COUNT_MAX];
  2565. int token_memb_entries = 0;
  2566. int i;
  2567. unsigned int lowest_nodeid;
  2568. memb_set_subtract (token_memb, &token_memb_entries,
  2569. instance->my_proc_list, instance->my_proc_list_entries,
  2570. instance->my_failed_list, instance->my_failed_list_entries);
  2571. /*
  2572. * find representative by searching for smallest identifier
  2573. */
  2574. lowest_nodeid = token_memb[0].nodeid;
  2575. for (i = 1; i < token_memb_entries; i++) {
  2576. if (lowest_nodeid > token_memb[i].nodeid) {
  2577. lowest_nodeid = token_memb[i].nodeid;
  2578. }
  2579. }
  2580. return (lowest_nodeid == instance->my_id.nodeid);
  2581. }
  2582. static int srp_addr_compare (const void *a, const void *b)
  2583. {
  2584. const struct srp_addr *srp_a = (const struct srp_addr *)a;
  2585. const struct srp_addr *srp_b = (const struct srp_addr *)b;
  2586. return (srp_a->nodeid == srp_b->nodeid);
  2587. }
  2588. static void memb_state_commit_token_create (
  2589. struct totemsrp_instance *instance)
  2590. {
  2591. struct srp_addr token_memb[PROCESSOR_COUNT_MAX];
  2592. struct srp_addr *addr;
  2593. struct memb_commit_token_memb_entry *memb_list;
  2594. int token_memb_entries = 0;
  2595. log_printf (instance->totemsrp_log_level_debug,
  2596. "Creating commit token because I am the rep.");
  2597. memb_set_subtract (token_memb, &token_memb_entries,
  2598. instance->my_proc_list, instance->my_proc_list_entries,
  2599. instance->my_failed_list, instance->my_failed_list_entries);
  2600. memset (instance->commit_token, 0, sizeof (struct memb_commit_token));
  2601. instance->commit_token->header.type = MESSAGE_TYPE_MEMB_COMMIT_TOKEN;
  2602. instance->commit_token->header.endian_detector = ENDIAN_LOCAL;
  2603. instance->commit_token->header.encapsulated = 0;
  2604. instance->commit_token->header.nodeid = instance->my_id.nodeid;
  2605. assert (instance->commit_token->header.nodeid);
  2606. instance->commit_token->ring_id.rep = instance->my_id.nodeid;
  2607. instance->commit_token->ring_id.seq = instance->token_ring_id_seq + 4;
  2608. /*
  2609. * This qsort is necessary to ensure the commit token traverses
  2610. * the ring in the proper order
  2611. */
  2612. qsort (token_memb, token_memb_entries, sizeof (struct srp_addr),
  2613. srp_addr_compare);
  2614. instance->commit_token->memb_index = 0;
  2615. instance->commit_token->addr_entries = token_memb_entries;
  2616. addr = (struct srp_addr *)instance->commit_token->end_of_commit_token;
  2617. memb_list = (struct memb_commit_token_memb_entry *)(addr + instance->commit_token->addr_entries);
  2618. memcpy (addr, token_memb,
  2619. token_memb_entries * sizeof (struct srp_addr));
  2620. memset (memb_list, 0,
  2621. sizeof (struct memb_commit_token_memb_entry) * token_memb_entries);
  2622. }
  2623. static void memb_join_message_send (struct totemsrp_instance *instance)
  2624. {
  2625. char memb_join_data[40000];
  2626. struct memb_join *memb_join = (struct memb_join *)memb_join_data;
  2627. char *addr;
  2628. unsigned int addr_idx;
  2629. memb_join->header.type = MESSAGE_TYPE_MEMB_JOIN;
  2630. memb_join->header.endian_detector = ENDIAN_LOCAL;
  2631. memb_join->header.encapsulated = 0;
  2632. memb_join->header.nodeid = instance->my_id.nodeid;
  2633. assert (memb_join->header.nodeid);
  2634. memb_join->ring_seq = instance->my_ring_id.seq;
  2635. memb_join->proc_list_entries = instance->my_proc_list_entries;
  2636. memb_join->failed_list_entries = instance->my_failed_list_entries;
  2637. srp_addr_copy (&memb_join->system_from, &instance->my_id);
  2638. /*
  2639. * This mess adds the joined and failed processor lists into the join
  2640. * message
  2641. */
  2642. addr = (char *)memb_join;
  2643. addr_idx = sizeof (struct memb_join);
  2644. memcpy (&addr[addr_idx],
  2645. instance->my_proc_list,
  2646. instance->my_proc_list_entries *
  2647. sizeof (struct srp_addr));
  2648. addr_idx +=
  2649. instance->my_proc_list_entries *
  2650. sizeof (struct srp_addr);
  2651. memcpy (&addr[addr_idx],
  2652. instance->my_failed_list,
  2653. instance->my_failed_list_entries *
  2654. sizeof (struct srp_addr));
  2655. addr_idx +=
  2656. instance->my_failed_list_entries *
  2657. sizeof (struct srp_addr);
  2658. if (instance->totem_config->send_join_timeout) {
  2659. usleep (random() % (instance->totem_config->send_join_timeout * 1000));
  2660. }
  2661. instance->stats.memb_join_tx++;
  2662. totemnet_mcast_flush_send (
  2663. instance->totemnet_context,
  2664. memb_join,
  2665. addr_idx);
  2666. }
  2667. static void memb_leave_message_send (struct totemsrp_instance *instance)
  2668. {
  2669. char memb_join_data[40000];
  2670. struct memb_join *memb_join = (struct memb_join *)memb_join_data;
  2671. char *addr;
  2672. unsigned int addr_idx;
  2673. int active_memb_entries;
  2674. struct srp_addr active_memb[PROCESSOR_COUNT_MAX];
  2675. log_printf (instance->totemsrp_log_level_debug,
  2676. "sending join/leave message");
  2677. /*
  2678. * add us to the failed list, and remove us from
  2679. * the members list
  2680. */
  2681. memb_set_merge(
  2682. &instance->my_id, 1,
  2683. instance->my_failed_list, &instance->my_failed_list_entries);
  2684. memb_set_subtract (active_memb, &active_memb_entries,
  2685. instance->my_proc_list, instance->my_proc_list_entries,
  2686. &instance->my_id, 1);
  2687. memb_join->header.type = MESSAGE_TYPE_MEMB_JOIN;
  2688. memb_join->header.endian_detector = ENDIAN_LOCAL;
  2689. memb_join->header.encapsulated = 0;
  2690. memb_join->header.nodeid = LEAVE_DUMMY_NODEID;
  2691. memb_join->ring_seq = instance->my_ring_id.seq;
  2692. memb_join->proc_list_entries = active_memb_entries;
  2693. memb_join->failed_list_entries = instance->my_failed_list_entries;
  2694. srp_addr_copy (&memb_join->system_from, &instance->my_id);
  2695. memb_join->system_from.nodeid = LEAVE_DUMMY_NODEID;
  2696. // TODO: CC Maybe use the actual join send routine.
  2697. /*
  2698. * This mess adds the joined and failed processor lists into the join
  2699. * message
  2700. */
  2701. addr = (char *)memb_join;
  2702. addr_idx = sizeof (struct memb_join);
  2703. memcpy (&addr[addr_idx],
  2704. active_memb,
  2705. active_memb_entries *
  2706. sizeof (struct srp_addr));
  2707. addr_idx +=
  2708. active_memb_entries *
  2709. sizeof (struct srp_addr);
  2710. memcpy (&addr[addr_idx],
  2711. instance->my_failed_list,
  2712. instance->my_failed_list_entries *
  2713. sizeof (struct srp_addr));
  2714. addr_idx +=
  2715. instance->my_failed_list_entries *
  2716. sizeof (struct srp_addr);
  2717. if (instance->totem_config->send_join_timeout) {
  2718. usleep (random() % (instance->totem_config->send_join_timeout * 1000));
  2719. }
  2720. instance->stats.memb_join_tx++;
  2721. totemnet_mcast_flush_send (
  2722. instance->totemnet_context,
  2723. memb_join,
  2724. addr_idx);
  2725. }
  2726. static void memb_merge_detect_transmit (struct totemsrp_instance *instance)
  2727. {
  2728. struct memb_merge_detect memb_merge_detect;
  2729. memb_merge_detect.header.type = MESSAGE_TYPE_MEMB_MERGE_DETECT;
  2730. memb_merge_detect.header.endian_detector = ENDIAN_LOCAL;
  2731. memb_merge_detect.header.encapsulated = 0;
  2732. memb_merge_detect.header.nodeid = instance->my_id.nodeid;
  2733. srp_addr_copy (&memb_merge_detect.system_from, &instance->my_id);
  2734. memcpy (&memb_merge_detect.ring_id, &instance->my_ring_id,
  2735. sizeof (struct memb_ring_id));
  2736. assert (memb_merge_detect.header.nodeid);
  2737. instance->stats.memb_merge_detect_tx++;
  2738. totemnet_mcast_flush_send (instance->totemnet_context,
  2739. &memb_merge_detect,
  2740. sizeof (struct memb_merge_detect));
  2741. }
  2742. static void memb_ring_id_set (
  2743. struct totemsrp_instance *instance,
  2744. const struct memb_ring_id *ring_id)
  2745. {
  2746. memcpy (&instance->my_ring_id, ring_id, sizeof (struct memb_ring_id));
  2747. }
  2748. int totemsrp_callback_token_create (
  2749. void *srp_context,
  2750. void **handle_out,
  2751. enum totem_callback_token_type type,
  2752. int delete,
  2753. int (*callback_fn) (enum totem_callback_token_type type, const void *),
  2754. const void *data)
  2755. {
  2756. struct totemsrp_instance *instance = (struct totemsrp_instance *)srp_context;
  2757. struct token_callback_instance *callback_handle;
  2758. token_hold_cancel_send (instance);
  2759. callback_handle = malloc (sizeof (struct token_callback_instance));
  2760. if (callback_handle == 0) {
  2761. return (-1);
  2762. }
  2763. *handle_out = (void *)callback_handle;
  2764. qb_list_init (&callback_handle->list);
  2765. callback_handle->callback_fn = callback_fn;
  2766. callback_handle->data = (void *) data;
  2767. callback_handle->callback_type = type;
  2768. callback_handle->delete = delete;
  2769. switch (type) {
  2770. case TOTEM_CALLBACK_TOKEN_RECEIVED:
  2771. qb_list_add (&callback_handle->list, &instance->token_callback_received_listhead);
  2772. break;
  2773. case TOTEM_CALLBACK_TOKEN_SENT:
  2774. qb_list_add (&callback_handle->list, &instance->token_callback_sent_listhead);
  2775. break;
  2776. }
  2777. return (0);
  2778. }
  2779. void totemsrp_callback_token_destroy (void *srp_context, void **handle_out)
  2780. {
  2781. struct token_callback_instance *h;
  2782. if (*handle_out) {
  2783. h = (struct token_callback_instance *)*handle_out;
  2784. qb_list_del (&h->list);
  2785. free (h);
  2786. h = NULL;
  2787. *handle_out = 0;
  2788. }
  2789. }
  2790. static void token_callbacks_execute (
  2791. struct totemsrp_instance *instance,
  2792. enum totem_callback_token_type type)
  2793. {
  2794. struct qb_list_head *list, *tmp_iter;
  2795. struct qb_list_head *callback_listhead = 0;
  2796. struct token_callback_instance *token_callback_instance;
  2797. int res;
  2798. int del;
  2799. switch (type) {
  2800. case TOTEM_CALLBACK_TOKEN_RECEIVED:
  2801. callback_listhead = &instance->token_callback_received_listhead;
  2802. break;
  2803. case TOTEM_CALLBACK_TOKEN_SENT:
  2804. callback_listhead = &instance->token_callback_sent_listhead;
  2805. break;
  2806. default:
  2807. assert (0);
  2808. }
  2809. qb_list_for_each_safe(list, tmp_iter, callback_listhead) {
  2810. token_callback_instance = qb_list_entry (list, struct token_callback_instance, list);
  2811. del = token_callback_instance->delete;
  2812. if (del == 1) {
  2813. qb_list_del (list);
  2814. }
  2815. res = token_callback_instance->callback_fn (
  2816. token_callback_instance->callback_type,
  2817. token_callback_instance->data);
  2818. /*
  2819. * This callback failed to execute, try it again on the next token
  2820. */
  2821. if (res == -1 && del == 1) {
  2822. qb_list_add (list, callback_listhead);
  2823. } else if (del) {
  2824. free (token_callback_instance);
  2825. }
  2826. }
  2827. }
  2828. /*
  2829. * Flow control functions
  2830. */
  2831. static unsigned int backlog_get (struct totemsrp_instance *instance)
  2832. {
  2833. unsigned int backlog = 0;
  2834. struct cs_queue *queue_use = NULL;
  2835. if (instance->memb_state == MEMB_STATE_OPERATIONAL) {
  2836. if (instance->waiting_trans_ack) {
  2837. queue_use = &instance->new_message_queue_trans;
  2838. } else {
  2839. queue_use = &instance->new_message_queue;
  2840. }
  2841. } else
  2842. if (instance->memb_state == MEMB_STATE_RECOVERY) {
  2843. queue_use = &instance->retrans_message_queue;
  2844. }
  2845. if (queue_use != NULL) {
  2846. backlog = cs_queue_used (queue_use);
  2847. }
  2848. instance->stats.token[instance->stats.latest_token].backlog_calc = backlog;
  2849. return (backlog);
  2850. }
  2851. static int fcc_calculate (
  2852. struct totemsrp_instance *instance,
  2853. struct orf_token *token)
  2854. {
  2855. unsigned int transmits_allowed;
  2856. unsigned int backlog_calc;
  2857. transmits_allowed = instance->totem_config->max_messages;
  2858. if (transmits_allowed > instance->totem_config->window_size - token->fcc) {
  2859. transmits_allowed = instance->totem_config->window_size - token->fcc;
  2860. }
  2861. instance->my_cbl = backlog_get (instance);
  2862. /*
  2863. * Only do backlog calculation if there is a backlog otherwise
  2864. * we would result in div by zero
  2865. */
  2866. if (token->backlog + instance->my_cbl - instance->my_pbl) {
  2867. backlog_calc = (instance->totem_config->window_size * instance->my_pbl) /
  2868. (token->backlog + instance->my_cbl - instance->my_pbl);
  2869. if (backlog_calc > 0 && transmits_allowed > backlog_calc) {
  2870. transmits_allowed = backlog_calc;
  2871. }
  2872. }
  2873. return (transmits_allowed);
  2874. }
  2875. /*
  2876. * don't overflow the RTR sort queue
  2877. */
  2878. static void fcc_rtr_limit (
  2879. struct totemsrp_instance *instance,
  2880. struct orf_token *token,
  2881. unsigned int *transmits_allowed)
  2882. {
  2883. int check = QUEUE_RTR_ITEMS_SIZE_MAX;
  2884. check -= (*transmits_allowed + instance->totem_config->window_size);
  2885. assert (check >= 0);
  2886. if (sq_lt_compare (instance->last_released +
  2887. QUEUE_RTR_ITEMS_SIZE_MAX - *transmits_allowed -
  2888. instance->totem_config->window_size,
  2889. token->seq)) {
  2890. *transmits_allowed = 0;
  2891. }
  2892. }
  2893. static void fcc_token_update (
  2894. struct totemsrp_instance *instance,
  2895. struct orf_token *token,
  2896. unsigned int msgs_transmitted)
  2897. {
  2898. token->fcc += msgs_transmitted - instance->my_trc;
  2899. token->backlog += instance->my_cbl - instance->my_pbl;
  2900. instance->my_trc = msgs_transmitted;
  2901. instance->my_pbl = instance->my_cbl;
  2902. }
  2903. /*
  2904. * Message Handlers
  2905. */
  2906. unsigned long long int tv_old;
  2907. /*
  2908. * message handler called when TOKEN message type received
  2909. */
  2910. static int message_handler_orf_token (
  2911. struct totemsrp_instance *instance,
  2912. const void *msg,
  2913. size_t msg_len,
  2914. int endian_conversion_needed)
  2915. {
  2916. char token_storage[1500];
  2917. char token_convert[1500];
  2918. struct orf_token *token = NULL;
  2919. int forward_token;
  2920. unsigned int transmits_allowed;
  2921. unsigned int mcasted_retransmit;
  2922. unsigned int mcasted_regular;
  2923. unsigned int last_aru;
  2924. #ifdef GIVEINFO
  2925. unsigned long long tv_current;
  2926. unsigned long long tv_diff;
  2927. tv_current = qb_util_nano_current_get ();
  2928. tv_diff = tv_current - tv_old;
  2929. tv_old = tv_current;
  2930. log_printf (instance->totemsrp_log_level_debug,
  2931. "Time since last token %0.4f ms", ((float)tv_diff) / 1000000.0);
  2932. #endif
  2933. if (instance->orf_token_discard) {
  2934. return (0);
  2935. }
  2936. #ifdef TEST_DROP_ORF_TOKEN_PERCENTAGE
  2937. if (random()%100 < TEST_DROP_ORF_TOKEN_PERCENTAGE) {
  2938. return (0);
  2939. }
  2940. #endif
  2941. if (endian_conversion_needed) {
  2942. orf_token_endian_convert ((struct orf_token *)msg,
  2943. (struct orf_token *)token_convert);
  2944. msg = (struct orf_token *)token_convert;
  2945. }
  2946. /*
  2947. * Make copy of token and retransmit list in case we have
  2948. * to flush incoming messages from the kernel queue
  2949. */
  2950. token = (struct orf_token *)token_storage;
  2951. memcpy (token, msg, sizeof (struct orf_token));
  2952. memcpy (&token->rtr_list[0], (char *)msg + sizeof (struct orf_token),
  2953. sizeof (struct rtr_item) * RETRANSMIT_ENTRIES_MAX);
  2954. /*
  2955. * Handle merge detection timeout
  2956. */
  2957. if (token->seq == instance->my_last_seq) {
  2958. start_merge_detect_timeout (instance);
  2959. instance->my_seq_unchanged += 1;
  2960. } else {
  2961. cancel_merge_detect_timeout (instance);
  2962. cancel_token_hold_retransmit_timeout (instance);
  2963. instance->my_seq_unchanged = 0;
  2964. }
  2965. instance->my_last_seq = token->seq;
  2966. #ifdef TEST_RECOVERY_MSG_COUNT
  2967. if (instance->memb_state == MEMB_STATE_OPERATIONAL && token->seq > TEST_RECOVERY_MSG_COUNT) {
  2968. return (0);
  2969. }
  2970. #endif
  2971. instance->flushing = 1;
  2972. totemnet_recv_flush (instance->totemnet_context);
  2973. instance->flushing = 0;
  2974. /*
  2975. * Determine if we should hold (in reality drop) the token
  2976. */
  2977. instance->my_token_held = 0;
  2978. if (instance->my_ring_id.rep == instance->my_id.nodeid &&
  2979. instance->my_seq_unchanged > instance->totem_config->seqno_unchanged_const) {
  2980. instance->my_token_held = 1;
  2981. } else {
  2982. if (instance->my_ring_id.rep != instance->my_id.nodeid &&
  2983. instance->my_seq_unchanged >= instance->totem_config->seqno_unchanged_const) {
  2984. instance->my_token_held = 1;
  2985. }
  2986. }
  2987. /*
  2988. * Hold onto token when there is no activity on ring and
  2989. * this processor is the ring rep
  2990. */
  2991. forward_token = 1;
  2992. if (instance->my_ring_id.rep == instance->my_id.nodeid) {
  2993. if (instance->my_token_held) {
  2994. forward_token = 0;
  2995. }
  2996. }
  2997. token_callbacks_execute (instance, TOTEM_CALLBACK_TOKEN_RECEIVED);
  2998. switch (instance->memb_state) {
  2999. case MEMB_STATE_COMMIT:
  3000. /* Discard token */
  3001. break;
  3002. case MEMB_STATE_OPERATIONAL:
  3003. messages_free (instance, token->aru);
  3004. /*
  3005. * Do NOT add break, this case should also execute code in gather case.
  3006. */
  3007. case MEMB_STATE_GATHER:
  3008. /*
  3009. * DO NOT add break, we use different free mechanism in recovery state
  3010. */
  3011. case MEMB_STATE_RECOVERY:
  3012. /*
  3013. * Discard tokens from another configuration
  3014. */
  3015. if (memcmp (&token->ring_id, &instance->my_ring_id,
  3016. sizeof (struct memb_ring_id)) != 0) {
  3017. if ((forward_token)
  3018. && instance->use_heartbeat) {
  3019. reset_heartbeat_timeout(instance);
  3020. }
  3021. else {
  3022. cancel_heartbeat_timeout(instance);
  3023. }
  3024. return (0); /* discard token */
  3025. }
  3026. /*
  3027. * Discard retransmitted tokens
  3028. */
  3029. if (sq_lte_compare (token->token_seq, instance->my_token_seq)) {
  3030. return (0); /* discard token */
  3031. }
  3032. last_aru = instance->my_last_aru;
  3033. instance->my_last_aru = token->aru;
  3034. transmits_allowed = fcc_calculate (instance, token);
  3035. mcasted_retransmit = orf_token_rtr (instance, token, &transmits_allowed);
  3036. if (instance->my_token_held == 1 &&
  3037. (token->rtr_list_entries > 0 || mcasted_retransmit > 0)) {
  3038. instance->my_token_held = 0;
  3039. forward_token = 1;
  3040. }
  3041. fcc_rtr_limit (instance, token, &transmits_allowed);
  3042. mcasted_regular = orf_token_mcast (instance, token, transmits_allowed);
  3043. /*
  3044. if (mcasted_regular) {
  3045. printf ("mcasted regular %d\n", mcasted_regular);
  3046. printf ("token seq %d\n", token->seq);
  3047. }
  3048. */
  3049. fcc_token_update (instance, token, mcasted_retransmit +
  3050. mcasted_regular);
  3051. if (sq_lt_compare (instance->my_aru, token->aru) ||
  3052. instance->my_id.nodeid == token->aru_addr ||
  3053. token->aru_addr == 0) {
  3054. token->aru = instance->my_aru;
  3055. if (token->aru == token->seq) {
  3056. token->aru_addr = 0;
  3057. } else {
  3058. token->aru_addr = instance->my_id.nodeid;
  3059. }
  3060. }
  3061. if (token->aru == last_aru && token->aru_addr != 0) {
  3062. instance->my_aru_count += 1;
  3063. } else {
  3064. instance->my_aru_count = 0;
  3065. }
  3066. /*
  3067. * We really don't follow specification there. In specification, OTHER nodes
  3068. * detect failure of one node (based on aru_count) and my_id IS NEVER added
  3069. * to failed list (so node never mark itself as failed)
  3070. */
  3071. if (instance->my_aru_count > instance->totem_config->fail_to_recv_const &&
  3072. token->aru_addr == instance->my_id.nodeid) {
  3073. log_printf (instance->totemsrp_log_level_error,
  3074. "FAILED TO RECEIVE");
  3075. instance->failed_to_recv = 1;
  3076. memb_set_merge (&instance->my_id, 1,
  3077. instance->my_failed_list,
  3078. &instance->my_failed_list_entries);
  3079. memb_state_gather_enter (instance, TOTEMSRP_GSFROM_FAILED_TO_RECEIVE);
  3080. } else {
  3081. instance->my_token_seq = token->token_seq;
  3082. token->token_seq += 1;
  3083. if (instance->memb_state == MEMB_STATE_RECOVERY) {
  3084. /*
  3085. * instance->my_aru == instance->my_high_seq_received means this processor
  3086. * has recovered all messages it can recover
  3087. * (ie: its retrans queue is empty)
  3088. */
  3089. if (cs_queue_is_empty (&instance->retrans_message_queue) == 0) {
  3090. if (token->retrans_flg == 0) {
  3091. token->retrans_flg = 1;
  3092. instance->my_set_retrans_flg = 1;
  3093. }
  3094. } else
  3095. if (token->retrans_flg == 1 && instance->my_set_retrans_flg) {
  3096. token->retrans_flg = 0;
  3097. instance->my_set_retrans_flg = 0;
  3098. }
  3099. log_printf (instance->totemsrp_log_level_debug,
  3100. "token retrans flag is %d my set retrans flag%d retrans queue empty %d count %d, aru %x",
  3101. token->retrans_flg, instance->my_set_retrans_flg,
  3102. cs_queue_is_empty (&instance->retrans_message_queue),
  3103. instance->my_retrans_flg_count, token->aru);
  3104. if (token->retrans_flg == 0) {
  3105. instance->my_retrans_flg_count += 1;
  3106. } else {
  3107. instance->my_retrans_flg_count = 0;
  3108. }
  3109. if (instance->my_retrans_flg_count == 2) {
  3110. instance->my_install_seq = token->seq;
  3111. }
  3112. log_printf (instance->totemsrp_log_level_debug,
  3113. "install seq %x aru %x high seq received %x",
  3114. instance->my_install_seq, instance->my_aru, instance->my_high_seq_received);
  3115. if (instance->my_retrans_flg_count >= 2 &&
  3116. instance->my_received_flg == 0 &&
  3117. sq_lte_compare (instance->my_install_seq, instance->my_aru)) {
  3118. instance->my_received_flg = 1;
  3119. instance->my_deliver_memb_entries = instance->my_trans_memb_entries;
  3120. memcpy (instance->my_deliver_memb_list, instance->my_trans_memb_list,
  3121. sizeof (struct totem_ip_address) * instance->my_trans_memb_entries);
  3122. }
  3123. if (instance->my_retrans_flg_count >= 3 &&
  3124. sq_lte_compare (instance->my_install_seq, token->aru)) {
  3125. instance->my_rotation_counter += 1;
  3126. } else {
  3127. instance->my_rotation_counter = 0;
  3128. }
  3129. if (instance->my_rotation_counter == 2) {
  3130. log_printf (instance->totemsrp_log_level_debug,
  3131. "retrans flag count %x token aru %x install seq %x aru %x %x",
  3132. instance->my_retrans_flg_count, token->aru, instance->my_install_seq,
  3133. instance->my_aru, token->seq);
  3134. memb_state_operational_enter (instance);
  3135. instance->my_rotation_counter = 0;
  3136. instance->my_retrans_flg_count = 0;
  3137. }
  3138. }
  3139. totemnet_send_flush (instance->totemnet_context);
  3140. token_send (instance, token, forward_token);
  3141. #ifdef GIVEINFO
  3142. tv_current = qb_util_nano_current_get ();
  3143. tv_diff = tv_current - tv_old;
  3144. tv_old = tv_current;
  3145. log_printf (instance->totemsrp_log_level_debug,
  3146. "I held %0.4f ms",
  3147. ((float)tv_diff) / 1000000.0);
  3148. #endif
  3149. if (instance->memb_state == MEMB_STATE_OPERATIONAL) {
  3150. messages_deliver_to_app (instance, 0,
  3151. instance->my_high_seq_received);
  3152. }
  3153. /*
  3154. * Deliver messages after token has been transmitted
  3155. * to improve performance
  3156. */
  3157. reset_token_timeout (instance); // REVIEWED
  3158. reset_token_retransmit_timeout (instance); // REVIEWED
  3159. if (instance->my_id.nodeid == instance->my_ring_id.rep &&
  3160. instance->my_token_held == 1) {
  3161. start_token_hold_retransmit_timeout (instance);
  3162. }
  3163. token_callbacks_execute (instance, TOTEM_CALLBACK_TOKEN_SENT);
  3164. }
  3165. break;
  3166. }
  3167. if ((forward_token)
  3168. && instance->use_heartbeat) {
  3169. reset_heartbeat_timeout(instance);
  3170. }
  3171. else {
  3172. cancel_heartbeat_timeout(instance);
  3173. }
  3174. return (0);
  3175. }
  3176. static void messages_deliver_to_app (
  3177. struct totemsrp_instance *instance,
  3178. int skip,
  3179. unsigned int end_point)
  3180. {
  3181. struct sort_queue_item *sort_queue_item_p;
  3182. unsigned int i;
  3183. int res;
  3184. struct mcast *mcast_in;
  3185. struct mcast mcast_header;
  3186. unsigned int range = 0;
  3187. int endian_conversion_required;
  3188. unsigned int my_high_delivered_stored = 0;
  3189. range = end_point - instance->my_high_delivered;
  3190. if (range) {
  3191. log_printf (instance->totemsrp_log_level_trace,
  3192. "Delivering %x to %x", instance->my_high_delivered,
  3193. end_point);
  3194. }
  3195. assert (range < QUEUE_RTR_ITEMS_SIZE_MAX);
  3196. my_high_delivered_stored = instance->my_high_delivered;
  3197. /*
  3198. * Deliver messages in order from rtr queue to pending delivery queue
  3199. */
  3200. for (i = 1; i <= range; i++) {
  3201. void *ptr = 0;
  3202. /*
  3203. * If out of range of sort queue, stop assembly
  3204. */
  3205. res = sq_in_range (&instance->regular_sort_queue,
  3206. my_high_delivered_stored + i);
  3207. if (res == 0) {
  3208. break;
  3209. }
  3210. res = sq_item_get (&instance->regular_sort_queue,
  3211. my_high_delivered_stored + i, &ptr);
  3212. /*
  3213. * If hole, stop assembly
  3214. */
  3215. if (res != 0 && skip == 0) {
  3216. break;
  3217. }
  3218. instance->my_high_delivered = my_high_delivered_stored + i;
  3219. if (res != 0) {
  3220. continue;
  3221. }
  3222. sort_queue_item_p = ptr;
  3223. mcast_in = sort_queue_item_p->mcast;
  3224. assert (mcast_in != (struct mcast *)0xdeadbeef);
  3225. endian_conversion_required = 0;
  3226. if (mcast_in->header.endian_detector != ENDIAN_LOCAL) {
  3227. endian_conversion_required = 1;
  3228. mcast_endian_convert (mcast_in, &mcast_header);
  3229. } else {
  3230. memcpy (&mcast_header, mcast_in, sizeof (struct mcast));
  3231. }
  3232. /*
  3233. * Skip messages not originated in instance->my_deliver_memb
  3234. */
  3235. if (skip &&
  3236. memb_set_subset (&mcast_header.system_from,
  3237. 1,
  3238. instance->my_deliver_memb_list,
  3239. instance->my_deliver_memb_entries) == 0) {
  3240. instance->my_high_delivered = my_high_delivered_stored + i;
  3241. continue;
  3242. }
  3243. /*
  3244. * Message found
  3245. */
  3246. log_printf (instance->totemsrp_log_level_trace,
  3247. "Delivering MCAST message with seq %x to pending delivery queue",
  3248. mcast_header.seq);
  3249. /*
  3250. * Message is locally originated multicast
  3251. */
  3252. instance->totemsrp_deliver_fn (
  3253. mcast_header.header.nodeid,
  3254. ((char *)sort_queue_item_p->mcast) + sizeof (struct mcast),
  3255. sort_queue_item_p->msg_len - sizeof (struct mcast),
  3256. endian_conversion_required);
  3257. }
  3258. }
  3259. /*
  3260. * recv message handler called when MCAST message type received
  3261. */
  3262. static int message_handler_mcast (
  3263. struct totemsrp_instance *instance,
  3264. const void *msg,
  3265. size_t msg_len,
  3266. int endian_conversion_needed)
  3267. {
  3268. struct sort_queue_item sort_queue_item;
  3269. struct sq *sort_queue;
  3270. struct mcast mcast_header;
  3271. if (endian_conversion_needed) {
  3272. mcast_endian_convert (msg, &mcast_header);
  3273. } else {
  3274. memcpy (&mcast_header, msg, sizeof (struct mcast));
  3275. }
  3276. if (mcast_header.header.encapsulated == MESSAGE_ENCAPSULATED) {
  3277. sort_queue = &instance->recovery_sort_queue;
  3278. } else {
  3279. sort_queue = &instance->regular_sort_queue;
  3280. }
  3281. assert (msg_len <= FRAME_SIZE_MAX);
  3282. #ifdef TEST_DROP_MCAST_PERCENTAGE
  3283. if (random()%100 < TEST_DROP_MCAST_PERCENTAGE) {
  3284. return (0);
  3285. }
  3286. #endif
  3287. /*
  3288. * If the message is foreign execute the switch below
  3289. */
  3290. if (memcmp (&instance->my_ring_id, &mcast_header.ring_id,
  3291. sizeof (struct memb_ring_id)) != 0) {
  3292. switch (instance->memb_state) {
  3293. case MEMB_STATE_OPERATIONAL:
  3294. memb_set_merge (
  3295. &mcast_header.system_from, 1,
  3296. instance->my_proc_list, &instance->my_proc_list_entries);
  3297. memb_state_gather_enter (instance, TOTEMSRP_GSFROM_FOREIGN_MESSAGE_IN_OPERATIONAL_STATE);
  3298. break;
  3299. case MEMB_STATE_GATHER:
  3300. if (!memb_set_subset (
  3301. &mcast_header.system_from,
  3302. 1,
  3303. instance->my_proc_list,
  3304. instance->my_proc_list_entries)) {
  3305. memb_set_merge (&mcast_header.system_from, 1,
  3306. instance->my_proc_list, &instance->my_proc_list_entries);
  3307. memb_state_gather_enter (instance, TOTEMSRP_GSFROM_FOREIGN_MESSAGE_IN_GATHER_STATE);
  3308. return (0);
  3309. }
  3310. break;
  3311. case MEMB_STATE_COMMIT:
  3312. /* discard message */
  3313. instance->stats.rx_msg_dropped++;
  3314. break;
  3315. case MEMB_STATE_RECOVERY:
  3316. /* discard message */
  3317. instance->stats.rx_msg_dropped++;
  3318. break;
  3319. }
  3320. return (0);
  3321. }
  3322. log_printf (instance->totemsrp_log_level_trace,
  3323. "Received ringid(%u:%lld) seq %x",
  3324. mcast_header.ring_id.rep,
  3325. mcast_header.ring_id.seq,
  3326. mcast_header.seq);
  3327. /*
  3328. * Add mcast message to rtr queue if not already in rtr queue
  3329. * otherwise free io vectors
  3330. */
  3331. if (msg_len > 0 && msg_len <= FRAME_SIZE_MAX &&
  3332. sq_in_range (sort_queue, mcast_header.seq) &&
  3333. sq_item_inuse (sort_queue, mcast_header.seq) == 0) {
  3334. /*
  3335. * Allocate new multicast memory block
  3336. */
  3337. // TODO LEAK
  3338. sort_queue_item.mcast = totemsrp_buffer_alloc (instance);
  3339. if (sort_queue_item.mcast == NULL) {
  3340. return (-1); /* error here is corrected by the algorithm */
  3341. }
  3342. memcpy (sort_queue_item.mcast, msg, msg_len);
  3343. sort_queue_item.msg_len = msg_len;
  3344. if (sq_lt_compare (instance->my_high_seq_received,
  3345. mcast_header.seq)) {
  3346. instance->my_high_seq_received = mcast_header.seq;
  3347. }
  3348. sq_item_add (sort_queue, &sort_queue_item, mcast_header.seq);
  3349. }
  3350. update_aru (instance);
  3351. if (instance->memb_state == MEMB_STATE_OPERATIONAL) {
  3352. messages_deliver_to_app (instance, 0, instance->my_high_seq_received);
  3353. }
  3354. /* TODO remove from retrans message queue for old ring in recovery state */
  3355. return (0);
  3356. }
  3357. static int message_handler_memb_merge_detect (
  3358. struct totemsrp_instance *instance,
  3359. const void *msg,
  3360. size_t msg_len,
  3361. int endian_conversion_needed)
  3362. {
  3363. struct memb_merge_detect memb_merge_detect;
  3364. if (endian_conversion_needed) {
  3365. memb_merge_detect_endian_convert (msg, &memb_merge_detect);
  3366. } else {
  3367. memcpy (&memb_merge_detect, msg,
  3368. sizeof (struct memb_merge_detect));
  3369. }
  3370. /*
  3371. * do nothing if this is a merge detect from this configuration
  3372. */
  3373. if (memcmp (&instance->my_ring_id, &memb_merge_detect.ring_id,
  3374. sizeof (struct memb_ring_id)) == 0) {
  3375. return (0);
  3376. }
  3377. /*
  3378. * Execute merge operation
  3379. */
  3380. switch (instance->memb_state) {
  3381. case MEMB_STATE_OPERATIONAL:
  3382. memb_set_merge (&memb_merge_detect.system_from, 1,
  3383. instance->my_proc_list, &instance->my_proc_list_entries);
  3384. memb_state_gather_enter (instance, TOTEMSRP_GSFROM_MERGE_DURING_OPERATIONAL_STATE);
  3385. break;
  3386. case MEMB_STATE_GATHER:
  3387. if (!memb_set_subset (
  3388. &memb_merge_detect.system_from,
  3389. 1,
  3390. instance->my_proc_list,
  3391. instance->my_proc_list_entries)) {
  3392. memb_set_merge (&memb_merge_detect.system_from, 1,
  3393. instance->my_proc_list, &instance->my_proc_list_entries);
  3394. memb_state_gather_enter (instance, TOTEMSRP_GSFROM_MERGE_DURING_GATHER_STATE);
  3395. return (0);
  3396. }
  3397. break;
  3398. case MEMB_STATE_COMMIT:
  3399. /* do nothing in commit */
  3400. break;
  3401. case MEMB_STATE_RECOVERY:
  3402. /* do nothing in recovery */
  3403. break;
  3404. }
  3405. return (0);
  3406. }
  3407. static void memb_join_process (
  3408. struct totemsrp_instance *instance,
  3409. const struct memb_join *memb_join)
  3410. {
  3411. struct srp_addr *proc_list;
  3412. struct srp_addr *failed_list;
  3413. int gather_entered = 0;
  3414. int fail_minus_memb_entries = 0;
  3415. struct srp_addr fail_minus_memb[PROCESSOR_COUNT_MAX];
  3416. proc_list = (struct srp_addr *)memb_join->end_of_memb_join;
  3417. failed_list = proc_list + memb_join->proc_list_entries;
  3418. /*
  3419. memb_set_print ("proclist", proc_list, memb_join->proc_list_entries);
  3420. memb_set_print ("faillist", failed_list, memb_join->failed_list_entries);
  3421. memb_set_print ("my_proclist", instance->my_proc_list, instance->my_proc_list_entries);
  3422. memb_set_print ("my_faillist", instance->my_failed_list, instance->my_failed_list_entries);
  3423. -*/
  3424. if (memb_join->header.type == MESSAGE_TYPE_MEMB_JOIN) {
  3425. if (instance->flushing) {
  3426. if (memb_join->header.nodeid == LEAVE_DUMMY_NODEID) {
  3427. log_printf (instance->totemsrp_log_level_warning,
  3428. "Discarding LEAVE message during flush, nodeid=%u",
  3429. memb_join->failed_list_entries > 0 ? failed_list[memb_join->failed_list_entries - 1 ].nodeid : LEAVE_DUMMY_NODEID);
  3430. if (memb_join->failed_list_entries > 0) {
  3431. my_leave_memb_set(instance, failed_list[memb_join->failed_list_entries - 1 ].nodeid);
  3432. }
  3433. } else {
  3434. log_printf (instance->totemsrp_log_level_warning,
  3435. "Discarding JOIN message during flush, nodeid=%d", memb_join->header.nodeid);
  3436. }
  3437. return;
  3438. } else {
  3439. if (memb_join->header.nodeid == LEAVE_DUMMY_NODEID) {
  3440. log_printf (instance->totemsrp_log_level_debug,
  3441. "Received LEAVE message from %u", memb_join->failed_list_entries > 0 ? failed_list[memb_join->failed_list_entries - 1 ].nodeid : LEAVE_DUMMY_NODEID);
  3442. if (memb_join->failed_list_entries > 0) {
  3443. my_leave_memb_set(instance, failed_list[memb_join->failed_list_entries - 1 ].nodeid);
  3444. }
  3445. }
  3446. }
  3447. }
  3448. if (memb_set_equal (proc_list,
  3449. memb_join->proc_list_entries,
  3450. instance->my_proc_list,
  3451. instance->my_proc_list_entries) &&
  3452. memb_set_equal (failed_list,
  3453. memb_join->failed_list_entries,
  3454. instance->my_failed_list,
  3455. instance->my_failed_list_entries)) {
  3456. memb_consensus_set (instance, &memb_join->system_from);
  3457. if (memb_consensus_agreed (instance) && instance->failed_to_recv == 1) {
  3458. instance->failed_to_recv = 0;
  3459. srp_addr_copy (&instance->my_proc_list[0],
  3460. &instance->my_id);
  3461. instance->my_proc_list_entries = 1;
  3462. instance->my_failed_list_entries = 0;
  3463. memb_state_commit_token_create (instance);
  3464. memb_state_commit_enter (instance);
  3465. return;
  3466. }
  3467. if (memb_consensus_agreed (instance) &&
  3468. memb_lowest_in_config (instance)) {
  3469. memb_state_commit_token_create (instance);
  3470. memb_state_commit_enter (instance);
  3471. } else {
  3472. goto out;
  3473. }
  3474. } else
  3475. if (memb_set_subset (proc_list,
  3476. memb_join->proc_list_entries,
  3477. instance->my_proc_list,
  3478. instance->my_proc_list_entries) &&
  3479. memb_set_subset (failed_list,
  3480. memb_join->failed_list_entries,
  3481. instance->my_failed_list,
  3482. instance->my_failed_list_entries)) {
  3483. goto out;
  3484. } else
  3485. if (memb_set_subset (&memb_join->system_from, 1,
  3486. instance->my_failed_list, instance->my_failed_list_entries)) {
  3487. goto out;
  3488. } else {
  3489. memb_set_merge (proc_list,
  3490. memb_join->proc_list_entries,
  3491. instance->my_proc_list, &instance->my_proc_list_entries);
  3492. if (memb_set_subset (
  3493. &instance->my_id, 1,
  3494. failed_list, memb_join->failed_list_entries)) {
  3495. memb_set_merge (
  3496. &memb_join->system_from, 1,
  3497. instance->my_failed_list, &instance->my_failed_list_entries);
  3498. } else {
  3499. if (memb_set_subset (
  3500. &memb_join->system_from, 1,
  3501. instance->my_memb_list,
  3502. instance->my_memb_entries)) {
  3503. if (memb_set_subset (
  3504. &memb_join->system_from, 1,
  3505. instance->my_failed_list,
  3506. instance->my_failed_list_entries) == 0) {
  3507. memb_set_merge (failed_list,
  3508. memb_join->failed_list_entries,
  3509. instance->my_failed_list, &instance->my_failed_list_entries);
  3510. } else {
  3511. memb_set_subtract (fail_minus_memb,
  3512. &fail_minus_memb_entries,
  3513. failed_list,
  3514. memb_join->failed_list_entries,
  3515. instance->my_memb_list,
  3516. instance->my_memb_entries);
  3517. memb_set_merge (fail_minus_memb,
  3518. fail_minus_memb_entries,
  3519. instance->my_failed_list,
  3520. &instance->my_failed_list_entries);
  3521. }
  3522. }
  3523. }
  3524. memb_state_gather_enter (instance, TOTEMSRP_GSFROM_MERGE_DURING_JOIN);
  3525. gather_entered = 1;
  3526. }
  3527. out:
  3528. if (gather_entered == 0 &&
  3529. instance->memb_state == MEMB_STATE_OPERATIONAL) {
  3530. memb_state_gather_enter (instance, TOTEMSRP_GSFROM_JOIN_DURING_OPERATIONAL_STATE);
  3531. }
  3532. }
  3533. static void memb_join_endian_convert (const struct memb_join *in, struct memb_join *out)
  3534. {
  3535. int i;
  3536. struct srp_addr *in_proc_list;
  3537. struct srp_addr *in_failed_list;
  3538. struct srp_addr *out_proc_list;
  3539. struct srp_addr *out_failed_list;
  3540. out->header.type = in->header.type;
  3541. out->header.endian_detector = ENDIAN_LOCAL;
  3542. out->header.nodeid = swab32 (in->header.nodeid);
  3543. srp_addr_copy_endian_convert (&out->system_from, &in->system_from);
  3544. out->proc_list_entries = swab32 (in->proc_list_entries);
  3545. out->failed_list_entries = swab32 (in->failed_list_entries);
  3546. out->ring_seq = swab64 (in->ring_seq);
  3547. in_proc_list = (struct srp_addr *)in->end_of_memb_join;
  3548. in_failed_list = in_proc_list + out->proc_list_entries;
  3549. out_proc_list = (struct srp_addr *)out->end_of_memb_join;
  3550. out_failed_list = out_proc_list + out->proc_list_entries;
  3551. for (i = 0; i < out->proc_list_entries; i++) {
  3552. srp_addr_copy_endian_convert (&out_proc_list[i], &in_proc_list[i]);
  3553. }
  3554. for (i = 0; i < out->failed_list_entries; i++) {
  3555. srp_addr_copy_endian_convert (&out_failed_list[i], &in_failed_list[i]);
  3556. }
  3557. }
  3558. static void memb_commit_token_endian_convert (const struct memb_commit_token *in, struct memb_commit_token *out)
  3559. {
  3560. int i;
  3561. struct srp_addr *in_addr = (struct srp_addr *)in->end_of_commit_token;
  3562. struct srp_addr *out_addr = (struct srp_addr *)out->end_of_commit_token;
  3563. struct memb_commit_token_memb_entry *in_memb_list;
  3564. struct memb_commit_token_memb_entry *out_memb_list;
  3565. out->header.type = in->header.type;
  3566. out->header.endian_detector = ENDIAN_LOCAL;
  3567. out->header.nodeid = swab32 (in->header.nodeid);
  3568. out->token_seq = swab32 (in->token_seq);
  3569. out->ring_id.rep = swab32(in->ring_id.rep);
  3570. out->ring_id.seq = swab64 (in->ring_id.seq);
  3571. out->retrans_flg = swab32 (in->retrans_flg);
  3572. out->memb_index = swab32 (in->memb_index);
  3573. out->addr_entries = swab32 (in->addr_entries);
  3574. in_memb_list = (struct memb_commit_token_memb_entry *)(in_addr + out->addr_entries);
  3575. out_memb_list = (struct memb_commit_token_memb_entry *)(out_addr + out->addr_entries);
  3576. for (i = 0; i < out->addr_entries; i++) {
  3577. srp_addr_copy_endian_convert (&out_addr[i], &in_addr[i]);
  3578. /*
  3579. * Only convert the memb entry if it has been set
  3580. */
  3581. if (in_memb_list[i].ring_id.rep != 0) {
  3582. out_memb_list[i].ring_id.rep = swab32(in_memb_list[i].ring_id.rep);
  3583. out_memb_list[i].ring_id.seq =
  3584. swab64 (in_memb_list[i].ring_id.seq);
  3585. out_memb_list[i].aru = swab32 (in_memb_list[i].aru);
  3586. out_memb_list[i].high_delivered = swab32 (in_memb_list[i].high_delivered);
  3587. out_memb_list[i].received_flg = swab32 (in_memb_list[i].received_flg);
  3588. }
  3589. }
  3590. }
  3591. static void orf_token_endian_convert (const struct orf_token *in, struct orf_token *out)
  3592. {
  3593. int i;
  3594. out->header.type = in->header.type;
  3595. out->header.endian_detector = ENDIAN_LOCAL;
  3596. out->header.nodeid = swab32 (in->header.nodeid);
  3597. out->seq = swab32 (in->seq);
  3598. out->token_seq = swab32 (in->token_seq);
  3599. out->aru = swab32 (in->aru);
  3600. out->ring_id.rep = swab32(in->ring_id.rep);
  3601. out->aru_addr = swab32(in->aru_addr);
  3602. out->ring_id.seq = swab64 (in->ring_id.seq);
  3603. out->fcc = swab32 (in->fcc);
  3604. out->backlog = swab32 (in->backlog);
  3605. out->retrans_flg = swab32 (in->retrans_flg);
  3606. out->rtr_list_entries = swab32 (in->rtr_list_entries);
  3607. for (i = 0; i < out->rtr_list_entries; i++) {
  3608. out->rtr_list[i].ring_id.rep = swab32(in->rtr_list[i].ring_id.rep);
  3609. out->rtr_list[i].ring_id.seq = swab64 (in->rtr_list[i].ring_id.seq);
  3610. out->rtr_list[i].seq = swab32 (in->rtr_list[i].seq);
  3611. }
  3612. }
  3613. static void mcast_endian_convert (const struct mcast *in, struct mcast *out)
  3614. {
  3615. out->header.type = in->header.type;
  3616. out->header.endian_detector = ENDIAN_LOCAL;
  3617. out->header.nodeid = swab32 (in->header.nodeid);
  3618. out->header.encapsulated = in->header.encapsulated;
  3619. out->seq = swab32 (in->seq);
  3620. out->this_seqno = swab32 (in->this_seqno);
  3621. out->ring_id.rep = swab32(in->ring_id.rep);
  3622. out->ring_id.seq = swab64 (in->ring_id.seq);
  3623. out->node_id = swab32 (in->node_id);
  3624. out->guarantee = swab32 (in->guarantee);
  3625. srp_addr_copy_endian_convert (&out->system_from, &in->system_from);
  3626. }
  3627. static void memb_merge_detect_endian_convert (
  3628. const struct memb_merge_detect *in,
  3629. struct memb_merge_detect *out)
  3630. {
  3631. out->header.type = in->header.type;
  3632. out->header.endian_detector = ENDIAN_LOCAL;
  3633. out->header.nodeid = swab32 (in->header.nodeid);
  3634. out->ring_id.rep = swab32(in->ring_id.rep);
  3635. out->ring_id.seq = swab64 (in->ring_id.seq);
  3636. srp_addr_copy_endian_convert (&out->system_from, &in->system_from);
  3637. }
  3638. static int ignore_join_under_operational (
  3639. struct totemsrp_instance *instance,
  3640. const struct memb_join *memb_join)
  3641. {
  3642. struct srp_addr *proc_list;
  3643. struct srp_addr *failed_list;
  3644. unsigned long long ring_seq;
  3645. proc_list = (struct srp_addr *)memb_join->end_of_memb_join;
  3646. failed_list = proc_list + memb_join->proc_list_entries;
  3647. ring_seq = memb_join->ring_seq;
  3648. if (memb_set_subset (&instance->my_id, 1,
  3649. failed_list, memb_join->failed_list_entries)) {
  3650. return (1);
  3651. }
  3652. /*
  3653. * In operational state, my_proc_list is exactly the same as
  3654. * my_memb_list.
  3655. */
  3656. if ((memb_set_subset (&memb_join->system_from, 1,
  3657. instance->my_memb_list, instance->my_memb_entries)) &&
  3658. (ring_seq < instance->my_ring_id.seq)) {
  3659. return (1);
  3660. }
  3661. return (0);
  3662. }
  3663. static int message_handler_memb_join (
  3664. struct totemsrp_instance *instance,
  3665. const void *msg,
  3666. size_t msg_len,
  3667. int endian_conversion_needed)
  3668. {
  3669. const struct memb_join *memb_join;
  3670. struct memb_join *memb_join_convert = alloca (msg_len);
  3671. if (endian_conversion_needed) {
  3672. memb_join = memb_join_convert;
  3673. memb_join_endian_convert (msg, memb_join_convert);
  3674. } else {
  3675. memb_join = msg;
  3676. }
  3677. /*
  3678. * If the process paused because it wasn't scheduled in a timely
  3679. * fashion, flush the join messages because they may be queued
  3680. * entries
  3681. */
  3682. if (pause_flush (instance)) {
  3683. return (0);
  3684. }
  3685. if (instance->token_ring_id_seq < memb_join->ring_seq) {
  3686. instance->token_ring_id_seq = memb_join->ring_seq;
  3687. }
  3688. switch (instance->memb_state) {
  3689. case MEMB_STATE_OPERATIONAL:
  3690. if (!ignore_join_under_operational (instance, memb_join)) {
  3691. memb_join_process (instance, memb_join);
  3692. }
  3693. break;
  3694. case MEMB_STATE_GATHER:
  3695. memb_join_process (instance, memb_join);
  3696. break;
  3697. case MEMB_STATE_COMMIT:
  3698. if (memb_set_subset (&memb_join->system_from,
  3699. 1,
  3700. instance->my_new_memb_list,
  3701. instance->my_new_memb_entries) &&
  3702. memb_join->ring_seq >= instance->my_ring_id.seq) {
  3703. memb_join_process (instance, memb_join);
  3704. memb_state_gather_enter (instance, TOTEMSRP_GSFROM_JOIN_DURING_COMMIT_STATE);
  3705. }
  3706. break;
  3707. case MEMB_STATE_RECOVERY:
  3708. if (memb_set_subset (&memb_join->system_from,
  3709. 1,
  3710. instance->my_new_memb_list,
  3711. instance->my_new_memb_entries) &&
  3712. memb_join->ring_seq >= instance->my_ring_id.seq) {
  3713. memb_join_process (instance, memb_join);
  3714. memb_recovery_state_token_loss (instance);
  3715. memb_state_gather_enter (instance, TOTEMSRP_GSFROM_JOIN_DURING_RECOVERY);
  3716. }
  3717. break;
  3718. }
  3719. return (0);
  3720. }
  3721. static int message_handler_memb_commit_token (
  3722. struct totemsrp_instance *instance,
  3723. const void *msg,
  3724. size_t msg_len,
  3725. int endian_conversion_needed)
  3726. {
  3727. struct memb_commit_token *memb_commit_token_convert = alloca (msg_len);
  3728. struct memb_commit_token *memb_commit_token;
  3729. struct srp_addr sub[PROCESSOR_COUNT_MAX];
  3730. int sub_entries;
  3731. struct srp_addr *addr;
  3732. log_printf (instance->totemsrp_log_level_debug,
  3733. "got commit token");
  3734. if (endian_conversion_needed) {
  3735. memb_commit_token_endian_convert (msg, memb_commit_token_convert);
  3736. } else {
  3737. memcpy (memb_commit_token_convert, msg, msg_len);
  3738. }
  3739. memb_commit_token = memb_commit_token_convert;
  3740. addr = (struct srp_addr *)memb_commit_token->end_of_commit_token;
  3741. #ifdef TEST_DROP_COMMIT_TOKEN_PERCENTAGE
  3742. if (random()%100 < TEST_DROP_COMMIT_TOKEN_PERCENTAGE) {
  3743. return (0);
  3744. }
  3745. #endif
  3746. switch (instance->memb_state) {
  3747. case MEMB_STATE_OPERATIONAL:
  3748. /* discard token */
  3749. break;
  3750. case MEMB_STATE_GATHER:
  3751. memb_set_subtract (sub, &sub_entries,
  3752. instance->my_proc_list, instance->my_proc_list_entries,
  3753. instance->my_failed_list, instance->my_failed_list_entries);
  3754. if (memb_set_equal (addr,
  3755. memb_commit_token->addr_entries,
  3756. sub,
  3757. sub_entries) &&
  3758. memb_commit_token->ring_id.seq > instance->my_ring_id.seq) {
  3759. memcpy (instance->commit_token, memb_commit_token, msg_len);
  3760. memb_state_commit_enter (instance);
  3761. }
  3762. break;
  3763. case MEMB_STATE_COMMIT:
  3764. /*
  3765. * If retransmitted commit tokens are sent on this ring
  3766. * filter them out and only enter recovery once the
  3767. * commit token has traversed the array. This is
  3768. * determined by :
  3769. * memb_commit_token->memb_index == memb_commit_token->addr_entries) {
  3770. */
  3771. if (memb_commit_token->ring_id.seq == instance->my_ring_id.seq &&
  3772. memb_commit_token->memb_index == memb_commit_token->addr_entries) {
  3773. memb_state_recovery_enter (instance, memb_commit_token);
  3774. }
  3775. break;
  3776. case MEMB_STATE_RECOVERY:
  3777. if (instance->my_id.nodeid == instance->my_ring_id.rep) {
  3778. /* Filter out duplicated tokens */
  3779. if (instance->originated_orf_token) {
  3780. break;
  3781. }
  3782. instance->originated_orf_token = 1;
  3783. log_printf (instance->totemsrp_log_level_debug,
  3784. "Sending initial ORF token");
  3785. // TODO convert instead of initiate
  3786. orf_token_send_initial (instance);
  3787. reset_token_timeout (instance); // REVIEWED
  3788. reset_token_retransmit_timeout (instance); // REVIEWED
  3789. }
  3790. break;
  3791. }
  3792. return (0);
  3793. }
  3794. static int message_handler_token_hold_cancel (
  3795. struct totemsrp_instance *instance,
  3796. const void *msg,
  3797. size_t msg_len,
  3798. int endian_conversion_needed)
  3799. {
  3800. const struct token_hold_cancel *token_hold_cancel = msg;
  3801. if (memcmp (&token_hold_cancel->ring_id, &instance->my_ring_id,
  3802. sizeof (struct memb_ring_id)) == 0) {
  3803. instance->my_seq_unchanged = 0;
  3804. if (instance->my_ring_id.rep == instance->my_id.nodeid) {
  3805. timer_function_token_retransmit_timeout (instance);
  3806. }
  3807. }
  3808. return (0);
  3809. }
  3810. void main_deliver_fn (
  3811. void *context,
  3812. const void *msg,
  3813. unsigned int msg_len)
  3814. {
  3815. struct totemsrp_instance *instance = context;
  3816. const struct totem_message_header *message_header = msg;
  3817. if (msg_len < sizeof (struct totem_message_header)) {
  3818. log_printf (instance->totemsrp_log_level_security,
  3819. "Received message is too short... ignoring %u.",
  3820. (unsigned int)msg_len);
  3821. return;
  3822. }
  3823. switch (message_header->type) {
  3824. case MESSAGE_TYPE_ORF_TOKEN:
  3825. instance->stats.orf_token_rx++;
  3826. break;
  3827. case MESSAGE_TYPE_MCAST:
  3828. instance->stats.mcast_rx++;
  3829. break;
  3830. case MESSAGE_TYPE_MEMB_MERGE_DETECT:
  3831. instance->stats.memb_merge_detect_rx++;
  3832. break;
  3833. case MESSAGE_TYPE_MEMB_JOIN:
  3834. instance->stats.memb_join_rx++;
  3835. break;
  3836. case MESSAGE_TYPE_MEMB_COMMIT_TOKEN:
  3837. instance->stats.memb_commit_token_rx++;
  3838. break;
  3839. case MESSAGE_TYPE_TOKEN_HOLD_CANCEL:
  3840. instance->stats.token_hold_cancel_rx++;
  3841. break;
  3842. default:
  3843. log_printf (instance->totemsrp_log_level_security, "Type of received message is wrong... ignoring %d.\n", (int)message_header->type);
  3844. printf ("wrong message type\n");
  3845. instance->stats.rx_msg_dropped++;
  3846. return;
  3847. }
  3848. /*
  3849. * Handle incoming message
  3850. */
  3851. totemsrp_message_handlers.handler_functions[(int)message_header->type] (
  3852. instance,
  3853. msg,
  3854. msg_len,
  3855. message_header->endian_detector != ENDIAN_LOCAL);
  3856. }
  3857. int totemsrp_iface_set (
  3858. void *context,
  3859. const struct totem_ip_address *interface_addr,
  3860. unsigned short ip_port,
  3861. unsigned int iface_no)
  3862. {
  3863. struct totemsrp_instance *instance = context;
  3864. int res;
  3865. totemip_copy(&instance->my_addrs[iface_no], interface_addr);
  3866. res = totemnet_iface_set (
  3867. instance->totemnet_context,
  3868. interface_addr,
  3869. ip_port,
  3870. iface_no);
  3871. return (res);
  3872. }
  3873. void main_iface_change_fn (
  3874. void *context,
  3875. const struct totem_ip_address *iface_addr,
  3876. unsigned int iface_no)
  3877. {
  3878. struct totemsrp_instance *instance = context;
  3879. int num_interfaces;
  3880. int i;
  3881. if (!instance->my_id.nodeid) {
  3882. instance->my_id.nodeid = iface_addr->nodeid;
  3883. }
  3884. totemip_copy (&instance->my_addrs[iface_no], iface_addr);
  3885. if (instance->iface_changes++ == 0) {
  3886. instance->memb_ring_id_create_or_load (&instance->my_ring_id, instance->my_id.nodeid);
  3887. instance->token_ring_id_seq = instance->my_ring_id.seq;
  3888. log_printf (
  3889. instance->totemsrp_log_level_debug,
  3890. "Created or loaded sequence id %llx.%u for this ring.",
  3891. instance->my_ring_id.seq,
  3892. instance->my_ring_id.rep);
  3893. if (instance->totemsrp_service_ready_fn) {
  3894. instance->totemsrp_service_ready_fn ();
  3895. }
  3896. }
  3897. for (i = 0; i < instance->totem_config->interfaces[iface_no].member_count; i++) {
  3898. totemsrp_member_add (instance,
  3899. &instance->totem_config->interfaces[iface_no].member_list[i],
  3900. iface_no);
  3901. }
  3902. num_interfaces = 0;
  3903. for (i = 0; i < INTERFACE_MAX; i++) {
  3904. if (instance->totem_config->interfaces[i].configured) {
  3905. num_interfaces++;
  3906. }
  3907. }
  3908. if (instance->iface_changes >= num_interfaces) {
  3909. memb_state_gather_enter (instance, TOTEMSRP_GSFROM_INTERFACE_CHANGE);
  3910. }
  3911. }
  3912. void totemsrp_net_mtu_adjust (struct totem_config *totem_config) {
  3913. totem_config->net_mtu -= sizeof (struct mcast);
  3914. }
  3915. void totemsrp_service_ready_register (
  3916. void *context,
  3917. void (*totem_service_ready) (void))
  3918. {
  3919. struct totemsrp_instance *instance = (struct totemsrp_instance *)context;
  3920. instance->totemsrp_service_ready_fn = totem_service_ready;
  3921. }
  3922. int totemsrp_member_add (
  3923. void *context,
  3924. const struct totem_ip_address *member,
  3925. int iface_no)
  3926. {
  3927. struct totemsrp_instance *instance = (struct totemsrp_instance *)context;
  3928. int res;
  3929. res = totemnet_member_add (instance->totemnet_context, &instance->my_addrs[iface_no], member, iface_no);
  3930. return (res);
  3931. }
  3932. int totemsrp_member_remove (
  3933. void *context,
  3934. const struct totem_ip_address *member,
  3935. int iface_no)
  3936. {
  3937. struct totemsrp_instance *instance = (struct totemsrp_instance *)context;
  3938. int res;
  3939. res = totemnet_member_remove (instance->totemnet_context, member, iface_no);
  3940. return (res);
  3941. }
  3942. void totemsrp_threaded_mode_enable (void *context)
  3943. {
  3944. struct totemsrp_instance *instance = (struct totemsrp_instance *)context;
  3945. instance->threaded_mode_enabled = 1;
  3946. }
  3947. void totemsrp_trans_ack (void *context)
  3948. {
  3949. struct totemsrp_instance *instance = (struct totemsrp_instance *)context;
  3950. instance->waiting_trans_ack = 0;
  3951. instance->totemsrp_waiting_trans_ack_cb_fn (0);
  3952. }
  3953. int totemsrp_reconfigure (void *context, struct totem_config *totem_config)
  3954. {
  3955. struct totemsrp_instance *instance = (struct totemsrp_instance *)context;
  3956. int res;
  3957. res = totemnet_reconfigure (instance->totemnet_context, totem_config);
  3958. return (res);
  3959. }
  3960. void totemsrp_stats_clear (void *context, int flags)
  3961. {
  3962. struct totemsrp_instance *instance = (struct totemsrp_instance *)context;
  3963. memset(&instance->stats, 0, sizeof(totemsrp_stats_t));
  3964. if (flags & TOTEMPG_STATS_CLEAR_TRANSPORT) {
  3965. totemnet_stats_clear (instance->totemnet_context);
  3966. }
  3967. }