uploading recordings

test/joint_trajectories/trajectory_0001.csv

@@ -0,0 +1,49 @@
+timestamp,shoulder_pan_joint,shoulder_lift_joint,elbow_joint,wrist_1_joint,wrist_2_joint,wrist_3_joint
+1746018827.987727,-2.656567797027455,-2.3712849421871565,-0.925558443966878,-2.044218054604814,1.6771913924565691,-1.9509870519726187
+1746018828.0438428,-2.652120856595637,-2.351424109627855,-0.9608171192921588,-2.028431268407176,1.679807183505904,-1.9473698628003278
+1746018828.0980728,-2.647594970314622,-2.332089936716241,-0.9948907900466022,-2.0132860687076333,1.6824665734419977,-1.9436853435421488
+1746018828.150571,-2.6429882791563926,-2.313236694824977,-1.0278764921238777,-1.9987304370812549,1.6851719017578564,-1.9399327881343014
+1746018828.2014976,-2.6382987353157055,-2.294814885433054,-1.0598744170818852,-1.9847129281701954,1.6879242480214058,-1.9361103501228445
+1746018828.250987,-2.6335241948588997,-2.2767822452980093,-1.0909696618664206,-1.9711899177215997,1.6907247392681217,-1.9322160918875375
+1746018828.299157,-2.6286624444814133,-2.25910212117193,-1.1212356609614638,-1.9581237957700224,1.6935745337534254,-1.9282480057032547
+1746018828.3461087,-2.623711198269035,-2.241742463858658,-1.1507362663155503,-1.9454818902536597,1.6964748221383763,-1.9242040100853421
+1746018828.391931,-2.6186680949383185,-2.2246750354050175,-1.1795273865911184,-1.9332356181869745,1.6994268283317515,-1.9200819464537484
+1746018828.4367027,-2.6135306949506067,-2.207874782468742,-1.2076582824800979,-1.921359814465153,1.7024318103456428,-1.9158795756110172
+1746018828.480493,-2.6082964775157835,-2.1913193351437776,-1.235172602413144,-1.909832194679763,1.7054910611489644,-1.9115945740398341
+1746018828.523364,-2.602962837480355,-2.1749886019263873,-1.2621092193549084,-1.898632920554509,1.7086059095158914,-1.9072245300077928
+1746018828.565371,-2.597527082095311,-2.158864439255521,-1.2885029133352541,-1.887744244903236,1.711777720865319,-1.9027669394671458
+1746018828.6065636,-2.5919864276594065,-2.142930379547983,-1.3143849330085462,-1.8771502188832048,1.7150078980867605,-1.8982192017368305
+1746018828.6469865,-2.586337996033707,-2.1271714055894106,-1.3397834613776034,-1.8668364485315454,1.7182978823473665,-1.8935786149534906
+1746018828.6866806,-2.5805788110234262,-2.1115737620113757,-1.3647240048810532,-1.8567898906408584,1.7216491538739787,-1.888842371277539
+1746018828.7256827,-2.5747057946232905,-2.0961247967011114,-1.3892297206643047,-1.8469986802916203,1.7250632327031976,-1.8840075518395907
+1746018828.7640262,-2.568715763122914,-2.080812826569625,-1.4133216935874773,-1.8374519840458203,1.728541679391494,-1.8790711214117943
+1746018828.801742,-2.5626054230689332,-2.065627023295545,-1.4370191720594812,-1.8281398740778985,1.7320860956762694,-1.874029922787756
+1746018828.838858,-2.5563713670810064,-2.0505573155703636,-1.4603397699098795,-1.8190532194872113,1.7356981250775654,-1.8688806708538452
+1746018828.8753996,-2.5500100695191747,-2.035594305069767,-1.48329964006603,-1.8101835917802045,1.7393794534287235,-1.8636199463337473
+1746018828.9113908,-2.5435178820005877,-2.020729193918573,-1.505913624682455,-1.8015231820869368,1.7431318093227937,-1.858244189187151
+1746018828.9468534,-2.536891028764185,-2.005953721841944,-1.5281953854927215,-1.7930647281267673,1.7469569644597502,-1.8527496916424473
+1746018828.981932,-2.5301256018826224,-1.9912601115311623,-1.5501575174630116,-1.7848014492920683,1.75085673387769,-1.8471325908422993
+1746018829.0168324,-2.523217556321584,-1.9766410210193348,-1.5718116482777529,-1.7767269884990602,1.7548329760490322,-1.8413888610798816
+1746018829.0515716,-2.5161627048476034,-1.9620895020763978,-1.5931685257489863,-1.7688353596779463,1.7588875928203578,-1.835514305602535
+1746018829.0861652,-2.5089567127866803,-1.9475989638056517,-1.6142380948881407,-1.7611208999530463,1.7630225291718924,-1.829504547958538
+1746018829.120628,-2.5015950926373596,-1.9331631407645378,-1.6350295660932637,-1.7535782257070403,1.7672397727696323,-1.8233550228616648
+1746018829.1549747,-2.494073198543518,-1.918776065047465,-1.655551475672208,-1.7462021918391264,1.7715413532798507,-1.8170609665472082
+1746018829.1892185,-2.4863862206339724,-1.904432041863381,-1.6758117397321064,-1.7389878536203982,1.7759293414120219,-1.8106174065922302
+1746018829.2233727,-2.478529179238171,-1.8901256282196597,-1.6958177023090106,-1.7319304306255023,1.780405847652105,-1.8040191511719863
+1746018829.2574494,-2.470496918989714,-1.8758516143898851,-1.7155761784824244,-1.7250252722810013,1.784973020643612,-1.7972607777237521
+1746018829.2914605,-2.462284102832323,-1.86160500789886,-1.7350934931122435,-1.7182678246205565,1.7896330451688005,-1.790336620988805
+1746018829.3254178,-2.4538852059461935,-1.8473810198056249,-1.754375515746359,-1.7116535978772094,1.7943881396767472,-1.7832407604030007
+1746018829.359332,-2.445294509616421,-1.8331750531060622,-1.7734276921725305,-1.7051781345753345,1.7992405532988585,-1.7759670068064304
+1746018829.393214,-2.436506095069578,-1.8189826931121282,-1.7922550730254687,-1.69883697781073,1.8041925622855022,-1.7685088884430336
+1746018829.4270732,-2.427513837309443,-1.8047996996958646,-1.8108623398073533,-1.6926256394278254,1.8092464657898573,-1.7608596362219362
+1746018829.46092,-2.418311398988563,-1.790622001314058,-1.8292538286354278,-1.6865395678191908,1.8144045809167348,-1.7530121682137474
+1746018829.4947634,-2.40889222435877,-1.7764456907543673,-1.8474335519925673,-1.6805741150850988,1.8196692369448968,-1.744959073357284
+1746018829.5286126,-2.39924953335109,-1.7622670225665948,-1.8654052187245902,-1.6747245033006095,1.8250427686213335,-1.7366925943552969
+1746018829.562476,-2.3893763158437915,-1.748082412163935,-1.8831722525006964,-1.6689857896451026,1.8305275084148604,-1.7282046097420172
+1746018829.5963614,-2.379265326186706,-1.7338884365990461,-1.9007378089298923,-1.6633528301549456,1.836125777604341,-1.7194866151109052
+1746018829.6302772,-2.3689090780605793,-1.7196818370388856,-1.9181047915060365,-1.657820241864649,1.8418398760636912,-1.710529703498208
+1746018829.6642306,-2.3582998397621493,-1.7054595229808347,-1.9352758665365535,-1.6523823631059535,1.847672070591579,-1.7013245449271
+1746018829.6982281,-2.3474296300191164,-1.6912185782709448,-1.9522534771944489,-1.6470332117384563,1.8536245816183596,-1.6918613651287444
+1746018829.732277,-2.336290214454239,-1.6769562690034054,-1.9690398568195848,-1.6417664410902078,1.859699568106305,-1.6821299234710119
+1746018829.7663827,-2.3248731028346676,-1.6626700533987864,-1.9856370415828184,-1.6365752933929596,1.865899110441612,-1.6721194901433825
+1746018829.8005512,-2.313169547261485,-1.6483575937774173,-2.0020468826151743,-1.6314525505051996,1.8722251910980745,-1.6618188226684314

test/joint_trajectories/trajectory_0002.csv

@@ -0,0 +1,50 @@
+timestamp,shoulder_pan_joint,shoulder_lift_joint,elbow_joint,wrist_1_joint,wrist_2_joint,wrist_3_joint
+1746018829.9629352,-2.3246323931825676,-1.662369183730692,-1.9859860284213637,-1.6364661343797922,1.8660312125625174,-1.6719081800763138
+1746018829.9963524,-2.3358193243840324,-1.6763668998952643,-1.9697282755917134,-1.6415486040325569,1.859955867123393,-1.681716456488925
+1746018830.029709,-2.3467455045973478,-1.6903392961166013,-1.9532941100206553,-1.6467039222294941,1.8539985060460893,-1.6912634178945085
+1746018830.0630164,-2.357412817347776,-1.7042910986683502,-1.9366765335125398,-1.651937838254169,1.8481587881336843,-1.7005522701579625
+1746018830.0962808,-2.367829044642684,-1.7182247925608807,-1.9198734973483391,-1.65725640881592,1.842434707104923,-1.7095927192408422
+1746018830.1295083,-2.378001712454484,-1.7321431048843852,-1.902882723676061,-1.662665286327453,1.8368241794365847,-1.718393994115416
+1746018830.162706,-2.387938116128487,-1.746048923035249,-1.8857017302114583,-1.6681698249102748,1.8313250780470778,-1.7269649122867352
+1746018830.1958811,-2.3976453244595373,-1.7599452899679868,-1.8683278179372114,-1.673775117375881,1.8259352440123369,-1.7353138992711519
+1746018830.2290413,-2.4071301838887775,-1.7738354001770886,-1.8507580577374494,-1.6794860312874649,1.8206524972781475,-1.7434490071506985
+1746018830.2621944,-2.4163993230949226,-1.7877225972294317,-1.832989276161644,-1.685307243356319,1.8154746460647377,-1.7513779323942549
+1746018830.2953491,-2.425459157893222,-1.8016103728025703,-1.8150180401770228,-1.6912432723799113,1.8103994950986984,-1.7591080329316544
+1746018830.3285139,-2.4343158963723455,-1.8155023672053947,-1.7968406407629245,-1.697298510924176,1.8054248527936752,-1.7666463444835099
+1746018830.3616977,-2.442975544208546,-1.8294023713737457,-1.7784530751836811,-1.7034772559564346,1.8005485374899468,-1.7739995961558246
+1746018830.39491,-2.4514439101046372,-1.8433143303503392,-1.759851027757332,-1.7097837386400039,1.7957683828525326,-1.7811742253134366
+1746018830.4281607,-2.4597266113085543,-1.8572423482760716,-1.7410298489149851,-1.716222153507498,1.7910822425179438,-1.7881763917501565
+1746018830.4614599,-2.4678290791726623,-1.8711906949387604,-1.7219845323194827,-1.722796687237546,1.7864879940708889,-1.7950119911763036
+1746018830.4948182,-2.4757565647206334,-1.8851638139460283,-1.7027096897813365,-1.7295115472695992,1.781983542424273,-1.801686668046411
+1746018830.5282469,-2.48351414419369,-1.8991663326118113,-1.68319952367387,-1.736370990504302,1.777566822668529,-1.8082058277512736
+1746018830.561757,-2.4911067245523895,-1.9132030736714287,-1.6634477965070025,-1.7433793523530943,1.7732358024496762,-1.8145746481994034
+1746018830.595361,-2.4985390489139676,-1.9272790689689243,-1.6434477972689074,-1.7505410764210922,1.7689884839295225,-1.82079809081341
+1746018830.6290712,-2.5058157019086287,-1.9413995752933326,-1.6231923040851692,-1.7578607451326924,1.76482290537594,-1.82688091096694
+1746018830.662901,-2.5129411149411043,-1.9555700925785702,-1.6026735426741605,-1.765343111640808,1.7607371424262315,-1.8328276678876576
+1746018830.6968637,-2.519919571346382,-1.9697963847260402,-1.5818831399926652,-1.7729931333994968,1.7567293090621519,-1.8386427340513691
+1746018830.730974,-2.52675521143073,-1.9840845033613033,-1.5608120723641956,-1.7808160078275237,1.7527975583311033,-1.844330304091874
+1746018830.765247,-2.5334520373910783,-1.9984408148981199,-1.5394506072601954,-1.7888172105491613,1.7489400828444133,-1.849894403250444
+1746018830.7997239,-2.5400139181075128,-2.01287203135727,-1.5177882377564893,-1.797002536770738,1.745155115080336,-1.8553388953880987
+1746018830.8346977,-2.5464445938050573,-2.027385245476731,-1.4958136085077476,-1.8053781464403147,1.7414409275164555,-1.8606674905830092
+1746018830.8701878,-2.5527476805821965,-2.041987970757935,-1.4735144318635378,-1.8139506139474644,1.7377958326135357,-1.8658837523345089
+1746018830.906216,-2.5589266748046233,-2.056688187224806,-1.4508773924805463,-1.8227269832556683,1.7342181826704879,-1.8709911043942884
+1746018830.9428046,-2.564984957363633,-2.0714943938345094,-1.4278880384536017,-1.8317148295281616,1.7307063695679723,-1.8759928372444565
+1746018830.979979,-2.570925797799328,-2.086415668679616,-1.4045306565761477,-1.8409223285179457,1.7272588244162428,-1.8808921142412387
+1746018831.0177665,-2.576752358289459,-2.1014617383715612,-1.3807881288261408,-1.8503583352558473,1.72387401712112,-1.885691977442181
+1746018831.0561965,-2.5824676975052707,-2.11664305830945,-1.3566417665261248,-1.860032473902345,1.7205504558804474,-1.8903953531338502
+1746018831.0953019,-2.588074774336134,-2.1319709059355443,-1.3320711178065574,-1.8699552410500637,1.7172866866219794,-1.8950050570761443
+1746018831.1351182,-2.5935764514851467,-2.147457489585476,-1.3070537429552438,-1.880138125302221,1.714081292392457,-1.8995237994784817
+1746018831.175685,-2.598975498938122,-2.163116076192637,-1.2815649508896658,-1.8905937466458593,1.7109328927064817,-1.9039541897223107
+1746018831.2170453,-2.6042745973086343,-2.1789611419513553,-1.255577488241776,-1.9013360200397096,1.7078401428628558,-1.9082987408435736
+1746018831.2592473,-2.6094763410618986,-2.1950085511503414,-1.2290611702556746,-1.9123803488177538,1.7048017332351737,-1.9125598737879748
+1746018831.3023446,-2.614583241620377,-2.2112757698523144,-1.2019824396691283,-1.9237438550735724,1.7018163885426851,-1.9167399214511214
+1746018831.3463962,-2.619597730353988,-2.2277821230545776,-1.1743038356968118,-1.9354456562837374,1.698882867106792,-1.9208411325148411
+1746018831.3914697,-2.624522161457751,-2.244549106616396,-1.1459833497468783,-1.9475072002625895,1.6959999600979527,-1.9248656750901965
+1746018831.4376402,-2.629358814719536,-2.2616007688731723,-1.1169736369810401,-1.9599526744268623,1.6931664907773376,-1.9288156401769119
+1746018831.484993,-2.6341098981803106,-2.2789641819084694,-1.0872210423732849,-1.9728095107512091,1.690381313737162,-1.9326930449480468
+1746018831.5336254,-2.6387775506888325,-2.29667002958243,-1.0566643851683533,-1.9861090154205274,1.6876433141434468,-1.9364998358677594
+1746018831.5836492,-2.6433638443520104,-2.3147533496405033,-1.025233424473071,-1.9998871631254325,1.6849514069848492,-1.9402378916487981
+1746018831.635194,-2.647870786881036,-2.333254482166248,-0.9928468977842484,-2.0141856119336783,1.6823045363314142,-1.9439090260547813
+1746018831.6884105,-2.6523003238315535,-2.352220298914748,-0.9594099781441661,-2.0290530185056923,1.6797016746076414,-1.9475149905501257
+1746018831.7434766,-2.6566543407331253,-2.371705822022165,-0.9248109253040582,-2.044546769766889,1.6771418218854173,-1.9510574767971396
+1746018831.800604,-2.660934665098117,-2.3917763936815626,-0.8889165963410672,-2.060735303978048,1.6746240052046204,-1.9545381189944557

test/joint_trajectories/trajectory_0003.csv

@@ -0,0 +1,49 @@
+timestamp,shoulder_pan_joint,shoulder_lift_joint,elbow_joint,wrist_1_joint,wrist_2_joint,wrist_3_joint
+1746018831.9868114,-2.6565677523006266,-2.3712859473778694,-0.9255562021889361,-2.0442193525101158,1.6771915874039305,-1.9509871358148483
+1746018832.0429308,-2.6521208586570473,-2.3514240765597316,-0.9608171893623072,-2.028431231308233,1.679807182530988,-1.9473698646276565
+1746018832.0971608,-2.6475949702484503,-2.332089937648089,-0.9948907880305828,-2.0132860697766257,1.6824665734803306,-1.9436853434865617
+1746018832.1496592,-2.6429882791583386,-2.313236694800291,-1.0278764921773265,-1.9987304370528798,1.6851719017566626,-1.9399327881358823
+1746018832.2005854,-2.6382987353156526,-2.294814885433657,-1.0598744170805698,-1.9847129281708982,1.6879242480214387,-1.9361103501228012
+1746018832.250075,-2.633524194858901,-2.2767822452979956,-1.0909696618664504,-1.9711899177215835,1.6907247392681217,-1.9322160918875386
+1746018832.298245,-2.6286624444814133,-2.2591021211719298,-1.1212356609614638,-1.9581237957700226,1.6935745337534254,-1.9282480057032545
+1746018832.3451965,-2.623711198269035,-2.241742463858658,-1.1507362663155505,-1.9454818902536597,1.6964748221383763,-1.924204010085342
+1746018832.391019,-2.618668094938318,-2.224675035405018,-1.1795273865911178,-1.933235618186975,1.6994268283317515,-1.9200819464537484
+1746018832.4357908,-2.6135306949506067,-2.2078747824687426,-1.2076582824800974,-1.9213598144651534,1.7024318103456428,-1.9158795756110172
+1746018832.479581,-2.6082964775157835,-2.1913193351437776,-1.2351726024131437,-1.9098321946797632,1.7054910611489644,-1.9115945740398341
+1746018832.522452,-2.602962837480355,-2.1749886019263873,-1.2621092193549082,-1.8986329205545092,1.7086059095158914,-1.907224530007793
+1746018832.5644588,-2.597527082095311,-2.158864439255521,-1.288502913335254,-1.8877442449032362,1.711777720865319,-1.9027669394671458
+1746018832.6056514,-2.591986427659406,-2.142930379547983,-1.3143849330085464,-1.8771502188832048,1.7150078980867605,-1.8982192017368305
+1746018832.6460745,-2.586337996033707,-2.1271714055894106,-1.3397834613776034,-1.8668364485315452,1.7182978823473665,-1.8935786149534903
+1746018832.6857686,-2.5805788110234267,-2.1115737620113757,-1.3647240048810532,-1.8567898906408586,1.7216491538739778,-1.888842371277539
+1746018832.7247705,-2.5747057946232905,-2.0961247967011114,-1.3892297206643045,-1.8469986802916203,1.7250632327031976,-1.8840075518395907
+1746018832.7631142,-2.568715763122914,-2.080812826569625,-1.4133216935874768,-1.8374519840458203,1.728541679391494,-1.8790711214117943
+1746018832.80083,-2.5626054230689332,-2.0656270232955447,-1.4370191720594814,-1.8281398740778985,1.7320860956762694,-1.874029922787756
+1746018832.8379457,-2.5563713670810064,-2.0505573155703636,-1.4603397699098797,-1.8190532194872113,1.7356981250775654,-1.8688806708538452
+1746018832.8744876,-2.5500100695191747,-2.035594305069767,-1.4832996400660297,-1.810183591780205,1.7393794534287235,-1.8636199463337475
+1746018832.9104788,-2.5435178820005877,-2.020729193918573,-1.5059136246824552,-1.8015231820869366,1.7431318093227937,-1.8582441891871508
+1746018832.9459414,-2.536891028764185,-2.005953721841944,-1.5281953854927215,-1.7930647281267673,1.7469569644597502,-1.8527496916424473
+1746018832.9810197,-2.5301256018826224,-1.9912601115311623,-1.5501575174630116,-1.7848014492920683,1.75085673387769,-1.8471325908422993
+1746018833.0159202,-2.523217556321584,-1.9766410210193348,-1.5718116482777529,-1.7767269884990602,1.7548329760490322,-1.8413888610798816
+1746018833.0506594,-2.5161627048476034,-1.9620895020763978,-1.5931685257489863,-1.7688353596779463,1.7588875928203578,-1.835514305602535
+1746018833.085253,-2.5089567127866803,-1.9475989638056517,-1.6142380948881407,-1.7611208999530463,1.7630225291718924,-1.829504547958538
+1746018833.1197162,-2.5015950926373596,-1.9331631407645378,-1.6350295660932637,-1.7535782257070403,1.7672397727696323,-1.8233550228616648
+1746018833.1540627,-2.494073198543518,-1.918776065047465,-1.655551475672208,-1.7462021918391264,1.7715413532798507,-1.8170609665472082
+1746018833.1883066,-2.4863862206339724,-1.904432041863381,-1.6758117397321064,-1.7389878536203982,1.7759293414120219,-1.8106174065922302
+1746018833.2224605,-2.478529179238171,-1.8901256282196597,-1.6958177023090106,-1.7319304306255023,1.780405847652105,-1.8040191511719863
+1746018833.2565372,-2.470496918989714,-1.8758516143898851,-1.7155761784824244,-1.7250252722810013,1.784973020643612,-1.7972607777237521
+1746018833.2905486,-2.462284102832323,-1.86160500789886,-1.7350934931122435,-1.7182678246205565,1.7896330451688005,-1.790336620988805
+1746018833.3245058,-2.4538852059461935,-1.8473810198056249,-1.754375515746359,-1.7116535978772094,1.7943881396767472,-1.7832407604030007
+1746018833.3584201,-2.445294509616421,-1.8331750531060622,-1.7734276921725305,-1.7051781345753345,1.7992405532988585,-1.7759670068064304
+1746018833.3923018,-2.436506095069578,-1.8189826931121282,-1.7922550730254687,-1.69883697781073,1.8041925622855022,-1.7685088884430336
+1746018833.4261613,-2.427513837309443,-1.8047996996958646,-1.8108623398073533,-1.6926256394278254,1.8092464657898573,-1.7608596362219362
+1746018833.460008,-2.418311398988563,-1.790622001314058,-1.8292538286354278,-1.6865395678191908,1.8144045809167348,-1.7530121682137474
+1746018833.4938514,-2.40889222435877,-1.7764456907543673,-1.8474335519925673,-1.6805741150850988,1.8196692369448968,-1.744959073357284
+1746018833.5277004,-2.39924953335109,-1.7622670225665948,-1.8654052187245902,-1.6747245033006095,1.8250427686213335,-1.7366925943552969
+1746018833.5615637,-2.3893763158437915,-1.748082412163935,-1.8831722525006964,-1.6689857896451026,1.8305275084148604,-1.7282046097420172
+1746018833.5954494,-2.379265326186706,-1.7338884365990461,-1.9007378089298923,-1.6633528301549456,1.836125777604341,-1.7194866151109052
+1746018833.6293652,-2.3689090780605793,-1.7196818370388856,-1.9181047915060365,-1.657820241864649,1.8418398760636912,-1.710529703498208
+1746018833.6633184,-2.3582998397621493,-1.7054595229808347,-1.9352758665365535,-1.6523823631059535,1.847672070591579,-1.7013245449271
+1746018833.6973162,-2.3474296300191164,-1.6912185782709448,-1.9522534771944489,-1.6470332117384563,1.8536245816183596,-1.6918613651287444
+1746018833.731365,-2.336290214454239,-1.6769562690034054,-1.9690398568195848,-1.6417664410902078,1.859699568106305,-1.6821299234710119
+1746018833.7654707,-2.3248731028346676,-1.6626700533987864,-1.9856370415828184,-1.6365752933929596,1.865899110441612,-1.6721194901433825
+1746018833.7996392,-2.313169547261485,-1.6483575937774173,-2.0020468826151743,-1.6314525505051996,1.8722251910980745,-1.6618188226684314

