totemsrp.c 141 KB

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