AS:

2025-04-30 14:15:19 +02:00 · 2025-04-30 14:15:19 +02:00 · 4ce1397d38
commit 4ce1397d38
parent bccc4b4fdf
48 changed files with 0 additions and 167511 deletions
--- a/test/.DS_Store
+++ b/test/.DS_Store
--- a/test/joint_states_cart_logs/cartesian.csv
+++ b/test/joint_states_cart_logs/cartesian.csv
--- a/test/joint_states_logs/elbow_joint.csv
+++ b/test/joint_states_logs/elbow_joint.csv
--- a/test/joint_states_logs/shoulder_lift_joint.csv
+++ b/test/joint_states_logs/shoulder_lift_joint.csv
--- a/test/joint_states_logs/shoulder_pan_joint.csv
+++ b/test/joint_states_logs/shoulder_pan_joint.csv
--- a/test/joint_states_logs/wrist_1_joint.csv
+++ b/test/joint_states_logs/wrist_1_joint.csv
--- a/test/joint_states_logs/wrist_2_joint.csv
+++ b/test/joint_states_logs/wrist_2_joint.csv
--- a/test/joint_states_logs/wrist_3_joint.csv
+++ b/test/joint_states_logs/wrist_3_joint.csv
--- a/test/joint_trajectories/trajectory_0001.csv
+++ b/test/joint_trajectories/trajectory_0001.csv
@ -1,2 +0,0 @@
-timestamp,shoulder_pan_joint,shoulder_lift_joint,elbow_joint,wrist_1_joint,wrist_2_joint,wrist_3_joint
-1746011500.6981866,-0.2584434767928996,-1.5593503626194987,1.918429404588129,-1.6944083250439956,-1.6324038286536853,-1.8219460785849033
--- a/test/joint_trajectories/trajectory_0002.csv
+++ b/test/joint_trajectories/trajectory_0002.csv
@ -1,2 +0,0 @@
-timestamp,shoulder_pan_joint,shoulder_lift_joint,elbow_joint,wrist_1_joint,wrist_2_joint,wrist_3_joint
-1746011502.5537577,-0.2308989147082774,-1.5576496867458662,1.9268478330411956,-1.7397192673604973,-1.7839696265599596,-1.800062792954931
--- a/test/joint_trajectories/trajectory_0003.csv
+++ b/test/joint_trajectories/trajectory_0003.csv
@ -1,2 +0,0 @@
-timestamp,shoulder_pan_joint,shoulder_lift_joint,elbow_joint,wrist_1_joint,wrist_2_joint,wrist_3_joint
-1746011503.7946618,-0.1686252647757187,-1.5472390563625094,1.9591905880121567,-1.8458983617027747,-2.1567869317617543,-1.7676185896498668
--- a/test/joint_trajectories/trajectory_0004.csv
+++ b/test/joint_trajectories/trajectory_0004.csv
@ -1,2 +0,0 @@
-timestamp,shoulder_pan_joint,shoulder_lift_joint,elbow_joint,wrist_1_joint,wrist_2_joint,wrist_3_joint
-1746011506.1262758,-0.37964591217805577,-1.5433421257233508,1.898245007183581,-1.3844446013798872,-0.9486654069655223,-2.0294127243158604
--- a/test/joint_trajectories/trajectory_0005.csv
+++ b/test/joint_trajectories/trajectory_0005.csv
@ -1,2 +0,0 @@
-timestamp,shoulder_pan_joint,shoulder_lift_joint,elbow_joint,wrist_1_joint,wrist_2_joint,wrist_3_joint
-1746011508.8176053,-0.12860039709478688,-1.5327987457296275,1.998946192099603,-1.9460947967968842,-2.4571289985280873,-1.769060918772316
--- a/test/joint_trajectories/trajectory_0006.csv
+++ b/test/joint_trajectories/trajectory_0006.csv
@ -1,2 +0,0 @@
-timestamp,shoulder_pan_joint,shoulder_lift_joint,elbow_joint,wrist_1_joint,wrist_2_joint,wrist_3_joint
-1746011511.4248803,-0.32851231244735324,-1.556318860706303,1.9054772242742963,-1.5542632600057393,-1.2513477173722232,-1.906920178150602
--- a/test/joint_trajectories/trajectory_0007.csv
+++ b/test/joint_trajectories/trajectory_0007.csv
@ -1,2 +0,0 @@
-timestamp,shoulder_pan_joint,shoulder_lift_joint,elbow_joint,wrist_1_joint,wrist_2_joint,wrist_3_joint
-1746011513.0201094,-0.2811586958622918,-1.5170442353198785,1.842088326077329,-1.4186114407746067,-1.510089919486052,-2.4769183223554463
--- a/test/joint_trajectories/trajectory_0008.csv
+++ b/test/joint_trajectories/trajectory_0008.csv
@ -1,2 +0,0 @@
-timestamp,shoulder_pan_joint,shoulder_lift_joint,elbow_joint,wrist_1_joint,wrist_2_joint,wrist_3_joint
-1746011514.4977942,-0.2598094630044301,-1.5109851246905668,1.835455896600081,-1.4172144983489905,-1.6251002087604622,-2.6978004634140476
--- a/test/joint_trajectories/trajectory_0009.csv
+++ b/test/joint_trajectories/trajectory_0009.csv
@ -1,2 +0,0 @@
-timestamp,shoulder_pan_joint,shoulder_lift_joint,elbow_joint,wrist_1_joint,wrist_2_joint,wrist_3_joint
-1746011516.3413794,-0.35378337935391757,-1.6016681749948434,2.001576650922292,-1.8398676754403294,-1.1068121709485519,-1.3089895738273505
--- a/test/joint_trajectories/trajectory_0010.csv
+++ b/test/joint_trajectories/trajectory_0010.csv
@ -1,2 +0,0 @@
-timestamp,shoulder_pan_joint,shoulder_lift_joint,elbow_joint,wrist_1_joint,wrist_2_joint,wrist_3_joint
-1746011516.9457223,-0.3556423347154132,-1.6207376464189907,2.0674685662627326,-2.094571991443367,-1.0957598017613526,-0.8558302161593532
--- a/test/joint_trajectories/trajectory_0011.csv
+++ b/test/joint_trajectories/trajectory_0011.csv
@ -1,2 +0,0 @@
-timestamp,shoulder_pan_joint,shoulder_lift_joint,elbow_joint,wrist_1_joint,wrist_2_joint,wrist_3_joint
-1746011518.62554,-0.22730261986774725,-1.490045675183208,2.2190438871192217,-3.301392142549558,-1.803855577475699,-1.1463284162240381
--- a/test/joint_trajectories/trajectory_0012.csv
+++ b/test/joint_trajectories/trajectory_0012.csv
@ -1,2 +0,0 @@
-timestamp,shoulder_pan_joint,shoulder_lift_joint,elbow_joint,wrist_1_joint,wrist_2_joint,wrist_3_joint
-1746011520.7094712,-0.4317759969545931,-1.5878768142143662,2.192443620570412,-2.521846200611928,-0.5524424819151541,-2.4849698587736393
--- a/test/joint_trajectories/trajectory_0013.csv
+++ b/test/joint_trajectories/trajectory_0013.csv
@ -1,2 +0,0 @@
-timestamp,shoulder_pan_joint,shoulder_lift_joint,elbow_joint,wrist_1_joint,wrist_2_joint,wrist_3_joint
-1746011523.1514468,-0.24750520595890402,-1.4000131090083312,1.6968945996898945,-0.9602205280305407,-1.6922387549044173,-2.0162200057746915
--- a/test/joint_trajectories/trajectory_0014.csv
+++ b/test/joint_trajectories/trajectory_0014.csv
@ -1,2 +0,0 @@
-timestamp,shoulder_pan_joint,shoulder_lift_joint,elbow_joint,wrist_1_joint,wrist_2_joint,wrist_3_joint
-1746011524.1556451,-0.3182135655214777,-1.560055437175354,1.9097863748307429,-1.5859980050857687,-1.3082834080649495,-2.3680372330882276
--- a/test/joint_trajectories/trajectory_0015.csv
+++ b/test/joint_trajectories/trajectory_0015.csv
@ -1,47 +0,0 @@
-timestamp,shoulder_pan_joint,shoulder_lift_joint,elbow_joint,wrist_1_joint,wrist_2_joint,wrist_3_joint
-1746011532.3775527,-0.30894014150806504,-1.5669624274668106,1.9042846745908033,-1.5759250186099247,-1.3052212682010704,-2.358970457919635
-1746011532.3865535,-0.29951462028540377,-1.5746827072638354,1.8991631799853055,-1.5655223084690406,-1.302157934148812,-2.349729009901037
-1746011532.3956466,-0.28999236793102323,-1.5821327904556532,1.893768031785319,-1.5551728647012082,-1.299085502736366,-2.3403768923063355
-1746011532.4048228,-0.2803828434536557,-1.5893147777944368,1.888113149667931,-1.5448870120534992,-1.29600789151451,-2.3309228625769896
-1746011532.4140818,-0.27068697279341025,-1.5962264257299066,1.8822006724905993,-1.534669627012995,-1.292926323254532,-2.321367305293071
-1746011532.423422,-0.2609057730729365,-1.6028655394437732,1.8760326119996122,-1.5245253966227839,-1.2898420809661382,-2.3117106837056016
-1746011532.432843,-0.25104034908015027,-1.6092301605114112,1.8696109643373768,-1.5144587139776953,-1.2867564873577304,-2.3019535517744245
-1746011532.442343,-0.2410918924967751,-1.615318561806938,1.862937699764272,-1.5044736710581663,-1.2836709029096613,-2.2920965549764483
-1746011532.4519212,-0.23106168250726977,-1.6211292423777088,1.8560147544355132,-1.494574053100561,-1.280586724529396,-2.2821404324939154
-1746011532.461576,-0.22095108620581394,-1.6266609215774772,1.8488440222206304,-1.4847633337661217,-1.277505384032303,-2.27208601926141
-1746011532.4713063,-0.2107615587926004,-1.63191253248257,1.8414273465564799,-1.475044671095092,-1.274428346452043,-2.261934247853489
-1746011532.4811106,-0.20049464355107371,-1.6368832146500345,1.833766512343601,-1.4654209042097546,-1.2713571081804027,-2.251686150198327
-1746011532.490987,-0.19015197159825803,-1.6415723062762058,1.825863237892543,-1.4558945507280288,-1.2682931949372982,-2.241342859102626
-1746011532.5009344,-0.17973526140124552,-1.6459793358131505,1.8177191669238457,-1.446467804847744,-1.265238159572765,-2.230905609573229
-1746011532.5109506,-0.16924631805390744,-1.650104013098832,1.8093358606224275,-1.437142536060682,-1.2621935797038921,-2.220375739921232
-1746011532.5210338,-0.15868703230898706,-1.6539462200547095,1.8007147897441387,-1.4279202884548707,-1.259161055190833,-2.20975469263481
-1746011532.5311825,-0.14805937936189872,-1.6575060010018712,1.7918573267692857,-1.4188022805633207,-1.2561422054572369,-2.199044015007587
-1746011532.5413945,-0.1373654173838048,-1.6607835526437718,1.78276473809483,-1.409789405717405,-1.2531386666616569,-2.188245359510044
-1746011532.5516677,-0.12660728580284886,-1.66377921376024,1.773438176253931,-1.4008822328632593,-1.2501520887277258,-2.1773604838923286
-1746011532.5620003,-0.11578720333378723,-1.6664934546537367,1.7638786721483601,-1.3920810077999068,-1.2471841322421073,-2.166391251007756
-1746011532.5723896,-0.10490746575767496,-1.6689268663848584,1.7540871272760539,-1.383385654798164,-1.244236465230428,-2.155339628347411
-1746011532.5828335,-0.09397044345468464,-1.6710801498299162,1.744064305932791,-1.3747957785597347,-1.2413107598225561,-2.144207687277447
-1746011532.5933301,-0.08297857869462044,-1.6729541045890408,1.733810827363511,-1.3663106664761655,-1.2384086888197157,-2.1329976019720163
-1746011532.6038766,-0.07193438269113583,-1.6745496177687471,1.723327157835163,-1.3579292911474354,-1.2355319221769676,-2.121711648036216
-1746011532.6144705,-0.060840432427123226,-1.6758676526582372,1.7126136025991432,-1.3496503131198552,-1.2326821234155756,-2.1103522008149636
-1746011532.6251094,-0.04969936726019375,-1.6769092373139614,1.701670297707322,-1.3414720838025957,-1.229860945980645,-2.0989217333853714
-1746011532.6357908,-0.038513885318542496,-1.6776754530620488,1.6904972016412279,-1.3333926485214538,-1.22707002956023,-2.087422814231895
-1746011532.6465118,-0.027286739698854756,-1.6781674229232575,1.6790940867092523,-1.3254097496674189,-1.224310996382744,-2.0758581046053415
-1746011532.6572702,-0.016020734479192722,-1.6783862999599461,1.6674605301614935,-1.317520829896112,-1.2215854475100847,-2.0642303555686525
-1746011532.6680627,-0.00471872056099798,-1.6783332555393113,1.6555959049661695,-1.3097230353321918,-1.2188949591442615,-2.052542404734268
-1746011532.6788871,0.006616408644537053,-1.6780094675017159,1.6434993701852099,-1.3020132187303681,-1.216241078965607,-2.0407971726997913
-1746011532.6897402,0.017981721669467987,-1.6774161082172339,1.6311698608795444,-1.294387942541572,-1.2136253225207554,-2.028997659190574
-1746011532.7006192,0.02937425356430845,-1.6765543325076628,1.6186060774667759,-1.2868434818291583,-1.2110491696785375,-2.0171469389197525
-1746011532.7115214,0.040791010577527764,-1.6754252654049557,1.6058064744449787,-1.279375826975629,-1.2085140611717575,-2.0052481571781136
-1746011532.7224438,0.05222897492076184,-1.6740299897103676,1.5927692483863591,-1.2719806861152065,-1.2060213952424548,-1.9933045251679966
-1746011532.7333837,0.06368510960067075,-1.6723695333114297,1.5794923250930877,-1.264653487221584,-1.2035725244077626,-1.9813193150971644
-1746011532.7443378,0.07515636329801145,-1.6704448562060403,1.565973345794613,-1.2573893797732356,-1.2011687523628145,-1.969295855050236
-1746011532.7553036,0.08663967527428262,-1.6682568371743745,1.5522096522508715,-1.2501832359106326,-1.1988113310363462,-1.9572375236568027
-1746011532.766278,0.09813198028623438,-1.6658062600298131,1.538198270608726,-1.2430296509904695,-1.1965014578137083,-1.9451477445767797
-1746011532.777258,0.10963021348861535,-1.663093799369412,1.5239358938392282,-1.2359229434313594,-1.1942402729409318,-1.9330299808247997
-1746011532.7882407,0.12113131530575494,-1.6601200057324186,1.5094188625604934,-1.2288571537331794,-1.1920288571223079,-1.920887728956595
-1746011532.7992232,0.13263223625295328,-1.656885290061631,1.4946431440245043,-1.2218260425380787,-1.1898682293226504,-1.908724513141237
-1746011532.8102028,0.14412994168914262,-1.6533899073466933,1.4796043090152429,-1.214823087584744,-1.1877593447840336,-1.8965438791438975
-1746011532.8211763,0.15562141648292682,-1.649633939310259,1.4642975063694816,-1.2078414793884473,-1.1857030932653418,-1.8843493882443578
-1746011532.8321412,0.16710366957485334,-1.6456172759768606,1.4487174347891267,-1.2008741154571434,-1.1837002975114548,-1.8721446111168845
-1746011532.843094,0.1785737384196322,-1.6413395959396315,1.4328583115640452,-1.1939135928278035,-1.1817517119573333,-1.8599331216972814
--- a/test/joint_trajectories/trajectory_0016.csv
+++ b/test/joint_trajectories/trajectory_0016.csv
@ -1,35 +0,0 @@
-timestamp,shoulder_pan_joint,shoulder_lift_joint,elbow_joint,wrist_1_joint,wrist_2_joint,wrist_3_joint
-1746011532.9093502,0.17852975827604078,-1.6413620961711513,1.432904773258274,-1.1939113868562339,-1.181767285751261,-1.8599814060470266
-1746011532.9121642,0.1791423661533531,-1.6443089751156363,1.4356220642759387,-1.1939515104006904,-1.1816828704790572,-1.8593172214226008
-1746011532.9151247,0.17972115967504276,-1.6474092781856875,1.4385175490404558,-1.1939806557195587,-1.1815860008009254,-1.858700491823218
-1746011532.9180827,0.18030354334605692,-1.6505069821021467,1.4413999620349998,-1.1940008540491647,-1.1814886645821547,-1.858079887453538
-1746011532.9210384,0.18088957698129748,-1.6536021263655902,1.4442698847790432,-1.1940126728906337,-1.181390854382581,-1.8574553437045864
-1746011532.9239917,0.18147929373640448,-1.6566947257343672,1.447127360905741,-1.1940161558519595,-1.181292567278401,-1.8568268243560773
-1746011532.9269423,0.18207272710781508,-1.659784794352331,1.4499724333863702,-1.1940113466541604,-1.1811938003380604,-1.8561942928092718
-1746011532.9298909,0.1826699109819847,-1.6628723458155636,1.4528051445531496,-1.193998289107684,-1.1810945506150201,-1.8555577120342512
-1746011532.9328368,0.1832709657561904,-1.6659574275662148,1.4556255880432118,-1.193977371439152,-1.180995296770786,-1.854916754332894
-1746011532.9357805,0.18387575443649595,-1.66903998307905,1.4584337006203159,-1.1939479487353288,-1.1808950726864766,-1.8542719617580978
-1746011532.9387217,0.1844843974179926,-1.6721200590454641,1.461229575321501,-1.1939104097402413,-1.1807943569348007,-1.8536230064904415
-1746011532.9416606,0.18509693046078723,-1.6751976668171398,1.4640132518871063,-1.1938647987709128,-1.1806931464676582,-1.8529698494381184
-1746011532.9445972,0.1857133894861458,-1.6782728172902541,1.4667847696327403,-1.19381116026532,-1.1805914382652711,-1.8523124513206506
-1746011532.9475315,0.18633381083856237,-1.6813455208285344,1.469544167305414,-1.1937495388220596,-1.1804892292938265,-1.8516507723891948
-1746011532.9504633,0.18695830953270587,-1.6844158204106683,1.472291533340563,-1.1936803006659134,-1.180386946009585,-1.8509845077222598
-1746011532.953393,0.18758676681114927,-1.6874836588207487,1.475026804464255,-1.1936028475611375,-1.1802837264473127,-1.850314145543893
-1746011532.95632,0.18821929781741575,-1.6905490782820654,1.4777500685985512,-1.1935175463754872,-1.1801799969715037,-1.8496393806758762
-1746011532.9592452,0.18885594089033386,-1.6936120869753721,1.4804613621837062,-1.1934244424978357,-1.1800757544544436,-1.8489601711712187
-1746011532.9621677,0.18949673458640826,-1.6966726926291358,1.4831607212883053,-1.193323581513419,-1.1799709957942388,-1.8482764748321703
-1746011532.9650881,0.1901417179225695,-1.6997309024502292,1.4858481814770812,-1.193215009239971,-1.1798657178761764,-1.8475882489509616
-1746011532.9680064,0.19079101680450838,-1.7027867569755777,1.488523828751278,-1.1930991126530077,-1.179760383096819,-1.8468951652101107
-1746011532.970922,0.19144449892397386,-1.7058401944209909,1.49118759539485,-1.1929752559509001,-1.1796540573836447,-1.846197749524356
-1746011532.9738357,0.19210229030174641,-1.7088912546130657,1.4938395670399442,-1.1928438268893742,-1.1795472030379548,-1.8454956733185028
-1746011532.976747,0.19276443213246397,-1.7119399426074104,1.4964797771935654,-1.192704872380535,-1.1794398168524336,-1.8447888914825854
-1746011532.979656,0.19343096583993402,-1.7149862630202437,1.4991082590526998,-1.192558439589233,-1.1793318956515038,-1.8440773586415828
-1746011532.9825628,0.19410193334911385,-1.7180302199533106,1.5017250453702289,-1.1924045759852178,-1.1792234362484706,-1.843361028864793
-1746011532.9854672,0.1947774727047218,-1.7210718515596957,1.5043302201296918,-1.1922436916924262,-1.1791149406731267,-1.842639548030878
-1746011532.9883695,0.19545743628220258,-1.724111091507644,1.50692371142953,-1.1920751098490152,-1.1790053953900768,-1.8419134837444424
-1746011532.9912696,0.19614196222257707,-1.7271479772824292,1.509505603021963,-1.1918992414966079,-1.1788953023303348,-1.8411824816285436
-1746011532.9941673,0.19683109483122152,-1.7301825108505824,1.5120759258325727,-1.1917161355098762,-1.1787846582173813,-1.8404464931245368
-1746011532.997063,0.19752487865420054,-1.7332146937496575,1.5146347105345308,-1.1915258410713998,-1.1786734598134356,-1.83970546939417
-1746011532.9999561,0.198223446155954,-1.736244556431033,1.5171820311847277,-1.1913287277480447,-1.178562158133051,-1.8389590858199736
-1746011533.0028472,0.19892666883640464,-1.7392720403097979,1.5197178297387968,-1.1911242052172775,-1.1784498415153513,-1.8382078421536026
-1746011533.0057359,0.19963467940373159,-1.7422971751413838,1.522242180031375,-1.190912644040474,-1.1783369608870868,-1.8374514133672655
--- a/test/joint_trajectories/trajectory_0017.csv
+++ b/test/joint_trajectories/trajectory_0017.csv
@ -1,17 +0,0 @@
-timestamp,shoulder_pan_joint,shoulder_lift_joint,elbow_joint,wrist_1_joint,wrist_2_joint,wrist_3_joint
-1746011532.96937,0.1996149312400659,-1.7423370505584117,1.5222788837364885,-1.1908851791808488,-1.1783330130878016,-1.837479699291939
-1746011532.9718719,0.200262293922445,-1.7449571274045572,1.5244528104277881,-1.1907199694402422,-1.1782373586883028,-1.8367807027588579
-1746011532.9744103,0.2008931564315537,-1.747615467765933,1.5266560784260381,-1.1905227839594892,-1.1781371178583053,-1.836106578625262
-1746011532.9769473,0.2015277961552968,-1.7502720018734532,1.528850436185305,-1.190320122937042,-1.1780364384300057,-1.8354283619633922
-1746011532.9794822,0.2021662778847655,-1.7529267134383824,1.5310360091458515,-1.1901121559955627,-1.1779353130981651,-1.834745982589347
-1746011532.9820156,0.20280863501156254,-1.755579600886335,1.5332128164305345,-1.1898989189173264,-1.1778337396089285,-1.8340594038536864
-1746011532.9845471,0.20345490122239562,-1.7582306623196367,1.535380876891213,-1.1896804476804461,-1.177731715716572,-1.8333685887760118
-1746011532.987077,0.20410520724689096,-1.7608799214426603,1.5375402472621884,-1.1894570994255063,-1.1776297282264434,-1.8326732118309557
-1746011532.9896052,0.20475939476397587,-1.7635273236812863,1.5396908695255505,-1.1892282687595537,-1.1775267968862857,-1.831973810950857
-1746011532.9921315,0.2054175943909744,-1.7661728924422135,1.541832800498801,-1.1889943135600172,-1.1774234084352213,-1.8312700605915737
-1746011532.994656,0.20607984159963522,-1.7688166245270907,1.5439660582046333,-1.188755271101918,-1.1773195605752425,-1.8305619218000004
-1746011532.9971788,0.2067461719769157,-1.7714585165012662,1.546090660591009,-1.188511178893645,-1.177215251050271,-1.8298493554830682
-1746011532.9996998,0.20741662150373985,-1.7740985646221508,1.5482066254380156,-1.188262074770003,-1.1771104776033998,-1.829132322109461
-1746011533.0022192,0.2080913294251041,-1.776736792853624,1.5503140117063676,-1.1880083396604972,-1.1770057492004449,-1.8284104769517562
-1746011533.0047367,0.20877012743980305,-1.7793731405421336,1.5524127537926482,-1.1877493263213408,-1.1769000412582562,-1.8276843885161107
-1746011533.0072525,0.20945315467114156,-1.7820076313710644,1.5545029108163382,-1.1874854165077162,-1.1767938626692256,-1.8269537120545105
--- a/test/joint_trajectories/trajectory_0018.csv
+++ b/test/joint_trajectories/trajectory_0018.csv
@ -1,15 +0,0 @@
-timestamp,shoulder_pan_joint,shoulder_lift_joint,elbow_joint,wrist_1_joint,wrist_2_joint,wrist_3_joint
-1746011533.0190654,0.20944771696269537,-1.7820177940736373,1.5545083280916252,-1.1874720958297715,-1.1767925896703122,-1.8269622054696948
-1746011533.0219567,0.210245905361218,-1.7850454316261009,1.5569053783895868,-1.187175817805035,-1.176671119450416,-1.8261054823207006
-1746011533.0248547,0.2110450542958917,-1.7880804262863563,1.5592950996813135,-1.1868588857222866,-1.1765473680943883,-1.8252504213329301
-1746011533.0277505,0.21184999518463377,-1.7911129266971686,1.5616734328935804,-1.1865355720157902,-1.176422980931931,-1.824389074522891
-1746011533.030644,0.21266079469762644,-1.794142922123413,1.5640404365631593,-1.1862059759939099,-1.1762979534657665,-1.8235213687671945
-1746011533.033535,0.21347761875867644,-1.7971704281462575,1.5663961735538372,-1.1858704943165908,-1.1761727928965247,-1.8226469338055695
-1746011533.0364237,0.2143003194568478,-1.8001953832839868,1.5687405936583678,-1.185528522743659,-1.176046474595747,-1.821766307990132
-1746011533.03931,0.2151290631707501,-1.803217802394025,1.5710737597926219,-1.1851804594664614,-1.1759195056931606,-1.820879120362124
-1746011533.0421937,0.21596391344958787,-1.8062376738889752,1.5733956965680616,-1.1848263696451777,-1.175791882698632,-1.8199853009958653
-1746011533.045075,0.21680504618685292,-1.8092550120048323,1.5757064674215364,-1.1844666701147677,-1.1756641380196526,-1.8190844600557678
-1746011533.0479538,0.21765230333496177,-1.8122697511928618,1.5780060183988258,-1.184100725064824,-1.1755351967317593,-1.8181771641344706
-1746011533.0508304,0.21850586127095273,-1.815281904992074,1.5802944130961434,-1.1837289529993977,-1.1754055911687653,-1.8172630226499327
-1746011533.0537043,0.2193657869623351,-1.8182914595537316,1.5825716753640862,-1.1833514222061552,-1.175275317883291,-1.8163419618666665
-1746011533.0565755,0.220232268502357,-1.8212984270540684,1.5848378683386573,-1.1829685706481636,-1.175144943129931,-1.8154135687062034
--- a/test/joint_trajectories/trajectory_0019.csv
+++ b/test/joint_trajectories/trajectory_0019.csv
@ -1,13 +0,0 @@
-timestamp,shoulder_pan_joint,shoulder_lift_joint,elbow_joint,wrist_1_joint,wrist_2_joint,wrist_3_joint
-1746011533.0714974,0.2202332353178278,-1.8212996301723934,1.5848342024508142,-1.1829621556169063,-1.175144355746336,-1.8154133099458098
-1746011533.074887,0.22126328798173267,-1.8248491996348302,1.5875039325546112,-1.1825096443583636,-1.1749896280960084,-1.8143089575371847
-1746011533.0782738,0.22230472178020166,-1.8283957826933195,1.5901523832884195,-1.1820417306737023,-1.174833029745834,-1.8131930984142417
-1746011533.081657,0.2233554823119892,-1.8319386319426068,1.5927854181635261,-1.1815662073996251,-1.1746754758575133,-1.8120670987319112
-1746011533.0850365,0.22441581318597592,-1.8354777584890876,1.5954031287131762,-1.1810836032409828,-1.1745176056412858,-1.8109304583431374
-1746011533.0884125,0.2254855588838094,-1.8390130757667882,1.5980054670147057,-1.1805932127270944,-1.174358128510822,-1.809783811391106
-1746011533.091785,0.22656507512691482,-1.8425446020134872,1.6005925429064334,-1.1800958596893751,-1.1741981299978,-1.808626374313122
-1746011533.0951536,0.22765429252059555,-1.846072267047234,1.6031643358006935,-1.1795910969756798,-1.1740367082782175,-1.8074585435167199
-1746011533.0985186,0.22875353476201177,-1.849596077349526,1.6057209413159574,-1.1790796342405936,-1.1738747715782,-1.8062796372673278
-1746011533.1018798,0.22986272720900525,-1.8531159602907912,1.608262338048145,-1.178561009760029,-1.1737113843384208,-1.8050900673871466
-1746011533.1052372,0.23098220692453797,-1.8566319201108015,1.6107886216874618,-1.1780359556031286,-1.173547489722104,-1.8038891275548088
-1746011533.108591,0.23211189379753172,-1.8601438818435339,1.6132997702703946,-1.1775039955219195,-1.1733821165937317,-1.8026772454473654
--- a/test/joint_trajectories/trajectory_0020.csv
+++ b/test/joint_trajectories/trajectory_0020.csv
@ -1,10 +0,0 @@
-timestamp,shoulder_pan_joint,shoulder_lift_joint,elbow_joint,wrist_1_joint,wrist_2_joint,wrist_3_joint
-1746011533.1262534,0.23295061628362745,-1.8606528281904156,1.6141227767097774,-1.1781085973591856,-1.1728280870610868,-1.801873625010036
-1746011533.1290176,0.2332226910494013,-1.8635476231107664,1.6157203731285588,-1.1769826557055938,-1.1732207615523518,-1.8014851303147161
-1746011533.1311831,0.2339647451029263,-1.865815387841045,1.6173258046554624,-1.1766286232338377,-1.173112816304153,-1.800688864191614
-1746011533.133347,0.234712410472262,-1.8680814424376027,1.6189269138120093,-1.176274417870966,-1.1730042828415328,-1.7998865040982508
-1746011533.1355095,0.23546458382048918,-1.8703457783271995,1.6205217491102424,-1.1759176402196132,-1.1728953262414372,-1.7990792326724827
-1746011533.13767,0.23622130022515941,-1.8726083846896246,1.6221103199469766,-1.175558326846458,-1.1727859457007208,-1.7982670110643595
-1746011533.139829,0.2369827067106569,-1.8748692255930655,1.6236926018532278,-1.1751966191861274,-1.1726766192773124,-1.7974495944339322
-1746011533.1419864,0.23774862589655887,-1.8771283385948851,1.625268673324137,-1.1748323517178003,-1.1725663871748784,-1.7966273437185916
-1746011533.144142,0.2385192047065856,-1.8793856876854476,1.6268385099631235,-1.1744656664579487,-1.1724557275369645,-1.7958000139980583
--- a/test/joint_trajectories_cart/trajectory_0001_cart.csv
+++ b/test/joint_trajectories_cart/trajectory_0001_cart.csv
@ -1,2 +0,0 @@
-timestamp,x,y,z,roll,pitch,yaw
-1746011500.6981866,0.6532147996609244,2.910667943093163e-05,0.45143072952175217,-1.3204229019021049e-05,0.24324840834544145,-6.09777640597976e-06
--- a/test/joint_trajectories_cart/trajectory_0002_cart.csv
+++ b/test/joint_trajectories_cart/trajectory_0002_cart.csv
@ -1,2 +0,0 @@
-timestamp,x,y,z,roll,pitch,yaw
-1746011502.5537577,0.6532209075758113,1.0756815914218787e-06,0.4516153142154451,-0.16215949666928248,0.24324442726272735,3.5922113093537217e-06
--- a/test/joint_trajectories_cart/trajectory_0003_cart.csv
+++ b/test/joint_trajectories_cart/trajectory_0003_cart.csv
@ -1,2 +0,0 @@
-timestamp,x,y,z,roll,pitch,yaw
-1746011503.7946618,0.6529296662848618,0.0001171952325476136,0.4518345764749449,-0.5540031529568706,0.24331773342964108,4.69086289888107e-05
--- a/test/joint_trajectories_cart/trajectory_0004_cart.csv
+++ b/test/joint_trajectories_cart/trajectory_0004_cart.csv
@ -1,2 +0,0 @@
-timestamp,x,y,z,roll,pitch,yaw
-1746011506.1262758,0.6531841589826776,7.594775719196867e-06,0.4516327471980498,0.7704351038290599,0.24324551392018412,8.825426257712039e-05
--- a/test/joint_trajectories_cart/trajectory_0005_cart.csv
+++ b/test/joint_trajectories_cart/trajectory_0005_cart.csv
@ -1,2 +0,0 @@
-timestamp,x,y,z,roll,pitch,yaw
-1746011508.8176053,0.6519301378527343,0.000246380607491159,0.4518166615560665,-0.8648432191117436,0.24331385935128844,6.84897539465569e-05
--- a/test/joint_trajectories_cart/trajectory_0006_cart.csv
+++ b/test/joint_trajectories_cart/trajectory_0006_cart.csv
@ -1,2 +0,0 @@
-timestamp,x,y,z,roll,pitch,yaw
-1746011511.4248803,0.6532211249765901,-4.640926830890013e-07,0.4516099103343386,0.41893370022393944,0.24324392159472094,6.9169210304312415e-06
--- a/test/joint_trajectories_cart/trajectory_0007_cart.csv
+++ b/test/joint_trajectories_cart/trajectory_0007_cart.csv
@ -1,2 +0,0 @@
-timestamp,x,y,z,roll,pitch,yaw
-1746011513.0201094,0.6532056398505591,-2.430523687325936e-05,0.4516035248995389,0.41890080872762575,0.24328409798273318,0.6621515721264102
--- a/test/joint_trajectories_cart/trajectory_0008_cart.csv
+++ b/test/joint_trajectories_cart/trajectory_0008_cart.csv
@ -1,2 +0,0 @@
-timestamp,x,y,z,roll,pitch,yaw
-1746011514.4977942,0.6531535873906201,3.226099854712443e-05,0.451621695542192,0.4189365351282477,0.24345255768684354,0.9324309523005815
--- a/test/joint_trajectories_cart/trajectory_0009_cart.csv
+++ b/test/joint_trajectories_cart/trajectory_0009_cart.csv
@ -1,2 +0,0 @@
-timestamp,x,y,z,roll,pitch,yaw
-1746011516.3413794,0.6532228899076257,-8.734005357835528e-07,0.4516109408555056,0.4189245598540158,0.24324870008972216,-0.5945868340929674
--- a/test/joint_trajectories_cart/trajectory_0010_cart.csv
+++ b/test/joint_trajectories_cart/trajectory_0010_cart.csv
@ -1,2 +0,0 @@
-timestamp,x,y,z,roll,pitch,yaw
-1746011516.9457223,0.6532259816635906,8.687875099125386e-06,0.4516023101187117,0.41892289323625903,0.24323021257171426,-0.9999976543455035
--- a/test/joint_trajectories_cart/trajectory_0011_cart.csv
+++ b/test/joint_trajectories_cart/trajectory_0011_cart.csv
@ -1,2 +0,0 @@
-timestamp,x,y,z,roll,pitch,yaw
-1746011518.62554,0.6526460598071762,0.00016233659881639828,0.4505174009244495,0.41888295418843996,-0.9593977816362218,-1.0000019508430145
--- a/test/joint_trajectories_cart/trajectory_0012_cart.csv
+++ b/test/joint_trajectories_cart/trajectory_0012_cart.csv
@ -1,2 +0,0 @@
-timestamp,x,y,z,roll,pitch,yaw
-1746011520.7094712,0.6532244274421134,-1.7968454893851904e-06,0.45161139839620745,0.41892026617979816,-0.9999989236882725,0.4459443492535846
--- a/test/joint_trajectories_cart/trajectory_0013_cart.csv
+++ b/test/joint_trajectories_cart/trajectory_0013_cart.csv
@ -1,2 +0,0 @@
-timestamp,x,y,z,roll,pitch,yaw
-1746011523.1514468,0.6532232229354377,1.4005465547722862e-07,0.4516135063656488,0.4189189404036424,0.8378378326699625,0.44594595564446193
--- a/test/joint_trajectories_cart/trajectory_0014_cart.csv
+++ b/test/joint_trajectories_cart/trajectory_0014_cart.csv
@ -1,2 +0,0 @@
-timestamp,x,y,z,roll,pitch,yaw
-1746011524.1556451,0.6526165258198791,0.00022251508158053351,0.45185868733414647,0.41889425028065813,0.05405305802733039,0.44594760180151755
--- a/test/joint_trajectories_cart/trajectory_0015_cart.csv
+++ b/test/joint_trajectories_cart/trajectory_0015_cart.csv
@ -1,47 +0,0 @@
-timestamp,x,y,z,roll,pitch,yaw
-1746011532.3775527,0.6512881887268702,0.007050389956288726,0.45883384215193174,0.41893680554671126,0.05405493303024958,0.4459506377683439
-1746011532.3865535,0.6494210525767303,0.014096258365284144,0.4660516807919667,0.4189372137893637,0.054054771598264925,0.44595076116694754
-1746011532.3956466,0.6475584462486482,0.021146586588911994,0.4732735009024223,0.418937639540948,0.05405480256408068,0.4459508826488975
-1746011532.4048228,0.6456959611371006,0.028196877359326522,0.4804952394461889,0.4189380351066616,0.0540548330734993,0.4459509956294648
-1746011532.4140818,0.6438334973021466,0.03524716963469923,0.48771693403395694,0.41893843164739697,0.0540548650884272,0.4459511084203038
-1746011532.423422,0.6419710560271976,0.042297464827151354,0.49493858493285725,0.4189388286968493,0.054054898322699184,0.44595122073758114
-1746011532.432843,0.6401086376831812,0.049347763522088896,0.5021601917919647,0.4189392257087538,0.054054932762312984,0.4459513323331494
-1746011532.442343,0.6382462425006378,0.05639806633340971,0.5093817543760966,0.41893962212438607,0.05405496838826595,0.4459514429505996
-1746011532.4519212,0.6363838705878709,0.06344837388949373,0.5166032725507721,0.41894001736476555,0.0540550051753644,0.4459515523234504
-1746011532.461576,0.6345215219313194,0.07049868682557954,0.5238247462731221,0.41894041083193806,0.05405504309195317,0.4459516601758356
-1746011532.4713063,0.6326591963969299,0.07754900577618078,0.5310461755827307,0.41894080191046257,0.05405508209958807,0.4459517662232993
-1746011532.4811106,0.6307968937323406,0.08459933136745729,0.5382675605923894,0.4189411899690717,0.05405512215273253,0.44595187017368965
-1746011532.490987,0.6289346135698085,0.09164966420963258,0.5454889014788349,0.4189415743625144,0.05405516319849011,0.4459519717281652
-1746011532.5009344,0.6270723554298027,0.09870000488953307,0.5527101984735424,0.41894195443357113,0.05405520517637865,0.44595207058230596
-1746011532.5109506,0.6252101187251904,0.10575035396332563,0.5599314518536389,0.4189423295152421,0.054055248018150905,0.44595216642733093
-1746011532.5210338,0.6233479027659393,0.11280071194951939,0.5671526619329876,0.4189426989330866,0.0540552916476569,0.4459522589514128
-1746011532.5311825,0.6214857067642444,0.11985107932229533,0.5743738290534699,0.4189430620077248,0.0540553359807797,0.4459523478410905
-1746011532.5413945,0.619623529840002,0.12690145650521492,0.58159495357651,0.4189434180574653,0.05405538092541573,0.44595243278276564
-1746011532.5516677,0.6177613710265463,0.13395184386535455,0.5888160358748533,0.41894376640105996,0.05405542638152815,0.44595251346428266
-1746011532.5620003,0.6158992292765568,0.1410022417079041,0.5960370763245991,0.41894410636056634,0.05405547224127168,0.445952589576575
-1746011532.5723896,0.6140371034680612,0.1480526502712529,0.6032580752974984,0.418944437264291,0.05405551838918558,0.4459526608153687
-1746011532.5828335,0.6121749924104495,0.15510306972259164,0.610479033153504,0.41894475844980317,0.05405556470245956,0.4459527268829339
-1746011532.5933301,0.6103128948504163,0.16215350015403363,0.6176999502335496,0.41894506926698644,0.05405561105127686,0.44595278748986317
-1746011532.6038766,0.6084508094777588,0.16920394157926164,0.6249208268525323,0.4189453690811145,0.054055657299229766,0.4459528423568681
-1746011532.6144705,0.6065887349309571,0.17625439393069608,0.63214166329247,0.4189456572759171,0.054055703303813776,0.4459528912165734
-1746011532.6251094,0.6047266698024585,0.183304857057166,0.6393624597957832,0.4189459332566162,0.05405574891698129,0.4459529338152956
-1746011532.6357908,0.6028646126436084,0.19035533072206456,0.6465832165586606,0.41894619645290165,0.05405579398577318,0.4459529699147775
-1746011532.6465118,0.6010025619691528,0.19740581460195988,0.6538039337244439,0.418946446321826,0.05405583835300709,0.4459529992938798
-1746011532.6572702,0.599140516261253,0.20445630828562025,0.6610246113769753,0.4189466823505827,0.054055881858017275,0.4459530217501919
-1746011532.6680627,0.59727847397296,0.21150681127341242,0.6682452495338352,0.4189469040591534,0.05405592433745181,0.44595303710155226
-1746011532.6788871,0.5954164335310711,0.21855732297702138,0.675465848139387,0.41894711100279125,0.054055965626099434,0.44595304518746165
-1746011532.6897402,0.5935543933383355,0.22560784271943266,0.6826864070575521,0.4189473027743174,0.054056005557748234,0.44595304587036744
-1746011532.7006192,0.5916923517749302,0.23265836973511314,0.689906926064208,0.41894747900621887,0.0540560439660668,0.4459530390368058
-1746011532.7115214,0.589830307199159,0.23970890317031993,0.6971274048391137,0.41894763937251167,0.05405608068548591,0.44595302459838476
-1746011532.7224438,0.5879682579473172,0.24675944208345774,0.7043478429572336,0.4189477835903714,0.05405611555207773,0.4459530024925937
-1746011532.7333837,0.5861062023326524,0.25380998544540284,0.7115682398793376,0.41894791142150195,0.05405614840441865,0.44595297268342715
-1746011532.7443378,0.5842441386433538,0.26086053213969906,0.7187885949417235,0.41894802267323883,0.05405617908441479,0.4459529351618146
-1746011532.7553036,0.582382065139506,0.2679110809625296,0.7260089073448978,0.4189481171993768,0.05405620743808544,0.4459528899458427
-1746011532.766278,0.5805199800489084,0.27496163062235307,0.7332291761410191,0.41894819490071916,0.05405623331628642,0.4459528370807702
-1746011532.777258,0.578657881561679,0.28201217973909004,0.7404494002198939,0.41894825572534605,0.0540562565753638,0.44595277663882227
-1746011532.7882407,0.5767957678235212,0.28906272684272516,0.7476695782932722,0.41894829966860114,0.05405627707771135,0.445952708718774
-1746011532.7992232,0.5749336369275324,0.2961132703711883,0.7548897088771448,0.41894832677281046,0.0540562946922452,0.4459526334453102
-1746011532.8102028,0.5730714869043956,0.30316380866735004,0.7621097902717207,0.41894833712673335,0.05405630929474836,0.44595255096817504
-1746011532.8211763,0.5712093157107727,0.31021433997495534,0.7693298205386735,0.4189483308647651,0.05405632076810223,0.4459524614611087
-1746011532.8321412,0.5693471212156821,0.3172648624332917,0.7765497974751978,0.41894830816590123,0.05405632900237528,0.4459523651205818
-1746011532.843094,0.5674849011845903,0.324315374070359,0.7837697185843172,0.4189482692524881,0.05405633389476564,0.44595226216433215
--- a/test/joint_trajectories_cart/trajectory_0016_cart.csv
+++ b/test/joint_trajectories_cart/trajectory_0016_cart.csv
@ -1,35 +0,0 @@
-timestamp,x,y,z,roll,pitch,yaw
-1746011532.9093502,0.5674853499674306,0.3242862163047914,0.7837520505570519,0.41894275091874245,0.05406598619636892,0.4459546385124911
-1746011532.9121642,0.5655203340044299,0.3243232139343958,0.7837811453682008,0.4189190125640916,0.05405405274687227,0.4459459617567151
-1746011532.9151247,0.5634728777509015,0.32432323296121107,0.7837808640921244,0.41891908771875325,0.054054065093887944,0.4459459801674847
-1746011532.9180827,0.56142538376228,0.32432322767354205,0.7837808693979561,0.41891916379478217,0.05405407750870588,0.4459459987475455
-1746011532.9210384,0.5593778897507958,0.32432322230419774,0.7837808746566378,0.4189192408141165,0.05405408999558747,0.44594601750175694
-1746011532.9239917,0.5573303956605581,0.324323216870689,0.783780879898348,0.4189193187915494,0.05405410255651824,0.4459460364329057
-1746011532.9269423,0.5552829014923439,0.32432321137257836,0.7837808851241632,0.4189193977421289,0.054054115193513566,0.4459460555438191
-1746011532.9298909,0.5532354072469263,0.32432320580930507,0.7837808903350302,0.4189194776811745,0.05405412790861878,0.44594607483736665
-1746011532.9328368,0.5511879129572292,0.3243232000219463,0.783780895473564,0.4189189999602915,0.054054066528201355,0.4459459653154673
-1746011532.9357805,0.5491404185276059,0.324323194483961,0.7837809007161218,0.4189190819233664,0.054054079405795256,0.44594598498304555
-1746011532.9387217,0.5470929240551087,0.3243231887222405,0.7837809058875711,0.4189191649224788,0.054054092367817566,0.44594600484211916
-1746011532.9416606,0.5450454295083246,0.32432318289251283,0.7837809110479097,0.4189192489741611,0.0540541054164527,0.44594602489575275
-1746011532.9445972,0.5429979348879981,0.32432317699467256,0.7837809161978866,0.4189193340951758,0.054054118553908466,0.44594604514704433
-1746011532.9475315,0.5409504401948257,0.3243231710281024,0.7837809213383895,0.4189194203025934,0.05405413178243131,0.4459460655991395
-1746011532.9504633,0.5389029454608026,0.32432316484919305,0.7837809264149049,0.4189190063301625,0.05405406707655031,0.44594596650076956
-1746011532.953393,0.5368554505927587,0.3243231588853115,0.7837809315949152,0.4189190947628819,0.054054080494091196,0.4459459873640832
-1746011532.95632,0.5348079556851494,0.32432315270920914,0.7837809367121189,0.41891918433505476,0.05405409400964625,0.44594600843792265
-1746011532.9592452,0.5327604607073285,0.3243231464613392,0.7837809418234594,0.41891927506511256,0.05405410762561882,0.44594602972564984
-1746011532.9621677,0.5307129656599798,0.32432314014149904,0.7837809469296537,0.41891936697176096,0.054054121344443117,0.44594605123066533
-1746011532.9650881,0.5286654705437356,0.3243231337490123,0.7837809520315433,0.4189194600740538,0.0540541351685951,0.44594607295642474
-1746011532.9680064,0.526617975395055,0.3243231271261544,0.7837809570743026,0.4189190133465497,0.054054067649949834,0.4459459677813797
-1746011532.970922,0.5245704801071371,0.324323120742288,0.7837809622262041,0.4189191088987512,0.054054081692357064,0.4459459899591836
-1746011532.9738357,0.5225229847879679,0.32432311412821635,0.7837809673200242,0.41891920570584323,0.054054095847763634,0.44594601236841264
-1746011532.976747,0.5204754894023057,0.32432310743816406,0.7837809724129858,0.41891930378842596,0.05405411011882692,0.44594603501276386
-1746011532.979656,0.5184279939507895,0.3243231006719233,0.7837809775057574,0.41891940316740844,0.05405412450824138,0.44594605789597763
-1746011532.9825628,0.5163804984340025,0.32432309382875696,0.7837809825991414,0.41891950386409554,0.05405413901874815,0.4459460810218539
-1746011532.9854672,0.5143330028933008,0.3243230867351692,0.7837809876380952,0.4189190210770627,0.054054068310297194,0.44594596918846346
-1746011532.9883695,0.5122855072069994,0.32432307990746007,0.7837809927914396,0.4189191244747295,0.05405408307141227,0.4459459928112815
-1746011532.9912696,0.5102380114978926,0.32432307282956124,0.7837809978912779,0.4189192292563803,0.05405409796212598,0.44594601668851686
-1746011532.9941673,0.5081905157257325,0.3243230656710888,0.7837810029950474,0.4189193354450786,0.05405411298538767,0.44594604082424105
-1746011532.997063,0.5061430198911258,0.3243230584318355,0.7837810081033706,0.41891944306423795,0.054054128144191756,0.4459460652225732
-1746011532.9999561,0.5040955240325694,0.32432305095389435,0.783781013170239,0.4189190281039311,0.05405406900093136,0.4459459704899269
-1746011533.0028472,0.5020480280368114,0.32432304370668014,0.783781018337226,0.41891913865609154,0.05405408444002193,0.4459459954260739
-1746011533.0057359,0.5000005320181706,0.324323036220767,0.7837810234636979,0.4189192507116003,0.054054100023951286,0.44594602063757643
--- a/test/joint_trajectories_cart/trajectory_0017_cart.csv
+++ b/test/joint_trajectories_cart/trajectory_0017_cart.csv
@ -1,17 +0,0 @@
-timestamp,x,y,z,roll,pitch,yaw
-1746011532.96937,0.4999799111984431,0.3243081283037476,0.7837763382146322,0.41893036666045197,0.05406520342098361,0.4459520469720618
-1746011532.9718719,0.498198598246477,0.3243232995029089,0.7837817133511014,0.41891902146016785,0.054054059442134345,0.4459459650099033
-1746011532.9744103,0.49639681535927316,0.32432331591000985,0.7837816523350581,0.4189191103759429,0.05405407144821279,0.44594598464693813
-1746011532.9769473,0.4945950175357502,0.3243233106893685,0.7837816558185404,0.4189192003558497,0.05405408356026246,0.4459460044781496
-1746011532.9794822,0.492793219698817,0.32432330538032317,0.7837816593398205,0.418919291424881,0.05405409578156464,0.44594602450820553
-1746011532.9820156,0.49099142182681615,0.3243233000189337,0.7837816628672264,0.4189193835992854,0.054054108114165125,0.44594604473988947
-1746011532.9845471,0.4891896239200019,0.32432329460485615,0.7837816664011746,0.41891947689557,0.054054120560140924,0.44594606517602114
-1746011532.987077,0.48738782601544817,0.3243232889859099,0.7837816699068272,0.41891901345481813,0.054054066267745,0.4459459664667732
-1746011532.9896052,0.4855860280030464,0.32432328361579815,0.7837816734906478,0.41891910904556084,0.05405407894685183,0.4459459873204016
-1746011532.9921315,0.4837842299934453,0.3243232780412712,0.7837816770464489,0.4189192058093559,0.054054091745767,0.4459460083871717
-1746011532.994656,0.4819824319500601,0.32432327241166403,0.7837816806104704,0.4189193037639644,0.05405410466671982,0.4459460296700891
-1746011532.9971788,0.48018063387319726,0.3243232667269524,0.7837816841829807,0.4189194029273745,0.05405411771196841,0.44594605117218783
-1746011532.9996998,0.47837883576312107,0.3243232609866381,0.7837816877643675,0.4189195033178884,0.054054130883808164,0.4459460728965463
-1746011533.0022192,0.4765770376606043,0.3243232550298062,0.783781691317646,0.418919020670677,0.054054066976875564,0.44594596776270296
-1746011533.0047367,0.47477523944441624,0.3243232493361584,0.7837816949557206,0.41891912357162425,0.05405408040895131,0.4459459899409692
-1746011533.0072525,0.47297344123632357,0.32432324342649127,0.7837816985659193,0.41891922775643586,0.05405409397473383,0.44594601235098746
--- a/test/joint_trajectories_cart/trajectory_0018_cart.csv
+++ b/test/joint_trajectories_cart/trajectory_0018_cart.csv
@ -1,15 +0,0 @@
-timestamp,x,y,z,roll,pitch,yaw
-1746011533.0190654,0.4729675835676446,0.32431919158166256,0.783782219687678,0.418922884054828,0.05405868097341197,0.4459483222897532
-1746011533.0219567,0.47089459816249213,0.32432287238180096,0.7837810330193966,0.4189190657577595,0.054054069850432804,0.44594597634878497
-1746011533.0248547,0.46881560483196083,0.3243228675515081,0.7837810199457409,0.41891920842841107,0.05405408868042115,0.4459460073194099
-1746011533.0277505,0.4667366080950193,0.3243228581755897,0.7837810255312853,0.41891935317054213,0.05405410772450029,0.44594603866277943
-1746011533.030644,0.46465761131310124,0.32432284868702294,0.7837810311435567,0.41891950002348666,0.05405412698769483,0.4459460703855337
-1746011533.033535,0.46257861452455523,0.3243228389036736,0.7837810367397424,0.4189190680570318,0.05405407308603246,0.4459459778929188
-1746011533.0364237,0.4604996175853681,0.32432282938741386,0.7837810424341896,0.4189192192454925,0.054054092801804524,0.4459460103931869
-1746011533.03931,0.45842062064063405,0.32432281957623044,0.7837810481133953,0.41891937266003854,0.054054112751202324,0.4459460432918138
-1746011533.0421937,0.4563416236426001,0.324322809654284,0.7837810538166952,0.41891952834086704,0.05405413293927991,0.445946076595379
-1746011533.045075,0.4542626266438649,0.3243227994218713,0.783781059506461,0.4189190770570686,0.054054073994403255,0.4459459794864965
-1746011533.0479538,0.45218362948898905,0.3243227894739724,0.7837810652987756,0.4189192373940573,0.05405409467538531,0.44594601362000447
-1746011533.0508304,0.4501046323345144,0.3243227792154759,0.7837810710783286,0.41891940012244544,0.05405411561077476,0.44594604817876654
-1746011533.0537043,0.44802563512886656,0.3243227688413813,0.7837810768850887,0.41891956528588714,0.05405413680605373,0.4459460831698299
-1746011533.0565755,0.44594663792894845,0.32432275813736583,0.7837810826820362,0.41891908672518635,0.05405407497758083,0.44594598118475093
--- a/test/joint_trajectories_cart/trajectory_0019_cart.csv
+++ b/test/joint_trajectories_cart/trajectory_0019_cart.csv
@ -1,13 +0,0 @@
-timestamp,x,y,z,roll,pitch,yaw
-1746011533.0714974,0.44594479370791107,0.3243229113593311,0.7837834733719453,0.41891998721071555,0.05405555708968378,0.445946672040322
-1746011533.074887,0.4434899234293596,0.3243221284925224,0.7837800252479045,0.4189191578719105,0.05405408390802372,0.4459459966004781
-1746011533.0782738,0.4410329262832197,0.3243221032886653,0.7837800326064785,0.4189194002158503,0.054054115351261894,0.4459460483515074
-1746011533.081657,0.43857593149369867,0.32432208526580847,0.7837800424032673,0.4189196469167678,0.054054147258543545,0.4459461008721819
-1746011533.0850365,0.43611893669538565,0.324322066742555,0.7837800521930054,0.41891917029277026,0.05405408569634271,0.4459459989852153
-1746011533.0884125,0.4336619416506908,0.32432204855344715,0.7837800621389451,0.41891942598366166,0.054054118566797926,0.44594605308849516
-1746011533.091785,0.431204946646144,0.3243220296329888,0.7837800720717742,0.4189191794136409,0.054054086899736536,0.44594600067556533
-1746011533.0951536,0.42874795144320704,0.32432201086746965,0.7837800821331815,0.4189194444943332,0.05405412078389863,0.44594605642453433
-1746011533.0985186,0.4262909562628118,0.3243219914405286,0.7837800922016209,0.41891918902008396,0.05405408791048293,0.44594600234282633
-1746011533.1018798,0.4238339608814064,0.3243219721801857,0.7837801024013001,0.41891946391135065,0.054054122861514,0.4459460598032368
-1746011533.1052372,0.421376965530512,0.3243219522339363,0.783780112612744,0.4189191990581946,0.05405408897376629,0.4459460040763636
-1746011533.108591,0.4189199699757924,0.32432193246638513,0.7837801229578205,0.4189194842024383,0.054054125047544234,0.44594606331668346
--- a/test/joint_trajectories_cart/trajectory_0020_cart.csv
+++ b/test/joint_trajectories_cart/trajectory_0020_cart.csv
@ -1,10 +0,0 @@
-timestamp,x,y,z,roll,pitch,yaw
-1746011533.1262534,0.41842447692181745,0.3246813746559968,0.783571645193747,0.4193546159992642,0.05398112551456086,0.4459945230852728
-1746011533.1290176,0.4165345722897328,0.3243238880878223,0.7837812215209303,0.4189189150143966,0.05405392159912383,0.4459458795883365
-1746011533.1311831,0.4149447971824438,0.32432330924252983,0.783782256231408,0.4189190379373616,0.05405393659333914,0.44594590418307367
-1746011533.133347,0.4133549745090436,0.32432330222803823,0.7837822593086075,0.4189191627286618,0.05405395180376138,0.4459459291070972
-1746011533.1355095,0.4117651512087156,0.32432329658904135,0.7837822621834206,0.4189192890305639,0.054053967185446875,0.44594595428888806
-1746011533.13767,0.41017532789440103,0.3243232909068814,0.7837822650719903,0.41891941686407186,0.054053982741013626,0.4459459797315213
-1746011533.139829,0.4085855045878922,0.32432328502953667,0.7837822680046664,0.418919048294228,0.05405406941982729,0.4459459715020369
-1746011533.1419864,0.4069956812244997,0.3243232793969047,0.7837822708929729,0.41891917925855926,0.05405408533160594,0.44594599747635805
-1746011533.144142,0.4054058578692489,0.32432327356954554,0.7837822738253393,0.41891931182272635,0.05405410142575136,0.4459460237215898