test/joint_trajectories/trajectory_0004.csv

@@ -0,0 +1,50 @@
+timestamp,shoulder_pan_joint,shoulder_lift_joint,elbow_joint,wrist_1_joint,wrist_2_joint,wrist_3_joint
+1746018833.9629507,-2.324632188594224,-1.6623693271971933,-1.9859861625555153,-1.6364657863266083,1.8660316432600403,-1.6719081889804013
+1746018833.9963675,-2.335819326188092,-1.6763668965146246,-1.969728275639677,-1.6415486123374243,1.8599558668257767,-1.6817164597772025
+1746018834.0297241,-2.3467455046022967,-1.6903392961676456,-1.953294110027188,-1.6467039221617474,1.8539985059979607,-1.691263417867352
+1746018834.0630317,-2.357412817347484,-1.704291098667895,-1.936676533512226,-1.6519378382544172,1.8481587881339312,-1.7005522701576399
+1746018834.0962958,-2.3678290446426877,-1.7182247925608825,-1.919873497348345,-1.6572564088159167,1.8424347071049256,-1.7095927192408489
+1746018834.1295235,-2.378001712454484,-1.7321431048843847,-1.9028827236760615,-1.6626652863274527,1.8368241794365847,-1.7183939941154158
+1746018834.1627212,-2.387938116128487,-1.7460489230352487,-1.8857017302114587,-1.6681698249102745,1.8313250780470778,-1.7269649122867352
+1746018834.1958961,-2.3976453244595373,-1.7599452899679866,-1.8683278179372114,-1.673775117375881,1.8259352440123369,-1.7353138992711519
+1746018834.2290564,-2.4071301838887775,-1.7738354001770889,-1.8507580577374492,-1.679486031287465,1.8206524972781475,-1.7434490071506987
+1746018834.2622097,-2.4163993230949226,-1.7877225972294317,-1.8329892761616438,-1.685307243356319,1.8154746460647377,-1.7513779323942549
+1746018834.2953644,-2.425459157893222,-1.8016103728025705,-1.815018040177023,-1.6912432723799111,1.8103994950986984,-1.7591080329316544
+1746018834.328529,-2.4343158963723455,-1.815502367205395,-1.7968406407629243,-1.697298510924176,1.8054248527936752,-1.7666463444835099
+1746018834.3617127,-2.442975544208546,-1.8294023713737457,-1.778453075183681,-1.7034772559564348,1.8005485374899468,-1.7739995961558246
+1746018834.394925,-2.4514439101046372,-1.843314330350339,-1.7598510277573318,-1.7097837386400043,1.7957683828525326,-1.7811742253134366
+1746018834.428176,-2.4597266113085543,-1.8572423482760718,-1.741029848914985,-1.716222153507498,1.7910822425179438,-1.7881763917501565
+1746018834.4614751,-2.4678290791726623,-1.8711906949387604,-1.7219845323194825,-1.7227966872375462,1.7864879940708889,-1.7950119911763038
+1746018834.4948335,-2.4757565647206334,-1.885163813946028,-1.7027096897813367,-1.7295115472695992,1.781983542424273,-1.801686668046411
+1746018834.528262,-2.48351414419369,-1.8991663326118116,-1.6831995236738697,-1.736370990504302,1.777566822668529,-1.8082058277512736
+1746018834.5617723,-2.4911067245523895,-1.9132030736714287,-1.6634477965070027,-1.743379352353094,1.7732358024496762,-1.8145746481994034
+1746018834.5953763,-2.4985390489139676,-1.9272790689689243,-1.6434477972689074,-1.7505410764210922,1.7689884839295225,-1.8207980908134098
+1746018834.6290865,-2.5058157019086287,-1.9413995752933328,-1.6231923040851692,-1.7578607451326926,1.7648229053759392,-1.82688091096694
+1746018834.662916,-2.5129411149411043,-1.9555700925785702,-1.6026735426741605,-1.765343111640808,1.7607371424262315,-1.8328276678876574
+1746018834.696879,-2.519919571346382,-1.9697963847260402,-1.5818831399926652,-1.772993133399497,1.7567293090621519,-1.8386427340513691
+1746018834.7309892,-2.52675521143073,-1.9840845033613033,-1.5608120723641956,-1.780816007827524,1.7527975583311033,-1.8443303040918742
+1746018834.7652624,-2.5334520373910787,-1.9984408148981199,-1.5394506072601954,-1.7888172105491613,1.7489400828444133,-1.849894403250444
+1746018834.7997391,-2.5400139181075128,-2.01287203135727,-1.5177882377564893,-1.797002536770738,1.745155115080336,-1.8553388953880987
+1746018834.8347127,-2.5464445938050573,-2.027385245476731,-1.4958136085077476,-1.8053781464403147,1.7414409275164555,-1.8606674905830092
+1746018834.870203,-2.5527476805821965,-2.041987970757935,-1.4735144318635378,-1.8139506139474644,1.7377958326135357,-1.8658837523345089
+1746018834.906231,-2.5589266748046233,-2.056688187224806,-1.4508773924805463,-1.8227269832556683,1.7342181826704879,-1.8709911043942884
+1746018834.9428196,-2.564984957363633,-2.0714943938345094,-1.4278880384536017,-1.8317148295281616,1.7307063695679723,-1.8759928372444565
+1746018834.979994,-2.570925797799328,-2.086415668679616,-1.4045306565761477,-1.8409223285179457,1.7272588244162428,-1.8808921142412387
+1746018835.0177815,-2.576752358289459,-2.1014617383715612,-1.3807881288261408,-1.8503583352558473,1.72387401712112,-1.885691977442181
+1746018835.0562117,-2.5824676975052707,-2.11664305830945,-1.3566417665261248,-1.860032473902345,1.7205504558804474,-1.8903953531338502
+1746018835.0953171,-2.588074774336134,-2.1319709059355443,-1.3320711178065574,-1.8699552410500637,1.7172866866219794,-1.8950050570761443
+1746018835.1351335,-2.5935764514851467,-2.147457489585476,-1.3070537429552438,-1.880138125302221,1.714081292392457,-1.8995237994784817
+1746018835.1757002,-2.598975498938122,-2.163116076192637,-1.2815649508896658,-1.8905937466458593,1.7109328927064817,-1.9039541897223107
+1746018835.2170606,-2.6042745973086343,-2.1789611419513553,-1.255577488241776,-1.9013360200397096,1.7078401428628558,-1.9082987408435736
+1746018835.2592626,-2.6094763410618986,-2.1950085511503414,-1.2290611702556746,-1.9123803488177538,1.7048017332351737,-1.9125598737879748
+1746018835.3023596,-2.614583241620377,-2.2112757698523144,-1.2019824396691283,-1.9237438550735724,1.7018163885426851,-1.9167399214511214
+1746018835.3464115,-2.619597730353988,-2.2277821230545776,-1.1743038356968118,-1.9354456562837374,1.698882867106792,-1.9208411325148411
+1746018835.391485,-2.624522161457751,-2.244549106616396,-1.1459833497468783,-1.9475072002625895,1.6959999600979527,-1.9248656750901965
+1746018835.4376554,-2.629358814719536,-2.2616007688731723,-1.1169736369810401,-1.9599526744268623,1.6931664907773376,-1.9288156401769119
+1746018835.485008,-2.6341098981803106,-2.2789641819084694,-1.0872210423732849,-1.9728095107512091,1.690381313737162,-1.9326930449480468
+1746018835.5336404,-2.6387775506888325,-2.29667002958243,-1.0566643851683533,-1.9861090154205274,1.6876433141434468,-1.9364998358677594
+1746018835.5836644,-2.6433638443520104,-2.3147533496405033,-1.025233424473071,-1.9998871631254325,1.6849514069848492,-1.9402378916487981
+1746018835.635209,-2.647870786881036,-2.333254482166248,-0.9928468977842484,-2.0141856119336783,1.6823045363314142,-1.9439090260547813
+1746018835.6884258,-2.6523003238315535,-2.352220298914748,-0.9594099781441661,-2.0290530185056923,1.6797016746076414,-1.9475149905501257
+1746018835.743492,-2.6566543407331253,-2.371705822022165,-0.9248109253040582,-2.044546769766889,1.6771418218854173,-1.9510574767971396
+1746018835.8006194,-2.660934665098117,-2.3917763936815626,-0.8889165963410672,-2.060735303978048,1.6746240052046204,-1.9545381189944557

test/joint_trajectories/trajectory_0005.csv

@@ -0,0 +1,49 @@
+timestamp,shoulder_pan_joint,shoulder_lift_joint,elbow_joint,wrist_1_joint,wrist_2_joint,wrist_3_joint
+1746018835.987803,-2.656567969897686,-2.3712867418535835,-0.9255553455936596,-2.0442193002403903,1.677191601025152,-1.9509874110940175
+1746018836.043924,-2.652120862077586,-2.351424064744933,-0.9608172215999868,-2.0284312113477605,1.6798071801161178,-1.9473698671598543
+1746018836.0981538,-2.6475949702440356,-2.3320899380810047,-0.9948907871519141,-2.0132860702259343,1.6824665734844668,-1.9436853434845773
+1746018836.1506522,-2.642988279159434,-2.3132366947895355,-1.0278764922010586,-1.9987304370401513,1.6851719017560347,-1.9399327881368085
+1746018836.2015784,-2.638298735315631,-2.2948148854339245,-1.059874417079989,-1.9847129281712077,1.687924248021452,-1.936110350122784
+1746018836.251068,-2.6335241948589014,-2.27678224529799,-1.0909696618664633,-1.9711899177215764,1.6907247392681208,-1.932216091887539
+1746018836.299238,-2.6286624444814133,-2.25910212117193,-1.1212356609614633,-1.9581237957700226,1.6935745337534254,-1.9282480057032545
+1746018836.3461897,-2.623711198269035,-2.241742463858658,-1.1507362663155503,-1.9454818902536597,1.6964748221383763,-1.924204010085342
+1746018836.3920121,-2.6186680949383185,-2.2246750354050175,-1.1795273865911184,-1.9332356181869748,1.6994268283317515,-1.9200819464537484
+1746018836.4367838,-2.6135306949506067,-2.2078747824687426,-1.2076582824800977,-1.921359814465153,1.7024318103456428,-1.9158795756110172
+1746018836.4805741,-2.6082964775157835,-2.191319335143777,-1.235172602413144,-1.9098321946797632,1.7054910611489644,-1.9115945740398341
+1746018836.5234451,-2.602962837480355,-2.1749886019263878,-1.262109219354908,-1.8986329205545092,1.7086059095158914,-1.907224530007793
+1746018836.565452,-2.597527082095311,-2.158864439255521,-1.2885029133352544,-1.887744244903236,1.71177772086532,-1.9027669394671456
+1746018836.6066446,-2.591986427659406,-2.142930379547983,-1.3143849330085464,-1.8771502188832048,1.7150078980867605,-1.8982192017368302
+1746018836.6470675,-2.586337996033707,-2.1271714055894106,-1.3397834613776034,-1.8668364485315452,1.7182978823473665,-1.8935786149534906
+1746018836.6867616,-2.5805788110234267,-2.1115737620113757,-1.3647240048810532,-1.8567898906408586,1.7216491538739778,-1.888842371277539
+1746018836.7257638,-2.5747057946232905,-2.0961247967011114,-1.3892297206643045,-1.8469986802916203,1.7250632327031976,-1.8840075518395907
+1746018836.7641072,-2.568715763122914,-2.080812826569625,-1.4133216935874768,-1.8374519840458203,1.728541679391494,-1.8790711214117943
+1746018836.801823,-2.5626054230689332,-2.0656270232955447,-1.4370191720594814,-1.8281398740778985,1.7320860956762694,-1.874029922787756
+1746018836.838939,-2.5563713670810064,-2.0505573155703636,-1.4603397699098797,-1.8190532194872113,1.7356981250775654,-1.8688806708538452
+1746018836.8754807,-2.5500100695191747,-2.035594305069767,-1.4832996400660297,-1.810183591780205,1.7393794534287235,-1.8636199463337475
+1746018836.9114718,-2.5435178820005877,-2.020729193918573,-1.5059136246824552,-1.8015231820869366,1.7431318093227937,-1.8582441891871508
+1746018836.9469345,-2.536891028764185,-2.005953721841944,-1.5281953854927215,-1.7930647281267673,1.7469569644597502,-1.8527496916424473
+1746018836.982013,-2.5301256018826224,-1.9912601115311623,-1.5501575174630116,-1.7848014492920683,1.75085673387769,-1.8471325908422993
+1746018837.0169134,-2.523217556321584,-1.9766410210193348,-1.5718116482777529,-1.7767269884990602,1.7548329760490322,-1.8413888610798816
+1746018837.0516527,-2.5161627048476034,-1.9620895020763978,-1.5931685257489863,-1.7688353596779463,1.7588875928203578,-1.835514305602535
+1746018837.0862463,-2.5089567127866803,-1.9475989638056517,-1.6142380948881407,-1.7611208999530463,1.7630225291718924,-1.829504547958538
+1746018837.1207092,-2.5015950926373596,-1.9331631407645378,-1.6350295660932637,-1.7535782257070403,1.7672397727696323,-1.8233550228616648
+1746018837.1550558,-2.494073198543518,-1.918776065047465,-1.655551475672208,-1.7462021918391264,1.7715413532798507,-1.8170609665472082
+1746018837.1892996,-2.4863862206339724,-1.904432041863381,-1.6758117397321064,-1.7389878536203982,1.7759293414120219,-1.8106174065922302
+1746018837.2234538,-2.478529179238171,-1.8901256282196597,-1.6958177023090106,-1.7319304306255023,1.780405847652105,-1.8040191511719863
+1746018837.2575305,-2.470496918989714,-1.8758516143898851,-1.7155761784824244,-1.7250252722810013,1.784973020643612,-1.7972607777237521
+1746018837.2915416,-2.462284102832323,-1.86160500789886,-1.7350934931122435,-1.7182678246205565,1.7896330451688005,-1.790336620988805
+1746018837.3254988,-2.4538852059461935,-1.8473810198056249,-1.754375515746359,-1.7116535978772094,1.7943881396767472,-1.7832407604030007
+1746018837.3594131,-2.445294509616421,-1.8331750531060622,-1.7734276921725305,-1.7051781345753345,1.7992405532988585,-1.7759670068064304
+1746018837.3932948,-2.436506095069578,-1.8189826931121282,-1.7922550730254687,-1.69883697781073,1.8041925622855022,-1.7685088884430336
+1746018837.4271543,-2.427513837309443,-1.8047996996958646,-1.8108623398073533,-1.6926256394278254,1.8092464657898573,-1.7608596362219362
+1746018837.4610012,-2.418311398988563,-1.790622001314058,-1.8292538286354278,-1.6865395678191908,1.8144045809167348,-1.7530121682137474
+1746018837.4948444,-2.40889222435877,-1.7764456907543673,-1.8474335519925673,-1.6805741150850988,1.8196692369448968,-1.744959073357284
+1746018837.5286937,-2.39924953335109,-1.7622670225665948,-1.8654052187245902,-1.6747245033006095,1.8250427686213335,-1.7366925943552969
+1746018837.562557,-2.3893763158437915,-1.748082412163935,-1.8831722525006964,-1.6689857896451026,1.8305275084148604,-1.7282046097420172
+1746018837.5964425,-2.379265326186706,-1.7338884365990461,-1.9007378089298923,-1.6633528301549456,1.836125777604341,-1.7194866151109052
+1746018837.6303582,-2.3689090780605793,-1.7196818370388856,-1.9181047915060365,-1.657820241864649,1.8418398760636912,-1.710529703498208
+1746018837.6643114,-2.3582998397621493,-1.7054595229808347,-1.9352758665365535,-1.6523823631059535,1.847672070591579,-1.7013245449271
+1746018837.6983092,-2.3474296300191164,-1.6912185782709448,-1.9522534771944489,-1.6470332117384563,1.8536245816183596,-1.6918613651287444
+1746018837.732358,-2.336290214454239,-1.6769562690034054,-1.9690398568195848,-1.6417664410902078,1.859699568106305,-1.6821299234710119
+1746018837.7664638,-2.3248731028346676,-1.6626700533987864,-1.9856370415828184,-1.6365752933929596,1.865899110441612,-1.6721194901433825
+1746018837.8006322,-2.313169547261485,-1.6483575937774173,-2.0020468826151743,-1.6314525505051996,1.8722251910980745,-1.6618188226684314

test/joint_trajectories/trajectory_0006.csv

@@ -0,0 +1,50 @@
+timestamp,shoulder_pan_joint,shoulder_lift_joint,elbow_joint,wrist_1_joint,wrist_2_joint,wrist_3_joint
+1746018837.9624937,-2.3246320499756634,-1.6623690828935132,-1.985985865117908,-1.6364665759463006,1.8660315409898365,-1.6719080440240734
+1746018837.9959111,-2.3358193278856954,-1.6763668981739894,-1.969728278761401,-1.6415486065242635,1.8599558635667384,-1.6817164593894947
+1746018838.0292678,-2.346745504588685,-1.6903392961610908,-1.9532941100077603,-1.6467039221533954,1.8539985060146833,-1.6912634178526196
+1746018838.062575,-2.3574128173475404,-1.7042910986678523,-1.9366765335123646,-1.6519378382545549,1.8481587881342065,-1.7005522701579419
+1746018838.0958395,-2.3678290446426877,-1.7182247925608836,-1.919873497348344,-1.6572564088159185,1.842434707104923,-1.7095927192408484
+1746018838.129067,-2.378001712454484,-1.732143104884385,-1.902882723676061,-1.662665286327453,1.8368241794365847,-1.718393994115416
+1746018838.1622646,-2.387938116128487,-1.7460489230352492,-1.8857017302114585,-1.6681698249102745,1.8313250780470778,-1.7269649122867352
+1746018838.1954398,-2.3976453244595373,-1.7599452899679866,-1.8683278179372116,-1.6737751173758808,1.8259352440123369,-1.735313899271152
+1746018838.2286,-2.4071301838887775,-1.7738354001770886,-1.8507580577374494,-1.679486031287465,1.8206524972781475,-1.7434490071506985
+1746018838.261753,-2.4163993230949226,-1.787722597229432,-1.8329892761616438,-1.685307243356319,1.8154746460647377,-1.7513779323942549
+1746018838.2949078,-2.425459157893222,-1.8016103728025703,-1.8150180401770228,-1.6912432723799113,1.8103994950986984,-1.7591080329316544
+1746018838.3280725,-2.4343158963723455,-1.8155023672053947,-1.7968406407629245,-1.697298510924176,1.8054248527936752,-1.7666463444835099
+1746018838.3612564,-2.442975544208546,-1.8294023713737457,-1.7784530751836811,-1.7034772559564346,1.8005485374899468,-1.7739995961558246
+1746018838.3944685,-2.4514439101046372,-1.8433143303503392,-1.759851027757332,-1.7097837386400039,1.7957683828525326,-1.7811742253134366
+1746018838.4277194,-2.4597266113085543,-1.8572423482760716,-1.7410298489149851,-1.716222153507498,1.7910822425179438,-1.7881763917501565
+1746018838.4610186,-2.4678290791726623,-1.8711906949387604,-1.7219845323194827,-1.722796687237546,1.7864879940708889,-1.7950119911763036
+1746018838.494377,-2.4757565647206334,-1.8851638139460283,-1.7027096897813365,-1.7295115472695992,1.781983542424273,-1.801686668046411
+1746018838.5278056,-2.48351414419369,-1.8991663326118113,-1.68319952367387,-1.736370990504302,1.777566822668529,-1.8082058277512736
+1746018838.5613158,-2.4911067245523895,-1.9132030736714287,-1.6634477965070025,-1.7433793523530943,1.7732358024496762,-1.8145746481994034
+1746018838.5949197,-2.4985390489139676,-1.9272790689689243,-1.6434477972689074,-1.7505410764210922,1.7689884839295225,-1.82079809081341
+1746018838.62863,-2.5058157019086287,-1.9413995752933326,-1.6231923040851692,-1.7578607451326924,1.76482290537594,-1.82688091096694
+1746018838.6624596,-2.5129411149411043,-1.9555700925785702,-1.6026735426741605,-1.765343111640808,1.7607371424262315,-1.8328276678876576
+1746018838.6964223,-2.519919571346382,-1.9697963847260402,-1.5818831399926652,-1.7729931333994968,1.7567293090621519,-1.8386427340513691
+1746018838.7305326,-2.52675521143073,-1.9840845033613033,-1.5608120723641956,-1.7808160078275237,1.7527975583311033,-1.844330304091874
+1746018838.7648058,-2.5334520373910783,-1.9984408148981199,-1.5394506072601954,-1.7888172105491613,1.7489400828444133,-1.849894403250444
+1746018838.7992826,-2.5400139181075128,-2.01287203135727,-1.5177882377564893,-1.797002536770738,1.745155115080336,-1.8553388953880987
+1746018838.8342564,-2.5464445938050573,-2.027385245476731,-1.4958136085077476,-1.8053781464403147,1.7414409275164555,-1.8606674905830092
+1746018838.8697464,-2.5527476805821965,-2.041987970757935,-1.4735144318635378,-1.8139506139474644,1.7377958326135357,-1.8658837523345089
+1746018838.9057746,-2.5589266748046233,-2.056688187224806,-1.4508773924805463,-1.8227269832556683,1.7342181826704879,-1.8709911043942884
+1746018838.9423633,-2.564984957363633,-2.0714943938345094,-1.4278880384536017,-1.8317148295281616,1.7307063695679723,-1.8759928372444565
+1746018838.9795377,-2.570925797799328,-2.086415668679616,-1.4045306565761477,-1.8409223285179457,1.7272588244162428,-1.8808921142412387
+1746018839.017325,-2.576752358289459,-2.1014617383715612,-1.3807881288261408,-1.8503583352558473,1.72387401712112,-1.885691977442181
+1746018839.0557551,-2.5824676975052707,-2.11664305830945,-1.3566417665261248,-1.860032473902345,1.7205504558804474,-1.8903953531338502
+1746018839.0948606,-2.588074774336134,-2.1319709059355443,-1.3320711178065574,-1.8699552410500637,1.7172866866219794,-1.8950050570761443
+1746018839.134677,-2.5935764514851467,-2.147457489585476,-1.3070537429552438,-1.880138125302221,1.714081292392457,-1.8995237994784817
+1746018839.1752436,-2.598975498938122,-2.163116076192637,-1.2815649508896658,-1.8905937466458593,1.7109328927064817,-1.9039541897223107
+1746018839.216604,-2.6042745973086343,-2.1789611419513553,-1.255577488241776,-1.9013360200397096,1.7078401428628558,-1.9082987408435736
+1746018839.258806,-2.6094763410618986,-2.1950085511503414,-1.2290611702556746,-1.9123803488177538,1.7048017332351737,-1.9125598737879748
+1746018839.3019032,-2.614583241620377,-2.2112757698523144,-1.2019824396691283,-1.9237438550735724,1.7018163885426851,-1.9167399214511214
+1746018839.345955,-2.619597730353988,-2.2277821230545776,-1.1743038356968118,-1.9354456562837374,1.698882867106792,-1.9208411325148411
+1746018839.3910284,-2.624522161457751,-2.244549106616396,-1.1459833497468783,-1.9475072002625895,1.6959999600979527,-1.9248656750901965
+1746018839.4371989,-2.629358814719536,-2.2616007688731723,-1.1169736369810401,-1.9599526744268623,1.6931664907773376,-1.9288156401769119
+1746018839.4845517,-2.6341098981803106,-2.2789641819084694,-1.0872210423732849,-1.9728095107512091,1.690381313737162,-1.9326930449480468
+1746018839.533184,-2.6387775506888325,-2.29667002958243,-1.0566643851683533,-1.9861090154205274,1.6876433141434468,-1.9364998358677594
+1746018839.5832078,-2.6433638443520104,-2.3147533496405033,-1.025233424473071,-1.9998871631254325,1.6849514069848492,-1.9402378916487981
+1746018839.6347528,-2.647870786881036,-2.333254482166248,-0.9928468977842484,-2.0141856119336783,1.6823045363314142,-1.9439090260547813
+1746018839.6879692,-2.6523003238315535,-2.352220298914748,-0.9594099781441661,-2.0290530185056923,1.6797016746076414,-1.9475149905501257
+1746018839.7430353,-2.6566543407331253,-2.371705822022165,-0.9248109253040582,-2.044546769766889,1.6771418218854173,-1.9510574767971396
+1746018839.8001628,-2.660934665098117,-2.3917763936815626,-0.8889165963410672,-2.060735303978048,1.6746240052046204,-1.9545381189944557

test/joint_trajectories/trajectory_0007.csv

@@ -0,0 +1,49 @@
+timestamp,shoulder_pan_joint,shoulder_lift_joint,elbow_joint,wrist_1_joint,wrist_2_joint,wrist_3_joint
+1746018839.9870331,-2.6565675913485474,-2.3712857992447525,-0.9255559078539157,-2.0442195724473806,1.677191409598639,-1.9509867943370052
+1746018840.043153,-2.652120857280843,-2.3514240719614046,-0.96081719414931,-2.0284312315864717,1.6798071825274352,-1.9473698629721563
+1746018840.0973828,-2.6475949702273307,-2.3320899377081545,-0.9948907878594264,-2.0132860698846207,1.6824665734944126,-1.9436853434702956
+1746018840.1498814,-2.642988279158342,-2.313236694798178,-1.0278764921815773,-1.9987304370507137,1.6851719017566502,-1.9399327881358737
+1746018840.2008076,-2.638298735315647,-2.294814885433705,-1.0598744170804624,-1.984712928170956,1.6879242480214423,-1.9361103501227963
+1746018840.250297,-2.633524194858901,-2.2767822452979947,-1.0909696618664526,-1.9711899177215821,1.6907247392681217,-1.9322160918875388
+1746018840.298467,-2.6286624444814133,-2.2591021211719298,-1.1212356609614642,-1.9581237957700224,1.6935745337534254,-1.9282480057032545
+1746018840.3454187,-2.623711198269035,-2.2417424638586576,-1.1507362663155507,-1.9454818902536595,1.6964748221383763,-1.924204010085342
+1746018840.391241,-2.618668094938318,-2.2246750354050175,-1.1795273865911182,-1.9332356181869748,1.6994268283317515,-1.9200819464537484
+1746018840.436013,-2.6135306949506067,-2.2078747824687426,-1.2076582824800979,-1.921359814465153,1.7024318103456428,-1.9158795756110172
+1746018840.4798033,-2.6082964775157835,-2.1913193351437776,-1.2351726024131435,-1.9098321946797634,1.7054910611489644,-1.9115945740398341
+1746018840.5226743,-2.602962837480355,-2.1749886019263873,-1.2621092193549082,-1.8986329205545092,1.7086059095158914,-1.907224530007793
+1746018840.564681,-2.597527082095311,-2.158864439255521,-1.288502913335254,-1.8877442449032362,1.711777720865319,-1.9027669394671458
+1746018840.6058736,-2.591986427659406,-2.142930379547983,-1.3143849330085464,-1.8771502188832048,1.7150078980867605,-1.8982192017368305
+1746018840.6462967,-2.586337996033707,-2.1271714055894106,-1.3397834613776034,-1.8668364485315452,1.7182978823473665,-1.8935786149534903
+1746018840.6859908,-2.5805788110234267,-2.1115737620113757,-1.3647240048810532,-1.8567898906408586,1.7216491538739778,-1.888842371277539
+1746018840.7249928,-2.5747057946232905,-2.0961247967011114,-1.3892297206643045,-1.8469986802916203,1.7250632327031976,-1.8840075518395907
+1746018840.7633364,-2.568715763122914,-2.080812826569625,-1.4133216935874768,-1.8374519840458203,1.728541679391494,-1.8790711214117943
+1746018840.801052,-2.5626054230689332,-2.0656270232955447,-1.4370191720594814,-1.8281398740778985,1.7320860956762694,-1.874029922787756
+1746018840.838168,-2.5563713670810064,-2.0505573155703636,-1.4603397699098797,-1.8190532194872113,1.7356981250775654,-1.8688806708538452
+1746018840.8747098,-2.5500100695191747,-2.035594305069767,-1.4832996400660297,-1.810183591780205,1.7393794534287235,-1.8636199463337475
+1746018840.910701,-2.5435178820005877,-2.020729193918573,-1.5059136246824552,-1.8015231820869366,1.7431318093227937,-1.8582441891871508
+1746018840.9461634,-2.536891028764185,-2.005953721841944,-1.5281953854927215,-1.7930647281267673,1.7469569644597502,-1.8527496916424473
+1746018840.981242,-2.5301256018826224,-1.9912601115311623,-1.5501575174630116,-1.7848014492920683,1.75085673387769,-1.8471325908422993
+1746018841.0161424,-2.523217556321584,-1.9766410210193348,-1.5718116482777529,-1.7767269884990602,1.7548329760490322,-1.8413888610798816
+1746018841.0508816,-2.5161627048476034,-1.9620895020763978,-1.5931685257489863,-1.7688353596779463,1.7588875928203578,-1.835514305602535
+1746018841.0854752,-2.5089567127866803,-1.9475989638056517,-1.6142380948881407,-1.7611208999530463,1.7630225291718924,-1.829504547958538
+1746018841.1199381,-2.5015950926373596,-1.9331631407645378,-1.6350295660932637,-1.7535782257070403,1.7672397727696323,-1.8233550228616648
+1746018841.154285,-2.494073198543518,-1.918776065047465,-1.655551475672208,-1.7462021918391264,1.7715413532798507,-1.8170609665472082
+1746018841.1885288,-2.4863862206339724,-1.904432041863381,-1.6758117397321064,-1.7389878536203982,1.7759293414120219,-1.8106174065922302
+1746018841.2226827,-2.478529179238171,-1.8901256282196597,-1.6958177023090106,-1.7319304306255023,1.780405847652105,-1.8040191511719863
+1746018841.2567594,-2.470496918989714,-1.8758516143898851,-1.7155761784824244,-1.7250252722810013,1.784973020643612,-1.7972607777237521
+1746018841.2907708,-2.462284102832323,-1.86160500789886,-1.7350934931122435,-1.7182678246205565,1.7896330451688005,-1.790336620988805
+1746018841.324728,-2.4538852059461935,-1.8473810198056249,-1.754375515746359,-1.7116535978772094,1.7943881396767472,-1.7832407604030007
+1746018841.358642,-2.445294509616421,-1.8331750531060622,-1.7734276921725305,-1.7051781345753345,1.7992405532988585,-1.7759670068064304
+1746018841.392524,-2.436506095069578,-1.8189826931121282,-1.7922550730254687,-1.69883697781073,1.8041925622855022,-1.7685088884430336
+1746018841.4263835,-2.427513837309443,-1.8047996996958646,-1.8108623398073533,-1.6926256394278254,1.8092464657898573,-1.7608596362219362
+1746018841.46023,-2.418311398988563,-1.790622001314058,-1.8292538286354278,-1.6865395678191908,1.8144045809167348,-1.7530121682137474
+1746018841.4940736,-2.40889222435877,-1.7764456907543673,-1.8474335519925673,-1.6805741150850988,1.8196692369448968,-1.744959073357284
+1746018841.5279226,-2.39924953335109,-1.7622670225665948,-1.8654052187245902,-1.6747245033006095,1.8250427686213335,-1.7366925943552969
+1746018841.561786,-2.3893763158437915,-1.748082412163935,-1.8831722525006964,-1.6689857896451026,1.8305275084148604,-1.7282046097420172
+1746018841.5956717,-2.379265326186706,-1.7338884365990461,-1.9007378089298923,-1.6633528301549456,1.836125777604341,-1.7194866151109052
+1746018841.6295874,-2.3689090780605793,-1.7196818370388856,-1.9181047915060365,-1.657820241864649,1.8418398760636912,-1.710529703498208
+1746018841.6635406,-2.3582998397621493,-1.7054595229808347,-1.9352758665365535,-1.6523823631059535,1.847672070591579,-1.7013245449271
+1746018841.6975384,-2.3474296300191164,-1.6912185782709448,-1.9522534771944489,-1.6470332117384563,1.8536245816183596,-1.6918613651287444
+1746018841.7315872,-2.336290214454239,-1.6769562690034054,-1.9690398568195848,-1.6417664410902078,1.859699568106305,-1.6821299234710119
+1746018841.765693,-2.3248731028346676,-1.6626700533987864,-1.9856370415828184,-1.6365752933929596,1.865899110441612,-1.6721194901433825
+1746018841.7998614,-2.313169547261485,-1.6483575937774173,-2.0020468826151743,-1.6314525505051996,1.8722251910980745,-1.6618188226684314

test/joint_trajectories/trajectory_0008.csv

@@ -0,0 +1,49 @@
+timestamp,shoulder_pan_joint,shoulder_lift_joint,elbow_joint,wrist_1_joint,wrist_2_joint,wrist_3_joint
+1746018842.5402875,-2.324867488892618,-1.6626638643050697,-1.9856481674287725,-1.6365686872386849,1.8659028757307166,-1.6721139169687684
+1746018842.5743926,-2.336285336847922,-1.6769497403275242,-1.9690513540169463,-1.6417602831704612,1.8597028749042845,-1.6821250658227473
+1746018842.6084414,-2.34742500994231,-1.6912121029455849,-1.952265112023755,-1.6470268222984992,1.8536277184471475,-1.6918567062637508
+1746018842.6424391,-2.3582954583576528,-1.70545307936971,-1.9352876507993915,-1.652375753968947,1.8476750537315745,-1.7013200743219217
+1746018842.6763926,-2.368904917330334,-1.719675412415731,-1.918116736112199,-1.6578134131794136,1.8418427163257363,-1.7105254071905907
+1746018842.7103083,-2.3792613695392113,-1.7338820187088817,-1.9007499248090844,-1.6633457817890964,1.836128485052602,-1.7194824803340931
+1746018842.7441938,-2.389372548011029,-1.7480759892384194,-1.8831845507077034,-1.6689785210597952,1.8305300923665309,-1.7282006248243642
+1746018842.778057,-2.399245940270436,-1.7622605832544262,-1.8654177104972995,-1.6747170135130687,1.8250452377037503,-1.7366887486048386
+1746018842.811906,-2.408888793065886,-1.776439224055793,-1.8474462488098538,-1.680566402634909,1.8196715991491086,-1.7449553569600713
+1746018842.8457494,-2.418308117519668,-1.7906154965185248,-1.8292667422745,-1.68653163073772,1.814406843647519,-1.7530085721433006
+1746018842.879596,-2.4275106946121183,-1.804793146322379,-1.8108754824011035,-1.6926174752096972,1.8092486359123248,-1.7608561521584685
+1746018842.9134552,-2.4365030809213355,-1.8189760808518962,-1.7922684571203384,-1.6988285833864205,1.804194646168435,-1.7685055087012589
+1746018842.947337,-2.445291614550306,-1.83316837176703,-1.773441330787354,-1.705169506284085,1.7992425568549697,-1.7759637242709054
+1746018842.981251,-2.453882421182761,-1.8473742592585363,-1.7543894224326417,-1.7116447314395444,1.794390068400034,-1.7832375684700812
+1746018843.015208,-2.462281420217367,-1.8615981580244894,-1.7351076820162925,-1.7182587151097757,1.7896349041691835,-1.7903335135143934
+1746018843.0492191,-2.4704943309371865,-1.875844665027125,-1.715590664409718,-1.7250159140930839,1.7849748146790532,-1.7972577489761261
+1746018843.0832956,-2.47852667867777,-1.8901185691141786,-1.695832500791148,-1.731920817446927,1.7804075811583937,-1.80401619578906
+1746018843.1174493,-2.486383800962901,-1.904424862616587,-1.6758268670966427,-1.7389779783934214,1.77593101853041,-1.8106145195426782
+1746018843.1516929,-2.4940708535819773,-1.9187687550655812,-1.6555669491155875,-1.746192046724132,1.771542977882727,-1.8170581430949386
+1746018843.186039,-2.5015928165873476,-1.9331556892076327,-1.6350454037569808,-1.75356780204161,1.767241348484406,-1.8233522585331812
+1746018843.2205017,-2.5089545001936986,-1.947591359536563,-1.6142543159381102,-1.7611101882074818,1.7630240594032731,-1.8295018385127595
+1746018843.255095,-2.5161605505649063,-1.9620817336095804,-1.5931851504579162,-1.7688243494070508,1.7588890807711808,-1.8355116470026929
+1746018843.2898338,-2.5232154554766004,-1.976633076469821,-1.5718286981100367,-1.7767156682900942,1.7548344247398155,-1.8413862494671194
+1746018843.3247337,-2.530123549845209,-1.9912519785640157,-1.550175015161265,-1.7847898067089647,1.7508581461650792,-1.8471300225106297
+1746018843.3598118,-2.536889021116365,-2.0059453876228623,-1.528213355164565,-1.7930527496508992,1.7469583430540085,-1.8527471630147285
+1746018843.3952734,-2.543515914507428,-2.020720645066686,-1.5059320918853654,-1.8015108530550576,1.7431331568045234,-1.8582416967917432
+1746018843.431264,-2.55000813810045,-2.0355855276141934,-1.4833186318870422,-1.8101708963206287,1.7393807722649646,-1.8636174867815025
+1746018843.4678047,-2.5563694677832736,-2.0505482949128515,-1.460359315035404,-1.8190401404559557,1.7356994176374743,-1.8688782408150693
+1746018843.5049198,-2.5626035520376185,-2.0656177441825485,-1.437039300828411,-1.8281263929974354,1.73208736424656,-1.8740275189687523
+1746018843.5426345,-2.5687139165739636,-2.0808032730786503,-1.4133424380177668,-1.8374380810504354,1.728542926191846,-1.8790687405305482
+1746018843.580977,-2.574703968813886,-2.0961149522482367,-1.389251114438977,-1.8469843340853005,1.7250644599018843,-1.8840051906001005
+1746018843.619978,-2.5805770022211805,-2.1115636093898282,-1.3647460832735314,-1.8567750784764343,1.7216503636039722,-1.8888400263422143
+1746018843.6596708,-2.586336200483651,-2.127160927053329,-1.3398062610875832,-1.8668211462238793,1.718299076723243,-1.8935762829129181
+1746018843.7000928,-2.59198464154793,-2.14291955696164,-1.3144084918670436,-1.8771344008751694,1.715009079222785,-1.8982168790760696
+1746018843.741284,-2.597525301510031,-2.15885325433725,-1.2885272698190924,-1.887727884411981,1.711778890895176,-1.9027646225275003
+1746018843.7832894,-2.6029610583646225,-2.1749770366296417,-1.2621344118238726,-1.898615989838548,1.7086070706146312,-1.907222214942744
+1746018843.826159,-2.608294695616196,-2.1913073722373317,-1.2351986679427869,-1.9098146654869097,1.7054922155579035,-1.9115922567634516
+1746018843.869948,-2.613528905755412,-2.2078624064075445,-1.2076852551025856,-1.921341658750917,1.7024329604011337,-1.9158772517366682
+1746018843.9147182,-2.6186662936039466,-2.224662233628094,-1.179555294664146,-1.9332168092383715,1.699427976499047,-1.9200796112202423
+1746018843.960539,-2.6237093795310957,-2.2417292287198323,-1.150765128596573,-1.9454624044238837,1.6964759710521848,-1.9242016582667052
+1746018844.0074894,-2.6286606025452244,-2.2590884528179984,-1.1212654807402322,-1.9581036151406634,1.6935756862672857,-1.9282456314970036
+1746018844.0556576,-2.6335223232628375,-2.276768155982648,-1.0910004181509518,-1.9711690341873827,1.6907258985155078,-1.9322136887744374
+1746018844.105146,-2.6382968267575286,-2.2948004060436342,-1.0599060512365686,-1.9846913497400405,1.6879254174928588,-1.9361079106879855
+1746018844.156071,-2.642986325290239,-2.3132218846188746,-1.027908887935713,-1.9987081973841945,1.6851730853871425,-1.9399303038527773
+1746018844.2085686,-2.647592960920918,-2.3320749078831513,-0.9949237227429526,-2.013263252386578,1.682467776055919,-1.9436828040336234
+1746018844.262797,-2.652118807999548,-2.351408754603147,-0.9608508897531411,-2.028407650512558,1.679808394220622,-1.9473672790949055
+1746018844.3189442,-2.6565658755308927,-2.3712814222056484,-0.9255726297006897,-2.0442018666333395,1.677193874683371,-1.9509855317761713
+1746018844.3772337,-2.660936109401195,-2.391761991854846,-0.8889481963044275,-2.0607182448089048,1.6746231815756811,-1.9545393022863669

test/joint_trajectories/trajectory_0009.csv

@@ -0,0 +1,42 @@
+timestamp,shoulder_pan_joint,shoulder_lift_joint,elbow_joint,wrist_1_joint,wrist_2_joint,wrist_3_joint
+1746018844.4323194,-2.660877261862579,-2.3915612336261627,-0.8892745731176053,-2.060581756344425,1.6746560467702452,-1.954490040833097
+1746018844.5018663,-2.6557016253685237,-2.367151732073812,-0.9329722265719926,-2.0408663006710657,1.6777023299366034,-1.950284122335776
+1746018844.568479,-2.650338301479531,-2.3435216649692228,-0.9748262064865951,-2.022170034928338,1.6808551155733973,-1.9459197479035828
+1746018844.6324482,-2.6448595231275824,-2.3206302212549903,-1.0150192676341385,-2.00437125890477,1.6840735359108852,-1.9414581925452332
+1746018844.6940737,-2.6392626596402247,-2.2983849561821654,-1.053739712316787,-1.987373145463973,1.6873590182698432,-1.936897110448579
+1746018844.753599,-2.6335440482396093,-2.2767099849378747,-1.091140526454904,-1.971097246079571,1.6907134915419153,-1.9322331955150607
+1746018844.8112278,-2.627699877042689,-2.255541403189485,-1.1273497901716167,-1.9554779579368455,1.6941389515028558,-1.9274629912990284
+1746018844.8671327,-2.6217261835824344,-2.2348247780796133,-1.1624758691154253,-1.9404598376249336,1.6976374611766571,-1.9225828884404097
+1746018844.921461,-2.615618848050387,-2.2145132424777683,-1.1966113549198447,-1.925995560355681,1.7012111528542908,-1.917589116436357
+1746018844.9743397,-2.6093735860153804,-2.1945660523232307,-1.229836047098761,-1.9120443742740236,1.7048622302288887,-1.9124777347253512
+1746018845.0258791,-2.6029859408132183,-2.1749474761822234,-1.262219247527254,-1.898570909569995,1.7085929705191631,-1.9072446232255862
+1746018845.076176,-2.596451275585984,-2.15562592839206,-1.293821550991666,-1.8855442474723783,1.7124057265704336,-1.901885472280265
+1746018845.1253145,-2.589764764954471,-2.1365732837297275,-1.3246962603079382,-1.8729371826298127,1.7163029289176146,-1.896395771963805
+1746018845.1733701,-2.5829213863081004,-2.117764329375401,-1.3548905175963548,-1.8607256314646146,1.7202870877915686,-1.8907708007007797
+1746018845.2204094,-2.575915910697711,-2.0991763221294404,-1.3844462180779842,-1.8488881521187457,1.7243607950467474,-1.885005613146809
+1746018845.2664921,-2.568742893317628,-2.080788627324052,-1.41340075520735,-1.8374055506774118,1.728526725984139,-1.879095027277583
+1746018845.3116713,-2.5613966635646004,-2.062582421872802,-1.441787633541303,-1.8262605547651598,1.7327876410391179,-1.8730336106288294
+1746018845.3559947,-2.5538713146626058,-2.0445404482129246,-1.4696369768295674,-1.8154375402081122,1.7371463872986794,-1.8668156656263457
+1746018845.399506,-2.5461606928442797,-2.026646809036475,-1.496975952322328,-1.8049222998003287,1.7416058998068351,-1.8604352139413074
+1746018845.4422443,-2.5382583860818433,-2.008886795024565,-1.523829127504841,-1.794701845674274,1.746169202610286,-1.8538859798019078
+1746018845.4843569,-2.5301577123631076,-1.991246739530718,-1.5502187718989133,-1.7847642386079776,1.7508394094890196,-1.8471613721880802
+1746018845.5262134,-2.521851707511356,-1.9737138954678772,-1.5761651138787571,-1.7750984389791293,1.755619724307854,-1.8402544658315958
+1746018845.5678425,-2.5133331125519365,-1.9562763306531217,-1.6016865603977386,-1.76569417512119,1.7605134409151653,-1.8331579809393252
+1746018845.6092708,-2.504594360633246,-1.9389228386356796,-1.6267998859455726,-1.7565418256350511,1.7655239425038518,-1.8258642615529352
+1746018845.650524,-2.4956275635156593,-1.9216428626354147,-1.6515203958325457,-1.7476323128238214,1.770654700336853,-1.8183652524538716
+1746018845.691625,-2.4864244976490446,-1.9044264306929433,-1.6758620679411436,-1.7389570048929837,1.7759092717250482,-1.8106524745182977
+1746018845.732597,-2.4769765898679537,-1.887264100509744,-1.6998376763324217,-1.7305076249262603,1.7812912971288517,-1.8027169984228417
+1746018845.7734613,-2.4672749027436818,-1.8701469127601613,-1.7234588994971436,-1.7222761649335785,1.7868044962361145,-1.794549416598781
+1746018845.814238,-2.4573101196443767,-1.853066351904166,-1.74673641556505,-1.7142548034896372,1.7924526628476727,-1.7861398133299125
+1746018845.8549469,-2.447072529568564,-1.8360143137332672,-1.7696799864028452,-1.7064358256536563,1.7982396583778275,-1.7774777328881506
+1746018845.895606,-2.4365520118341872,-1.8189830790519497,-1.7922985322225422,-1.6988115439934046,1.8041694037498326,-1.7685521456012738
+1746018845.936233,-2.4257380207249533,-1.8019652930411643,-1.8146001980711162,-1.6913742196378094,1.8102458694357564,-1.7593514117497224
+1746018845.9768445,-2.4146195702188327,-1.7849539499747735,-1.836592413368029,-1.684115982358782,1.8164730633555406,-1.749863243194603
+1746018846.0174568,-2.403185218950566,-1.7679423830691017,-1.8582819454898074,-1.67702874873967,1.8228550163112764,-1.7400746626478572
+1746018846.0580845,-2.391423055591449,-1.7509242593437726,-1.8796749482630837,-1.6701041375293006,1.8293957645893064,-1.729971960508938
+1746018846.0987422,-2.3793206848662733,-1.7338935794618204,-1.900777006113524,-1.663333381310824,1.8360993293143677,-1.719540649211549
+1746018846.1394434,-2.3668652144696614,-1.71684468260119,-1.921593174523144,-1.656707233637037,1.8429696920862773,-1.7087654150505553
+1746018846.1802008,-2.35404324319303,-1.6997722564903195,-1.9421280173687696,-1.6502158708020003,1.8500107663703318,-1.6976300674949925
+1746018846.2210262,-2.3408408506298817,-1.6826713528192683,-1.9623856416465784,-1.6438487874362184,1.8572263640475164,-1.6861174860404806
+1746018846.2619305,-2.3272435888919,-1.665537408316354,-1.982369730028953,-1.6375946851332603,1.8646201564597407,-1.674209564716127
+1746018846.3029237,-2.3132364768425053,-1.6483662718597736,-2.0020835716477787,-1.631441353343968,1.8721956292088429,-1.6618871544406322

test/joint_trajectories/trajectory_0010.csv

@@ -0,0 +1,24 @@
+timestamp,shoulder_pan_joint,shoulder_lift_joint,elbow_joint,wrist_1_joint,wrist_2_joint,wrist_3_joint
+1746018846.3560357,-2.3130085956938866,-1.6483233526243926,-2.001977206248431,-1.6314733113507236,1.8723087568514263,-1.6616594225035375
+1746018846.4305744,-2.3388358476021205,-1.6795460542007503,-1.9664368180404543,-1.6425485632303423,1.8583739130646464,-1.684427078831277
+1746018846.5047834,-2.362647087264697,-1.710630663521463,-1.929485668203533,-1.654140630995307,1.8453295054735044,-1.70515310496932
+1746018846.5787566,-2.38524072066141,-1.7416164876426439,-1.8916255347633935,-1.6661784706090492,1.832857910617216,-1.7246866713100308
+1746018846.6526036,-2.4066879165837656,-1.772549426654369,-1.8528149107566543,-1.6787097382051663,1.8209319155061339,-1.7431089883505848
+1746018846.7264087,-2.4270634867744083,-1.803464910887023,-1.8130208451561034,-1.6917873807028299,1.8095274743428993,-1.7605076413015845
+1746018846.8002665,-2.4464370770556814,-1.8344023750415324,-1.7722041374105049,-1.70546001075909,1.7986202070321387,-1.7769618250610493
+1746018846.8742797,-2.464873352229402,-1.8654049090770946,-1.7303183448807542,-1.7197740207063121,1.7881860302351003,-1.7925432489101956
+1746018846.9485602,-2.4824323075854995,-1.8965195152315921,-1.6873086821866494,-1.734775167169783,1.7782014140406837,-1.8073169303173995
+1746018847.023231,-2.499169576884385,-1.9277975484986474,-1.6431106682832322,-1.750510123619308,1.7686435631331445,-1.8213418982473633
+1746018847.0984266,-2.515136735413988,-1.9592953707943308,-1.5976484503980861,-1.7670280594852574,1.7594905384681407,-1.834671820492901
+1746018847.1742954,-2.530381592906062,-1.9910752586345577,-1.5508326974006406,-1.7843823234114629,1.7507213334694898,-1.8473555619151956
+1746018847.2511272,-2.544948473012585,-2.02320662620703,-1.502557914652279,-1.8026323258921155,1.7423159157986694,-1.8594376805662984
+1746018847.33048,-2.5588784773562345,-2.0557676569134933,-1.4526989717652803,-1.8218457450095547,1.7342552433420195,-1.8709588683013811
+1746018847.4125922,-2.572209733115841,-2.0888474824947716,-1.4011065426442688,-1.8421012240361587,1.7265212611556757,-1.881956341987868
+1746018847.4977489,-2.5849776237714557,-2.1225491192448254,-1.3476010141333377,-1.8634918013750936,1.7190968846095789,-1.8924641908525368
+1746018847.5862975,-2.597215003075061,-2.156993482156479,-1.2919641913282793,-1.8861294293305844,1.7119659728025542,-1.9025136849151718
+1746018847.6786654,-2.608952392569415,-2.1923249801243347,-1.2339277521284209,-1.9101511305001087,1.7051132954222599,-1.9121335488517688
+1746018847.7753854,-2.62021816305776,-2.2287195051033524,-1.1731567639384495,-1.935727669516739,1.6985244955594485,-1.9213502049969469
+1746018847.8771353,-2.631038700292097,-2.266396176996222,-1.1092254406221964,-1.9630762026428175,1.692186050547594,-1.9301879884749291
+1746018847.984796,-2.6414385546579795,-2.3056352264240374,-1.041580206816695,-1.9924794566165864,1.6860852327341735,-1.9386693364873135
+1746018848.0995455,-2.6514405733959023,-2.346806404631134,-0.9694809829908353,-2.0243161316700506,1.6802100723780216,-1.9468149521890472
+1746018848.2230148,-2.6610660107953903,-2.3904165342649235,-0.891902860265656,-2.0591117367270884,1.6745493261558808,-1.9546439402665394

test/joint_trajectories/trajectory_0011.csv

@@ -0,0 +1,18 @@
+timestamp,shoulder_pan_joint,shoulder_lift_joint,elbow_joint,wrist_1_joint,wrist_2_joint,wrist_3_joint
+1746018848.2643304,-2.6609347487505555,-2.3904755025187687,-0.8916116138109151,-2.0593167577101767,1.6746293736765256,-1.9545390845923662
+1746018848.4278781,-2.6475531493072775,-2.332318534806963,-0.9943716968370002,-2.013565313574511,1.682490414580407,-1.9436497516464375
+1746018848.5865493,-2.6339045194406596,-2.2754722799061518,-1.0940677285933433,-1.969542426340629,1.6905077553408931,-1.932547644666357
+1746018848.726085,-2.6190663880240668,-2.2238026054586078,-1.181740610454354,-1.9320343919110845,1.6992022371674427,-1.9204314114830487
+1746018848.8568728,-2.6033934070997264,-2.174329564014844,-1.2639170623258666,-1.8976314190106425,1.7083642728307726,-1.9076037456955157
+1746018848.9800177,-2.5868032934933214,-2.1266751279832836,-1.341291313785015,-1.8659825536647,1.718038444620415,-1.8939904458004968
+1746018849.0967052,-2.5692198702647198,-2.080442419046562,-1.4146081969793198,-1.8367071108395678,1.7282627815289686,-1.8795199449258921
+1746018849.2078116,-2.5505574657807384,-2.0353250128181197,-1.4844184670314229,-1.8095222375768334,1.7390793755610483,-1.8641106993373677
+1746018849.3140135,-2.530721284543266,-1.9910746347012829,-1.5511470373904463,-1.7842063812936106,1.7505336738296329,-1.8476709341994808
+1746018849.4180765,-2.509606267481844,-1.9474848560071414,-1.615126653025983,-1.760580635828015,1.7626746293723121,-1.830097009816757
+1746018849.5209816,-2.487095896203111,-1.9043800875809487,-1.6766208845549073,-1.7384952286674875,1.7755547320918614,-1.8112715515031887
+1746018849.623092,-2.463060886353499,-1.8616081514239577,-1.7358400165117254,-1.717819218717114,1.789229913233929,-1.7910612483308577
+1746018849.7247272,-2.437357783499739,-1.819035280519161,-1.7929523367620606,-1.698431976491794,1.8037592566058942,-1.7693142652982765
+1746018849.8261704,-2.4098274864327496,-1.776542884785589,-1.8480923649767727,-1.680215488641479,1.819204424966241,-1.7458572061753823
+1746018849.9276726,-2.3802937443161665,-1.7340257146298896,-1.9013670084679408,-1.663046774310319,1.8356286737151244,-1.7204915624652455
+1746018850.029455,-2.348561706300859,-1.6913912489620513,-1.9528603051450268,-1.6467898270707944,1.8530952749049048,-1.6929895894622942
+1746018850.1317062,-2.3144166497039267,-1.648560279501294,-2.0026372117318076,-1.6312865552694753,1.8716651091213938,-1.6630895702386406

test/joint_trajectories/trajectory_0012.csv

@@ -0,0 +1,4 @@
+timestamp,shoulder_pan_joint,shoulder_lift_joint,elbow_joint,wrist_1_joint,wrist_2_joint,wrist_3_joint
+1746018850.109841,-2.313011843897503,-1.6483278638043584,-2.001973134912872,-1.631473607524726,1.8723022286671673,-1.6616605676847982
+1746018850.9285998,-2.530057868362053,-1.9912887235928973,-1.5500285523322554,-1.7848794748435552,1.7508934604482302,-1.8470722114886884
+1746018851.9807262,-2.66090844815948,-2.391741808932408,-0.8889580877977425,-2.060722047953615,1.6746397246401257,-1.9545166867765127

test/joint_trajectories/trajectory_0013.csv

@@ -0,0 +1,6 @@
+timestamp,shoulder_pan_joint,shoulder_lift_joint,elbow_joint,wrist_1_joint,wrist_2_joint,wrist_3_joint
+1746018851.5973852,-2.6608992184765543,-2.391989626851453,-0.8884322127188211,-2.0610011947501348,1.6746442142862108,-1.9545087957586498
+1746018852.1919017,-2.6029044107903507,-2.175002713505088,-1.2619779734894523,-1.8987579475592,1.7086796971987361,-1.9072056912717912
+1746018852.650539,-2.5300530074321905,-1.9911976499513728,-1.5501482326683962,-1.7848832159339922,1.750936604029861,-1.847101460421629
+1746018853.0620122,-2.4364126458090603,-1.8188401607040356,-1.792335579468164,-1.6989204345833993,1.8043023971112344,-1.7684754807829304
+1746018853.4696677,-2.313041265082593,-1.6480818588616595,-2.002234897954106,-1.6315915489852604,1.872411311265667,-1.661800398910474

test/joint_trajectories/trajectory_0014.csv

@@ -0,0 +1,5 @@
+timestamp,shoulder_pan_joint,shoulder_lift_joint,elbow_joint,wrist_1_joint,wrist_2_joint,wrist_3_joint
+1746018853.1196609,-2.3130113520279294,-1.648325580267437,-2.0019753776066005,-1.6314736381361497,1.8723036414963827,-1.6616607582297658
+1746018853.6607533,-2.4699891120194684,-1.8749778101254129,-1.7165904026027747,-1.724776644488748,1.7853302453653583,-1.7968751622153594
+1746018854.222654,-2.58022921110272,-2.11034624955184,-1.3666577963427213,-1.8560060626683874,1.7218522810006531,-1.8885548842815478
+1746018854.9840958,-2.660900393826002,-2.3920882685349434,-0.8882298622663658,-2.061105495482815,1.674643586760336,-1.9545098252724087

test/joint_trajectories/trajectory_0015.csv

@@ -0,0 +1,6 @@
+timestamp,shoulder_pan_joint,shoulder_lift_joint,elbow_joint,wrist_1_joint,wrist_2_joint,wrist_3_joint
+1746018854.5857203,-2.6608992364924906,-2.391998742211375,-0.8884133845660367,-2.0610109650372497,1.674644204602144,-1.9545088150235257
+1746018855.1802669,-2.6029044159431307,-2.1750027107661634,-1.261977980411899,-1.8987579468806866,1.7086796970381348,-1.9072056980080838
+1746018855.638904,-2.530053007429944,-1.9911976499443473,-1.5501482326775624,-1.784883215932142,1.7509366040327956,-1.8471014604205982
+1746018856.0503771,-2.4364126458090523,-1.8188401607040505,-1.7923355794681415,-1.698920434583396,1.804302397111229,-1.768475480782915
+1746018856.4580326,-2.313041265082593,-1.648081858861659,-2.0022348979541063,-1.6315915489852604,1.872411311265667,-1.6618003989104737

test/joint_trajectories/trajectory_0016.csv

@@ -0,0 +1,4 @@
+timestamp,shoulder_pan_joint,shoulder_lift_joint,elbow_joint,wrist_1_joint,wrist_2_joint,wrist_3_joint
+1746018856.150761,-2.313009953566788,-1.6483215379860596,-2.0019795627446983,-1.631472905032882,1.8723066215453645,-1.6616604891281928
+1746018856.9695346,-2.5300578687393553,-1.9912887230961742,-1.5500285541171726,-1.7848794736403348,1.7508934602761297,-1.847072211839675
+1746018858.021661,-2.6609084481595286,-2.3917418089286335,-0.8889580878056473,-2.060722047949449,1.6746397246401052,-1.9545166867765533

test/joint_trajectories/trajectory_0017.csv

@@ -0,0 +1,7 @@
+timestamp,shoulder_pan_joint,shoulder_lift_joint,elbow_joint,wrist_1_joint,wrist_2_joint,wrist_3_joint
+1746018857.5495617,-2.660899302230865,-2.392025404827116,-0.8883582428013344,-2.0610396015402404,1.6746441699032264,-1.9545088818412941
+1746018858.03965,-2.615528788576293,-2.214614992975414,-1.1962898699669853,-1.9262010237551856,1.7012759762388958,-1.9175228174280992
+1746018858.4300761,-2.561292881365791,-2.0626085021640415,-1.4416017879509189,-1.8264012161759362,1.7328581622598236,-1.8729535840622131
+1746018858.7666776,-2.4954979559493378,-1.921613228789207,-1.6514139228439317,-1.747741091546823,1.770741105680469,-1.8182630675361218
+1746018859.0931258,-2.414450811594105,-1.784870900410647,-1.8365413167359037,-1.6842092245652904,1.8165860531760938,-1.7497284587716226
+1746018859.419361,-2.3130102016373804,-1.6482177569989882,-2.0020828136446647,-1.6315268038763553,1.872352510197027,-1.6617054021835982

test/joint_trajectories/trajectory_0018.csv

@@ -0,0 +1,4 @@
+timestamp,shoulder_pan_joint,shoulder_lift_joint,elbow_joint,wrist_1_joint,wrist_2_joint,wrist_3_joint
+1746018859.1601691,-2.313008228565413,-1.6483158278494643,-2.0019854696581354,-1.631472115415696,1.872310711194097,-1.6616604176314222
+1746018859.9789567,-2.5300578690813227,-1.9912887226431317,-1.5500285557418627,-1.7848794725457204,1.750893460120368,-1.847072212157987
+1746018861.0310829,-2.6609084481595735,-2.391741808925192,-0.8889580878128558,-2.06072204794565,1.6746397246400875,-1.9545166867765904

test/joint_trajectories/trajectory_0019.csv

@@ -0,0 +1,7 @@
+timestamp,shoulder_pan_joint,shoulder_lift_joint,elbow_joint,wrist_1_joint,wrist_2_joint,wrist_3_joint
+1746018860.5458684,-2.6608993141666497,-2.3920293955061878,-0.8883499955898984,-2.0610438801437265,1.6746441636646425,-1.9545088935264285
+1746018861.03597,-2.615528787978891,-2.2146149908948014,-1.1962898729589728,-1.926201023315805,1.7012759778885602,-1.917522817898188
+1746018861.4263961,-2.561292881365768,-2.0626085021656806,-1.441601787948662,-1.8264012161758152,1.7328581622588528,-1.8729535840613691
+1746018861.7629974,-2.495497955949338,-1.9216132287892056,-1.6514139228439335,-1.7477410915468232,1.7707411056804698,-1.8182630675361227
+1746018862.0894456,-2.414450811594105,-1.784870900410647,-1.8365413167359037,-1.6842092245652904,1.8165860531760938,-1.7497284587716226
+1746018862.4156811,-2.3130102016373804,-1.6482177569989882,-2.0020828136446647,-1.6315268038763553,1.872352510197027,-1.6617054021835982

test/joint_trajectories/trajectory_0020.csv

@@ -0,0 +1,4 @@
+timestamp,shoulder_pan_joint,shoulder_lift_joint,elbow_joint,wrist_1_joint,wrist_2_joint,wrist_3_joint
+1746018862.1515627,-2.313008521539318,-1.6483168722231125,-2.0019843899417324,-1.631472238564406,1.872309973057284,-1.6616604031041338
+1746018862.970348,-2.5300578690196116,-1.9912887227241693,-1.5500285554485365,-1.7848794727441384,1.7508934601485429,-1.8470722121005971
+1746018864.022474,-2.6609084481595655,-2.391741808925812,-0.8889580878115577,-2.0607220479463337,1.6746397246400901,-1.9545166867765837

test/joint_trajectories/trajectory_0021.csv

@@ -0,0 +1,7 @@
+timestamp,shoulder_pan_joint,shoulder_lift_joint,elbow_joint,wrist_1_joint,wrist_2_joint,wrist_3_joint
+1746018863.5637312,-2.6608992903786857,-2.392021009144001,-0.8883673324424155,-2.0610348828617324,1.674644176109414,-1.9545088700368323
+1746018864.053805,-2.6155287892350185,-2.2146149952669463,-1.1962898666711363,-1.926201024239328,1.701275974419156,-1.9175228169091953
+1746018864.4442313,-2.561292881365816,-2.062608502162236,-1.4416017879534062,-1.8264012161760694,1.732858162260893,-1.8729535840631433
+1746018864.7808328,-2.4954979559493373,-1.9216132287892083,-1.65141392284393,-1.7477410915468223,1.770741105680468,-1.8182630675361207
+1746018865.107281,-2.4144508115941044,-1.7848709004106473,-1.8365413167359033,-1.6842092245652907,1.8165860531760938,-1.7497284587716229
+1746018865.4335163,-2.3130102016373804,-1.6482177569989882,-2.002082813644665,-1.6315268038763553,1.872352510197027,-1.6617054021835982

test/joint_trajectories/trajectory_0022.csv

@@ -0,0 +1,4 @@
+timestamp,shoulder_pan_joint,shoulder_lift_joint,elbow_joint,wrist_1_joint,wrist_2_joint,wrist_3_joint
+1746018865.1454973,-2.3130094134797368,-1.6483198465856737,-2.001981312549549,-1.6314726439594216,1.8723078443112016,-1.6616604315564611
+1746018865.9642751,-2.5300578688417263,-1.9912887229596485,-1.550028554603313,-1.7848794733138196,1.7508934602295874,-1.8470722119350325
+1746018867.0164015,-2.660908448159542,-2.391741808927602,-0.8889580878078083,-2.06072204794831,1.6746397246401,-1.9545166867765644

test/joint_trajectories_cart/trajectory_0001_cart.csv

@@ -0,0 +1,49 @@
+timestamp,x,y,z,roll,pitch,yaw
+1746018827.987727,0.98945062782806,0.3385907998268771,0.3547658488225996,0.3548421467685384,0.5400812646549652,0.9297790405611733
+1746018828.0438428,0.9790511074898933,0.3385982738312275,0.35476833660709517,0.35484387763999325,0.5400804356434588,0.9297799370759682
+1746018828.0980728,0.9686448732330093,0.3386023290932313,0.35477102085890877,0.35484392178328955,0.5400804470429994,0.9297799854891357
+1746018828.150571,0.9582374791097322,0.3386058647672078,0.35477337912832924,0.3548439836894107,0.5400804795215272,0.9297800451300114
+1746018828.2014976,0.9478290263272051,0.3386088843312398,0.3547753962783834,0.3548440618459587,0.5400805303671868,0.9297801153340102
+1746018828.250987,0.9374197007077508,0.33861147542544184,0.3547771309807368,0.3548441551233814,0.5400805979258549,0.9297801955713083
+1746018828.299157,0.9270096449290561,0.3386137045013258,0.35477862780822406,0.3548442627545597,0.5400806810211118,0.9297802855268571
+1746018828.3461087,0.9165989728101251,0.3386156245084926,0.3547799222645473,0.354844384233516,0.5400807788019361,0.9297803850388385
+1746018828.391931,0.9061877761961924,0.33861727808352854,0.35478104293707247,0.3548445192630661,0.5400808906752442,0.9297804940706165
+1746018828.4367027,0.8957761300305052,0.3386186999260437,0.35478201309934854,0.35484466771664,0.5400810162556035,0.9297806126903317
+1746018828.480493,0.885364096084589,0.3386199185463974,0.35478285188878494,0.35484482961065383,0.5400811553285416,0.9297807410563901
+1746018828.523364,0.874951725744389,0.33862095757169225,0.354783575185974,0.354845005084438,0.5400813078235711,0.9297808794072243
+1746018828.565371,0.8645390621193361,0.3386218367348407,0.35478419628019464,0.3548451943857001,0.5400814737943136,0.9297810280541893
+1746018828.6065636,0.8541261416585598,0.3386225726328759,0.3547847263794221,0.354845397860099,0.540081653403877,0.9297811873768238
+1746018828.6469865,0.8437129954033898,0.3386231793149332,0.3547851750056843,0.3548456159439455,0.5400818469142277,0.9297813578199472
+1746018828.6866806,0.8332996499680384,0.33862366874292565,0.35478555030483927,0.3548458491593261,0.5400820546786156,0.9297815398921883
+1746018828.7256827,0.8228861283147662,0.3386240511559741,0.35478585929172735,0.35484609811114,0.540082277136425,0.9297817341657004
+1746018828.7640262,0.8124724503719865,0.3386243353612869,0.35478610804601607,0.35484636348567705,0.5400825148099425,0.9297819412768413
+1746018828.801742,0.8020586335311176,0.33862452896828976,0.35478630187005794,0.354846646050476,0.5400827683027233,0.9297821619276997
+1746018828.838858,0.7916446930489613,0.3386246385785615,0.35478644541722654,0.35484694665526634,0.5400830382992801,0.9297823968883666
+1746018828.8753996,0.7812306423758255,0.3386246699410691,0.3547865427971164,0.35484726623384416,0.540083325565927,0.9297826469998716
+1746018828.9113908,0.7708164934247872,0.33862462807993604,0.3547865976624941,0.35484760580679175,0.5400836309526341,0.9297829131777642
+1746018828.9468534,0.7604022567939512,0.3386245174003163,0.3547866132817376,0.3548479664849486,0.5400839553958138,0.9297831964162833
+1746018828.981932,0.7499879419508725,0.33862434177669787,0.3547865925996949,0.3548483494736006,0.5400842999219613,0.9297834977931297
+1746018829.0168324,0.7395735573863236,0.3386241046270163,0.35478653828923035,0.3548487560773453,0.5400846656521302,0.92978381847482
+1746018829.0515716,0.7291591107430333,0.338623808975238,0.3547864527952661,0.35484918770559803,0.5400850538072088,0.9297841597226251
+1746018829.0861652,0.7187446089238667,0.3386234575045385,0.3547863383727542,0.35484964587875323,0.5400854657140032,0.9297845228991151
+1746018829.120628,0.7083300581829869,0.33862305260275155,0.3547861971197193,0.35485013223496914,0.5400859028121348,0.9297849094753228
+1746018829.1549747,0.6979154642028539,0.3386225964014569,0.3547860310063113,0.3548506485375911,0.5400863666617777,0.9297853210385344
+1746018829.1892185,0.6875008321593309,0.33862209080979605,0.3547858419006139,0.3548511966832113,0.5400868589522595,0.9297857593007371
+1746018829.2233727,0.6770861667767518,0.33862153754391094,0.35478563159183485,0.3548517787103644,0.5400873815115691,0.9297862261077503
+1746018829.2574494,0.6666714723744348,0.3386209381527294,0.3547854018113845,0.35485239680887254,0.5400879363168252,0.9297867234490398
+1746018829.2914605,0.6562567529058541,0.3386202940407016,0.35478515425227664,0.35485305332983186,0.5400885255057382,0.9297872534682682
+1746018829.3254178,0.6458420119914607,0.3386196064879625,0.3547848905872013,0.3548537507962404,0.5400891513891459,0.9297878184745573
+1746018829.359332,0.6354272529459345,0.3386188766683402,0.3547846124855788,0.35485449191425694,0.5400898164646668,0.92978842095451
+1746018829.393214,0.6250124788005298,0.3386181056655299,0.3547843216298531,0.3548552795850811,0.5400905234315458,0.9297890635849653
+1746018829.4270732,0.6145976923210283,0.3386172944877095,0.3547840197312423,0.3548561169174115,0.5400912752067503,0.9297897492464945
+1746018829.46092,0.6041828960217211,0.3386164440808249,0.35478370854514174,0.3548570072404519,0.5400920749423886,0.9297904810376029
+1746018829.4947634,0.5937680921757482,0.3386155553407147,0.35478338988635155,0.3548579541173864,0.5400929260445052,0.9297912622896114
+1746018829.5286126,0.5833532828220642,0.3386146291242265,0.35478306564426487,0.3548589613592577,0.5400938321933121,0.9297920965821272
+1746018829.562476,0.5729384697692176,0.3386136662594256,0.3547827377981535,0.3548600330391174,0.5400947973649016,0.9297929877590374
+1746018829.5963614,0.5625236545961011,0.33861266755498065,0.3547824084326578,0.35486117350630475,0.5400958258544716,0.9297939399448671
+1746018829.6302772,0.5521088386497741,0.3386116338087682,0.35478207975358095,0.35486238740066606,0.5400969223010706,0.9297949575613353
+1746018829.6642306,0.5416940230404215,0.33861056581572724,0.35478175410406476,0.3548636796664716,0.5400980917138504,0.9297960453438767
+1746018829.6982281,0.5312792086334933,0.33860946437494666,0.3547814339812177,0.3548650555657311,0.5400993394997665,0.9297972083578123
+1746018829.732277,0.5208643960390388,0.33860833029595816,0.3547811220532441,0.3548665206905392,0.5401006714926271,0.9297984520137942
+1746018829.7663827,0.510449585598229,0.338607164404173,0.35478082117710863,0.3548680809740007,0.5401020939833232,0.9297997820820324
+1746018829.8005512,0.5000347773670611,0.3386059675453585,0.3547805344167477,0.3548697426991863,0.5401036137509987,0.9298012047046857

test/joint_trajectories_cart/trajectory_0002_cart.csv

@@ -0,0 +1,50 @@
+timestamp,x,y,z,roll,pitch,yaw
+1746018829.9629352,0.5102308375666442,0.33860537194136614,0.35477988772721825,0.35486990276464075,0.5401023480303815,0.9297999290938809
+1746018829.9963524,0.5204328851034223,0.3386115837486437,0.3547815871128587,0.3548656967057072,0.5400998130540181,0.9297969484277177
+1746018830.029709,0.5306352568720152,0.3386125547994577,0.35478185566022347,0.35486429081603743,0.5400984591601475,0.929795755583826
+1746018830.0630164,0.5408376413778965,0.33861353594040705,0.35478211203886995,0.3548629219579096,0.5400971778041765,0.9297946120687574
+1746018830.0962808,0.5510400180632159,0.33861448801991634,0.3547823756375527,0.35486163330249554,0.5400959737673785,0.9297935412447313
+1746018830.1295083,0.561242386946426,0.338615410187246,0.3547826434393109,0.3548604196295559,0.5400948419363,0.9297925381920231
+1746018830.162706,0.5714447475169135,0.3386163016911055,0.35478291322351,0.35485927629083747,0.5400937773615129,0.9297915983966191
+1746018830.1958811,0.5816470990133458,0.3386171617678129,0.35478318288543653,0.35485819891060466,0.5400927754491894,0.9297907176327769
+1746018830.2290413,0.5918494404299254,0.3386179896408494,0.35478345043028775,0.3548571833706688,0.5400918319332397,0.9297898919463334
+1746018830.2621944,0.6020517705213024,0.3386187845147894,0.35478371395961616,0.35485622579919324,0.5400909428521983,0.9297891176408328
+1746018830.2953491,0.6122540878048776,0.33861954556848267,0.35478397165804665,0.3548553225590352,0.5400901045273436,0.9297883912635053
+1746018830.3285139,0.6224563905604233,0.3386202719474199,0.35478422178013236,0.3548544702359173,0.5400893135420816,0.9297877095913418
+1746018830.3616977,0.6326586768269248,0.33862096275526304,0.35478446263728514,0.3548536656266058,0.5400885667225659,0.9297870696174111
+1746018830.39491,0.6428609443964908,0.33862161704447313,0.35478469258467193,0.3548529057272062,0.5400878611195548,0.9297864685375535
+1746018830.4281607,0.6530631908051621,0.33862223380595297,0.3547849100079784,0.35485218772169463,0.5400871939914349,0.9297859037375167
+1746018830.4614599,0.6632654133203727,0.3386228119575897,0.3547851133099109,0.35485150897074424,0.5400865627883917,0.9297853727806085
+1746018830.4948182,0.6734676089247714,0.3386233503315536,0.3547853008962955,0.35485086700091045,0.5400859651376393,0.9297848733958944
+1746018830.5282469,0.6836697742960235,0.338623847660165,0.3547854711616042,0.3548502594942173,0.5400853988296749,0.9297844034669644
+1746018830.561757,0.6938719057821414,0.33862430256010556,0.3547856224737223,0.35484968427814606,0.5400848618054711,0.9297839610212794
+1746018830.595361,0.7040739993717672,0.33862471351469964,0.35478575315772803,0.35484913931606493,0.540084352144552,0.9297835442200874
+1746018830.6290712,0.7142760506587136,0.3386250788539257,0.3547858614784251,0.3548486226980787,0.540083868053884,0.929783151348902
+1746018830.662901,0.7244780547999153,0.3386253967317582,0.3547859456213176,0.35484813263229864,0.5400834078575071,0.9297827808085288
+1746018830.6968637,0.7346800064657361,0.33862566510034064,0.35478600367166335,0.35484766743652335,0.5400829699868459,0.9297824311066042
+1746018830.730974,0.744881899781361,0.338625881680388,0.35478603359115696,0.35484722553030124,0.5400825529716318,0.9297821008496331
+1746018830.765247,0.7550837282576983,0.33862604392709517,0.3547860331917262,0.35484680542734776,0.5400821554313623,0.9297817887354863
+1746018830.7997239,0.7652854847098542,0.33862614899064114,0.3547860001057848,0.3548464057282994,0.5400817760672394,0.9297814935463206
+1746018830.8346977,0.7754871611607881,0.33862619367019925,0.3547859317521677,0.3548460251137502,0.5400814136544997,0.9297812141418956
+1746018830.8701878,0.7856887487271866,0.33862617436007514,0.3547858252967799,0.35484566233753684,0.5400810670350813,0.9297809494532385
+1746018830.906216,0.7958902374838415,0.3386260869862885,0.3547856776067546,0.354845316220228,0.5400807351105352,0.9297806984766164
+1746018830.9428046,0.8060916163019007,0.33862592693146554,0.3547854851966493,0.35484498564274897,0.5400804168350929,0.9297804602677694
+1746018830.979979,0.8162928726551361,0.3386256889453817,0.3547852441647786,0.3548446695400894,0.540080111208812,0.9297802339363596
+1746018831.0177665,0.8264939923867874,0.3386253670377588,0.3547849501173374,0.35484436689499904,0.5400798172706679,0.9297800186405696
+1746018831.0561965,0.8366949594275045,0.3386249543490016,0.354784598077269,0.35484407673159696,0.540079534091475,0.9297798135817845
+1746018831.0953019,0.8468957554521337,0.3386244429933126,0.35478418237399745,0.35484379810875677,0.5400792607664834,0.9297796179992969
+1746018831.1351182,0.8570963594594918,0.3386238238669661,0.35478369650897196,0.3548435301131466,0.540078996407449,0.9297794311649141
+1746018831.175685,0.8672967472543252,0.3386230864123113,0.354783132990414,0.35484327185171877,0.5400787401339501,0.9297792523773852
+1746018831.2170453,0.8774968908039783,0.3386222183250202,0.35478248312854505,0.3548430224434288,0.5400784910636309,0.9297790809564763
+1746018831.2592473,0.8876967574331005,0.3386212051879557,0.3547817367796329,0.35484278100987465,0.5400782483009794,0.9297789162365343
+1746018831.3023446,0.8978963088068814,0.3386200300091943,0.3547808820231383,0.354842546664443,0.5400780109240952,0.9297787575592836
+1746018831.3463962,0.9080954996352522,0.3386186726335796,0.35477990475047566,0.3548423184994226,0.5400777779687443,0.9297786042655434
+1746018831.3914697,0.9182942760046386,0.3386171089854539,0.3547787881357081,0.3548420955703074,0.5400775484086952,0.9297784556854235
+1746018831.4376402,0.9284925732063453,0.3386153100832404,0.3547775119465214,0.35484187687627416,0.5400773211309818,0.9297783111263974
+1746018831.484993,0.9386903128753308,0.33861324074150284,0.3547760516362452,0.35484166133530687,0.5400770949041368,0.9297781698584056
+1746018831.5336254,0.9488873991701418,0.33861085783851486,0.3547743771312058,0.3548414477518555,0.5400768683365978,0.9297780310947452
+1746018831.5836492,0.9590837135976907,0.3386081079698914,0.3547724511872236,0.35484123477385576,0.5400766398211737,0.9297778939669725
+1746018831.635194,0.9692791078880415,0.33860492421897315,0.3547702271257263,0.35484102083439917,0.5400764074594073,0.929777757491109
+1746018831.6884105,0.9794733940066245,0.3386012216309549,0.354767645658593,0.3548408040708161,0.5400761689563759,0.9297776205210437
+1746018831.7434766,0.9896663298695357,0.33859689074179633,0.35476463034426053,0.35484058220979026,0.5400759214711092,0.9297774816826611
+1746018831.800604,0.9998575984452447,0.33859178811412316,0.35476108093583825,0.35484035240015555,0.5400756613986569,0.9297773392782596

test/joint_trajectories_cart/trajectory_0003_cart.csv

@@ -0,0 +1,49 @@
+timestamp,x,y,z,roll,pitch,yaw
+1746018831.9868114,0.9894510705865257,0.33859111094126054,0.35476610526485686,0.35484239062022366,0.5400812230399126,0.9297791634638071
+1746018832.0429308,0.9790510923743092,0.3385982632609757,0.3547683300166405,0.3548438777872087,0.5400804352570674,0.929779937132873
+1746018832.0971608,0.9686448736754288,0.3386023294126957,0.35477102107492137,0.3548439217773581,0.5400804470354574,0.9297799854850345
+1746018832.1496592,0.9582374790977437,0.33860586475829935,0.3547733791224178,0.3548439836894648,0.540080479521734,0.9297800451300654
+1746018832.2005854,0.9478290263275049,0.3386088843314691,0.3547753962785372,0.354844061845958,0.5400805303671822,0.9297801153340085
+1746018832.250075,0.9374197007077442,0.33861147542543657,0.3547771309807332,0.354844155123382,0.5400805979258545,0.9297801955713082
+1746018832.298245,0.9270096449290561,0.33861370450132566,0.3547786278082245,0.3548442627545595,0.5400806810211117,0.9297802855268567
+1746018832.3451965,0.9165989728101249,0.3386156245084924,0.3547799222645471,0.35484438423351605,0.5400807788019362,0.9297803850388383
+1746018832.391019,0.9061877761961924,0.3386172780835289,0.35478104293707247,0.3548445192630661,0.5400808906752443,0.9297804940706169
+1746018832.4357908,0.8957761300305053,0.3386186999260437,0.35478201309934815,0.35484466771664025,0.540081016255604,0.9297806126903315
+1746018832.479581,0.885364096084589,0.3386199185463975,0.354782851888785,0.3548448296106538,0.5400811553285415,0.9297807410563901
+1746018832.522452,0.874951725744389,0.33862095757169225,0.35478357518597403,0.3548450050844381,0.5400813078235712,0.9297808794072245
+1746018832.5644588,0.8645390621193363,0.3386218367348407,0.35478419628019475,0.35484519438570006,0.5400814737943135,0.9297810280541892
+1746018832.6056514,0.8541261416585597,0.33862257263287604,0.35478472637942204,0.3548453978600991,0.5400816534038773,0.9297811873768241
+1746018832.6460745,0.8437129954033898,0.33862317931493324,0.35478517500568424,0.35484561594394526,0.5400818469142276,0.929781357819947
+1746018832.6857686,0.8332996499680385,0.3386236687429251,0.35478555030483927,0.3548458491593254,0.5400820546786163,0.929781539892188
+1746018832.7247705,0.822886128314766,0.3386240511559741,0.3547858592917275,0.3548460981111399,0.5400822771364249,0.9297817341657006
+1746018832.7631142,0.8124724503719867,0.338624335361287,0.35478610804601624,0.3548463634856769,0.5400825148099422,0.9297819412768412
+1746018832.80083,0.8020586335311176,0.33862452896828965,0.3547863018700582,0.3548466460504759,0.5400827683027231,0.9297821619276995
+1746018832.8379457,0.7916446930489611,0.3386246385785615,0.35478644541722626,0.3548469466552664,0.5400830382992803,0.9297823968883668
+1746018832.8744876,0.7812306423758256,0.33862466994106916,0.3547865427971168,0.3548472662338443,0.540083325565927,0.929782646999872
+1746018832.9104788,0.7708164934247871,0.33862462807993604,0.354786597662494,0.35484760580679164,0.5400836309526343,0.9297829131777638
+1746018832.9459414,0.7604022567939512,0.3386245174003163,0.3547866132817376,0.3548479664849486,0.5400839553958138,0.9297831964162833
+1746018832.9810197,0.7499879419508725,0.33862434177669787,0.3547865925996949,0.3548483494736006,0.5400842999219613,0.9297834977931297
+1746018833.0159202,0.7395735573863236,0.3386241046270163,0.35478653828923035,0.3548487560773453,0.5400846656521302,0.92978381847482
+1746018833.0506594,0.7291591107430333,0.338623808975238,0.3547864527952661,0.35484918770559803,0.5400850538072088,0.9297841597226251
+1746018833.085253,0.7187446089238667,0.3386234575045385,0.3547863383727542,0.35484964587875323,0.5400854657140032,0.9297845228991151
+1746018833.1197162,0.7083300581829869,0.33862305260275155,0.3547861971197193,0.35485013223496914,0.5400859028121348,0.9297849094753228
+1746018833.1540627,0.6979154642028539,0.3386225964014569,0.3547860310063113,0.3548506485375911,0.5400863666617777,0.9297853210385344
+1746018833.1883066,0.6875008321593309,0.33862209080979605,0.3547858419006139,0.3548511966832113,0.5400868589522595,0.9297857593007371
+1746018833.2224605,0.6770861667767518,0.33862153754391094,0.35478563159183485,0.3548517787103644,0.5400873815115691,0.9297862261077503
+1746018833.2565372,0.6666714723744348,0.3386209381527294,0.3547854018113845,0.35485239680887254,0.5400879363168252,0.9297867234490398
+1746018833.2905486,0.6562567529058541,0.3386202940407016,0.35478515425227664,0.35485305332983186,0.5400885255057382,0.9297872534682682
+1746018833.3245058,0.6458420119914607,0.3386196064879625,0.3547848905872013,0.3548537507962404,0.5400891513891459,0.9297878184745573
+1746018833.3584201,0.6354272529459345,0.3386188766683402,0.3547846124855788,0.35485449191425694,0.5400898164646668,0.92978842095451
+1746018833.3923018,0.6250124788005298,0.3386181056655299,0.3547843216298531,0.3548552795850811,0.5400905234315458,0.9297890635849653
+1746018833.4261613,0.6145976923210283,0.3386172944877095,0.3547840197312423,0.3548561169174115,0.5400912752067503,0.9297897492464945
+1746018833.460008,0.6041828960217211,0.3386164440808249,0.35478370854514174,0.3548570072404519,0.5400920749423886,0.9297904810376029
+1746018833.4938514,0.5937680921757482,0.3386155553407147,0.35478338988635155,0.3548579541173864,0.5400929260445052,0.9297912622896114
+1746018833.5277004,0.5833532828220642,0.3386146291242265,0.35478306564426487,0.3548589613592577,0.5400938321933121,0.9297920965821272
+1746018833.5615637,0.5729384697692176,0.3386136662594256,0.3547827377981535,0.3548600330391174,0.5400947973649016,0.9297929877590374
+1746018833.5954494,0.5625236545961011,0.33861266755498065,0.3547824084326578,0.35486117350630475,0.5400958258544716,0.9297939399448671
+1746018833.6293652,0.5521088386497741,0.3386116338087682,0.35478207975358095,0.35486238740066606,0.5400969223010706,0.9297949575613353
+1746018833.6633184,0.5416940230404215,0.33861056581572724,0.35478175410406476,0.3548636796664716,0.5400980917138504,0.9297960453438767
+1746018833.6973162,0.5312792086334933,0.33860946437494666,0.3547814339812177,0.3548650555657311,0.5400993394997665,0.9297972083578123
+1746018833.731365,0.5208643960390388,0.33860833029595816,0.3547811220532441,0.3548665206905392,0.5401006714926271,0.9297984520137942
+1746018833.7654707,0.510449585598229,0.338607164404173,0.35478082117710863,0.3548680809740007,0.5401020939833232,0.9297997820820324
+1746018833.7996392,0.5000347773670611,0.3386059675453585,0.3547805344167477,0.3548697426991863,0.5401036137509987,0.9298012047046857

test/joint_trajectories_cart/trajectory_0004_cart.csv

@@ -0,0 +1,50 @@
+timestamp,x,y,z,roll,pitch,yaw
+1746018833.9629507,0.5102307535480057,0.33860553079152406,0.35477975608674506,0.3548703179616748,0.5401022341663749,0.9298001210477349
+1746018833.9963675,0.5204328843983944,0.3386115813910952,0.354781588792492,0.35486569898265385,0.5400998168763496,0.9297969506009277
+1746018834.0297241,0.5306352568887265,0.3386125548044641,0.3547818556267326,0.3548642907525997,0.5400984591649294,0.9297957555507093
+1746018834.0630317,0.5408376413777933,0.33861353594059973,0.3547821120393196,0.35486292195787833,0.5400971778037434,0.9297946120686386
+1746018834.0962958,0.551040018063216,0.3386144880199135,0.3547823756375488,0.35486163330250264,0.5400959737673802,0.9297935412447351
+1746018834.1295235,0.561242386946426,0.33861541018724595,0.354782643439311,0.3548604196295558,0.5400948419363,0.9297925381920227
+1746018834.1627212,0.5714447475169135,0.33861630169110535,0.35478291322350985,0.3548592762908375,0.5400937773615128,0.929791598396619
+1746018834.1958961,0.5816470990133457,0.33861716176781287,0.3547831828854367,0.3548581989106046,0.5400927754491893,0.9297907176327768
+1746018834.2290564,0.5918494404299255,0.3386179896408494,0.35478345043028764,0.35485718337066896,0.54009183193324,0.9297898919463335
+1746018834.2622097,0.6020517705213024,0.3386187845147895,0.3547837139596164,0.3548562257991931,0.540090942852198,0.9297891176408328
+1746018834.2953644,0.6122540878048774,0.3386195455684826,0.3547839716580464,0.3548553225590352,0.5400901045273439,0.9297883912635054
+1746018834.328529,0.6224563905604233,0.3386202719474199,0.3547842217801323,0.3548544702359173,0.5400893135420816,0.9297877095913417
+1746018834.3617127,0.6326586768269249,0.3386209627552631,0.354784462637285,0.3548536656266058,0.5400885667225659,0.9297870696174111
+1746018834.394925,0.6428609443964907,0.338621617044473,0.35478469258467216,0.35485290572720624,0.5400878611195548,0.9297864685375534
+1746018834.428176,0.6530631908051621,0.338622233805953,0.3547849100079783,0.3548521877216947,0.540087193991435,0.9297859037375168
+1746018834.4614751,0.6632654133203728,0.3386228119575897,0.354785113309911,0.35485150897074424,0.5400865627883916,0.9297853727806089
+1746018834.4948335,0.6734676089247712,0.33862335033155355,0.3547853008962955,0.3548508670009105,0.5400859651376394,0.9297848733958944
+1746018834.528262,0.6836697742960236,0.3386238476601651,0.3547854711616042,0.3548502594942174,0.540085398829675,0.9297844034669644
+1746018834.5617723,0.6938719057821414,0.33862430256010545,0.3547856224737222,0.35484968427814606,0.5400848618054711,0.9297839610212792
+1746018834.5953763,0.7040739993717672,0.33862471351469964,0.35478575315772803,0.3548491393160649,0.540084352144552,0.9297835442200871
+1746018834.6290865,0.7142760506587137,0.33862507885392557,0.35478586147842484,0.35484862269807815,0.5400838680538848,0.9297831513489022
+1746018834.662916,0.7244780547999153,0.3386253967317582,0.3547859456213176,0.3548481326322985,0.5400834078575071,0.9297827808085285
+1746018834.696879,0.7346800064657361,0.33862566510034064,0.3547860036716633,0.3548476674365234,0.540082969986846,0.9297824311066042
+1746018834.7309892,0.7448818997813609,0.33862588168038793,0.354786033591157,0.35484722553030146,0.5400825529716319,0.9297821008496333
+1746018834.7652624,0.7550837282576984,0.3386260439270948,0.3547860331917262,0.35484680542734776,0.5400821554313623,0.929781788735486
+1746018834.7997391,0.7652854847098542,0.33862614899064114,0.3547860001057848,0.3548464057282994,0.5400817760672394,0.9297814935463206
+1746018834.8347127,0.7754871611607881,0.33862619367019925,0.3547859317521677,0.3548460251137502,0.5400814136544997,0.9297812141418956
+1746018834.870203,0.7856887487271866,0.33862617436007514,0.3547858252967799,0.35484566233753684,0.5400810670350813,0.9297809494532385
+1746018834.906231,0.7958902374838415,0.3386260869862885,0.3547856776067546,0.354845316220228,0.5400807351105352,0.9297806984766164
+1746018834.9428196,0.8060916163019007,0.33862592693146554,0.3547854851966493,0.35484498564274897,0.5400804168350929,0.9297804602677694
+1746018834.979994,0.8162928726551361,0.3386256889453817,0.3547852441647786,0.3548446695400894,0.540080111208812,0.9297802339363596
+1746018835.0177815,0.8264939923867874,0.3386253670377588,0.3547849501173374,0.35484436689499904,0.5400798172706679,0.9297800186405696
+1746018835.0562117,0.8366949594275045,0.3386249543490016,0.354784598077269,0.35484407673159696,0.540079534091475,0.9297798135817845
+1746018835.0953171,0.8468957554521337,0.3386244429933126,0.35478418237399745,0.35484379810875677,0.5400792607664834,0.9297796179992969
+1746018835.1351335,0.8570963594594918,0.3386238238669661,0.35478369650897196,0.3548435301131466,0.540078996407449,0.9297794311649141
+1746018835.1757002,0.8672967472543252,0.3386230864123113,0.354783132990414,0.35484327185171877,0.5400787401339501,0.9297792523773852
+1746018835.2170606,0.8774968908039783,0.3386222183250202,0.35478248312854505,0.3548430224434288,0.5400784910636309,0.9297790809564763
+1746018835.2592626,0.8876967574331005,0.3386212051879557,0.3547817367796329,0.35484278100987465,0.5400782483009794,0.9297789162365343
+1746018835.3023596,0.8978963088068814,0.3386200300091943,0.3547808820231383,0.354842546664443,0.5400780109240952,0.9297787575592836
+1746018835.3464115,0.9080954996352522,0.3386186726335796,0.35477990475047566,0.3548423184994226,0.5400777779687443,0.9297786042655434
+1746018835.391485,0.9182942760046386,0.3386171089854539,0.3547787881357081,0.3548420955703074,0.5400775484086952,0.9297784556854235
+1746018835.4376554,0.9284925732063453,0.3386153100832404,0.3547775119465214,0.35484187687627416,0.5400773211309818,0.9297783111263974
+1746018835.485008,0.9386903128753308,0.33861324074150284,0.3547760516362452,0.35484166133530687,0.5400770949041368,0.9297781698584056
+1746018835.5336404,0.9488873991701418,0.33861085783851486,0.3547743771312058,0.3548414477518555,0.5400768683365978,0.9297780310947452
+1746018835.5836644,0.9590837135976907,0.3386081079698914,0.3547724511872236,0.35484123477385576,0.5400766398211737,0.9297778939669725
+1746018835.635209,0.9692791078880415,0.33860492421897315,0.3547702271257263,0.35484102083439917,0.5400764074594073,0.929777757491109
+1746018835.6884258,0.9794733940066245,0.3386012216309549,0.354767645658593,0.3548408040708161,0.5400761689563759,0.9297776205210437
+1746018835.743492,0.9896663298695357,0.33859689074179633,0.35476463034426053,0.35484058220979026,0.5400759214711092,0.9297774816826611
+1746018835.8006194,0.9998575984452447,0.33859178811412316,0.35476108093583825,0.35484035240015555,0.5400756613986569,0.9297773392782596

test/joint_trajectories_cart/trajectory_0005_cart.csv

@@ -0,0 +1,49 @@
+timestamp,x,y,z,roll,pitch,yaw
+1746018835.987803,0.9894514649621959,0.33859106643705594,0.35476579441382267,0.35484249959314046,0.5400810193952152,0.9297792152802237
+1746018836.043924,0.9790510872924697,0.33859825627096457,0.3547683235695871,0.35484387737989737,0.5400804356282864,0.9297799369587324
+1746018836.0981538,0.9686448738836344,0.3386023295304469,0.354771021142283,0.35484392178153074,0.5400804470379574,0.9297799854875691
+1746018836.1506522,0.9582374790925539,0.33860586475413884,0.3547733791195893,0.35484398368956804,0.5400804795218502,0.9297800451301365
+1746018836.2015784,0.947829026327638,0.33860888433156894,0.35477539627860416,0.3548440618459579,0.5400805303671801,0.9297801153340087
+1746018836.251068,0.937419700707741,0.33861147542543424,0.3547771309807317,0.3548441551233816,0.5400805979258546,0.9297801955713083
+1746018836.299238,0.9270096449290562,0.3386137045013258,0.3547786278082243,0.3548442627545595,0.5400806810211118,0.9297802855268568
+1746018836.3461897,0.9165989728101251,0.3386156245084926,0.3547799222645473,0.35484438423351583,0.5400807788019361,0.9297803850388383
+1746018836.3920121,0.9061877761961923,0.33861727808352854,0.35478104293707247,0.35484451926306626,0.5400808906752445,0.9297804940706167
+1746018836.4367838,0.8957761300305054,0.3386186999260437,0.35478201309934804,0.3548446677166402,0.5400810162556038,0.9297806126903316
+1746018836.4805741,0.8853640960845888,0.3386199185463974,0.35478285188878533,0.3548448296106537,0.5400811553285414,0.92978074105639
+1746018836.5234451,0.8749517257443892,0.33862095757169225,0.354783575185974,0.35484500508443817,0.5400813078235712,0.9297808794072246
+1746018836.565452,0.8645390621193361,0.33862183673484075,0.35478419628019453,0.3548451943857008,0.5400814737943135,0.929781028054189
+1746018836.6066446,0.8541261416585597,0.33862257263287604,0.35478472637942204,0.35484539786009894,0.5400816534038773,0.9297811873768239
+1746018836.6470675,0.8437129954033898,0.33862317931493324,0.35478517500568424,0.35484561594394537,0.5400818469142276,0.9297813578199473
+1746018836.6867616,0.8332996499680385,0.3386236687429251,0.35478555030483927,0.3548458491593254,0.5400820546786163,0.929781539892188
+1746018836.7257638,0.822886128314766,0.3386240511559741,0.3547858592917275,0.3548460981111399,0.5400822771364249,0.9297817341657006
+1746018836.7641072,0.8124724503719867,0.338624335361287,0.35478610804601624,0.3548463634856769,0.5400825148099422,0.9297819412768412
+1746018836.801823,0.8020586335311176,0.33862452896828965,0.3547863018700582,0.3548466460504759,0.5400827683027231,0.9297821619276995
+1746018836.838939,0.7916446930489611,0.3386246385785615,0.35478644541722626,0.3548469466552664,0.5400830382992803,0.9297823968883668
+1746018836.8754807,0.7812306423758256,0.33862466994106916,0.3547865427971168,0.3548472662338443,0.540083325565927,0.929782646999872
+1746018836.9114718,0.7708164934247871,0.33862462807993604,0.354786597662494,0.35484760580679164,0.5400836309526343,0.9297829131777638
+1746018836.9469345,0.7604022567939512,0.3386245174003163,0.3547866132817376,0.3548479664849486,0.5400839553958138,0.9297831964162833
+1746018836.982013,0.7499879419508725,0.33862434177669787,0.3547865925996949,0.3548483494736006,0.5400842999219613,0.9297834977931297
+1746018837.0169134,0.7395735573863236,0.3386241046270163,0.35478653828923035,0.3548487560773453,0.5400846656521302,0.92978381847482
+1746018837.0516527,0.7291591107430333,0.338623808975238,0.3547864527952661,0.35484918770559803,0.5400850538072088,0.9297841597226251
+1746018837.0862463,0.7187446089238667,0.3386234575045385,0.3547863383727542,0.35484964587875323,0.5400854657140032,0.9297845228991151
+1746018837.1207092,0.7083300581829869,0.33862305260275155,0.3547861971197193,0.35485013223496914,0.5400859028121348,0.9297849094753228
+1746018837.1550558,0.6979154642028539,0.3386225964014569,0.3547860310063113,0.3548506485375911,0.5400863666617777,0.9297853210385344
+1746018837.1892996,0.6875008321593309,0.33862209080979605,0.3547858419006139,0.3548511966832113,0.5400868589522595,0.9297857593007371
+1746018837.2234538,0.6770861667767518,0.33862153754391094,0.35478563159183485,0.3548517787103644,0.5400873815115691,0.9297862261077503
+1746018837.2575305,0.6666714723744348,0.3386209381527294,0.3547854018113845,0.35485239680887254,0.5400879363168252,0.9297867234490398
+1746018837.2915416,0.6562567529058541,0.3386202940407016,0.35478515425227664,0.35485305332983186,0.5400885255057382,0.9297872534682682
+1746018837.3254988,0.6458420119914607,0.3386196064879625,0.3547848905872013,0.3548537507962404,0.5400891513891459,0.9297878184745573
+1746018837.3594131,0.6354272529459345,0.3386188766683402,0.3547846124855788,0.35485449191425694,0.5400898164646668,0.92978842095451
+1746018837.3932948,0.6250124788005298,0.3386181056655299,0.3547843216298531,0.3548552795850811,0.5400905234315458,0.9297890635849653
+1746018837.4271543,0.6145976923210283,0.3386172944877095,0.3547840197312423,0.3548561169174115,0.5400912752067503,0.9297897492464945
+1746018837.4610012,0.6041828960217211,0.3386164440808249,0.35478370854514174,0.3548570072404519,0.5400920749423886,0.9297904810376029
+1746018837.4948444,0.5937680921757482,0.3386155553407147,0.35478338988635155,0.3548579541173864,0.5400929260445052,0.9297912622896114
+1746018837.5286937,0.5833532828220642,0.3386146291242265,0.35478306564426487,0.3548589613592577,0.5400938321933121,0.9297920965821272
+1746018837.562557,0.5729384697692176,0.3386136662594256,0.3547827377981535,0.3548600330391174,0.5400947973649016,0.9297929877590374
+1746018837.5964425,0.5625236545961011,0.33861266755498065,0.3547824084326578,0.35486117350630475,0.5400958258544716,0.9297939399448671
+1746018837.6303582,0.5521088386497741,0.3386116338087682,0.35478207975358095,0.35486238740066606,0.5400969223010706,0.9297949575613353
+1746018837.6643114,0.5416940230404215,0.33861056581572724,0.35478175410406476,0.3548636796664716,0.5400980917138504,0.9297960453438767
+1746018837.6983092,0.5312792086334933,0.33860946437494666,0.3547814339812177,0.3548650555657311,0.5400993394997665,0.9297972083578123
+1746018837.732358,0.5208643960390388,0.33860833029595816,0.3547811220532441,0.3548665206905392,0.5401006714926271,0.9297984520137942
+1746018837.7664638,0.510449585598229,0.338607164404173,0.35478082117710863,0.3548680809740007,0.5401020939833232,0.9297997820820324
+1746018837.8006322,0.5000347773670611,0.3386059675453585,0.3547805344167477,0.3548697426991863,0.5401036137509987,0.9298012047046857

test/joint_trajectories_cart/trajectory_0006_cart.csv

@@ -0,0 +1,50 @@
+timestamp,x,y,z,roll,pitch,yaw
+1746018837.9624937,0.5102306875593026,0.33860556456342195,0.35478002757694416,0.35487016941200744,0.5401025405160459,0.9298001220997502
+1746018837.9959111,0.5204328850940596,0.3386115801077767,0.35478158624335365,0.3548656954519625,0.5400998163251943,0.9297969485490394
+1746018838.0292678,0.530635256889031,0.33861255481936614,0.35478185564203296,0.35486429075511383,0.5400984591341419,0.92979575554463
+1746018838.062575,0.5408376413777307,0.3386135359405312,0.35478211203927335,0.3548629219583532,0.5400971778038364,0.9297946120689181
+1746018838.0958395,0.5510400180632162,0.33861448801991345,0.3547823756375483,0.3548616333025001,0.5400959737673825,0.9297935412447351
+1746018838.129067,0.561242386946426,0.338615410187246,0.35478264343931115,0.35486041962955583,0.5400948419362998,0.929792538192023
+1746018838.1622646,0.5714447475169135,0.3386163016911057,0.3547829132235098,0.3548592762908375,0.5400937773615131,0.9297915983966191
+1746018838.1954398,0.5816470990133457,0.33861716176781287,0.3547831828854366,0.35485819891060466,0.5400927754491891,0.9297907176327771
+1746018838.2286,0.5918494404299253,0.3386179896408493,0.35478345043028775,0.35485718337066874,0.5400918319332398,0.9297898919463334
+1746018838.261753,0.6020517705213025,0.33861878451478944,0.35478371395961616,0.3548562257991932,0.5400909428521982,0.9297891176408328
+1746018838.2949078,0.6122540878048776,0.33861954556848267,0.35478397165804665,0.3548553225590352,0.5400901045273436,0.9297883912635053
+1746018838.3280725,0.6224563905604233,0.3386202719474199,0.35478422178013236,0.3548544702359173,0.5400893135420816,0.9297877095913418
+1746018838.3612564,0.6326586768269248,0.33862096275526304,0.35478446263728514,0.3548536656266058,0.5400885667225659,0.9297870696174111
+1746018838.3944685,0.6428609443964908,0.33862161704447313,0.35478469258467193,0.3548529057272062,0.5400878611195548,0.9297864685375535
+1746018838.4277194,0.6530631908051621,0.33862223380595297,0.3547849100079784,0.35485218772169463,0.5400871939914349,0.9297859037375167
+1746018838.4610186,0.6632654133203727,0.3386228119575897,0.3547851133099109,0.35485150897074424,0.5400865627883917,0.9297853727806085
+1746018838.494377,0.6734676089247714,0.3386233503315536,0.3547853008962955,0.35485086700091045,0.5400859651376393,0.9297848733958944
+1746018838.5278056,0.6836697742960235,0.338623847660165,0.3547854711616042,0.3548502594942173,0.5400853988296749,0.9297844034669644
+1746018838.5613158,0.6938719057821414,0.33862430256010556,0.3547856224737223,0.35484968427814606,0.5400848618054711,0.9297839610212794
+1746018838.5949197,0.7040739993717672,0.33862471351469964,0.35478575315772803,0.35484913931606493,0.540084352144552,0.9297835442200874
+1746018838.62863,0.7142760506587136,0.3386250788539257,0.3547858614784251,0.3548486226980787,0.540083868053884,0.929783151348902
+1746018838.6624596,0.7244780547999153,0.3386253967317582,0.3547859456213176,0.35484813263229864,0.5400834078575071,0.9297827808085288
+1746018838.6964223,0.7346800064657361,0.33862566510034064,0.35478600367166335,0.35484766743652335,0.5400829699868459,0.9297824311066042
+1746018838.7305326,0.744881899781361,0.338625881680388,0.35478603359115696,0.35484722553030124,0.5400825529716318,0.9297821008496331
+1746018838.7648058,0.7550837282576983,0.33862604392709517,0.3547860331917262,0.35484680542734776,0.5400821554313623,0.9297817887354863
+1746018838.7992826,0.7652854847098542,0.33862614899064114,0.3547860001057848,0.3548464057282994,0.5400817760672394,0.9297814935463206
+1746018838.8342564,0.7754871611607881,0.33862619367019925,0.3547859317521677,0.3548460251137502,0.5400814136544997,0.9297812141418956
+1746018838.8697464,0.7856887487271866,0.33862617436007514,0.3547858252967799,0.35484566233753684,0.5400810670350813,0.9297809494532385
+1746018838.9057746,0.7958902374838415,0.3386260869862885,0.3547856776067546,0.354845316220228,0.5400807351105352,0.9297806984766164
+1746018838.9423633,0.8060916163019007,0.33862592693146554,0.3547854851966493,0.35484498564274897,0.5400804168350929,0.9297804602677694
+1746018838.9795377,0.8162928726551361,0.3386256889453817,0.3547852441647786,0.3548446695400894,0.540080111208812,0.9297802339363596
+1746018839.017325,0.8264939923867874,0.3386253670377588,0.3547849501173374,0.35484436689499904,0.5400798172706679,0.9297800186405696
+1746018839.0557551,0.8366949594275045,0.3386249543490016,0.354784598077269,0.35484407673159696,0.540079534091475,0.9297798135817845
+1746018839.0948606,0.8468957554521337,0.3386244429933126,0.35478418237399745,0.35484379810875677,0.5400792607664834,0.9297796179992969
+1746018839.134677,0.8570963594594918,0.3386238238669661,0.35478369650897196,0.3548435301131466,0.540078996407449,0.9297794311649141
+1746018839.1752436,0.8672967472543252,0.3386230864123113,0.354783132990414,0.35484327185171877,0.5400787401339501,0.9297792523773852
+1746018839.216604,0.8774968908039783,0.3386222183250202,0.35478248312854505,0.3548430224434288,0.5400784910636309,0.9297790809564763
+1746018839.258806,0.8876967574331005,0.3386212051879557,0.3547817367796329,0.35484278100987465,0.5400782483009794,0.9297789162365343
+1746018839.3019032,0.8978963088068814,0.3386200300091943,0.3547808820231383,0.354842546664443,0.5400780109240952,0.9297787575592836
+1746018839.345955,0.9080954996352522,0.3386186726335796,0.35477990475047566,0.3548423184994226,0.5400777779687443,0.9297786042655434
+1746018839.3910284,0.9182942760046386,0.3386171089854539,0.3547787881357081,0.3548420955703074,0.5400775484086952,0.9297784556854235
+1746018839.4371989,0.9284925732063453,0.3386153100832404,0.3547775119465214,0.35484187687627416,0.5400773211309818,0.9297783111263974
+1746018839.4845517,0.9386903128753308,0.33861324074150284,0.3547760516362452,0.35484166133530687,0.5400770949041368,0.9297781698584056
+1746018839.533184,0.9488873991701418,0.33861085783851486,0.3547743771312058,0.3548414477518555,0.5400768683365978,0.9297780310947452
+1746018839.5832078,0.9590837135976907,0.3386081079698914,0.3547724511872236,0.35484123477385576,0.5400766398211737,0.9297778939669725
+1746018839.6347528,0.9692791078880415,0.33860492421897315,0.3547702271257263,0.35484102083439917,0.5400764074594073,0.929777757491109
+1746018839.6879692,0.9794733940066245,0.3386012216309549,0.354767645658593,0.3548408040708161,0.5400761689563759,0.9297776205210437
+1746018839.7430353,0.9896663298695357,0.33859689074179633,0.35476463034426053,0.35484058220979026,0.5400759214711092,0.9297774816826611
+1746018839.8001628,0.9998575984452447,0.33859178811412316,0.35476108093583825,0.35484035240015555,0.5400756613986569,0.9297773392782596

test/joint_trajectories_cart/trajectory_0007_cart.csv

@@ -0,0 +1,49 @@
+timestamp,x,y,z,roll,pitch,yaw
+1746018839.9870331,0.9894510355610513,0.3385912571647137,0.3547664248803014,0.35484193565140265,0.5400812026739317,0.9297789204019978
+1746018840.043153,0.9790510900580351,0.3385982636222143,0.3547683318795274,0.35484387708550785,0.5400804362558663,0.9297799368189359
+1746018840.0973828,0.9686448737018083,0.338602329453063,0.3547710211121765,0.3548439217787354,0.5400804470334919,0.9297799854855084
+1746018840.1498814,0.9582374790966991,0.3386058647577248,0.3547733791220962,0.3548439836894355,0.5400804795217156,0.9297800451300474
+1746018840.2008076,0.9478290263275285,0.3386088843314891,0.35477539627855115,0.35484406184595746,0.5400805303671812,0.929780115334008
+1746018840.250297,0.9374197007077437,0.33861147542543635,0.35477713098073305,0.3548441551233821,0.5400805979258542,0.9297801955713083
+1746018840.298467,0.9270096449290561,0.33861370450132566,0.3547786278082242,0.3548442627545596,0.5400806810211121,0.9297802855268568
+1746018840.3454187,0.9165989728101249,0.33861562450849236,0.35477992226454746,0.3548443842335158,0.5400807788019358,0.9297803850388381
+1746018840.391241,0.9061877761961923,0.3386172780835289,0.3547810429370727,0.3548445192630661,0.5400808906752443,0.929780494070617
+1746018840.436013,0.8957761300305052,0.33861869992604365,0.3547820130993479,0.35484466771664025,0.5400810162556039,0.9297806126903315
+1746018840.4798033,0.885364096084589,0.3386199185463975,0.3547828518887851,0.3548448296106538,0.5400811553285415,0.9297807410563901
+1746018840.5226743,0.874951725744389,0.33862095757169225,0.35478357518597403,0.3548450050844381,0.5400813078235712,0.9297808794072245
+1746018840.564681,0.8645390621193363,0.3386218367348407,0.35478419628019475,0.35484519438570006,0.5400814737943135,0.9297810280541892
+1746018840.6058736,0.8541261416585597,0.33862257263287604,0.35478472637942204,0.3548453978600991,0.5400816534038773,0.9297811873768241
+1746018840.6462967,0.8437129954033898,0.33862317931493324,0.35478517500568424,0.35484561594394526,0.5400818469142276,0.929781357819947
+1746018840.6859908,0.8332996499680385,0.3386236687429251,0.35478555030483927,0.3548458491593254,0.5400820546786163,0.929781539892188
+1746018840.7249928,0.822886128314766,0.3386240511559741,0.3547858592917275,0.3548460981111399,0.5400822771364249,0.9297817341657006
+1746018840.7633364,0.8124724503719867,0.338624335361287,0.35478610804601624,0.3548463634856769,0.5400825148099422,0.9297819412768412
+1746018840.801052,0.8020586335311176,0.33862452896828965,0.3547863018700582,0.3548466460504759,0.5400827683027231,0.9297821619276995
+1746018840.838168,0.7916446930489611,0.3386246385785615,0.35478644541722626,0.3548469466552664,0.5400830382992803,0.9297823968883668
+1746018840.8747098,0.7812306423758256,0.33862466994106916,0.3547865427971168,0.3548472662338443,0.540083325565927,0.929782646999872
+1746018840.910701,0.7708164934247871,0.33862462807993604,0.354786597662494,0.35484760580679164,0.5400836309526343,0.9297829131777638
+1746018840.9461634,0.7604022567939512,0.3386245174003163,0.3547866132817376,0.3548479664849486,0.5400839553958138,0.9297831964162833
+1746018840.981242,0.7499879419508725,0.33862434177669787,0.3547865925996949,0.3548483494736006,0.5400842999219613,0.9297834977931297
+1746018841.0161424,0.7395735573863236,0.3386241046270163,0.35478653828923035,0.3548487560773453,0.5400846656521302,0.92978381847482
+1746018841.0508816,0.7291591107430333,0.338623808975238,0.3547864527952661,0.35484918770559803,0.5400850538072088,0.9297841597226251
+1746018841.0854752,0.7187446089238667,0.3386234575045385,0.3547863383727542,0.35484964587875323,0.5400854657140032,0.9297845228991151
+1746018841.1199381,0.7083300581829869,0.33862305260275155,0.3547861971197193,0.35485013223496914,0.5400859028121348,0.9297849094753228
+1746018841.154285,0.6979154642028539,0.3386225964014569,0.3547860310063113,0.3548506485375911,0.5400863666617777,0.9297853210385344
+1746018841.1885288,0.6875008321593309,0.33862209080979605,0.3547858419006139,0.3548511966832113,0.5400868589522595,0.9297857593007371
+1746018841.2226827,0.6770861667767518,0.33862153754391094,0.35478563159183485,0.3548517787103644,0.5400873815115691,0.9297862261077503
+1746018841.2567594,0.6666714723744348,0.3386209381527294,0.3547854018113845,0.35485239680887254,0.5400879363168252,0.9297867234490398
+1746018841.2907708,0.6562567529058541,0.3386202940407016,0.35478515425227664,0.35485305332983186,0.5400885255057382,0.9297872534682682
+1746018841.324728,0.6458420119914607,0.3386196064879625,0.3547848905872013,0.3548537507962404,0.5400891513891459,0.9297878184745573
+1746018841.358642,0.6354272529459345,0.3386188766683402,0.3547846124855788,0.35485449191425694,0.5400898164646668,0.92978842095451
+1746018841.392524,0.6250124788005298,0.3386181056655299,0.3547843216298531,0.3548552795850811,0.5400905234315458,0.9297890635849653
+1746018841.4263835,0.6145976923210283,0.3386172944877095,0.3547840197312423,0.3548561169174115,0.5400912752067503,0.9297897492464945
+1746018841.46023,0.6041828960217211,0.3386164440808249,0.35478370854514174,0.3548570072404519,0.5400920749423886,0.9297904810376029
+1746018841.4940736,0.5937680921757482,0.3386155553407147,0.35478338988635155,0.3548579541173864,0.5400929260445052,0.9297912622896114
+1746018841.5279226,0.5833532828220642,0.3386146291242265,0.35478306564426487,0.3548589613592577,0.5400938321933121,0.9297920965821272
+1746018841.561786,0.5729384697692176,0.3386136662594256,0.3547827377981535,0.3548600330391174,0.5400947973649016,0.9297929877590374
+1746018841.5956717,0.5625236545961011,0.33861266755498065,0.3547824084326578,0.35486117350630475,0.5400958258544716,0.9297939399448671
+1746018841.6295874,0.5521088386497741,0.3386116338087682,0.35478207975358095,0.35486238740066606,0.5400969223010706,0.9297949575613353
+1746018841.6635406,0.5416940230404215,0.33861056581572724,0.35478175410406476,0.3548636796664716,0.5400980917138504,0.9297960453438767
+1746018841.6975384,0.5312792086334933,0.33860946437494666,0.3547814339812177,0.3548650555657311,0.5400993394997665,0.9297972083578123
+1746018841.7315872,0.5208643960390388,0.33860833029595816,0.3547811220532441,0.3548665206905392,0.5401006714926271,0.9297984520137942
+1746018841.765693,0.510449585598229,0.338607164404173,0.35478082117710863,0.3548680809740007,0.5401020939833232,0.9297997820820324
+1746018841.7998614,0.5000347773670611,0.3386059675453585,0.3547805344167477,0.3548697426991863,0.5401036137509987,0.9298012047046857

test/joint_trajectories_cart/trajectory_0008_cart.csv

@@ -0,0 +1,49 @@
+timestamp,x,y,z,roll,pitch,yaw
+1746018842.5402875,0.5104440846719139,0.3386068104107253,0.3547788766321834,0.3548683946803408,0.5401020146176606,0.9297990355283123
+1746018842.5743926,0.5208589434736831,0.3386074486389229,0.3547791992112156,0.35486682726211377,0.5401008346652705,0.9297977812677931
+1746018842.6084414,0.5312738152904978,0.3386085231377703,0.35477945901221725,0.3548652773570319,0.5400993844242197,0.9297964816228174
+1746018842.6424391,0.5416886762189116,0.33860956414884674,0.3547797326537425,0.3548638272386115,0.5400980261039631,0.9297952706303569
+1746018842.6763926,0.5521035288560308,0.3386105734235112,0.35478001315408325,0.3548624634164672,0.5400967515820373,0.9297941380289428
+1746018842.7103083,0.5625183728801105,0.33861155015027633,0.3547802979805631,0.35486118049810284,0.5400955549446282,0.9297930785245245
+1746018842.7441938,0.5729332076996463,0.3386124934899272,0.354780584677762,0.3548599733693764,0.5400944307505756,0.9297920871515345
+1746018842.778057,0.5833480324386696,0.33861340259428574,0.3547808709289912,0.35485883721738815,0.5400933739534488,0.9297911592647436
+1746018842.811906,0.5937628459450863,0.33861427659956217,0.35478115453963016,0.35485776751892834,0.540092379874089,0.929790290524119
+1746018842.8457494,0.6041776467959188,0.3386151146192766,0.3547814334215864,0.354856760027366,0.5400914441741087,0.9297894768787137
+1746018842.879596,0.6145924332994557,0.3386159157362372,0.354781705577983,0.3548558107591475,0.54009056283085,0.9297887145504744
+1746018842.9134552,0.6250072034942205,0.3386166789935513,0.354781969088006,0.35485491598012414,0.5400897321138279,0.9297880000181953
+1746018842.947337,0.6354219551446234,0.3386174033846353,0.354782222091806,0.3548540721919195,0.5400889485626406,0.9297873300017958
+1746018842.981251,0.645836685733121,0.3386180878421396,0.35478246277534065,0.3548532761184714,0.5400882089663114,0.9297867014470579
+1746018843.015208,0.6562513924486427,0.33861873122568253,0.35478268935502055,0.35485252469285716,0.5400875103440117,0.9297861115109097
+1746018843.0492191,0.6666660721709877,0.33861933230824387,0.35478290006200464,0.3548518150445045,0.5400868499270995,0.9297855575473329
+1746018843.0832956,0.6770807214508109,0.33861988976102886,0.3547830931259661,0.35485114448682914,0.5400862251424045,0.9297850370939107
+1746018843.1174493,0.6874953364847085,0.33862040213657035,0.3547832667581168,0.3548505105053418,0.5400856335966832,0.9297845478590666
+1746018843.1516929,0.6979099130848254,0.3386208678497805,0.3547834191332516,0.3548499107462614,0.5400850730621646,0.929784087709971
+1746018843.186039,0.7083244466422343,0.3386212851565882,0.3547835483705282,0.35484934300562093,0.5400845414631047,0.9297836546611234
+1746018843.2205017,0.7187389320832016,0.3386216521297463,0.3547836525126443,0.3548488052188824,0.5400840368632686,0.9297832468635927
+1746018843.255095,0.7291533638172167,0.33862196663125893,0.35478372950302045,0.3548482954510314,0.5400835574542612,0.9297828625948783
+1746018843.2898338,0.7395677356754277,0.3386222262808148,0.35478377716050835,0.35484781188714903,0.5400831015446186,0.9297825002493824
+1746018843.3247337,0.7499820408378017,0.3386224284194115,0.35478379315105446,0.3548473528234164,0.5400826675495859,0.9297821583294369
+1746018843.3598118,0.7603962717469366,0.33862257006723123,0.3547837749556275,0.35484691665852297,0.5400822539814921,0.9297818354368601
+1746018843.3952734,0.7708104200059512,0.3386226478745653,0.3547837198335545,0.3548465018854457,0.5400818594406371,0.9297815302649937
+1746018843.431264,0.7812244762572634,0.338622658064322,0.3547836247802293,0.35484610708353137,0.5400814826066125,0.9297812415911764
+1746018843.4678047,0.7916384300382565,0.33862259636428776,0.3547834864778963,0.354845730910852,0.5400811222299495,0.9297809682696033
+1746018843.5049198,0.8020522696088227,0.33862245792684165,0.3547833012378911,0.3548453720967464,0.5400807771240027,0.929780709224518
+1746018843.5426345,0.8124659817444418,0.33862223723323553,0.354783064932311,0.3548450294344816,0.54008044615696,0.9297804634436779
+1746018843.580977,0.8228795514867315,0.3386219279787632,0.3547827729125347,0.3548447017739518,0.5400801282438424,0.9297802299720244
+1746018843.619978,0.8332929618411472,0.338621522934118,0.3547824199113008,0.35484438801429646,0.5400798223383568,0.9297800079054849
+1746018843.6596708,0.8437061934085042,0.33862101377688675,0.35478199992410064,0.35484408709630927,0.5400795274244228,0.9297797963848167
+1746018843.7000928,0.8541192239329839,0.33862039088530266,0.3547815060643793,0.35484379799448323,0.5400792425071519,0.9297795945893922
+1746018843.741284,0.8645320277438772,0.3386196430839282,0.354780930385305,0.354843519708477,0.5400789666030109,0.9297794017307852
+1746018843.7832894,0.8749445750609143,0.3386187573275949,0.3547802636585345,0.35484325125374316,0.54007869872883,0.929779217046009
+1746018843.826159,0.8853568311228323,0.33861771830529663,0.3547794950971589,0.35484299165096983,0.540078437889182,0.9297790397901903
+1746018843.869948,0.8957687550845774,0.338616507939286,0.3547786120054782,0.3548427399138723,0.5400781830615539,0.9297788692284126
+1746018843.9147182,0.9061802986083771,0.3386151047454902,0.35477759933184766,0.3548424950347194,0.5400779331784775,0.9297787046263575
+1746018843.960539,0.9165914040449656,0.3386134830082501,0.3547764390916355,0.35484225596673186,0.54007768710551,0.9297785452392581
+1746018844.0074894,0.9270020020590983,0.3386116117033171,0.35477510961390757,0.35484202160215017,0.5400774436135003,0.9297783902984681
+1746018844.0556576,0.9374120084910398,0.3386094530747695,0.3547735845455799,0.35484179074428723,0.5400772013429141,0.92977823899467
+1746018844.105146,0.9478213201515535,0.33860696072891644,0.3547718315167805,0.35484156207109024,0.540076958757013,0.9297780904563273
+1746018844.156071,0.9582298091031093,0.3386040770427362,0.3547698103250159,0.35484133408658447,0.5400767140791349,0.9297779437212912
+1746018844.2085686,0.9686373147523818,0.33860072958147797,0.3547674704231579,0.35484110505473054,0.5400764652069426,0.9297777976984619
+1746018844.262797,0.9790436327126595,0.33859682605435887,0.3547647473793561,0.3548408729072569,0.5400762095926251,0.9297776511146897
+1746018844.3189442,0.9894484987886571,0.33859224706338553,0.35476155778354296,0.3548406351121366,0.5400759440716495,0.9297775024393419
+1746018844.3772337,0.999851565403366,0.3385868354337149,0.3547577917453807,0.3548403884810008,0.5400756646117768,0.9297773497741979

test/joint_trajectories_cart/trajectory_0009_cart.csv

@@ -0,0 +1,42 @@
+timestamp,x,y,z,roll,pitch,yaw
+1746018844.4323194,0.9997484988833173,0.3386066113332168,0.3547773286570418,0.3548351047365334,0.5400714505874364,0.9297745256683936
+1746018844.5018663,0.98732122402018,0.3385451664409863,0.3547349018942071,0.354846349655948,0.5400835848308985,0.9297816002052235
+1746018844.568479,0.9748411095658571,0.3385520261751348,0.3547395708086607,0.3548466148387508,0.5400836743785448,0.9297818039232204
+1746018844.6324482,0.9623581784281144,0.33855865398030294,0.35474397095840726,0.35484667711819945,0.5400836727185443,0.9297818825554784
+1746018844.6940737,0.9498728524019968,0.3385641235034418,0.3547476048144682,0.35484677577752893,0.5400837154536844,0.9297819843882299
+1746018844.753599,0.9373856454778458,0.33856866978576977,0.35475063203313484,0.35484690948381575,0.5400837976802587,0.9297821090157239
+1746018844.8112278,0.9248969226767055,0.3385724628759203,0.35475316630776565,0.35484707565976936,0.5400839156004087,0.929782255290771
+1746018844.8671327,0.9124069624096844,0.33857563247347744,0.35475529427392144,0.35484727262014437,0.5400840665487614,0.929782422581251
+1746018844.921461,0.8999159803571215,0.3385782788009319,0.3547570828719523,0.35484749938081245,0.5400842487284764,0.9297826106707163
+1746018844.9743397,0.8874241462345426,0.3385804804648471,0.354758584631521,0.35484775550792697,0.5400844610130635,0.929782819677958
+1746018845.0258791,0.87493159545736,0.3385822999255165,0.35475984134377203,0.354848041014445,0.540084702809481,0.9297830500029584
+1746018845.076176,0.8624384374344458,0.3385837873890275,0.354760886671796,0.3548483562888922,0.540084973962506,0.9297833022909344
+1746018845.1253145,0.8499447615724599,0.3385849836271595,0.3547617480406406,0.35484870204656777,0.5400852746877851,0.9297835774091013
+1746018845.1733701,0.8374506416943303,0.3385859220542095,0.35476244802875007,0.3548490792968025,0.5400856055253075,0.9297838764327032
+1746018845.2204094,0.8249561393390087,0.33858663027944447,0.35476300540813765,0.35484948932197924,0.5400859673077817,0.9297842006379763
+1746018845.2664921,0.8124613062588918,0.33858713128344486,0.35476343593303095,0.354849933665421,0.5400863611401829,0.9297845515005048
+1746018845.3116713,0.7999661863330724,0.33858744432064586,0.3547637529457608,0.3548504141261897,0.5400867883879061,0.9297849306979307
+1746018845.3559947,0.7874708170493286,0.33858758561985086,0.35476396784810316,0.3548509327593993,0.5400872506717774,0.929785340116324
+1746018845.399506,0.7749752306636584,0.3385875689338237,0.35476409047238505,0.3548514918811314,0.5400877498686912,0.9297857818597388
+1746018845.4422443,0.7624794551157862,0.3385874059748644,0.35476412937712676,0.3548520940772762,0.5400882881170608,0.9297862582626878
+1746018845.4843569,0.7499835147579705,0.33858710676334514,0.35476409208533555,0.3548527422158773,0.5400888678265254,0.9297867719053385
+1746018845.5262134,0.7374874309394219,0.33858667990919283,0.3547639852788763,0.3548534394626725,0.5400894916915682,0.9297873256313656
+1746018845.5678425,0.7249912224779258,0.33858613284124717,0.354763814958972,0.3548541892996497,0.5400901627088501,0.929787922568432
+1746018845.6092708,0.7124949060424977,0.3385854719957992,0.35476358658046525,0.3548549955465056,0.5400908841981867,0.9297885661513248
+1746018845.650524,0.6999984964651418,0.3385847029729266,0.3547633051656786,0.3548558623849477,0.5400916598271854,0.9297892601478194
+1746018845.691625,0.6875020069955975,0.3385838306672683,0.3547629754024121,0.35485679438582624,0.540092493639634,0.9297900086873429
+1746018845.732597,0.6750054495097293,0.3385828593783838,0.35476260172961815,0.35485779653908217,0.5400933900877963,0.9297908162925537
+1746018845.7734613,0.6625088346798526,0.3385817929047351,0.3547621884135743,0.35485887428653395,0.5400943540688262,0.9297916879139299
+1746018845.814238,0.6500121721134119,0.3385806346244482,0.35476173961680124,0.35486003355749,0.5400953909655453,0.9297926289674641
+1746018845.8549469,0.6375154704650281,0.3385793875653645,0.3547612594615541,0.35486128080716817,0.5400965066918748,0.929793645375546
+1746018845.895606,0.6250187375258156,0.338578054466366,0.35476075208938473,0.35486262305786354,0.540097707743227,0.9297947436110687
+1746018845.936233,0.6125219802929873,0.33857663783153635,0.3547602217180199,0.354864067942739,0.5400990012521911,0.9297959307447449
+1746018845.9768445,0.6000252050220882,0.338575139978408,0.3547596726965879,0.3548656237520472,0.5401003950498381,0.9297972144955476
+1746018846.0174568,0.5875284172636248,0.33857356308124165,0.35475910956008433,0.3548672994814761,0.5401018977329638,0.9297986032840703
+1746018846.0580845,0.5750316218854113,0.3385719092100821,0.3547585370838215,0.3548691048821673,0.5401035187375515,0.9298001062884721
+1746018846.0987422,0.5625348230815901,0.338570180366104,0.3547579603384975,0.3548710505117865,0.5401052684186746,0.9298017335024719
+1746018846.1394434,0.550038024368978,0.3385683785135949,0.3547573847464348,0.3548731477858011,0.5401071581369579,0.9298034957946205
+1746018846.1802008,0.5375412285711494,0.3385665056087457,0.35475681613943055,0.35487540902782044,0.5401092003515608,0.9298054049677559
+1746018846.2210262,0.5250444377904748,0.33856456362523696,0.3547562608185833,0.35487784751753065,0.5401114087194537,0.929807473817149
+1746018846.2619305,0.5125476533681845,0.33856255457646495,0.3547557256163532,0.3548804775343148,0.5401137982004399,0.929809716185346
+1746018846.3029237,0.5000508758324201,0.33856048053403154,0.3547552179610149,0.3548833143941388,0.5401163851670047,0.9298121470110581

test/joint_trajectories_cart/trajectory_0010_cart.csv

@@ -0,0 +1,24 @@
+timestamp,x,y,z,roll,pitch,yaw
+1746018846.3560357,0.49998878872379254,0.3387094903963945,0.354839871013792,0.3548519649120779,0.5400691520460852,0.9297797663797738
+1746018846.4305744,0.5228282430344469,0.33821063928618317,0.3545502223887582,0.35498434878619634,0.540204679145653,0.9298825123247647
+1746018846.5047834,0.5455411342747011,0.33823302523162807,0.3545529006646513,0.35495550847175616,0.5401843539298066,0.929861224081184
+1746018846.5787566,0.5682496190243458,0.33824282490516866,0.3545558734349246,0.35494208952974576,0.5401711614048076,0.9298500914260566
+1746018846.6526036,0.590957900378033,0.3382518826610232,0.3545586043747151,0.3549300690121092,0.5401597067041203,0.92984034853555
+1746018846.7264087,0.6136658024570547,0.33826015393575803,0.3545612588810303,0.3549194956400368,0.5401496477078788,0.9298319011336778
+1746018846.8002665,0.6363732501675361,0.33826758872709356,0.3545637294689188,0.3549101766089429,0.5401407839937716,0.9298245639746534
+1746018846.8742797,0.6590801355391167,0.3382741357964561,0.3545659236467247,0.35490194097059574,0.5401329411008654,0.9298181755715189
+1746018846.9485602,0.6817863171052154,0.3382797358380553,0.35456775201231544,0.35489464026070044,0.5401259702581296,0.9298125976309133
+1746018847.023231,0.7044916159191791,0.3382843183697779,0.3545691246730506,0.3548881453692795,0.5401197440558254,0.9298077116525593
+1746018847.0984266,0.7271958090033783,0.33828779760680266,0.35456994712644235,0.354882343795292,0.540114152717769,0.9298034159586004
+1746018847.1742954,0.7498986194699777,0.33829006706207454,0.3545701154482128,0.3548771371104796,0.5401091008674621,0.9297996230458393
+1746018847.2511272,0.7725997021243378,0.33829099232782356,0.3545695103603376,0.35487243861640466,0.5401045046779525,0.9297962572318157
+1746018847.33048,0.7952986226851875,0.33829040119474424,0.3545679895472882,0.35486817114988534,0.5401002892876888,0.929793252546758
+1746018847.4125922,0.8179948276628553,0.33828806978551607,0.3545653772515819,0.35486426496444184,0.5400963863480642,0.9297905508076562
+1746018847.4977489,0.8406876001143351,0.33828370258031926,0.35456144961280417,0.35486065557954405,0.5400927315353962,0.9297880997916463
+1746018847.5862975,0.8633759933492307,0.33827690283391776,0.3545559132308124,0.3548572814331301,0.5400892617963933,0.9297858513957861
+1746018847.6786654,0.8860587290286966,0.3382671274169874,0.35454837266725203,0.35485408107440236,0.5400859119746221,0.9297837596162838
+1746018847.7753854,0.9087340355841982,0.3382536155115722,0.35453827929523496,0.3548509894502283,0.5400826102309365,0.9297817780774897
+1746018847.8771353,0.9313993822929791,0.3382352715868446,0.35452484743031265,0.3548479324772159,0.54007927120415,0.9297798566366299
+1746018847.984796,0.954051021738706,0.3382104644725058,0.354506910263934,0.3548448183405421,0.5400757848847308,0.9297779361634769
+1746018848.0995455,0.9766831592636704,0.3381766633023656,0.35448265847872484,0.35484152229485677,0.5400719970145644,0.929775939646141
+1746018848.2230148,0.9992863431188839,0.3381297332004651,0.35444913356607816,0.3548378577455304,0.5400676716481043,0.9297737555000983

test/joint_trajectories_cart/trajectory_0011_cart.csv

@@ -0,0 +1,18 @@
+timestamp,x,y,z,roll,pitch,yaw
+1746018848.2643304,0.9992804959341806,0.3382914629802017,0.35455573842335586,0.3548330928132742,0.5400514429451964,0.929771140807757
+1746018848.4278781,0.9687473750343337,0.33870880840272666,0.35483815456343815,0.35483876954238325,0.5400744701956002,0.9297765280060807
+1746018848.5865493,0.9368038487630073,0.3378119723609305,0.3542951388982721,0.3549107453076916,0.5401656469803148,0.9298279928926948
+1746018848.726085,0.9057733986376945,0.33791008389766325,0.3543592330505417,0.3549104353340919,0.5401597288618876,0.9298285688258593
+1746018848.8568728,0.8746392130039544,0.33793815235574254,0.3543772863297318,0.35491228502665234,0.5401605421626795,0.9298309453883272
+1746018848.9800177,0.843485265823824,0.33795666455609796,0.3543895648695141,0.35491559847201287,0.540162694158454,0.9298342993505829
+1746018849.0967052,0.8123157653640375,0.33796565332673506,0.3543961314896692,0.35492042325308404,0.54016637776686,0.9298387504361137
+1746018849.2078116,0.7811356279812804,0.3379673839653477,0.35439848388738193,0.35492682871816644,0.5401715862204244,0.9298443979473233
+1746018849.3140135,0.7499480704734274,0.3379632350676856,0.3543975618405587,0.3549349671190365,0.5401784141005402,0.9298514030021741
+1746018849.4180765,0.7187553581549995,0.33795413112190864,0.35439403531443364,0.3549450715790903,0.5401870376842642,0.9298599905605887
+1746018849.5209816,0.6875591477915445,0.33794070447293506,0.3543884125624668,0.3549574595973635,0.5401977162780988,0.9298704570970021
+1746018849.623092,0.6563606929302407,0.3379233974367479,0.3543811112756897,0.3549725431800478,0.5402108012761616,0.9298831833208678
+1746018849.7247272,0.6251609682670684,0.33790252797637044,0.35437250813514276,0.3549908444429329,0.5402267523337033,0.9298986517742928
+1746018849.8261704,0.5939607449667617,0.33787833450458526,0.3543629773062246,0.3550130162632814,0.540246160823194,0.9299174694889244
+1746018849.9276726,0.5627606339207122,0.3378510083771943,0.35435292402149887,0.35503986762696044,0.5402697813532412,0.9299403958656436
+1746018850.029455,0.5315611059304126,0.3378207188944283,0.35434281716627125,0.35507239290919174,0.5402985724188303,0.9299683755098243
+1746018850.1317062,0.5003624932217149,0.3377876333507215,0.35433322352514074,0.35511180327864755,0.5403337471166165,0.9300025746597204

test/joint_trajectories_cart/trajectory_0012_cart.csv

@@ -0,0 +1,4 @@
+timestamp,x,y,z,roll,pitch,yaw
+1746018850.109841,0.499992043122568,0.338709140222359,0.3548392169436988,0.3548463175336527,0.540070041861325,0.9297780547560188
+1746018850.9285998,0.7499973046315764,0.33870293312379074,0.35483361032338595,0.3548395049421963,0.5400746772839561,0.9297769699209532
+1746018851.9807262,0.9998356122475539,0.3386132202252099,0.3547730142926479,0.35483843990819075,0.5400718696528575,0.9297760873954152

test/joint_trajectories_cart/trajectory_0013_cart.csv

@@ -0,0 +1,6 @@
+timestamp,x,y,z,roll,pitch,yaw
+1746018851.5973852,0.9999433781397413,0.33868086429244976,0.35481929187095496,0.35483836835081034,0.5400740168144992,0.9297762924632146
+1746018852.1919017,0.8749498931177248,0.3386927310763343,0.35484343399624013,0.3549024998178859,0.5400723101628678,0.9298106454335342
+1746018852.650539,0.7499420133523669,0.3386750043994965,0.35484102897222214,0.3549068055176385,0.5400842016916279,0.9298151092698327
+1746018853.0620122,0.6249191509860896,0.3386403636395043,0.3548390731756355,0.354945265870671,0.5401027962998316,0.9298401102697195
+1746018853.4696677,0.499875584105039,0.3385745548597752,0.35484071434453474,0.35504725952431515,0.5401451711343492,0.9299056005373023

test/joint_trajectories_cart/trajectory_0014_cart.csv

@@ -0,0 +1,5 @@
+timestamp,x,y,z,roll,pitch,yaw
+1746018853.1196609,0.49999084438380526,0.3387084934158545,0.3548393873007208,0.3548478037444571,0.5400698452652806,0.9297787023959861
+1746018853.6607533,0.666064626102785,0.33866578932364383,0.35488467204663354,0.3549347970851296,0.5400421724810315,0.9298238923251426
+1746018854.222654,0.8325228461228629,0.33852860158610715,0.35479637037843237,0.354831378690314,0.5400500613890574,0.9297743564996565
+1746018854.9840958,0.9999875006688111,0.33870240888305936,0.3548337336022367,0.3548387138094628,0.5400744126782482,0.9297764919382692

test/joint_trajectories_cart/trajectory_0015_cart.csv

@@ -0,0 +1,6 @@
+timestamp,x,y,z,roll,pitch,yaw
+1746018854.5857203,0.9999474315208599,0.33868295563742656,0.3548207000685034,0.3548384000591708,0.5400740653141097,0.9297763119430412
+1746018855.1802669,0.8749498925957069,0.3386927251913073,0.35484343255512185,0.3549025050221844,0.5400723111120405,0.9298106484680194
+1746018855.638904,0.7499420133477953,0.3386750043989203,0.35484102897289266,0.35490680551982146,0.5400842016915113,0.9298151092706827
+1746018856.0503771,0.6249191509860967,0.3386403636395169,0.35483907317563734,0.3549452658706545,0.5401027962998273,0.9298401102697097
+1746018856.4580326,0.4998755841050389,0.338574554859775,0.35484071434453496,0.35504725952431504,0.5401451711343493,0.929905600537302

test/joint_trajectories_cart/trajectory_0016_cart.csv

@@ -0,0 +1,4 @@
+timestamp,x,y,z,roll,pitch,yaw
+1746018856.150761,0.49998853114052927,0.338707677573972,0.35483961884533083,0.3548504943665232,0.54006909797661,0.9297796613536519
+1746018856.9695346,0.7499973042956015,0.3387029324915161,0.3548336097637454,0.3548395050147193,0.5400746772867365,0.9297769699623466
+1746018858.021661,0.9998356122458891,0.33861322022428136,0.35477301429200314,0.3548384399081783,0.5400718696528185,0.9297760873954044

test/joint_trajectories_cart/trajectory_0017_cart.csv

@@ -0,0 +1,7 @@
+timestamp,x,y,z,roll,pitch,yaw
+1746018857.5495617,0.9999592984167665,0.3386890622517516,0.35482485824181675,0.354838487803229,0.5400741960315382,0.9297763654757398
+1746018858.03965,0.8999562727380719,0.3387090881666049,0.35484194256190416,0.3548600656380242,0.5400735032343046,0.9297878984267088
+1746018858.4300761,0.799968719413789,0.33870486490712504,0.3548432532415722,0.3548607494088734,0.5400769645450677,0.9297887937355175
+1746018858.7666776,0.6999654810738004,0.3386959861882976,0.35484275087611616,0.35486885616066466,0.5400810797017587,0.9297939844530492
+1746018859.0931258,0.5999551160118943,0.33868197589617544,0.3548426315096846,0.35488723825658325,0.5400882992429289,0.9298055232783259
+1746018859.419361,0.4999369673011772,0.33865879620851624,0.35484395770809113,0.3549268632794481,0.5401026815139718,0.9298300626069816

test/joint_trajectories_cart/trajectory_0018_cart.csv

@@ -0,0 +1,4 @@
+timestamp,x,y,z,roll,pitch,yaw
+1746018859.1601691,0.49998533177233717,0.3387063621105274,0.35483993505553313,0.35485437982058404,0.5400681850395332,0.9297811219484226
+1746018859.9789567,0.7499973039890306,0.33870293191704115,0.3548336092550731,0.3548395050807673,0.540074677289148,0.9297769700000567
+1746018861.0310829,0.9998356122443709,0.3386132202234346,0.35477301429141483,0.3548384399081676,0.5400718696527826,0.9297760873953944

test/joint_trajectories_cart/trajectory_0019_cart.csv

@@ -0,0 +1,7 @@
+timestamp,x,y,z,roll,pitch,yaw
+1746018860.5458684,0.9999610750659504,0.3386899739017742,0.3548254772061733,0.35483850024602265,0.5400742140443552,0.929776373006245
+1746018861.03597,0.8999562713841975,0.3387090882560545,0.3548419428312903,0.3548600675532033,0.5400735029793525,0.9297878994221204
+1746018861.4263961,0.7999687194147795,0.33870486490766455,0.3548432532414361,0.3548607494072374,0.5400769645449378,0.9297887937345831
+1746018861.7629974,0.6999654810737996,0.3386959861882967,0.3548427508761163,0.3548688561606662,0.5400810797017589,0.9297939844530497
+1746018862.0894456,0.5999551160118943,0.33868197589617544,0.3548426315096846,0.35488723825658325,0.5400882992429289,0.9298055232783259
+1746018862.4156811,0.4999369673011772,0.33865879620851624,0.35484395770809113,0.3549268632794481,0.5401026815139718,0.9298300626069816

test/joint_trajectories_cart/trajectory_0020_cart.csv

@@ -0,0 +1,4 @@
+timestamp,x,y,z,roll,pitch,yaw
+1746018862.1515627,0.49998591070260895,0.33870661712031336,0.35483987803105016,0.35485366085642783,0.5400683402487926,0.9297808455433704
+1746018862.970348,0.7499973040441732,0.33870293202059265,0.3548336093474972,0.354839505068949,0.540074677288707,0.9297769699933072
+1746018864.022474,0.9998356122446445,0.33861322022358703,0.3547730142915205,0.3548384399081691,0.5400718696527892,0.9297760873953962

test/joint_trajectories_cart/trajectory_0021_cart.csv

@@ -0,0 +1,7 @@
+timestamp,x,y,z,roll,pitch,yaw
+1746018863.5637312,0.9999573415902931,0.33868805653797474,0.35482417337976296,0.3548384739247426,0.5400741756848338,0.9297763570464891
+1746018864.053805,0.8999562742297146,0.33870908806717387,0.35484194226548893,0.35486006352541904,0.5400735035161047,0.9297878973286712
+1746018864.4442313,0.7999687194126974,0.3387048649065311,0.35484325324172145,0.35486074941067625,0.5400769645452117,0.9297887937365478
+1746018864.7808328,0.699965481073801,0.3386959861882985,0.35484275087611616,0.3548688561606629,0.5400810797017583,0.9297939844530482
+1746018865.107281,0.5999551160118943,0.33868197589617577,0.3548426315096847,0.3548872382565834,0.5400882992429288,0.9298055232783266
+1746018865.4335163,0.49993696730117715,0.3386587962085161,0.35484395770809085,0.35492686327944817,0.5401026815139722,0.9298300626069815

test/joint_trajectories_cart/trajectory_0022_cart.csv

@@ -0,0 +1,4 @@
+timestamp,x,y,z,roll,pitch,yaw
+1746018865.1454973,0.499987575675419,0.33870730662912885,0.35483971389291424,0.35485163273874254,0.5400688123076307,0.9297800812744245
+1746018865.9642751,0.7499973042036086,0.33870293231940085,0.35483360961229005,0.35483950503462186,0.5400746772874496,0.9297769699737076
+1746018867.0164015,0.999835612245434,0.33861322022402784,0.3547730142918266,0.35483843990817504,0.5400718696528076,0.9297760873954016