{"sample":0,"step":0,"t":0,"sim_time":0,"vehicle":{"origin_ned":[4.8572257327350599e-17,1.3010426069826053e-17,2],"origin_quat_xyzw":[-2.7105054312137616e-19,1.3870270390407578e-17,-1.2536087619363648e-17,0.99999999999999989],"cg_ned":[-0.050408325622803098,0.00024927379720570081,1.6997419941089058],"linear_velocity_ned":[0,0,0],"angular_velocity_ned":[0,0,0]},"sensors":{"Odom":[4.8572257327350599e-17,1.3010426069826053e-17,2,0,0,0,1.4901161193847656e-08,0,0,0.99999999999999989,0,0,0],"Pressure":[12753.697120767716],"DVL":[0.023837251994643271,-0.0016582992067534221,0.018316064379539646,9.0145360610980969,-0.011170275841916488,0.015350379925766822,-0.011696819037183049,0],"IMU":[4.488596994089989e-17,3.2437920808491482e-17,-1.4799359654427139e-17,-0.06697248598619214,0.017111408928462003,0.099762237732694714,0.019878688229610027,0.0092734600682736722,-9.8006215368180403],"FOG":[-0.00086434831023020982],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[0,0,0,0,0],"omega_rad_s":[0,0,0,0,0],"thrust_n":[0,0,0,0,0],"torque_nm":[0,0,0,0,0],"angle_rad":[0,0,0,0,0]},"command":[0,0,0,0,0],"arm":{"servo_position":[0,0,0,0,0,0],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0,0,0,0,0,0]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":1,"step":8,"t":0.040000000000000001,"sim_time":0.040000000000000001,"vehicle":{"origin_ned":[5.2168144206769795e-05,7.2725352031743212e-09,1.9999044523306448],"origin_quat_xyzw":[-1.2182700806793641e-08,9.2695532114926157e-05,-3.9738434908836912e-08,0.99999999570376819],"cg_ned":[-0.050411821743538865,0.00024927776245586164,1.6996557968464787],"linear_velocity_ned":[-0.00015259316556290702,1.7921782875398936e-07,-0.003824812765692619],"angular_velocity_ned":[-9.6013943937590681e-07,0.0082014526417966589,-3.592747755328241e-06]},"sensors":{"Odom":[5.2168144206769795e-05,7.2725352031743212e-09,1.9999044523306448,0.0023106668432182663,2.8648090363295855e-07,-0.0042382622453825706,-1.2182700955247621e-08,9.269553324448033e-05,-3.9738435393075087e-08,0.99999999570376819,-9.6012520385340282e-07,0.0082014526418078913,-3.5927259235932268e-06],"Pressure":[12752.040084965014],"DVL":[-0.022375838451975619,-0.01268015469790108,-0.035257314184164459,9.11229699223761,-0.016987048225217922,0.01988069364521125,-0.0028280097765942336,0],"IMU":[-2.4372769126616892e-08,0.00018539106449441396,-7.9479129431079139e-08,0.004424079290456219,-0.045054135563458983,-0.046028381394713609,-0.080574387869679867,9.9228956287763731e-05,-9.9173376011607779],"FOG":[0.00040881832975303122],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[0.089796204465073984,-6.2287916441354767,-6.2365731102085551,9.7255687505905577,9.7255687505905577],"omega_rad_s":[0.016719656723092419,-1.1597665406925783,-1.1612154044897847,1.8108454998333949,1.8108447972045307],"thrust_n":[3.5677873430036328e-06,-0.016802065217004628,-0.016845361226345799,0.041753099364082474,0.048232206136586582],"torque_nm":[-6.6896012681318121e-08,0.00031503872281883676,0.00031585052299398374,-0.00078287061307654642,-0.00090435386506099852],"angle_rad":[0.00021408041935301012,-0.014849658133887646,-0.014868209400946467,0.023186078625384118,0.023186073052460048]},"command":[0.00085520194728641889,-0.059321825182242639,-0.059395934382938616,0.092624464291338651,0.092624464291338651],"arm":{"servo_position":[-1.0587911840678754e-24,0,0,0,0,0],"servo_velocity":[-4.2351647362715017e-22,0,0,0,0,0],"servo_effort":[-0.0010500945564782575,0.84244055581330846,0.21765633381712229,-1.4334057484021827e-06,0.00036308621086548505,-0.00051938919092777553]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":2,"step":16,"t":0.080000000000000002,"sim_time":0.080000000000000002,"vehicle":{"origin_ned":[0.00019483166378846117,1.3902580977339252e-08,1.9996412243684774],"origin_quat_xyzw":[-2.2687959052798381e-08,0.00034551666066484686,-1.7051810345920046e-07,0.99999994030910189],"cg_ned":[-0.050420970113018625,0.00024929130253874331,1.699418123987301],"linear_velocity_ned":[-0.00028769036470347603,5.0761882968330659e-07,-0.0075758158312409394],"angular_velocity_ned":[3.2979239825542915e-07,0.016054924859966995,-9.5040089727466408e-06]},"sensors":{"Odom":[0.00019483166378846117,1.3902580977339252e-08,1.9996412243684774,0.0045381621991629293,-7.0518248910212019e-08,-0.0083853147887049014,-2.2687959078951929e-08,0.00034551666106314122,-1.705181036557652e-07,0.99999994030910189,3.3088434394641499e-07,0.016054924860510886,-9.5030521909125282e-06],"Pressure":[12744.581222292752],"DVL":[-0.0046490383060567792,-0.036092878445545575,-7.5108486465079861e-05,9.0753901561563577,0.033907560311039593,-0.024384603670947046,0.019506200649391403,0],"IMU":[-4.5493759926403875e-08,0.00069103333507153234,-3.4105194613953657e-07,0.044352777514791504,-0.032773452372823142,0.17672665532297993,-0.069508222857040197,-0.0035837367874082034,-9.9003543959322897],"FOG":[0.0065573660706916663],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[0.10409219946312351,-10.768873482635577,-10.784414861518853,16.874951982391121,16.874951982391121],"omega_rad_s":[0.048040110559303316,-4.1394791019185151,-4.1450999085604217,6.4783608002834026,6.4783456541899014],"thrust_n":[2.9459240728366725e-05,-0.21599385970623872,-0.2165926248800108,0.53516050028020512,0.58380717496948842],"torque_nm":[-5.5236076365687603e-07,0.0040498848694919759,0.004061111716500203,-0.010034259380253848,-0.010946384530677908],"angle_rad":[0.0016459548178291022,-0.12806704988602266,-0.12823427167911383,0.20024706374754714,0.20024678685971042]},"command":[0.00099135428060117626,-0.10256069983462454,-0.10270871296684621,0.16071382840372495,0.16071382840372495],"arm":{"servo_position":[-1.0587911840678754e-24,0,0,0,0,0],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.0026046681397986532,0.82457933583616505,0.22115568143194936,-1.3759237770549945e-06,0.00040757076394649862,-0.00058842356555805083]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":3,"step":24,"t":0.12,"sim_time":0.12000000000000004,"vehicle":{"origin_ned":[0.00042396646666881255,-2.4925861317678932e-08,1.9992149831721511],"origin_quat_xyzw":[4.851926930252355e-08,0.00075141212939372102,-4.9315605179383973e-07,0.99999971768974316],"cg_ned":[-0.050435536874858973,0.00024932794511551144,1.6990330712017327],"linear_velocity_ned":[-0.00042672771614030375,1.3329874505391591e-06,-0.011200311751576217],"angular_velocity_ned":[7.0801370626054966e-06,0.023552538693608766,-2.2738764022795047e-05]},"sensors":{"Odom":[0.00042396646666881255,-2.4925861317678932e-08,1.9992149831721511,0.0066619374970367379,-1.9434649251215707e-06,-0.012388186208015765,4.851926931200081e-08,0.00075141212954049413,-4.931560518901677e-07,0.99999971768974316,7.0910729938974411e-06,0.023552538698391263,-2.2730401105243072e-05],"Pressure":[12737.603836193321],"DVL":[-0.0014665743409215514,-0.007334964465626077,-0.013191068507977494,9.0524605921498171,-0.033297950925110967,0.00019979835010646023,-0.032232162046448423,0],"IMU":[9.6297492994566793e-08,0.0015028244002560213,-9.8624002291268424e-07,0.024411448457088585,0.037294279928775161,-0.12037163847337744,-0.069869406586123561,-0.019897995291973114,-9.9399767608055107],"FOG":[-0.018217676972991651],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-0.18292433807232458,-13.853167742361542,-13.883451641292146,21.78404632285255,21.78404632285255],"omega_rad_s":[-0.0096384222803333561,-7.2848798566332853,-7.2976243023900382,11.429073505019423,11.429010691200451],"thrust_n":[-1.1818435015678494e-06,-0.67020636591323135,-0.67260040656321285,1.6663071400511158,1.7950290852939494],"torque_nm":[2.2159565654397176e-08,0.012566369360873084,0.012611257623060241,-0.031243258875958423,-0.033656795349261547],"angle_rad":[0.0024619095811630825,-0.36549783901878374,-0.36604139878232572,0.57240883369441276,0.57240701131772131]},"command":[-0.001742136553069758,-0.13193493087963373,-0.1322233489646871,0.20746710783669095,0.20746710783669095],"arm":{"servo_position":[-1.0587911840678756e-24,0,0,4.2351647362715018e-24,0,0],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.0059877513991579536,0.79300525023096691,0.22136223270257693,-1.4835982120129007e-06,0.00044623361935774996,-0.00065133249975731292]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":4,"step":32,"t":0.16,"sim_time":0.16000000000000006,"vehicle":{"origin_ned":[0.00073457587636278215,-1.8896926193187049e-07,1.9986325009721322],"origin_quat_xyzw":[3.4579501255757436e-07,0.0013031882892488027,-1.209370504753101e-06,0.99999915084898972],"cg_ned":[-0.050456162695526267,0.00024941530879348032,1.6985068980766345],"linear_velocity_ned":[-0.00059053115625763784,2.9887952316797061e-06,-0.014646497833070081],"angular_velocity_ned":[2.2284465769994976e-05,0.030687567638115223,-4.8055443233113738e-05]},"sensors":{"Odom":[0.00073457587636278215,-1.8896926193187049e-07,1.9986325009721322,0.0086618209999586686,-6.1496455175522632e-06,-0.016194901702883919,3.4579501257037891e-07,0.001303188289297059,-1.2093705047978832e-06,0.99999915084898972,2.2335442996468327e-05,0.030687567658855358,-4.8018518274868328e-05],"Pressure":[12725.954909223759],"DVL":[-0.019668186087320811,0.037891229715766014,-0.0051970293443697052,8.9718406615256772,0.0050227200080378035,-0.021180471113869108,-0.0076785457195818977,0],"IMU":[6.8843970126264021e-07,0.002606377317067332,-2.4178458960785945e-06,0.030594460533469783,-0.092135465231754171,-0.057187388460860966,-0.063340732130212102,0.0017933141256490078,-9.9121153881162911],"FOG":[-0.0067684334328781274],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-0.40699420224477983,-16.299618688275711,-16.357987405232375,25.717991375092836,25.717991375092836],"omega_rad_s":[-0.12733442610000639,-10.285796824143999,-10.311791651569047,16.178368108607028,16.178213818170725],"thrust_n":[-0.00020679654701782218,-1.3369675081952175,-1.3438724186476709,3.3394413161484908,3.5794474225670636],"torque_nm":[3.8774352565841659e-06,0.02506814077866033,0.025197607849643828,-0.062614524677784195,-0.067114639173132443],"angle_rad":[-0.00049036277578174867,-0.7258748325619282,-0.72721064505246402,1.1386741093087971,1.1386678682225662]},"command":[-0.0038761352594740939,-0.15523446369786392,-0.15579035624030832,0.24493325119136033,0.24493325119136033],"arm":{"servo_position":[-1.0587911840678749e-24,0,0,-4.2351647362715018e-24,-8.4703294725430109e-24,0],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.01087211912218029,0.74926163750630725,0.21859201171854836,-1.7846580285446755e-06,0.00047946567868571461,-0.00070816892235873313]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":5,"step":40,"t":0.20000000000000001,"sim_time":0.20000000000000009,"vehicle":{"origin_ned":[0.0011208637918546857,-5.8466280568146697e-07,1.9979022843053555],"origin_quat_xyzw":[1.0629473289570839e-06,0.0019935219616631647,-2.5999550309358658e-06,0.99999801292917512],"cg_ned":[-0.050484199351905464,0.00024959246714080941,1.6978476452801454],"linear_velocity_ned":[-0.00079423188824119105,5.721974791954658e-06,-0.017876229557942106],"angular_velocity_ned":[4.7943994966504245e-05,0.037453717312045845,-8.8728437527160235e-05]},"sensors":{"Odom":[0.0011208637918546857,-5.8466280568146697e-07,1.9979022843053555,0.010522803967614614,-1.3230234910507e-05,-0.019767245288236941,1.062947328964863e-06,0.0019935219616777546,-2.5999550309548939e-06,0.99999801292917512,4.8102780524746433e-05,0.037453717373254848,-8.8616588606236986e-05],"Pressure":[12707.143184925968],"DVL":[0.01646951615816919,-0.036548840004035563,-0.0035234945219959094,9.0587335527960562,-0.016654864507126659,0.018677009474483381,-0.0064180218290601655,0],"IMU":[2.1155411135603215e-06,0.0039870465696809926,-5.1957030084113124e-06,0.13944225633812227,-0.017734974541401737,0.0547243691469863,-0.032224300781178744,-0.0090419861511906747,-9.893825892279164],"FOG":[-0.0099114568451528062],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-0.64668625827525883,-18.342639437186957,-18.44521911911594,29.038401942390649,29.038401942390649],"omega_rad_s":[-0.28707571344640348,-13.036852600833335,-13.085555541375294,20.559591294895579,20.559299707866813],"thrust_n":[-0.0010511371617107884,-2.1481403836497051,-2.1645488649310876,5.3931806913572347,5.7678354554733993],"torque_nm":[1.9708821782077285e-05,0.040277632193431973,0.040585291217457894,-0.10112213796294817,-0.10814691479012621],"angle_rad":[-0.0091326056019239415,-1.2007269589050515,-1.2035930729543831,1.8867361945281251,1.8867208401443187]},"command":[-0.0061589167454786558,-0.17469180416368529,-0.17566875351538991,0.27655620897514904,0.27655620897514904],"arm":{"servo_position":[1.5881867761018134e-23,-2.1684043449710089e-21,-6.3527471044072523e-24,-4.2351647362715025e-24,-8.4703294725430109e-24,0],"servo_velocity":[0,-4.3368086899420177e-19,0,0,0,0],"servo_effort":[-0.016729102878259627,0.69586211152165467,0.21335394613740338,-2.2702229034924045e-06,0.00050101066269102464,-0.00075916539060663646]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":6,"step":48,"t":0.23999999999999999,"sim_time":0.24000000000000013,"vehicle":{"origin_ned":[0.0015764873403415758,-1.3333191515487309e-06,1.9970339897563019],"origin_quat_xyzw":[2.4224535694511981e-06,0.0028149687483838672,-4.9925728184000551e-06,0.9999960379522268],"cg_ned":[-0.050521464012662352,0.00024990627904170054,1.6970645381871441],"linear_velocity_ned":[-0.0010468358221116989,9.6874743175445345e-06,-0.02086633144146768],"angular_velocity_ned":[8.5026485962339226e-05,0.043845169198823718,-0.00014642408728004821]},"sensors":{"Odom":[0.0015764873403415758,-1.3333191515487309e-06,1.9970339897563019,0.01223548302979895,-2.3436742163593887e-05,-0.023082077257807799,2.4224535694713109e-06,0.0028149687484072391,-4.9925728184415063e-06,0.9999960379522268,8.5412292953389521e-05,0.043845169340988865,-0.00014615673215821623],"Pressure":[12691.298345274945],"DVL":[0.018487062899489932,0.020183950817884995,0.030209466845624464,8.9849166113487602,-0.047471249145796798,0.018076348618534743,0.031482362553726675,0],"IMU":[4.8168564082669033e-06,0.0056299449562133954,-9.9716258444505653e-06,0.063743744469079919,0.02573833264461688,0.042778875981727513,0.01184594706416757,0.011444872208004159,-9.8818550758953787],"FOG":[-0.0024810876130912131],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-0.90052489063938379,-20.090582169149528,-20.254093009439099,31.913400324608979,31.913400324608979],"omega_rad_s":[-0.48040087068100434,-15.510521879126857,-15.593992006942113,24.527787820695728,24.527316890291459],"thrust_n":[-0.0029434228230626218,-3.0404079684145322,-3.0738794358992507,7.6754411419146811,8.2009109815819894],"torque_nm":[5.5189177932424162e-05,0.057007649407772483,0.057635239423110954,-0.1439145214109003,-0.15376708090466232],"angle_rad":[-0.024950146632160105,-1.7793114174514959,-1.7848858776120287,2.8006571151999617,2.8006261905988463]},"command":[-0.0085764275298988932,-0.19133887780142408,-0.19289612389941999,0.30393714594865695,0.30393714594865695],"arm":{"servo_position":[1.5881867761018134e-23,0,-6.3527471044072523e-24,-4.2351647362715025e-24,-1.0926725019580475e-21,0],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.023058207911870795,0.6352170845496139,0.2061390206551923,-2.9338949711367302e-06,0.00050395725291961133,-0.00080458489685898606]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":7,"step":56,"t":0.28000000000000003,"sim_time":0.28000000000000014,"vehicle":{"origin_ned":[0.0020947897129909923,-2.5605485836655028e-06,1.9960378851574279],"origin_quat_xyzw":[4.6568317664919104e-06,0.0037599754514923808,-8.7321902590925794e-06,0.99999293121834965],"cg_ned":[-0.050570015730463734,0.00025040802618045172,1.6961674367872688],"linear_velocity_ned":[-0.0013522781250213762,1.496420491635919e-05,-0.023606177518633926],"angular_velocity_ned":[0.00013365304714371888,0.049856860999052774,-0.00022146547567290542]},"sensors":{"Odom":[0.0020947897129909923,-2.5605485836655028e-06,1.9960378851574279,0.013795142570759204,-3.6782461592049246e-05,-0.026128913602126852,4.6568317664887578e-06,0.0037599754514898356,-8.7321902590866688e-06,0.99999293121834965,0.00013444569876310461,0.049856861280021009,-0.00022092177715589946],"Pressure":[12669.690446475846],"DVL":[-0.010926114484614882,0.017088765710196935,0.001158644619079616,9.0755053819014613,0.0001859418022302022,3.3157657703309168e-05,-0.045527608054927005,0],"IMU":[9.2481935459781778e-06,0.0075199687028385089,-1.7429730743590121e-05,-0.017865175697996553,0.019211525370734249,0.097970608792816938,0.0045257073891663462,0.014849796124357424,-9.8700077081519328],"FOG":[-0.00043311122007531254],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-1.1627852436106412,-21.605887943739937,-21.846358894974017,34.441187721222008,34.441187721222008],"omega_rad_s":[-0.69971203630800627,-17.712280152685814,-17.844183202664663,28.090318300335902,28.089632985328901],"thrust_n":[-0.0062438654733283673,-3.9638977637001851,-4.0243247357341216,10.065622608082455,10.751991283528977],"torque_nm":[0.0001170724776249069,0.074323083069378487,0.075456088795014795,-0.18873042390154604,-0.20159983656616834],"angle_rad":[-0.049111561554364511,-2.4506060676222168,-2.4605884438659751,3.8640008895973823,3.8639464064680604]},"command":[-0.011074145177244202,-0.20577036136895177,-0.20806056090451444,0.32801131163068581,0.32801131163068581],"arm":{"servo_position":[1.5881867761018134e-23,0,-6.3527471044072523e-24,-4.2351647362715025e-24,-1.0926725019580475e-21,0],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.029459753979991284,0.56931118207699549,0.19735504472907969,-3.7602487111594792e-06,0.00050329710659880096,-0.00084466801936865015]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":8,"step":64,"t":0.32000000000000001,"sim_time":0.32000000000000017,"vehicle":{"origin_ned":[0.0026689856448271071,-4.388100098054275e-06,1.9949244295947595],"origin_quat_xyzw":[7.9943427643858103e-06,0.0048208980821783263,-1.4158072503060705e-05,0.9999883792711397],"cg_ned":[-0.050631982573722339,0.00025115082742240116,1.6951664054852476],"linear_velocity_ned":[-0.0017107515687650157,2.1575204040528521e-05,-0.026094495295696421],"angular_velocity_ned":[0.00019332493154500973,0.055484746329626806,-0.00031318172114840249]},"sensors":{"Odom":[0.0026689856448271071,-4.388100098054275e-06,1.9949244295947595,0.015200583845061994,-5.3105260270929707e-05,-0.028906718974516139,7.9943427643802538e-06,0.0048208980821749757,-1.4158072503050866e-05,0.9999883792711397,0.00019476872550298755,0.055484746824791827,-0.00031219787791312957],"Pressure":[12644.313302118886],"DVL":[0.0058175952224438516,-0.017332283818306399,0.022407222239572915,9.0348217367269505,-0.006626293070668525,-0.013377522692489598,-0.0013332157478363497,0],"IMU":[1.5852727348533833e-05,0.0096418337374434317,-2.8240048789507686e-05,-0.086726840107286388,0.092715998879549885,0.064395824768727905,0.042191605515858641,0.013344689712533078,-9.8554483388104437],"FOG":[-0.011266650161102364],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-1.4285114189130095,-22.92951868548046,-23.261607577051151,36.687361058110355,36.687361058110355],"omega_rad_s":[-0.93809301082706298,-19.661252420965262,-19.855914696649556,31.276754321107727,31.275827962029766],"thrust_n":[-0.011222082297323315,-4.8825389516508961,-4.9815862023815116,12.476416612917197,13.328824130766609],"torque_nm":[0.00021041404307481216,0.091547605343454311,0.093404741294653343,-0.2339328114921975,-0.24991545245187397],"angle_rad":[-0.082496663493269146,-3.2041506991954019,-3.2208044334906312,5.0611819817317674,5.0610947365000776]},"command":[-0.013604870656314376,-0.21837636843314723,-0.22153911978143953,0.34940343864867007,0.34940343864867007],"arm":{"servo_position":[1.5881867761018134e-23,0,-6.3527471044072112e-24,-4.2351647362714996e-24,-1.0926725019580475e-21,0],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.035643456654307737,0.49966372677181947,0.18732042284366573,-4.7300699775122886e-06,0.00049952089668063441,-0.00087960779574305014]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":9,"step":72,"t":0.35999999999999999,"sim_time":0.36000000000000021,"vehicle":{"origin_ned":[0.0032922990857181325,-6.9280533032876315e-06,1.9937039752283741],"origin_quat_xyzw":[1.2648835987127534e-05,0.0059900243711958467,-2.158767836927597e-05,0.99998205933007189],"cg_ned":[-0.050709439196481729,0.00025218780885099656,1.6940714058159554],"linear_velocity_ned":[-0.0021198838684321048,2.9505047130495554e-05,-0.028336469599578938],"angular_velocity_ned":[0.00026311736786292799,0.060725990415746507,-0.00042023794218379567]},"sensors":{"Odom":[0.0032922990857181325,-6.9280533032876315e-06,1.9937039752283741,0.016453093881573982,-7.2122192957681e-05,-0.031420994478848073,1.2648835987153487e-05,0.0059900243712081372,-2.1587678369320263e-05,0.99998205933007189,0.0002655202498184134,0.060725991217400244,-0.00041860758691667513],"Pressure":[12620.707110206535],"DVL":[0.030361245681123659,-0.02495832530584912,0.011100316952348014,9.0202076511115425,-0.0074385489867554401,0.017640911884153301,0.01610408887045035,0],"IMU":[2.5040393598994401e-05,0.011980120927429587,-4.302613607488193e-05,0.010075666593070021,0.056313025357946855,0.15977182887440147,0.061200251870140297,0.0072445321277047371,-9.8857108375561289],"FOG":[-0.0033173467823096672],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-1.6938287857143981,-24.090617995691176,-24.527317591004561,38.699513498519138,38.699513498519138],"omega_rad_s":[-1.1894566407509191,-21.381193211650736,-21.6528348046334,34.124682253569695,34.123496745858958],"thrust_n":[-0.01804033709760567,-5.7717353130427682,-5.9221550648351267,14.848687176035565,15.868341457782968],"torque_nm":[0.00033825632058010635,0.10822003711955192,0.11104040746565862,-0.27841288455066693,-0.29753140233343062],"angle_rad":[-0.1257272426222496,-4.030370714649127,-4.056531535321624,6.3780043974030596,6.3778743134322093]},"command":[-0.016131702721089505,-0.22943445710182073,-0.2335935008667101,0.36856679522399177,0.36856679522399177],"arm":{"servo_position":[1.5881867761018134e-23,0,-6.3527471044071171e-24,-4.2351647362714996e-24,-1.0926725019580475e-21,0],"servo_velocity":[0,0,4.3368086899420177e-19,0,0,0],"servo_effort":[-0.041415171147320642,0.42739651590280114,0.17627721644984581,-5.8297659279832649e-06,0.00049301825668451968,-0.00090964913360528569]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":10,"step":80,"t":0.40000000000000002,"sim_time":0.40000000000000024,"vehicle":{"origin_ned":[0.0039580613848583523,-1.027899029201778e-05,1.9923865707713719],"origin_quat_xyzw":[1.8813014374395596e-05,0.0072595993643631753,-3.1306550746940872e-05,0.99997364809430811],"cg_ned":[-0.050804325668836872,0.00025357087539140162,1.692892091892968],"linear_velocity_ned":[-0.0025756519963506001,3.871300231302671e-05,-0.030341444712195124],"angular_velocity_ned":[0.00034183336356214663,0.065579086684372248,-0.00054090501594443777]},"sensors":{"Odom":[0.0039580613848583523,-1.027899029201778e-05,1.9923865707713719,0.017555650926995868,-9.3473639422317711e-05,-0.033681461639702044,1.8813014374423338e-05,0.0072595993643738803,-3.1306550746987039e-05,0.99997364809430811,0.00034556254465274445,0.065579087899753058,-0.00053838221118915493],"Pressure":[12592.80335442385],"DVL":[0.027785552788144645,-0.061648870282375812,0.029520877448172955,8.9478233394916646,-0.01234270439821533,0.017224428421270328,0.01528350257394117,0],"IMU":[3.7174409523969925e-05,0.01451932743140719,-6.2344873038306577e-05,-0.023538487538635928,0.058916080574690263,-0.11048180731827342,0.095041926950943115,0.0012039874282757284,-9.8662935508998757],"FOG":[-0.004126306955235871],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-1.9557923644794881,-25.111040330416383,-25.663625830587478,40.514014444346117,40.514014444346117],"omega_rad_s":[-1.4486086772776583,-22.896214328911849,-23.258396112835261,36.672845909604369,36.671391171600746],"thrust_n":[-0.026755625372409133,-6.6155758328341641,-6.8305431473602036,17.144904713411268,18.32992817530263],"torque_nm":[0.00050166797573267133,0.12404204686564059,0.12807268401300381,-0.3214669633764613,-0.34368615328692431],"angle_rad":[-0.1792019260106931,-4.9206568918566749,-4.9597154219796877,7.8018134940586235,7.8016299535427951]},"command":[-0.018626593947423695,-0.23915276505158459,-0.24441548410083314,0.38584775661282017,0.38584775661282017],"arm":{"servo_position":[1.5881867761018134e-23,0,-1.0905549195899116e-21,-4.2351647362714996e-24,-5.4294811919000653e-21,0],"servo_velocity":[0,0,2.1684043449710089e-19,0,0,0],"servo_effort":[-0.046657354262676351,0.35331816161313273,0.16440615503760045,-7.0431406639844685e-06,0.00048410022210575805,-0.00093489861718058505]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":11,"step":88,"t":0.44,"sim_time":0.44000000000000028,"vehicle":{"origin_ned":[0.0046597794076951721,-1.4523669178652496e-05,1.9909818421187468],"origin_quat_xyzw":[2.6654255667644647e-05,0.0086218524595961781,-4.3562823747900377e-05,0.99996282983518725],"cg_ned":[-0.050918397156189552,0.00025534991441685434,1.6916376840175746],"linear_velocity_ned":[-0.0030730471141547765,4.9142151154866047e-05,-0.032121228391289162],"angular_velocity_ned":[0.00042811637703368469,0.070043890833142552,-0.000673260448949193]},"sensors":{"Odom":[0.0046597794076951721,-1.4523669178652496e-05,1.9909818421187468,0.018512346593201608,-0.00011675612158305433,-0.03570034762195827,2.6654255667706437e-05,0.0086218524596161656,-4.3562823748001364e-05,0.99996282983518725,0.0004335916016863476,0.070043892579634712,-0.00066956472811785484],"Pressure":[12563.245735088485],"DVL":[0.021876703749384614,0.0032502632685344861,-0.0013718402833470813,8.9258998381399497,0.0041011267010456834,-0.028099026020301072,-0.043923547391194584,0],"IMU":[5.2563160103093711e-05,0.017243920865447255,-8.6675677318735731e-05,0.046374214419598735,0.17756961518159486,0.024086003197789568,0.11299789026045244,-0.0016764160881610171,-9.8172670321228779],"FOG":[-0.0021132001475235446],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-2.2121717340176357,-26.007765162253456,-26.685877358767595,42.159601397832631,42.159601397832631],"omega_rad_s":[-1.7112202366367106,-24.228841232069477,-24.694110349982569,38.957918655088939,38.95619173503129],"thrust_n":[-0.037332786095089707,-7.4043764989323337,-7.6969235807777325,19.34317680135263,20.689293519461184],"torque_nm":[0.000699989739282932,0.1388320593549813,0.14431731713958251,-0.36268456502536184,-0.38792425348989718],"angle_rad":[-0.24313145299738734,-5.8673313428741292,-5.9231981904039293,9.321462375182378,9.3212145207297272]},"command":[-0.021068302228739389,-0.24769300154527102,-0.25415121294064374,0.40152001331269171,0.40152001331269171],"arm":{"servo_position":[8.3644503541362162e-23,-2.7105054312137611e-22,-6.3527471044071171e-24,-4.2351647362714996e-24,-5.4294811919000653e-21,0],"servo_velocity":[0,-5.4210108624275222e-20,0,0,0,0],"servo_effort":[-0.05130821611885282,0.27800311506631648,0.15184319155932272,-8.3448325121087094e-06,0.00047301568603869669,-0.00095559291757691799]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":12,"step":96,"t":0.47999999999999998,"sim_time":0.48000000000000032,"vehicle":{"origin_ned":[0.005391182948704637,-1.972777894062623e-05,1.9894989281370223],"origin_quat_xyzw":[3.6312196182547625e-05,0.010069024553061421,-5.8565115769294514e-05,0.99994930371299395],"cg_ned":[-0.051053194277437049,0.00025757226417755415,1.6903168984035235],"linear_velocity_ned":[-0.003606442839771253,6.072337687454128e-05,-0.033688899700170784],"angular_velocity_ned":[0.0005205218749814751,0.074121608642478423,-0.00081533124469236563]},"sensors":{"Odom":[0.005391182948704637,-1.972777894062623e-05,1.9894989281370223,0.019328081036448154,-0.00014154547814637742,-0.037491173976170224,3.6312196182556034e-05,0.010069024553063754,-5.856511576930808e-05,0.99994930371299395,0.00052820743753042069,0.074121611036602031,-0.00081015433792093862],"Pressure":[12531.797558157119],"DVL":[0.018852930998572697,-0.050111954495608971,0.0080664934987952318,8.9421252699216538,-0.0043148761810335454,-0.013746977870656225,-0.017528321035479303,0],"IMU":[7.1455812599297353e-05,0.02013839361148512,-0.00011641664281576875,-0.003670389695518664,0.085187616454544715,0.1046665310525715,0.12998371064028941,-0.013249086296239084,-9.8170729970895874],"FOG":[-0.0055844684616583587],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-2.4612684602627728,-26.794316348655293,-27.606119522335362,43.659497368264191,43.659497368264191],"omega_rad_s":[-1.9737450478787701,-25.399243197345026,-25.978942422287496,41.013132866154052,41.011136910118758],"thrust_n":[-0.049662281656053048,-8.1327557823420964,-8.5153354769004785,21.432464355066617,22.933548985014973],"torque_nm":[0.00093116778105099471,0.15248917091891437,0.159662540191884,-0.40185870665749918,-0.43000404346903087],"angle_rad":[-0.3175715125347891,-6.8635644734120742,-6.9406249730994594,10.927194566838832,10.926871563641097]},"command":[-0.023440652002502598,-0.25518396522528852,-0.26291542402224155,0.41580473684061131,0.41580473684061131],"arm":{"servo_position":[-5.1880768019325895e-23,0,-1.0905549195899116e-21,-4.2351647362714996e-24,-5.4294811919000653e-21,0],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.05534635166532581,0.20186758380553999,0.13869931637154803,-9.7411912958692738e-06,0.00046000186759811686,-0.00097186206620473656]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":13,"step":104,"t":0.52000000000000002,"sim_time":0.52000000000000035,"vehicle":{"origin_ned":[0.006146265362281654,-2.5939649692438896e-05,1.9879464539982332],"origin_quat_xyzw":[4.7897597218224451e-05,0.011593394249336362,-7.6482700136173759e-05,0.99993279027442439],"cg_ned":[-0.051210019586103502,0.00026028218675319963,1.6889379153489212],"linear_velocity_ned":[-0.0041697436999154399,7.3375153901272146e-05,-0.035058007559952177],"angular_velocity_ned":[0.00061757739025841707,0.07781471882146368,-0.00096518724836033582]},"sensors":{"Odom":[0.006146265362281654,-2.5939649692438896e-05,1.9879464539982332,0.020008448710744389,-0.00016741869452866168,-0.039067933306031456,4.789759721826498e-05,0.011593394249346172,-7.6482700136238472e-05,0.99993279027442439,0.00062797372612339859,0.077814721959116775,-0.00095820088992899333],"Pressure":[12500.366559080545],"DVL":[-0.028046133775936753,-0.022098040159157131,0.0058405738022676863,8.9207100767461061,0.002371935925790825,-0.030350592916620307,0.02472657918401254,0],"IMU":[9.40406474333437e-05,0.023187315174593104,-0.00015188535750950988,0.061763854835158866,0.13306511037500607,-0.099309975826948019,0.18998779140518252,0.022492096037132689,-9.8252421844290314],"FOG":[0.0016411285849249665],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-2.7018276616399226,-27.481853256497931,-28.434216209166951,45.03276948771618,45.03276948771618],"omega_rad_s":[-2.2333222324299564,-26.425098327159265,-27.129298160540639,42.867865967578787,42.865609182039876],"thrust_n":[-0.063579017560214959,-8.7982503958959377,-9.2824284807861694,23.408991947884832,25.057504355385035],"torque_nm":[0.0011921065792540307,0.16496719492304884,0.17404553401474071,-0.43891859902284064,-0.46982820666346942],"angle_rad":[-0.40245178203077975,-7.9032764310693597,-8.0063406670993214,12.610495272192765,12.610086528464773]},"command":[-0.025731692015618309,-0.26173193577617077,-0.27080205913492333,0.42888351893063031,0.42888351893063031],"arm":{"servo_position":[1.5881867761018134e-23,0,-1.0905549195899116e-21,-4.2351647362714996e-24,-5.4294811919000653e-21,0],"servo_velocity":[1.3552527156068805e-20,0,-4.3368086899420177e-19,0,0,0],"servo_effort":[-0.058777249865757754,0.1252072485307329,0.12505987979841668,-1.1188864430870316e-05,0.00044525294810448754,-0.0009838899858972891]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":14,"step":112,"t":0.56000000000000005,"sim_time":0.56000000000000039,"vehicle":{"origin_ned":[0.0069192977733498612,-3.3190227450854374e-05,1.9863325305659736],"origin_quat_xyzw":[6.1492017580168576e-05,0.0131873018385264,-9.7447259197440763e-05,0.99991303711521984],"cg_ned":[-0.051389939029854115,0.00026352069435940829,1.6875083742511372],"linear_velocity_ned":[-0.0047571795097908791,8.7016605697210969e-05,-0.036241992182841257],"angular_velocity_ned":[0.00071780889798447227,0.081126832275155575,-0.0011210085600494133]},"sensors":{"Odom":[0.0069192977733498612,-3.3190227450854374e-05,1.9863325305659736,0.020558948747448885,-0.00019395160016713733,-0.040444505572703626,6.1492017580175881e-05,0.013187301838527968,-9.7447259197452351e-05,0.99991303711521984,0.00073144459592152527,0.081126836196865212,-0.0011118733277927181],"Pressure":[12467.157431923051],"DVL":[0.0017630181111587852,0.0085034217855974939,0.0026008697240875959,8.9961096591743139,0.029374906802569285,-0.00065343538493294626,0.012539047109315877,0],"IMU":[0.00012044509959496872,0.026375379995942368,-0.00019332298311597608,-0.046391277444615471,0.14429534578083283,-0.062193104941556075,0.21878881846898143,0.013825363987276896,-9.8185043660234079],"FOG":[-0.003851960901679225],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-2.9328642648275052,-28.079494351262589,-29.178190215344955,46.295247844380611,46.295247844380611],"omega_rad_s":[-2.4876663993500863,-27.321691599695164,-28.159210725028956,44.547705738905357,44.545200422148525],"thrust_n":[-0.078879178817830631,-9.4003061850650482,-9.9965675118883741,25.273660225116139,27.060987553641144],"torque_nm":[0.0014789846028343242,0.17625574096996965,0.18743564084790706,-0.47388112922092768,-0.50739351663077148],"angle_rad":[-0.49760097839676437,-8.9810397332866057,-9.1152919200254754,14.363937867624125,14.363433214923948]},"command":[-0.027932040617404813,-0.26742375572631039,-0.27788752586042814,0.4409071223274344,0.4409071223274344],"arm":{"servo_position":[1.5881867761018134e-23,0,1.0778494253810973e-21,-4.2351647362714996e-24,-5.4294811919000653e-21,0],"servo_velocity":[0,1.0842021724855044e-19,0,0,0,0],"servo_effort":[-0.061622997727369649,0.048206458807378859,0.11097674121524891,-1.2694371398721543e-05,0.00042888316655988765,-0.00099181465201508617]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":15,"step":120,"t":0.59999999999999998,"sim_time":0.60000000000000042,"vehicle":{"origin_ned":[0.0077048358226633404,-4.1493384263698745e-05,1.984664768579705],"origin_quat_xyzw":[7.7148145523485569e-05,0.014843173767886795,-0.00012155550469111827,0.99988982366304691],"cg_ned":[-0.05159379105787356,0.0002673255088928331,1.6860353845395688],"linear_velocity_ned":[-0.0053631305944652988,0.00010156450021247717,-0.037253924881469419],"angular_velocity_ned":[0.0008197793384411182,0.084062870864654984,-0.0012811119442144526]},"sensors":{"Odom":[0.0077048358226633404,-4.1493384263698745e-05,1.984664768579705,0.02098525504728915,-0.00022073432849303029,-0.041634396529695958,7.7148145523520982e-05,0.014843173767893609,-0.00012155550469117406,0.99988982366304691,0.00083720362217684435,0.084062875506636811,-0.0012694863668833416],"Pressure":[12431.20102172312],"DVL":[0.0093075036487784563,-0.011984634936705945,-0.01300059465894025,9.0154154251101382,-0.001695939633736761,0.0060364321216224096,-0.021917242269357949,0],"IMU":[0.00015073717371298301,0.029687456181590938,-0.00024090013024361342,0.060698797304968341,0.033913760891346019,-0.086537591516388179,0.25953617040941818,-0.0047313020131839337,-9.8250163074065728],"FOG":[-0.009122553534640419],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.1535868693876292,-28.594757202923159,-29.84465699154967,47.460198229712546,47.460198229712546],"omega_rad_s":[-2.7349477761095478,-28.102085991238354,-29.08057320417765,46.074739883672329,46.072001560567649],"thrust_n":[-0.095333140949891121,-9.9395499463563759,-10.657197966494666,27.030232877039854,28.94696453546366],"torque_nm":[0.0017874963928104588,0.18636656149418213,0.19982246187177502,-0.50681686644449742,-0.54275558503994359],"angle_rad":[-0.60276701809860334,-10.091986939656525,-10.262937106671588,16.181038531563008,16.180428368636246]},"command":[-0.030034160660834565,-0.27233102098022055,-0.28423482849094922,0.45200188790202428,0.45200188790202428],"arm":{"servo_position":[1.5881867761018134e-23,0,-1.0905549195899116e-21,-4.2351647362714996e-24,-5.4294811919000653e-21,0],"servo_velocity":[0,0,-4.3368086899420177e-19,-6.7762635780344027e-21,0,0],"servo_effort":[-0.063915977324540241,-0.028914141679632153,0.096517219049592984,-1.4221110764225833e-05,0.00041105394219157518,-0.00099576158405040608]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":16,"step":128,"t":0.64000000000000001,"sim_time":0.64000000000000046,"vehicle":{"origin_ned":[0.0084977282728898595,-5.0846609987336366e-05,1.9829503003942277],"origin_quat_xyzw":[9.4890646211987615e-05,0.016553547435009003,-0.00014887226475730414,0.99986296506077821],"cg_ned":[-0.051822193934814964,0.00027173099149481862,1.6845255452887498],"linear_velocity_ned":[-0.0059821918294572221,0.00011693420892923442,-0.038106296547825644],"angular_velocity_ned":[0.00092210321729291886,0.086628886517329182,-0.001443971336405185]},"sensors":{"Odom":[0.0084977282728898595,-5.0846609987336366e-05,1.9829503003942277,0.021293131356000822,-0.00024737569400906103,-0.042650513203130153,9.4890646211982492e-05,0.016553547435008108,-0.00014887226475729612,0.99986296506077821,0.00094387941968114325,0.086628891643522832,-0.0014295212666776374],"Pressure":[12394.444997580937],"DVL":[0.0085321576718642121,-0.0174663925770349,-0.021147046173046986,8.945491488377904,-0.032990002018071209,-0.041169337113099877,-0.018330937210681259,0],"IMU":[0.00018492790665163651,0.033108634809525028,-0.00029472369935632805,-0.028497558006230096,0.10677775626579747,-0.14225103308162002,0.29180928020236274,-0.0011255616218217844,-9.810988317624421],"FOG":[-0.0014499260664036008],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.3633774889126404,-29.034010125401775,-30.439257641072725,48.538845982651551,48.538845982651551],"omega_rad_s":[-2.9737090046531578,-28.777418516552878,-29.903468905402413,47.467946170024447,47.464992838942237],"thrust_n":[-0.11269670050100736,-10.417339612491846,-11.264465914545717,28.684112984469298,30.720260153595326],"torque_nm":[0.002113063134393888,0.19532511773422209,0.21120873589773223,-0.53782711845879938,-0.5760048778799125],"angle_rad":[-0.7176333214978281,-11.231728480312363,-11.445168260316704,18.056125032360566,18.055400436886313]},"command":[-0.032032166561072765,-0.27651438214668356,-0.28989769181974023,0.4622747236443005,0.4622747236443005],"arm":{"servo_position":[1.5881867761018134e-23,-1.0842021724855045e-21,-3.2589592645609207e-21,-4.2351647362714996e-24,-5.4294811919000653e-21,0],"servo_velocity":[0,-2.1684043449710089e-19,-4.3368086899420177e-19,0,0,0],"servo_effort":[-0.065695466837476665,-0.10600922949936115,0.081732942917686818,-1.5760228318789214e-05,0.00039190045843342348,-0.00099591351164507328]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":17,"step":136,"t":0.68000000000000005,"sim_time":0.68000000000000049,"vehicle":{"origin_ned":[0.009293120986530963,-6.1231856914440688e-05,1.9811958074862672],"origin_quat_xyzw":[0.00011471725876996049,0.018311092542031275,-0.0001794337373352553,0.99983231520760596],"cg_ned":[-0.052075555494977034,0.00027676808857798923,1.6829849712744323],"linear_velocity_ned":[-0.0066092195172769352,0.00013303980661657716,-0.038810906339364383],"angular_velocity_ned":[0.0010234547661867161,0.088831954204821664,-0.0016082181931502901]},"sensors":{"Odom":[0.009293120986530963,-6.1231856914440688e-05,1.9811958074862672,0.021488379741568593,-0.00027350559947972406,-0.043505045727360893,0.00011471725876997651,0.018311092542033832,-0.00017943373733528034,0.99983231520760596,0.0010501546810132701,0.088831959318499895,-0.0015906263059163651],"Pressure":[12357.328353037745],"DVL":[0.014515930723449855,-0.030156156740857941,0.061786226478875154,8.9005153714086145,-0.033875499302994168,0.048533354598948135,-0.014830000209594629,0],"IMU":[0.00022297431633927969,0.036624272303641951,-0.00035484406500498793,-0.0059912306344002738,0.078203386326444593,-0.1414623826216064,0.32617064966306819,0.0075849378228714359,-9.8301051984017231],"FOG":[-0.011915112742381596],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5617482061562513,-29.402684771558985,-30.966854195732985,49.540738484861713,49.540738484861713],"omega_rad_s":[-3.202792138065659,-29.357182086450965,-30.636471300219089,48.743590901422088,48.740442392814323],"thrust_n":[-0.13071967861652434,-10.835466099320611,-11.818970845821912,30.241522453302348,32.38669377460797],"torque_nm":[0.0024509939740598313,0.20316498936226143,0.22160570335916085,-0.5670285459994191,-0.60725050827389937],"angle_rad":[-0.84183200780392298,-12.396282097666157,-12.658245614414467,19.984221444012015,19.983374256756655]},"command":[-0.033921411487202395,-0.2800255692529427,-0.2949224209117427,0.47181655699868297,0.47181655699868297],"arm":{"servo_position":[1.5881867761018134e-23,-1.0842021724855045e-21,-3.2589592645609207e-21,2.9646153153900515e-23,-5.4294811919000653e-21,0],"servo_velocity":[0,-2.1684043449710089e-19,0,0,0,0],"servo_effort":[-0.06700132018964304,-0.18294753190851473,0.066672118057039279,-1.7322710997181267e-05,0.00037155005058790735,-0.00099248510981093723]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":18,"step":144,"t":0.71999999999999997,"sim_time":0.72000000000000053,"vehicle":{"origin_ned":[0.010086458461024267,-7.2616463592420214e-05,1.9794075498554271],"origin_quat_xyzw":[0.00013660002123857341,0.020108630639738091,-0.00021325078173796489,0.99979776897047168],"cg_ned":[-0.052354084121422111,0.00028246428869593316,1.6814193217475266],"linear_velocity_ned":[-0.0072393523265291112,0.00014979454567687412,-0.039378820017075031],"angular_velocity_ned":[0.001122578669046933,0.090680070246220143,-0.0017726441682200621]},"sensors":{"Odom":[0.010086458461024267,-7.2616463592420214e-05,1.9794075498554271,0.021576811863730963,-0.00029877816702560806,-0.044209420743818013,0.00013660002123860903,0.020108630639743337,-0.00021325078173802051,0.99979776897047168,0.0011547780982765093,0.090680074480737907,-0.001751619189869557],"Pressure":[12318.24536476088],"DVL":[0.0034211664469530334,-0.037991434271372151,-0.0052600226737973248,8.9056006947990003,0.012179875672047542,0.012005467301783441,-0.017673412975798209,0],"IMU":[0.00026478256762579009,0.04022002914443059,-0.00042126232705973687,-0.035815328454953305,0.12085526141544452,-0.14362701401815331,0.38202514015152567,-0.022541451134607773,-9.8348303622351327],"FOG":[-0.0033835797160386232],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.7482976759320983,-29.705462518605046,-31.431699983987329,50.474042520242897,50.474042520242897],"omega_rad_s":[-3.4212746335467821,-29.849483805060295,-31.286908236235288,49.915606488913554,49.912283926526484],"thrust_n":[-0.14915208831598306,-11.195963280158908,-12.321610269112826,31.708967967249745,33.952511768359628],"torque_nm":[0.0027966016559246819,0.20992431150297949,0.23103019254586549,-0.59454314938593289,-0.63660959565674313],"angle_rad":[-0.97495438813615476,-13.582013046350653,-13.898743325577327,21.960948373823449,21.95997125948325]},"command":[-0.03569807310411522,-0.28290916684385758,-0.29934952365702217,0.48070516685945613,0.48070516685945613],"arm":{"servo_position":[1.5881867761018134e-23,0,-1.0905549195899118e-21,-4.2351647362714996e-24,-5.4294811919000653e-21,0],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.067876053683536663,-0.2596133556387773,0.051379592192002443,-1.8866561345748447e-05,0.00035012933765475758,-0.00098555403261317716]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":19,"step":152,"t":0.76000000000000001,"sim_time":0.76000000000000056,"vehicle":{"origin_ned":[0.010873483508375775,-8.4954187937676692e-05,1.9775913953391886],"origin_quat_xyzw":[0.00016048670403631869,0.021939152800651032,-0.00025031202450806012,0.9997592636041428],"cg_ned":[-0.052657800322548687,0.00028884358904263026,1.6798338298916697],"linear_velocity_ned":[-0.0078680223418610088,0.00016711065755628296,-0.039820368200226774],"angular_velocity_ned":[0.0012182926568107967,0.092182074589360785,-0.0019361844935997052]},"sensors":{"Odom":[0.010873483508375775,-8.4954187937676692e-05,1.9775913953391886,0.021564233226441642,-0.00032287208686963359,-0.044774297526695331,0.0001604867040363202,0.02193915280065124,-0.0002503120245080625,0.9997592636041428,0.0012565675913410288,0.092182076579698694,-0.0019114702017892944],"Pressure":[12279.975874296591],"DVL":[0.018134091868380581,-0.035622215810219668,-0.02554026226945252,8.8256042062626499,-0.0088813597855212888,-0.0016782436229005999,-0.0013329687846417582,0],"IMU":[0.00031021150261025031,0.043881904807498422,-0.00049393715772116779,0.082943565041648917,-0.01207568677961833,-0.032184045876428563,0.39941261750981405,-0.0013243168721282397,-9.7938599669913806],"FOG":[-0.014635997881104675],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.9227014670163425,-29.946417254421533,-31.837562528294526,51.345780305176646,51.345780305176646],"omega_rad_s":[-3.6284210946212259,-30.26127155340426,-31.861086882698537,50.995932852686025,50.992458205405136],"thrust_n":[-0.1677488947248473,-11.500989756054759,-12.773483589110414,33.092904685016009,35.424025399804584],"torque_nm":[0.0031452917760908866,0.21564355792602677,0.23950281729582032,-0.62049196284405028,-0.66420047624633594],"angle_rad":[-1.116559252351871,-14.785583904427879,-15.163504880509883,23.982437490944889,23.981323979518486]},"command":[-0.037359061590631834,-0.28520397385163365,-0.30321488122185264,0.48900743147787279,0.48900743147787279],"arm":{"servo_position":[1.5881867761018134e-23,-1.0842021724855045e-21,1.0778494253810972e-21,1.2705494208814508e-23,-5.4294811919000653e-21,0],"servo_velocity":[0,0,0,3.3881317890172014e-21,0,0],"servo_effort":[-0.06835844426658913,-0.33589081778213764,0.035899548720023544,-2.038663529999774e-05,0.0003277563593102768,-0.00097535555777192664]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":20,"step":160,"t":0.80000000000000004,"sim_time":0.8000000000000006,"vehicle":{"origin_ned":[0.011650235770993674,-9.8186285523765924e-05,1.9757528477198023],"origin_quat_xyzw":[0.00018630232572450944,0.023795835931886711,-0.00029058673392952079,0.99971677941459802],"cg_ned":[-0.052986548516199126,0.00029592645836639964,1.678233331850048],"linear_velocity_ned":[-0.0084909561074641531,0.00018489961770461969,-0.040145166472140566],"angular_velocity_ned":[0.0013094963137745793,0.09334757404990543,-0.0020979087024727539]},"sensors":{"Odom":[0.011650235770993674,-9.8186285523765924e-05,1.9757528477198023,0.021456434167991759,-0.00034549286776076931,-0.045209587218782835,0.00018630232572453955,0.023795835931890556,-0.00029058673392956774,0.99971677941459802,0.0013544199339308889,0.093347571788762629,-0.0020692922236013878],"Pressure":[12243.988035736393],"DVL":[0.031891197118381211,-0.028461430026433161,-0.0099116378341037158,8.7779835777263795,-0.025137199628555477,0.0012262808303435413,0.0056066670258270957,0],"IMU":[0.00035907627115703015,0.047596269965111612,-0.0005727911391584002,0.029502017550074856,0.09278658971008405,-0.1616451656028822,0.42158384392488363,-0.011038964611087125,-9.7847167173927669],"FOG":[-0.0011134406632544453],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-4.0846902412336759,-30.129132525599619,-32.187823765055796,52.162018239887651,52.162018239887651],"omega_rad_s":[-3.8236425161967622,-30.598530045374307,-32.364481727057147,51.994817217663467,51.991212928869786],"thrust_n":[-0.18627328404303867,-11.752759351350699,-13.175834032816427,34.399533651722784,36.8073883073302],"torque_nm":[0.0034926240758069754,0.22036423783782558,0.24704688811530801,-0.64499125596980211,-0.69013853076244125],"angle_rad":[-1.2661793961253536,-16.003912752607356,-16.449606637511302,26.045258768737629,26.044003280758645]},"command":[-0.0389018118212731,-0.28694411929142494,-0.30655070252434091,0.49678112609416814,0.49678112609416814],"arm":{"servo_position":[1.5881867761018134e-23,-1.0842021724855045e-21,1.0778494253810972e-21,1.2705494208814508e-23,-5.4294811919000653e-21,0],"servo_velocity":[0,-4.3368086899420177e-19,8.6736173798840355e-19,3.3881317890172014e-21,0,0],"servo_effort":[-0.068486329082538946,-0.41166700412530921,0.020275227185518576,-2.1877371666708898e-05,0.00030455031650316244,-0.00096202318180816542]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":21,"step":168,"t":0.83999999999999997,"sim_time":0.84000000000000064,"vehicle":{"origin_ned":[0.012413049048204068,-0.00011224262770562725,1.9738970730130601],"origin_quat_xyzw":[0.00021395075715771388,0.025672057228847411,-0.00033402749726148116,0.99967033972622354],"cg_ned":[-0.053340008747791094,0.00030372981123310123,1.6766222945863938],"linear_velocity_ned":[-0.0091041716399313018,0.00020307233512067258,-0.040362148929327255],"angular_velocity_ned":[0.0013951696306172372,0.094186855349794416,-0.0022570143627276694]},"sensors":{"Odom":[0.012413049048204068,-0.00011224262770562725,1.9738970730130601,0.021259178784207858,-0.00036637237009758404,-0.045524486081236916,0.00021395075715774194,0.025672057228850773,-0.0003340274972615249,0.99967033972622354,0.0014473102543821549,0.094186846025291718,-0.0022243339790616913],"Pressure":[12202.848898684375],"DVL":[0.015249471089361675,-0.053434303628478952,0.029584399522317218,8.7600620170315437,-0.033288404552793874,0.016702366740704487,0.013163504374475294,0],"IMU":[0.00041115206389139643,0.051349894966140258,-0.00065771664547884044,0.082879898420866141,0.08771382522397761,0.078243772258868083,0.48460711913407217,0.0021694585606110203,-9.7717071970730469],"FOG":[-0.014629834666317261],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-4.2340397404868568,-30.256787901929556,-32.485552126091399,52.928019548689257,52.928019548689257],"omega_rad_s":[-4.006465780476919,-30.866445660742876,-32.801889106200093,52.921072388586595,52.917361071030257],"thrust_n":[-0.20449913938813025,-11.953501466144782,-13.530013809493809,35.634688314693008,38.108466808510968],"torque_nm":[0.0038343588635274422,0.2241281524902147,0.25368775892800893,-0.6681504059004939,-0.71453375265958075],"angle_rad":[-1.4233267689770683,-17.234138483896874,-17.754328123484886,28.146358766824918,28.144956625280003]},"command":[-0.040324188004636732,-0.28815988478028148,-0.30938621072467998,0.50407637665418337,0.50407637665418337],"arm":{"servo_position":[1.5881867761018134e-23,1.0842021724855045e-21,1.0778494253810972e-21,-4.2351647362714996e-24,-5.4294811919000653e-21,0],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.068297326396768804,-0.48682839019441421,0.0045485545855371377,-2.3332282443128686e-05,0.00028062166381067342,-0.00094576332823311134]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":22,"step":176,"t":0.88,"sim_time":0.88000000000000067,"vehicle":{"origin_ned":[0.013158547766752099,-0.00012704285272235037,1.9720289236032305],"origin_quat_xyzw":[0.00024331638888063306,0.027561407139567312,-0.00038057262658022111,0.9996200102029259],"cg_ned":[-0.053717708230048358,0.00031226697814036217,1.6750048422193469],"linear_velocity_ned":[-0.0097039729645942013,0.00022153887525166592,-0.040479610286718204],"angular_velocity_ned":[0.001474381910582697,0.094710807463286917,-0.0024128049191499863]},"sensors":{"Odom":[0.013158547766752099,-0.00012704285272235037,1.9720289236032305,0.020978196650977703,-0.00038527088851533667,-0.045727518670197025,0.00024331638888065293,0.027561407139569564,-0.00038057262658025223,0.9996200102029259,0.001534301015732211,0.094710787293787443,-0.002375956760551958],"Pressure":[12163.25020145605],"DVL":[-0.0024390484638013785,-0.0042243585744528092,-0.0015130422038424939,8.833228181301358,-0.019750130518501545,-0.0016179569264213149,-0.0118474663407106,0],"IMU":[0.00046617789605055864,0.055129975347035134,-0.00074858110992014775,0.019331396788448016,0.06228734120885026,0.31146665325690598,0.50839085279290963,-0.0065925180998819728,-9.7665863334258152],"FOG":[-0.0027911730424377661],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-4.3705603692356414,-30.332230896317689,-32.733563860999723,53.648368576493013,53.648368576493013],"omega_rad_s":[-4.1765084580230774,-31.069543471554251,-33.177554004896088,53.782296545095313,53.778500730355958],"thrust_n":[-0.22221269071872018,-12.105439959978515,-13.83746388030114,36.803778848503086,39.332771533573315],"torque_nm":[0.0041664879509760028,0.22697699924959719,0.25945244775564641,-0.69007085340943308,-0.73748946625449974],"angle_rad":[-1.5874965155269283,-18.473592053661143,-19.075127866264136,30.283008356437939,30.281455787741486]},"command":[-0.041624384468910869,-0.2888783894887399,-0.31174822724761642,0.51093684358564773,0.51093684358564773],"arm":{"servo_position":[1.5881867761018134e-23,-1.0842021724855045e-21,5.414658115323115e-21,-2.1175823681357487e-24,-5.4294811919000653e-21,0],"servo_velocity":[0,-4.3368086899420177e-19,0,-4.2351647362715017e-22,0,0],"servo_effort":[-0.067823667137862517,-0.56126057889480596,-0.011238177631082676,-2.4718115928479276e-05,0.00025608171533767545,-0.00092678906599370629]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":23,"step":184,"t":0.92000000000000004,"sim_time":0.92000000000000071,"vehicle":{"origin_ned":[0.013883642665750977,-0.00014249755424689578,1.9701529600792465],"origin_quat_xyzw":[0.0002742658938489341,0.029457700842098113,-0.00043014827215417576,0.99956589758343639],"cg_ned":[-0.054119032637030252,0.00032154768359116327,1.6733847806109976],"linear_velocity_ned":[-0.010286943274807805,0.00024020887551066958,-0.0405052503412743],"angular_velocity_ned":[0.0015462877768193219,0.094930853394792417,-0.0025646835736898434]},"sensors":{"Odom":[0.013883642665750977,-0.00014249755424689578,1.9701529600792465,0.020619176557060075,-0.00040197573509439405,-0.045826584576786566,0.00027426589384894,0.029457700842098748,-0.00043014827215418503,0.99956589758343639,0.0016145386849105892,0.094930817453004704,-0.0025236276517542175],"Pressure":[12124.873730752048],"DVL":[0.0025692986490022142,-0.044256076035734171,0.0069448629537084937,8.9132760963861308,-0.0004646062511030895,-0.025494595084413488,-0.03488643419648009,0],"IMU":[0.00052386050780235942,0.058924154390613125,-0.00084523162390507734,0.059203020568819431,0.13038579470428227,0.12956950542277673,0.562601856031272,-0.019241691574556269,-9.7745363341335629],"FOG":[-0.0014561644438542166],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-4.4940979464135546,-30.358035622875164,-32.934467200636242,54.327073388049676,54.327073388049676],"omega_rad_s":[-4.3334620096444851,-31.211801727985112,-33.495271727438997,54.585059107365502,54.581201040522338],"thrust_n":[-0.23921398526282522,-12.210784209239435,-14.099700788414456,37.911773765240085,40.485428833603549],"torque_nm":[0.0044852622236779731,0.22895220392323942,0.26436938978277108,-0.71084575809825146,-0.75910179063006655],"angle_rad":[-1.758170209185099,-19.719772694486288,-20.40962370875409,32.452758452922161,32.451052578915224]},"command":[-0.042800932822986235,-0.28912414878928727,-0.31366159238701186,0.51740069893380647,0.51740069893380647],"arm":{"servo_position":[1.5881867761018134e-23,3.2526065174565132e-21,1.0778494253810972e-21,2.2040519077917891e-39,3.2441361879839704e-21,0],"servo_velocity":[0,4.3368086899420177e-19,0,0,0,0],"servo_effort":[-0.067096847224569184,-0.63484804201921263,-0.027043557342830687,-2.6043240964347591e-05,0.00043883824557727113,-0.00090525227315035341]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":24,"step":192,"t":0.95999999999999996,"sim_time":0.96000000000000074,"vehicle":{"origin_ned":[0.014585525760762892,-0.00015850944511161622,1.9682734708188439],"origin_quat_xyzw":[0.00030664996266008081,0.031354988321022452,-0.00048267033080258068,0.99950814789202225],"cg_ned":[-0.054543237142418689,0.00033157803049031905,1.6717656201892879],"linear_velocity_ned":[-0.010849939169474817,0.00025899169501580476,-0.040446216373146042],"angular_velocity_ned":[0.0016101331801937353,0.094858885276974586,-0.0027121415824279196]},"sensors":{"Odom":[0.014585525760762892,-0.00015850944511161622,1.9682734708188439,0.020187758164440225,-0.0004163026941933827,-0.045829003971131321,0.00030664996266009518,0.031354988321023923,-0.00048267033080260329,0.99950814789202225,0.0016872599950917863,0.094858827317416378,-0.0026669065384583184],"Pressure":[12085.640759343571],"DVL":[0.039449225240372664,-0.022202538333246247,0.0089181181758119146,8.7712408912982944,0.035293894108412903,-0.01663329581735605,-0.024787273035566392,0],"IMU":[0.00058387813327625182,0.06272054291559212,-0.00094749904276342949,0.011714859732725626,0.020455052735397633,0.15857116478833275,0.59143649835793433,0.0064553326075069001,-9.7592421647695815],"FOG":[-0.0010200898306545515],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-4.6045186173363195,-30.336547428487762,-33.090699639314501,54.967650804810063,54.967650804810063],"omega_rad_s":[-4.4770753361896798,-31.296745507733725,-33.758470769268193,55.335057213287683,55.331158684877906],"thrust_n":[-0.25531761545073184,-12.271726010957815,-14.318308496795451,38.963204682593997,41.571177209325263],"torque_nm":[0.0047872052897012232,0.23009486270545909,0.26846828431491465,-0.73056008779863735,-0.77945957267484867],"angle_rad":[-1.9348184232148451,-20.970328224652846,-21.755576758235119,34.65340250147991,34.651541324078487]},"command":[-0.043852558260345897,-0.28891949931893107,-0.31514952037442379,0.52350143623628631,0.52350143623628631],"arm":{"servo_position":[1.5881867761018134e-23,1.0842021724855043e-21,1.0778494253810972e-21,2.2040519077917891e-39,3.2441361879839704e-21,0],"servo_velocity":[0,4.3368086899420177e-19,-8.6736173798840355e-19,0,0,0],"servo_effort":[-0.066145323880770074,-0.7074732967195817,-0.042826586665082593,-2.730673779587737e-05,0.000409744653919986,-0.00088130879995978486]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":25,"step":200,"t":1,"sim_time":1.0000000000000007,"vehicle":{"origin_ned":[0.01526166465400243,-0.00017497454820578502,1.966394489465906],"origin_quat_xyzw":[0.00034030510144608992,0.033247563059374527,-0.00053804608196131028,0.99944694418936741],"cg_ned":[-0.05498945714993371,0.00034236048377181747,1.6701505970715307],"linear_velocity_ned":[-0.011390081746180654,0.00027779623568143842,-0.040309146545448732],"angular_velocity_ned":[0.001665253072996514,0.094507186921082689,-0.002854742703316448]},"sensors":{"Odom":[0.01526166465400243,-0.00017497454820578502,1.966394489465906,0.0196895215557082,-0.00042809503926134751,-0.045741563798122581,0.00034030510144609409,0.033247563059374936,-0.00053804608196131689,0.99944694418936741,0.0017517894725701134,0.094507099213412757,-0.0028054296187359456],"Pressure":[12048.399959757135],"DVL":[0.0042769508862382719,0.004432126545763776,0.0082597024942214076,8.8905691632458783,0.032123932686312612,0.0099529866277170004,0.0024451966833003696,0],"IMU":[0.00064588432701898687,0.066507736338748583,-0.0010552014547595813,-0.029190141042898132,0.12118961989263752,0.031829999547458382,0.6484802753677481,-0.0038026861805250641,-9.7825419071681612],"FOG":[0.0050522803843547027],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-4.7017117062520084,-30.26992142288087,-33.204557600341701,55.573196425257102,55.573196425257102],"omega_rad_s":[-4.6071445044355608,-31.327523885132855,-33.970279633201848,56.037246868351922,56.0333290770592],"thrust_n":[-0.27035349614656407,-12.29044012179873,-14.494932328185063,39.96218465791366,42.594378420590665],"torque_nm":[0.0050691280527480759,0.23044575228372624,0.27177998115346996,-0.74929096233588133,-0.79864459538607491],"angle_rad":[-2.1169027895752013,-22.223038716925952,-23.110878274742642,36.882944633821616,36.880927013653512]},"command":[-0.044778206726209607,-0.28828496593219877,-0.31623388190801621,0.52926853738340096,0.52926853738340096],"arm":{"servo_position":[1.5881867761018134e-23,1.0842021724855043e-21,1.0778494253810972e-21,2.2040519077917891e-39,3.2441361879839704e-21,0],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.064994797617802469,-0.77902046261620839,-0.058547123198003669,-2.8513788305487828e-05,0.00037890892717655532,-0.00085521731036842109]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":26,"step":208,"t":1.04,"sim_time":1.0399999999999998,"vehicle":{"origin_ned":[0.015909796197244544,-0.0001917833779362003,1.9645198104197128],"origin_quat_xyzw":[0.00037505545143985507,0.035129969385026022,-0.00059617566613118472,0.99938250392879624],"cg_ned":[-0.055456718739287383,0.00035389387744222899,1.6685426925315832],"linear_velocity_ned":[-0.011904750486674205,0.00029653197297950377,-0.040100210049710816],"angular_velocity_ned":[0.0017110754427916816,0.093888380370964628,-0.0029921225320228362]},"sensors":{"Odom":[0.015909796197244544,-0.0001917833779362003,1.9645198104197128,0.019129979765405251,-0.00043722421962280958,-0.045570562418490883,0.00037505545143987957,0.035129969385028312,-0.00059617566613122364,0.99938250392879624,0.0018075440493392262,0.093888253542887115,-0.002938907327009107],"Pressure":[12009.939863491172],"DVL":[0.020914438185438807,0.0090271058853430217,0.010584529884603998,8.8258401725823568,0.0023560947358068651,-0.010512502829347497,0.012682655295925126,0],"IMU":[0.00070951176525911716,0.070274829095497218,-0.0011681472427795463,0.06508879033179811,0.079990098763011552,-0.027534154751976875,0.68033811761846597,-0.0033659902927975689,-9.7708917577247583],"FOG":[-0.0020559831013095674],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-4.7855842990706874,-30.160150873287566,-33.278219867709787,56.146443710858343,56.146443710858343],"omega_rad_s":[-4.7235034836751195,-31.306972981033276,-34.133580189955772,56.695952993045118,56.69203643390658],"thrust_n":[-0.28416729937545682,-12.269085961940997,-14.631273250449999,40.912434019927105,43.559037543074325],"torque_nm":[0.0053281368632898162,0.23004536178639373,0.27433637344593748,-0.76710813787363308,-0.81673195393264364],"angle_rad":[-2.303877664846564,-23.475802931469058,-24.473538912289015,39.139572580720952,39.137398210860589]},"command":[-0.045576993324482735,-0.28723953212654824,-0.31693542731152174,0.53472803534150803,0.53472803534150803],"arm":{"servo_position":[1.5881867761018134e-23,-1.0842021724855046e-21,9.7514668052651321e-21,0,1.1917753567868006e-20,0],"servo_velocity":[0,0,0,0,1.7347234759768071e-18,0],"servo_effort":[-0.063671451103191612,-0.84937627960706319,-0.074167354944846289,-2.962587615947557e-05,0.00034648933286185631,-0.00082711064227672772]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":27,"step":216,"t":1.0800000000000001,"sim_time":1.079999999999999,"vehicle":{"origin_ned":[0.016527919559530056,-0.0002088221135594463,1.962653002473038],"origin_quat_xyzw":[0.00041071461026942621,0.036997008617362361,-0.00065695337612629693,0.9993150759791114],"cg_ned":[-0.055943948870435641,0.00036617342687917065,1.6669446508871972],"linear_velocity_ned":[-0.012391577346960383,0.00031510859848502806,-0.039825144325826921],"angular_velocity_ned":[0.0017471178963455801,0.093015366039260527,-0.0031239744312668094]},"sensors":{"Odom":[0.016527919559530056,-0.0002088221135594463,1.962653002473038,0.018514567993362239,-0.00044358877997053924,-0.045321851240150909,0.0004107146102694461,0.036997008617364151,-0.0006569533761263287,0.9993150759791114,0.0018540292986498378,0.093015188935233459,-0.0030671092760349585],"Pressure":[11971.732776312538],"DVL":[0.023739945485962036,-0.029440195181086287,-0.021863908994025533,8.6968905927482574,-0.015841118458151175,-0.0073517472642879601,-0.025401721465077989,0],"IMU":[0.00077437599002830445,0.074011426716543052,-0.0012861376805425153,0.026445900506231249,0.1082870852642869,0.015557660966114556,0.73729396896765576,-0.0069051846947470819,-9.7853441083295376],"FOG":[-0.0045231726484086477],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-4.8560599517591445,-30.009091174186842,-33.313766740834737,56.689814704483361,56.689814704483361],"omega_rad_s":[-4.8260177746981503,-31.237666980771085,-34.251051456127577,57.314962012598983,57.311066386319091],"thrust_n":[-0.29662086719696146,-12.209809177352746,-14.729082912844721,41.817310270000569,44.468827807145843],"torque_nm":[0.005561641259943028,0.22893392207536398,0.27617030461583852,-0.7840745675625107,-0.83379052138398468],"angle_rad":[-2.4951914991179831,-24.726626985199257,-25.841679880192633,41.421634579347838,41.419303955066731]},"command":[-0.04624819001675376,-0.28580086832558899,-0.31727396896033083,0.53990299718555579,0.53990299718555579],"arm":{"servo_position":[1.5881867761018134e-23,-1.0842021724855046e-21,9.7514668052651321e-21,0,3.2441361879839704e-21,0],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.062196923278765956,-0.91842217313804642,-0.08964754122530387,-3.0683663744352914e-05,0.00031272482842200467,-0.00079719990825750789]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":28,"step":224,"t":1.1200000000000001,"sim_time":1.1199999999999981,"vehicle":{"origin_ned":[0.017114288835838612,-0.00022597374309646996,1.9607974208821042],"origin_quat_xyzw":[0.00044708743483665722,0.038843744134504234,-0.00072026874394299882,0.99924493737390285],"cg_ned":[-0.056449985290701693,0.00037919075174136106,1.6653589960295023],"linear_velocity_ned":[-0.012848438293782729,0.00033343651448535086,-0.039489288470565154],"angular_velocity_ned":[0.0017729903517356778,0.091901265350251449,-0.0032500410497185279]},"sensors":{"Odom":[0.017114288835838612,-0.00022597374309646996,1.9607974208821042,0.017848635040222272,-0.00044711456974036527,-0.045000872585735256,0.00044708743483669327,0.038843744134507363,-0.00072026874394305683,0.99924493737390285,0.0018908419409115699,0.091901024916283908,-0.0031898543353249434],"Pressure":[11933.116788339081],"DVL":[0.0088397085973313076,-0.027899687442531421,0.010569710179079633,8.7122288531139045,0.0072231981797735833,-0.010800138855154167,-0.0055500615332253582,0],"IMU":[0.00084007906470855392,0.077707655805368911,-0.0014089690320717278,0.0063684951954392994,0.15878915723152628,0.084201198632919763,0.7652378096510144,-0.0104207012957071,-9.7834288311245476],"FOG":[-0.010936985826315755],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-4.9130728899059761,-29.818482024349965,-33.313197240590725,57.205461485397528,57.205461485397528],"omega_rad_s":[-4.914578020684937,-31.121960597700696,-34.325204773761364,57.897599539741869,57.893743679526636],"thrust_n":[-0.30759234185907419,-12.114743528820215,-14.790158251664797,42.679838844957253,45.327117015439867],"torque_nm":[0.0057673564098576421,0.22715144116537903,0.27731546721871497,-0.80024697834294845,-0.84988344403949745],"angle_rad":[-2.6902879483435802,-25.97361486198275,-27.213525645566719,43.72761963905522,43.72513402434987]},"command":[-0.046791170380056916,-0.28398554308904728,-0.31726854514848313,0.54481391890854791,0.54481391890854791],"arm":{"servo_position":[1.5881867761018134e-23,-1.0842021724855046e-21,9.7514668052651321e-21,0,-1.0926725019580475e-21,0],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.06059050392985034,-0.98605009837370994,-0.10495227396422212,-3.1656202852672956e-05,0.00010181206645645863,-0.00076581991501273902]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":29,"step":232,"t":1.1599999999999999,"sim_time":1.1599999999999973,"vehicle":{"origin_ned":[0.017667405055499075,-0.00024311918978040399,1.9589562180013198],"origin_quat_xyzw":[0.00048397184481721318,0.040665505143417019,-0.00078600748530518463,0.99917238985818513],"cg_ned":[-0.056973586167960805,0.00039293391444308743,1.6637880466195718],"linear_velocity_ned":[-0.013273448033813142,0.00035142743939069583,-0.039097614832419851],"angular_velocity_ned":[0.0017883916136641194,0.090559368907868629,-0.0033701132149494321]},"sensors":{"Odom":[0.017667405055499075,-0.00024311918978040399,1.9589562180013198,0.017137432398267066,-0.00044775354043279179,-0.044612696225453344,0.00048397184481722809,0.040665505143418268,-0.0007860074853052088,0.99917238985818513,0.0019176666962314611,0.090559050094687815,-0.0033070084709354744],"Pressure":[11894.785053835669],"DVL":[0.03628898960512307,-0.030566992982109416,0.00067520759144291216,8.7983960238931349,0.008207203102874169,-0.00065581422029028027,0.010646553558798809,0],"IMU":[0.00090621318325294711,0.081354171483350432,-0.0015364342808948475,-0.05113068244110236,0.070842141441783579,-0.084202152275212425,0.784664305229967,0.0035249089172986886,-9.763617340642023],"FOG":[-0.004161406209318496],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-4.9565678781998672,-29.589962067731541,-33.278438634368548,57.695302506150931,57.695302506150931],"omega_rad_s":[-4.9890957026171483,-30.962023625212431,-34.358411695938926,58.446795858607381,58.442997671899391],"thrust_n":[-0.31697632667388181,-11.986011885983999,-14.816335162763906,43.502743716565696,46.136994176415087],"torque_nm":[0.0059433061251352838,0.22473772286220001,0.27780628430182325,-0.81567644468560696,-0.8650686408077829],"angle_rad":[-2.8886067816970522,-27.214960442882461,-28.587397879394999,46.056140629289175,46.053502020825213]},"command":[-0.047205408363808259,-0.28180916254982419,-0.31693751080350996,0.54947907148715169,0.54947907148715169],"arm":{"servo_position":[1.5881867761018134e-23,-1.0842021724855046e-21,9.7514668052651321e-21,0,3.2441361879839704e-21,-1.7347234759768071e-20],"servo_velocity":[0,0,0,0,8.6736173798840355e-19,0],"servo_effort":[-0.058872350689637205,-1.0521493135875646,-0.12004567487891024,-3.2559647796250931e-05,7.5815965161690117e-05,-0.0007328369795077522]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":30,"step":240,"t":1.2,"sim_time":1.1999999999999964,"vehicle":{"origin_ned":[0.018186007838078715,-0.00026013840753410497,1.9571323526477071],"origin_quat_xyzw":[0.00052116060108985075,0.04245788967142692,-0.00085405237464266314,0.99909775627353803],"cg_ned":[-0.057513439520790098,0.00040738747994982391,1.6622339301189177],"linear_velocity_ned":[-0.013664953903816397,0.00036899471527165428,-0.038654757789127928],"angular_velocity_ned":[0.0017931109879319523,0.089003091304653698,-0.0034840233560056392]},"sensors":{"Odom":[0.018186007838078715,-0.00026013840753410497,1.9571323526477071,0.016386105467253151,-0.00044548390940481165,-0.044162053283709764,0.00052116060108987677,0.042457889671429036,-0.00085405237464270575,0.99909775627353803,0.0019342776936583208,0.089002677004903386,-0.0034184767527982878],"Pressure":[11856.803884535868],"DVL":[-0.015311760788275966,-0.010896967366780167,0.0094895131984851118,8.7878044350522835,-0.020855458810050919,0.028903003644725853,0.014100387003596782,0],"IMU":[0.00097236418241661792,0.084942163340943733,-0.0016683246409715689,-0.016202075126584892,0.095452291030081959,-0.071065079368026612,0.85274297916208242,-0.026538617070015882,-9.7677603822806294],"FOG":[-0.001330953700054765],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-4.986496100168452,-29.325082618455809,-33.211361633193185,58.161053521361083,58.161053521361083],"omega_rad_s":[-5.0494986054338877,-30.759868759232386,-34.352927847811827,58.965141332152207,58.961417754726398],"thrust_n":[-0.32468384623513885,-11.825726073940118,-14.809482895989564,44.288476703669218,46.901295671397129],"torque_nm":[0.0060878221169088547,0.22173236388637721,0.27767780429980432,-0.8304089381937978,-0.87939929383869631],"angle_rad":[-3.0895846084457856,-28.448940754151312,-29.961710418869011,48.405919752762159,48.403130841773816]},"command":[-0.04749043904922335,-0.27928650112815057,-0.31629868222088747,0.5539147954415341,0.5539147954415341],"arm":{"servo_position":[-5.1880768019325895e-23,3.2526065174565132e-21,9.7514668052651321e-21,-6.7762635780344029e-23,-1.0926725019580475e-21,-1.7347234759768071e-20],"servo_velocity":[-1.3552527156068805e-20,8.6736173798840355e-19,0,-1.3552527156068805e-20,0,0],"servo_effort":[-0.057060979716077286,-1.1166154548469869,-0.1348936308393448,-3.3384320314928449e-05,4.9969790980762431e-05,-0.00069856901856975686]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":31,"step":248,"t":1.24,"sim_time":1.2399999999999956,"vehicle":{"origin_ned":[0.018669066539887605,-0.00027691143919914593,1.9553285984057376],"origin_quat_xyzw":[0.00055844305533036967,0.044216766313205119,-0.00092428397733916633,0.99902137685701531],"cg_ned":[-0.058068172339529031,0.00042253259015824236,1.6606985957270726],"linear_velocity_ned":[-0.014021528589219253,0.00038605350232333611,-0.038165038592797289],"angular_velocity_ned":[0.001787022434860552,0.087245916365613116,-0.0035916360410155877]},"sensors":{"Odom":[0.018669066539887605,-0.00027691143919914593,1.9553285984057376,0.015599682308113465,-0.00044030797130980762,-0.043653365438800766,0.00055844305533036902,0.044216766313205057,-0.00092428397733916514,0.99902137685701531,0.0019405321004897481,0.087245387381508291,-0.0035241930887655007],"Pressure":[11821.492319114233],"DVL":[0.038272308080596257,-0.039688437063230345,-0.0071643020407518663,8.6529636047956693,-0.021399076199439739,0.01863723640293221,0.0061370500836055051,0],"IMU":[0.0010381149625098846,0.088463358961401076,-0.0018044307093459946,0.0044133029594895078,0.11293342664495742,-0.095846790124210657,0.86434804636734419,-0.017630250310152248,-9.7574769373670325],"FOG":[-0.010886973554431722],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-5.0028145676627593,-29.025315785611298,-33.113787298656817,58.604254191839111,58.604254191839111],"omega_rad_s":[-5.0957277957194949,-30.517374036252328,-34.310911944036413,59.454933442468629,59.451300403266082],"thrust_n":[-0.33064236240338118,-11.635985806227698,-14.771497667196583,45.03924543581325,47.622629824446861],"torque_nm":[0.0061995442950633969,0.21817473386676933,0.27696558125993598,-0.84448585192149861,-0.89292430920837884],"angle_rad":[-3.2926554627869136,-29.673910210243783,-31.334965074944954,50.775776040775362,50.772840173374576]},"command":[-0.047645853025359612,-0.27643157891058379,-0.31536940284435061,0.55813575420799155,0.55813575420799155],"arm":{"servo_position":[-5.1880768019325895e-23,-1.0842021724855046e-21,9.7514668052651321e-21,0,-1.0926725019580475e-21,-1.7347234759768071e-20],"servo_velocity":[0,-8.6736173798840355e-19,0,0,0,0],"servo_effort":[-0.055169527764117487,-1.1793515160668968,-0.14946592000667425,-3.4139729449458511e-05,2.4342169450518865e-05,-0.00066321748032650114]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":32,"step":256,"t":1.28,"sim_time":1.2799999999999947,"vehicle":{"origin_ned":[0.019115771091374717,-0.00029331941603825268,1.9535475509956872],"origin_quat_xyzw":[0.00059560682814362089,0.0459382752196386,-0.00099658123833944613,0.99894360548941208],"cg_ned":[-0.058636359498960844,0.00043834704715782838,1.6591838263554608],"linear_velocity_ned":[-0.014341964951804917,0.00040252158189541296,-0.037632489877825664],"angular_velocity_ned":[0.0017700862271740896,0.085301361911391205,-0.0036928510431285767]},"sensors":{"Odom":[0.019115771091374717,-0.00029331941603825268,1.9535475509956872,0.014783065808398582,-0.00043225242367340831,-0.043090774672593521,0.00059560682814365472,0.045938275219641202,-0.00099658123833950272,0.99894360548941208,0.0019363721956801303,0.085300696956826183,-0.0036241218820581476],"Pressure":[11786.221647035782],"DVL":[0.012616606363245415,-0.022123254511728571,0.00071567661247560013,8.7698891680978015,0.010307699864947759,-0.0089509782113557767,0.042729086373125114,0],"IMU":[0.0011030487383833774,0.091910025988076766,-0.001944543268998568,0.036885722587887707,0.12780052076241499,-0.13098164487756453,0.90883813894189847,-0.0029473156464843364,-9.7503680359553115],"FOG":[-0.0071582783399207232],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-5.0054779286407118,-28.692067847719123,-32.987492833924321,59.026291054861801,59.026291054861801],"omega_rad_s":[-5.1277326463711725,-30.236302247229887,-34.234440656950007,59.918216746242436,59.914689141325503],"thrust_n":[-0.3347954330946577,-11.418877734477872,-14.704295358815227,45.75703904717524,48.303400122939941],"torque_nm":[0.0062774143705248316,0.21410395752146011,0.27570553797778552,-0.85794448213453589,-0.90568875230512391],"angle_rad":[-3.4972512194335121,-30.888295677259283,-32.705748101456244,53.164614564271062,53.161535700560556]},"command":[-0.047671218368006779,-0.27325778902589642,-0.31416659841832689,0.56215515290344575,0.56215515290344575],"arm":{"servo_position":[-5.1880768019325895e-23,-1.0842021724855046e-21,5.4146581153231142e-21,0,3.2441361879839704e-21,-1.7347234759768071e-20],"servo_velocity":[-1.3552527156068805e-20,0,8.6736173798840355e-19,1.3552527156068805e-20,8.6736173798840355e-19,0],"servo_effort":[-0.053215335623661979,-1.2402603541310069,-0.16373086455210656,-3.4828211831512447e-05,-9.9036682370653253e-07,-0.00062694019951953239]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":33,"step":264,"t":1.3200000000000001,"sim_time":1.3199999999999938,"vehicle":{"origin_ned":[0.019525522517523319,-0.00030924554224748263,1.9517916348590423],"origin_quat_xyzw":[0.0006324394979680902,0.047618828188880941,-0.0010708220666924835,0.99886480594838289],"cg_ned":[-0.059216532401250979,0.00045480542678946121,1.6576912497105312],"linear_velocity_ned":[-0.014625269045660673,0.00041831950572477559,-0.037060875898717399],"angular_velocity_ned":[0.0017423456992041715,0.083182934702734412,-0.0037875953214737234]},"sensors":{"Odom":[0.019525522517523319,-0.00030924554224748263,1.9517916348590423,0.013941024092908056,-0.00042136703676307725,-0.042478167772655374,0.00063243949796810647,0.047618828188882169,-0.001070822066692511,0.99886480594838289,0.0019218215923295463,0.083182110445774005,-0.0037182490729471911],"Pressure":[11752.041809662696],"DVL":[-0.012716313449514047,-0.0021733747965836034,-0.0064362065295966294,8.7155747690040322,-0.00084202258928495882,-0.015552032980653037,-0.010635196357734274,0],"IMU":[0.0011667522799066691,0.095274972452329687,-0.0020884540225450171,0.046310156214725409,0.090511532699681957,-0.18531741913723382,0.93752136887267923,-0.012303904237366445,-9.7321615299434292],"FOG":[0.0059049127756186587],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-4.9944405317564353,-28.326682348712925,-32.8342212242285,59.42841757910481,59.42841757910481],"omega_rad_s":[-5.1454681691115107,-29.918315564407912,-34.125522130901381,60.356817145649927,60.353408820031689],"thrust_n":[-0.3371025902829583,-11.176472894168279,-14.609805319969249,46.44365226663669,48.945826680741675],"torque_nm":[0.0063206735678054691,0.20955886676565522,0.27393384974942347,-0.87081847999943807,-0.91773425026390631],"angle_rad":[-3.7028018650995884,-32.09059220403703,-34.072727228364791,55.57141711210005,55.568199784425133]},"command":[-0.047566100302442245,-0.26977792713059928,-0.31270686880217619,0.56598492932480771,0.56598492932480771],"arm":{"servo_position":[1.5881867761018134e-23,-1.0842021724855046e-21,1.0778494253810964e-21,0,-1.0926725019580475e-21,-1.7347234759768071e-20],"servo_velocity":[0,0,-8.6736173798840355e-19,0,0,0],"servo_effort":[-0.051210830151316569,-1.2992576470867077,-0.17766188881273437,-3.544409526356215e-05,-2.5966712961600631e-05,-0.00058990953737687488]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":34,"step":272,"t":1.3600000000000001,"sim_time":1.359999999999993,"vehicle":{"origin_ned":[0.019897929323529268,-0.00032457639354638025,1.950063108558707],"origin_quat_xyzw":[0.00066873016360884194,0.049255107504521625,-0.0011468837529979836,0.9987853482317125],"cg_ned":[-0.059807180972249574,0.00047187878950652804,1.6562223479704317],"linear_velocity_ned":[-0.014870282394545214,0.00043334724891952811,-0.03645374665060324],"angular_velocity_ned":[0.0017039202103115965,0.080904049412305709,-0.0038758159967130857]},"sensors":{"Odom":[0.019897929323529268,-0.00032457639354638025,1.950063108558707,0.013078542232573605,-0.00040774491658686449,-0.041819195796443699,0.00066873016360886992,0.049255107504523686,-0.0011468837529980316,0.9987853482317125,0.0018969777580516317,0.080903040551975516,-0.0038065745576770656],"Pressure":[11718.372442272712],"DVL":[0.032947082250076358,0.030646844362792372,0.011447214225077348,8.6918599611445586,0.010404850778444061,-0.03183594009413853,-0.014396122974850011,0],"IMU":[0.0012288188876225078,0.098551544645755412,-0.0022359559506948735,-0.11628063973304355,0.076293891979464443,0.066934758840233477,0.9797979812938864,-0.027575520116339063,-9.7268091750584933],"FOG":[-0.00013300989763474725],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-4.9696713710532689,-27.930497598261212,-32.65572684036556,59.811771362043082,59.811771362043082],"omega_rad_s":[-5.1488951791477486,-29.564997427685281,-33.986114228343588,60.772371167856278,60.769094904473704],"thrust_n":[-0.3375395880465395,-10.910835214938423,-14.48997467213273,47.10070779814648,49.551965218295081],"torque_nm":[0.0063288672758726157,0.20457816028009546,0.27168702510248871,-0.88313827121524657,-0.92909934784303294],"angle_rad":[-3.9087356892860914,-33.279359409786345,-35.434649262377931,57.995234123489801,57.991883394124848]},"command":[-0.047330203533840653,-0.26600473903105915,-0.3110069222891958,0.56963591773374367,0.56963591773374367],"arm":{"servo_position":[1.5881867761018134e-23,-1.0842021724855046e-21,9.7514668052651321e-21,0,-1.0926725019580475e-21,-1.7347234759768071e-20],"servo_velocity":[1.3552527156068805e-20,0,8.6736173798840355e-19,0,0,0],"servo_effort":[-0.049175664883979946,-1.3562585989703875,-0.19121632486787679,-3.5980471249088964e-05,-5.0454537739179121e-05,-0.00055229571797360013]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":35,"step":280,"t":1.4000000000000001,"sim_time":1.3999999999999921,"vehicle":{"origin_ned":[0.020232810922431711,-0.0003392036736447544,1.948364069339207],"origin_quat_xyzw":[0.00070427095537130139,0.050844064076473391,-0.0012246432942086859,0.99870560497045913],"cg_ned":[-0.060406748176403131,0.00048953389754295207,1.6547784664333414],"linear_velocity_ned":[-0.015075989498774367,0.0004475023685978351,-0.035814408857805347],"angular_velocity_ned":[0.0016550074817925995,0.078478065151088891,-0.0039574833231355265]},"sensors":{"Odom":[0.020232810922431711,-0.0003392036736447544,1.948364069339207,0.012200518890569959,-0.00039150598766926972,-0.041117278821491042,0.00070427095537131288,0.050844064076474224,-0.0012246432942087059,0.99870560497045913,0.001862014545922152,0.078476844538040547,-0.0038891139169775065],"Pressure":[11685.603786038368],"DVL":[0.029303369540515448,-0.00096987686138734486,-0.018183273308159952,8.6414076094707344,-0.015522615985421309,0.0010868800177464765,0.0073931387887455763,0],"IMU":[0.0012888512527638202,0.10173362364330041,-0.0023868434469973428,-0.056173021913302972,0.081061386315347608,0.042574207292770241,1.019891952547366,-0.018588823075442903,-9.7238076243881366],"FOG":[-0.0017019900420821505],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-4.9312683294451594,-27.50511077398583,-32.453994013557256,60.177384563922487,60.177384563922487],"omega_rad_s":[-5.1380156789782463,-29.177950915232159,-33.818206464609339,61.166350091397668,61.163217606697607],"thrust_n":[-0.33610317560344194,-10.624081060966544,-14.346821737459427,47.729673608395885,50.123723617535759],"torque_nm":[0.0063019345425645371,0.19920151989312274,0.26900290757736434,-0.89493138015742291,-0.93981981782879576],"angle_rad":[-4.1144802722685085,-34.453220484101678,-36.790339869962516,60.435177678318325,60.431699096866758]},"command":[-0.046964460280430088,-0.26195343594272219,-0.3090856572719739,0.57311794822783324,0.57311794822783324],"arm":{"servo_position":[1.5881867761018134e-23,-1.0842021724855046e-21,9.7514668052651321e-21,0,-1.0926725019580475e-21,-1.7347234759768071e-20],"servo_velocity":[0,0,1.7347234759768071e-18,0,0,0],"servo_effort":[-0.0471177381563413,-1.4111854512769861,-0.20437735156605624,-3.6454726498332075e-05,-7.4432101719283477e-05,-0.00051427166848212551]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":36,"step":288,"t":1.4399999999999999,"sim_time":1.4399999999999913,"vehicle":{"origin_ned":[0.020530174253885612,-0.00035302425407485801,1.9466964598864924],"origin_quat_xyzw":[0.00073885855134302257,0.052382916297754052,-0.001303977880007641,0.99862594789534287],"cg_ned":[-0.061013651744338225,0.00050773417979773012,1.6533608243634503],"linear_velocity_ned":[-0.015241975269840564,0.00046071141278119636,-0.035145903498694696],"angular_velocity_ned":[0.0015958792973011511,0.075918264497871965,-0.0040325957566725518]},"sensors":{"Odom":[0.020530174253885612,-0.00035302425407485801,1.9466964598864924,0.011311296959178024,-0.00037276615943430432,-0.04037563596188002,0.00073885855134302257,0.052382916297754045,-0.0013039778800076408,0.99862594789534287,0.0018171784863650316,0.075916803282857034,-0.0039659028351457185],"Pressure":[11652.926195786797],"DVL":[0.014521753099813009,-0.040897854211231703,-0.015394021630798834,8.7000501010195244,0.0054062524335285978,-0.010301902484390254,0.014008553257527713,0],"IMU":[0.0013464642899954247,0.10481562330157801,-0.0025409127405635161,0.0095491477385113537,0.05836903006357852,-0.19249339937787688,1.0448548346803155,-0.01103938241920685,-9.7567158603436077],"FOG":[-0.020966203830797482],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-4.8792071513820918,-27.051826006327083,-32.230774547010093,60.526195784491208,60.526195784491208],"omega_rad_s":[-5.1128396548471091,-28.758738934131475,-33.623768856611314,61.54007984082493,61.537101784571547],"thrust_n":[-0.33280669218382247,-10.318313509956456,-14.182368510558019,48.331877930751226,50.662876005842094],"torque_nm":[0.006240125478446672,0.19346837831168354,0.26591940957296289,-0.90622271120158548,-0.94992892510953919],"angle_rad":[-4.3194636316173156,-35.610862172414421,-38.138704144161061,62.890415344658514,62.88681490537568]},"command":[-0.046468639536972299,-0.25763643815549603,-0.30695975759057231,0.57643995985229723,0.57643995985229723],"arm":{"servo_position":[1.5881867761018134e-23,-1.0842021724855046e-21,9.7514668052651321e-21,0,-1.0926725019580475e-21,-1.7347234759768071e-20],"servo_velocity":[0,0,8.6736173798840355e-19,0,0,0],"servo_effort":[-0.045045718114128316,-1.4639729872791625,-0.21712927918489869,-3.6886166906283315e-05,-9.7873590904674071e-05,-0.00047596643291657463]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":37,"step":296,"t":1.48,"sim_time":1.4799999999999904,"vehicle":{"origin_ned":[0.020790198193574277,-0.00036594061056558034,1.9450620737851776],"origin_quat_xyzw":[0.00077229560355945805,0.053869147542977697,-0.0013847651848352142,0.99854674448814684],"cg_ned":[-0.061626297305203151,0.00052644022655518941,1.6519705241673857],"linear_velocity_ned":[-0.0153680237322537,0.00047290557525851576,-0.034451060775398973],"angular_velocity_ned":[0.0015268784005594966,0.073237792642775495,-0.0041011680371160677]},"sensors":{"Odom":[0.020790198193574277,-0.00036594061056558034,1.9450620737851776,0.01041504456513897,-0.00035165935291849189,-0.039597305794590733,0.0007722956035594678,0.053869147542978384,-0.0013847651848352318,0.99854674448814684,0.0017627846816818619,0.073236060476954259,-0.0040369845289358712],"Pressure":[11621.181296443012],"DVL":[-0.0024700259776111941,-0.024229755696517485,-0.0051998908275448135,8.6464493417172843,-0.0048618509425813325,0.001920341049538717,-0.013026022327240797,0],"IMU":[0.0014012877932406897,0.10779248557200388,-0.0026979619124130961,-0.061198990477126465,0.12257700235808944,0.019334478871193109,1.0770159623069209,-0.0024195635137426071,-9.7244309171779602],"FOG":[0.012127808961417543],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-4.8134154025375109,-26.571843623698786,-31.987745987736837,60.859065252561614,60.859065252561614],"omega_rad_s":[-5.073355169172979,-28.30883550084911,-33.4047110992177,61.8947598025931,61.891945762138235],"thrust_n":[-0.32767620189499347,-9.9955822243821633,-13.99859912369063,48.908526426830115,51.171077012300039],"torque_nm":[0.0061439287855311279,0.18741716670716554,0.26247373356919934,-0.91703487050306465,-0.95945769398062586],"angle_rad":[-4.5231136854730201,-36.751031666327471,-39.478724571746,65.360164798257586,65.356448897464603]},"command":[-0.045842051452738196,-0.25306517736855988,-0.30464519988320798,0.57961014526249155,0.57961014526249155],"arm":{"servo_position":[1.5881867761018134e-23,-1.0842021724855046e-21,1.0778494253810964e-21,0,-1.0926725019580475e-21,-1.7347234759768071e-20],"servo_velocity":[0,0,-8.6736173798840355e-19,0,0,0],"servo_effort":[-0.042969245957063675,-1.5145616939289241,-0.22945274690205922,-3.7252682320481686e-05,-0.00012073443836607646,-0.00043753716077429849]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":38,"step":304,"t":1.52,"sim_time":1.5199999999999896,"vehicle":{"origin_ned":[0.021013222728704761,-0.0003778614855721161,1.9434625602168176],"origin_quat_xyzw":[0.00080439206598256774,0.055300502832368217,-0.0014668837104048346,0.99846835482756857],"cg_ned":[-0.062243086270345069,0.00054561001083372484,1.6506085594869879],"linear_velocity_ned":[-0.01545411443085515,0.00048402202525029699,-0.033732514863053183],"angular_velocity_ned":[0.0014484125464634037,0.070449617136506174,-0.0041632369948351334]},"sensors":{"Odom":[0.021013222728704761,-0.0003778614855721161,1.9434625602168176,0.0095157424880538671,-0.00032833517881929739,-0.038785163765760626,0.00080439206598259289,0.055300502832369952,-0.0014668837104048805,0.99846835482756857,0.0016992115990003978,0.070447582393518407,-0.0041024152289206523],"Pressure":[11589.464046612253],"DVL":[0.0024668331276798683,-0.020495387088435756,0.00063489977894959707,8.6681446769759702,0.041177449284312821,-0.034746491138098669,0.045953731112866589,0],"IMU":[0.0014529688768143817,0.11065967417013799,-0.0028577910069732398,-0.020227266700566848,0.025137449688733556,-0.012198055371283427,1.1149154481479064,-0.020064313096058738,-9.771249251945612],"FOG":[0.0016556731540930715],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-4.7337893541723695,-26.066316800547472,-31.72656875251251,61.176785251902039,61.176785251902039],"omega_rad_s":[-5.0195258071985585,-27.82963859587527,-33.1628949616995,62.231479359634932,62.228837868530512],"thrust_n":[-0.32075028340170475,-9.6578862495008639,-13.79746018285862,49.460717687680479,51.649875279893202],"torque_nm":[0.006014067813781966,0.18108536717814125,0.25870237842859917,-0.92738845664400915,-0.96843516149799747],"angle_rad":[-4.7248573293544869,-37.872533363484663,-40.809458907630763,67.843689143180669,67.839864536947715]},"command":[-0.045083708134974948,-0.24825063619569021,-0.30215779764297629,0.58263605001811469,0.58263605001811469],"arm":{"servo_position":[1.5881867761018134e-23,-1.0842021724855046e-21,1.0778494253810964e-21,0,-1.0926725019580475e-21,-1.7347234759768071e-20],"servo_velocity":[0,0,-1.7347234759768071e-18,0,0,0],"servo_effort":[-0.040897243858568993,-1.5629025517674984,-0.2413311104843551,-3.7578927895358028e-05,-0.00014297410396517892,-0.0003990922284195929]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":39,"step":312,"t":1.5600000000000001,"sim_time":1.5599999999999887,"vehicle":{"origin_ned":[0.021199737964548729,-0.00038870247355470965,1.9418994285176949],"origin_quat_xyzw":[0.00083496642271009699,0.0566749846960133,-0.0015502130623226459,0.99839112865662061],"cg_ned":[-0.06286242343652769,0.00056519912294235514,1.6492758227994606],"linear_velocity_ned":[-0.01550041261573845,0.00049400373962853129,-0.032992714625741576],"angular_velocity_ned":[0.0013609491207175787,0.06756649519945683,-0.0042188565229657263]},"sensors":{"Odom":[0.021199737964548729,-0.00038870247355470965,1.9418994285176949,0.0086171796410840912,-0.00030295736231271533,-0.037941934694066932,0.00083496642271012897,0.056674984696015465,-0.0015502130623227053,0.99839112865662061,0.0016268953325975805,0.06756412523197329,-0.0041622589568380023],"Pressure":[11562.249661035228],"DVL":[0.004807357053541521,-0.025383516532363197,-0.00057744805157832792,8.6329894191353596,0.0093918763464058089,0.0036332462754166367,-0.0027525880270716074,0],"IMU":[0.0015011742128398342,0.11341316666289107,-0.0030202020147243043,-0.068521623734362339,0.0086836871779359878,-0.066838589947126256,1.12650961792833,-0.019679459674154742,-9.7240827932976188],"FOG":[0.0074180357914472566],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-4.640181933351939,-25.53635055141784,-31.448883809051999,61.480088677552544,61.480088677552544],"omega_rad_s":[-4.9512846077124921,-27.322477671725451,-32.900142609549327,62.551232257843374,62.548770808566694],"thrust_n":[-0.31207952191031646,-9.3071734269840025,-13.580858300817601,49.989457175074939,52.100725551677023],"torque_nm":[0.0058514910358184336,0.17450950175595006,0.25464109314033001,-0.93730232203265496,-0.97688860409394429],"angle_rad":[-4.92411932378484,-38.974226002574902,-42.13003845732964,70.340292845291259,70.336366607559057]},"command":[-0.044192208889066088,-0.24320333858493182,-0.29951317913382858,0.585524654071929,0.585524654071929],"arm":{"servo_position":[1.5881867761018134e-23,-1.0842021724855046e-21,9.7514668052651321e-21,0,-1.0926725019580475e-21,-1.7347234759768071e-20],"servo_velocity":[0,0,1.7347234759768071e-18,0,-4.3368086899420177e-19,0],"servo_effort":[-0.0388371633320179,-1.6089536753756024,-0.25274976144551953,-3.7853384915923162e-05,-0.00013111446918929049,-0.0003603475392089704]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":40,"step":320,"t":1.6000000000000001,"sim_time":1.5999999999999879,"vehicle":{"origin_ned":[0.021350373284587928,-0.00039838653127984979,1.9403740525952267],"origin_quat_xyzw":[0.00086384681011860407,0.057990848660472154,-0.0016346341438829976,0.99831540267169194],"cg_ned":[-0.063482724245184349,0.00058516100938487499,1.6479731125677426],"linear_velocity_ned":[-0.015507261438662021,0.00050279989457434988,-0.032233935195697852],"angular_velocity_ned":[0.0012650108650404204,0.064600959915408748,-0.0042680945918608009]},"sensors":{"Odom":[0.021350373284587928,-0.00039838653127984979,1.9403740525952267,0.0077229523684398515,-0.00027570205804218695,-0.037070206643370178,0.00086384681011861524,0.057990848660472903,-0.0016346341438830186,0.99831540267169194,0.0015463251062176366,0.064598221344941698,-0.00421658435961991],"Pressure":[11530.444699120613],"DVL":[0.036566703515377309,-0.003566622069028122,-0.0032549782083606624,8.5886373401856311,-0.0081020069682943823,0.012626973537906344,0.0096498625608803408,0],"IMU":[0.0015455920561084624,0.11604944581147092,-0.0031849987010635992,-0.073288476426271412,0.022588021936033063,-0.14802998715786039,1.1696905930308423,-0.014389958112480498,-9.7504997422755828],"FOG":[-0.0095392342811342554],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-4.5323865659419544,-24.983005468639941,-31.156315076782022,61.769656781740423,61.769656781740423],"omega_rad_s":[-4.8685249266091546,-26.788619796961875,-32.618242808963672,62.854928978991396,62.85265403923313],"thrust_n":[-0.3017258321880123,-8.9453395465168164,-13.350656763671994,50.49566937938237,52.524999650987056],"torque_nm":[0.0056573593535252306,0.16772511649719032,0.2503248143188499,-0.94679380086341958,-0.98484374345600734],"angle_rad":[-5.1203208721898523,-40.055020062965575,-43.439666638266694,72.849318192723402,72.845297674016194]},"command":[-0.04316558634230433,-0.23793338541561848,-0.29672681025506686,0.588282445540385,0.588282445540385],"arm":{"servo_position":[1.5881867761018134e-23,-1.0842021724855046e-21,5.4146581153231142e-21,0,5.3363075677020922e-22,-1.7347234759768071e-20],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.036795921069392834,-1.6526813971166336,-0.26369626187227857,-3.8099640381436276e-05,-0.00016631581758445667,-0.00032227628429591757]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":41,"step":328,"t":1.6400000000000001,"sim_time":1.639999999999987,"vehicle":{"origin_ned":[0.021465886547391025,-0.00040684440232321138,1.9388876753212188],"origin_quat_xyzw":[0.00089087201828918865,0.05924659813626125,-0.0017200293587368548,0.99824149806313511],"cg_ned":[-0.064102421694445091,0.00060544722972422343,1.6467011400025993],"linear_velocity_ned":[-0.015475173608069059,0.00051036622537522429,-0.031458286126052219],"angular_velocity_ned":[0.001161168929630444,0.061565283383051249,-0.0043110343578485035]},"sensors":{"Odom":[0.021465886547391025,-0.00040684440232321138,1.9388876753212188,0.0068364570335546155,-0.00024675574609620091,-0.036172439515295779,0.00089087201828922584,0.059246598136263727,-0.0017200293587369265,0.99824149806313511,0.0014580366540119546,0.061562142405968502,-0.0042654659834429559],"Pressure":[11506.468062571643],"DVL":[0.039370195940277436,-0.033628001333522776,0.022938813807695503,8.6417198036089822,0.030757653831931173,-0.027875780922221524,0.0015282029235550165,0],"IMU":[0.0015859340192790671,0.11856548971930043,-0.0033519864760164966,0.083127543900456013,0.1240349246023696,0.064214898711099019,1.2044753332136395,-0.0051716394741448159,-9.7184665299624289],"FOG":[-0.012378795339115047],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-4.4101147549535868,-24.407294819165227,-30.850471362282782,62.046125458852821,62.046125458852821],"omega_rad_s":[-4.771087360781344,-26.229273721741666,-32.318955906551814,63.143407483629531,63.141324515783047],"thrust_n":[-0.28976160990846667,-8.5742267538715726,-13.108672094429778,50.980208929665423,52.923995789871533],"torque_nm":[0.0054330301857837496,0.16076675163509199,0.24578760177055836,-0.95587891743122666,-0.99232492106009151],"angle_rad":[-5.3128777491282451,-41.113875372111124,-44.737617761394162,75.37014221518595,75.366035002047823]},"command":[-0.042001092904319873,-0.23245042684919262,-0.29381401297412174,0.59091548056050303,0.59091548056050303],"arm":{"servo_position":[1.5881867761018134e-23,-1.0842021724855046e-21,1.0778494253810964e-21,-1.3552527156068806e-22,6.0139339255055312e-22,-1.7347234759768071e-20],"servo_velocity":[0,0,0,-2.7105054312137611e-20,0,0],"servo_effort":[-0.034779975080842393,-1.6940588418901101,-0.2741597627191909,-3.8302778418243844e-05,-0.00020064455420146823,-0.00028459588579471141]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":42,"step":336,"t":1.6799999999999999,"sim_time":1.6799999999999862,"vehicle":{"origin_ned":[0.021547153305115849,-0.00041401497823544337,1.9374414129182025],"origin_quat_xyzw":[0.00091589241168417933,0.060440978827609571,-0.0018062827873563539,0.99816971831544887],"cg_ned":[-0.064719972999322195,0.00062600772765215201,1.6454605354567455],"linear_velocity_ned":[-0.015404825197943671,0.00051666533937474914,-0.030667720678579258],"angular_velocity_ned":[0.0010500394878190482,0.058471456221373806,-0.004347770933995126]},"sensors":{"Odom":[0.021547153305115849,-0.00041401497823544337,1.9374414129182025,0.0059608855911423564,-0.00021631383315114648,-0.035250975207287975,0.0009158924116842072,0.060440978827611409,-0.001806282787356409,0.99816971831544887,0.0013626086278696057,0.058467878945332452,-0.0043089809734685978],"Pressure":[11478.892544535167],"DVL":[0.069596949120814489,-0.024544955682803106,0.030058548230047104,8.6511368117072429,-0.032089295206046989,-0.0078843835286634429,0.011639309910806965,0],"IMU":[0.0016219366834903557,0.12095876102115388,-0.0035209722373569243,-0.039511704334716208,0.038340161316400931,0.15751479893327242,1.2201476010303969,-0.013232278168703933,-9.7184486213619969],"FOG":[-0.020856017805796549],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-4.2729702667082119,-23.810181097029901,-30.532946052286327,62.310091052102358,62.310091052102358],"omega_rad_s":[-4.6587421350868405,-25.645591216104144,-32.004017182376259,63.417442397628719,63.415555881242824],"thrust_n":[-0.27626879355026557,-8.1956208149072705,-12.856670025330034,51.443870149697979,53.298946803935529],"torque_nm":[0.0051800398790674794,0.1536678902795113,0.24106256297493814,-0.9645725653068371,-0.99935525257379121],"angle_rad":[-5.5011977974616588,-42.149798807067818,-46.0232359741224,77.902173994828729,77.897987870107812]},"command":[-0.040694954921030591,-0.22676362949552287,-0.29078996240272692,0.59342943859145103,0.59342943859145103],"arm":{"servo_position":[1.5881867761018134e-23,-1.0842021724855046e-21,1.0778494253810964e-21,0,7.369186641112412e-22,-1.7347234759768071e-20],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.032794029705299953,-1.7330701676328795,-0.28413219744966245,-3.8472721541605138e-05,-0.00023400763200204472,-0.00024737229758227408]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":43,"step":344,"t":1.72,"sim_time":1.7199999999999853,"vehicle":{"origin_ned":[0.021595156158413426,-0.00041984556500985766,1.9360362593644815],"origin_quat_xyzw":[0.0009387707065988323,0.061572972735147551,-0.0018932803500095927,0.99810034727357611],"cg_ned":[-0.065333865934471436,0.00064679111187407659,1.6442518544772577],"linear_velocity_ned":[-0.015297048057042295,0.00052166705305925628,-0.029864046986446229],"angular_velocity_ned":[0.00093227539200718104,0.0553311705615009,-0.0043784143267962781]},"sensors":{"Odom":[0.021595156158413426,-0.00041984556500985766,1.9360362593644815,0.0050992239368815575,-0.00018457828199170456,-0.034308049025284802,0.00093877070659886385,0.061572972735149618,-0.0018932803500096562,0.99810034727357611,0.0012606548135382059,0.055327123341912608,-0.0043472125873294347],"Pressure":[11451.981127058041],"DVL":[0.025929949958808023,-0.026003401252396974,0.02708940131202461,8.5875953452663136,-0.0077753548890814664,-0.01224571363895012,-0.03324917343549607,0],"IMU":[0.0016533629182573623,0.12322719524841251,-0.0036917642268700975,-0.062880921259674413,0.074337227561957125,-0.076356773312657458,1.2309341036783603,-0.032128590432522822,-9.7642287103645504],"FOG":[-0.00132435885778296],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-4.1204060286111801,-23.192573195427471,-30.205316816106031,62.562114397200986,62.562114397200986],"omega_rad_s":[-4.5311643580536058,-25.038667115160361,-31.675138882311803,63.67775284178628,63.676066298672851],"thrust_n":[-0.26133775351309785,-7.8112483545611395,-12.596361240217698,51.887395321555374,53.65102718943033],"torque_nm":[0.0049000828783705846,0.14646090664802139,0.23618177325408185,-0.97288866227916326,-1.0059567598018186],"angle_rad":[-5.6846775753686662,-43.161842019721327,-47.29593430382991,80.444852315138604,80.44059521923009]},"command":[-0.039241962177249338,-0.22088164948026162,-0.28766968396291459,0.59582966092572365,0.59582966092572365],"arm":{"servo_position":[1.5881867761018134e-23,-1.0842021724855046e-21,1.0778494253810964e-21,0,-3.4728350837426326e-22,-8.6736173798840357e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.030843590018893349,-1.7697046444604174,-0.29360680507375581,-3.8611183838690324e-05,-0.00028080566958904254,-0.00021125049944921428]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":44,"step":352,"t":1.76,"sim_time":1.7599999999999845,"vehicle":{"origin_ned":[0.021610974148011747,-0.00042429208458354703,1.9346730906712124],"origin_quat_xyzw":[0.00095938265102563807,0.062641791729220866,-0.0019809099480356143,0.99803364748372059],"cg_ned":[-0.06594262495269744,0.00066774494263645843,1.6430755833587176],"linear_velocity_ned":[-0.015152823794245755,0.00052534825463921946,-0.029048936643665601],"angular_velocity_ned":[0.00080856155386522805,0.052155795371015563,-0.0044030826725979799]},"sensors":{"Odom":[0.021610974148011747,-0.00042429208458354703,1.9346730906712124,0.0042542462439937243,-0.00015175596464296053,-0.033345797737718723,0.00095938265102565618,0.062641791729222046,-0.0019809099480356516,0.99803364748372059,0.0011528189348136981,0.05215124517086122,-0.0043802437402079304],"Pressure":[11430.132961069767],"DVL":[0.014237525304697764,-0.0068402431702767278,0.021705589460858838,8.6026639038973638,-0.01341346575368353,-0.017344122519674994,0.022049593263651791,0],"IMU":[0.0016800030043831503,0.12536918831993932,-0.0038641718842336394,0.098020650690457359,0.12602588961757324,0.10395667998946992,1.2563392211032236,-0.011387161496822121,-9.7106770846813593],"FOG":[0.0030474116058329935],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.951670968936178,-22.555318357605774,-29.869144146605311,62.8027276428856,62.8027276428856],"omega_rad_s":[-4.3878997353693761,-24.409536967854862,-31.334011698055001,63.925009872236267,63.923525893972915],"thrust_n":[-0.24506607629479793,-7.4227734528214286,-12.3293974141357,52.311483170694686,53.981360234471595],"torque_nm":[0.0045949889305274619,0.13917700224040178,0.23117620151504442,-0.98084030945052536,-1.0121505043963426],"angle_rad":[-5.8626977932405628,-44.149099111132706,-48.555193777230194,82.997643611136482,82.993323604284285]},"command":[-0.037634961608915982,-0.21481255578672165,-0.28446803949147914,0.59812121564652954,0.59812121564652954],"arm":{"servo_position":[1.5881867761018134e-23,-1.0842021724855046e-21,1.0778494253810964e-21,0,-1.4314856808597677e-21,-8.6736173798840357e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.028931226867072661,-1.8039613057877379,-0.30257934351726362,-3.8729704159146222e-05,-0.00031248773200061845,-0.00017531163919733096]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":45,"step":360,"t":1.8,"sim_time":1.7999999999999836,"vehicle":{"origin_ned":[0.021595772342501249,-0.00042731917546161085,1.933352669316009],"origin_quat_xyzw":[0.00097761755740334686,0.063646870761128516,-0.0020690615539939667,0.99796985880862821],"cg_ned":[-0.06654481696449166,0.00068881602598482256,1.6419321444896935],"linear_velocity_ned":[-0.01497327503398622,0.00052769340428943622,-0.028223930597938107],"angular_velocity_ned":[0.00067960842139098965,0.048956361002572404,-0.0044219043088114798]},"sensors":{"Odom":[0.021595772342501249,-0.00042731917546161085,1.933352669316009,0.0034285145737305324,-0.00011805653737431816,-0.032366264501900784,0.00097761755740336225,0.063646870761129515,-0.0020690615539939992,0.99796985880862821,0.0010397686107534707,0.04895127575013497,-0.0044081596621769522],"Pressure":[11405.939268762311],"DVL":[0.033450453377895747,-0.02375342522052078,-0.010787265990557689,8.6515960753628018,-0.029190363737185646,0.0035681815130384586,-0.037077393216371372,0],"IMU":[0.0017016754648118821,0.12738358328786339,-0.0040380056505999731,-0.027492724981491235,0.014167663236893176,0.2281580484902645,1.2714733453282299,-0.022887753461332747,-9.6764607794469182],"FOG":[0.0030593462551548089],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.765719784400571,-21.899197769240683,-29.525969214027249,63.032436249105281,63.032436249105281],"omega_rad_s":[-4.2283141780751601,-23.759173899134257,-30.982304573148326,64.159842534674397,64.158562812292189],"thrust_n":[-0.22755704100384627,-7.0317947848161495,-12.05736675140116,52.716795478997675,54.291023534764669],"torque_nm":[0.0042666945188221178,0.13184615221530283,0.22607562658877173,-0.98843991523120645,-1.0179566912768376],"angle_rad":[-6.0346170418171132,-45.11070419209765,-49.80056255262533,85.56004018848725,85.555665414235847]},"command":[-0.035863997946672103,-0.20856378827848271,-0.28119970680025952,0.60030891665814556,0.60030891665814556],"arm":{"servo_position":[-1.7999450129153881e-23,-1.0842021724855046e-21,1.0778494253810964e-21,0,-1.4314856808597677e-21,-8.6736173798840357e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.02705979594294573,-1.8358448757938053,-0.31104693428390118,-3.8819067248754033e-05,-0.00034296271195230076,-0.00014014090682535032]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":46,"step":368,"t":1.8400000000000001,"sim_time":1.8399999999999828,"vehicle":{"origin_ned":[0.021550791631111399,-0.00042890022765667581,1.9320756487928299],"origin_quat_xyzw":[0.00099337873221881342,0.064587860792229529,-0.0021576272690516491,0.99790919731283445],"cg_ned":[-0.06713905682046177,0.00070995070878360569,1.6408219014668965],"linear_velocity_ned":[-0.01475965790945461,0.00052869419038728191,-0.027390444036531732],"angular_velocity_ned":[0.00054614501596383371,0.045743543301438851,-0.0044350119048504324]},"sensors":{"Odom":[0.021550791631111399,-0.00042890022765667581,1.9320756487928299,0.0026243771386049615,-8.3690327144660516e-05,-0.03137140235389272,0.00099337873221884204,0.064587860792231389,-0.0021576272690517111,0.99790919731283445,0.00092218791687138522,0.045737892251165722,-0.0044310428357182225],"Pressure":[11385.043373252529],"DVL":[-0.027460982255363496,-0.014556897495880572,0.042705446485304666,8.6239384930546681,0.036589248191379611,0.010880034803680379,0.0034484593798359128,0],"IMU":[0.0017182276904547495,0.12926965649406388,-0.0042130767577433521,0.061680473554069824,0.07335457383229961,-0.020048328836823313,1.3000668725211653,-0.031512492501801624,-9.723925622468915],"FOG":[-0.0018593842433198391],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5610871737393528,-21.224917841550987,-29.177311925641956,63.251721767313434,63.251721767313434],"omega_rad_s":[-4.0515201251461175,-23.088483563449508,-30.621664333096582,64.382842914502589,64.381768270081537],"thrust_n":[-0.20891790273138722,-6.6398427070569488,-11.781790156138216,53.103962566320675,54.581053428565752],"torque_nm":[0.0039172106762135105,0.12449705075731779,0.22090856542759163,-0.99569929811851265,-1.0233947517856081],"angle_rad":[-6.1997629922521593,-46.045828772931429,-51.031655045553244,88.131558660774658,88.127137310652131]},"command":[-0.033915115940374788,-0.20214207468143797,-0.27787916119659006,0.60239735016488982,0.60239735016488982],"arm":{"servo_position":[1.5881867761018134e-23,-1.0842021724855046e-21,1.0778494253810964e-21,0,-1.4314856808597677e-21,-8.6736173798840357e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.025230399787854053,-1.8653679303913817,-0.31900894223434689,-3.8893250436070592e-05,-0.00037217335959340725,-0.00010580960120507372]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":47,"step":376,"t":1.8800000000000001,"sim_time":1.8799999999999819,"vehicle":{"origin_ned":[0.021477338649286845,-0.00042901729689357392,1.9308425783373275],"origin_quat_xyzw":[0.0010065837099385055,0.06546462124330843,-0.0022465013628246567,0.99785185442846758],"cg_ned":[-0.067724012456365917,0.00073109517619522233,1.6397451640046117],"linear_velocity_ned":[-0.014513353706029821,0.00052834988778340496,-0.026549771935666936],"angular_velocity_ned":[0.00040890939976406674,0.042527634452049386,-0.0044425442278307244]},"sensors":{"Odom":[0.021477338649286845,-0.00042901729689357392,1.9308425783373275,0.0018439636334097388,-4.8865427284033825e-05,-0.030363077046444722,0.001006583709938533,0.06546462124331022,-0.0022465013628247183,0.99785185442846758,0.00080076842172787646,0.042521388518427343,-0.0044489759046667044],"Pressure":[11364.944910920602],"DVL":[0.014491760070025774,-0.00038269164266908039,0.015086688880379914,8.5642228931501077,0.040723839809739183,0.036965110282510899,0.041579750107459942,0],"IMU":[0.0017295361745529982,0.13102710273708615,-0.0043891970490159953,0.05035582161972698,0.069491813059423396,0.21334073652488686,1.3032951441505827,-0.018498698888148962,-9.7126888853390199],"FOG":[0.0096436354094873826],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.3356685906626447,-20.533097325036845,-28.824667122909034,63.46104344066773,63.46104344066773],"omega_rad_s":[-3.8562604853372391,-22.39829722076346,-30.253714046732174,64.594570176395138,64.59370059650135],"thrust_n":[-0.18925747139085719,-6.2483765288316242,-11.504117267331909,53.473587713770108,54.852447985145879],"torque_nm":[0.0035485775885785724,0.11715705991559296,0.21570219876247335,-1.0026297696331896,-1.0284833997214853],"angle_rad":[-6.3574197507072077,-46.953678917935854,-52.248151007916789,90.711738565576809,90.707278845082925]},"command":[-0.031768272292025189,-0.19555330785749375,-0.27452063926580034,0.60439088991112122,0.60439088991112122],"arm":{"servo_position":[1.5881867761018134e-23,-1.0842021724855046e-21,5.4146581153231142e-21,0,-1.4314856808597677e-21,-8.6736173798840357e-21],"servo_velocity":[0,0,8.6736173798840355e-19,0,0,0],"servo_effort":[-0.023443997822077005,-1.8925446709149967,-0.32646636576708959,-3.8940022065315547e-05,-0.00040008441283001815,-7.2414716180630874e-05]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":48,"step":384,"t":1.9199999999999999,"sim_time":1.9199999999999811,"vehicle":{"origin_ned":[0.021376776056077226,-0.00042766094692286332,1.9296539076462444],"origin_quat_xyzw":[0.0010171643646938271,0.066277212413050762,-0.0023355802713941726,0.99779799636810573],"cg_ned":[-0.068298409745410363,0.00075219574307763284,1.6387021925441045],"linear_velocity_ned":[-0.01423586190959406,0.00052666676444665828,-0.025703097947503334],"angular_velocity_ned":[0.00026864268074355634,0.039318564808233057,-0.0044446415808522153]},"sensors":{"Odom":[0.021376776056077226,-0.00042766094692286332,1.9296539076462444,0.0010891951186482959,-1.3786159588554109e-05,-0.029343075455874952,0.0010171643646938362,0.066277212413051359,-0.0023355802713941939,0.99779799636810573,0.00067620274046570588,0.039311696890231951,-0.0044620380674862126],"Pressure":[11346.603718495786],"DVL":[-0.0054039064113915927,0.0047691187250639977,0.01001595360601484,8.6166372909895639,-0.0081387223032396341,0.0046123503900199515,-0.011810751775324077,0],"IMU":[0.0017355065055432693,0.13265602034611379,-0.0045661787762415421,-0.0095002887540756083,0.0186300483203128,0.19590812546044914,1.3434499501842045,-0.0029200171413507562,-9.7065078241365068],"FOG":[0.0051264160716131442],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.0863600745632804,-19.824255085583559,-28.469501320722149,63.660840674731432,63.660840674731432],"omega_rad_s":[-3.6407201042587891,-21.689362041894796,-29.880050777448364,64.795554015668316,64.79488868636949],"thrust_n":[-0.16868273045639151,-5.8587816767552088,-11.225722776319449,53.82625046408041,55.106170276505146],"torque_nm":[0.0031628011960573407,0.10985215643916017,0.21048230205598972,-1.0092421962015077,-1.0332406926844717],"angle_rad":[-6.5068090105358358,-47.833492045213561,-53.449794526374454,93.300141126320113,93.295651222290161]},"command":[-0.029393905472031242,-0.1888024293865101,-0.27113810781640141,0.60629372071172793,0.60629372071172793],"arm":{"servo_position":[1.5881867761018134e-23,-1.0842021724855046e-21,1.0778494253810964e-21,0,-1.4314856808597677e-21,-8.6736173798840357e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.021698881096920367,-1.9174090429237445,-0.33342013904358903,-3.8981794845302151e-05,-0.00042665146366672367,-4.0010427093353642e-05]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":49,"step":392,"t":1.96,"sim_time":1.9599999999999802,"vehicle":{"origin_ned":[0.021250513293868067,-0.00042482998020499003,1.9285099915383468],"origin_quat_xyzw":[0.0010250667991476771,0.067025888062372224,-0.0024247625161589203,0.99774776376309049],"cg_ned":[-0.068861037042179107,0.00077319911409809677,1.6376932025567952],"linear_velocity_ned":[-0.013928792062883905,0.00052365715057795881,-0.024851500907483712],"angular_velocity_ned":[0.00012607685487260313,0.036125891598094102,-0.0044414380833768825]},"sensors":{"Odom":[0.021250513293868067,-0.00042482998020499003,1.9285099915383468,0.00036178505217105469,2.1350206847213556e-05,-0.028313109355141999,0.0010250667991476812,0.067025888062372502,-0.0024247625161589303,0.99774776376309049,0.0005491716727001459,0.036118376864492631,-0.0044702991541326108],"Pressure":[11326.905226019286],"DVL":[0.0039201920258807024,-0.027825421607727659,0.0078932077590386091,8.6019533775895312,0.0049532154925988484,-0.0054310226390314655,0.0098355922564047678,0],"IMU":[0.0017360729209555837,0.13415689655366547,-0.0047438343120729774,0.042592732132815073,0.026372721605036533,0.037234348104222298,1.3624930558877519,-0.019148286631124844,-9.7386226763767088],"FOG":[-0.010422539507459522],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-2.8083803701506111,-19.098799603776868,-28.113253233350289,63.851535752458062,63.851535752458062],"omega_rad_s":[-3.4021976037249146,-20.962331680926951,-29.50224428744443,64.986298029826486,64.985835372542823],"thrust_n":[-0.14729337988967184,-5.4723687906300658,-10.94790431525877,54.162510299875642,55.343151454063793],"torque_nm":[0.0027617508729313473,0.10260691482431376,0.20527320591110193,-1.0155470681226684,-1.0376840897636963],"angle_rad":[-6.6470607365111878,-48.684533353986559,-54.636392953836392,95.896348151631045,95.891836201019714]},"command":[-0.026746479715720108,-0.18189332955977969,-0.26774526888905037,0.60810986430912439,0.60810986430912439],"arm":{"servo_position":[1.5881867761018134e-23,-1.0842021724855046e-21,1.0778494253810964e-21,0,-1.4314856808597677e-21,-8.6736173798840357e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.01998958684974975,-1.9399894979898005,-0.33987287655135073,-3.9006103822200198e-05,-0.00045182553205193413,-8.6592210692294486e-06]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":50,"step":400,"t":2,"sim_time":1.9999999999999793,"vehicle":{"origin_ned":[0.0210999960250043,-0.00042053087413621861,1.9274110968973706],"origin_quat_xyzw":[0.0010302509214484661,0.067711084432524202,-0.0025139482942144065,0.99770127177025503],"cg_ned":[-0.069410749048258669,0.00079405270206885895,1.6367183702180876],"linear_velocity_ned":[-0.01359383358537695,0.00051934419980173118,-0.023995861779092173],"angular_velocity_ned":[-1.8089986859414248e-05,0.032958383018014126,-0.004433031058734346]},"sensors":{"Odom":[0.0210999960250043,-0.00042053087413621861,1.9274110968973706,-0.00033687279327239677,5.6367956399194478e-05,-0.027274696685997704,0.0010302509214484851,0.067711084432525451,-0.0025139482942144525,0.99770127177025503,0.0004203176643492023,0.032950199122524997,-0.0044737918619935082],"Pressure":[11307.12326967734],"DVL":[0.036442608789157768,0.018383417998653184,-0.010072174720040189,8.5892895749080971,0.012973392890055483,0.024094772271228259,0.0014405362824599791,0],"IMU":[0.0017311972955431844,0.13553058568336951,-0.0049219752933446007,-0.099124295954616373,0.021867380734825276,0.11389185665147875,1.370839958991517,-0.032161843679193253,-9.6780100531866644],"FOG":[0.0082552905678300783],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-2.4938737936221069,-18.356994178770197,-27.757309986321054,64.0335270306891,64.0335270306891],"omega_rad_s":[-3.1364767055256992,-20.217751166131574,-29.121830787250754,65.167280995307294,65.167018705223242],"thrust_n":[-0.12517114474505353,-5.0903720304688305,-10.671877794504972,54.482909359257079,55.564282145084334],"torque_nm":[0.0023469589639697535,0.095444475571290571,0.20009770864696824,-1.0215545504860704,-1.0418302902203316],"angle_rad":[-6.7771644789537904,-49.506091780428413,-55.80781570708286,98.499961036967349,98.495435097105158]},"command":[-0.02375117898687721,-0.17482851598828761,-0.26435533320305765,0.60984311457799145,0.60984311457799145],"arm":{"servo_position":[1.5881867761018134e-23,-1.0842021724855046e-21,1.0778494253810964e-21,0,-1.4314856808597677e-21,-8.6736173798840357e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.01830364480487123,-1.9604781069436472,-0.34585936359416491,-3.9017209548654812e-05,-0.00047562376173940354,2.1566197588481035e-05]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":51,"step":408,"t":2.04,"sim_time":2.0399999999999787,"vehicle":{"origin_ned":[0.020926697379075987,-0.00041477648640158009,1.9263574335224822],"origin_quat_xyzw":[0.0010326893020760433,0.068333404638628942,-0.0026030385365677215,0.99765861072496931],"cg_ned":[-0.069946466253721584,0.00081470516661780602,1.6357778608793787],"linear_velocity_ned":[-0.01323257612061671,0.00051376300682289661,-0.023135879638207821],"angular_velocity_ned":[-0.00016321291533736928,0.029824393091463668,-0.0044194860564252952]},"sensors":{"Odom":[0.020926697379075987,-0.00041477648640158009,1.9263574335224822,-0.0010055531460420727,9.1122351579729372e-05,-0.026228179152368501,0.0010326893020760524,0.068333404638629539,-0.002603038536567744,0.99765861072496931,0.00029022485330871661,0.02981552025354486,-0.0044725205732109048],"Pressure":[11291.397659752749],"DVL":[0.025931762678283701,0.013914805048190173,0.00051925440862579837,8.6129944472906139,-0.0011168189480507058,-0.002448993347216169,0.022136082441228236,0],"IMU":[0.0017208667824124065,0.13677827802558049,-0.0051004108420921457,-0.0012856641910889729,0.00063569257877547219,0.11723502013137191,1.3549461719755309,-0.011092111502613151,-9.7162876145993273],"FOG":[0.0042888715538378329],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-2.1283536063519017,-17.598827534729669,-27.402893634948306,64.207005833725276,64.207005833725276],"omega_rad_s":[-2.8364019810099275,-19.456006062548031,-28.740274265318206,65.338917368162001,65.338852462364926],"thrust_n":[-0.10235067917254592,-4.7139320677775105,-10.398749958203764,54.787877144380936,55.770320773244315],"torque_nm":[0.0019190752344852363,0.08838622627082833,0.19497656171632063,-1.0272726964571428,-1.045693514498331],"angle_rad":[-6.895879404353761,-50.297474543313832,-56.96399209759042,101.11059913771608,101.10606715832732]},"command":[-0.020270034346208589,-0.16760788128313969,-0.26097993938046005,0.61149529365452637,0.61149529365452637],"arm":{"servo_position":[1.5881867761018134e-23,-1.0842021724855046e-21,1.0778494253810964e-21,0,-1.4314856808597677e-21,-8.6736173798840357e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.016630780468926996,-1.9790260141860736,-0.35138979867831649,-3.9016145566198297e-05,-0.00049799406005410901,5.062758782177263e-05]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":52,"step":416,"t":2.0800000000000001,"sim_time":2.0799999999999779,"vehicle":{"origin_ned":[0.020732120358009809,-0.00040758663930704148,1.9253491637288063],"origin_quat_xyzw":[0.0010323677513190581,0.068893623254708436,-0.002691935918164831,0.99761984561889949],"cg_ned":[-0.070467175052342387,0.00083510639454301237,1.634871839722446],"linear_velocity_ned":[-0.012846756102284555,0.00050694097282391571,-0.02227208957437259],"angular_velocity_ned":[-0.00030854954994855672,0.026732644610350575,-0.0044009875872163843]},"sensors":{"Odom":[0.020732120358009809,-0.00040758663930704148,1.9253491637288063,-0.001642940077866183,0.00012541885378391263,-0.025174792298894171,0.0010323677513190551,0.068893623254708242,-0.0026919359181648236,0.99761984561889949,0.000159585049026269,0.026723066205774627,-0.0044665923929574618],"Pressure":[11277.353900015067],"DVL":[0.015372592868078017,-0.012330057062017166,0.011560137068210848,8.5437248509435797,-0.026512359366763421,0.0053655107995081294,0.043973307113393763,0],"IMU":[0.0017050945606689766,0.13790150916539079,-0.0052789495041124755,-0.06632774898439836,0.032218596058592418,-0.17371096021776247,1.376231538886483,-0.017716366145303523,-9.6439771944403407],"FOG":[-0.0041317183890134919],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-1.6810669642887468,-16.824326074883466,-27.051383989093015,64.371972398542667,64.371972398542667],"omega_rad_s":[-2.4882504488341164,-18.677359492781246,-28.359013352338629,65.501481201481241,65.501610055650644],"thrust_n":[-0.078747830620292308,-4.3441263163847799,-10.129554769593424,55.077631354838282,55.961823765998552],"torque_nm":[0.001476521824130481,0.081452368432214622,0.18992915192987672,-1.0327055879032176,-1.0492841956124728],"angle_rad":[-7.0015430308664817,-51.058001284082323,-58.104909162036542,103.72789496134885,103.72336475831716]},"command":[-0.016010161564654731,-0.16023167690365206,-0.25763222846755252,0.61306640379564448,0.61306640379564448],"arm":{"servo_position":[1.5881867761018134e-23,-1.0842021724855046e-21,1.0778494253810964e-21,0,-5.7682943708017857e-21,-8.6736173798840357e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.015020240656223375,-1.9953224787209616,-0.35641324799301249,-3.9008505961003803e-05,-0.00051884977297400408,7.8420183035877062e-05]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":53,"step":424,"t":2.1200000000000001,"sim_time":2.119999999999977,"vehicle":{"origin_ned":[0.020517786714516595,-0.00039899179365818801,1.9243863731662354],"origin_quat_xyzw":[0.00102929077894776,0.069392678367653934,-0.0027805497058979497,0.99758501657392018],"cg_ned":[-0.070971934125217087,0.00085520781297865312,1.6340004411804876],"linear_velocity_ned":[-0.012438210133273104,0.00049892917358964944,-0.021405262305799064],"angular_velocity_ned":[-0.00045292949648965156,0.023690824202944893,-0.0043781434659911946]},"sensors":{"Odom":[0.020517786714516595,-0.00039899179365818801,1.9243863731662354,-0.0022480832261632788,0.00015891952066451537,-0.024115991267002607,0.0010292907789477745,0.06939267836765492,-0.0027805497058979891,0.99758501657392018,2.9574779422042409e-05,0.023680528795482773,-0.0044564692359719965],"Pressure":[11262.580755917912],"DVL":[-0.062322991403709289,-0.014740383842818269,-0.007352944573033442,8.5595093907004092,0.01245483917650715,-0.0043503067686498547,0.00080521718968689499,0],"IMU":[0.0016839299295399017,0.13890214419414354,-0.0054574082848968374,0.0095685795141260566,0.097095871544345111,-0.069314086068841763,1.4057885656814102,-0.015650956923536605,-9.7145163695674093],"FOG":[-0.026454982831743683],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-1.0578216056517054,-16.03320691407734,-26.704262518330605,64.528811986323689,64.528811986323689],"omega_rad_s":[-2.0575416156316688,-17.881930996836243,-27.979517133204496,65.655270912789931,65.655589292737716],"thrust_n":[-0.053820375578640271,-3.9819703773062707,-9.8652957397615371,55.3524676213692,56.139398252133134],"torque_nm":[0.0010091320420995053,0.074661944574492572,0.18497429512052888,-1.0378587679006726,-1.0526137172274965],"angle_rad":[-7.0915407589303632,-51.786999258331967,-59.230612154867082,106.35149232052876,106.34697155091294]},"command":[-0.010074491482397193,-0.15269720870549847,-0.25432630969838671,0.61456011415546374,0.61456011415546374],"arm":{"servo_position":[-1.7999450129153881e-23,-1.0842021724855046e-21,1.0778494253810964e-21,0,-5.7682943708017857e-21,-4.3368086899420178e-21],"servo_velocity":[0,0,0,0,0,8.6736173798840355e-19],"servo_effort":[-0.013784462032618038,-2.0082956960962832,-0.36063161111696634,-3.9020429928752297e-05,-0.00053820512511383979,0.00010492857742173291]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":54,"step":432,"t":2.1600000000000001,"sim_time":2.1599999999999762,"vehicle":{"origin_ned":[0.020285228039767206,-0.00038903590211419523,1.9234690786086706],"origin_quat_xyzw":[0.0010234824496045615,0.06983165061365855,-0.0028687972457526923,0.99755414041474955],"cg_ned":[-0.071459871115287649,0.00087496030207872026,1.6331637727221917],"linear_velocity_ned":[-0.012008513300281432,0.0004895869908097838,-0.020535990306599645],"angular_velocity_ned":[-0.00059596837773506545,0.020705982242373518,-0.0043508977944627164]},"sensors":{"Odom":[0.020285228039767206,-0.00038903590211419523,1.9234690786086706,-0.0028199796760912622,0.00019138271673229965,-0.023053006850476048,0.0010234824496045806,0.069831650613659854,-0.002868797245752746,0.99755414041474955,-9.9498271985694656e-05,0.020694960694950457,-0.0044420594857493417],"Pressure":[11247.823422660031],"DVL":[-0.0032621538930055361,-0.014211995881083845,-0.010665151456949828,8.5964960350374877,-0.024889898722935296,0.012762293893509937,0.03074059146273567,0],"IMU":[0.0016574596555826815,0.13978233576252264,-0.0056356155865072265,-0.013731757195851339,-0.022903935419980405,0.084610051569049327,1.4029618733101046,-0.018931358479025773,-9.6841716420679766],"FOG":[-0.010621342196807269],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[0.75669609553379513,-15.224369416588655,-26.363053202646292,64.677845808484406,64.677845808484406],"omega_rad_s":[-1.2925311106428223,-17.06947687010144,-27.60328983942334,65.800602373687951,65.801105483179583],"thrust_n":[-0.021198523873745722,-3.6283404232668337,-9.6069490637538806,55.612728126893224,56.303671102588758],"torque_nm":[0.00039747232263273233,0.068031382936253146,0.18013029494538527,-1.0427386523792481,-1.0556938331735393],"angle_rad":[-7.1582626155662741,-52.483792524198471,-60.341205884294936,108.98104744764227,108.9765435863259]},"command":[0.0072066294812742392,-0.14499399444370148,-0.25107669716805991,0.61597948389032764,0.61597948389032764],"arm":{"servo_position":[-1.7999450129153881e-23,-1.0842021724855046e-21,1.0778494253810964e-21,0,-5.7682943708017857e-21,-4.3368086899420178e-21],"servo_velocity":[-3.3881317890172014e-21,0,0,0,0,0],"servo_effort":[-0.012363904561638989,-2.0191491877423426,-0.36434616947148762,-3.9022463095218443e-05,-0.00055598411574033369,0.00013004299007070619]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":55,"step":440,"t":2.2000000000000002,"sim_time":2.1999999999999753,"vehicle":{"origin_ned":[0.020035986729523461,-0.0003777639485855733,1.9225972408776273],"origin_quat_xyzw":[0.0010149607656802415,0.070211751828073876,-0.0029565818843631212,0.99752721185110438],"cg_ned":[-0.071930175179229131,0.00089430839710010011,1.6323619252681421],"linear_velocity_ned":[-0.011559288790822622,0.00047901067008482789,-0.0196645406826821],"angular_velocity_ned":[-0.00073751648603091844,0.017783939119940761,-0.0043186861576037941]},"sensors":{"Odom":[0.020035986729523461,-0.0003777639485855733,1.9225972408776273,-0.0033580848990557776,0.00022291693567304166,-0.021986710755849636,0.0010149607656802491,0.070211751828074404,-0.0029565818843631437,0.99752721185110438,-0.00022762544967905134,0.017772184270125578,-0.004422795975417006],"Pressure":[11237.073962408085],"DVL":[0.012420419856285305,0.015093190443906647,0.011033830645484022,8.5938832755634742,0.007187988864724458,-0.011258242074345051,-0.037225953731724902,0],"IMU":[0.0016257592886451525,0.14054450117969505,-0.0058133704415187998,-0.027965291493206465,0.069536148526639321,0.1414995697015872,1.397659439870869,-0.015326628936298511,-9.6759373943816627],"FOG":[-0.017553214680252553],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[1.4994010397317445,-14.398150970462808,-26.02870731329029,64.819307930439038,64.819307930439038],"omega_rad_s":[-0.3743909456747147,-16.239829773950962,-27.231726374107502,65.937776489528204,65.938459016078113],"thrust_n":[-0.001755821458161916,-3.2841897307777321,-9.3553595617727012,55.858745481288935,56.455227065621138],"torque_nm":[3.2921652340535924e-05,0.061578557452082475,0.17541299178323813,-1.0473514777741675,-1.0585355074803964],"angle_rad":[-7.1887688515968602,-53.147695654775021,-61.436853504513024,111.61622896063662,111.61174927886458]},"command":[0.01428000990220709,-0.13712524733774104,-0.24789245060276466,0.61732674219465744,0.61732674219465744],"arm":{"servo_position":[-1.0587911840678734e-24,-1.0842021724855046e-21,1.0778494253810964e-21,0,-5.7682943708017857e-21,-4.3368086899420178e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.011207320834274427,-2.0271413673622423,-0.36772059102557575,-3.9047162596779398e-05,-0.00057226118529610443,0.00015380213785227441]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":56,"step":448,"t":2.2400000000000002,"sim_time":2.2399999999999745,"vehicle":{"origin_ned":[0.0197715878715784,-0.00036521078411389776,1.9217707755672677],"origin_quat_xyzw":[0.0010037741496766639,0.070534296080964315,-0.0030438140893545213,0.99750420586061117],"cg_ned":[-0.072382108235895165,0.00091322607145714939,1.631594978120005],"linear_velocity_ned":[-0.011092473375125282,0.00046821316874884827,-0.018791323323472678],"angular_velocity_ned":[-0.00087557292153508915,0.014929984884122033,-0.0042823520587845299]},"sensors":{"Odom":[0.0197715878715784,-0.00036521078411389776,1.9217707755672677,-0.00386230601064872,0.00025387582557986324,-0.020918151872986568,0.0010037741496766843,0.070534296080965744,-0.0030438140893545829,0.99750420586061117,-0.00035276803113077075,0.014917500522428958,-0.0043992440959735434],"Pressure":[11224.919223528448],"DVL":[-0.0065117005928877489,-0.014951890442636928,0.0053264235197696026,8.5992730878201176,0.017639493908396042,-0.040720940284713313,0.014591932914231547,0],"IMU":[0.001588963646195287,0.14119126458573392,-0.005990480080808114,0.057192329958628121,-0.012900586466278747,-0.077438423734081274,1.4172829214900187,-0.029154206965390044,-9.6566524698469944],"FOG":[0.0014587642160255919],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[1.9790224493770103,-13.552354653331326,-25.702270150848452,64.953353281497058,64.953353281497058],"omega_rad_s":[0.42322827566938276,-15.392371158938388,-26.866090826645397,66.067051531690666,66.067907713743466],"thrust_n":[0.0023205888240649172,-2.9503308059769258,-9.111234781423688,56.090806664673472,56.594573094129082],"torque_nm":[-4.3511040451217202e-05,0.055318702612067366,0.17083565215169416,-1.0517026249626276,-1.0611482455149204],"angle_rad":[-7.1852351259721976,-53.7780090110654,-62.517770453448612,114.25671653242658,114.25226807863048]},"command":[0.018847832851209622,-0.12907004431744121,-0.24478352524617575,0.61860336458568632,0.61860336458568632],"arm":{"servo_position":[-1.0587911840678734e-24,-1.0842021724855046e-21,1.0778494253810964e-21,0,-5.7682943708017857e-21,-4.3368086899420178e-21],"servo_velocity":[0,0,8.6736173798840355e-19,0,0,0],"servo_effort":[-0.010218090457597331,-2.0330977394224248,-0.37066268738727087,-3.9075864162934022e-05,-0.000586933272311493,0.00017609480320251674]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":57,"step":456,"t":2.2800000000000002,"sim_time":2.2799999999999736,"vehicle":{"origin_ned":[0.019493536543979798,-0.00035140296832801923,1.9209895413038858],"origin_quat_xyzw":[0.00098999341080278675,0.070800708255591926,-0.0031304088110390752,0.99748507766493866],"cg_ned":[-0.072815012817126504,0.00093170983996397757,1.6308629881109966],"linear_velocity_ned":[-0.010610122642015479,0.00045726289597327062,-0.017916932261627144],"angular_velocity_ned":[-0.0010097884391879039,0.012149569587192061,-0.0042417188793583598]},"sensors":{"Odom":[0.019493536543979798,-0.00035140296832801923,1.9209895413038858,-0.0043325906919485756,0.00028423914981418649,-0.019848596665769453,0.00098999341080280518,0.070800708255593245,-0.0031304088110391337,0.99748507766493866,-0.00047466764547425782,0.012136362697485008,-0.0043711879390938247],"Pressure":[11214.803825272949],"DVL":[-0.0071870137432310677,-0.037424859534817133,0.0038044384693498561,8.6970099990380163,0.022824118675082109,-0.0037404583585128959,0.0059529632212155376,0],"IMU":[0.0015472507293221129,0.14172547409101502,-0.0061667558478942976,-0.022848792922573108,-0.02945787633498716,-0.10503797830670873,1.4260978395307824,-0.015368343242680939,-9.6511159023348192],"FOG":[-0.0085354026892980293],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[2.3639687029089003,-12.684438863446713,-25.384846753128802,65.080300272441718,65.080300272441718],"omega_rad_s":[1.0994493289312901,-14.525805960860957,-26.507623944990872,66.188697358601544,66.189721029139307],"thrust_n":[0.015509653395068164,-2.6274077734302388,-8.8752208145329323,56.309229783044294,56.722257518592954],"torque_nm":[-0.00029080600115752813,0.049263895751816979,0.16641039027249249,-1.0557980584320807,-1.0635423284736181],"angle_rad":[-7.1526011741866364,-54.373991949176165,-63.584222378784752,116.90220027538278,116.89778985829209]},"command":[0.022513987646751433,-0.12080417965187346,-0.24176044526789336,0.61981238354706403,0.61981238354706403],"arm":{"servo_position":[-1.0587911840678734e-24,-1.0842021724855046e-21,1.0778494253810964e-21,0,-5.7682943708017857e-21,-4.3368086899420178e-21],"servo_velocity":[0,0,8.6736173798840355e-19,0,0,0],"servo_effort":[-0.0095268932602039415,-2.0357082906914283,-0.37266070479153168,-4.2406747833179185e-05,-0.00059879111116328755,0.0001968341498844878]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":58,"step":464,"t":2.3199999999999998,"sim_time":2.3199999999999728,"vehicle":{"origin_ned":[0.019203315052732067,-0.000336376482256962,1.9202533406191107],"origin_quat_xyzw":[0.00097368754286028417,0.071012523445670342,-0.0032162742744454237,0.99746976346465677],"cg_ned":[-0.073228314717600745,0.00094974517923118664,1.630165989567244],"linear_velocity_ned":[-0.010114344761885882,0.00044581290762822276,-0.017041935603403471],"angular_velocity_ned":[-0.0011402285582706631,0.0094486376465535461,-0.0041964939315898547]},"sensors":{"Odom":[0.019203315052732067,-0.000336376482256962,1.9202533406191107,-0.0047687936352026929,0.00031370258658172683,-0.018779328061761653,0.00097368754286030542,0.071012523445671896,-0.003216274274445494,0.99746976346465677,-0.00059349803841778905,0.0094347160045248086,-0.004338355662136654],"Pressure":[11206.559120524291],"DVL":[0.013593528445027142,0.018094097833127844,-0.0062611338955615645,8.6156475518445745,-0.02256829382332377,0.0056556726663273792,-0.0067738361252587297,0],"IMU":[0.0015007943385781553,0.14215020036509579,-0.0063419942444437379,-0.018216397040459895,0.067125116664633985,-0.010513690098761123,1.4314112458978561,-0.00055216404516846354,-9.6689420274384972],"FOG":[-0.0037393379692560805],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[2.6930095651198847,-11.79144570909048,-25.077118017682988,65.200456450902067,65.200456450902067],"omega_rad_s":[1.6720329768364623,-13.638300617760526,-26.157409549369291,66.303002092832344,66.304186713704766],"thrust_n":[0.035794465423360025,-2.3160220525931741,-8.6478187972853799,56.514368385718114,56.838871066464939],"torque_nm":[-0.00067114622668800058,0.043425413486122014,0.16214660244910092,-1.0596444072322146,-1.0657288324962177],"angle_rad":[-7.0953300596518361,-54.934839849411617,-64.636521069333043,119.55238155295335,119.54801572618881]},"command":[0.0256477101439989,-0.11229948294371886,-0.23882969540650464,0.62095672810382918,0.62095672810382918],"arm":{"servo_position":[-1.0587911840678734e-24,-1.0842021724855046e-21,1.0778494253810964e-21,0,-5.7682943708017857e-21,-4.3368086899420178e-21],"servo_velocity":[0,0,8.6736173798840355e-19,0,0,0],"servo_effort":[-0.0090350723739415426,-2.0361468216086176,-0.37415524570297898,-4.8906120123311806e-05,-0.00060978432315730716,0.00021580698542889517]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":59,"step":472,"t":2.3599999999999999,"sim_time":2.3599999999999719,"vehicle":{"origin_ned":[0.018902394883166418,-0.00032017547328347894,1.9195619156761665],"origin_quat_xyzw":[0.00095492293757752666,0.07117141176444429,-0.0033013167891407565,0.99745817936247172],"cg_ned":[-0.073621525671207541,0.00096730811084027289,1.6295039938010942],"linear_velocity_ned":[-0.0096073173437927952,0.00043371379050557844,-0.016166893579750357],"angular_velocity_ned":[-0.0012670935985244099,0.0068346805392131985,-0.0041467856659429935]},"sensors":{"Odom":[0.018902394883166418,-0.00032017547328347894,1.9195619156761665,-0.0051703794257932211,0.00034216324569306164,-0.017711718104427919,0.0009549229375775401,0.071171411764445289,-0.0033013167891408029,0.99745817936247172,-0.00070952157927142083,0.0068200510366429289,-0.0043008950935735906],"Pressure":[11196.542240435283],"DVL":[-0.018154495344142967,-0.017977890195855911,0.020617893752515108,8.6990475703437919,0.0040825504982701013,-0.0091694998501657358,0.029799446013320449,0],"IMU":[0.0014497614306484814,0.14246878631325058,-0.0065159869559786041,0.034244414922112769,0.013001700749039957,0.042530557371127806,1.4453178203582879,-0.027005645375904885,-9.6769816293717721],"FOG":[-0.017074394900616602],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[2.9828533034809794,-10.869486275199712,-24.780136774072581,65.314180811700936,65.314180811700936],"omega_rad_s":[2.1598229225456569,-12.727368172147335,-25.816501753721106,66.410277773559116,66.411616441004796],"thrust_n":[0.059668335496489602,-2.0167625156687614,-8.429477891036548,56.706604328944046,56.945080237673075],"torque_nm":[-0.0011187812905591801,0.037814297168789285,0.15805271045693528,-1.0632488311677009,-1.0677202544563702],"angle_rad":[-7.0171340287319088,-55.459660202318055,-65.675020543426527,122.20697376699741,122.2026588144672]},"command":[0.028408126699818851,-0.10351891690666393,-0.23600130261021504,0.62203981725429458,0.62203981725429458],"arm":{"servo_position":[-1.0587911840678734e-24,-1.0842021724855046e-21,1.0778494253810964e-21,0,-5.7682943708017857e-21,-4.3368086899420178e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.0087548347014350086,-2.0349707095113216,-0.37538074362798701,-5.6537184993727718e-05,-0.00062147089765314317,0.00023269941323935859]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":60,"step":480,"t":2.3999999999999999,"sim_time":2.399999999999971,"vehicle":{"origin_ned":[0.018592246745259527,-0.00030283825499438535,1.9189149489605342],"origin_quat_xyzw":[0.00093374706182910582,0.071279198582081177,-0.0033854865710003707,0.9974502205356407],"cg_ned":[-0.073994245252666499,0.00098437621713668984,1.6288769926347495],"linear_velocity_ned":[-0.0090912403889344146,0.00042119583765139147,-0.015292258080508795],"angular_velocity_ned":[-0.0013924579742096283,0.0043151402039696687,-0.004097220902266753]},"sensors":{"Odom":[0.018592246745259527,-0.00030283825499438535,1.9189149489605342,-0.0055368791101161547,0.00037002255467859327,-0.016647038100776668,0.00093374706182911286,0.071279198582081718,-0.0033854865710003963,0.9974502205356407,-0.00082421562164801138,0.0042997895664478817,-0.0042636922502831132],"Pressure":[11190.344459198117],"DVL":[-0.00069789019292594654,0.0023700564494023701,0.037007503024127683,8.6315097831772487,0.0080648658130456664,-0.02532103339175357,-0.022995442810110137,0],"IMU":[0.0013942722486631996,0.14268488752290762,-0.0066886157860528489,-0.010638475455101014,0.001299448275329294,-0.06288907898196007,1.4453025707650351,-0.004708349499599503,-9.6882214368748016],"FOG":[0.0030650597344319538],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[3.2444492954809916,-9.9114197486519604,-24.496133732730208,65.421837172995495,65.421837172995495],"omega_rad_s":[2.5796350949302034,-11.789273180869762,-25.486233781919733,66.510859461423863,66.512344885593464],"thrust_n":[0.085070075683107385,-1.7301125402349977,-8.2208107528077168,56.88635917835883,57.041599948626619],"torque_nm":[-0.0015950639190582636,0.032439610129406209,0.15414020161514469,-1.066619234594228,-1.0695299990367491],"angle_rad":[-6.921015788601812,-55.947436285576224,-66.700121865736534,124.86570336366921,124.86144528450103]},"command":[0.030899517099818967,-0.094394473796685335,-0.2332965117402877,0.62306511593329039,0.62306511593329039],"arm":{"servo_position":[-1.0587911840678734e-24,-1.0842021724855046e-21,1.0778494253810964e-21,0,-5.7682943708017857e-21,-4.3368086899420178e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.010588486996377771,-2.031994421854221,-0.37632691055810857,-5.6692422314933395e-05,-0.00063443365867165509,0.00025193039739621639]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":61,"step":488,"t":2.4399999999999999,"sim_time":2.4399999999999702,"vehicle":{"origin_ned":[0.018274310703960336,-0.00028439046869957484,1.9183120705025374],"origin_quat_xyzw":[0.00091018541178177143,0.071337812987558744,-0.0034687411629803042,0.99744576586168954],"cg_ned":[-0.074346161113331699,0.0010009284136252691,1.6282849550686007],"linear_velocity_ned":[-0.0085683329666651313,0.00040793528066398408,-0.014418673601143005],"angular_velocity_ned":[-0.001515505700223884,0.0018942745205885814,-0.0040412116389648691]},"sensors":{"Odom":[0.018274310703960336,-0.00028439046869957484,1.9183120705025374,-0.0058687629867706301,0.00039732120501193989,-0.015586595636667014,0.00091018541178178357,0.071337812987559701,-0.0034687411629803506,0.99744576586168954,-0.00093777090530374103,0.0018782043543250973,-0.0042201136394921122],"Pressure":[11184.12623136613],"DVL":[-0.007547754703132032,0.00085541675087727367,0.045681740205700455,8.6240570251229851,-0.002583957800146113,0.014618440749871097,0.045660283439094868,0],"IMU":[0.0013343995218052748,0.14280236872435401,-0.0068597796546500337,0.028542854988189099,-0.011891592002102457,-0.074931085092807881,1.4400838802239002,-0.014342409627725089,-9.6421384482917443],"FOG":[-0.015673645125436508],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[3.4869691291688811,-8.9019898963703064,-24.227849132822687,65.523774501453801,65.523774501453801],"omega_rad_s":[2.9462405034264108,-10.816501142293923,-25.168639056352415,66.605091161297722,66.606715696486489],"thrust_n":[0.11092428693369637,-1.4559475126927657,-8.0228224877264811,57.054127530062402,57.129111564557618],"torque_nm":[-0.0020798303800068072,0.027299015862989356,0.15042792164487159,-1.0697648911886699,-1.0711708418354557],"angle_rad":[-6.8093508354548691,-56.396914660302429,-67.712298838279423,127.52831040000905,127.52411489349666]},"command":[0.033209229801608391,-0.084780856155907677,-0.23074142031259703,0.62403594763289327,0.62403594763289327],"arm":{"servo_position":[-1.0587911840678734e-24,-1.0842021724855046e-21,-3.2589592645609214e-21,0,-5.7682943708017857e-21,-2.1684043449710085e-21],"servo_velocity":[0,0,-8.6736173798840355e-19,0,0,0],"servo_effort":[-0.0091635719718363325,-2.0284514704918344,-0.37734279976381496,-5.5887876063156903e-05,-0.00064949682041414564,0.00027340868323536449]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":62,"step":496,"t":2.48,"sim_time":2.4799999999999693,"vehicle":{"origin_ned":[0.017949991900987228,-0.00026484370180442128,1.9177528575743248],"origin_quat_xyzw":[0.00088424542006610091,0.071349283785340029,-0.0035509708150136443,0.99744467937807302],"cg_ned":[-0.074677051361606836,0.001016937977670752,1.6277278251661329],"linear_velocity_ned":[-0.008040874908196995,0.00039416410386048918,-0.013546794121751072],"angular_velocity_ned":[-0.0016394466529824545,-0.00042322731173596796,-0.0039820474083443989]},"sensors":{"Odom":[0.017949991900987228,-0.00026484370180442128,1.9177528575743248,-0.006166460208766978,0.00042490985706706674,-0.014531736592732604,0.00088424542006611349,0.071349283785341042,-0.0035509708150136946,0.99744467937807302,-0.001052963275692694,-0.00044004278746239062,-0.004173875768745618],"Pressure":[11177.582745778174],"DVL":[-0.025589665602928358,0.0052683626701649465,0.027117691199931834,8.6803343289468842,-0.020817980753363795,0.003173275764801013,-0.0070733145696204938,0],"IMU":[0.0012701869735975944,0.14282529555450399,-0.0070292438420070961,0.017886288296726987,0.07290992715452882,0.040610166419148254,1.433111819640233,-0.02332047473764215,-9.68931551924506],"FOG":[-0.016172940730000088],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[3.7150065089862356,-7.8345030861507778,-23.972572651965208,65.62037241849481,65.62037241849481],"omega_rad_s":[3.2712843238225093,-9.8020844566483287,-24.864126095992638,66.69333171167473,66.69508739957169],"thrust_n":[0.13670918831319578,-1.1950918583018959,-7.8354535346049889,57.210431225837191,57.20833521338087],"torque_nm":[-0.0025632972808724208,0.022407972343160557,0.14691475377384353,-1.0726955854844473,-1.0726562852508914],"angle_rad":[-6.6839973581392513,-56.806559503810149,-68.712067409269409,130.19454902141948,130.19042147390459]},"command":[0.035381014371297481,-0.074614315106197884,-0.22831021573300198,0.62495592779518871,0.62495592779518871],"arm":{"servo_position":[-1.0587911840678734e-24,-1.0842021724855046e-21,1.0778494253810964e-21,0,2.9053230090822499e-21,-7.4538899358378402e-22],"servo_velocity":[0,0,0,0,0,1.3552527156068805e-20],"servo_effort":[-0.0096245160719042946,-2.0251019508392458,-0.37864241265480414,-5.430056404841305e-05,-0.00064887383071171047,0.00029779249611249187]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":63,"step":504,"t":2.52,"sim_time":2.5199999999999685,"vehicle":{"origin_ned":[0.017620631330482819,-0.0002441633359196668,1.9172368379206346],"origin_quat_xyzw":[0.00085585311361422584,0.071315691721665228,-0.0036321451430587014,0.99744681419681114],"cg_ned":[-0.07498678618268767,0.0010323881888484284,1.6272055151829639],"linear_velocity_ned":[-0.0075112010770539625,0.00038002357664204488,-0.012677491600802872],"angular_velocity_ned":[-0.0017688430055487327,-0.0026355535774781444,-0.0039215675519288879]},"sensors":{"Odom":[0.017620631330482819,-0.0002441633359196668,1.9172368379206346,-0.006431303265921515,0.00045406841657565761,-0.013483881248193604,0.00085585311361424264,0.07131569172166663,-0.003632145143058773,0.99744681419681114,-0.0011740942095148812,-0.0026531765191932211,-0.0041274444208933263],"Pressure":[11174.039654124363],"DVL":[-2.6099701157158289e-07,0.0017781249573032359,0.016724369221391158,8.5895540141858895,0.0075450786102748638,0.014783352425655743,-0.032121354355944091,0],"IMU":[0.0012015007164445969,0.1427578383631857,-0.0071969448729635541,-2.6033223867471394e-05,0.071268144999589347,-0.056417973206067916,1.4356881870370208,-0.014007942779114978,-9.6772990023887377],"FOG":[-0.001183768392910089],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[3.9377473724263972,-6.6693560973991532,-23.733744040977612,65.712034357749985,65.712034357749985],"omega_rad_s":[3.5656328104854329,-8.7298202321490894,-24.574035776768742,66.775957654823173,66.777836293465569],"thrust_n":[0.16237839617459587,-0.94717502125984776,-7.6592368285125927,57.355878166519865,57.279976223271248],"torque_nm":[-0.0030445949282736726,0.017759531648622148,0.14361069053461112,-1.0754227156222478,-1.0739995541863361],"angle_rad":[-6.5463683467111098,-57.174362742893159,-69.699980751871735,132.86418811955181,132.86013359325142]},"command":[0.037502355927870448,-0.063517677118087174,-0.2260356575331201,0.62582889864523794,0.62582889864523794],"arm":{"servo_position":[-1.0587911840678734e-24,-1.0842021724855046e-21,1.0778494253810964e-21,0,2.9053230090822499e-21,-4.7433845046240786e-22],"servo_velocity":[0,0,-8.6736173798840355e-19,0,0,0],"servo_effort":[-0.010021528514702184,-2.0226601719445259,-0.38042661826791574,-5.107927513555349e-05,-0.00067138255163226178,0.00030621221976054563]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":64,"step":512,"t":2.5600000000000001,"sim_time":2.5599999999999676,"vehicle":{"origin_ned":[0.017287493648609389,-0.00022225066374280378,1.9167634877904187],"origin_quat_xyzw":[0.00082482220198372435,0.071239155389201239,-0.0037122694573169697,0.99745201461686595],"cg_ned":[-0.075275332317613519,0.0010472656459318576,1.6267178998069032],"linear_velocity_ned":[-0.0069817868550823949,0.00036557436572970875,-0.01181178110931988],"angular_velocity_ned":[-0.0019105074978112381,-0.0047409609574075046,-0.0038613609536553043]},"sensors":{"Odom":[0.017287493648609389,-0.00022225066374280378,1.9167634877904187,-0.0066647847978072074,0.00048667156827881804,-0.01244460094694997,0.0008248222019837301,0.071239155389201739,-0.0037122694573169957,0.99745201461686595,-0.0013077284838573272,-0.0047595081524777032,-0.0040833548060725221],"Pressure":[11168.85583486322],"DVL":[-0.015721008316286277,0.0071558091219877272,0.016210739959920992,8.5553093739770159,0.0177588951668976,-0.0081510551753091222,-0.0016559807236546384,0],"IMU":[0.001127973281719867,0.14260424344433478,-0.0073629070176941137,-0.02477734676298033,0.040992307954950361,0.13784247624826743,1.428941938732053,-0.0031290493518328893,-9.6857103656918451],"FOG":[-0.004957506069335137],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[4.1643974684464125,-5.3368978581732724,-23.512607514043069,65.799210192575146,65.799210192575146],"omega_rad_s":[3.8397075922198249,-7.5682792708805824,-24.299741657019077,66.853371195388348,66.855364415518792],"thrust_n":[0.18825984281480895,-0.71090118459652463,-7.4946987760224069,57.491133235393086,57.344789245613512],"torque_nm":[-0.0035298720527776684,0.013329397211184837,0.14052560205042011,-1.0779587481636204,-1.0752147983552536],"angle_rad":[-6.3974537282406327,-57.497348521612139,-70.676647124260498,135.53701220351368,135.5330354285922]},"command":[0.039660928270918216,-0.050827598649269265,-0.22392959537183876,0.62665914469119188,0.62665914469119188],"arm":{"servo_position":[-1.0587911840678734e-24,-1.0842021724855046e-21,1.0778494253810964e-21,0,1.1578940388966286e-20,1.6940658945086011e-21],"servo_velocity":[0,0,0,0,1.7347234759768071e-18,4.3368086899420177e-19],"servo_effort":[-0.010447853100227637,-2.0218869023719086,-0.38275119664996843,-4.5528486981382223e-05,-0.00069848858878184211,0.00031571286168432459]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":65,"step":520,"t":2.6000000000000001,"sim_time":2.5999999999999668,"vehicle":{"origin_ned":[0.016951734667004004,-0.00019893402708518653,1.9163322300474603],"origin_quat_xyzw":[0.00079083073085627347,0.07112178466470058,-0.0037914267904772788,0.99746012021321206],"cg_ned":[-0.075542758800558982,0.0010615612201594058,1.6262648045044883],"linear_velocity_ned":[-0.0064552442137265501,0.00035099922772411084,-0.010951101031465809],"angular_velocity_ned":[-0.0020696894425402748,-0.0067422597790839393,-0.0038067321845947069]},"sensors":{"Odom":[0.016951734667004004,-0.00019893402708518653,1.9163322300474603,-0.0068698585427367552,0.00052390823771046103,-0.011415668956108432,0.00079083073085627986,0.071121784664701163,-0.00379142679047731,0.99746012021321206,-0.001458323710487432,-0.0067618972934178267,-0.0040475830060844641],"Pressure":[11167.370727893584],"DVL":[-0.0056157734459477493,-0.0082818462590993729,-0.0038377357894984615,8.6088474894925042,-0.013094397286926166,-0.00039195929788284962,0.023554891085009355,0],"IMU":[0.0010489509176051829,0.14236873930289176,-0.0075273302527376412,-0.087860188025997557,-0.10326906998469843,0.04751627292136356,1.4285831711844039,-0.01386407988308073,-9.7014592868158083],"FOG":[0.00082885363876658482],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[4.4056416939470111,-3.6379679146202553,-23.311227538816055,65.882421355019844,65.882421355019844],"omega_rad_s":[4.1041146929649921,-6.2421187979659996,-24.042784641632348,66.926014289880342,66.928113639023564],"thrust_n":[0.21503701265159245,-0.4822518880877214,-7.3424604389966195,57.617003091995223,57.403538874281637],"torque_nm":[-0.0040319439872173596,0.0090422229016447787,0.13767113323118663,-1.0803188079749104,-1.0763163538927807],"angle_rad":[-6.237823364137383,-57.770420090601903,-71.642732607284302,138.21282273805537,138.20892810763337]},"command":[0.041958492323304869,-0.034647313472573861,-0.22201169084586719,0.62745163195256992,0.62745163195256992],"arm":{"servo_position":[-1.0587911840678734e-24,-1.0842021724855046e-21,-3.2589592645609214e-21,0,2.9053230090822499e-21,-4.7433845046240786e-22],"servo_velocity":[0,0,-8.6736173798840355e-19,0,0,0],"servo_effort":[-0.01130645554894181,-2.0237605055814374,-0.38524396140761263,-3.9639212256751988e-05,-0.00072566094762573097,0.00032423100567597533]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":66,"step":528,"t":2.6400000000000001,"sim_time":2.6399999999999659,"vehicle":{"origin_ned":[0.016614325685623377,-0.00017424669051962138,1.915942439452976],"origin_quat_xyzw":[0.00075390098337056581,0.070965543901235759,-0.0038698447593160275,0.99747097577505872],"cg_ned":[-0.075789232101668977,0.001075285410711119,1.6258459853054021],"linear_velocity_ned":[-0.005933496307305758,0.00033702749292637327,-0.010097379383046386],"angular_velocity_ned":[-0.0022054636549444723,-0.00864940326554294,-0.0037674696342042038]},"sensors":{"Odom":[0.016614325685623377,-0.00017424669051962138,1.915942439452976,-0.0070507925297730815,0.00055368436076246052,-0.010398905357343273,0.00075390098337057068,0.070965543901236217,-0.0038698447593160522,0.99747097577505872,-0.0015839440758658116,-0.0086699937395005259,-0.0040239786218950035],"Pressure":[11164.48823618626],"DVL":[0.025076394321138416,-0.037334250434110539,0.0060674017617912777,8.536112957466262,-0.021984382636798118,-0.021061544578253533,-0.01187270085114181,0],"IMU":[0.00096445239670117286,0.14205526584319922,-0.0076906558730389036,-0.0090532433439432305,-0.027007335483708539,0.013761923617771224,1.4165491259650036,-0.020449777097572841,-9.6597543878345018],"FOG":[-0.0014383230330448256],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[4.6444345769411646,1.2587720461444285,-23.131963499984082,65.962256824182589,65.962256824182589],"omega_rad_s":[4.3636123009291161,-4.1052675231389255,-23.805031263620503,66.994380060790377,66.996577193010822],"thrust_n":[0.24304973115161232,-0.20620681929637197,-7.2033318708260303,57.734501657449584,57.456961208603332],"torque_nm":[-0.0045571824590927316,0.0038663778618069746,0.13506247257798806,-1.0825219060771798,-1.0773180226613126],"angle_rad":[-6.0677171859532324,-57.976776311866367,-72.598973062712744,140.89144002576762,140.887631596462]},"command":[0.044232710256582521,0.011988305201375509,-0.22030441428556269,0.62821196975411986,0.62821196975411986],"arm":{"servo_position":[-1.7999450129153881e-23,-1.0842021724855046e-21,1.0778494253810964e-21,0,2.9053230090822499e-21,-4.7433845046240786e-22],"servo_velocity":[-6.7762635780344027e-21,0,0,0,-1.7347234759768071e-18,0],"servo_effort":[-0.014561829832532866,-2.0258079784867671,-0.38592848451799672,-3.998467110951076e-05,-0.00073615406922755298,0.00032547892093653138]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":67,"step":536,"t":2.6800000000000002,"sim_time":2.6799999999999651,"vehicle":{"origin_ned":[0.01627613046088533,-0.00014892594457844546,1.9155934653497835],"origin_quat_xyzw":[0.00071528333367576209,0.070772312766311019,-0.0039477554784828296,0.99748442761886857],"cg_ned":[-0.076014972823049753,0.0010884723511258886,1.6254611634058103],"linear_velocity_ned":[-0.0054187473195242072,0.00032405248335462127,-0.0092501115930175119],"angular_velocity_ned":[-0.0022587043609267618,-0.010460348984561385,-0.0037438059050625958]},"sensors":{"Odom":[0.01627613046088533,-0.00014892594457844546,1.9155934653497835,-0.0072088400088654806,0.00055917428124286164,-0.0093943685859430946,0.00071528333367578095,0.070772312766312892,-0.0039477554784829337,0.99748442761886857,-0.0016260808280113398,-0.010481279995132179,-0.0040044175266924359],"Pressure":[11162.585374990758],"DVL":[-0.029063136503408776,0.020864499385621481,0.016793623593279045,8.6413837782224991,-0.0013913124681484968,-0.0095694814587799354,0.041305799907648683,0],"IMU":[0.00087697007279157987,0.14166760329512731,-0.0078531582187649305,0.021250586845075071,0.053525575564646571,0.051951385493568251,1.4356391303189382,-0.011159079727865071,-9.6936633469039251],"FOG":[-0.0090021098845435334],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[4.7880410445866239,3.9899188807442547,-22.971775144275533,66.039109969144747,66.039109969144747],"omega_rad_s":[4.5952392507998008,-1.3286659294413061,-23.587228866704901,67.058963491073285,67.06125030801185],"thrust_n":[0.26951239002276994,-0.019969920339599115,-7.0773948722949047,57.844459620020693,57.505916234901242],"torque_nm":[-0.0050533573129269357,0.00037443600636748344,0.13270115385552947,-1.0845836178753878,-1.0782359294043982],"angle_rad":[-5.8877733071541707,-58.077040380935735,-73.546159383116617,143.57270453061381,143.56898603087734]},"command":[0.045600390900824989,0.037999227435659567,-0.21877881089786222,0.62894390446804516,0.62894390446804516],"arm":{"servo_position":[1.5881867761018134e-23,-1.0842021724855046e-21,-3.2589592645609214e-21,0,2.9053230090822499e-21,-4.7433845046240786e-22],"servo_velocity":[0,0,-8.6736173798840355e-19,0,0,0],"servo_effort":[-0.020348288991185303,-2.0234758506518506,-0.38636521365293752,-2.9979594731179711e-05,-0.00073330433437494315,0.00032894718708603639]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":68,"step":544,"t":2.7200000000000002,"sim_time":2.7199999999999642,"vehicle":{"origin_ned":[0.015937916193357327,-0.00012366152768299946,1.9152846586206993],"origin_quat_xyzw":[0.00067618032121520815,0.070544171927277299,-0.0040251608486947489,0.99750030609890539],"cg_ned":[-0.076220414479409831,0.0011011434019585695,1.6251101017213905],"linear_velocity_ned":[-0.0049178573971512454,0.0003110648248535275,-0.0084086712368034895],"angular_velocity_ned":[-0.0022767359729444253,-0.012160170153044486,-0.0037132793748257775]},"sensors":{"Odom":[0.015937916193357327,-0.00012366152768299946,1.9152846586206993,-0.0073462561554422223,0.00055512549809665014,-0.0084032201375265972,0.00067618032121521726,0.070544171927278257,-0.0040251608486948035,0.99750030609890539,-0.001634902391322714,-0.012181165198481926,-0.0039734137885626547],"Pressure":[11162.076681378925],"DVL":[-0.0018684864153638465,-0.015962016591136302,-0.010253131686907982,8.539058608582879,-0.031732463271259344,-0.044978007991561694,-0.014652871179630362,0],"IMU":[0.00078892962153877743,0.14120993545379401,-0.0080146565633820981,0.01379540502618452,-0.064022468732450183,0.08425489559639486,1.4096855171262217,0.0010327047688775196,-9.689418739717846],"FOG":[-0.011176816268152463],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[4.8401941137496989,5.4360539017982266,-22.823770456513163,66.112930214838102,66.112930214838102],"omega_rad_s":[4.7730277668893981,1.0949305245611372,-23.387855627035595,67.120088913655024,67.122457368445978],"thrust_n":[0.29075374865331477,0.017160149476665134,-6.9633090269049873,57.947220651343834,57.551220841157381],"torque_nm":[-0.0054516327872496514,-0.00032175280268747131,0.13056204425446852,-1.0865103872126971,-1.0790853907717011],"angle_rad":[-5.6997756152898926,-58.073882640770485,-74.485062661415057,146.2564725655337,146.25284740207354]},"command":[0.046097086797616177,0.051771941921887873,-0.2173692424429825,0.62964695442702956,0.62964695442702956],"arm":{"servo_position":[1.5881867761018134e-23,-1.0842021724855046e-21,1.0778494253810964e-21,0,2.9053230090822499e-21,-4.7433845046240786e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.020819487288182476,-2.0205030348766289,-0.38917130330555944,-3.3904617882114437e-05,-0.00075682807608327561,0.00034204876018463758]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":69,"step":552,"t":2.7600000000000002,"sim_time":2.7599999999999634,"vehicle":{"origin_ned":[0.015600432043829673,-9.866366283873911e-05,1.9150153012487516],"origin_quat_xyzw":[0.0006369701787458772,0.070283464786858929,-0.0041018639151538406,0.99751842266645241],"cg_ned":[-0.076406163132494778,0.0011132843470860402,1.6247925434276287],"linear_velocity_ned":[-0.004431555171323192,0.0002975406701371322,-0.0075743315137411114],"angular_velocity_ned":[-0.0022795553118177946,-0.013740044129231015,-0.0036757050198423743]},"sensors":{"Odom":[0.015600432043829673,-9.866366283873911e-05,1.9150153012487516,-0.0074607598465271825,0.00054684210480807635,-0.0074273308892405521,0.00063697017874588446,0.070283464786859734,-0.0041018639151538874,0.99751842266645241,-0.0016303284595269309,-0.013760980814552379,-0.0039336279210577156],"Pressure":[11161.146048965593],"DVL":[-0.0029966858033915094,0.018703983673430444,0.025226867438568043,8.5444107278292094,0.018082515777809279,-0.016380115456341781,0.016690747009294453,0],"IMU":[0.00070111974926696764,0.14068696702148073,-0.0081746895915805959,0.0071375613199417889,-0.0084408074326222694,0.11642680430535686,1.3909860267892529,0.014146489965221033,-9.6867437485379124],"FOG":[-0.0034517131041838277],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[4.8719210674770128,6.4945045193504365,-22.681847230674084,66.184390158072745,66.184390158072745],"omega_rad_s":[4.9036753107026056,3.1151005994165737,-23.203147260178579,67.178156350845072,67.180598176605969],"thrust_n":[0.30687363371819854,0.12845068316137861,-6.8585586785213746,58.043347375045386,57.59379631201169],"torque_nm":[-0.0057538806322162232,-0.0024084503092758483,0.12859797522227578,-1.0883127632821012,-1.0798836808502195],"angle_rad":[-5.5057679658218444,-57.983047718539837,-75.416331064622412,148.94261460223544,148.93908585543366]},"command":[0.046399248261685837,0.061852423993813681,-0.21601759267308651,0.63032752531497849,0.63032752531497849],"arm":{"servo_position":[1.5881867761018134e-23,-1.0842021724855046e-21,-3.2589592645609214e-21,-1.3552527156068806e-22,2.9053230090822499e-21,-4.7433845046240786e-22],"servo_velocity":[0,0,-8.6736173798840355e-19,-2.7105054312137611e-20,0,0],"servo_effort":[-0.020715207592580897,-2.0140523203514045,-0.38952572386015377,-3.6476838198287364e-05,-0.00076115863536503723,0.00034755876019563727]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":70,"step":560,"t":2.8000000000000003,"sim_time":2.7999999999999625,"vehicle":{"origin_ned":[0.015264556708337193,-7.4129007499508645e-05,1.9147846223213034],"origin_quat_xyzw":[0.00059796958857570614,0.069992514014090984,-0.0041777157477416961,0.99753858928138184],"cg_ned":[-0.076572682963690145,0.0011248656244218318,1.6245081758904705],"linear_velocity_ned":[-0.0039546156610148521,0.00028328396087594885,-0.0067483233779035709],"angular_velocity_ned":[-0.0022645028780259777,-0.015206784304550188,-0.0036312558526936955]},"sensors":{"Odom":[0.015264556708337193,-7.4129007499508645e-05,1.9147846223213034,-0.0075488470090100384,0.00053336659889082448,-0.0064669125925112233,0.00059796958857571113,0.069992514014091581,-0.0041777157477417316,0.99753858928138184,-0.0016096744542919033,-0.015227514942349142,-0.0038848446647398636],"Pressure":[11161.049338100598],"DVL":[-0.0077491106655675421,-0.0023191543421133649,0.009357284918271945,8.6781114874161318,0.01367227060559544,0.010163595633569699,0.01831158368031292,0],"IMU":[0.00061419602002152167,0.14010336106003471,-0.0083329034387149281,0.048002879890500019,-0.029512336241317449,0.01188917727922136,1.3894431454109715,-0.009642486679386459,-9.7191862620263052],"FOG":[-0.0089543281304765455],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[4.8802774032260867,7.3340613629261453,-22.552153635695639,66.253818194992334,66.253818194992334],"omega_rad_s":[4.9949685987778958,4.7780546736335863,-23.032245078299614,67.233591244222268,67.23609802617824],"thrust_n":[0.31839275596988836,0.29740854387437976,-6.7625093133256753,58.133654435953332,57.634290249900026],"torque_nm":[-0.0059698641744354072,-0.0055764101976446215,0.12679704962485638,-1.0900060206741253,-1.0806429421856254],"angle_rad":[-5.3074439971237473,-57.819693913005899,-76.340526073577038,151.63101832044862,151.62758873583905]},"command":[0.046478832411677017,0.069848203456439481,-0.21478241557805372,0.63098874471421273,0.63098874471421273],"arm":{"servo_position":[1.5881867761018134e-23,-1.0842021724855046e-21,1.0778494253810964e-21,0,2.9053230090822499e-21,-4.7433845046240786e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.019191914208544502,-2.0063274970794671,-0.38870251883176921,-3.8897897989445129e-05,-0.00075764313709922749,0.00034911940861007167]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":71,"step":568,"t":2.8399999999999999,"sim_time":2.8399999999999617,"vehicle":{"origin_ned":[0.014931304455734984,-5.0205495184968982e-05,1.9145918132125821],"origin_quat_xyzw":[0.00055942891605224691,0.069673564085684841,-0.0042525459127258844,0.99756062340097695],"cg_ned":[-0.076720257184505342,0.0011358645990382167,1.6242566344659242],"linear_velocity_ned":[-0.0034830635821408544,0.00026845616084215907,-0.0059316453313670945],"angular_velocity_ned":[-0.0022409491140346922,-0.016559409514752807,-0.0035788520046111678]},"sensors":{"Odom":[0.014931304455734984,-5.0205495184968982e-05,1.9145918132125821,-0.0076059984974416427,0.00051771885078086266,-0.0055225079656184492,0.0005594289160522609,0.069673564085686576,-0.0042525459127259902,0.99756062340097695,-0.0015824030051015368,-0.016579861604237457,-0.003827305578819956],"Pressure":[11162.076632921726],"DVL":[0.014675488005653287,-0.00024699625528381512,0.035946273268070275,8.6479089426849534,-0.00056675805948101299,0.0013715299694059221,0.020594057701652985,0],"IMU":[0.0005286816081177953,0.13946362353626804,-0.0084889122381215827,-0.032275269369345994,0.010458129619863987,-0.060926976215815179,1.3861377342332781,0.0128320966756564,-9.6490674131063283],"FOG":[-0.010921769916727424],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[4.8694504936655072,8.012484721548196,-22.436492393894675,66.321438923135091,66.321438923135091],"omega_rad_s":[5.052283815014472,6.1401869844548695,-22.87534505989424,67.286733952790797,67.289297339065257],"thrust_n":[0.32572851531931368,0.48765174282670565,-6.6751524697752469,58.21874404974222,57.673291348133688],"torque_nm":[-0.0061074096622371309,-0.0091434701780007312,0.12515910880828587,-1.0916014509326666,-1.0813742127775068],"angle_rad":[-5.1062609598470869,-57.596818048493091,-77.258202185402709,154.32158610379742,154.3182580914731]},"command":[0.046375718987290544,0.076309378300459002,-0.21368087994185403,0.63163275164890564,0.63163275164890564],"arm":{"servo_position":[1.5881867761018134e-23,-1.0842021724855046e-21,-3.2589592645609214e-21,0,2.9053230090822499e-21,-4.7433845046240786e-22],"servo_velocity":[0,0,-8.6736173798840355e-19,0,0,0],"servo_effort":[-0.016678924104316952,-1.9953530602933214,-0.3867267857980598,-3.9409942429365485e-05,-0.0007502622329665096,0.00034796760398776212]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":72,"step":576,"t":2.8799999999999999,"sim_time":2.8799999999999608,"vehicle":{"origin_ned":[0.014601888087034165,-2.695264882713439e-05,1.9144360861310585],"origin_quat_xyzw":[0.00052144541492820512,0.069328936133956853,-0.00432620593491058,0.99758433761332765],"cg_ned":[-0.076849015573902266,0.0011462604388847006,1.6240375886799423],"linear_velocity_ned":[-0.0030132883860087539,0.00025316672744442976,-0.0051225477838479465],"angular_velocity_ned":[-0.0022121311466646587,-0.017795552109215244,-0.0035201505409143937]},"sensors":{"Odom":[0.014601888087034165,-2.695264882713439e-05,1.9144360861310585,-0.0076280257366723751,0.00050084243973991921,-0.0045920650401260164,0.00052144541492820707,0.069328936133957117,-0.0043262059349105965,0.99758433761332765,-0.0015515338965843377,-0.017815680940803443,-0.0037630990015918978],"Pressure":[11167.080937208049],"DVL":[-0.011113664204997629,0.0059776928865986362,-0.0011097116823352866,8.600599708769737,-0.0050490706231087028,0.023789112264245897,-0.0055185658662243757,0],"IMU":[0.000444784979851169,0.13877241289900658,-0.0086423978501114947,-0.068945611609811081,-4.9845346284386333e-05,0.14275800230471608,1.369691119834213,-0.015188512571685395,-9.6856790078517889],"FOG":[0.00016288503733043712],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[4.8519589405651571,8.5582922700168158,-22.340833824148071,66.386887628361023,66.386887628361023],"omega_rad_s":[5.0836472686172449,7.2512870939473872,-22.734306910881767,67.337776049696942,67.340387708302799],"thrust_n":[0.3297719270394035,0.67722726171710468,-6.5974497472371105,58.298828524485174,57.711131561265034],"torque_nm":[-0.006183223631988817,-0.012698011157195715,0.12370218276069585,-1.0931030348340971,-1.0820837167737194],"angle_rad":[-4.9033963963673779,-57.325294486631876,-78.169957382977913,157.01423157119467,157.01100720781733]},"command":[0.046209132767287213,0.081507545428731579,-0.21276984594426734,0.63225607265105743,0.63225607265105743],"arm":{"servo_position":[-1.7999450129153881e-23,-1.0842021724855046e-21,1.0778494253810964e-21,0,2.9053230090822499e-21,-4.7433845046240786e-22],"servo_velocity":[-6.7762635780344027e-21,0,0,0,0,0],"servo_effort":[-0.014654730915853025,-1.9831984237683811,-0.38420865201560594,-3.8970864165496128e-05,-0.00074164834270764462,0.00034529440053235875]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":73,"step":584,"t":2.9199999999999999,"sim_time":2.91999999999996,"vehicle":{"origin_ned":[0.014277598652357074,-4.4382862803974462e-06,1.9143167173266922],"origin_quat_xyzw":[0.00048412431602670356,0.068960900963458707,-0.0043985847524111816,0.99760954897902332],"cg_ned":[-0.076958980634244264,0.0011560346406834304,1.623850761604025],"linear_velocity_ned":[-0.0025433142718937138,0.0002374364735487923,-0.0043196241430826683],"angular_velocity_ned":[-0.0021769026111316914,-0.018919661543053815,-0.0034569356134279551]},"sensors":{"Odom":[0.014277598652357074,-4.4382862803974462e-06,1.9143167173266922,-0.0076143602641891295,0.00048227887284348916,-0.0036737578854386527,0.00048412431602671364,0.068960900963460151,-0.0043985847524112736,0.99760954897902332,-0.0015156733039247156,-0.018939412718475542,-0.0036938167296801418],"Pressure":[11170.175576056801],"DVL":[-0.016968472681064245,0.0047356273489884779,0.020769264764755345,8.648365769651857,-0.018668008217227802,0.0035711404884956905,0.00042120075605701197,0],"IMU":[0.00036272343984622521,0.13803428669336001,-0.0087931179939619922,-0.088280364301116077,-0.0068817227391005827,0.071888929092530279,1.3545510270709329,-0.014164198501418816,-9.6709570931512019],"FOG":[0.011154592128287805],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[4.8257768163701282,8.9933297506298526,-22.268455630485583,66.449647399228297,66.449647399228297],"omega_rad_s":[5.0947513299819782,8.1528833308270912,-22.611778550467179,67.386647841133581,67.389299523541112],"thrust_n":[0.33120089311323198,0.85358251621393233,-6.53079889616426,58.37378954749893,57.747568070770591],"torque_nm":[-0.0062100167458730999,-0.016004672179011234,0.1224524793030799,-1.094508554015605,-1.0827669013269487],"angle_rad":[-4.6997498253753927,-57.01419864210871,-79.076486546564027,159.7088694982761,159.70575052865837]},"command":[0.045959779203525029,0.085650759529808121,-0.21208052981414841,0.63285378475455523,0.63285378475455523],"arm":{"servo_position":[1.5881867761018134e-23,3.2526065174565132e-21,5.4146581153231142e-21,0,2.9053230090822499e-21,-4.7433845046240786e-22],"servo_velocity":[6.7762635780344027e-21,8.6736173798840355e-19,0,0,0,0],"servo_effort":[-0.013109197611270277,-1.9707870036246986,-0.38144556433195459,-3.8106849559688119e-05,-0.00073257715497938196,0.00034175317904669883]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":74,"step":592,"t":2.96,"sim_time":2.9599999999999591,"vehicle":{"origin_ned":[0.013959736114106933,1.7251664255878195e-05,1.9142330870429491],"origin_quat_xyzw":[0.00044759307056297146,0.068571659125178777,-0.0044695956385571245,0.99763608091332134],"cg_ned":[-0.077050125462851449,0.0011651676968157524,1.6236959656354739],"linear_velocity_ned":[-0.0020724606995295184,0.00022118991573023768,-0.0035202664266177097],"angular_velocity_ned":[-0.0021340734579368865,-0.019934578038599403,-0.0033901398671353842]},"sensors":{"Odom":[0.013959736114106933,1.7251664255878195e-05,1.9142330870429491,-0.0075654097547710446,0.00046153160671656343,-0.0027648277168396407,0.00044759307056298138,0.06857165912518029,-0.0044695956385572234,0.99763608091332134,-0.0014735154437179512,-0.01995388592776353,-0.003620208286624768],"Pressure":[11172.042398542786],"DVL":[-0.055683085809381715,-0.007714505530753449,0.0069163327168256013,8.5685755204272986,0.027803247416371978,0.014035067633370544,-0.0083808461560177933,0],"IMU":[0.00028275398164692315,0.13725366165816219,-0.0089408778931624935,-0.066379568339529432,-0.12839067870710352,-0.22451963364838046,1.365854886862448,-0.0066852620967226169,-9.6907359156370116],"FOG":[-0.0034776142618857878],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[4.7888883323931983,9.3330023111270499,-22.220911400023329,66.508865149604688,66.508865149604688],"omega_rad_s":[5.0887245366395399,8.8789560070870372,-22.510174431918262,67.433050569997931,67.435734210451386],"thrust_n":[0.3304045950642584,1.0100871284707589,-6.4764371166030621,58.443067601001289,57.781954986301415],"torque_nm":[-0.0061950861574548467,-0.018939133658826733,0.1214331959363074,-1.0958075175187743,-1.0834116559931519],"angle_rad":[-4.4960546837928153,-56.671117078287907,-79.978586272982795,162.40540695518993,162.40239479811851]},"command":[0.045608460308506647,0.088885736296448095,-0.21162772761926979,0.63341776332956845,0.63341776332956845],"arm":{"servo_position":[-1.0587911840678734e-24,3.2526065174565132e-21,9.7514668052651321e-21,-1.3552527156068806e-22,2.9053230090822499e-21,-4.7433845046240786e-22],"servo_velocity":[0,8.6736173798840355e-19,0,-2.7105054312137611e-20,0,0],"servo_effort":[-0.011913312423109963,-1.95811859286502,-0.37849417226762055,-3.7032937511732757e-05,-0.00072312453034172617,0.00033758401707719338]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":75,"step":600,"t":3,"sim_time":2.9999999999999583,"vehicle":{"origin_ned":[0.013649573180022037,3.8020921516658491e-05,1.9141846801444693],"origin_quat_xyzw":[0.0004119962392837324,0.068163367735840918,-0.0045391671871331443,0.99766376175505866],"cg_ned":[-0.077122425688997909,0.0011736425791305171,1.6235731075669297],"linear_velocity_ned":[-0.0016013240825895805,0.00020460590558032246,-0.0027223099603906091],"angular_velocity_ned":[-0.00208337216952773,-0.020842072161454141,-0.0033205695823601594]},"sensors":{"Odom":[0.013649573180022037,3.8020921516658491e-05,1.9141846801444693,-0.0074824783495929838,0.00043862736160105414,-0.0018631775571276224,0.00041199623928373847,0.068163367735841918,-0.004539167187133211,0.99766376175505866,-0.0014246907076248981,-0.020860867532718982,-0.0035430292267039643],"Pressure":[11172.884077247889],"DVL":[-0.02667388388012484,-0.012090876486605725,0.017352502623411072,8.6106509549758954,0.018381823379155698,0.037688302326676977,-0.016019700188429381,0],"IMU":[0.00020516414387368462,0.13643486739201721,-0.0090855128812675837,-0.016326706656802571,-0.095868888607162653,0.10862718236212347,1.3588748834641406,0.0011945861730315189,-9.7310741081157808],"FOG":[-0.016967121888380208],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[4.7393757804975136,9.5881597897889712,-22.198693787179089,66.563725274837381,66.563725274837381],"omega_rad_s":[5.066926004199499,9.4565370432405764,-22.431357372888883,67.476487653058157,67.479195402571847],"thrust_n":[0.32756716761096322,1.1436182039145537,-6.4352789796089764,58.505758433403962,57.813341960065252],"torque_nm":[-0.006141884392705561,-0.021442841323397882,0.1206614808676683,-1.0969829706263243,-1.0840001617512236],"angle_rad":[-4.2929628572515117,-56.302438813606429,-80.877137534315835,165.10373414358321,165.10082990005051]},"command":[0.045136912195214415,0.091315807521799727,-0.21141613130646753,0.63394024071273702,0.63394024071273702],"arm":{"servo_position":[-1.0587911840678734e-24,-1.0842021724855046e-21,5.4146581153231142e-21,0,2.9053230090822499e-21,-4.7433845046240786e-22],"servo_velocity":[0,0,8.6736173798840355e-19,0,0,0],"servo_effort":[-0.01094448904964726,-1.9450894078470151,-0.37538120688531607,-3.5856948667607378e-05,-0.00071326206488150489,0.00033296906336938408]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":76,"step":608,"t":3.04,"sim_time":3.0399999999999574,"vehicle":{"origin_ned":[0.013348327726231582,5.7778806682163859e-05,1.9141710642528456],"origin_quat_xyzw":[0.00037747913203515002,0.067738161267509839,-0.0046072480518038255,0.99769242368727584],"cg_ned":[-0.077175899313177421,0.0011814516981383874,1.6234821700560298],"linear_velocity_ned":[-0.0011312736073869941,0.00018794812813726085,-0.0019241217635448729],"angular_velocity_ned":[-0.0020248718232562164,-0.021642780895903446,-0.0032494034908647326]},"sensors":{"Odom":[0.013348327726231582,5.7778806682163859e-05,1.9141710642528456,-0.0073672342880549066,0.00041373940553210696,-0.00096739005727360138,0.00037747913203515528,0.067738161267510782,-0.0046072480518038897,0.99769242368727584,-0.0013691307511375518,-0.02166099389941312,-0.0034634546526584467],"Pressure":[11177.426131076878],"DVL":[-0.029157660995486032,-0.024664285906928582,-0.0067434351716107385,8.6787079824204429,0.0033741025592381314,-0.042152499446702782,-0.009269382599283801,0],"IMU":[0.00013023834001831761,0.13558218783088385,-0.0092269002364920114,0.015882118289173689,-0.055212700779076029,0.084774741390817365,1.3393138401866875,-0.0064888810366868646,-9.6968363024645381],"FOG":[-0.0060920337920168247],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[4.6774798474096819,9.767813708656254,-22.201900092184399,66.613596812470533,66.613596812470533],"omega_rad_s":[5.0302620119459016,9.907184223585956,-22.376629018620203,67.516394169819989,67.519118394691233],"thrust_n":[0.32283185804745851,1.2531552476938981,-6.4079341922656434,58.560841071342807,57.8406991339439],"torque_nm":[-0.0060530973383898477,-0.023496660894260595,0.12014876610498082,-1.0980157700876776,-1.0845131087614484],"angle_rad":[-4.0910839727594599,-55.913599954629568,-81.773082679197543,167.80371959829273,167.80092406023161]},"command":[0.044547427118187446,0.09302679722529765,-0.21144666754461333,0.63441520773781457,0.63441520773781457],"arm":{"servo_position":[-1.0587911840678734e-24,-1.0842021724855046e-21,9.7514668052651321e-21,0,2.9053230090822499e-21,-4.7433845046240786e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.010326434432766237,-1.9314494605287786,-0.37208375861665377,-3.4654591333414002e-05,-0.00070291684403946163,0.00032797336381670974]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":77,"step":616,"t":3.0800000000000001,"sim_time":3.0799999999999566,"vehicle":{"origin_ned":[0.01305708370457194,7.6444180202625989e-05,1.9141918705667544],"origin_quat_xyzw":[0.00034418851074215039,0.067298156344162904,-0.0046738078697981574,0.99772190273990768],"cg_ned":[-0.077210688700489305,0.0011886013577450504,1.6234231929161904],"linear_velocity_ned":[-0.0006666551649849833,0.00017162470656455808,-0.0011244094697453585],"angular_velocity_ned":[-0.0019585255950700011,-0.022338080025494186,-0.0031775006442519935]},"sensors":{"Odom":[0.01305708370457194,7.6444180202625989e-05,1.9141918705667544,-0.0072244825389231691,0.0003871495701309386,-7.6736773163783205e-05,0.00034418851074215353,0.067298156344163515,-0.0046738078697981999,0.99772190273990768,-0.0013066864844938429,-0.02235563881733315,-0.0033823269469903531],"Pressure":[11184.429453224904],"DVL":[-0.008864325546058243,-0.027627695706632226,0.011425328065365604,8.6469709209765302,-0.00052501475673494052,0.0030532538945110799,0.0103299121091642,0],"IMU":[5.8259257154682367e-05,0.13469987081301232,-0.0093649609080117841,0.053535221000810727,-0.062392628672991862,0.014729708541886096,1.3523345713693169,-0.0027305950181336839,-9.6977095598902014],"FOG":[-0.002283158659591146],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[4.6035350544294777,9.8816349125671419,-22.229331205780877,66.658100067608814,66.658100067608814],"omega_rad_s":[4.979439829955183,10.248600229841806,-22.346653180077269,67.552238230361397,67.554971496676501],"thrust_n":[0.31633109457295,1.339040682251696,-6.3946574703511043,58.6073794467193,57.863066683828563],"torque_nm":[-0.0059312080232428134,-0.025107012792219302,0.1198998275690832,-1.098888364625987,-1.0849325003217858],"angle_rad":[-3.8909964606324503,-55.509268984596062,-82.66740359540411,170.50520978187924,170.50252344038202]},"command":[0.043843190994566454,0.094110808691115641,-0.21170791624553215,0.63483904826294113,0.63483904826294113],"arm":{"servo_position":[-1.0587911840678734e-24,-1.0842021724855046e-21,9.7514668052651321e-21,0,2.9053230090822499e-21,-4.7433845046240786e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.0098736421213844235,-1.917501451692271,-0.36875348562891785,-3.345374247327334e-05,-0.00069235062412588476,0.00032304275043018788]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":78,"step":624,"t":3.1200000000000001,"sim_time":3.1199999999999557,"vehicle":{"origin_ned":[0.012776775075863916,9.3946050172155626e-05,1.9142467646328218],"origin_quat_xyzw":[0.00031227138613434101,0.066845431692782759,-0.0047388298230757091,0.9977520404590986],"cg_ned":[-0.077227065070195389,0.0011951105019790214,1.6233962399177548],"linear_velocity_ned":[-0.00021063894355765361,0.00015590969852111408,-0.00032318630757529021],"angular_velocity_ned":[-0.0018844287555856384,-0.022930132755197716,-0.003105445973464716]},"sensors":{"Odom":[0.012776775075863916,9.3946050172155626e-05,1.9142467646328218,-0.0070579365269640947,0.00035907917365236614,0.00080843595768180694,0.00031227138613434507,0.066845431692783619,-0.0047388298230757707,0.9977520404590986,-0.0012373798554472348,-0.022946964623616822,-0.0033002363939253036],"Pressure":[11187.778487237441],"DVL":[-0.0011243197377080027,-0.021966173412719427,-0.0081939197759688491,8.5885238377893778,0.010221262506409999,-0.0057166175164018876,0.0039620633708764858,0],"IMU":[-1.0493200931042728e-05,0.13379208783154303,-0.0094996446210745874,0.0019522850985825479,-0.067803857625119549,-0.085711846952120502,1.3179369771609286,-0.018601152069448793,-9.739912318050445],"FOG":[-0.0092044440066566726],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[4.5179014868054548,9.9372016443746407,-22.279271381652734,66.69704649198124,66.69704649198124],"omega_rad_s":[4.9151063273447795,10.495906458792987,-22.341156113686274,67.583579195173982,67.58631427827433],"thrust_n":[0.30820164533213473,1.4025439602403724,-6.3952222333954802,58.644638960992417,57.879654322107001],"torque_nm":[-0.0057787808499775266,-0.026297699254506986,0.11991041687616526,-1.099586980518608,-1.0852435185395064],"angle_rad":[-3.6932513389755295,-55.093460710769897,-83.561084667304868,173.20803184213582,173.20545489558842]},"command":[0.043027633207671001,0.094640015660710869,-0.21218353696812128,0.63520996659029749,0.63520996659029749],"arm":{"servo_position":[-1.0587911840678734e-24,-1.0842021724855046e-21,1.0778494253810964e-21,0,2.9053230090822499e-21,-4.7433845046240786e-22],"servo_velocity":[0,0,-1.7347234759768071e-18,0,0,0],"servo_effort":[-0.0095468500567034726,-1.9031532495606109,-0.36540949703256526,-3.2271756305093391e-05,-0.00068162966737492572,0.00031831592158998006]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":79,"step":632,"t":3.1600000000000001,"sim_time":3.1599999999999548,"vehicle":{"origin_ned":[0.012508149242761793,0.00011022560373207652,1.9143353910143417],"origin_quat_xyzw":[0.000281868457763899,0.066382031342551232,-0.0048023006411257009,0.99778268394152902],"cg_ned":[-0.077225467028268227,0.0012010074198420693,1.6234013437851282],"linear_velocity_ned":[0.00023331742408162922,0.00014092371917879352,0.0004781995635818071],"angular_velocity_ned":[-0.001803152380487032,-0.023420263041264558,-0.0030329508282831794]},"sensors":{"Odom":[0.012508149242761793,0.00011022560373207652,1.9143353910143417,-0.0068711813842861789,0.00032981204279065949,0.0016863969845454028,0.00028186845776390231,0.066382031342552009,-0.0048023006411257573,0.99778268394152902,-0.0011618284302170221,-0.023436298983634939,-0.0032169729256669652],"Pressure":[11193.264671253908],"DVL":[-0.028688188384425783,0.036764216347349561,0.0058616872711184254,8.5778867483922419,0.024776805819278248,0.0056192804782945237,-0.00053054881429265527,0],"IMU":[-7.57536507812298e-05,0.13286294035239876,-0.0096309105608402851,0.020030470493242435,-0.060329107389576517,0.0053202179253428652,1.3009196886852077,0.0016688772048921172,-9.7261639411090748],"FOG":[-0.016887798746530666],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[4.4212155278654244,9.9437790986104257,-22.348201297454349,66.730805231700344,66.730805231700344],"omega_rad_s":[4.8378687145838457,10.662230435728443,-22.358975466307331,67.610195533975499,67.612925428752334],"thrust_n":[0.29858519370538494,1.4455201750113214,-6.4089307127598616,58.672298982960548,57.890104100862743],"torque_nm":[-0.0055984723819759675,-0.027103503281462275,0.12016745086424746,-1.1001056059305105,-1.0854394518911765],"angle_rad":[-3.4983753659897459,-54.669636368478514,-84.455081212155704,175.91199987606328,175.90953223881155]},"command":[0.042106814551099284,0.094702658082004051,-0.21284001235670807,0.63553147839714619,0.63553147839714619],"arm":{"servo_position":[-1.0587911840678734e-24,-1.0842021724855046e-21,1.0778494253810964e-21,0,2.9053230090822499e-21,-4.8111471404044257e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.0090470554443206151,-1.8880178952750188,-0.36190006604634939,-3.1100101390320412e-05,-0.00067051387095243232,0.00031340012877750453]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":80,"step":640,"t":3.2000000000000002,"sim_time":3.199999999999954,"vehicle":{"origin_ned":[0.012251857040231934,0.00012523380214674831,1.9144573430804808],"origin_quat_xyzw":[0.00025310654279662331,0.065909963191187651,-0.0048642047145922027,0.99781368611665611],"cg_ned":[-0.077206409822438968,0.0012063219905581138,1.6234384755315312],"linear_velocity_ned":[0.00066377673963019437,0.0001267074986538625,0.0012781726868370379],"angular_velocity_ned":[-0.0017153259957441546,-0.023811010882088417,-0.0029601824912560935]},"sensors":{"Odom":[0.012251857040231934,0.00012523380214674831,1.9144573430804808,-0.0066661549976422107,0.00029954368237131097,0.0025555357981990917,0.0002531065427966264,0.065909963191188456,-0.0048642047145922617,0.99781368611665611,-0.0010806340708126609,-0.02382618635229964,-0.003132784191519944],"Pressure":[11199.637246901601],"DVL":[0.019899152831177026,0.0054357834291630025,-0.0048780851629357871,8.5867349330313605,0.002867751421967032,0.034852519363046779,0.025921227196973727,0],"IMU":[-0.00013728554992296392,0.13191645684186878,-0.0097587164244585176,0.0033850250298901232,-0.062786206837053216,0.088913790164543177,1.3004700006836598,-0.0038178041181215743,-9.7249924751981709],"FOG":[-0.001967911968974014],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[4.3138611490553744,9.903293588841322,-22.434810722618032,66.759894504735854,66.759894504735854],"omega_rad_s":[4.74830250490559,10.757647736159933,-22.398678503239829,67.632112497055189,67.634830418973849],"thrust_n":[0.28762763405564085,1.4697486040628613,-6.434994054341109,58.690482037935269,57.894468817059014],"torque_nm":[-0.0053930181385432674,-0.027557786326178651,0.12065613851889583,-1.1004465382112865,-1.0855212903198566],"angle_rad":[-3.3068713557662033,-54.240797935218922,-85.350293049847053,178.61692499115023,178.6145663022422]},"command":[0.041084391895765467,0.094317081798488786,-0.21366486402493362,0.6358085190927224,0.6358085190927224],"arm":{"servo_position":[-1.0587911840678734e-24,-1.0842021724855046e-21,5.4146581153231142e-21,0,2.9053230090822499e-21,-4.8111471404044257e-21],"servo_velocity":[0,0,-8.6736173798840355e-19,0,-1.7347234759768071e-18,0],"servo_effort":[-0.0086593681128596233,-1.8725262631231803,-0.35830790126592349,-2.995597849162589e-05,-0.00065908887022612939,0.00030836975808441633]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":81,"step":648,"t":3.2400000000000002,"sim_time":3.2399999999999531,"vehicle":{"origin_ned":[0.012008461318084557,0.00013892822221916491,1.9146121678774988],"origin_quat_xyzw":[0.00022610319207585247,0.065431174209147888,-0.004924534142706518,0.9978449074292236],"cg_ned":[-0.077170462293134012,0.0012110865646239024,1.6235075447756828],"linear_velocity_ned":[0.0010794778821208906,0.0001133306810137479,0.0020752400965635943],"angular_velocity_ned":[-0.001621387274552422,-0.024105641026477647,-0.0028875265630813789]},"sensors":{"Odom":[0.012008461318084557,0.00013892822221916491,1.9146121678774988,-0.0064448692299215009,0.00026842312299603057,0.0034143939904527367,0.00022610319207585692,0.065431174209149179,-0.0049245341427066151,0.9978449074292236,-0.00099417174735150562,-0.02411989421900481,-0.0030481077810291181],"Pressure":[11206.179078083056],"DVL":[-0.011769349223748858,-0.017326026942995627,0.023567762980213174,8.5450756719896646,0.0033685734387791984,0.0083424951099738097,0.0014677253529907514,0],"IMU":[-0.00019487287727938557,0.13095654309240173,-0.0098830378550574163,0.044205091357495452,-0.040391125659606397,-0.082886277131375738,1.2774570669100394,0.00092433947874912079,-9.7170964200594714],"FOG":[0.010342712249281164],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[4.1957087642050679,9.8184305941090138,-22.5379838373848,66.784784037841405,66.784784037841405],"omega_rad_s":[4.6467946845466139,10.789883670951781,-22.458905673588884,67.649508714013905,67.652208128342465],"thrust_n":[0.27545931711042609,1.4768742396904944,-6.4726991791854971,58.699588855926294,57.893044645425199],"torque_nm":[-0.0051648621958204901,-0.027691391994196769,0.1213631096097281,-1.1006172910486181,-1.0854945871017228],"angle_rad":[-3.1192230745329677,-53.809600678923751,-86.247564385342812,181.32262299397061,181.32037262658699]},"command":[0.039959131087667313,0.09350886280103822,-0.21464746511795049,0.63604556226515629,0.63604556226515629],"arm":{"servo_position":[-1.0587911840678734e-24,-1.0842021724855046e-21,1.0778494253810964e-21,0,2.9053230090822499e-21,-4.8111471404044257e-21],"servo_velocity":[0,0,0,0,-1.7347234759768071e-18,0],"servo_effort":[-0.0083711586874320003,-1.8567833899758461,-0.35465348004594788,-2.8850947111128406e-05,-0.00064738802836142957,0.00030324385514650945]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":82,"step":656,"t":3.2800000000000002,"sim_time":3.2799999999999523,"vehicle":{"origin_ned":[0.011778441256118016,0.00015127296616383843,1.9147993716420499],"origin_quat_xyzw":[0.00020096766657558878,0.064947544549492656,-0.0049832887399606516,0.99787621622239442],"cg_ned":[-0.077118239115776269,0.0012153363882195204,1.6236084042012515],"linear_velocity_ned":[0.0014793673504716429,0.00010086745716233282,0.0028680377170788975],"angular_velocity_ned":[-0.0015217829359444428,-0.024307578658556078,-0.0028153180646847973]},"sensors":{"Odom":[0.011778441256118016,0.00015127296616383843,1.9147993716420499,-0.0062092145195161248,0.00023661303853388739,0.0042616858112521595,0.00020096766657558832,0.064947544549492503,-0.0049832887399606403,0.99787621622239442,-0.00090282975580323463,-0.02432085071253709,-0.0029633323137784797],"Pressure":[11213.098089087462],"DVL":[-0.065921025709416603,0.025485449487858178,0.035838639467066565,8.5993170344205705,-0.0018589227544404008,-0.00039004042239418216,-0.030206098388912205,0],"IMU":[-0.00024831794178035348,0.129986970422132,-0.010003868169419165,-0.017793507975149652,0.059905559634736122,-0.0034260907565724671,1.2874722606288072,-0.0075532414461026215,-9.7274339769939253],"FOG":[-0.022774700918421511],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[4.0665714217196367,9.6912245230501544,-22.656590873961793,66.805901154966818,66.805901154966818],"omega_rad_s":[4.5335472616350314,10.764932179642541,-22.538345780602214,67.662652438433284,67.665327089013928],"thrust_n":[0.2621963214233346,1.4684162890742423,-6.5213860030760422,58.700175368627846,57.886274484293665],"torque_nm":[-0.004916181026687525,-0.027532805420142043,0.1222759875576758,-1.1006282881617722,-1.0853676465805064],"angle_rad":[-2.9359031986538997,-53.378431324982962,-87.147686185123277,184.02891901305648,184.02677608517405]},"command":[0.038729251635425108,0.092297376410001478,-0.21577705594249327,0.63624667766635068,0.63624667766635068],"arm":{"servo_position":[-1.0587911840678734e-24,-1.0842021724855046e-21,1.0778494253810964e-21,0,2.9053230090822499e-21,-2.6427427954334168e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.0081632780834761838,-1.8408749627063479,-0.35095206815851626,-2.7779860854494917e-05,-0.0006354401776499679,0.000298031736781567]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":83,"step":664,"t":3.3200000000000003,"sim_time":3.3199999999999514,"vehicle":{"origin_ned":[0.011562199428923156,0.0001622389837953955,1.9150184265212604],"origin_quat_xyzw":[0.00017780086556661942,0.064460884742354521,-0.0050404749952939155,0.99790748886703262],"cg_ned":[-0.077050392079316257,0.001219109680654359,1.6237408558404043],"linear_velocity_ned":[0.0018626149998796485,8.9391537168062119e-05,0.003655382239431982],"angular_velocity_ned":[-0.0014169557406646155,-0.024420376629810829,-0.002743838437858278]},"sensors":{"Odom":[0.011562199428923156,0.0001622389837953955,1.9150184265212604,-0.0059609396249528457,0.00020428139204070378,0.0050963484837862252,0.00017780086556662094,0.064460884742355076,-0.005040474995293958,0.99790748886703262,-0.00080699735125174281,-0.024432611720509971,-0.0028787927114945246],"Pressure":[11218.585774601797],"DVL":[-0.011068153137114111,0.011717083632333137,0.026829936762214804,8.6650512705144624,-0.024223239428903778,-0.011661732621915975,0.019282730051198172,0],"IMU":[-0.00029744119365595229,0.12901137005598637,-0.010121216117563293,-0.091462786350563902,0.0557140700763517,-0.083881526705965381,1.2838438159693788,0.0082316052860276524,-9.7216417423613137],"FOG":[-0.012781383941774405],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[3.9262178134053261,9.5230286143239624,-22.789528641400395,66.82361709763137,66.82361709763137],"omega_rad_s":[4.4086256176511425,10.687381829656754,-22.635727800844577,67.671854707871432,67.674498638932334],"thrust_n":[0.24794766340547242,1.4457578679454632,-6.5804366259116636,58.692869137019208,57.874666545848328],"torque_nm":[-0.0046490186888526091,-0.027107960023977435,0.12338318673584368,-1.10049129631911,-1.0851499977346564],"angle_rad":[-2.7573795127671854,-52.949469546587785,-88.051397888323535,186.73564998658904,186.73361337263555]},"command":[0.03739255060386025,0.090695510612609165,-0.21704312991809899,0.63641540092982263,0.63641540092982263],"arm":{"servo_position":[-1.0587911840678734e-24,-1.0842021724855046e-21,5.4146581153231142e-21,0,2.9053230090822499e-21,-2.6427427954334168e-21],"servo_velocity":[0,0,8.6736173798840355e-19,0,0,0],"servo_effort":[-0.0080176258694947614,-1.824888768653024,-0.34721859381156195,-2.6752801176264915e-05,-0.00062326989553643112,0.00029274007427991267]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":84,"step":672,"t":3.3599999999999999,"sim_time":3.3599999999999506,"vehicle":{"origin_ned":[0.011360069107034701,0.00017180405365970841,1.9152687793990879],"origin_quat_xyzw":[0.00015669538546606899,0.063972933515178868,-0.0050961048770805702,0.99793860980478166],"cg_ned":[-0.076967601478385814,0.0012224474301928874,1.6239046596302567],"linear_velocity_ned":[0.0022285946972702558,7.8967453823475047e-05,0.0044363287824230793],"angular_velocity_ned":[-0.0013073433997441754,-0.024447679348355549,-0.0026733028946753878]},"sensors":{"Odom":[0.011360069107034701,0.00017180405365970841,1.9152687793990879,-0.0057016654442106967,0.00017159336737395466,0.0059175935013409398,0.00015669538546607298,0.063972933515180491,-0.0050961048770806995,0.99793860980478166,-0.00070706545563509649,-0.024458824782063848,-0.0027947574802282635],"Pressure":[11225.708059540164],"DVL":[0.0015391302825856082,0.031244025187425167,0.037510274511019369,8.6249110696612625,0.010657914149452169,0.0078124981834580502,0.0046281694095882441,0],"IMU":[-0.00034208076612325319,0.12803322876973619,-0.010235103313484354,-0.054661604033316789,-0.032346278930905144,-0.046078083374370228,1.2518695855318802,0.019705902372686563,-9.7025585022389205],"FOG":[-0.0085674339828258738],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[3.774307090435443,9.3145039859187353,-22.935727874972464,66.838227763652739,66.838227763652739],"omega_rad_s":[4.2719706253368983,10.560633188195524,-22.749819983209687,67.677431369968232,67.680038942070198],"thrust_n":[0.23281837920523116,1.4101451390989661,-6.6492690706033342,58.678301071939003,57.85872786180493],"torque_nm":[-0.0043653446100980842,-0.026440221358105618,0.12467379507381252,-1.1002181450988564,-1.0848511474088425],"angle_rad":[-2.5841200160734217,-52.524739001387729,-88.95938899258789,189.44266549078841,189.44073383403463]},"command":[0.035945781813670884,0.08870956177065463,-0.21843550357116634,0.63655455013002615,0.63655455013002615],"arm":{"servo_position":[-1.0587911840678734e-24,-1.0842021724855046e-21,9.7514668052651321e-21,0,2.9053230090822499e-21,-2.6427427954334168e-21],"servo_velocity":[0,0,1.7347234759768071e-18,0,0,0],"servo_effort":[-0.0079129777345559333,-1.8089118898773147,-0.34346809032095182,-2.576163032620365e-05,-0.00061091357503771854,0.00028737602737903138]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":85,"step":680,"t":3.3999999999999999,"sim_time":3.3999999999999497,"vehicle":{"origin_ned":[0.011172319776636866,0.00017995253923741008,1.9155498622963592],"origin_quat_xyzw":[0.0001377352774511414,0.063485356606028401,-0.0051501942161782119,0.99796947148955129],"cg_ned":[-0.076870569855485474,0.0012253927332739954,1.6240995437663501],"linear_velocity_ned":[0.0025767728515967256,6.9636159364531698e-05,0.0052102040713825669],"angular_velocity_ned":[-0.0011934050483125801,-0.024393161426791179,-0.0026038318031489736]},"sensors":{"Odom":[0.011172319776636866,0.00017995253923741008,1.9155498622963592,-0.0054329791384534806,0.00013870612071620485,0.0067249208389063486,0.00013773527745114278,0.063485356606029039,-0.0051501942161782631,0.99796947148955129,-0.00060345694807652055,-0.024403168029177625,-0.0027114036795472911],"Pressure":[11233.316440204924],"DVL":[-0.01684908593072753,0.024719861888862597,0.010115545612933057,8.658250420932518,-0.015360957360056087,-0.0085704818165970639,0.026588187374604312,0],"IMU":[-0.00038209258946273671,0.12705588652765315,-0.010345560857517248,-0.046938618809769919,-0.038948697936359369,0.043594582502816184,1.2309244384844291,-0.0089238634028091929,-9.7089123914549518],"FOG":[0.0014025427924255832],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[3.6103204750543751,9.0655991998080498,-23.094127626732316,66.849939500477802,66.849939500477802],"omega_rad_s":[4.1233833864705041,10.387040535804944,-22.879423027412113,67.679671933445675,67.682237834097037],"thrust_n":[0.2169100512718217,1.3626933011769546,-6.7273273962669329,58.657049587196376,57.838910952587156],"torque_nm":[-0.0040670634613466572,-0.025550499397067904,0.12613738868000499,-1.099819679759932,-1.0844795803610092],"angle_rad":[-2.4165981988575687,-52.106151459215518,-89.872300496447181,192.14982720309899,192.1479989285684]},"command":[0.034384004524327383,0.086339039998171899,-0.21994407263554586,0.63666609048074096,0.63666609048074096],"arm":{"servo_position":[-1.0587911840678734e-24,-1.0842021724855046e-21,9.7514668052651321e-21,0,2.9053230090822499e-21,-2.6427427954334168e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.0078212165296110796,-1.7930218884946905,-0.33971811714791744,-2.4809165439473467e-05,-0.00059840167862619932,0.00028196389820434926]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":86,"step":688,"t":3.4399999999999999,"sim_time":3.4399999999999489,"vehicle":{"origin_ned":[0.01099915114864454,0.00018667462288698847,1.9158611027572998],"origin_quat_xyzw":[0.00012099489130076129,0.062999747397263814,-0.0052027598811352068,0.9979999741872424],"cg_ned":[-0.076760028311828335,0.0012279889116301459,1.62432521540174],"linear_velocity_ned":[0.0029062142596711321,6.1361465030268888e-05,0.0059765886184974977],"angular_velocity_ned":[-0.0010756683001938066,-0.024260386756614825,-0.0025353154881711591]},"sensors":{"Odom":[0.01099915114864454,0.00018667462288698847,1.9158611027572998,-0.0051568770737805084,0.00010573590776428655,0.0075180311601397804,0.00012099489130076105,0.062999747397263689,-0.0052027598811351964,0.9979999741872424,-0.0004966915356301011,-0.024269209831788,-0.0026286886761677964],"Pressure":[11242.740162288954],"DVL":[-0.011811129902552217,-0.0087696227074161217,0.026432214976164239,8.6392477217953907,0.020067655829227784,-0.010772977415057979,-0.014801882535506124,0],"IMU":[-0.00041735222333262888,0.12608253776411285,-0.010452623648804416,0.027161176408588592,0.034440074727628243,0.048074405630520969,1.2395472703545662,-0.0020919501177389067,-9.7220439920334272],"FOG":[0.00023893044796420917],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[3.4334408333179796,8.7758962505030347,-23.263484877474337,66.858875087928993,66.858875087928993],"omega_rad_s":[3.9624805977304365,10.168082872829306,-23.023318443800601,67.678818614355549,67.681337863107487],"thrust_n":[0.200319249140087,1.3044212425642587,-6.8140420985576551,58.629604221641003,57.815582028720115],"torque_nm":[-0.0037559859213766311,-0.024457898298079858,0.12776328934795603,-1.0993050791557686,-1.0840421630385022],"angle_rad":[-2.2552995406911274,-51.695545135361073,-90.790725238003461,194.8570073362317,194.85528066391319]},"command":[0.03269943650779028,0.083579964290505085,-0.22155699883308894,0.63675119131360947,0.63675119131360947],"arm":{"servo_position":[-1.0587911840678734e-24,-1.0842021724855046e-21,9.7514668052651321e-21,0,2.9053230090822499e-21,-2.6427427954334168e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.0076614916608864448,-1.777250916641683,-0.33599473786892181,-2.3876126057045766e-05,-0.00058581908912113333,0.00027659167131774973]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":87,"step":696,"t":3.48,"sim_time":3.479999999999948,"vehicle":{"origin_ned":[0.010840673520427349,0.00019196374549239792,1.9162019269718762],"origin_quat_xyzw":[0.0001065368755172441,0.062517632889425856,-0.0052538152516660806,0.99803002542663932],"cg_ned":[-0.076636759584854899,0.0012302751221610953,1.6245813650459155],"linear_velocity_ned":[0.0032155286565688102,5.4020656794066394e-05,0.006734999322026881],"angular_velocity_ned":[-0.000954755254916266,-0.024052580150559562,-0.0024676178210662411]},"sensors":{"Odom":[0.010840673520427349,0.00019196374549239792,1.9162019269718762,-0.0048757078371289737,7.2738154087585241e-05,0.0082964941506541885,0.00010653687551724629,0.062517632889427147,-0.005253815251666189,0.99803002542663932,-0.00038738777380962342,-0.024060180689263171,-0.0025465551475348791],"Pressure":[11249.340737248856],"DVL":[-0.01868283165432516,-0.0070901157335346099,-0.0019419906998913916,8.679316546668467,-0.0084399548798432325,0.032147265361939674,0.015902690643090186,0],"IMU":[-0.00044775825109021847,0.1251162433613717,-0.01055632138884949,-0.057945053045608812,-0.044609237543875468,0.032516015390176178,1.2309636740860137,0.0096187133574891399,-9.7410349955689846],"FOG":[-0.0041393790125195465],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[3.2419470886347184,8.4451195731024793,-23.441882310351648,66.865139277719052,66.865139277719052],"omega_rad_s":[3.7885061798308435,9.9046588762668328,-23.180082660016552,67.675068507792943,67.67753645218751],"thrust_n":[0.18312396444211765,1.2363287951826178,-6.9087131103411661,58.596374122156327,57.789038206310074],"torque_nm":[-0.0034335743332897062,-0.023181164909674087,0.12953837081889688,-1.0986820147904313,-1.083544466368314],"angle_rad":[-2.1007325800045273,-51.294713155946411,-91.715203190963521,197.56408670521299,197.56245966328825]},"command":[0.030875686558425888,0.080429710220023612,-0.22325602200334901,0.63681085026399098,0.63681085026399098],"arm":{"servo_position":[-1.0587911840678734e-24,-1.0842021724855046e-21,9.7514668052651321e-21,0,-1.4314856808597679e-21,-2.6427427954334168e-21],"servo_velocity":[0,-8.6736173798840355e-19,0,0,0,0],"servo_effort":[-0.0075254163538949802,-1.7615557306438865,-0.3322976233045159,-2.2976519295919794e-05,-0.00058975968691186336,0.00027070422067028915]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":88,"step":704,"t":3.52,"sim_time":3.5199999999999472,"vehicle":{"origin_ned":[0.010696924144227363,0.00019581850152329181,1.9165717530204582],"origin_quat_xyzw":[9.441219003075848e-05,0.062040466486357616,-0.0053033756841748521,0.99805954021333099],"cg_ned":[-0.076501577384477978,0.0012322889615769812,1.6248676587890765],"linear_velocity_ned":[0.0035043947755025147,4.7626951350524455e-05,0.0074847937303645744],"angular_velocity_ned":[-0.00083123752214978172,-0.023773829751047512,-0.002400820936866515]},"sensors":{"Odom":[0.010696924144227363,0.00019581850152329181,1.9165717530204582,-0.0045910106033326481,3.9878423260489849e-05,0.0090599039145973365,9.4412190030762885e-05,0.062040466486360503,-0.0053033756841750984,0.99805954021333099,-0.00027607612999662121,-0.023780173969429299,-0.0024651543511597855],"Pressure":[11259.482635798751],"DVL":[-0.012639067457756122,-0.025713517500478848,0.035234500499382281,8.6580448191152719,0.011111129312044521,-0.01704104262634255,-0.026421749552469686,0],"IMU":[-0.0004732327665091505,0.1241599162161261,-0.010656689408097393,0.043521318637060852,0.06054521963824272,0.041570331155121452,1.2138644476686331,0.01371978165120542,-9.713357973925822],"FOG":[-0.01657420312067787],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[3.033897433605885,8.0722149553866078,-23.627975132689865,66.86889712659169,66.86889712659169],"omega_rad_s":[3.6002788085305237,9.5971478175839238,-23.348219314872679,67.668606308026,67.671018621349702],"thrust_n":[0.16538935140295383,1.1594111076632285,-7.0105971829740028,58.55775989113571,57.759543218067634],"torque_nm":[-0.0031010503388053841,-0.021738958268685535,0.13144869718076257,-1.0979579979587946,-1.0829914353387684],"angle_rad":[-1.9534463786767267,-50.905423475660797,-92.646214689850638,200.27095367004065,200.26942410789462]},"command":[0.028894261272437001,0.07687823767034864,-0.22502833459704633,0.63684663930087326,0.63684663930087326],"arm":{"servo_position":[-1.0587911840678734e-24,3.2526065174565132e-21,9.7514668052651321e-21,0,-1.4314856808597679e-21,-2.6427427954334168e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.0073612997969490545,-1.7461489611477261,-0.32864840749453694,-2.2098544546520103e-05,-0.00057694276415142247,0.00026542384038955074]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":89,"step":712,"t":3.5600000000000001,"sim_time":3.5599999999999463,"vehicle":{"origin_ned":[0.010567885565647764,0.00019824480205290216,1.916969995482559],"origin_quat_xyzw":[8.4660317358557422e-05,0.061569618884771374,-0.0053514576181063088,0.99808844135395947],"cg_ned":[-0.076355302650069956,0.0012340685665084292,1.6251837416069508],"linear_velocity_ned":[0.0037726949771885562,4.219119354243325e-05,0.0082255282995840305],"angular_velocity_ned":[-0.00070571906494450913,-0.02342825127526689,-0.0023349483704997866]},"sensors":{"Odom":[0.010567885565647764,0.00019824480205290216,1.916969995482559,-0.0043041648158383874,7.3362089336600922e-06,0.0098080802980785985,8.4660317358558492e-05,0.061569618884772151,-0.0053514576181063764,0.99808844135395947,-0.00016332485585291302,-0.023433311156229444,-0.0023845826375623871],"Pressure":[11267.156131412044],"DVL":[0.0060156639080969979,0.011219105934558441,0.018525082187755365,8.6091487055765565,0.0086274426113075956,0.003123331028893543,-0.0025099307666861834,0],"IMU":[-0.00049372062092435068,0.12321630301696929,-0.010753766671007803,0.082314932102265842,-0.023710801073043766,0.040672021907669463,1.199072678789767,0.0042645349020010905,-9.7041300680534874],"FOG":[-0.027690232177467994],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[2.8070413658997611,7.65409624681977,-23.820666519650306,66.870246547783566,66.870246547783566],"omega_rad_s":[3.3962816616005607,9.244903399327546,-23.526336656147524,67.659595105082388,67.661947795884643],"thrust_n":[0.14718890689166911,1.0745565772144889,-7.119000995374936,58.514121020561966,57.727313992786414],"torque_nm":[-0.0027597920042187955,-0.020147935822771666,0.13348126866328008,-1.0971397691355369,-1.0823871373647453],"angle_rad":[-1.8140446379333315,-50.529451470436825,-93.58418265858802,202.97750354882692,202.97606915029735]},"command":[0.02673372729428344,0.072896154731616855,-0.22686349066333625,0.63685949093127203,0.63685949093127203],"arm":{"servo_position":[7.4115382884751301e-24,-1.0842021724855046e-21,9.7514668052651321e-21,0,-1.4314856808597679e-21,-4.7433845046240786e-22],"servo_velocity":[3.3881317890172014e-21,0,0,0,0,0],"servo_effort":[-0.0071877715188605768,-1.7310603265958715,-0.32505345354252296,-2.1248991868661718e-05,-0.00056416140703223147,0.00026017021121076876]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":90,"step":720,"t":3.6000000000000001,"sim_time":3.5999999999999455,"vehicle":{"origin_ned":[0.010453491091352088,0.00019925491980681584,1.9173960713143574],"origin_quat_xyzw":[7.7310263037659311e-05,0.061106378970172161,-0.0053980807412097875,0.99811665911184355],"cg_ned":[-0.076198758510069242,0.0012356525175751057,1.6255292437195632],"linear_velocity_ned":[0.0040204215428782586,3.772125979657067e-05,0.0089568868022252505],"angular_velocity_ned":[-0.00057872057743595779,-0.02301995975487783,-0.0022701511926132966]},"sensors":{"Odom":[0.010453491091352088,0.00019925491980681584,1.9173960713143574,-0.0040164635540042458,-2.4746505006781574e-05,0.010540983370413827,7.7310263037661412e-05,0.061106378970173826,-0.005398080741209935,0.99811665911184355,-4.9602519190719812e-05,-0.023023712271100845,-0.0023050518232606522],"Pressure":[11276.008739712788],"DVL":[-0.006402624421361424,-0.023308699736484355,-0.0043835525063080083,8.6186775262386881,0.0080442567353282961,0.049531965603407835,0.003331287781047694,0],"IMU":[-0.00050918757664201195,0.12228798608378386,-0.010847599862932964,0.039243719597270486,-0.060756393446961765,0.0038179056058930015,1.2084657543922728,0.009859784439640043,-9.7033752367744448],"FOG":[-0.00025688720736399828],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[2.5577272824325981,7.1862827718031896,-24.01903178760471,66.869231008697,66.869231008697],"omega_rad_s":[3.1743854299390386,8.8460826310874943,-23.713159101650017,67.648162237269148,67.650451652908487],"thrust_n":[0.12859592524594177,0.98255788144194989,-7.2332851832517404,58.465750555534235,57.692501969577222],"torque_nm":[-0.0024111735983614077,-0.018422960277036562,0.13562409718597015,-1.0962328229162668,-1.0817344119295729],"angle_rad":[-1.6832045046407262,-50.168625410261491,-94.529476888252063,205.6836373819327,205.6822956788175]},"command":[0.024359307451739028,0.068440788302887523,-0.22875268369147345,0.63684981913044758,0.63684981913044758],"arm":{"servo_position":[-1.0587911840678734e-24,-1.0842021724855046e-21,9.7514668052651321e-21,0,-1.4314856808597679e-21,-4.7433845046240786e-22],"servo_velocity":[1.6940658945086007e-21,-8.6736173798840355e-19,0,0,0,0],"servo_effort":[-0.0070070390691664144,-1.7163475575986589,-0.32152530130745793,-2.0422604728572297e-05,-0.00055143913570228863,0.000254959122127826]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":91,"step":728,"t":3.6400000000000001,"sim_time":3.6399999999999446,"vehicle":{"origin_ned":[0.01035362840800591,0.00019886861752760397,1.9178494038992522],"origin_quat_xyzw":[7.2378048705514587e-05,0.060651953241098996,-0.0054432635185823006,0.99814413098095445],"cg_ned":[-0.076032766251428421,0.0012370788306403909,1.6259037848731828],"linear_velocity_ned":[0.0042476601294918993,3.4189720281471939e-05,0.0096786468554293289],"angular_velocity_ned":[-0.00045099824927506991,-0.022553088388247208,-0.002206189053716208]},"sensors":{"Odom":[0.01035362840800591,0.00019886861752760397,1.9178494038992522,-0.0037291305484267552,-5.6159839302526027e-05,0.011258678393995815,7.2378048705515861e-05,0.060651953241100065,-0.0054432635185823969,0.99814413098095445,6.4342170936552729e-05,-0.022555518392040376,-0.0022264131604545346],"Pressure":[11285.073464262585],"DVL":[-0.015953094829369914,0.0073891039385459547,-0.012597651821385438,8.652261037080816,0.017831482326280731,0.0084047504229805732,0.039612284506675449,0],"IMU":[-0.00051962468326624382,0.12137738222436111,-0.01093823456857977,0.067469504055032353,-0.025971467748235191,0.049862526126425798,1.1714825520320515,0.0069821854550775487,-9.7046672790307387],"FOG":[-0.0098515266871859915],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[2.2804085583025029,6.6613885977667824,-24.222056891337548,66.865854975593493,66.865854975593493],"omega_rad_s":[2.9314067067960621,8.3972194972669314,-23.907494059977282,67.634396741280781,67.636619568385584],"thrust_n":[0.10967564291016449,0.8840968892850839,-7.3528425237339317,58.41287271969891,57.655189007276569],"torque_nm":[-0.0020564183045655841,-0.016576816674095326,0.13786579732001122,-1.0952413634943547,-1.0810347938864358],"angle_rad":[-1.5617115240222812,-49.824882151884573,-95.482418350693024,208.38926042962683,208.3880088152543]},"command":[0.021718176745738123,0.063441796169207448,-0.23068625610797663,0.63681766643422377,0.63681766643422377],"arm":{"servo_position":[-1.0587911840678734e-24,-1.0842021724855046e-21,9.7514668052651321e-21,0,-1.4314856808597679e-21,-4.7433845046240786e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.0067327372721713748,-1.7020595583017697,-0.31807392023008846,-1.9617762599243707e-05,-0.00053881244853673082,0.0002498005707021824]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":92,"step":736,"t":3.6800000000000002,"sim_time":3.6799999999999438,"vehicle":{"origin_ned":[0.010268140506861895,0.00019711316600409703,1.9183294261082375],"origin_quat_xyzw":[6.9865764539304962e-05,0.060207466131336103,-0.0054870235272964059,0.9981708013730064],"cg_ned":[-0.075858144493679128,0.0012383844314262751,1.6263069777975392],"linear_velocity_ned":[0.0044543706362424806,3.1561971762639051e-05,0.010390675535485052],"angular_velocity_ned":[-0.00032321674001277635,-0.022031720594308229,-0.0021430782988797431]},"sensors":{"Odom":[0.010268140506861895,0.00019711316600409703,1.9183294261082375,-0.0034435146657196807,-8.6751900619863351e-05,0.01196130045804231,6.9865764539305558e-05,0.060207466131336609,-0.0054870235272964519,0.9981708013730064,0.00017788376501486549,-0.022032819903195021,-0.0021487602196003457],"Pressure":[11293.957855847959],"DVL":[0.0033901792824568401,0.0025880802993055469,-0.038991740223915557,8.6195809509241155,0.0089087601708415249,-0.0024907069777466537,-0.015843083889418838,0],"IMU":[-0.00052505014067358573,0.12048674340438073,-0.011025715927112784,-0.0019047137217212693,-0.040728032184354689,-0.017058654876969857,1.2033066770332339,0.0030797941287260045,-9.740058780170795],"FOG":[-0.0062718518742890658],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[1.965512439364387,6.0679237199534848,-24.42879831983527,66.860093588753728,66.860093588753728],"omega_rad_s":[2.66234139237788,7.8923974514153219,-24.108195375724542,67.618351078693976,67.620504341050577],"thrust_n":[0.090479277221894097,0.77970712941799547,-7.4770746109481312,58.355645903726533,57.615392658809604],"torque_nm":[-0.0016964864479105148,-0.014619508676587421,0.14019514895527746,-1.0941683606948724,-1.0802886123526803],"angle_rad":[-1.4505165759588601,-49.500351186200184,-96.443281193840022,211.09428067153274,211.09311641429426]},"command":[0.018719166089184638,0.057789749713842709,-0.23265522209366923,0.63676279608336883,0.63676279608336883],"arm":{"servo_position":[7.4115382884751301e-24,-1.0842021724855046e-21,9.7514668052651321e-21,0,-1.4314856808597679e-21,-4.7433845046240786e-22],"servo_velocity":[3.3881317890172014e-21,0,0,0,0,0],"servo_effort":[-0.0064434477491860775,-1.6882298255185002,-0.31471837952744763,-1.8827911615377859e-05,-0.00052634593111340708,0.00024475243429686582]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":93,"step":744,"t":3.7200000000000002,"sim_time":3.7199999999999429,"vehicle":{"origin_ned":[0.010196799846740573,0.00019402003794074195,1.9188355822560574],"origin_quat_xyzw":[6.9762915367452451e-05,0.05977396160372412,-0.0055293794801151335,0.99819662121743169],"cg_ned":[-0.075675735858321991,0.0012396029028930227,1.6267384307819763],"linear_velocity_ned":[0.0046396140323481496,2.9724332542852293e-05,0.011092831303021144],"angular_velocity_ned":[-0.00019601146665487756,-0.021459871597382732,-0.0020808351260752102]},"sensors":{"Odom":[0.010196799846740573,0.00019402003794074195,1.9188355822560574,-0.0031618384500700912,-0.00011646868404203741,0.01264886411966974,6.9762915367454768e-05,0.059773961603726097,-0.0055293794801153174,0.99819662121743169,0.00029042629845700546,-0.021459638848782353,-0.0020721817821124783],"Pressure":[11303.289658950147],"DVL":[0.0037451354866499852,0.0096738652021600442,0.020146978987946169,8.7651082222477861,-0.024871147737977731,0.013426091019126563,-0.00023620252952480606,0],"IMU":[-0.00052550677187547469,0.11961815998893188,-0.011110092415425482,-0.050481228473467768,0.020824610006919597,0.26473619314036773,1.1736301219436081,0.007471203331822893,-9.7210712158257024],"FOG":[-0.032982324570714497],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[1.5923362702296553,5.3895379128050278,-24.637904301049009,66.85191952189497,66.85191952189497],"omega_rad_s":[2.3578461275853582,7.3224536716896642,-24.314082549873856,67.600048997354421,67.602130050523741],"thrust_n":[0.070979964816333729,0.66985131806692255,-7.6053319519098226,58.294180669057894,57.573085315704802],"torque_nm":[-0.0013308743403062575,-0.012559712213754798,0.14259997409830916,-1.0930158875448357,-1.0794953496694653],"angle_rad":[-1.3508596429344792,-49.197470754087469,-97.412293643097371,213.79860748860946,213.79752774533472]},"command":[0.015165107335520527,0.051328932502905031,-0.23464670762903816,0.63668494782757112,0.63668494782757112],"arm":{"servo_position":[7.4115382884751301e-24,-1.0842021724855046e-21,9.7514668052651321e-21,0,-1.4314856808597679e-21,-1.5585406229479123e-21],"servo_velocity":[1.6940658945086007e-21,0,0,0,0,0],"servo_effort":[-0.0061542834818008466,-1.6748624588641263,-0.31148753094278586,-1.805956916520057e-05,-0.00051414110269809208,0.00023993207469743901]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":94,"step":752,"t":3.7600000000000002,"sim_time":3.7599999999999421,"vehicle":{"origin_ned":[0.010139314467073487,0.00018962494500902481,1.9193673193176861],"origin_quat_xyzw":[7.2047196441895448e-05,0.059352401909198965,-0.0055703515672985253,0.99822154774389982],"cg_ned":[-0.075486400035716883,0.0012407649983663988,1.6271977390193739],"linear_velocity_ned":[0.0048033847468951021,2.8648234438762129e-05,0.011784634795535223],"angular_velocity_ned":[-6.9973979018494138e-05,-0.020841695475207891,-0.0020195174361349322]},"sensors":{"Odom":[0.010139314467073487,0.00018962494500902481,1.9193673193176861,-0.0028854032433996983,-0.00014517829302059261,0.013321167191162907,7.2047196441897793e-05,0.059352401909200908,-0.0055703515672987074,0.99822154774389982,0.0004014250149977987,-0.020840135767067579,-0.0019968015628546135],"Pressure":[11311.660176763558],"DVL":[-0.024254047225706666,0.016359937967677086,-0.00023197691422723868,8.7574295771354311,-0.03850776739276883,0.022605129515697424,0.0010501218317259713,0],"IMU":[-0.00052106040762390756,0.11877355829871813,-0.011191416329641756,0.055329057287480998,0.01868736730652016,-0.012897297572411799,1.160212615924674,0.014833435797265865,-9.6927950197752342],"FOG":[-0.026915448104312963],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[1.1051937549582862,4.5959329719155271,-24.848108290320461,66.841372037989231,66.841372037989231],"omega_rad_s":[1.9962358696013331,6.6723508087563861,-24.523878405808912,67.579513251960364,67.58151977787432],"thrust_n":[0.050891671959212861,0.55482732799333334,-7.7368896418547832,58.228594508128289,57.528242107974911],"torque_nm":[-0.00095421884923524122,-0.010403012399874999,0.14506668078477722,-1.0917861470274053,-1.0786545395245295],"angle_rad":[-1.2646007145665288,-48.919166102811559,-98.389633775277247,216.50215111809013,216.50115294718685]},"command":[0.010525654809126535,0.04377079020871931,-0.2366486503840044,0.63658449559989749,0.63658449559989749],"arm":{"servo_position":[-1.0587911840678734e-24,-1.0842021724855046e-21,9.7514668052651321e-21,0,-1.4314856808597679e-21,-1.5585406229479123e-21],"servo_velocity":[0,-8.6736173798840355e-19,0,0,0,0],"servo_effort":[-0.0058511840478720619,-1.6619523819921496,-0.30836049350769212,-1.7309460538815244e-05,-0.000502171901628289,0.00023525424495355444]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":95,"step":760,"t":3.8000000000000003,"sim_time":3.7999999999999412,"vehicle":{"origin_ned":[0.010095342430158222,0.00018397064573473683,1.9199240752099516],"origin_quat_xyzw":[7.6685702726938694e-05,0.058943665817852951,-0.0056099622249051869,0.9982455442941337],"cg_ned":[-0.075290998212013877,0.001241902240765065,1.6276844729249493],"linear_velocity_ned":[0.0049456392219108429,2.8421247040199882e-05,0.012465421463888453],"angular_velocity_ned":[5.4399702895051068e-05,-0.020181382183989925,-0.0019592330065121345]},"sensors":{"Odom":[0.010095342430158222,0.00018397064573473683,1.9199240752099516,-0.0026155410688297595,-0.00017266597379796391,0.013977818079490455,7.6685702726940401e-05,0.058943665817854277,-0.0056099622249053118,0.9982455442941337,0.0005104373539445298,-0.02017850611843882,-0.0019227804590158429],"Pressure":[11323.745400407448],"DVL":[0.0046563994010690966,0.0075937720310047113,-0.01772519529139268,8.7255593215015637,-0.00094669990956559478,0.012584557744118411,-0.046273912941261479,0],"IMU":[-0.00051179744961214778,0.11795469711312986,-0.011269745087603266,0.065925263917633536,-0.09502259517384265,0.033886148215703425,1.1358321723477796,-0.011475320605313442,-9.7087755486255443],"FOG":[-0.00058189427220469228],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-0.26734575091212359,3.6193336938684584,-25.058481940207855,66.828586038108071,66.828586038108071],"omega_rad_s":[1.4013064842975191,5.912416392260063,-24.736403955347644,67.556794903345363,67.558724906966319],"thrust_n":[0.025091973238806509,0.4341825435618154,-7.871060196352003,58.159061179358787,57.48089229709084],"torque_nm":[-0.0004704744982276221,-0.0081409226917840399,0.14758237868160004,-1.0904823971129773,-1.0777667305704535],"angle_rad":[-1.1968035751516166,-48.669265277720562,-99.375430930400384,219.2048232640019,219.20390363843433]},"command":[-0.0025461500086868911,0.034469844703509125,-0.23865220895436054,0.63646272417245786,0.63646272417245786],"arm":{"servo_position":[-1.0587911840678734e-24,-1.0842021724855046e-21,9.7514668052651321e-21,0,-1.4314856808597679e-21,-1.5585406229479123e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.0055081682283832853,-1.6495227395032841,-0.30534714956374132,-1.6581491000651645e-05,-0.00049048922564084085,0.00023074461215252817]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":96,"step":768,"t":3.8399999999999999,"sim_time":3.8399999999999403,"vehicle":{"origin_ned":[0.010064503016904772,0.0001771112421473616,1.9205052823208029],"origin_quat_xyzw":[8.3637458675421441e-05,0.058548549054591503,-0.0056482378694650915,0.99826858000106733],"cg_ned":[-0.075090382028372565,0.0012430529342572986,1.6281981820778364],"linear_velocity_ned":[0.0050667712141832339,2.9143611833108054e-05,0.013134768961004257],"angular_velocity_ned":[0.00017661008926176576,-0.019483047576536877,-0.0019002087132622605]},"sensors":{"Odom":[0.010064503016904772,0.0001771112421473616,1.9205052823208029,-0.002353158605138525,-0.00019870902352347981,0.014618710070649072,8.3637458675423569e-05,0.058548549054593002,-0.0056482378694652354,0.99826858000106733,0.00061703136594957347,-0.019478871361182176,-0.0018503972371190231],"Pressure":[11330.553227274278],"DVL":[0.0094538007223009344,0.031205688435718512,-0.0011743846233477364,8.756926165632116,-0.003448195708016061,-0.0051691395184128635,-0.015599389979508865,0],"IMU":[-0.0004978199221301944,0.11716316860452518,-0.011345144340481244,-0.060692677039182977,0.020957094597529133,0.14955341872532202,1.1514462733600468,-0.00033293289766694618,-9.7402267432631771],"FOG":[-0.0054696736642166899],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-1.1526525198723712,2.2417857951580014,-25.268326550366947,66.813652605778529,66.813652605778529],"omega_rad_s":[0.5886696984189006,4.964797863698573,-24.950591384654143,67.531966185933783,67.533817991111817],"thrust_n":[0.0044385587060685227,0.30450447940085862,-8.0072067169908738,58.085782596853562,57.431094910807978],"torque_nm":[-8.3222975738784824e-05,-0.0057094589887660991,0.15013512594357889,-1.0891084236910045,-1.0768330295776496],"angle_rad":[-1.1594319655380221,-48.453712754028778,-100.36976949927458,221.90653828493328,221.90569410505623]},"command":[-0.010977643046403534,0.021350340906266679,-0.24065072905111379,0.63632050100741455,0.63632050100741455],"arm":{"servo_position":[-1.0587911840678734e-24,-1.0842021724855046e-21,9.7514668052651321e-21,0,-1.4314856808597679e-21,-1.5585406229479123e-21],"servo_velocity":[0,-8.6736173798840355e-19,0,0,0,0],"servo_effort":[-0.0052619429300814246,-1.6376063320169498,-0.30244851662480254,-1.5877220450838134e-05,-0.00047910098351228376,0.0002263861823332174]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":97,"step":776,"t":3.8799999999999999,"sim_time":3.8799999999999395,"vehicle":{"origin_ned":[0.010046374032574482,0.00016909625663475455,1.9211103731914267],"origin_quat_xyzw":[9.2844582664391176e-05,0.058167768553424218,-0.0056852173608272138,0.99829062921824463],"cg_ned":[-0.074885398696531907,0.0012442421351142282,1.6287384019396522],"linear_velocity_ned":[0.0051664229637204875,3.0210892981585104e-05,0.013792411121488312],"angular_velocity_ned":[0.00029547625112231405,-0.018750406398171323,-0.0018436088248739335]},"sensors":{"Odom":[0.010046374032574482,0.00016909625663475455,1.9211103731914267,-0.0020998020577035603,-0.00022367778623832621,0.015243780571438503,9.2844582664392735e-05,0.058167768553425189,-0.0056852173608273092,0.99829062921824463,0.00072020352526064161,-0.018744959246453457,-0.0017809406339672912],"Pressure":[11342.81989357461],"DVL":[0.0471538416368373,0.0188619014169281,0.020792177698756471,8.7150464250585706,0.0072028558488199234,-0.0067676248958029386,-0.032839552516068848,0],"IMU":[-0.000479264203972717,0.1164004067891341,-0.011417705970743793,0.033676016547746816,-0.040337859942991494,0.056232775397959969,1.1273050482816236,0.00059177186274446576,-9.6852043774884891],"FOG":[0.0088436330742908634],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-1.5979182181643961,-1.7447789657319768,-25.477134985528579,66.796618770234502,66.796618770234502],"omega_rad_s":[-0.12965669290887222,3.2679034656900212,-25.1655387972753,67.505091574916349,67.506863816430723],"thrust_n":[-0.0002103638950431998,0.12965845331361808,-8.1447724449623617,58.008940021116395,57.378899337971163],"torque_nm":[3.9443230320599972e-06,-0.0024310959996303389,0.15271448334304427,-1.0876676253959325,-1.0758543625869594],"angle_rad":[-1.1525476846710607,-48.289860964554038,-101.37269500891689,224.60721325763356,224.60644136379051]},"command":[-0.015218268744422819,-0.016616942530780731,-0.24263938081455788,0.63615827400223335,0.63615827400223335],"arm":{"servo_position":[-1.0587911840678734e-24,-1.0842021724855046e-21,9.7514668052651321e-21,-6.7762635780344029e-23,-1.4314856808597679e-21,-4.7433845046240795e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.005798393459865916,-1.6261431364251997,-0.29969694383363848,-1.5248845626463977e-05,-0.00046813242420139293,0.00022235164686731235]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":98,"step":784,"t":3.9199999999999999,"sim_time":3.9199999999999386,"vehicle":{"origin_ned":[0.010040476182590755,0.00015996344205217541,1.9217387840690505],"origin_quat_xyzw":[0.00010422965509514047,0.057801963496666983,-0.0057209639266933331,0.99831167113475061],"cg_ned":[-0.074676907140001414,0.0012454744856889909,1.6293046578799819],"linear_velocity_ned":[0.0052454398530527128,3.1276516065777328e-05,0.014437943586180807],"angular_velocity_ned":[0.00041025182201235438,-0.017988049102158822,-0.0017892108341708032]},"sensors":{"Odom":[0.010040476182590755,0.00015996344205217541,1.9217387840690505,-0.0018560707279022155,-0.00024768363538514446,0.015853009703368764,0.00010422965509514039,0.057801963496666935,-0.0057209639266933288,0.99831167113475061,0.00081923005581407905,-0.017981369169233475,-0.0017142687606224716],"Pressure":[11351.941018138514],"DVL":[0.02480206601126704,-0.0023466524315212955,-0.023074929594905678,8.5732921134860511,0.0089318359327183201,0.011317543521764553,0.0040855985944056802,0],"IMU":[-0.00045630762090262172,0.11566768960167328,-0.01148757228583968,0.00057181307478365931,-0.041262638059267817,-0.025377842993373676,1.1318529653581801,0.00014264106072260987,-9.7086704374774175],"FOG":[-0.021866273980547198],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-1.9393619871078775,-3.3145305366955062,-25.684552813887247,66.777516687956364,66.777516687956364],"omega_rad_s":[-0.73828391576464669,1.2649520267940351,-25.380506619890543,67.476225622801309,67.477917232705224],"thrust_n":[-0.0069288096564562654,0.017865581224330893,-8.283290336948637,57.928703361448008,57.324328843172353],"torque_nm":[0.00012991518105855501,-0.00033497964795620421,0.15531169381778698,-1.0861631880271503,-1.0748311658094816],"angle_rad":[-1.1718747661108828,-48.205399944752159,-102.38422064516895,227.30676762004688,227.30606480467867]},"command":[-0.018470114162932167,-0.031566957492338156,-0.24461478870368808,0.63597634940910819,0.63597634940910819],"arm":{"servo_position":[-1.0587911840678734e-24,-1.0842021724855046e-21,9.7514668052651321e-21,0,-1.4314856808597679e-21,-4.7433845046240795e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.0051982382313101845,-1.6155850133392131,-0.29706117817434546,-1.4573096861044804e-05,-0.0004574073975918382,0.00021822308587156602]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":99,"step":792,"t":3.96,"sim_time":3.9599999999999378,"vehicle":{"origin_ned":[0.010046409735251047,0.00014975474079950745,1.9223899398869293],"origin_quat_xyzw":[0.00011771400487031744,0.057451652708257903,-0.0057554690495239648,0.99833169253536302],"cg_ned":[-0.07446561641356679,0.0012467478564998219,1.6298964432523158],"linear_velocity_ned":[0.0053090597380601933,3.2250912271030017e-05,0.015070380619011541],"angular_velocity_ned":[0.00052148016133766485,-0.017202593533363481,-0.0017317024084965165]},"sensors":{"Odom":[0.010046409735251047,0.00014975474079950745,1.9223899398869293,-0.0016187384078423666,-0.00027048461192906995,0.016446398465306867,0.0001177140048703199,0.057451652708259103,-0.0057554690495240854,0.99833169253536302,0.00091410679858982191,-0.017194715402825751,-0.0016450319270394406],"Pressure":[11363.224273817052],"DVL":[-0.014289428363363737,0.032228772949827997,0.021034491466583108,8.7038888662397724,-0.018483113550565654,-0.032943652132046058,0.0027906647486646463,0],"IMU":[-0.00042911994619362708,0.11496605382362832,-0.011554740555993807,-0.012398555380013618,-0.039367704970065462,-0.027441539954007877,1.1319092052174378,-0.0095739591881094759,-9.7380771251251126],"FOG":[-0.0097080018017719517],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-2.2239606115327066,-4.3532907148433573,-25.889767105793926,66.756374552780457,66.756374552780457],"omega_rad_s":[-1.2505215987172178,-0.47365004676534128,-25.594756630026119,67.445413463899143,67.447023699218349],"thrust_n":[-0.019905164279025597,-0.003812136959047759,-8.4223191444086645,57.845263242116992,57.267349074287281],"torque_nm":[0.00037322183023173001,7.1477567982145495e-05,0.15791848395766248,-1.0845986857896937,-1.0737627951428865],"angle_rad":[-1.2133073336973408,-48.195135030448419,-103.4043305427229,230.00512276846686,230.00448578844299]},"command":[-0.021180577252692446,-0.041459911569936732,-0.24656921053137074,0.63577499574076624,0.63577499574076624],"arm":{"servo_position":[-1.0587911840678734e-24,-1.0842021724855046e-21,9.7514668052651321e-21,0,-1.4314856808597679e-21,-4.7433845046240795e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.0030924149051709429,-1.6059388949063738,-0.29450897242797003,-1.3779787861091052e-05,-0.00044685387797108856,0.00021386047901466126]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":100,"step":800,"t":4,"sim_time":3.9999999999999369,"vehicle":{"origin_ned":[0.010063866937164753,0.00013852480105024491,1.9230632547448403],"origin_quat_xyzw":[0.00013321361092141057,0.057117246961547907,-0.0057886446138871155,0.99835068685667827],"cg_ned":[-0.07425208044473873,0.0012480584728322536,1.6305132223002339],"linear_velocity_ned":[0.0053592174349449146,3.319621624161174e-05,0.015689319429686668],"angular_velocity_ned":[0.00062886697709104062,-0.016398110097579154,-0.0016695780168322566]},"sensors":{"Odom":[0.010063866937164753,0.00013852480105024491,1.9230632547448403,-0.0013871641959880138,-0.00029179694136988058,0.017024003883273669,0.00013321361092141567,0.057117246961550086,-0.0057886446138873358,0.99835068685667827,0.0010044160473108765,-0.01638907248713618,-0.0015717603560317323],"Pressure":[11370.740947303409],"DVL":[-0.021828338764492344,-0.031664314877283994,-0.0046039024494126078,8.7328642711961137,0.016907960303399219,0.019254548806554705,-0.02492460475259041,0],"IMU":[-0.00039787109463178239,0.11429631972130706,-0.011619047783129282,0.074676953306567442,-0.032754366262663037,-0.030956210180456977,1.1038803584779509,0.019961984338256286,-9.7238222272332866],"FOG":[-0.030012258898030095],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-2.4676365860828091,-5.2106411411257518,-26.091844611190876,66.733212163320331,66.733212163320331],"omega_rad_s":[-1.6824992457970116,-1.9553328145619484,-25.807479881114389,67.41269193113483,67.414220397258731],"thrust_n":[-0.036048725574691416,-0.05266865300500298,-8.5613339219547893,57.758760741093177,57.207946856081378],"torque_nm":[0.00067591360452546408,0.00098753724384380596,0.16052501103665229,-1.082976763895497,-1.0726490035515259],"angle_rad":[-1.2733611877529274,-48.24846049851196,-104.43297771161251,232.70220171929759,232.70162730965291]},"command":[-0.023501300819836278,-0.049625153725007157,-0.24849375820181785,0.63555440155543175,0.63555440155543175],"arm":{"servo_position":[-3.1763735522036243e-24,-1.0842021724855046e-21,1.0778494253810964e-21,0,-1.4314856808597679e-21,-2.3716922523120384e-22],"servo_velocity":[-4.2351647362715017e-22,-8.6736173798840355e-19,-1.7347234759768071e-18,0,0,0],"servo_effort":[-0.0015004034654511513,-1.59667153744198,-0.29206631635903524,-1.2986688888579245e-05,-0.00043664705754967224,0.00020971152086062697]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":101,"step":808,"t":4.04,"sim_time":4.0399999999999361,"vehicle":{"origin_ned":[0.010092500419352377,0.00012632863995331038,1.9237581491426266],"origin_quat_xyzw":[0.00015065094385917019,0.056799104652489767,-0.0058204403849140508,0.99836865009308773],"cg_ned":[-0.074036861918810884,0.0012494116924818826,1.6311544570807386],"linear_velocity_ned":[0.0053948539525642417,3.437858323402181e-05,0.016294847018062018],"angular_velocity_ned":[0.00073264635296489526,-0.015576568172025995,-0.001605938737115875]},"sensors":{"Odom":[0.010092500419352377,0.00012632863995331038,1.9237581491426266,-0.0011631052320977297,-0.00031170407156284245,0.017585915432782807,0.00015065094385917141,0.056799104652490225,-0.0058204403849140976,0.99836865009308773,0.00109076904271923,-0.015566406049680959,-0.0014975017581147702],"Pressure":[11380.35936001301],"DVL":[-0.048510538489454462,-0.013626731131023454,-0.022027092279180233,8.7463968761897526,-0.0095091513935122302,-0.011719587652942582,-0.0069584813827676126,0],"IMU":[-0.00036272162709956307,0.11365920268044358,-0.011680405597962655,-0.01771022661876686,0.030150954542859452,-0.062948100239840654,1.1055295751346688,0.0028202104513515075,-9.7215441682198005],"FOG":[-0.022886046601145391],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-2.6818260506030862,-5.9569314329782479,-26.291070132356154,66.70803424444189,66.70803424444189],"omega_rad_s":[-2.049102570633917,-3.2210957340603015,-26.018111373030635,67.378087318132657,67.379533921953282],"thrust_n":[-0.053480674153271519,-0.13870500936326949,-8.699927424461146,57.669278394037953,57.146132864651364],"torque_nm":[0.0010027626403738409,0.0026007189255613026,0.1631236392086465,-1.0812989698882116,-1.0714899912122131],"angle_rad":[-1.3491683420505092,-48.356026067280872,-105.47008706573573,235.39792872571053,235.39741361269972]},"command":[-0.025541200481934152,-0.056732680314078555,-0.25039114411767766,0.63531461185182758,0.63531461185182758],"arm":{"servo_position":[2.0203809154758067e-39,-1.0842021724855046e-21,9.7514668052651321e-21,-6.7762635780344029e-23,-1.4314856808597679e-21,-3.3881317890171738e-23],"servo_velocity":[0,0,0,-1.3552527156068805e-20,0,0],"servo_effort":[-0.00056198263803715527,-1.5876884167562924,-0.28972842452199066,-1.2225127425396783e-05,-0.00042682811559764645,0.00020087891434319066]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":102,"step":816,"t":4.0800000000000001,"sim_time":4.0799999999999352,"vehicle":{"origin_ned":[0.010131907164584522,0.00011322327469592657,1.9244740521718464],"origin_quat_xyzw":[0.00016994673947071505,0.056497538592007346,-0.0058508507737209262,0.99838558022257806],"cg_ned":[-0.073820552262855915,0.0012508196377666238,1.6318196109586371],"linear_velocity_ned":[0.0054156056897810114,3.5898966816828833e-05,0.016886938972910603],"angular_velocity_ned":[0.00083239183359134171,-0.014740578686583256,-0.0015423488640661624]},"sensors":{"Odom":[0.010131907164584522,0.00011322327469592657,1.9244740521718464,-0.00094780542373847066,-0.00033012502946098179,0.018132223465884559,0.00016994673947071977,0.056497538592008914,-0.0058508507737210884,0.99838558022257806,0.0011729487558410842,-0.014729331676889116,-0.0014238524385729483],"Pressure":[11393.008198770201],"DVL":[0.03793859817963053,0.00051457592720286914,0.010097435209049727,8.6546834283805669,-0.0036422922626593609,0.014894358577890057,0.016833905272502718,0],"IMU":[-0.00032383997018824276,0.11305532673687159,-0.011738814821924976,-0.055549252023917299,0.020269304897094335,-0.10349670348053622,1.0891731593353149,0.016274277171015795,-9.7607022915223922],"FOG":[-0.025490956318368539],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-2.872597035004123,-6.6207425508935627,-26.487576969785231,66.680842431888408,66.680842431888408],"omega_rad_s":[-2.3629696838182532,-4.310198806629737,-26.226357353018003,67.341616722258053,67.342981619037701],"thrust_n":[-0.071126229912441177,-0.24536136476810164,-8.8378660351980631,57.576890323277439,57.081893938038284],"torque_nm":[0.0013336168108582722,0.0046005255894019069,0.16570998815996371,-1.0795666935614521,-1.0702855113382179],"angle_rad":[-1.4384090497339217,-48.510102558720035,-106.51556792749055,238.09222887419716,238.09176978605518]},"command":[-0.027358067000039267,-0.063054690960891072,-0.25226263780747837,0.635055642208461,0.635055642208461],"arm":{"servo_position":[-6.6174449004240195e-26,-1.0842021724855046e-21,9.7514668052651321e-21,0,-1.4314856808597679e-21,-3.3881317890171738e-23],"servo_velocity":[-1.3234889800848443e-23,0,1.7347234759768071e-18,0,0,0],"servo_effort":[8.8040581587278639e-05,-1.5791557723280745,-0.28751450714761667,-1.1491896117352776e-05,-0.00041742143298602335,0.00019187286158189968]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":103,"step":824,"t":4.1200000000000001,"sim_time":4.1199999999999344,"vehicle":{"origin_ned":[0.010181649743081819,9.9269033543358982e-05,1.9252103990912226],"origin_quat_xyzw":[0.00019101499521476071,0.056212804097018267,-0.0058798923215881869,0.99840147788107181],"cg_ned":[-0.073603743450308914,0.001252296419075168,1.6325081443228415],"linear_velocity_ned":[0.0054216888495125315,3.777480485248992e-05,0.017465490568759946],"angular_velocity_ned":[0.00092771318735189749,-0.013893163137656525,-0.0014795923354126396]},"sensors":{"Odom":[0.010181649743081819,9.9269033543358982e-05,1.9252103990912226,-0.00074204226529679868,-0.00034700191775037048,0.018663022289030568,0.00019101499521476247,0.056212804097018787,-0.0058798923215882416,0.99840147788107181,0.0012506886867270485,-0.013880875532819813,-0.0013516284466501154],"Pressure":[11404.024346600452],"DVL":[0.019208541500499707,0.031270274054166894,0.0082713682089013158,8.6318976156625649,0.0056379984717875161,-0.041676601762063864,-0.015206099223805223,0],"IMU":[-0.00028140961735866602,0.11248520069032683,-0.011794320761503449,0.13963230258198611,0.037018123572985256,0.0049923068111259496,1.0890774521978586,0.028837811016922194,-9.7110005167625566],"FOG":[-0.027743618668228248],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.0436396052185155,-7.2198438223271948,-26.681253190298836,66.651638404145814,66.651638404145814],"omega_rad_s":[-2.6340646629572984,-5.2560395438942509,-26.431994360017523,67.303291044054845,67.304574613665523],"thrust_n":[-0.088386781979370388,-0.36243122912553893,-8.9749632766469372,57.481667599548985,57.015198057859024],"torque_nm":[0.0016572521621131949,0.0067955855461038555,0.16828056143713008,-1.0777812674915435,-1.0690349635848568],"angle_rad":[-1.5392072410689437,-48.704401060391874,-107.56931969691003,240.78502778800228,240.78462146427725]},"command":[-0.028987043859223956,-0.068760417355497094,-0.25410717324094129,0.63477750861091253,0.63477750861091253],"arm":{"servo_position":[-6.6174449004240161e-26,-1.0842021724855046e-21,9.7514668052651321e-21,0,-3.5998900258307764e-21,-3.3881317890171738e-23],"servo_velocity":[0,0,1.7347234759768071e-18,0,0,0],"servo_effort":[0.00060265417897884942,-1.5711416641290146,-0.28542944767788703,-1.0781978724974513e-05,-0.0004084287178113792,0.00018315940322042643]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":104,"step":832,"t":4.1600000000000001,"sim_time":4.1599999999999335,"vehicle":{"origin_ned":[0.010241271657242146,8.4528325566938806e-05,1.9259666297847173],"origin_quat_xyzw":[0.00021376368140751546,0.055945095413564704,-0.0059075922308028167,0.99841634649994093],"cg_ned":[-0.073387010539847405,0.0012538557501225202,1.6332195125976217],"linear_velocity_ned":[0.005413660133722663,3.9978901670583998e-05,0.018030367018170217],"angular_velocity_ned":[0.0010182939272821391,-0.013037377284746337,-0.0014180127717677786]},"sensors":{"Odom":[0.010241271657242146,8.4528325566938806e-05,1.9259666297847173,-0.00054625705957804353,-0.00036230257211884931,0.019178412543758447,0.00021376368140751874,0.055945095413565564,-0.0059075922308029077,0.99841634649994093,0.0013237459092336206,-0.013024097431262732,-0.0012811994680059756],"Pressure":[11413.777464613517],"DVL":[0.019246809715942302,-0.019871446404901762,-0.025742720638243337,8.6653208681050504,-0.025859308893107013,0.016999108488311095,-0.0090507456374916348,0],"IMU":[-0.00023562628321246041,0.11194921096902374,-0.011846990078136829,0.023595517712012279,-0.0018561041750790996,-0.04744843640418852,1.0903855567274978,0.005848388484648288,-9.7127837766905003],"FOG":[-0.016015181943086314],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.1976336680707318,-7.7663783592261568,-26.871933546217708,66.620422939843522,66.620422939843522],"omega_rad_s":[-2.8701322713984094,-6.0857961053598411,-26.634819068899834,67.263116763577756,67.264319598655504],"thrust_n":[-0.10494124751910562,-0.48380176255471574,-9.111045554337295,57.383674724939716,56.946004464689338],"torque_nm":[0.0019676483909832308,0.0090712830479009222,0.17083210414382433,-1.0759439010926197,-1.0677375837129253],"angle_rad":[-1.6500335605604151,-48.933825643968696,-108.63123334541322,243.4762514222526,243.47589462250784]},"command":[-0.030453653981626017,-0.073965508183106252,-0.25592317663064484,0.63448021847470026,0.63448021847470026],"arm":{"servo_position":[9.9261673506363519e-25,-1.0842021724855046e-21,9.7514668052651321e-21,0,-3.5998900258307764e-21,-3.3881317890171738e-23],"servo_velocity":[0,-8.6736173798840355e-19,0,0,0,0],"servo_effort":[0.0010696761616406163,-1.5636589730902291,-0.28347108371818669,-1.0093456936353412e-05,-0.00039986822101703258,0.00017474768143362079]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":105,"step":840,"t":4.2000000000000002,"sim_time":4.1999999999999327,"vehicle":{"origin_ned":[0.010310306860664864,6.9064713713779457e-05,1.9267421879705147],"origin_quat_xyzw":[0.00023809569333899249,0.055694544857351369,-0.0059339817376459734,0.99843019227400687],"cg_ned":[-0.073170901626677526,0.0012555096831502609,1.6339531654491017],"linear_velocity_ned":[0.0053922681300903235,4.246099966207636e-05,0.018581418800470758],"angular_velocity_ned":[0.0011038782896016369,-0.012176354136963906,-0.0013577005849142859]},"sensors":{"Odom":[0.010310306860664864,6.9064713713779457e-05,1.9267421879705147,-0.00036071702591497544,-0.00037601300939868655,0.019678501239535882,0.00023809569333900209,0.05569454485735361,-0.0059339817376462128,0.99843019227400687,0.0013919105538741303,-0.012162133844065568,-0.0012126762116645973],"Pressure":[11423.395566757006],"DVL":[-0.01549705577863722,-0.0030546377928923358,-0.0051994017842728595,8.7907459854445396,0.0013425544860850059,0.0099653118035415763,-0.020002051498867884,0],"IMU":[-0.0001866951984648817,0.11144761993641113,-0.011896897383462855,0.082480830424261603,-0.015007325217163869,-0.039467589229372477,1.075340666953795,0.0025983619361761145,-9.7078684571969838],"FOG":[-0.0085928830071059],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.3366082103416246,-8.2691478745101143,-27.059436043292827,66.587195814705012,66.587195814705012],"omega_rad_s":[-3.0771669217089284,-6.8211491953091752,-26.83463552582511,67.221097051491597,67.222219948811045],"thrust_n":[-0.12062702974186411,-0.60590844142300948,-9.24594287789437,57.282971425616886,56.874265710841399],"torque_nm":[0.0022617568076599521,0.011360783276681427,0.17336142896051945,-1.0740557142303166,-1.0663924820782764],"angle_rad":[-1.7696274388120099,-49.194239917066348,-109.7011919095838,246.16582591355001,246.16551542566978]},"command":[-0.031777221050872613,-0.078753789281048703,-0.25770891469802693,0.63416376966385724,0.63416376966385724],"arm":{"servo_position":[9.9261673506363519e-25,-1.0842021724855046e-21,9.7514668052651321e-21,0,-3.5998900258307764e-21,-3.3881317890171738e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.0015387637659767979,-1.5567411685244614,-0.28164416240888007,-9.4231764855936117e-06,-0.00039174522758004887,0.00016665557484551763]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":106,"step":848,"t":4.2400000000000002,"sim_time":4.2399999999999318,"vehicle":{"origin_ned":[0.010388284848539875,5.294228278587311e-05,1.9275365207216477],"origin_quat_xyzw":[0.00026390974343309275,0.055461222498193206,-0.005959092365906974,0.99844302409743324],"cg_ned":[-0.072955932540697363,0.001257267999677607,1.6347085463773918],"linear_velocity_ned":[0.0053583539170017859,4.516062825285948e-05,0.019118489633226689],"angular_velocity_ned":[0.0011842606843372012,-0.011313173649979564,-0.0012986061751632666]},"sensors":{"Odom":[0.010388284848539875,5.294228278587311e-05,1.9275365207216477,-0.00018557559662951998,-0.00038813180815553522,0.020163391825193562,0.00026390974343309964,0.055461222498194664,-0.0059590923659071302,0.99844302409743324,0.0014550068984377986,-0.011298067652796839,-0.0011460242752905252],"Pressure":[11432.936345138629],"DVL":[-0.0059668883788049085,-0.017924992683470753,0.0053142250409764259,8.6677903210514842,0.018996052848357731,0.0052672966585459906,0.0077730429477908649,0],"IMU":[-0.00013482888155239321,0.11098056528344882,-0.011944117643752278,-0.044730565632942983,-0.04419028417044546,-0.21392935671444202,1.0778940551864438,-0.00088245803907485189,-9.7793200027745915],"FOG":[-0.01215935081876276],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.4621461813999752,-8.7347113440638946,-27.243561783005852,66.551957459101615,66.551957459101615],"omega_rad_s":[-3.2598098197938516,-7.4792079591324949,-27.031245969198554,67.177232850586662,67.178276804675193],"thrust_n":[-0.13536997575305848,-0.72673322258050821,-9.3794819408901624,57.179613249991803,56.799931457511157],"torque_nm":[0.0025381870453698462,0.013626247923384531,0.17586528639169055,-1.0721177484373463,-1.0649987148283344],"angle_rad":[-1.8969363380653272,-49.482268115689592,-110.7790705532137,248.85367747019365,248.85341011840438]},"command":[-0.03297282077523786,-0.083187727086322799,-0.25946249317148429,0.63382816627715821,0.63382816627715821],"arm":{"servo_position":[-1.1249656330721157e-24,-1.0842021724855046e-21,9.7514668052651321e-21,-3.3881317890172014e-23,-3.5998900258307764e-21,-3.3881317890171738e-23],"servo_velocity":[0,0,0,-6.7762635780344027e-21,0,0],"servo_effort":[0.002037185563809911,-1.5503864791005759,-0.27994803621529379,-8.7892182152240683e-06,-0.00038406426234209048,0.00015888672608532222]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":107,"step":856,"t":4.2800000000000002,"sim_time":4.279999999999931,"vehicle":{"origin_ned":[0.010474734451974721,3.6225182028121932e-05,1.9283490783245589],"origin_quat_xyzw":[0.00029110119515786571,0.055245138405033478,-0.0059829538624063677,0.99845485336382789],"cg_ned":[-0.072742584344516317,0.0012591379801570989,1.6354850930552391],"linear_velocity_ned":[0.0053128026614968991,4.8014617506334543e-05,0.019641442684947778],"angular_velocity_ned":[0.0012592813744215117,-0.010450753687680281,-0.0012406051974975523]},"sensors":{"Odom":[0.010474734451974721,3.6225182028121932e-05,1.9283490783245589,-2.0890487985544305e-05,-0.00039866702383384084,0.02063319948834982,0.00029110119515787227,0.055245138405034727,-0.005982953862406503,0.99845485336382789,0.0015128952286739402,-0.010434819121524561,-0.0010811296891247179],"Pressure":[11441.286561212934],"DVL":[0.0098412804122856769,-0.0037657273044483229,-0.018394837543112476,8.6835004481307934,-0.026350536472477936,-0.0029682543935811031,-0.010166729461348285,0],"IMU":[-8.0245260711681588e-05,0.110548064546407,-0.011988721984263123,0.025493391372729442,-0.03330202718082035,0.17786704965135211,1.0735779424097303,0.027402860179016393,-9.779706464950408],"FOG":[-0.020008109670131925],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5755116753307439,-9.1681205412645319,-27.424118733010829,66.514708124543787,66.514708124543787],"omega_rad_s":[-3.4216661485160325,-8.0734161122382417,-27.224452300378886,67.131523970495408,67.132490166047717],"thrust_n":[-0.1491438701308937,-0.84517862051587267,-9.5114867057638666,57.073651218408195,56.722952031682745],"torque_nm":[0.0027964475649542571,0.015847099134672613,0.17834037573307254,-1.0701309603451536,-1.0635553505940516],"angle_rad":[-2.0310690416038377,-49.795133123051151,-111.86473651031022,251.53973231456953,251.53950496718673]},"command":[-0.034052492146007085,-0.087315433726328884,-0.26118208317153169,0.63347341070994079,0.63347341070994079],"arm":{"servo_position":[-1.1249656330721157e-24,3.2526065174565132e-21,9.7514668052651321e-21,-3.3881317890172014e-23,-3.5998900258307764e-21,-3.3881317890171738e-23],"servo_velocity":[0,8.6736173798840355e-19,0,-6.7762635780344027e-21,0,0],"servo_effort":[0.0025781118170759404,-1.5445723309345334,-0.27837818879113219,-8.2252622425082654e-06,-0.00037682239063454155,0.00015145344701298572]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":108,"step":864,"t":4.3200000000000003,"sim_time":4.3199999999999301,"vehicle":{"origin_ned":[0.010569187499941249,1.8977333173161902e-05,1.9291793124122509],"origin_quat_xyzw":[0.00031956282746804625,0.055046248118793245,-0.0060055930986492078,0.99846569360152626],"cg_ned":[-0.072531302861571723,0.0012611244412188325,1.6362822364564553],"linear_velocity_ned":[0.0052564836780549188,5.0963406047337185e-05,0.020150061631823923],"angular_velocity_ned":[0.0013288211778169513,-0.0095916712182947655,-0.0011835368123820664]},"sensors":{"Odom":[0.010569187499941249,1.8977333173161902e-05,1.9291793124122509,0.00013338134845637759,-0.00040763160089596969,0.021087937483475771,0.00031956282746805091,0.05504624811879405,-0.0060055930986492954,0.99846569360152626,0.0015654687137174324,-0.0095749671392278361,-0.0010178378347367406],"Pressure":[11452.759099351142],"DVL":[0.016698038424481032,-0.0035363410887341452,-0.013590990116520384,8.6893023606448061,0.012949500100351586,0.019648991408225926,-0.041869394713153353,0],"IMU":[-2.3166090643454756e-05,0.11015002608659914,-0.012030775453748928,0.047536261816268272,0.068631221082240373,0.02191465144083625,1.0724186362278929,0.00084224877354838765,-9.754212059278224],"FOG":[-0.00032063181332665953],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.6777242132796593,-9.5734212351841581,-27.600949932849836,66.475455190531108,66.475455190531108],"omega_rad_s":[-3.565550247125945,-8.6143506417044371,-27.41406571147413,67.083970416426169,67.084860216845073],"thrust_n":[-0.16194732789355998,-0.96068813505564665,-9.6417846972088448,56.965133989106768,56.643286487276292],"torque_nm":[0.0030365123980042497,0.018012902532293377,0.18078346307266585,-1.0680962622957522,-1.0620616216364303],"angle_rad":[-2.1712599811090785,-50.130528353738164,-112.95804926834418,254.22391664965684,254.22372622645167]},"command":[-0.035025944888377708,-0.091175440335087218,-0.2628661898366651,0.63309957324315336,0.63309957324315336],"arm":{"servo_position":[3.1101991031993861e-24,-1.0842021724855046e-21,9.7514668052651321e-21,0,-3.5998900258307764e-21,-3.3881317890171738e-23],"servo_velocity":[1.6940658945086007e-21,0,1.7347234759768071e-18,0,0,0],"servo_effort":[0.0031671831383653952,-1.5392206997266915,-0.27692087116740699,-7.6747917206048012e-06,-0.00037002676382213876,0.00014436048701682748]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":109,"step":872,"t":4.3600000000000003,"sim_time":4.3599999999999293,"vehicle":{"origin_ned":[0.010671180438785136,1.2622387833710353e-06,1.9300266694776618],"origin_quat_xyzw":[0.00034918561743973325,0.054864457668236152,-0.0060270337031534151,0.99847556015103134],"cg_ned":[-0.072322499983432625,0.0012632299817862168,1.6370993952633828],"linear_velocity_ned":[0.0051902346437540034,5.3954042678512883e-05,0.020644018007267142],"angular_velocity_ned":[0.0013928022859926517,-0.0087383623539415058,-0.0011272354601239473]},"sensors":{"Odom":[0.010671180438785136,1.2622387833710353e-06,1.9300266694776618,0.00027731143446227229,-0.00041504414558690786,0.021527493419791852,0.00034918561743974176,0.054864457668237492,-0.0060270337031535625,0.99847556015103134,0.0016126600548114071,-0.0087209492163908674,-0.00095598479692752679],"Pressure":[11463.918788449892],"DVL":[-0.012995061782342495,-0.0021663102827958534,-0.045485431617046566,8.5974210731095351,-0.021128272091165239,-0.00537602939801342,0.010980833283963499,0],"IMU":[3.6184586885284048e-05,0.10978625915240037,-0.012070336258191825,-0.030715149764606854,0.009208074728500765,0.0015913978736461912,1.067911007140367,0.00050385360046353053,-9.7115618077467261],"FOG":[-0.012896045849496622],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.7696124712441086,-9.9538918764211424,-27.773932447545395,66.434275237733473,66.434275237733473],"omega_rad_s":[-3.6936704884689693,-9.1103694422315424,-27.599916423309807,67.034590672292651,67.03540560462973],"thrust_n":[-0.1737906760192641,-1.073018512117865,-9.7702142759723234,56.854143253061515,56.56093299505855],"torque_nm":[0.0032585751753612022,0.020119097102209972,0.18319151767448111,-1.0660151859949034,-1.0605174936573478],"angle_rad":[-2.3168419407210483,-50.486518318307304,-114.05886118693839,256.9061570328634,256.90600051187369]},"command":[-0.035901071154705796,-0.094798970251629935,-0.26451364235757518,0.63270738321650932,0.63270738321650932],"arm":{"servo_position":[-1.1249656330721157e-24,-1.0842021724855046e-21,9.7514668052651321e-21,0,-3.5998900258307764e-21,-3.3881317890171738e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.0038056131989945789,-1.5343325303069355,-0.27557738463730114,-7.131393394894939e-06,-0.0003636712888994272,0.00013761143764780707]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":110,"step":880,"t":4.4000000000000004,"sim_time":4.3999999999999284,"vehicle":{"origin_ned":[0.010780254302419745,-1.6857359015175991e-05,1.930890596522173],"origin_quat_xyzw":[0.00037985941339245132,0.054699624002730748,-0.0060472960106155126,0.99848447011044983],"cg_ned":[-0.072116553942495026,0.0012654550414528619,1.637935981626059],"linear_velocity_ned":[0.0051148962335226837,5.6931972061017353e-05,0.021123266542551873],"angular_velocity_ned":[0.0014511735054740585,-0.0078932642174257168,-0.0010715380752530492]},"sensors":{"Odom":[0.010780254302419745,-1.6857359015175991e-05,1.930890596522173,0.00041094850193963998,-0.00042093345670301787,0.021952033584809943,0.00037985941339246107,0.05469962400273215,-0.0060472960106156678,0.99848447011044983,0.0016544292410461143,-0.0078752035090199242,-0.00089540603844959926],"Pressure":[11473.561529185943],"DVL":[0.014430426567235449,-0.016268268801460633,-0.007278578308124924,8.7570465720779662,-0.026124802097645766,-0.011231278843502047,0.0053362890555833618,0],"IMU":[9.7581780934402309e-05,0.10945647475808615,-0.012107455639850512,0.0044314192777906106,-0.024001889674669548,-0.059631354191911547,1.0511125009340305,0.011565476300723987,-9.7274850317157444],"FOG":[-0.012552302373587849],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.8518939057278976,-10.31211693102852,-27.94293062012899,66.391198562757083,66.391198562757083],"omega_rad_s":[-3.8077792560184283,-9.5680830599922633,-27.781847200757561,66.983414001013443,66.984155743609335],"thrust_n":[-0.18468973365342756,-1.1820954927850809,-9.8966207470688854,56.740771663035019,56.475900832340706],"torque_nm":[0.0034629325060017671,0.022164290489720261,0.18556163900754163,-1.0638894686819067,-1.0589231406063881],"angle_rad":[-2.4672252927645109,-50.861461007226502,-115.1670181576112,259.58638111832965,259.58625554211346]},"command":[-0.036684703864075213,-0.098210637438366846,-0.26612314876313325,0.63229712916911507,0.63229712916911507],"arm":{"servo_position":[-1.1249656330721157e-24,-1.0842021724855046e-21,9.7514668052651321e-21,0,-3.5998900258307764e-21,-3.3881317890171738e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.0044870512273484497,-1.530013319942392,-0.27437167381073169,-6.5953226483434483e-06,-0.00035776118059830704,0.00013122495627045967]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":111,"step":888,"t":4.4400000000000004,"sim_time":4.4399999999999276,"vehicle":{"origin_ned":[0.010895956376561725,-3.5319703266734146e-05,1.9317705460611299],"origin_quat_xyzw":[0.00041147341012547404,0.054551559367571355,-0.0060663970670293268,0.99849244207796795],"cg_ned":[-0.071913810208565909,0.0012677979795635,1.6387914069169949],"linear_velocity_ned":[0.0050312683220623744,5.9847522501756547e-05,0.02158779521033637],"angular_velocity_ned":[0.0015039085528883204,-0.0070584488702000129,-0.0010162814740116233]},"sensors":{"Odom":[0.010895956376561725,-3.5319703266734146e-05,1.9317705460611299,0.00053441250938446403,-0.00042533046865125807,0.022361731672396756,0.00041147341012547837,0.054551559367571924,-0.0060663970670293901,0.99849244207796795,0.0016907571023495264,-0.0070398027874294293,-0.00083593454172752372],"Pressure":[11483.796620384666],"DVL":[0.011595267464940865,-0.0045959903844928597,-0.031326067664386559,8.7229122788308437,-0.015669179725752398,-0.020189294548794798,0.004020251371706412,0],"IMU":[0.00016080043706567649,0.10916029445567235,-0.012142177897644806,0.0076838139365570527,0.0072395501138501238,-0.051700233706929319,1.0441306703878557,-0.0049028719412877201,-9.7267387329328958],"FOG":[-0.0052887995171936111],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.9251864121038396,-10.650238380467268,-28.107827524892723,66.346208848908645,66.346208848908645],"omega_rad_s":[-3.909287084920948,-9.9927393845758612,-27.95971073461596,66.930454450397548,66.931124820415718],"thrust_n":[-0.19466297600263208,-1.2879301357625499,-10.020854384893207,56.625079416868545,56.388178075067216],"torque_nm":[0.003649930800049351,0.024148690045547809,0.18789101971674765,-1.0617202390662852,-1.0572783389075102],"angle_rad":[-2.6218824926489122,-51.253946795351865,-116.28235997743002,262.26451738044273,262.2644198618658]},"command":[-0.037382727734322281,-0.10143084171873588,-0.2676935954751688,0.63186865570389183,0.63186865570389183],"arm":{"servo_position":[-1.1249656330721157e-24,-1.0842021724855046e-21,9.7514668052651321e-21,0,-3.5998900258307764e-21,-3.3881317890171667e-23],"servo_velocity":[0,0,1.7347234759768071e-18,0,0,0],"servo_effort":[0.0052007405993830793,-1.5264280874997103,-0.27335186651314786,-6.0664131835954304e-06,-0.00035230008542456477,0.00012519528694796315]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":112,"step":896,"t":4.4800000000000004,"sim_time":4.4799999999999267,"vehicle":{"origin_ned":[0.01101784091679614,-5.406415556047546e-05,1.9326659767258156],"origin_quat_xyzw":[0.00044391661493854993,0.054420035312674142,-0.0060843507654935883,0.99849949592895071],"cg_ned":[-0.071714583120753378,0.0012702552565799874,1.6396650830033173],"linear_velocity_ned":[0.0049401127124052546,6.2654783410382342e-05,0.022037638752500355],"angular_velocity_ned":[0.0015510034499778458,-0.0062359488722095154,-0.00096131806241135274]},"sensors":{"Odom":[0.01101784091679614,-5.406415556047546e-05,1.9326659767258156,0.0006477981291980392,-0.00042827096933662428,0.022756799369071139,0.0004439166149385547,0.054420035312674725,-0.0060843507654936534,0.99849949592895071,0.0017216482602756718,-0.0062167800013846319,-0.00077741632221512195],"Pressure":[11492.185456475969],"DVL":[-0.025579542656221827,-0.015706589913803637,-0.019136650102336755,8.7284094830894201,0.017487075114489381,0.0024629648614035056,0.0085437158840836833,0],"IMU":[0.00022561629405970678,0.10889725837071325,-0.012174540670520109,0.14511374503647723,-0.0045417112096462035,-0.021904028738267481,1.0483267076123872,-0.0034206413667344769,-9.7291076299610175],"FOG":[-0.019984047270904259],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.9900178800560906,-10.970069646258418,-28.268528306199698,66.299289752611358,66.299289752611358],"omega_rad_s":[-3.9993391334635913,-10.388552132387332,-28.133376930075983,66.875715541399089,66.876316479870866],"thrust_n":[-0.20372950895448969,-1.3905782231662882,-10.142776285398584,56.507106498459358,56.297735878815089],"torque_nm":[0.0038199282928966819,0.026073341684367906,0.19017705535122345,-1.059508246846113,-1.0555825477277831],"angle_rad":[-2.7803361874841999,-51.66275177978509,-117.4047209592476,264.94049461347242,264.940422340917]},"command":[-0.038000170286248483,-0.1044768537738897,-0.26922407910666379,0.63142180716772722,0.63142180716772722],"arm":{"servo_position":[-1.1249656330721157e-24,-1.0842021724855046e-21,9.7514668052651321e-21,0,-3.5998900258307764e-21,-3.3881317890171667e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.0059567304557862286,-1.5232877468477075,-0.27244301386940345,-5.5451295689789272e-06,-0.00034727863448532779,0.00011952951168738448]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":113,"step":904,"t":4.5200000000000005,"sim_time":4.5199999999999259,"vehicle":{"origin_ned":[0.011145468904457487,-7.3031287659760039e-05,1.9335763542647237],"origin_quat_xyzw":[0.00047707820408690252,0.054304785224154627,-0.0061011680713760012,0.99850565268620806],"cg_ned":[-0.071519157618722462,0.0012728215988281285,1.6405564236575922],"linear_velocity_ned":[0.00484214200539251,6.5312534741902872e-05,0.022472849651761311],"angular_velocity_ned":[0.001592467708914843,-0.0054275370912690744,-0.00090650654085570523]},"sensors":{"Odom":[0.011145468904457487,-7.3031287659760039e-05,1.9335763542647237,0.00075123291958457223,-0.00042979061753865372,0.02313744559483865,0.00047707820408691022,0.054304785224155501,-0.0061011680713760992,0.99850565268620806,0.0017471186176568889,-0.0054079082103334558,-0.00071970251777864246],"Pressure":[11503.789572279458],"DVL":[0.010760778502471126,0.037113971500429575,-0.019955678940175952,8.7273051911564998,-0.0097115664224238923,0.0015685197091318476,-0.0039819443411491353,0],"IMU":[0.00029180652880896654,0.10866683027690376,-0.012204575409853024,-0.011536551829280792,0.028496231758017465,0.046119144419212124,1.0613880238203575,0.0050172181440996735,-9.7407020178789594],"FOG":[-0.019362036305573069],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-4.0468488256137611,-11.273090860958515,-28.424934263306426,66.250415069346914,66.250415069346914],"omega_rad_s":[-4.0788771868939699,-10.758911145650945,-28.302725387282816,66.819190029082719,66.819723588120439],"thrust_n":[-0.21190853056422923,-1.4901084114424723,-10.262253198897564,56.386871087534779,56.2045310094136],"torque_nm":[0.0039732849480792988,0.027939532714546356,0.19241724747932934,-1.0572538328912773,-1.053834956426505],"angle_rad":[-2.9421500717796265,-52.086801300147691,-118.53393043268157,267.61424150054421,267.61419174257918]},"command":[-0.038541417386797727,-0.10736277010436682,-0.2707136596505374,0.63095633399378015,0.63095633399378015],"arm":{"servo_position":[7.3453638394708879e-24,-1.0842021724855046e-21,9.7514668052651321e-21,0,-3.5998900258307764e-21,-3.3881317890171667e-23],"servo_velocity":[3.3881317890172014e-21,0,0,6.7762635780344027e-21,0,-4.3368086899420177e-19],"servo_effort":[0.0067442046320209748,-1.5206983848507458,-0.27169577725488564,-5.7474144602741902e-06,-0.00034317880956906654,0.00011469897806198694]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":114,"step":912,"t":4.5600000000000005,"sim_time":4.559999999999925,"vehicle":{"origin_ned":[0.011278409373227175,-9.2162809929995267e-05,1.9345011511439214],"origin_quat_xyzw":[0.00051084763818453152,0.054205510016433589,-0.0061168571033969246,0.99851093423042969],"cg_ned":[-0.071327791262542226,0.0012754901752534493,1.641464845077502],"linear_velocity_ned":[0.0047380197182259436,6.7783362170267014e-05,0.022893498418779076],"angular_velocity_ned":[0.0016283135766035528,-0.004634753713233246,-0.00085171222396138114]},"sensors":{"Odom":[0.011278409373227175,-9.2162809929995267e-05,1.9345011511439214,0.00084486906523877732,-0.00042992275340230263,0.023503878567861031,0.0005108476381845326,0.054205510016433693,-0.0061168571033969367,0.99851093423042969,0.0017671849466043411,-0.0046147277227773925,-0.00066265089425041035],"Pressure":[11513.903252971666],"DVL":[0.02349695199248835,0.030597043889509241,-0.055595815645910346,8.666044564023613,-0.019406576009959629,0.0013761554574726338,-0.0056249373348512249,0],"IMU":[0.00035914989427446331,0.10846840899691061,-0.012232307590582921,0.036450114161537012,0.02108435439607154,-0.029553089090653902,1.0546367004081727,-0.021098421571073198,-9.7183725780918646],"FOG":[0.011161055760710435],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-4.0960549705864651,-11.560629276954959,-28.576977734910464,66.199564318708767,66.199564318708767],"omega_rad_s":[-4.1486768873867144,-11.106585662864816,-28.467651403834118,66.760864680474498,66.761333007864494],"thrust_n":[-0.21921827303314495,-1.5865946862219205,-10.379162135411194,56.264377396390117,56.108515034909836],"torque_nm":[0.0041103426193714676,0.029748650366661012,0.19460929003895991,-1.0549570761823146,-1.0520346569045596],"angle_rad":[-3.1069216484398181,-52.525141693671721,-119.66981325593299,270.28568628765129,270.28565639713457]},"command":[-0.039010047338918712,-0.11010123120909485,-0.27216169271343299,0.63047204113055966,0.63047204113055966],"arm":{"servo_position":[7.3453638394708879e-24,-1.0842021724855046e-21,9.7514668052651321e-21,0,-3.5998900258307764e-21,-3.3881317890171667e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.0075646072201375194,-1.5185189056287771,-0.27105913042257584,-6.1447586095199174e-06,-0.00033949248608261621,0.00010928325535297789]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":115,"step":920,"t":4.6000000000000005,"sim_time":4.5999999999999241,"vehicle":{"origin_ned":[0.011416239485491517,-0.00011140154861993237,1.9354398469798459],"origin_quat_xyzw":[0.00054511476846897853,0.054121881483964011,-0.0061314233618399109,0.9985153631477498],"cg_ned":[-0.071140716132024759,0.0012782527311351029,1.6423897668376164],"linear_velocity_ned":[0.0046283616603142461,7.0033212348335678e-05,0.023299677846333414],"angular_velocity_ned":[0.0016585643284105823,-0.0038589706745721856,-0.00079681331867261038]},"sensors":{"Odom":[0.011416239485491517,-0.00011140154861993237,1.9354398469798459,0.00092886482961959237,-0.00042870195738351901,0.023856313773087272,0.00054511476846899436,0.05412188148396558,-0.0061314233618400887,0.9985153631477498,0.0017818745213620507,-0.0038386104255993792,-0.00060613113605782222],"Pressure":[11524.246210336405],"DVL":[0.0057649608333620204,0.012372039986980178,-0.0092743810417277566,8.7239517175887684,0.025351835885416247,-0.032111791009311608,0.0043475962747378111,0],"IMU":[0.00042742685180708354,0.10830133511447802,-0.012257757213526144,0.08101517964690183,0.0089618489187979402,0.11494233929834642,1.0507410380934452,-0.0093161745883401093,-9.7758708562289378],"FOG":[-0.0158415614901216],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-4.1379491625367129,-11.833811786802146,-28.724596513605857,66.146713082679852,66.146713082679852],"omega_rad_s":[-4.2093774191838467,-11.433859005813217,-28.628064627364044,66.700721612557842,66.701126936892294],"thrust_n":[-0.2256754847378474,-1.6801093386390336,-10.493389924728575,56.139619107314836,56.00963459904672],"torque_nm":[0.0042314153388346397,0.031502050099481878,0.19675106108866081,-1.0526178582621533,-1.0501806487321264],"angle_rad":[-3.2742762590516441,-52.976918721944983,-120.81219043664271,272.95475658543859,272.95474400300498]},"command":[-0.039409039643206786,-0.11270296939811568,-0.27356758584386531,0.62996869602552241,0.62996869602552241],"arm":{"servo_position":[7.3453638394708879e-24,-1.0842021724855046e-21,9.7514668052651321e-21,0,-3.5998900258307764e-21,-3.3881317890171667e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.0084213779413826097,-1.5166529650368017,-0.27049839572094042,-6.5044439598526588e-06,-0.00033595829429552493,0.00010469948220504904]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":116,"step":928,"t":4.6399999999999997,"sim_time":4.6399999999999233,"vehicle":{"origin_ned":[0.01155854605456523,-0.00013069143117787666,1.9363919277508619],"origin_quat_xyzw":[0.00057977001854003004,0.054053548409085016,-0.006144869810525859,0.99851896243693028],"cg_ned":[-0.070958140900272776,0.0012810997488618271,1.6433306120661093],"linear_velocity_ned":[0.0045137283316272047,7.2032539871269357e-05,0.023691469790061783],"angular_velocity_ned":[0.0016832487267668668,-0.0031011367483888995,-0.00074168465018770158]},"sensors":{"Odom":[0.01155854605456523,-0.00013069143117787666,1.9363919277508619,0.0010034567820727874,-0.00042615908728379294,0.024194927598828467,0.00057977001854005053,0.054053548409086931,-0.0061448698105260767,0.99851896243693028,0.0017912146785230834,-0.0030805049523326762,-0.00055000976608758243],"Pressure":[11534.958038928764],"DVL":[0.0005915619753510123,-0.011804515223792798,-0.050978380748387189,8.6593511206347831,0.0087740899471619362,0.028746722721015309,0.024022930544135991,0],"IMU":[0.00049641983753221557,0.10816490320690275,-0.012280939005296337,0.040209483527625704,-0.076478028827597549,0.12994044892767817,1.0470702736603108,-0.006639833387283238,-9.7154257996970266],"FOG":[-0.015727938737023075],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-4.1727972490109186,-12.093665535963265,-28.867753191773751,66.091841842327156,66.091841842327156],"omega_rad_s":[-4.2615092276041766,-11.742639645352062,-28.783890435485809,66.638740418233141,66.639085033051231],"thrust_n":[-0.23129567923968339,-1.770722055060086,-10.604834273980488,56.012580669675344,55.907840203841644],"torque_nm":[0.0043367939857440639,0.033201038532376617,0.19884064263713419,-1.0502358875564126,-1.048272003822031],"angle_rad":[-3.4438622837310748,-53.441360630038467,-121.96087970678282,275.62137921950466,275.62138147645436]},"command":[-0.039740926181056367,-0.11517776700917395,-0.27493098277879763,0.62944611278406815,0.62944611278406815],"arm":{"servo_position":[7.3453638394708879e-24,-1.0842021724855046e-21,9.7514668052651321e-21,0,-3.5998900258307764e-21,-3.3881317890171667e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.0092938439715171649,-1.515335746692859,-0.27009751931720649,-6.8246007171958541e-06,-0.00033259598085453158,0.00010045535101372564]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":117,"step":936,"t":4.6799999999999997,"sim_time":4.6799999999999224,"vehicle":{"origin_ned":[0.011704927444920354,-0.00014997738589201857,1.9373568846224287],"origin_quat_xyzw":[0.00061470440320073982,0.054000143315744716,-0.0061571969168868479,0.99852175518939112],"cg_ned":[-0.070780252911158234,0.0012840205942505174,1.6442868073326529],"linear_velocity_ned":[0.0043946335488449983,7.3754316358254018e-05,0.024068969546751567],"angular_velocity_ned":[0.0017024000069751507,-0.0023620095604018386,-0.00068621281823269585]},"sensors":{"Odom":[0.011704927444920354,-0.00014997738589201857,1.9373568846224287,0.0010688956973220433,-0.00042232490318200804,0.024519894495193151,0.00061470440320074546,0.054000143315745215,-0.0061571969168869051,0.99852175518939112,0.0017952362078274048,-0.0023411687010357926,-0.00049416500329485481],"Pressure":[11543.367057104744],"DVL":[0.0014848442327749906,-0.011811701942074607,-0.024594593044648037,8.6323509823657165,-0.0068128826621994829,-0.020531687363683795,-0.022186541275348408,0],"IMU":[0.00056591319824696108,0.10805837536839191,-0.012301862548161301,0.041103975765717164,0.002066681929935608,0.094440410493773067,1.0404452370426438,-0.0060487953789540297,-9.7381704855577773],"FOG":[-0.021505529390131919],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-4.200798592078999,-12.341194509292764,-29.006450949840481,66.034943909684472,66.034943909684472],"omega_rad_s":[-4.30550637556538,-12.034573554051201,-28.935079076850563,66.574903470518748,66.575189715239532],"thrust_n":[-0.23609245108930163,-1.8585093951243712,-10.713411120380814,55.883247957831763,55.803091979266092],"torque_nm":[0.0044267334579244063,0.034847051158581964,0.20087645850714025,-1.0478108992093458,-1.0463079746112391],"angle_rad":[-3.6153470864924713,-53.917765825141352,-123.11569637533385,278.28548025698916,278.2854949774549]},"command":[-0.040007605638847608,-0.11753518580278823,-0.27625191380800457,0.62890422771128074,0.62890422771128074],"arm":{"servo_position":[7.3453638394708879e-24,-1.0842021724855046e-21,9.7514668052651321e-21,0,-2.5156878533452718e-21,-3.3881317890171667e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.010195147087428061,-1.5143340437544546,-0.26978674999417335,-7.0868997143821638e-06,-0.00032940757469549295,9.6550842868875947e-05]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":118,"step":944,"t":4.7199999999999998,"sim_time":4.7199999999999216,"vehicle":{"origin_ned":[0.011854993239272402,-0.00016920540379884979,1.9383342144296745],"origin_quat_xyzw":[0.00064980966429064018,0.053961284842942152,-0.0061684029828599661,0.99852376450945823],"cg_ned":[-0.070607219919123387,0.0012870035929613576,1.6452577834639721],"linear_velocity_ned":[0.004271548073306786,7.5173406939475329e-05,0.02443229042331126],"angular_velocity_ned":[0.0017160589075417897,-0.0016422204637983296,-0.00063030049037383418]},"sensors":{"Odom":[0.011854993239272402,-0.00016920540379884979,1.9383342144296745,0.0011254300047129524,-0.00041723207256019702,0.024831395412202334,0.00064980966429065091,0.053961284842943054,-0.0061684029828600693,0.99852376450945823,0.0017939775701028941,-0.0016212326721974637,-0.00043849063228786018],"Pressure":[11554.271822365145],"DVL":[-0.01312494161036454,0.0074983139465929806,-0.0014356486488114502,8.6459178511345982,-0.042761753723263664,-0.014615798509809716,0.016554684733915057,0],"IMU":[0.00063569338511009767,0.10798098596137259,-0.012320532973616469,-0.093344248943210917,0.086466084912563468,-0.10031050609317116,1.0571629781317715,0.0034193799192172008,-9.7700047350849335],"FOG":[-0.01116581758617183],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-4.2221274620347229,-12.577257227032467,-29.140693564838124,65.976008325361931,65.976008325361931],"omega_rad_s":[-4.3417265624515506,-12.311084423772325,-29.081599848734935,66.509194466508546,66.509424710496063],"thrust_n":[-0.24007812307941742,-1.9435497085197435,-10.81905102225714,55.751607238914026,55.695354450355914],"torque_nm":[0.004501464807739078,0.036441557034745199,0.20285720666732138,-1.045342635729638,-1.0442878959441733],"angle_rad":[-3.7884136045310397,-54.405493407810994,-124.27645421173996,280.94698509472437,280.94700999713774]},"command":[-0.040210737733664029,-0.11978340216221398,-0.27753041490322022,0.62834293643201833,0.62834293643201833],"arm":{"servo_position":[7.3453638394708879e-24,-1.0842021724855046e-21,9.7514668052651321e-21,0,-2.5156878533452718e-21,-3.3881317890171667e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.011130398081849504,-1.5135077104210839,-0.2695278243993342,-7.2834420984446216e-06,-0.00032639100727945215,9.2969299108958749e-05]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":119,"step":952,"t":4.7599999999999998,"sim_time":4.7599999999999207,"vehicle":{"origin_ned":[0.012008364454815776,-0.00018832261019178175,1.939323419649789],"origin_quat_xyzw":[0.00068497844611873477,0.053936581019035916,-0.0061784843991918399,0.99852501338876531],"cg_ned":[-0.070439191809269858,0.0012900361135960122,1.646242975995182],"linear_velocity_ned":[0.0041448999851612196,7.6266842549667545e-05,0.024781551964072113],"angular_velocity_ned":[0.0017242767522120147,-0.00094221224565810562,-0.00057386135691728441]},"sensors":{"Odom":[0.012008364454815776,-0.00018832261019178175,1.939323419649789,0.0011733258748346347,-0.000410915119257675,0.025129603200881326,0.00068497844611877185,0.053936581019038837,-0.0061784843991921747,0.99852501338876531,0.0017874866143248963,-0.00092113914255406964,-0.0003828908130445607],"Pressure":[11563.520025799024],"DVL":[0.0049109165660011925,-0.009795239998090741,-0.020366159018041095,8.729359254194522,0.0014538683337513498,0.037292513264320676,-0.0042471223759241389,0],"IMU":[0.00070554922489699163,0.10793194817252959,-0.012336951495344847,-0.027145486581696094,0.056863320289743668,-0.09146520398305244,1.0551749108320128,-0.016787674158130782,-9.7241377400233411],"FOG":[-0.0095334851082602319],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-4.2369335220452609,-12.802624735242512,-29.270495845438287,65.915025145783943,65.915025145783943],"omega_rad_s":[-4.3704671243732927,-12.573410802642679,-29.223437897123649,66.44159797501321,66.441774603565108],"thrust_n":[-0.24326437051441169,-2.0259208912601521,-10.92169706806518,55.617643819278101,55.584597349629199],"torque_nm":[0.004561206947145219,0.037986016711127862,0.20478182002622214,-1.0428308216114646,-1.0422112003055475],"angle_rad":[-3.962757672638185,-54.903955106948885,-125.44296612157825,283.60581849619592,283.60585139416645]},"command":[-0.040351747829002485,-0.12192975938326202,-0.27876662709941225,0.62776214424556143,0.62776214424556143],"arm":{"servo_position":[7.3453638394708879e-24,-1.0842021724855046e-21,9.7514668052651321e-21,0,-2.5156878533452718e-21,-3.3881317890171667e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.012100947036909034,-1.5127978490713072,-0.26930762482920267,-7.4051693916196185e-06,-0.00032354808817820649,8.9708312937331798e-05]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":120,"step":960,"t":4.7999999999999998,"sim_time":4.7999999999999199,"vehicle":{"origin_ned":[0.012164674308660126,-0.00020727735622272565,1.9403240078536601],"origin_quat_xyzw":[0.00072010452717083666,0.053925633399486035,-0.0061874358218948298,0.99852552453599497],"cg_ned":[-0.070276302275423003,0.001293104656632198,1.6472418252411798],"linear_velocity_ned":[0.0040150762244162263,7.7013834656249663e-05,0.025116873405115703],"angular_velocity_ned":[0.0017271154258775674,-0.0002622157199944344,-0.00051681678773383803]},"sensors":{"Odom":[0.012164674308660126,-0.00020727735622272565,1.9403240078536601,0.0012128761521455222,-0.00040340998457661297,0.025414675271014917,0.00072010452717086442,0.053925633399488117,-0.0061874358218950683,0.99852552453599497,0.0017758198705863178,-0.00024111826062881943,-0.00032727685806072869],"Pressure":[11575.401645233722],"DVL":[0.038591551721889175,-0.0050892050017240717,-0.025318133190579482,8.7165571901778787,0.027921596384188577,-0.0022263960848997455,0.027448383483307685,0],"IMU":[0.00077527230271506094,0.10791046229885187,-0.01235111577666287,0.11021541428700786,0.043549310481785161,0.065184499169814766,1.0439628266706409,-0.0030382816989070341,-9.7596921031034487],"FOG":[-0.006859443605630366],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-4.245349678873942,-13.018020407395444,-29.395891088590375,65.851989700227506,65.851989700227506],"omega_rad_s":[-4.3919778454942442,-12.82264628397194,-29.360594812689602,66.372100666379211,66.37222606702133],"thrust_n":[-0.24566279585668507,-2.1057023310231027,-11.021305586349573,55.481343911663338,55.470798442790112],"torque_nm":[0.0046061774223128456,0.039481918706683175,0.20664947974405451,-1.0402751983436875,-1.0400774708023148],"angle_rad":[-4.1380859022649137,-55.412608792093422,-126.61504478764189,286.26190465163739,286.26194345428166]},"command":[-0.040431901703561354,-0.12398114673709947,-0.27996086751038451,0.62716180666883337,0.62716180666883337],"arm":{"servo_position":[7.3453638394708879e-24,-1.0842021724855046e-21,1.0778494253810964e-21,0,-2.5156878533452718e-21,-3.3881317890171667e-23],"servo_velocity":[0,0,-1.7347234759768071e-18,0,0,0],"servo_effort":[0.013099210191562039,-1.5121917357551644,-0.26911866412056656,-7.4314157866503163e-06,-0.00032087971651272354,8.6745959926811295e-05]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":121,"step":968,"t":4.8399999999999999,"sim_time":4.839999999999919,"vehicle":{"origin_ned":[0.012323568961654527,-0.00022601912014925691,1.9413354910349188],"origin_quat_xyzw":[0.00075508271355711077,0.053928040984218488,-0.0061952502582166826,0.99852532021974183],"cg_ned":[-0.070118670391985688,0.0012961949196493281,1.6482537762078229],"linear_velocity_ned":[0.0038824259700695478,7.7394936132117541e-05,0.025438370281696605],"angular_velocity_ned":[0.0017246279983961991,0.00039771794959292373,-0.00045909066617511003]},"sensors":{"Odom":[0.012323568961654527,-0.00022601912014925691,1.9413354910349188,0.0012443939759923415,-0.00039474881577014268,0.025686752377625046,0.00075508271355714189,0.053928040984220708,-0.0061952502582169377,0.99852532021974183,0.0017590230986478748,0.00041877939400237043,-0.00027156416853448033],"Pressure":[11583.794809825271],"DVL":[-0.032845256971555804,-0.0076539434096201363,-0.029800046536461788,8.7112334663868314,0.0088760082761033671,-0.0035477207728905726,0.028242293643228666,0],"IMU":[0.00084465667835955543,0.10791572358813488,-0.012363020148813273,-0.022945555773485192,-0.0012953414271416937,0.2849836858749723,1.0417999883692777,-0.023476876920325213,-9.75143779048482],"FOG":[-0.026411558900228768],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-4.2474626138435889,-13.224133777205118,-29.51692891496587,65.786903541031748,65.786903541031748],"omega_rad_s":[-4.4064642517824399,-13.059773510407519,-29.493089179836808,66.300692713243322,66.300769262316976],"thrust_n":[-0.24728465879179123,-2.1829776176521039,-11.11784688186215,55.342697460416858,55.3539454321416],"torque_nm":[0.0046365873523460865,0.040930830330976949,0.20845962903491533,-1.0376755773828161,-1.037886476852655],"angle_rad":[-4.314113908060528,-55.930953473219112,-127.79250334554717,288.91516729468771,288.91521000641455]},"command":[-0.040452024893748467,-0.12594413121147732,-0.28111360871396068,0.62654193848601669,0.62654193848601669],"arm":{"servo_position":[2.4286022784556895e-23,-1.0842021724855046e-21,9.7514668052651321e-21,0,-2.5156878533452718e-21,-3.3881317890171667e-23],"servo_velocity":[3.3881317890172014e-21,0,0,0,0,0],"servo_effort":[0.014117417855000652,-1.5116389727708179,-0.26895449267158894,-7.2938881890306999e-06,-0.00031837867256707367,8.4075882395917074e-05]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":122,"step":976,"t":4.8799999999999999,"sim_time":4.8799999999999182,"vehicle":{"origin_ned":[0.01248470797224753,-0.0002444987160473951,1.9423573849696778],"origin_quat_xyzw":[0.0007898092648498784,0.053943403412695379,-0.0062019192174300698,0.99852442214880288],"cg_ned":[-0.06996640204931133,0.0012992918771980101,1.6492782784164572],"linear_velocity_ned":[0.0037472639258017159,7.7393082061010516e-05,0.025746153184803316],"angular_velocity_ned":[0.0017169086537501381,0.0010376852679927666,-0.0004006185355328237]},"sensors":{"Odom":[0.01248470797224753,-0.0002444987160473951,1.9423573849696778,0.0012682064361824509,-0.00038497433843758498,0.025945959422367611,0.00078980926484989542,0.053943403412696538,-0.0062019192174302034,0.99852442214880288,0.0017371822787722226,0.0010586514430755924,-0.00021567592387077247],"Pressure":[11594.052597588588],"DVL":[0.012218847019930883,0.016384233423415766,-0.013245007657118817,8.6868365683612225,-0.016951607224820399,0.030270243309732093,-0.011436303393014118,0],"IMU":[0.00091349967463211668,0.10794692863964074,-0.012372655897481245,-0.061292574633895695,-0.012474126623885676,0.089420028631484905,1.0435746605981751,0.0089018366102100802,-9.7377931273520524],"FOG":[-0.028691139766659955],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-4.2433584660080914,-13.42161549058611,-29.633671587071198,65.719774510546543,65.719774510546543],"omega_rad_s":[-4.4140944918935148,-13.28568698149024,-29.620955495503853,66.227368834082711,66.227398884374864],"thrust_n":[-0.24814114578361149,-2.2578356120307079,-11.21130475136864,55.201700383571783,55.234037069865458],"torque_nm":[0.0046526464834427145,0.042334417725575772,0.21021196408816201,-1.0350318821919711,-1.0356381950599773],"angle_rad":[-4.490564606494913,-56.458525413688641,-128.97515603989515,291.5655298675855,291.56557458736603]},"command":[-0.040412937771505633,-0.12782490943415342,-0.28222544368639235,0.62590261438615757,0.62590261438615757],"arm":{"servo_position":[7.3453638394708879e-24,-1.0842021724855046e-21,9.7514668052651321e-21,0,-2.5156878533452718e-21,-3.3881317890171667e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.015160075340582948,-1.5111261829100215,-0.26880942587849427,-6.8257110197601722e-06,-0.00031604280478926729,8.1685236482911366e-05]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":123,"step":984,"t":4.9199999999999999,"sim_time":4.9199999999999173,"vehicle":{"origin_ned":[0.012647764554505531,-0.00026266857453691801,1.943389208599545],"origin_quat_xyzw":[0.00082418244050158217,0.053971323613204718,-0.0062074328371148988,0.99852285138013541],"cg_ned":[-0.06981959126355046,0.0013023798547997635,1.6503147856639893],"linear_velocity_ned":[0.0036098733545801135,7.69926631857393e-05,0.026040326088985492],"angular_velocity_ned":[0.0017040684925459346,0.0016579006985005616,-0.00034134047050559459]},"sensors":{"Odom":[0.012647764554505531,-0.00026266857453691801,1.943389208599545,0.0012846484832955787,-0.00037413311963166955,0.026192405730354158,0.00082418244050161209,0.053971323613206681,-0.0062074328371151243,0.99852285138013541,0.0017103991384768587,0.001678713705194033,-0.00015953856359121331],"Pressure":[11602.183301113908],"DVL":[0.023928948571522762,0.013622908768975277,-0.0079077917686035254,8.7074844642784583,0.0039044517680516138,0.020281736429520688,0.014103473383813505,0],"IMU":[0.00098160291798616108,0.10800328071342756,-0.012380011483135269,-0.030036171666383286,-0.022159422096427576,0.015035912076924727,1.0437922660740035,0.00066717300606569489,-9.7474049244679346],"FOG":[0.00020809001648613469],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-4.2331377294098722,-13.611081335327412,-29.746190960903217,65.650616908683233,65.650616908683233],"omega_rad_s":[-4.4150185307499372,-13.501208692841152,-29.744242596403488,66.152129010395655,66.152114880135059],"thrust_n":[-0.24824516679054581,-2.3303705362860949,-11.301675547177407,55.058356184075571,55.111083813419356],"torque_nm":[0.0046545968773227349,0.043694447555364287,0.21190641650957642,-1.0323441784514169,-1.0333328215016131],"angle_rad":[-4.6671672085592162,-56.99489496885014,-130.16281882814138,294.2129157197632,294.21296063993606]},"command":[-0.040315597422951162,-0.12962934605073725,-0.28329705677050682,0.62524397055888792,0.62524397055888792],"arm":{"servo_position":[7.3453638394708879e-24,-1.0842021724855046e-21,9.7514668052651321e-21,0,-2.5156878533452718e-21,-3.3881317890171667e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.016220475499735196,-1.5106327038476017,-0.26867975323224946,-6.034366332535493e-06,-0.00031387860575557013,7.9557568997932861e-05]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":124,"step":992,"t":4.96,"sim_time":4.9599999999999165,"vehicle":{"origin_ned":[0.012812426854065515,-0.00028047918264098625,1.9444304805513506],"origin_quat_xyzw":[0.00085809608943723575,0.054011412542061231,-0.0062117797125713827,0.99852062811897624],"cg_ned":[-0.069678321721570027,0.0013054422778702819,1.651362753253087],"linear_velocity_ned":[0.0034704818242335179,7.6154811433586477e-05,0.026320791282004964],"angular_velocity_ned":[0.0016851689530271228,0.0022590756739134655,-0.00028110594859736421]},"sensors":{"Odom":[0.012812426854065515,-0.00028047918264098625,1.9444304805513506,0.0012941695780998718,-0.00036197933916961021,0.026425970467438931,0.00085809608943726589,0.054011412542063132,-0.0062117797125716013,0.99852062811897624,0.0016777159391455901,0.0022796659464251767,-0.00010310312942471043],"Pressure":[11613.144141280665],"DVL":[0.025827852019275684,0.0083821182945490909,-0.029680394211105434,8.7628795848794567,0.010714564955522195,0.0010277648794584176,0.037412423848902802,0],"IMU":[0.0010487594117379137,0.10808399913930988,-0.012385072917915921,-0.094432968095610054,-0.029144813618921597,0.052299927440028184,1.0326350021066912,-0.019143908580626222,-9.7585322039899545],"FOG":[0.0020919723053533148],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-4.216892673854252,-13.793120482675098,-29.854566208831997,65.579452645846644,65.579452645846644],"omega_rad_s":[-4.4093719128291839,-13.707100940409431,-29.863011334566533,66.074979193299512,66.07492315568058],"thrust_n":[-0.24761166676891072,-2.4006819250547538,-11.388966299403913,54.912677584784639,54.985118369845239],"torque_nm":[0.004642718751917076,0.045012786094776637,0.2135431181138234,-1.0296127047147121,-1.0309709694345983],"angle_rad":[-4.8436565922634793,-57.539663974533752,-131.35530989724171,296.85724833264106,296.85729173730397]},"command":[-0.040160882608135731,-0.13136305221595332,-0.28432920198887618,0.62456621567472992,0.62456621567472992],"arm":{"servo_position":[7.3453638394708879e-24,-1.0842021724855046e-21,9.7514668052651321e-21,0,-2.5156878533452718e-21,-3.3881317890171667e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.017461030073107318,-1.510024985411049,-0.26854835106863739,-4.759097237239263e-06,-0.00031183579788584588,7.7121964875570713e-05]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":125,"step":1000,"t":5,"sim_time":4.9999999999999156,"vehicle":{"origin_ned":[0.012978406856876512,-0.00029785917188113469,1.945480683421642],"origin_quat_xyzw":[0.00089140259906239118,0.054063311725512105,-0.006214946423293532,0.99851777058179192],"cg_ned":[-0.069542671258501235,0.001308459589858765,1.6524216058657191],"linear_velocity_ned":[0.0033291928688879862,7.4800664480911011e-05,0.026586319480395318],"angular_velocity_ned":[0.0016584156591742539,0.0028430920673953009,-0.00021976733493103383]},"sensors":{"Odom":[0.012978406856876512,-0.00029785917188113469,1.945480683421642,0.0012975679911954867,-0.00034805758610874376,0.026645336827632881,0.00089140259906239747,0.054063311725512479,-0.0062149464232935745,0.99851777058179192,0.0016373099658671183,0.0028633675991081315,-4.6419304530581786e-05],"Pressure":[11620.603598867006],"DVL":[0.029462015331283224,-0.050662725609117408,-0.052723012397245209,8.7276686029419874,0.0051196725528144353,-0.018072224899304896,0.025941091760050737,0],"IMU":[0.0011146788723350614,0.10818836400249227,-0.012387826870417045,0.058467668196232718,0.042029569056889711,-0.081296689014328113,1.0465007496004677,-0.015464889010554188,-9.728094783081108],"FOG":[-0.018225935167217232],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-4.190680563467823,-13.968641919753868,-29.959120351316518,65.506610436820807,65.506610436820807],"omega_rad_s":[-4.396289348737632,-13.904156770365388,-29.97738766339819,65.99599864120735,65.995902897577281],"thrust_n":[-0.24614695974351347,-2.468902743845673,-11.473235135597792,54.7648141586834,54.856349858752942],"torque_nm":[0.0046152554951908774,0.046291926447106363,0.21512315879245861,-1.0268402654753142,-1.0285565598516178],"angle_rad":[-5.0197543208697395,-58.09246501607268,-132.55245106332464,299.49845269497695,299.49849295766393]},"command":[-0.039911243461598314,-0.13303468495003684,-0.28532495572682398,0.62387248035067433,0.62387248035067433],"arm":{"servo_position":[7.3453638394708879e-24,-1.0842021724855046e-21,9.7514668052651321e-21,0,-2.5156878533452718e-21,-3.3881317890171667e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.018716754210700307,-1.5088989456404367,-0.26833697529407041,-4.2987639615319276e-06,-0.00030987674097025,7.4759808144955381e-05]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":126,"step":1008,"t":5.04,"sim_time":5.0399999999999148,"vehicle":{"origin_ned":[0.013153013526137902,-0.00031018138529575459,1.9465600519395565],"origin_quat_xyzw":[0.00092574449499930299,0.054123905921043006,-0.0062180364423155615,0.99851443746586954],"cg_ned":[-0.069403492957218496,0.0013171704835453946,1.6535110688422328],"linear_velocity_ned":[0.0037411512556118614,0.00046272122064148911,0.028037037771857815],"angular_velocity_ned":[0.0018710767376889474,0.0030716215691887938,-0.00027836074038552081]},"sensors":{"Odom":[0.013153013526137902,-0.00031018138529575459,1.9465600519395565,0.001611601522503156,-1.7814725313886076e-05,0.028119437400605924,0.00092574449499933475,0.054123905921044872,-0.0062180364423157757,0.99851443746586954,0.0018522258238914706,0.0030944733071038111,-8.2257968283260696e-05],"Pressure":[11632.467935264061],"DVL":[0.00057337936246520894,-0.011058881111091779,-0.063026015275578079,8.7447855560710899,-0.017636551590132641,0.014420521530262295,-0.00026505021544660025,0],"IMU":[0.0011825796182155163,0.10831015743459146,-0.012390308564991981,-0.064884298492652551,0.044802979705814809,-0.0053221498934360647,1.0737183019251619,0.020226942129786825,-9.6967831505302478],"FOG":[0.0037231673895479021],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-105,105,0,105,105],"omega_rad_s":[-38.598466726424526,26.331769340093402,-19.893809247903999,79.33291335262615,79.33277505422673],"thrust_n":[-19.005764357240942,8.845858312573748,-5.0547101939365762,79.288224650184091,79.41050381553508],"torque_nm":[0.35635808169826771,-0.16585984336075774,0.094775816136310795,-1.4866542121909516,-1.4889469465412832],"angle_rad":[-6.0088038266985073,-57.692019540626973,-133.51180253055472,302.45544478413558,302.45548028123994]},"command":[-1,1,0,1,1],"arm":{"servo_position":[7.3453638394708879e-24,-1.0842021724855046e-21,1.0778494253810964e-21,0,-2.5156878533452718e-21,-3.3881317890171667e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.19250464053460237,-1.9697660878701992,-0.31666115657798266,-3.8548987503294552e-06,-0.0002966594119378069,3.1347890685201134e-05]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":127,"step":1016,"t":5.0800000000000001,"sim_time":5.0799999999999139,"vehicle":{"origin_ned":[0.013369972516816223,-0.00029007033028558308,1.9477383677688476],"origin_quat_xyzw":[0.00097353881163521393,0.054180534843869324,-0.0062166729514694982,0.99851132935166487],"cg_ned":[-0.069219593983284325,0.0013656998323123737,1.6546988594057068],"linear_velocity_ned":[0.005491667232369964,0.0019776983738013804,0.031189908517698001],"angular_velocity_ned":[0.0029793961955125715,0.0024939312108857243,0.00027487356372958062]},"sensors":{"Odom":[0.013369972516816223,-0.00029007033028558308,1.9477383677688476,0.0028197544074409844,0.0012445031613108916,0.031467358732652224,0.0009735388116352174,0.054180534843869518,-0.0062166729514695198,0.99851132935166487,0.0029012304555692953,0.0025313859785220491,0.00058906444632253301],"Pressure":[11644.636720517576],"DVL":[0.010644219524229479,0.0023202921910659598,-0.017534064056274463,8.7548853728031748,0.00014213031253450988,0.001416875039799968,0.037369387475564217,0],"IMU":[0.0012780389099124058,0.10842417074839419,-0.012382368651845175,0.014806777357161684,0.087705961464470239,0.015758158404795448,1.1162115235096095,0.060203817335795468,-9.664624450909594],"FOG":[-0.026572813438019274],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-105,105,0,105,105],"omega_rad_s":[-61.70922270063619,53.545589340767044,-13.066076094433523,88.349082545623361,88.348907377332338],"thrust_n":[-48.547419570648557,36.553938110679034,-2.1876779046129995,98.352195784621173,98.46838923239271],"torque_nm":[0.91026411694966025,-0.68538633957523198,0.041018960711493753,-1.8441036709616472,-1.8462822981073637],"angle_rad":[-8.1028479905165209,-55.99122460438447,-134.14521381721613,305.84319135007576,305.84322042358457]},"command":[-1,1,0,1,1],"arm":{"servo_position":[-5.3475572240328135e-22,7.5894152073985318e-21,1.8425084185149166e-20,0,-2.5156878533452718e-21,-3.3881317890171667e-23],"servo_velocity":[0,1.7347234759768071e-18,0,0,0,0],"servo_effort":[0.79556854821365863,-2.3861467880149601,-0.34675981044465243,2.6533747769583556e-05,-0.00024812278276256926,-5.6616366089549546e-05]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":128,"step":1024,"t":5.1200000000000001,"sim_time":5.1199999999999131,"vehicle":{"origin_ned":[0.013679003616855201,-0.00019855371879507833,1.9490734547316697],"origin_quat_xyzw":[0.001054244671221611,0.054216349072058911,-0.0061888550498021624,0.99850947623677677],"cg_ned":[-0.068931348930508257,0.0015015902510579068,1.6560400595465832],"linear_velocity_ned":[0.0087462356901302721,0.0046582160230036551,0.03548715017180739],"angular_velocity_ned":[0.0051430109087584027,0.0010918735720514968,0.0020505455044310282]},"sensors":{"Odom":[0.013679003616855201,-0.00019855371879507833,1.9490734547316697,0.0051430227242962312,0.0034841642444029225,0.036152732682993592,0.0010542446712216323,0.054216349072060001,-0.0061888550498022865,0.99850947623677677,0.0048769706126540998,0.0011588802784064216,0.0025922268639769304],"Pressure":[11656.514610159724],"DVL":[0.011991649485171372,-0.010980019055931687,-0.072747403222308743,8.6404727580731624,-0.01445130326792203,0.0090731889248352997,0.02347514641035775,0],"IMU":[0.001442756260978778,0.10849686357420558,-0.012317684029599997,0.018368865002052256,-0.036914045702187655,-0.039947286478091329,1.1707742980654781,0.098184608131339626,-9.6019205609168345],"FOG":[-0.0094152887897341036],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-105,105,0,105,105],"omega_rad_s":[-77.082482979325647,71.673699076598623,-8.444979884923038,94.438487471299567,94.438306667217773],"thrust_n":[-75.670185451835081,65.412668179754618,-0.9241394630995371,112.3086017356237,112.37260601123272],"torque_nm":[1.418815977221908,-1.2264875283703991,0.017327614933116325,-2.1057862825429448,-2.1069863627106131],"angle_rad":[-10.937824936588031,-53.41710589820768,-134.55797342067157,309.52199915764498,309.52202095965492]},"command":[-1,1,0,1,1],"arm":{"servo_position":[5.4944645008222311e-22,-1.0842021724855039e-21,9.7514668052651305e-21,0,-2.5156878533452718e-21,-3.3881317890171667e-23],"servo_velocity":[0,0,-1.7347234759768071e-18,0,0,0],"servo_effort":[1.4305579829348622,-2.7162976062457282,-0.36514717431725807,7.4146659666116848e-05,-0.00018013810917584663,-0.000187575451297505]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":129,"step":1032,"t":5.1600000000000001,"sim_time":5.1599999999999122,"vehicle":{"origin_ned":[0.014126438039750305,-1.1978618583347901e-06,1.950603816519314],"origin_quat_xyzw":[0.0011854815023638731,0.054217587301334448,-0.0061098126970182487,0.99850974860020114],"cg_ned":[-0.068484354639318276,0.0017663958729758535,1.6575709445125346],"linear_velocity_ned":[0.013218852053789152,0.008262532192579582,0.040527774918259658],"angular_velocity_ned":[0.0081283556697292793,-0.0008915161566782115,0.0049340363900932764]},"sensors":{"Odom":[0.014126438039750305,-1.1978618583347901e-06,1.950603816519314,0.008418120436090944,0.0065168459780356267,0.041732996968242696,0.001185481502363913,0.054217587301336273,-0.0061098126970184543,0.99850974860020114,0.007556427348887616,-0.00078281267291114426,0.0057876845188828451],"Pressure":[11671.600370751754],"DVL":[0.010548873506567157,0.036414628935112846,-0.076673615548926821,8.6698618529077525,0.017305320822078796,-0.014358033522369043,0.010434409878126872,0],"IMU":[0.0017149968429651069,0.10850082618130016,-0.012144579463453693,-0.007757457842835375,0.018725112104764303,0.029521351589901004,1.1912010139672529,0.12231714926316846,-9.6273261963560746],"FOG":[0.0047971333745532359],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-105,105,0,105,105],"omega_rad_s":[-87.266016155246803,83.683470372566575,-5.3197414476003546,98.546126342117248,98.545987759902758],"thrust_n":[-96.8584260389392,89.026568883428695,-0.37727283715020443,122.16327137176185,122.13775021126754],"torque_nm":[1.8160954882301101,-1.669248166564288,0.0070738656965663336,-2.2905613382205354,-2.2900828164612665],"angle_rad":[-14.263980634904131,-50.263753101562017,-134.82144893613665,313.39726342410751,313.39727877455971]},"command":[-1,1,0,1,1],"arm":{"servo_position":[5.4944645008222311e-22,7.5894152073985318e-21,1.0778494253810949e-21,0,1.821120836596746e-21,-3.3881317890171667e-23],"servo_velocity":[0,1.7347234759768071e-18,0,0,0,0],"servo_effort":[1.9539424361247608,-2.951719871838745,-0.3751176653340017,0.00013157119103292589,-7.9843883064587749e-05,-0.00029259276528259028]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":130,"step":1040,"t":5.2000000000000002,"sim_time":5.1999999999999114,"vehicle":{"origin_ned":[0.014747814700336551,0.00032828900324292638,1.9523540638736818],"origin_quat_xyzw":[0.0013790511691736671,0.054175765138878867,-0.0059600975185150739,0.99851267489554651],"cg_ned":[-0.067838118024841118,0.00219080830155261,1.6593147725337782],"linear_velocity_ned":[0.018545611424452834,0.012515877426489373,0.046038759479379757],"angular_velocity_ned":[0.011616492532389675,-0.0031926781562940125,0.0086142881450954421]},"sensors":{"Odom":[0.014747814700336551,0.00032828900324292638,1.9523540638736818,0.012398007884036014,0.010132469779571367,0.047882233495382127,0.0013790511691737278,0.054175765138881254,-0.0059600975185153367,0.99851267489554651,0.01065287710976274,-0.0030342777519044516,0.0098311454378452109],"Pressure":[11690.049274836327],"DVL":[-0.020415678836157358,-0.012563327933249956,-0.059836727677920795,8.7485451434189283,0.0064364418567711881,0.00087196260929198622,-0.0042885901460350999,0],"IMU":[0.0021206677394910805,0.10841909574554326,-0.011822735650673124,-0.04353561002723174,0.0062360695873148169,-0.15346141056489337,1.2041237101255862,0.1255623337036112,-9.5777156176986971],"FOG":[-0.010111631582579958],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-105,105,0,105,105],"omega_rad_s":[-94.010382358989375,91.6379276989,-3.2086469368809163,101.31226734944306,101.31222184174351],"thrust_n":[-112.24153223165681,106.55694498058182,-0.14642527969124325,128.94781719690866,128.8096513453813],"torque_nm":[2.1045287293435657,-1.9979427183859093,0.0027454739942108118,-2.4177715724420374,-2.4151809627259002],"angle_rad":[-17.915464110614007,-46.726714227405985,-134.98402306402781,317.40493578163012,317.40494752355323]},"command":[-1,1,0,1,1],"arm":{"servo_position":[5.4944645008222311e-22,-1.0842021724855039e-21,9.7514668052651305e-21,0,1.821120836596746e-21,-3.3881317890171667e-23],"servo_velocity":[0,0,1.7347234759768071e-18,0,0,0],"servo_effort":[2.3439681171639792,-3.1094479754833513,-0.37929260742142029,0.00019211560944435316,1.037246780869527e-05,-0.00037287171048065585]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":131,"step":1048,"t":5.2400000000000002,"sim_time":5.2399999999999105,"vehicle":{"origin_ned":[0.015567767763248586,0.00080844818213880905,1.954339165130125],"origin_quat_xyzw":[0.001641307390233139,0.05408693640142595,-0.0057268196240505553,0.99851845899700431],"cg_ned":[-0.066965733859055535,0.0027954364808687082,1.6612859199362202],"linear_velocity_ned":[0.024414124977106738,0.017188442204835952,0.051832951893025836],"angular_velocity_ned":[0.015345979268764033,-0.0056113174482142593,0.012796195510555905]},"sensors":{"Odom":[0.015567767763248586,0.00080844818213880905,1.954339165130125,0.01685911134546849,0.014150075318670368,0.054367684119684886,0.0016413073902332171,0.054086936401428524,-0.0057268196240508277,0.99851845899700431,0.013935961233462413,-0.0053986720185066088,0.014400413455952133],"Pressure":[11709.62037732789],"DVL":[-0.010577658628029606,0.025867837499004814,-0.066743278857335595,8.7186408480002413,-0.016456569612132318,-0.0026423419379939628,-0.03490746739022918,0],"IMU":[0.0026739117708799204,0.10824366015506397,-0.011325649142592166,-0.022757946046083687,0.0072392546893750897,0.025919171786986498,1.2070870006099483,0.13714508407308562,-9.5950798702993705],"FOG":[-0.0032243438857303477],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-105,105,0,105,105],"omega_rad_s":[-98.476478323104089,96.905615713884714,-1.7851337496418986,103.17054896365889,103.17064040271435],"thrust_n":[-122.96097836142408,118.91801131153512,-0.05232124153236023,133.52123686616582,133.25974905009451],"torque_nm":[2.3055183442767015,-2.2297127120912834,0.0009810232787317544,-2.5035231912406091,-2.4986202946892728],"angle_rad":[-21.78239036754028,-42.935569893701022,-135.07849854825932,321.50166643787117,321.5016793149826]},"command":[-1,1,0,1,1],"arm":{"servo_position":[5.4944645008222311e-22,-1.0842021724855039e-21,1.0778494253810949e-21,0,-2.5156878533452718e-21,-3.3881317890171667e-23],"servo_velocity":[0,0,0,0,-8.6736173798840355e-19,0],"servo_effort":[2.6251168983092508,-3.210601573457053,-0.3797270823582316,0.00025289707458393996,0.00010396074938328705,-0.00043270765220876752]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":132,"step":1056,"t":5.2800000000000002,"sim_time":5.2799999999999097,"vehicle":{"origin_ned":[0.016602124177906172,0.0014516638242438812,1.9565674110501259],"origin_quat_xyzw":[0.0019744230018087215,0.053950503731794081,-0.0054024988419267847,0.99852704410404347],"cg_ned":[-0.065851088398076699,0.0035929987075811911,1.6634926527510969],"linear_velocity_ned":[0.030588003596120617,0.02210815725560155,0.0577812459634418],"angular_velocity_ned":[0.019125597809287704,-0.008000830099842109,0.017249684201029583]},"sensors":{"Odom":[0.016602124177906172,0.0014516638242438812,1.9565674110501259,0.021630862129492542,0.018431403703740565,0.061024790194304311,0.0019744230018087909,0.053950503731795975,-0.0054024988419269747,0.99852704410404347,0.01723887761692203,-0.0077319179004402662,0.019245568917910849],"Pressure":[11732.738672421809],"DVL":[-0.012563307393940577,-0.046397465456421198,-0.03864164905613942,8.6953950486179021,0.020128953022356667,0.017901218018830437,0.015835266458522086,0],"IMU":[0.003379782792717194,0.10797308046126124,-0.010638190434771672,0.028879799818067629,-0.0081995478826335129,0.035798551757510955,1.2125326881834071,0.14291456079134784,-9.5743249295971484],"FOG":[-0.0066415305525586686],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-105,105,0,105,105],"omega_rad_s":[-101.43369679070675,100.39373624683724,-0.82777725875688957,104.41458782380899,104.41484818370694],"thrust_n":[-130.23595502324099,127.36042787296087,-0.015763468909978626,136.53832965953063,136.15233382121411],"torque_nm":[2.441924156685769,-2.3880080226180169,0.00029556504206209927,-2.5600936811161996,-2.5528562591477644],"angle_rad":[-25.791976038099872,-38.976157632681492,-135.12711506678909,325.65812220479268,325.65814245736829]},"command":[-1,1,0,1,1],"arm":{"servo_position":[5.4944645008222311e-22,7.5894152073985318e-21,1.0778494253810949e-21,0,-2.5156878533452718e-21,-3.3881317890171667e-23],"servo_velocity":[0,1.7347234759768071e-18,0,0,0,0],"servo_effort":[2.823415217294226,-3.2705247011827949,-0.37734756213489445,0.00031231065020966497,0.00018253202069842435,-0.00047863438276320543]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":133,"step":1064,"t":5.3200000000000003,"sim_time":5.3199999999999088,"vehicle":{"origin_ned":[0.017860240341638453,0.0022657845652656865,1.9590424706394509],"origin_quat_xyzw":[0.002377620265678239,0.053768260661461335,-0.0049837274671169348,0.99853817329526606],"cg_ned":[-0.064485958176014657,0.0045904928725184089,1.6659390232830704],"linear_velocity_ned":[0.036898471503120825,0.027152975484844015,0.063794676839853917],"angular_velocity_ned":[0.022821215990908781,-0.010258958587146944,0.021805932695521845]},"sensors":{"Odom":[0.017860240341638453,0.0022657845652656865,1.9590424706394509,0.026591654259308997,0.022876839079469927,0.067738502378635629,0.0023776202656782758,0.053768260661462175,-0.0049837274671170129,0.99853817329526606,0.020445589066768452,-0.0099335067486781507,0.024183799591977681],"Pressure":[11758.124606962374],"DVL":[0.013187732690494664,-0.032081092666613235,-0.04221232153484894,8.7018797149718825,-0.035373576688237859,-0.035923568789980133,-0.0047959961239325537,0],"IMU":[0.0042368770179764433,0.10761058930347728,-0.0097537770728757228,0.095370902507706273,0.0098149371446614817,0.14389210646349426,1.2167599462339236,0.12657441847514303,-9.5914483785012354],"FOG":[-0.014932033867220196],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-105,105,0,105,105],"omega_rad_s":[-103.39175505103201,102.70338578609494,-0.18642269168312578,105.24315595508664,105.24360395278087],"thrust_n":[-135.07660951730577,132.99489578813481,-0.0023986355285212234,138.47571478040174,137.97072579715265],"torque_nm":[2.5326864284494834,-2.4936542960275281,4.4974416159772936e-05,-2.5964196521325333,-2.586951108696613],"angle_rad":[-29.896021601489682,-34.905325591912657,-135.1449495446015,329.85445957965578,329.85449442877467]},"command":[-1,1,0,1,1],"arm":{"servo_position":[5.4944645008222311e-22,-1.0842021724855039e-21,1.0778494253810949e-21,0,-1.5754812818929987e-21,-3.3881317890171667e-23],"servo_velocity":[0,0,-3.4694469519536142e-18,0,4.0657581468206416e-20,0],"servo_effort":[2.9622192616765322,-3.3012212977104216,-0.37279921539715405,0.00036946627060990204,0.00028154008888184052,-0.00051435784848526632]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":134,"step":1072,"t":5.3600000000000003,"sim_time":5.3599999999999079,"vehicle":{"origin_ned":[0.019346912049539561,0.0032554894901093167,1.9617648423369483],"origin_quat_xyzw":[0.0028480580553358953,0.053543622935592637,-0.004469995375771074,0.99855144491888093],"cg_ned":[-0.062867645931385829,0.0057909267301414578,1.6686261899125026],"linear_velocity_ned":[0.043228957742031379,0.032238802639476295,0.069812345521479816],"angular_velocity_ned":[0.026338878575419399,-0.012317915194053449,0.026347605825969556]},"sensors":{"Odom":[0.019346912049539561,0.0032554894901093167,1.9617648423369483,0.031657565267765753,0.027417482065644431,0.074429444822979487,0.0028480580553359998,0.053543622935594594,-0.004469995375771238,0.99855144491888093,0.023474932508590611,-0.011936812197997139,0.029087866033212336],"Pressure":[11788.621143026618],"DVL":[0.013184071888184287,-0.029956938942935614,-0.069191856359206619,8.6191013098627565,0.015519922519051786,0.010608379706557204,-0.037308837980356467,0],"IMU":[0.005239263907166049,0.10716257387420289,-0.0086719037014514628,-0.049568198530933964,0.005198029909417529,0.16226835823704028,1.1977142607813089,0.11301874977580686,-9.5919599449327393],"FOG":[-0.0094588519063622898],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-105,105,0,105,105],"omega_rad_s":[-104.6882483279302,104.23271681136126,0.24076235027996801,105.79080037271812,105.79144227980228],"thrust_n":[-138.24041428877678,136.68019999036494,-0.0022738796099900549,139.67117909276456,139.05712275328568],"torque_nm":[2.5920077679145646,-2.5627537498193429,4.2635242687313538e-05,-2.6188346079893354,-2.607321051624107],"angle_rad":[-34.062611745582203,-30.760717413196286,-135.142221410584,334.077258908766,334.07731603917699]},"command":[-1,1,0,1,1],"arm":{"servo_position":[5.4944645008222311e-22,-1.0842021724855039e-21,1.0778494253810949e-21,0,-1.5754812818929987e-21,-5.759824041329239e-22],"servo_velocity":[0,0,-3.4694469519536142e-18,0,0,0],"servo_effort":[3.060133762740624,-3.3116080878641347,-0.36657671496629429,0.00042393437504045469,0.0003488586251453224,-0.00058402858314116784]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":135,"step":1080,"t":5.4000000000000004,"sim_time":5.3999999999999071,"vehicle":{"origin_ned":[0.02106378866521031,0.0044233185396466736,1.9647328769644381],"origin_quat_xyzw":[0.0033814541064330485,0.053281052415036279,-0.0038627658874867731,0.99856635946809802],"cg_ned":[-0.060997224779372798,0.0071945878365818677,1.6715533386774886],"linear_velocity_ned":[0.049500800945915843,0.037308785426169846,0.075792897170405132],"angular_velocity_ned":[0.029613131329855033,-0.014135194815933512,0.03079623014625894]},"sensors":{"Odom":[0.02106378866521031,0.0044233185396466736,1.9647328769644381,0.036771744982940599,0.032006766417769845,0.081043621399527824,0.0033814541064330263,0.053281052415035932,-0.0038627658874867479,0.99856635946809802,0.026270253043947377,-0.013700032889067251,0.033872289186153828],"Pressure":[11819.765433290073],"DVL":[0.056970303383381479,-0.021262279174062378,-0.085604172969109854,8.6106176949353124,-0.017119817089674506,-0.017442166055092707,0.023963120054785087,0],"IMU":[0.0063778598730140357,0.10663744715101975,-0.0073962016072361674,0.030689606749146024,-0.059052167087993275,-0.032345851143528212,1.2046704228133724,0.093778575927313576,-9.5683388235337716],"FOG":[0.0030562382579007973],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-105,105,0,105,105],"omega_rad_s":[-105.54654141367264,105.24539865892709,0.52284185173940001,106.14858594334295,106.14941747393368],"thrust_n":[-140.26699954912576,139.03858932043951,-0.0041154847825654508,140.36022802838554,139.64974757634292],"torque_nm":[2.6300062415461078,-2.6069735497582402,7.7165339673102238e-05,-2.631754275532229,-2.6184327670564302],"angle_rad":[-38.270613823628906,-26.567257602554239,-135.12585573887475,338.31744855287388,338.31753565554288]},"command":[-1,1,0,1,1],"arm":{"servo_position":[4.8862551400242407e-21,7.5894152073985318e-21,1.0778494253810949e-21,0,-5.9122899718350167e-21,-5.759824041329239e-22],"servo_velocity":[8.6736173798840355e-19,1.7347234759768071e-18,0,0,0,0],"servo_effort":[3.1306765615197816,-3.3080801999020553,-0.35902960335250578,0.00047550642114235005,0.00037730895306625707,-0.00066764029159306149]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":136,"step":1088,"t":5.4400000000000004,"sim_time":5.4399999999999062,"vehicle":{"origin_ned":[0.023010385490565527,0.0057704019775173315,1.9679434914271257],"origin_quat_xyzw":[0.0039725229044285711,0.052985640252691146,-0.0031648090633468241,0.99858235763124648],"cg_ned":[-0.058878277244174618,0.0087999374091127999,1.6747183213584536],"linear_velocity_ned":[0.055662162446117547,0.04232490436153994,0.081708471112368425],"angular_velocity_ned":[0.032598535631929715,-0.015686355207236709,0.035100686281798313]},"sensors":{"Odom":[0.023010385490565527,0.0057704019775173315,1.9679434914271257,0.041896222867067449,0.036613527561002439,0.087544922769317871,0.0039725229044286466,0.052985640252692152,-0.0031648090633468844,0.99858235763124648,0.028792113505421005,-0.015199069816736152,0.038480994257996413],"Pressure":[11853.045460382025],"DVL":[-0.0099059017639651775,-0.03624757344932486,-0.091247317283020241,8.7310832477358478,-0.01381781680953721,0.033907289209020378,0.012133044058458909,0],"IMU":[0.0076414031333292311,0.10604483863298428,-0.0059330350102318446,0.08183238734214858,-0.0044344996785845268,-0.038435496612078325,1.1920458922961634,0.089766190174872432,-9.5913049891224169],"FOG":[-0.010454660366731259],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-105,105,0,105,105],"omega_rad_s":[-106.11176039921791,105.91449600308333,0.70665663155996428,106.37814276888967,106.37915131844748],"thrust_n":[-141.52296605755095,140.50116289864485,-0.0053240006508329619,140.70536355980445,139.91262832483795],"torque_nm":[2.6535556135790803,-2.6343968043495911,9.9825012203118047e-05,-2.6382255667463337,-2.6233617810907117],"angle_rad":[-42.505976101758947,-22.341470687551112,-135.10054330750444,342.56889959279056,342.56902399266068]},"command":[-1,1,0,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,1.0778494253810949e-21,0,1.1434944787933055e-20,3.7608262858090938e-21],"servo_velocity":[0,0,0,0,1.7347234759768071e-18,8.6736173798840355e-19],"servo_effort":[3.1832888489555735,-3.2950843337745548,-0.35040961443470153,0.00052397969504158119,0.00061108551616553244,-0.00075498905580348051]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":137,"step":1096,"t":5.4800000000000004,"sim_time":5.4799999999999054,"vehicle":{"origin_ned":[0.025184771253249957,0.0072969514447490912,1.971392664600587],"origin_quat_xyzw":[0.0046152841347402275,0.052662817539171819,-0.0023797351000381271,0.99859885022067052],"cg_ned":[-0.0565160338203088,0.010604216150328416,1.6781180970334066],"linear_velocity_ned":[0.061679081966061797,0.047261777786578599,0.087540551272434375],"angular_velocity_ned":[0.035263828846831859,-0.016959302441881131,0.039228768467624721]},"sensors":{"Odom":[0.025184771253249957,0.0072969514447490912,1.971392664600587,0.047005233088247028,0.041216759437778104,0.093909768837661917,0.0046152841347402319,0.052662817539171861,-0.0023797351000381288,0.99859885022067052,0.031013322732771929,-0.016421879977324163,0.042878287172223271],"Pressure":[11890.813345831073],"DVL":[0.030876396407824157,-0.061746933047333689,-0.086638261721201273,8.5828893738146164,-0.0081410560389731847,-0.010238360155795745,-0.026452037251355295,0],"IMU":[0.0090171446618080766,0.10539503940929501,-0.0042905145400568209,-0.040498206326986703,-0.025351421609452727,0.0050712312690879002,1.1695229837097092,0.082242844783343302,-9.5869243794740076],"FOG":[0.024086679596552869],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-105,105,0,105,105],"omega_rad_s":[-106.47902488555791,106.35197205555167,0.82397501533011785,106.52117719265698,106.52234400668951],"thrust_n":[-142.25561929487844,141.356220884435,-0.0066059473251950176,140.81795898054798,139.95787336500686],"torque_nm":[2.6672928617789711,-2.6504291415831562,0.00012386151234740662,-2.640336730885275,-2.624210125593879],"angle_rad":[-46.759238993056705,-18.094428534843146,-135.06945954497732,346.82747457862007,346.82764295134143]},"command":[-1,1,0,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,1.0778494253810949e-21,0,-5.9122899718350167e-21,3.7608262858090931e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[3.2243257211350054,-3.2756667347557542,-0.34090085811537535,0.00056936149551375167,0.000431943365313162,-0.00084769550946445021]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":138,"step":1104,"t":5.5200000000000005,"sim_time":5.5199999999999045,"vehicle":{"origin_ned":[0.027584025064248632,0.0090025864389077365,1.9750757799309],"origin_quat_xyzw":[0.0053032858529501736,0.052318156528863853,-0.0015116770807761448,0.99861524146639502],"cg_ned":[-0.053916795230742165,0.012603855578956234,1.6817490360376068],"linear_velocity_ned":[0.067529760690453147,0.052102724328695657,0.093277009659544885],"angular_velocity_ned":[0.037588137481713295,-0.017950558989140507,0.0431610256301296]},"sensors":{"Odom":[0.027584025064248632,0.0090025864389077365,1.9750757799309,0.052081039690064619,0.045802235815883358,0.10012334452648014,0.005303285852950387,0.052318156528865956,-0.0015116770807762055,0.99861524146639502,0.032915779908391354,-0.01736479454977554,0.04704232269008328],"Pressure":[11930.404061120485],"DVL":[-0.026448851130606407,-0.075352313615403135,-0.11550800288432089,8.6447242379342697,0.0014350079112500438,-0.0139360287599788,-0.0042852826538579735,0],"IMU":[0.010491348793569685,0.10469862687424614,-0.0024778220858394507,0.090647706973101566,-0.022184251994193983,0.10030003086409792,1.1628636655748583,0.061641517053405107,-9.6085791692546891],"FOG":[0.018671442217376211],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-105,105,0,105,105],"omega_rad_s":[-106.71262850897823,106.63300040707173,0.89634222329147173,106.60591042205851,106.60721249141763],"thrust_n":[-142.63536941942593,141.8016460600457,-0.0081023232300314295,140.77401239792107,139.86169088581866],"torque_nm":[2.6744131766142365,-2.6587808636258572,0.00015191856056308929,-2.6395127324610206,-2.6224067041091002],"angle_rad":[-51.02401309073722,-13.833608527574027,-135.0347521557058,351.09038367079563,351.09060184042409]},"command":[-1,1,0,1,1],"arm":{"servo_position":[4.8862551400242407e-21,-1.0842021724855039e-21,1.0778494253810949e-21,0,-5.9122899718350167e-21,3.7608262858090931e-21],"servo_velocity":[0,0,-3.4694469519536142e-18,0,0,-1.7347234759768071e-18],"servo_effort":[3.2581287754455999,-3.2519387878840762,-0.33063578152617967,0.000611906450592545,0.00045978623495738651,-0.00094543795036354007]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":139,"step":1112,"t":5.5600000000000005,"sim_time":5.5599999999999037,"vehicle":{"origin_ned":[0.030204547922393916,0.010886553428310821,1.9789878595253714],"origin_quat_xyzw":[0.0060297712831303306,0.05195723099652895,-0.00056507359407473854,0.99863094719584955],"cg_ned":[-0.051087535012697964,0.014794762746904222,1.6856071262056571],"linear_velocity_ned":[0.073200802484730335,0.056837089086695616,0.098910031848210039],"angular_velocity_ned":[0.039558388018419842,-0.018662753464051642,0.046886770127639261]},"sensors":{"Odom":[0.030204547922393916,0.010886553428310821,1.9789878595253714,0.05711125535947334,0.050360235775247328,0.10617696196741384,0.0060297712831304364,0.051957230996529859,-0.00056507359407474852,0.99863094719584955,0.034488289138595717,-0.018030046619177079,0.050960857269877667],"Pressure":[11974.097844095704],"DVL":[0.014921697209580842,-0.071012521744178825,-0.10587344463802817,8.6448736118537113,0.012573045544218188,-0.0012583747126331266,0.0052007762653019565,0],"IMU":[0.012049666728373556,0.10396620557190803,-0.00050474497030894051,-0.024820347887326372,-0.033866852583080129,0.26450902985457614,1.1510724670955175,0.009906572336321048,-9.6220824457813254],"FOG":[-0.00062148791797738388],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-105,105,0,105,105],"omega_rad_s":[-106.85607888995712,106.80845293889027,0.93836934412737594,106.65143681436268,106.65284843858046],"thrust_n":[-142.77894915104017,141.97320146281436,-0.0097684835482769287,140.62523919186529,139.67565454028002],"torque_nm":[2.6771052965820044,-2.6619975274277694,0.00018315906653019242,-2.6367232348474738,-2.6189185226302505],"angle_rad":[-55.295986495507883,-9.5640589355561847,-134.99787186303178,355.35574886292318,355.35602166800885]},"command":[-1,1,0,1,1],"arm":{"servo_position":[-3.7873622398597949e-21,-1.0842021724855039e-21,1.8425084185149166e-20,0,-5.9122899718350167e-21,-4.9127910940749426e-21],"servo_velocity":[-8.6736173798840355e-19,0,0,0,0,0],"servo_effort":[3.2876316027915471,-3.2253598433766739,-0.31971310009006293,0.00065142127539539628,0.00048862691110545143,-0.00104896875264032]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":140,"step":1120,"t":5.6000000000000005,"sim_time":5.5999999999999028,"vehicle":{"origin_ned":[0.033042275243405576,0.012947870583932646,1.9831237232712433],"origin_quat_xyzw":[0.0067878069092503117,0.051585517239437301,0.00045548117662553347,0.9986454088541139],"cg_ned":[-0.048035625222223009,0.017172517521788076,1.689688112028243],"linear_velocity_ned":[0.078684603202526696,0.061458397793397193,0.1044347125228242],"angular_velocity_ned":[0.041167544065130943,-0.01910286892910263,0.050401300786338116]},"sensors":{"Odom":[0.033042275243405576,0.012947870583932646,1.9831237232712433,0.062087002831160198,0.054883964970480356,0.11206623875871605,0.0067878069092501513,0.051585517239436079,0.00045548117662552268,0.9986454088541139,0.035725072780376545,-0.018424051915964659,0.054628297543183033],"Pressure":[12018.054647615549],"DVL":[0.028442220711941579,-0.08230759237645191,-0.096016917184791259,8.613997975891273,0.0011784912739162868,0.018425555488421477,-0.0043760419105014275,0],"IMU":[0.013677421933324042,0.10320822685107593,0.0016186473514308969,-0.04076921196435055,-0.028694330015561577,0.025377215862705801,1.1491528819104897,-0.0023498147824728803,-9.6189149271561512],"FOG":[-0.0015167269987566086],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-105,105,0,105,105],"omega_rad_s":[-106.93881511562185,106.91275316688183,0.95996411183043928,106.67067379022447,106.67216781916004],"thrust_n":[-142.76593583721115,141.96348841510562,-0.011520109261163447,140.40677097602972,139.43451751256276],"torque_nm":[2.6768612969477092,-2.661815407783231,0.00021600204864681465,-2.6326269558005579,-2.6143972033605518],"angle_rad":[-59.57225309701343,-5.2891842550667594,-134.95979674766963,359.62230904927651,359.62264026414908]},"command":[-1,1,0,1,1],"arm":{"servo_position":[4.8862551400242407e-21,-1.0842021724855039e-21,1.0778494253810949e-21,0,-5.9122899718350167e-21,-4.9127910940749426e-21],"servo_velocity":[8.6736173798840355e-19,0,0,0,0,0],"servo_effort":[3.314787503764923,-3.1969479896151078,-0.30820934356057089,0.00068796359179187135,0.00051877509157231361,-0.0011572696651988988]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":141,"step":1128,"t":5.6399999999999997,"sim_time":5.639999999999902,"vehicle":{"origin_ned":[0.03609282105816488,0.01518542126406178,1.9874780965755179],"origin_quat_xyzw":[0.0075703835611501628,0.051208323620535047,0.001545340789922743,0.99865810406092159],"cg_ned":[-0.044768647586851916,0.019732509704288421,1.693987588370389],"linear_velocity_ned":[0.083977544546319741,0.065963087653933786,0.10984810279593715],"angular_velocity_ned":[0.042413359584997187,-0.019280999532507479,0.053704013376026288]},"sensors":{"Odom":[0.03609282105816488,0.01518542126406178,1.9874780965755179,0.067001672041614918,0.059368484263830137,0.1177898318075238,0.0075703835611503345,0.051208323620536206,0.0015453407899227781,0.99865810406092159,0.03662470811482655,-0.018556194725110362,0.058043685787334209],"Pressure":[12065.153841065106],"DVL":[0.0058344531842960644,-0.060172623739809583,-0.10980996044702412,8.6844430551618572,-0.019643745535732001,-0.023010306182113718,0.032125700671257015,0],"IMU":[0.015359833365470119,0.10243486296693234,0.0038822273203864594,0.056823854015448844,0.036275284305870542,-0.03560050482367938,1.1292256735638222,-0.035218561644484128,-9.5962479715099374],"FOG":[0.0055058662196594077],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-105,105,0,105,105],"omega_rad_s":[-106.98075473127572,106.96919224758193,0.96784400169601303,106.67235839952652,106.67390719260425],"thrust_n":[-142.65039305263542,141.83540515816321,-0.013282433242023576,140.14245138882691,139.16158523578602],"torque_nm":[2.6746948697369146,-2.6594138467155606,0.00024904562328794208,-2.6276709635405044,-2.6092797231709883],"angle_rad":[-63.85085794788435,-1.0112767433669876,-134.9211844148833,363.88922042086074,363.88961272007475]},"command":[-1,1,0,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,1.0778494253810949e-21,0,-5.9122899718350167e-21,-4.9127910940749426e-21],"servo_velocity":[8.6736173798840355e-19,0,0,0,0,0],"servo_effort":[3.3408706914875985,-3.1674174085575739,-0.2961895357391669,0.00072161699013169127,0.00055035359833193636,-0.0012708866222391681]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":142,"step":1136,"t":5.6799999999999997,"sim_time":5.6799999999999011,"vehicle":{"origin_ned":[0.039351575744663629,0.017598012396293758,1.9920456827845028],"origin_quat_xyzw":[0.0083704984893773898,0.05083074029810656,0.0026998778807608807,0.9986685542537197],"cg_ned":[-0.041294263394110235,0.022470034869629181,1.6985010634200195],"linear_velocity_ned":[0.089078757795474278,0.070349638899635455,0.11514856760842362],"angular_velocity_ned":[0.043297502465274938,-0.019209475575420208,0.056797085216475071]},"sensors":{"Odom":[0.039351575744663629,0.017598012396293758,1.9920456827845028,0.071850095093195579,0.063809985340602157,0.12334855704203077,0.0083704984893775009,0.050830740298107233,0.0026998778807609163,0.9986685542537197,0.037189374604960766,-0.018437980880848266,0.06120929535805867],"Pressure":[12114.637805929111],"DVL":[0.019609018971738792,-0.074328152062432484,-0.0912973007129083,8.664903949617683,0.020631285041244066,0.025211744162394262,-0.01452226751303386,0],"IMU":[0.017082194381862249,0.10165591888101946,0.0062759642949925566,0.064586881213270442,0.0034808788552932977,0.081898191181371358,1.0859315154658971,-0.042089932641131415,-9.6106309477858662],"FOG":[0.015823852396844314],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-105,105,0,105,105],"omega_rad_s":[-106.9953713380412,106.99352714628502,0.96656255855814577,106.66239860115869,106.66397475215661],"thrust_n":[-142.46895531792481,141.63153603224799,-0.015001800991723793,139.8484578012694,138.8723881547923],"torque_nm":[2.6712929122110909,-2.6555913006046503,0.00028128376859482115,-2.622158583773802,-2.6038572779023554],"angle_rad":[-68.130489579714364,3.2681238422790835,-134.88247520858113,368.15592138086367,368.15637633657855]},"command":[-1,1,0,1,1],"arm":{"servo_position":[5.4944645008222292e-22,7.5894152073985318e-21,1.8425084185149166e-20,0,-5.9122899718350167e-21,-4.9127910940749426e-21],"servo_velocity":[-8.6736173798840355e-19,1.7347234759768071e-18,0,0,0,0],"servo_effort":[3.3666876600781355,-3.1372790717248509,-0.28371168048845535,0.00075246682302180026,0.00058341459597199504,-0.0013897741671678957]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":143,"step":1144,"t":5.7199999999999998,"sim_time":5.7199999999999003,"vehicle":{"origin_ned":[0.042813772352216735,0.020184409074565285,1.9968212112568282],"origin_quat_xyzw":[0.0091812236710684045,0.05045760342464916,0.0039145335372051887,0.99867632985653998],"cg_ned":[-0.037620123740281904,0.025380361947336207,1.7032240008403425],"linear_velocity_ned":[0.093989271209294678,0.07461797795733778,0.12033534835328535],"angular_velocity_ned":[0.043824914096869894,-0.018902197663439639,0.059684591065698248]},"sensors":{"Odom":[0.042813772352216735,0.020184409074565285,1.9968212112568282,0.076628012583042013,0.068205310024021221,0.12874476482361299,0.009181223671068571,0.050457603424650076,0.0039145335372052599,0.99867632985653998,0.037424293004552668,-0.018082398758862445,0.064129679018534613],"Pressure":[12164.553354598798],"DVL":[0.02596258009174102,-0.092925625279622878,-0.11103737356313551,8.6035337358454491,0.023827403914153274,-0.031195573109033915,-0.026224775933754631,0],"IMU":[0.018830019222607325,0.10088077035985568,0.0087900315224165686,0.0042514540678983068,0.029471495047971696,0.014926112457458465,1.0794916632016605,-0.062211838790422039,-9.5788351771512357],"FOG":[0.012936891806383185],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-105,105,0,105,105],"omega_rad_s":[-106.99177754708478,106.99641594812921,0.95920556144391256,106.64478779417792,106.64636466847132],"thrust_n":[-142.24639104429139,141.3806299282665,-0.01664417449920683,139.53576821087756,138.57718430246277],"torque_nm":[2.6671198320804645,-2.6508868111549972,0.00031207827186012813,-2.6162956539539541,-2.598322205671177],"angle_rad":[-72.410271773033372,7.5479867828389038,-134.84396222043154,372.42204112647931,372.4225592304673]},"command":[-1,1,0,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,1.8425084185149166e-20,0,-5.9122899718350167e-21,-4.9127910940749426e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[3.3927255435630013,-3.1068964963054571,-0.27082817508242046,0.0007806280435070002,0.00061794971010463743,-0.0015137876532791586]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":144,"step":1152,"t":5.7599999999999998,"sim_time":5.7599999999998994,"vehicle":{"origin_ned":[0.046474531975269628,0.022943353284196857,2.0017994686179743],"origin_quat_xyzw":[0.009995763737517047,0.050093469870195313,0.0051848519009372075,0.99868105333706658],"cg_ned":[-0.033753807392593538,0.028458781423129596,1.7081518479125848],"linear_velocity_ned":[0.098711430128482144,0.078769072691313807,0.12540827110907446],"angular_velocity_ned":[0.044003323097309442,-0.018374195495674261,0.062371911053872443]},"sensors":{"Odom":[0.046474531975269628,0.022943353284196857,2.0017994686179743,0.081331722883517824,0.072551645044184473,0.1339819017244154,0.0099957637375172256,0.050093469870196208,0.0051848519009373003,0.99868105333706658,0.037337288904680702,-0.01750350402398837,0.066811024512143727],"Pressure":[12218.246763734971],"DVL":[0.048585171095199227,-0.066622030286426437,-0.098744209121106763,8.6018105916350542,-0.0010231054858817141,0.00068199420565593694,-0.013754399369379855,0],"IMU":[0.020589164932744843,0.10011832056356705,0.011414880114527915,0.05262285844078983,0.02234486691809557,0.10673613248282758,1.0724014929290575,-0.10366780132570984,-9.638401076286053],"FOG":[0.0078510717189150744],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-105,105,0,105,105],"omega_rad_s":[-106.97613470509093,106.98506606779816,0.94786324000921507,106.62222375467043,106.62377587935363],"thrust_n":[-141.9994071536758,141.1020379620501,-0.018190295520313985,139.21183811032867,138.28265913352837],"torque_nm":[2.6624888841314216,-2.64566321178844,0.00034106804100588736,-2.6102219645686628,-2.5927998587536569],"angle_rad":[-76.689622637766405,11.827625632942029,-134.80583877573676,376.68733778344267,376.68791848715125]},"command":[-1,1,0,1,1],"arm":{"servo_position":[-3.7873622398597949e-21,-1.0842021724855039e-21,1.8425084185149166e-20,0,-5.9122899718350167e-21,-4.9127910940749426e-21],"servo_velocity":[-8.6736173798840355e-19,0,0,0,0,0],"servo_effort":[3.419248775612945,-3.0765472290258637,-0.25759071190308569,0.00080628583394264054,0.00065390441030305647,-0.0016427097248196102]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":145,"step":1160,"t":5.7999999999999998,"sim_time":5.7999999999998986,"vehicle":{"origin_ned":[0.050328894977540797,0.025873572129186319,2.0069753182263224],"origin_quat_xyzw":[0.010807505872602851,0.049742599436587431,0.0065065045581029048,0.99868240047401458],"cg_ned":[-0.029702777694753893,0.031700640235968018,1.7132800540871631],"linear_velocity_ned":[0.10324849330315973,0.082804644445449271,0.13036754440561715],"angular_velocity_ned":[0.043842870381010049,-0.017641248650956513,0.064865314502724675]},"sensors":{"Odom":[0.050328894977540797,0.025873572129186319,2.0069753182263224,0.085957873318875958,0.076846318371659797,0.13906418544327187,0.010807505872603314,0.049742599436589555,0.0065065045581031832,0.99868240047401458,0.036938450700254782,-0.016716066022394945,0.069260695631419206],"Pressure":[12272.094147437914],"DVL":[0.024266179633597305,-0.097534203164238054,-0.099597110673543626,8.7411359301282587,-0.030583748220488243,-0.012688699816914829,-0.0033978302290849417,0],"IMU":[0.022345934208309399,0.099376969179954741,0.014141289741442416,0.081404836905469846,-0.019535809256388273,0.029812136600723363,1.0612773780149136,-0.12972169117618679,-9.6126301575892263],"FOG":[0.011069103157276432],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-105,105,0,105,105],"omega_rad_s":[-106.95260696559602,106.96434972719324,0.93395058558317534,106.59652751599977,106.59803085751129],"thrust_n":[-141.73924125519792,140.80873968211085,-0.019630957645976815,138.88173780108312,137.99308037831591],"torque_nm":[2.6576107735349619,-2.6401638690395792,0.00036808045586206529,-2.6040325837703091,-2.5873702570934238],"angle_rad":[-80.968159248344378,16.106586717620189,-134.76823064149852,380.95165654115078,380.9522983087416]},"command":[-1,1,0,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,1.0778494253810949e-21,0,-5.9122899718350137e-21,-4.9127910940749426e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[3.4463690392126587,-3.0464355684298736,-0.24404972679357922,0.00082952107199359571,0.00069118530875817992,-0.0017763308322589412]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":146,"step":1168,"t":5.8399999999999999,"sim_time":5.8399999999998977,"vehicle":{"origin_ned":[0.054371843245651315,0.028973778948071401,2.0123437114313547],"origin_quat_xyzw":[0.011610063352923493,0.049408943175390144,0.0078753075599745717,0.99868010007913333],"cg_ned":[-0.02547435252253611,0.035101367279183671,1.7186040831654197],"linear_velocity_ned":[0.10760435860952317,0.086726974493311723,0.13521362890913494],"angular_velocity_ned":[0.043355806917960552,-0.016719617049641592,0.06717166018036505]},"sensors":{"Odom":[0.054371843245651315,0.028973778948071401,2.0123437114313547,0.090503334580610217,0.081086680627562982,0.14399637297059015,0.01161006335292398,0.049408943175392225,0.007875307559974903,0.99868010007913333,0.036239849153304776,-0.015735323519107454,0.071486897025086538],"Pressure":[12329.708044040497],"DVL":[0.03904300303832034,-0.11610369449406019,-0.15412451964000617,8.6379408354749305,-0.00024197195337980623,0.02549719067333692,0.010979279389275025,0],"IMU":[0.024087163104125616,0.098664591486286687,0.01696040224464683,-0.062398284253649433,0.003643669388899571,0.20252413616948559,1.0417881667339104,-0.14358564925823733,-9.613303560186484],"FOG":[-0.0002758899085437104],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-105,105,0,105,105],"omega_rad_s":[-106.9240069749536,106.93755887916471,0.91842462284007964,106.56892685463883,106.5703590099702],"thrust_n":[-141.47342289559285,140.50940005846323,-0.020963345734054215,138.54892300684764,137.71108109882289],"torque_nm":[2.6526266792923656,-2.6345512510961857,0.00039306273251351654,-2.597792306378393,-2.5820827706029297],"angle_rad":[-85.245633108973365,20.384573675016597,-134.73121787132473,385.21490132362203,385.21560169409196]},"command":[-1,1,0,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,1.8425084185149166e-20,0,-5.9122899718350137e-21,-4.9127910940749426e-21],"servo_velocity":[-8.6736173798840355e-19,0,0,0,0,0],"servo_effort":[3.4740955086143854,-3.0167226374548219,-0.23025547816089173,0.00085044760270643776,0.00072967727825450318,-0.0019143413261439978]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":147,"step":1176,"t":5.8799999999999999,"sim_time":5.8799999999998969,"vehicle":{"origin_ned":[0.058598316592154476,0.032242670100113439,2.0178996932079207],"origin_quat_xyzw":[0.012397313696775492,0.049096136369211098,0.0092872334915444499,0.99867393242278679],"cg_ned":[-0.021075683316702246,0.038656492452512292,1.7241194213165421],"linear_velocity_ned":[0.11178336821998629,0.090538760401626367,0.13994714890013235],"angular_velocity_ned":[0.042556235285826013,-0.015625806931667003,0.069298207207899504]},"sensors":{"Odom":[0.058598316592154476,0.032242670100113439,2.0178996932079207,0.09496513462819467,0.085270033858458494,0.14878358371111128,0.012397313696775925,0.049096136369212812,0.0092872334915447743,0.99867393242278679,0.035255291000453978,-0.01457677466298803,0.073498453202057751],"Pressure":[12385.757995467689],"DVL":[0.037158627842590476,-0.10529828384338559,-0.15745678211599101,8.7226647684428862,0.0029151708008452073,0.0053084884074769845,-0.014127094560282411,0],"IMU":[0.025800296062146681,0.097988524624872494,0.019863743446449474,0.015655795813244881,-0.016980166556506034,0.01901394857967096,1.0394531648719767,-0.15371954807028129,-9.6024690421348335],"FOG":[0.024227266079860782],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-105,105,0,105,105],"omega_rad_s":[-106.89223284891337,106.90691611409828,0.901931788123575,106.54024814397835,106.54158846623835],"thrust_n":[-141.20696845537788,140.20976477817086,-0.022188477978098638,138.21575644896797,137.43819137092888],"torque_nm":[2.6476306585383358,-2.6289330895907037,0.00041603396208934949,-2.5915454334181502,-2.5769660882049172],"angle_rad":[-89.521886483701934,24.661396393866511,-134.69484962085804,389.47701562108244,389.47777127649886]},"command":[-1,1,0,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,1.0778494253810949e-21,0,-5.9122899718350137e-21,-4.9127910940749426e-21],"servo_velocity":[8.6736173798840355e-19,0,0,0,0,0],"servo_effort":[3.5023713646863177,-2.9875413443953596,-0.2162595506172667,0.00086918109059161246,0.00076924385501351156,-0.0020563869434484898]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":148,"step":1184,"t":5.9199999999999999,"sim_time":5.919999999999896,"vehicle":{"origin_ned":[0.06300322531365353,0.035678918872569097,2.0236384035146791],"origin_quat_xyzw":[0.013163432126523829,0.048807495198990913,0.010738419850592981,0.9986637265897681],"cg_ned":[-0.016513740595263393,0.042361660881641491,1.729821581969184],"linear_velocity_ned":[0.11579016872485681,0.094243012582573421,0.14456882335487065],"angular_velocity_ned":[0.04145988784669917,-0.014376389999434169,0.071252454871127552]},"sensors":{"Odom":[0.06300322531365353,0.035678918872569097,2.0236384035146791,0.099340424617723966,0.089393592759794915,0.15343115399867202,0.013163432126524282,0.048807495198992593,0.01073841985059335,0.9986637265897681,0.034000107375050395,-0.0132560198765333,0.075304620378545004],"Pressure":[12448.116942001949],"DVL":[-0.013929310943902554,-0.11187478115534379,-0.17806926909642787,8.6805590300174096,0.012220402302860532,-0.022666171983897102,-0.029309076528631649,0],"IMU":[0.027473450053462321,0.097355559328749924,0.022843236080947495,0.057345443043957056,0.00027561951266713222,-0.039765982245480017,1.0502585763572319,-0.18296041369227772,-9.6504681343315326],"FOG":[0.0021076719422709056],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-105,105,0,105,105],"omega_rad_s":[-106.85856390015299,106.87392042199653,0.88490789778174661,106.51104619372771,106.51227586776001],"thrust_n":[-140.94319102025264,139.91360574007197,-0.023309532467823659,137.88386156164245,137.17519949667025],"torque_nm":[2.6426848316297376,-2.6233801076263497,0.00043705373377169381,-2.5853224042807961,-2.5720349905625679],"angle_rad":[-93.796822846962257,28.936936460471468,-134.65915419502286,393.73796952114321,393.73877635873242]},"command":[-1,1,0,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,1.0778494253810949e-21,0,-5.9122899718350137e-21,-4.9127910940749426e-21],"servo_velocity":[-8.6736173798840355e-19,0,0,0,0,0],"servo_effort":[3.5310923519866653,-2.9590018443812141,-0.20211085316641378,0.00088594092097626334,0.00080975347638416332,-0.0022019208037600997]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":149,"step":1192,"t":5.96,"sim_time":5.9599999999998952,"vehicle":{"origin_ned":[0.067581460526770984,0.039281160630531886,2.0295550756405452],"origin_quat_xyzw":[0.013902933418048059,0.048546016706536743,0.012225166355592003,0.99864935688753143],"cg_ned":[-0.011795304104608511,0.046212645075257644,1.7357061088374199],"linear_velocity_ned":[0.11962961375396898,0.097843074118676349,0.14907943511370636],"angular_velocity_ned":[0.040085574899784746,-0.012987802722098322,0.073040859781790965]},"sensors":{"Odom":[0.067581460526770984,0.039281160630531886,2.0295550756405452,0.1036264649940036,0.093453995562935585,0.15794453449594728,0.013902933418047983,0.048546016706536473,0.012225166355591933,0.99864935688753143,0.032492714989433125,-0.011788653124737661,0.076913943224734826],"Pressure":[12509.730148037901],"DVL":[-0.00028489660698806374,-0.11330624178984881,-0.1899744466141291,8.7079622834066157,-0.032980050480354725,-0.013828196945603496,-0.019400902464986852,0],"IMU":[0.029095493599659027,0.096771936433320729,0.025891190621982446,0.13304534727420164,-0.034222854349962015,-0.05404477874199487,1.0112904861901506,-0.19314719584575646,-9.6211738657590296],"FOG":[0.03561812534168482],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-105,105,0,105,105],"omega_rad_s":[-106.8238607741514,106.83958118856447,0.86764595735164729,106.48169211971589,106.48279419951922],"thrust_n":[-140.68424129461366,139.62337058946659,-0.024330880841988142,137.55436169016437,136.9223967894967],"torque_nm":[2.6378295242740069,-2.6179381985524994,0.00045620401578727772,-2.5791442816905827,-2.5672949398030633],"angle_rad":[-98.070386890238282,33.211123778624668,-134.62414586097302,397.99775093560891,397.99860414197542]},"command":[-1,1,0,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,1.0778494253810949e-21,0,-5.9122899718350137e-21,-4.9127910940749426e-21],"servo_velocity":[8.6736173798840355e-19,0,-3.4694469519536142e-18,0,0,0],"servo_effort":[3.5593490032044919,-2.9312165068636471,-0.1878621391642801,0.00090055286755545531,0.00085104931394891677,-0.0023506687285041734]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":150,"step":1200,"t":6,"sim_time":5.9999999999998943,"vehicle":{"origin_ned":[0.072327902622237941,0.043047949559624654,2.0356450318368071],"origin_quat_xyzw":[0.014610758052594498,0.048314379916872423,0.013743900379955752,0.99863073838367422],"cg_ned":[-0.0069269562022398114,0.050205359360296541,1.741768577576051],"linear_velocity_ned":[0.12330669271644606,0.10134258052476942,0.15347979079516291],"angular_velocity_ned":[0.038455642307232502,-0.011476348387669158,0.074668394179084024]},"sensors":{"Odom":[0.072327902622237941,0.043047949559624654,2.0356450318368071,0.10782057435214544,0.09744713720947551,0.1623291845835543,0.014610758052594836,0.04831437991687354,0.013743900379956072,0.99863073838367422,0.030755104775209312,-0.010190334279345249,0.078333854139836234],"Pressure":[12573.129173142299],"DVL":[0.01308986045051681,-0.098500588379727555,-0.13233442574847254,8.7559736170965525,0.0036793172438664245,-0.011832842528256648,-0.014116656827586156,0],"IMU":[0.03065621093439069,0.096243343549312577,0.029000235927886846,0.0074311965300551258,-0.097803594106972327,0.029233283985833615,1.0137126256137197,-0.24128862007916588,-9.673220133881804],"FOG":[0.025945523578135926],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-105,105,0,105,105],"omega_rad_s":[-106.78870090028508,106.80457654224345,0.850342156472359,106.45243280831326,106.45339222821045],"thrust_n":[-140.43147048885123,139.34062437646026,-0.025257533351536635,137.22804690648934,136.67974077072572],"torque_nm":[2.6330900716659609,-2.6126367070586296,0.00047357875034131203,-2.5730258794966758,-2.5627451394511072],"angle_rad":[-102.34255099608363,37.483920750634269,-134.58982946720403,402.25635966667403,402.25725379288212]},"command":[-1,1,0,1,1],"arm":{"servo_position":[-3.7873622398597949e-21,-1.0842021724855039e-21,1.8425084185149166e-20,0,-5.9122899718350137e-21,-4.9127910940749426e-21],"servo_velocity":[-1.7347234759768071e-18,0,0,0,0,0],"servo_effort":[3.5869710950449796,-2.9043067388765178,-0.17357696189580063,0.00091313317222741354,0.00089293798684039988,-0.0025021865092922308]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":151,"step":1208,"t":6.04,"sim_time":6.0399999999998935,"vehicle":{"origin_ned":[0.077237427327184763,0.046977769260559077,2.0419036790346028],"origin_quat_xyzw":[0.015282259584666561,0.048114946795928495,0.015291202435885073,0.99860782270362591],"cg_ned":[-0.0019150777843863942,0.054335861768517471,1.7480045961159518],"linear_velocity_ned":[0.126826471326169,0.10474511158941419,0.15777069516051032],"angular_velocity_ned":[0.036590299728646733,-0.0098581971450229979,0.076142343636036683]},"sensors":{"Odom":[0.077237427327184763,0.046977769260559077,2.0419036790346028,0.11192017158863068,0.10136979042012055,0.16659050122290739,0.015282259584667258,0.048114946795930688,0.015291202435885769,0.99860782270362591,0.028806824358203115,-0.0084765783402387246,0.079573896911035322],"Pressure":[12636.246085655865],"DVL":[0.028879692932475567,-0.11221909699343258,-0.13550543318164268,8.6393807400877609,0.00038870243603461227,-0.027249864729929137,0.030698923444352749,0],"IMU":[0.032146273171419201,0.095774910345493458,0.032163360506249176,0.067670698371186999,0.03952926148236028,0.11094328682852544,1.0058035393381224,-0.25255517162266883,-9.654260228724393],"FOG":[0.039179111101461273],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-105,105,0,105,105],"omega_rad_s":[-106.75347014592174,106.76936053235103,0.83312706699494354,106.42343115671967,106.42423472492739],"thrust_n":[-140.18571371099895,139.0663008641626,-0.026094431050096442,136.90548174447878,136.44697125574268],"torque_nm":[2.6284821320812299,-2.6074931412030482,0.00048927058218930825,-2.5669777827089768,-2.5583807110451753],"angle_rad":[-106.61330608891971,41.755311575373433,-134.5562035745954,406.51380339457228,406.51473243127407]},"command":[-1,1,0,1,1],"arm":{"servo_position":[4.8862551400242407e-21,-1.0842021724855039e-21,1.0778494253810949e-21,0,-5.9122899718350137e-21,-4.9127910940749426e-21],"servo_velocity":[1.7347234759768071e-18,-1.7347234759768071e-18,-3.4694469519536142e-18,0,0,0],"servo_effort":[3.614361887751913,-2.8783698714975299,-0.15930081368742385,0.00092607548247023049,0.00093528997818290312,-0.0026560819508952959]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":152,"step":1216,"t":6.0800000000000001,"sim_time":6.0799999999998926,"vehicle":{"origin_ned":[0.082304912378346876,0.051069037608307791,2.0483265035131852],"origin_quat_xyzw":[0.015913198625885534,0.047949767112405561,0.016863822255809621,0.99858059336354199],"cg_ned":[0.0032341538720067416,0.058600355423424906,1.7544098045448946],"linear_velocity_ned":[0.13019405365401324,0.10805432807770335,0.16195295131160628],"angular_velocity_ned":[0.034510551878916086,-0.0081491468810979788,0.077469989754758772]},"sensors":{"Odom":[0.082304912378346876,0.051069037608307791,2.0483265035131852,0.11592281024299547,0.1052186983255991,0.17073377035711307,0.015913198625885656,0.047949767112405922,0.016863822255809749,0.99858059336354199,0.026668122157499034,-0.0066626486578508642,0.08064370075792808],"Pressure":[12701.326136990107],"DVL":[0.064087641707754661,-0.07985020500372618,-0.19768995442224191,8.7130168522717746,-0.013052040093216047,0.014748504688833305,-0.0069474588582444574,0],"IMU":[0.033557221466334428,0.095371210822078376,0.035373935829087398,0.060698178624098778,-0.060525545177718729,0.013113226607438674,0.97816821519017205,-0.26190715719673502,-9.6706122810132307],"FOG":[0.053817231630577986],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-105,105,0,105,105],"omega_rad_s":[-106.71842483691177,106.73423566676679,0.81608680406203771,106.39479330658362,106.39542968070636],"thrust_n":[-139.94744636183367,138.80092084951067,-0.026846427681816686,136.58707751403594,136.22368946766235],"torque_nm":[2.6240146192843814,-2.6025172659283262,0.00050337051903406296,-2.5610077033881735,-2.5541941775186694],"angle_rad":[-110.88265544723392,46.025295009973149,-134.52326257811086,410.77009496556673,410.77105241746045]},"command":[-1,1,0,1,1],"arm":{"servo_position":[-3.7873622398597949e-21,-1.0842021724855039e-21,1.8425084185149166e-20,0,-5.9122899718350137e-21,-7.4301730133147225e-20],"servo_velocity":[-1.7347234759768071e-18,0,3.4694469519536142e-18,0,0,-1.3877787807814457e-17],"servo_effort":[3.6413721052631893,-2.8534923600252164,-0.14509269413356674,0.00093825656883320628,0.00097791322601867964,-0.0028118481076668312]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":153,"step":1224,"t":6.1200000000000001,"sim_time":6.1199999999998917,"vehicle":{"origin_ned":[0.087525244309295161,0.055320099752267954,2.0549090648883821],"origin_quat_xyzw":[0.016499755211337327,0.0478205855819454,0.018458679390484619,0.99854906080158368],"cg_ned":[0.0085147657308091672,0.062995191028483943,1.760979874810368],"linear_velocity_ned":[0.13341454409166575,0.11127393738901727,0.16602734971719693],"angular_velocity_ned":[0.03223797075907308,-0.0063645105632565129,0.078658597976541483]},"sensors":{"Odom":[0.087525244309295161,0.055320099752267954,2.0549090648883821,0.11982620298886491,0.10899061628267066,0.17476411286921648,0.016499755211337969,0.047820585581947267,0.018458679390485337,0.99854906080158368,0.024359722737963899,-0.0047634550316212661,0.08155294104628652],"Pressure":[12768.736254989602],"DVL":[0.064274924564743555,-0.1161273358098141,-0.15720816383568301,8.6331101298092996,0.018183868002449807,0.011207640720211945,0.029372375920537232,0],"IMU":[0.034881485382757885,0.095036269226404027,0.038625710757351883,0.051812519778177996,0.065048497366958266,0.098678325789330432,0.99130805836586777,-0.29269263306225973,-9.6773410896970145],"FOG":[0.041884042519450319],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-105,105,0,105,105],"omega_rad_s":[-106.68373373407753,106.6994019928766,0.79927737879764982,106.36658707362672,106.36704672147624],"thrust_n":[-139.71689851342921,138.54472800571705,-0.027518206266345348,136.27314194926112,136.00941236655322],"torque_nm":[2.6196918471267976,-2.5977136501071945,0.00051596636749397533,-2.5551214115486465,-2.5501764818728727],"angle_rad":[-115.15061052003654,50.293879475212499,-134.49099814389348,415.02525055994903,415.02622951891777]},"command":[-1,1,0,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,1.8425084185149166e-20,0,-5.9122899718350137e-21,-7.4301730133147225e-20],"servo_velocity":[8.6736173798840355e-19,0,0,0,0,0],"servo_effort":[3.6678127788522765,-2.829742456657554,-0.13100968458947554,0.00094942092060974032,0.0010206118058470801,-0.0029690184972193546]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":154,"step":1232,"t":6.1600000000000001,"sim_time":6.1599999999998909,"vehicle":{"origin_ned":[0.092893325191739526,0.059729222022659657,2.061646989946063],"origin_quat_xyzw":[0.01703853733963297,0.047728850564008655,0.020072862881705525,0.99851325742069974],"cg_ned":[0.013920988436138353,0.067516868074000327,1.7677105101965158],"linear_velocity_ned":[0.13649302149303683,0.11440766553800019,0.16999466952541689],"angular_velocity_ned":[0.029794527151507048,-0.0045190612690623813,0.079715359246452469]},"sensors":{"Odom":[0.092893325191739526,0.059729222022659657,2.061646989946063,0.12362823596481642,0.11268233837369906,0.17868645137473319,0.017038537339633335,0.047728850564009682,0.020072862881705955,0.99851325742069974,0.021902665365080409,-0.0027935098427088905,0.0823112617774166],"Pressure":[12837.309167981328],"DVL":[0.052285824467721349,-0.14606071717945995,-0.22025101594009838,8.6434647113594316,-0.037818286790757633,0.002610148266871374,-0.011909617547632697,0],"IMU":[0.036112393443134924,0.094773568442846207,0.041912804287774878,-0.0084063988442322178,0.065264833907818176,0.19185282988798463,0.9660425713587214,-0.30483081514468147,-9.6677518557870137],"FOG":[0.0274115882979373],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-105,105,0,105,105],"omega_rad_s":[-106.64950643869059,106.66499031186767,0.78273443284238531,106.33885441877925,106.33912956711154],"thrust_n":[-139.49413352783097,138.29777962532086,-0.028114241848650526,135.963913094264,135.80360907282494],"torque_nm":[2.6155150036468306,-2.5930833679747658,0.00052714203466219746,-2.5493233705174503,-2.5463176701154677],"angle_rad":[-119.41718809969048,54.561079746869311,-134.4594001820289,419.27928845554533,419.28028167194532]},"command":[-1,1,0,1,1],"arm":{"servo_position":[4.8862551400242407e-21,-1.0842021724855039e-21,1.0778494253810949e-21,0,6.3476649067237265e-20,-4.9127910940749396e-21],"servo_velocity":[8.6736173798840355e-19,0,-3.4694469519536142e-18,0,1.3877787807814457e-17,0],"servo_effort":[3.693654218086448,-2.8072373306242175,-0.11710569739737578,0.00095957191186518079,0.0010632344701894272,-0.0031270947844605082]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":155,"step":1240,"t":6.2000000000000002,"sim_time":6.19999999999989,"vehicle":{"origin_ned":[0.098404079540619846,0.064294586626182551,2.0685359666435446],"origin_quat_xyzw":[0.017526586198860748,0.04767572444721721,0.021703628990023097,0.99847323277257172],"cg_ned":[0.019447254755120286,0.072162035035916075,1.7745974448289836],"linear_velocity_ned":[0.13943451506860485,0.11745923247016371,0.17385567358339354],"angular_velocity_ned":[0.027202415773252338,-0.0026269280108089273,0.080647316974360256]},"sensors":{"Odom":[0.098404079540619846,0.064294586626182551,2.0685359666435446,0.1273269969111594,0.11629072614420206,0.1825054728288738,0.017526586198861223,0.047675724447218494,0.021703628990023684,0.99847323277257172,0.019318140996116083,-0.00076683290708906993,0.082928181612673665],"Pressure":[12903.597120596743],"DVL":[-0.0092043991208105302,-0.1431350730778424,-0.19067703177015294,8.627903056417324,-0.0055237170665366053,0.0078330140427204445,0.01008756782605465,0],"IMU":[0.037244176932294315,0.094586061365168783,0.045229694798242556,0.078074997767197465,0.08616016729840198,0.024011745570747652,0.97883072427100537,-0.30127504195522337,-9.6414291726701666],"FOG":[0.038305739005477457],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-105,105,0,105,105],"omega_rad_s":[-106.61581261363655,106.63108465468505,0.7664798403416283,106.3116198869548,106.31170446035905],"thrust_n":[-139.27910156212047,138.06000886447026,-0.028638795517508697,135.65958129871913,135.60572752169739],"torque_nm":[2.611483154289759,-2.5886251662088178,0.00053697741595328809,-2.5436171493509838,-2.5426073910318263],"angle_rad":[-123.68240841257699,58.826914720311542,-134.42845750438849,423.53222819418295,423.5332281458584]},"command":[-1,1,0,1,1],"arm":{"servo_position":[4.8862551400242407e-21,-1.0842021724855039e-21,1.8425084185149166e-20,0,-5.9122899718350197e-21,-4.9127910940749396e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[3.7189004894109567,-2.7860835135145647,-0.10343270624445736,0.00096876409625265265,0.0011056312279693688,-0.0032856053907930798]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":156,"step":1248,"t":6.2400000000000002,"sim_time":6.2399999999998892,"vehicle":{"origin_ned":[0.10405246088518658,0.069014287291016704,2.0755717381487506],"origin_quat_xyzw":[0.017961378115342062,0.047662094831213517,0.023348399487280364,0.99842904898339191],"cg_ned":[0.025088197088013731,0.076927488398415969,1.7816364428499019],"linear_velocity_ned":[0.1422439840053652,0.1204323182392331,0.17761110364904978],"angular_velocity_ned":[0.024483903321451322,-0.00070158287712326732,0.08146145422485615]},"sensors":{"Odom":[0.10405246088518658,0.069014287291016704,2.0755717381487506,0.13092077836849131,0.11981273350897735,0.18622560056056472,0.017961378115342312,0.047662094831214176,0.02334839948728069,0.99842904898339191,0.01662733484762427,0.001303060077615127,0.083413164639132897],"Pressure":[12973.64830221904],"DVL":[0.068652564290152096,-0.14321261841156085,-0.19635010779168968,8.5809861489587469,0.0022855317764696155,0.039308652433854945,-0.025815395016449173,0],"IMU":[0.038271967341045723,0.094476183577409167,0.048571210929796625,-0.0583768541120748,-0.08226490577789794,0.049667616254374256,0.96083135624358751,-0.31826156131822919,-9.6317790652127204],"FOG":[0.062142208487455351],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-105,105,0,105,105],"omega_rad_s":[-106.58269498892247,106.59773749121835,0.75052618510941882,106.28489631642732,106.28478586839829],"thrust_n":[-139.07167635964524,137.83126505927055,-0.029095911326094299,135.36030553827098,135.41521149933752],"torque_nm":[2.6075939317433487,-2.5843362198613229,0.00054554833736426822,-2.5380057288425815,-2.5390352156125777],"angle_rad":[-127.94629383081357,63.091405901332543,-134.39815826890145,427.78409002081605,427.78508897948149]},"command":[-1,1,0,1,1],"arm":{"servo_position":[-3.7873622398597949e-21,-1.0842021724855039e-21,1.8425084185149166e-20,0,-5.9122899718350197e-21,-4.9127910940749396e-21],"servo_velocity":[0,-1.7347234759768071e-18,3.4694469519536142e-18,0,0,0],"servo_effort":[3.7431675819426422,-2.7662595717569367,-0.090039655133457464,0.00097704943500365117,0.0011475922993796522,-0.0034439670135681618]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":157,"step":1256,"t":6.2800000000000002,"sim_time":6.2799999999998883,"vehicle":{"origin_ned":[0.10983345825304924,0.073886326008473266,2.0827500974479896],"origin_quat_xyzw":[0.018340823059672405,0.047688586614032018,0.025004759588289346,0.99838077651474311],"cg_ned":[0.030838644289202001,0.081810170639846122,1.7888232977438931],"linear_velocity_ned":[0.14492630178366445,0.12333054968697922,0.18126168793101585],"angular_velocity_ned":[0.021661134178589558,0.0012442158042423918,0.082164627111050284]},"sensors":{"Odom":[0.10983345825304924,0.073886326008473266,2.0827500974479896,0.13440809493847083,0.12324545067635416,0.18985098050151197,0.018340823059672932,0.047688586614033385,0.025004759588290064,0.99838077651474311,0.013851244346087522,0.0034032123299731687,0.083775533009766229],"Pressure":[13045.916960667217],"DVL":[0.060964245481278323,-0.15530825560840764,-0.2074106319308219,8.625470941662849,0.0095388457943066697,0.011845062382021756,-0.0088215169958299113,0],"IMU":[0.039191787121643035,0.094445867785869123,0.051932522332692944,-0.026713329497405524,0.020514703454225777,0.15956956818957571,0.97047745491796578,-0.35275697281995466,-9.6444617529534469],"FOG":[0.054068464056060278],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-105,105,0,105,105],"omega_rad_s":[-106.55017816053804,106.5649800217556,0.73487979651800617,106.25868870116231,106.25838033936441],"thrust_n":[-138.87168028493156,137.61134244430579,-0.029489432154287631,135.06622310308026,135.23151301281044],"torque_nm":[2.6038440053424674,-2.5802126708307336,0.00055292685289289316,-2.5324916831827551,-2.5355908689901958],"angle_rad":[-132.2088680041671,67.354576388426324,-134.36849027899984,432.0348945071014,432.03588460183437]},"command":[-1,1,0,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,1.0778494253810949e-21,0,-5.9122899718350197e-21,-4.9127910940749396e-21],"servo_velocity":[8.6736173798840355e-19,0,0,0,0,0],"servo_effort":[3.7663433710480718,-2.747825092649304,-0.076975793895583608,0.00098481633076589114,0.0011889498194009422,-0.0036017557553916749]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":158,"step":1264,"t":6.3200000000000003,"sim_time":6.3199999999998875,"vehicle":{"origin_ned":[0.11574210588693383,0.07890862371847264,2.0900668828728564],"origin_quat_xyzw":[0.018663237998366538,0.04775558078632737,0.026670455608643225,0.99832849045231808],"cg_ned":[0.036693618092714875,0.086807166980147968,1.7961538325960651],"linear_velocity_ned":[0.14748624439242428,0.12615743119321646,0.18480818954046166],"angular_velocity_ned":[0.018753215804858725,0.0031991090958645935,0.08276377923544892]},"sensors":{"Odom":[0.11574210588693383,0.07890862371847264,2.0900668828728564,0.13778792547083607,0.12658689356846933,0.19338548317758905,0.018663237998366868,0.04775558078632821,0.026670455608643697,0.99832849045231808,0.011007801588942542,0.0055220590677890861,0.08402437576795975],"Pressure":[13116.653026563379],"DVL":[0.048987438573916256,-0.15359525931068518,-0.16858618665351638,8.7019189878347856,-0.014729106701354591,0.011598893238041315,-0.012596085547634224,0],"IMU":[0.040000490627624674,0.09449657299122044,0.055309128723913484,-0.03247940889005331,0.048730573122676382,0.030237513398969296,0.95154509249614005,-0.35276170027212495,-9.6569976624164742],"FOG":[0.056363064415225005],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-105,105,0,105,105],"omega_rad_s":[-106.51827454127908,106.5328291392823,0.71954280777288437,106.2329968061357,106.23248910758362],"thrust_n":[-138.67891181060213,137.40000261567056,-0.029823001456342091,134.77743972484834,135.05411776177561],"torque_nm":[2.6002295964487905,-2.5762500490438227,0.00055918127730641433,-2.5270769948409066,-2.5322647080332938],"angle_rad":[-136.47015527622023,71.616450187565306,-134.33944118486608,436.28466229978505,436.28563557735839]},"command":[-1,1,0,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,1.0778494253810949e-21,0,-5.9122899718350197e-21,-4.9127910940749396e-21],"servo_velocity":[0,0,-3.4694469519536142e-18,0,0,0],"servo_effort":[3.7887007508154937,-2.7305728037541983,-0.064228723639995433,0.00099166372182356061,0.001229646342514872,-0.0037586145799536237]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":159,"step":1272,"t":6.3600000000000003,"sim_time":6.3599999999998866,"vehicle":{"origin_ned":[0.1217734986528452,0.084079060702602501,2.0975179749801756],"origin_quat_xyzw":[0.018927266908970401,0.047863246174657967,0.028343393970970101,0.99827226759596355],"cg_ned":[0.042648328588291151,0.091915699515296531,1.8036239020804457],"linear_velocity_ned":[0.14992847316013158,0.12891635174215374,0.18825139412442429],"angular_velocity_ned":[0.015776951644474641,0.005152879850104858,0.083265869665149803]},"sensors":{"Odom":[0.1217734986528452,0.084079060702602501,2.0975179749801756,0.14105961893659613,0.12983576620919768,0.19683271816321862,0.018927266908970421,0.047863246174658022,0.028343393970970132,0.99827226759596355,0.00811260788314919,0.0076491575704849797,0.084168553550786299],"Pressure":[13189.175918395853],"DVL":[0.079246775930568072,-0.19715238738729976,-0.19180376128096627,8.547586951886446,0.026719321218883558,-0.031150099692848408,-0.00079619685606004186,0],"IMU":[0.040695599466904972,0.094629343162579538,0.058696848188463491,0.068873839238850015,-0.028707713007841768,0.074234195838304748,0.96077643067886898,-0.37087655736960357,-9.6457214777750746],"FOG":[0.059374135602072831],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-105,105,0,105,105],"omega_rad_s":[-106.48698837565141,106.50129213606735,0.70451455109885475,106.20781695085748,106.20710984014622],"thrust_n":[-138.49316083298015,137.19698886104331,-0.030100070348479526,134.49403044070914,134.8825522110121],"torque_nm":[2.5967467656183776,-2.5724435411445619,0.00056437631903399129,-2.5217630707632961,-2.5290478539564765],"angle_rad":[-140.73018029254496,75.877051751837158,-134.31099861811208,440.53341395392135,440.53436243493053]},"command":[-1,1,0,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,1.8425084185149166e-20,0,-5.9122899718350197e-21,-4.9127910940749396e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[3.8100546504697559,-2.714630210684708,-0.051855357782634462,0.00099802772471177222,0.0012695268872085297,-0.0039139494745725027]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":160,"step":1280,"t":6.4000000000000004,"sim_time":6.3999999999998858,"vehicle":{"origin_ned":[0.12792278995681289,0.089395443225060406,2.1050992927176515],"origin_quat_xyzw":[0.019131931281312797,0.048011537460343756,0.030021634964400794,0.9982121833108456],"cg_ned":[0.048698170263524729,0.097133126271817499,1.8112293905045485],"linear_velocity_ned":[0.15225755542015432,0.13161069697959327,0.19159201845789162],"angular_velocity_ned":[0.012753104447044434,0.0070950608929613666,0.083677269009112265]},"sensors":{"Odom":[0.12792278995681289,0.089395443225060406,2.1050992927176515,0.14422242396705348,0.13298972884742516,0.20019600330288176,0.019131931281313273,0.04801153746034495,0.030021634964401543,0.9982121833108456,0.0051851446716947042,0.0097734506151161363,0.084216749217378845],"Pressure":[13262.661702733018],"DVL":[0.038346403073383502,-0.1818405956873248,-0.24204383822844014,8.7333975681207079,0.026302369791005881,-0.016857500886534742,-0.021363645671425239,0],"IMU":[0.041275397699546003,0.094844792209395512,0.062091806722280977,0.10174095318068611,0.050990261987302672,0.048594087171006758,0.95668699861944451,-0.36999526401144184,-9.60429571709229],"FOG":[0.051991336224776641],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-105,105,0,105,105],"omega_rad_s":[-106.45631847061672,106.4703698922479,0.68979250312541207,106.18314319033941,106.18223784461148],"thrust_n":[-138.31418329243101,137.00202407044594,-0.030323969368935156,134.21609282185682,134.71633470722239],"torque_nm":[2.5933909367330812,-2.568787951320862,0.00056857442566753428,-2.5165517404098159,-2.5259312757604202],"angle_rad":[-144.98896773880602,80.13640567320698,-134.28315028134216,444.7811698232976,444.78208555373004]},"command":[-1,1,0,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,1.0778494253810949e-21,0,-5.9122899718350197e-21,-4.9127910940749396e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[3.8301175314770628,-2.7001815226307535,-0.039925147672686088,0.001003775691109486,0.0013084015488909954,-0.0040675507019895035]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":161,"step":1288,"t":6.4400000000000004,"sim_time":6.4399999999998849,"vehicle":{"origin_ned":[0.13418519379007277,0.094855487043857573,2.1128067901798953],"origin_quat_xyzw":[0.019276649397255829,0.04820020160337888,0.031703386976831588,0.99814830892388229],"cg_ned":[0.054838717490432357,0.10245693824317841,1.8189662106648936],"linear_velocity_ned":[0.15447792993541556,0.13424374279735324,0.19483077559675632],"angular_velocity_ned":[0.0097018880944654377,0.0090159790046639796,0.084004139481866677]},"sensors":{"Odom":[0.13418519379007277,0.094855487043857573,2.1128067901798953,0.14727583305055172,0.13604664417168552,0.20347835418725096,0.019276649397256412,0.04820020160338033,0.031703386976832545,0.99814830892388229,0.0022443129144673595,0.011884531787423103,0.084177377743872933],"Pressure":[13337.104615055601],"DVL":[0.016148443759075648,-0.18743302186660579,-0.21263709035325534,8.5879327947131738,0.0034095637755801951,0.0045082101538640564,-0.0037380940699482689,0],"IMU":[0.041738965105739802,0.09514310691114658,0.065490426986297437,-0.063312353957906839,0.039366257661940303,0.095187114204131659,0.97569331532415005,-0.36619804222414759,-9.6771083581575557],"FOG":[0.055856420542891395],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-105,105,0,105,105],"omega_rad_s":[-106.42626004407728,106.44005903273327,0.67537292521000469,106.15896810922428,106.15786688764149],"thrust_n":[-138.14172512666104,136.81482318719051,-0.030497886317505274,133.94372105377812,134.55500977727019],"torque_nm":[2.5901573461248955,-2.5652779347598225,0.00057183536845322391,-2.5114447697583402,-2.5229064333238158],"angle_rad":[-149.24654216727731,84.394536477344559,-134.25588400715262,449.02794998865744,449.02882508842447]},"command":[-1,1,0,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,1.0778494253810949e-21,0,-5.9122899718350197e-21,-4.9127910940749396e-21],"servo_velocity":[0,1.7347234759768071e-18,3.4694469519536142e-18,0,0,0],"servo_effort":[3.8488423217388634,-2.687263026109429,-0.028470564762356383,0.0010088721370430484,0.001346168263766541,-0.0042188407850986759]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":162,"step":1296,"t":6.4800000000000004,"sim_time":6.4799999999998841,"vehicle":{"origin_ned":[0.14055599021648821,0.10045681835176401,2.1206364545411707],"origin_quat_xyzw":[0.019361223915168028,0.048428792257373107,0.033387000918321419,0.9980807097918879],"cg_ned":[0.061065719258318905,0.10788475467565831,1.8268303039653495],"linear_velocity_ned":[0.15659390634555997,0.13681863970519317,0.1979683789110861],"angular_velocity_ned":[0.0066428689111600976,0.010906745066196974,0.084252379275937414]},"sensors":{"Odom":[0.14055599021648821,0.10045681835176401,2.1206364545411707,0.15021958373801236,0.13900458657671347,0.20668248818452056,0.019361223915168476,0.048428792257374224,0.033387000918322189,0.9980807097918879,-0.00069165374580508129,0.013972641231491669,0.084058522001509248],"Pressure":[13412.382246038895],"DVL":[0.044789972216589757,-0.18207730841800884,-0.20333410346485023,8.4758099507011675,-0.03968540017186839,0.0057145824881907692,-0.0041905996200667858,0],"IMU":[0.042086147756672188,0.095524067793262016,0.068889415708630067,-0.028840305147080199,0.057156981901434083,0.10537893303196347,0.96220148259581983,-0.36591689909723052,-9.673971189553777],"FOG":[0.071412609169974009],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-105,105,0,105,105],"omega_rad_s":[-106.39680596666129,106.41035338227512,0.66125129687399209,106.13528336889452,106.13398973610418],"thrust_n":[-137.97552815259266,136.63509845140263,-0.030624876435705967,133.67700463146343,134.39815189442882],"torque_nm":[2.5870411528611124,-2.5619080959637994,0.00057421643316948694,-2.50644383683994,-2.5199653480205408],"angle_rad":[-153.50292788281757,88.651468488023681,-134.22918779643618,453.27377421189482,453.27460092040661]},"command":[-1,1,0,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,-1.6269385334386976e-20,0,-7.5301229010907305e-20,-4.9127910940749396e-21],"servo_velocity":[0,0,-3.4694469519536142e-18,0,0,0],"servo_effort":[3.8662709228341705,-2.6759264496639599,-0.017527998144840039,0.0010133577253593209,0.0013827153349566647,-0.0043672865977316747]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":163,"step":1304,"t":6.5200000000000005,"sim_time":6.5199999999998832,"vehicle":{"origin_ned":[0.14703053047049508,0.10619697539498457,2.1285843045005195],"origin_quat_xyzw":[0.0193858278787176,0.048696683836628119,0.035070964644544754,0.99800944389302915],"cg_ned":[0.067375093851147871,0.11341431792428013,1.8348176404369925],"linear_velocity_ned":[0.15860965455986942,0.13933840599402664,0.20100554940331583],"angular_velocity_ned":[0.0035948834239679429,0.012759253597863448,0.084427672428883105]},"sensors":{"Odom":[0.14703053047049508,0.10619697539498457,2.1285843045005195,0.15305365270910318,0.14186186309776069,0.20981083213333729,0.019385827878717638,0.048696683836628216,0.035070964644544823,0.99800944389302915,-0.0036052683351243476,0.01602867622495556,0.083867974755997304],"Pressure":[13488.18680346532],"DVL":[0.030536321560230648,-0.1750695085133043,-0.19604696941342867,8.5850687033776296,-0.0059176705184506451,-0.0032822437697176588,0.020468619903431646,0],"IMU":[0.042317525872483427,0.095987069881128831,0.072285751792019501,0.12409596650501804,0.011725610965882193,0.033519592539411919,0.97177240133656473,-0.39792165493149417,-9.6620113173084494],"FOG":[0.067785513777227191],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-105,105,0,105,105],"omega_rad_s":[-106.36794759982608,106.38124494853132,0.64742260891036607,106.11208007611779,106.11059852252124],"thrust_n":[-137.81533283357695,136.46256186817268,-0.030707866080037841,133.41602917174401,134.24536619220947],"torque_nm":[2.5840374906295684,-2.5586730350282383,0.00057577248900070961,-2.5015505469702002,-2.517100616103928],"angle_rad":[-157.75814886891584,92.907225738496365,-134.20304984268452,457.5186619078961,457.51943262649473]},"command":[-1,1,0,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,-1.6269385334386976e-20,0,-7.5301229010907305e-20,-4.9127910940749396e-21],"servo_velocity":[0,0,-3.4694469519536142e-18,0,0,0],"servo_effort":[3.8822578291126217,-2.6661613303705209,-0.0071212454043999632,0.0010171144264548547,0.0014179360645887045,-0.0045127380177826613]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":164,"step":1312,"t":6.5600000000000005,"sim_time":6.5599999999998824,"vehicle":{"origin_ned":[0.15360424196170624,0.11207341099236287,2.1366463895027668],"origin_quat_xyzw":[0.019350988717436683,0.049003086426987488,0.036753897357464343,0.99793456087326871],"cg_ned":[0.073762923098191047,0.11904348782388198,1.8429242191405104],"linear_velocity_ned":[0.16052920066942519,0.1418059169906587,0.20394301550899546],"angular_velocity_ned":[0.00057591882813803484,0.014566207063311293,0.084535433026697235]},"sensors":{"Odom":[0.15360424196170624,0.11207341099236287,2.1366463895027668,0.1557782619797673,0.14461703052622915,0.21286552476199755,0.019350988717437068,0.049003086426988467,0.036753897357465072,0.99793456087326871,-0.0064798945697250223,0.018044226558330403,0.083613170983978191],"Pressure":[13563.891136028407],"DVL":[0.017889771041632137,-0.17545695597932723,-0.22872432604469123,8.5735196302666417,0.0067733860390647186,0.00018415974997469838,0.0054675285074978729,0],"IMU":[0.042434378194764616,0.096531145817351158,0.07567667502992223,-0.027507326017090473,-0.058237730145891273,0.10589777543044959,0.97550260388121712,-0.38147301646995513,-9.6779236152546648],"FOG":[0.078737240783337339],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-105,105,0,105,105],"omega_rad_s":[-106.33967536095143,106.35272458546785,0.63388156133034168,106.08934903204737,106.08768499116826],"thrust_n":[-137.66088077408054,136.296928040175,-0.030749659757208562,133.16087571104018,134.09628999164102],"torque_nm":[2.5811415145140106,-2.5555674007532811,0.00057655612044766062,-2.4967664195820034,-2.5143054373432694],"angle_rad":[-162.01222874077001,97.161831914592412,-134.17745854682889,461.76263212827723,461.76333945941695]},"command":[-1,1,0,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,-1.6269385334386976e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,-3.4694469519536142e-18,0,0,0],"servo_effort":[3.896772560660775,-2.6579869353649319,0.0027260194887887383,0.0010205526741052507,0.0014517660543929441,-0.0046543641593138002]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":165,"step":1320,"t":6.6000000000000005,"sim_time":6.5999999999998815,"vehicle":{"origin_ned":[0.16027263280903542,0.11808349617358688,2.144818789577486],"origin_quat_xyzw":[0.019257570386683704,0.049347060039882935,0.038434543306149718,0.99785610161439098],"cg_ned":[0.080225446726934754,0.12477023600702979,1.8511460686074332],"linear_velocity_ned":[0.16235643050685378,0.14422390247632189,0.20678152282962126],"angular_velocity_ned":[-0.0023969608691396921,0.016321057828509955,0.084580835689168354]},"sensors":{"Odom":[0.16027263280903542,0.11808349617358688,2.144818789577486,0.15839386687127174,0.14726891467016226,0.21584843547407695,0.019257570386683798,0.049347060039883178,0.038434543306149906,0.99785610161439098,-0.00929981900011774,0.020011530593286607,0.08330121323130206],"Pressure":[13639.818544189375],"DVL":[0.010757510398965796,-0.16412253022220349,-0.19922488940261118,8.4830231413782666,0.0094374780558105394,-0.050784868303274056,-0.051468296025718216,0],"IMU":[0.04243864300429058,0.09715498842593874,0.079059673931829291,0.027229353126191326,0.033163464265647306,0.1463410236077578,0.97573309530740482,-0.37742552041498467,-9.6753766892156623],"FOG":[0.076981164496003396],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-105,105,0,105,105],"omega_rad_s":[-106.31197910379983,106.32478244038541,0.620622696773654,106.06708089928182,106.06524066416817],"thrust_n":[-137.51191611156281,136.13791505300296,-0.030752947148782472,132.91162153010285,133.95059127555092],"torque_nm":[2.5783484270918033,-2.5525859072438051,0.00057661775903967137,-2.4920929036894282,-2.51157358641658],"angle_rad":[-166.26519071657719,101.41531031920637,-134.15240252569669,466.0057035531388,466.00634033622816]},"command":[-1,1,0,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,1.0778494253810949e-21,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[3.9097837344606123,-2.6514038094620376,0.011987390146266617,0.0010238443582607144,0.0014840912252295044,-0.0047920846151435006]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":166,"step":1328,"t":6.6400000000000006,"sim_time":6.6399999999998807,"vehicle":{"origin_ned":[0.16703129625146657,0.12422452452042436,2.1530976161896369],"origin_quat_xyzw":[0.01910675414884978,0.049727528904511105,0.040111765965316598,0.99777409820364149],"cg_ned":[0.086759056760114958,0.13059263989054068,1.8594792478866764],"linear_velocity_ned":[0.1640950898290591,0.1465949405447971,0.20952184760940909],"angular_velocity_ned":[-0.0053076896345562842,0.018018023359682115,0.08456879268600076]},"sensors":{"Odom":[0.16703129625146657,0.12422452452042436,2.1530976161896369,0.16090116028669432,0.14981661947520222,0.21876118492431351,0.019106754148849957,0.049727528904511563,0.040111765965316959,0.99777409820364149,-0.012050313556159136,0.021923503912869898,0.082938841026356472],"Pressure":[13720.995526315628],"DVL":[0.0057807409049340577,-0.19769473895647513,-0.23807409251366829,8.4757203142688144,0.020390922706849012,-0.016690595297534687,0.039730537670707958,0],"IMU":[0.042332876949363461,0.097856974078762801,0.082432475011757558,-0.08759621342987127,0.014633842477080371,0.10894877275464109,0.97633094105698393,-0.39709985296383321,-9.6797540448838717],"FOG":[0.073857312945902906],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-105,105,0,105,105],"omega_rad_s":[-106.28484837406987,106.29740825512874,0.60764049016627797,106.04526631405876,106.04325695385674],"thrust_n":[-137.36818687530175,135.98524567074236,-0.030720306999212868,132.66833878731705,133.80796860379888],"torque_nm":[2.5756535039119086,-2.5497233563264197,0.0005760057562352413,-2.4875313522621947,-2.5088994113212304],"angle_rad":[-170.51705760107362,105.66768385119997,-134.12787061617198,470.24789448819257,470.2484538320989]},"command":[-1,1,0,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,1.0778494253810949e-21,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[3.9212744724371813,-2.6464105401551943,0.020644352002191935,0.0010263002632607888,0.0015148316404251475,-0.0049258103648031513]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":167,"step":1336,"t":6.6799999999999997,"sim_time":6.6799999999998798,"vehicle":{"origin_ned":[0.17387591446652456,0.13049371699553872,2.1614790134529485],"origin_quat_xyzw":[0.018900018362912052,0.050143295436855348,0.041784541420598738,0.99768857431910285],"cg_ned":[0.093360291710297333,0.13650887651600355,1.8679198475607262],"linear_velocity_ned":[0.16574877633994547,0.14892145467276494,0.21216479075492134],"angular_velocity_ned":[-0.0081412454513394138,0.019652039172338868,0.084503938188170882]},"sensors":{"Odom":[0.17387591446652456,0.13049371699553872,2.1614790134529485,0.16330105073815065,0.1522595320101123,0.22160514995098565,0.018900018362912226,0.050143295436855813,0.041784541420599126,0.99768857431910285,-0.014717674610059314,0.023773705679808004,0.082532412195225363],"Pressure":[13797.770667259863],"DVL":[0.055863057865726998,-0.21280333655552161,-0.21910956342247742,8.5295873682080305,0.032381526735082426,-0.00074402253351913859,0.019471754469347652,0],"IMU":[0.042120212263027361,0.098635186199924493,0.085793030907825613,-0.024104673372970939,0.0033069418997356305,0.057307834329694204,0.99442451906847185,-0.39188395913005164,-9.6650366823230662],"FOG":[0.091672590293619169],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-105,105,0,105,105],"omega_rad_s":[-106.25827258047541,106.27059156789477,0.59492940871596267,106.02389596116487,106.02172523835488],"thrust_n":[-137.2294458935786,135.83864862692857,-0.030654211154666659,132.43109517549993,133.66815023561287],"torque_nm":[2.5730521105045994,-2.5469746617549109,0.00057476645914999991,-2.4830830345406238,-2.5062778169177422],"angle_rad":[-174.76785177728689,109.91897499399022,-134.10385187647452,474.48922286549549,474.48969817772155]},"command":[-1,1,0,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,1.0778494253810949e-21,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,3.4694469519536142e-18,0,0,0],"servo_effort":[3.9312448896307375,-2.643002036824166,0.028682652343180789,0.0010281247419803303,0.0015439333928283603,-0.0050551861590093184]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":168,"step":1344,"t":6.7199999999999998,"sim_time":6.719999999999879,"vehicle":{"origin_ned":[0.18080226203583039,0.13688822778423357,2.1699591601007033],"origin_quat_xyzw":[0.018639116957309243,0.050593053851159496,0.043451951971794286,0.99759954595564349],"cg_ned":[0.10002583084497463,0.14251721645642479,1.876463991176555],"linear_velocity_ned":[0.1673209478402434,0.15120571311650574,0.21471119225397753],"angular_velocity_ned":[-0.010883722073944809,0.021218753044269015,0.084390643579242433]},"sensors":{"Odom":[0.18080226203583039,0.13688822778423357,2.1699591601007033,0.16559466715926813,0.15459733711474277,0.22438148946583625,0.01863911695730976,0.050593053851160905,0.043451951971795494,0.99759954595564349,-0.017289287240716815,0.025556350741195784,0.082087910767397756],"Pressure":[13874.557151018911],"DVL":[0.078723370304099455,-0.20460480092948197,-0.22187979902360078,8.4860517564626985,-0.0014748286222575581,0.028030174322563703,0.0048602734517844129,0],"IMU":[0.041804311797031209,0.099487438845292223,0.089139509227239788,-0.042669753591039104,0.013471463342290484,-0.041425623059041572,0.99511723627774862,-0.38425850963436808,-9.7369030832360046],"FOG":[0.08908557631531823],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-105,105,0,105,105],"omega_rad_s":[-106.2322411088596,106.24432184821326,0.58248395180661972,106.00296062347091,106.00063691275948],"thrust_n":[-137.09545146826389,135.69785886303708,-0.030557027711514934,132.19995270716035,133.53089314976862],"torque_nm":[2.5705397150299487,-2.5443348536819457,0.00057294426959090519,-2.4787491132592572,-2.5037042465581618],"angle_rad":[-179.01759520377647,114.16920581061838,-134.08033558551733,478.72970624657091,478.73009125915831]},"command":[-1,1,0,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,1.0778494253810949e-21,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[3.9397161163625363,-2.64116767949234,0.036092328134158191,0.0010292241179542029,0.0015713555457694383,-0.0051799348856993487]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":169,"step":1352,"t":6.7599999999999998,"sim_time":6.7599999999998781,"vehicle":{"origin_ned":[0.18780620917107688,0.14340515006402055,2.1785342716763525],"origin_quat_xyzw":[0.018326057503576101,0.05107540355421572,0.045113179417020526,0.99750702243695366],"cg_ned":[0.10675248853973085,0.14861601732623655,1.8851078366616998],"linear_velocity_ned":[0.16881491859542797,0.15344982353648282,0.21716192854272978],"angular_velocity_ned":[-0.013522335445488861,0.022714475505646592,0.084232993227355474]},"sensors":{"Odom":[0.18780620917107688,0.14340515006402055,2.1785342716763525,0.16778333723008423,0.15683000565555252,0.22709115586466844,0.01832605750357642,0.051075403554216602,0.04511317941702131,0.99750702243695366,-0.019753624420345339,0.027266272532554713,0.08161092332449775],"Pressure":[13954.874336863981],"DVL":[0.0435436286249812,-0.21118395317804939,-0.25883088834390938,8.4881737553437429,0.027245912156750193,0.030715620979849378,-0.0061854643146062394,0],"IMU":[0.041389323655593377,0.10041130059676374,0.092470281031516263,-0.038239048693210126,0.0020798472432920351,0.041018097526416185,0.99598367400137156,-0.36497477901408709,-9.7150717871640531],"FOG":[0.097780923169381778],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-105,105,0,105,105],"omega_rad_s":[-106.20674339749969,106.21858858670711,0.57029867727396577,105.98245121462629,105.97998342336273],"thrust_n":[-136.96596821873698,135.56261835015411,-0.030431024582917736,131.97496794963345,133.39598188932689],"torque_nm":[2.5681119041013183,-2.5417990940653898,0.00057058171092970759,-2.4745306490556271,-2.5011746604248795],"angle_rad":[-183.26630941551721,118.41839794314483,-134.05731124099171,482.96936182711482,482.9696506193356]},"command":[-1,1,0,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,1.0778494253810949e-21,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[3.9468072743194123,-2.6408874928258839,0.042864201295301878,0.0010296959519151033,0.0015970470143193282,-0.0053000078798156698]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":170,"step":1360,"t":6.7999999999999998,"sim_time":6.7999999999998773,"vehicle":{"origin_ned":[0.19488372419992639,0.15004152280446109,2.1872006034089426],"origin_quat_xyzw":[0.017963078475908844,0.051588861690146884,0.046767498758694889,0.99741100766987667],"cg_ned":[0.1135372086015129,0.15480371768326037,1.8938475781456083],"linear_velocity_ned":[0.17023386575754015,0.15565574264883417,0.21951792832828451],"angular_velocity_ned":[-0.016045484211385925,0.024136153466287492,0.084034828005256079]},"sensors":{"Odom":[0.19488372419992639,0.15004152280446109,2.1872006034089426,0.16986858387149051,0.15895781717005306,0.22973492458745781,0.017963078475908723,0.05158886169014653,0.04676749875869457,0.99741100766987667,-0.022100304709064836,0.028898917158422004,0.081106676078089524],"Pressure":[14033.588708726093],"DVL":[0.028840049873536375,-0.22484096436496648,-0.20787823164843261,8.5267678610023321,0.028463742615076778,-0.024580240749346238,0.035454437276407291,0],"IMU":[0.040879834589558781,0.10140411750949822,0.095783910275161865,-0.026197116653056247,0.12092558686722381,0.14581505250163571,1.0181734286745561,-0.37930850160681112,-9.6992510669789844],"FOG":[0.086637580913172571],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-105,105,0,105,105],"omega_rad_s":[-106.18176898665934,106.19338135430846,0.55836821846132012,105.96235879982721,105.95975629130321],"thrust_n":[-136.84076708606017,135.43267593524527,-0.030278370158647754,131.75619116604275,133.26322676421088],"torque_nm":[2.5657643828636281,-2.5393626737858486,0.00056771944047464542,-2.4704285843633018,-2.498685501828954],"angle_rad":[-187.51401552717965,122.66657261490542,-134.03476855662089,487.20820644272459,487.20839346065185]},"command":[-1,1,0,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,1.0778494253810949e-21,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[3.9524584904722353,-2.6421190081898214,0.048993601522416032,0.0010291976970796971,0.0016209778254362827,-0.0054149373306410778]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":171,"step":1368,"t":6.8399999999999999,"sim_time":6.8399999999998764,"vehicle":{"origin_ned":[0.20203087587095719,0.15679433797695566,2.1959544533463076],"origin_quat_xyzw":[0.017552625721694571,0.052131875280066152,0.048414272169507368,0.99731150156826853],"cg_ned":[0.12037705886363248,0.16107883073895995,1.9026794478972857],"linear_velocity_ned":[0.17158082805225688,0.15782526651318696,0.2217801647539647],"angular_velocity_ned":[-0.018442773857907276,0.025481327888148175,0.083799750632993553]},"sensors":{"Odom":[0.20203087587095719,0.15679433797695566,2.1959544533463076,0.17185210799439754,0.16098134860342467,0.23231340179155854,0.017552625721694751,0.052131875280066679,0.04841427216950786,0.99731150156826853,-0.024320111777652559,0.030450317896042186,0.080580037775007218],"Pressure":[14113.285627684476],"DVL":[0.059687916091036131,-0.23434213879832588,-0.24588416925691958,8.5072755097069503,-0.0058927399073271285,-0.0055469527107631983,-0.021255441737544196,0],"IMU":[0.040280822199466708,0.10246303600606219,0.099079143797611541,0.054949121661547307,-0.049723134977110117,0.097961907388536482,1.0148953365442659,-0.35949265450358719,-9.6706254251240669],"FOG":[0.10327562742367967],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-105,105,0,105,105],"omega_rad_s":[-106.15730755043784,106.16868984111375,0.5466872950369166,105.94267460908422,105.93994712858087],"thrust_n":[-136.71962627135616,135.30778760800874,-0.030101135482470408,131.54366635777399,133.13246278562107],"torque_nm":[2.5634929925879284,-2.5370210176501637,0.00056439629029632029,-2.466443744208263,-2.496233677230395],"angle_rad":[-191.76073423797465,126.9137506346534,-134.01269745887976,491.44625657528098,491.44633664835266]},"command":[-1,1,0,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-9.7578195523695395e-21,-1.6269385334386976e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,-1.7347234759768071e-18,-3.4694469519536142e-18,0,0,0],"servo_effort":[3.9566722416594002,-2.6448299871862075,0.054479026629241506,0.0010279818541143885,0.0016431203163351318,-0.0055247678334700541]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":172,"step":1376,"t":6.8799999999999999,"sim_time":6.8799999999998755,"vehicle":{"origin_ned":[0.20924383529554325,0.1636605480190565,2.204792165688529],"origin_quat_xyzw":[0.017097328815006824,0.05270283315841498,0.050052943136773331,0.997208501572171],"cg_ned":[0.12726922573484398,0.16743993813629951,1.9115997184308793],"linear_velocity_ned":[0.17285871478189882,0.15996003979445103,0.22394966828671603],"angular_velocity_ned":[-0.020705016833172819,0.026748124630075473,0.083531111979035247]},"sensors":{"Odom":[0.20924383529554325,0.1636605480190565,2.204792165688529,0.17373578946966003,0.16290147154121787,0.23482705208337615,0.017097328815007085,0.052702833158415785,0.050052943136774095,0.997208501572171,-0.026404985231572788,0.031917100301900668,0.08003550477744853],"Pressure":[14193.598587485991],"DVL":[0.038579829254754144,-0.21053326124061736,-0.23232199425418359,8.5201628548907742,-0.026314210434687655,-0.027391878087583116,0.01321247368874188,0],"IMU":[0.039597607285378658,0.10358502605229464,0.10235490168743892,-0.043632670238371564,-0.011641716578605694,0.21120191355457679,1.0337641727679463,-0.35072449208039003,-9.6833387464572684],"FOG":[0.11966170623807741],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-105,105,0,105,105],"omega_rad_s":[-106.13334891669844,106.1445038811087,0.5352507195968349,105.92339004520802,105.92054764866479],"thrust_n":[-136.60233129663709,135.18771683488399,-0.029901296959774504,131.33743000718903,133.00354859544856],"torque_nm":[2.561293711811945,-2.5347696906540746,0.00056064931799577205,-2.4625768126347944,-2.4938165361646614],"angle_rad":[-196.00648583748571,131.1599524019199,-133.99108808338175,495.68352835973269,495.68349671441842]},"command":[-1,1,0,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-9.7578195523695395e-21,-1.6269385334386976e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,-3.4694469519536142e-18,0,0,0],"servo_effort":[3.9594775156440929,-2.648975515632956,0.059323632783238496,0.0010260507205478318,0.0016634677605938072,-0.0056293181105639906]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":173,"step":1384,"t":6.9199999999999999,"sim_time":6.9199999999998747,"vehicle":{"origin_ned":[0.21651887765706462,0.17063707339145232,2.2137101341735992],"origin_quat_xyzw":[0.016599977417278242,0.053300077457450599,0.051683029973013425,0.99710200426314666],"cg_ned":[0.13421100897069943,0.1738856838331341,1.9206047046542483],"linear_velocity_ned":[0.17407030104267782,0.16206155411238604,0.22602752539205956],"angular_velocity_ned":[-0.022824242993415223,0.027935201955918625,0.083232010835149736]},"sensors":{"Odom":[0.21651887765706462,0.17063707339145232,2.2137101341735992,0.17552166161441674,0.16471934426448506,0.23727621339932412,0.016599977417278356,0.053300077457450967,0.051683029973013786,0.99710200426314666,-0.028348027311400931,0.033296446014834738,0.079477199463344028],"Pressure":[14276.447839623579],"DVL":[0.023914402296420292,-0.24277694303054553,-0.23849775860637137,8.4833780414209361,0.020434068207104673,0.0058575390043326073,-0.0082687594571243736,0],"IMU":[0.038835806459042749,0.10476690411493078,0.1056102662987827,-0.052876980319790719,-0.034058722056193827,0.12572809493046444,1.0345732791566791,-0.32872605788282172,-9.6819089550032995],"FOG":[0.10505138299530321],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-105,105,0,105,105],"omega_rad_s":[-106.1098830791103,106.12081346731011,0.52405340142125534,105.90449668839351,105.90154967357196],"thrust_n":[-136.48867547829568,135.07223516037845,-0.029680738823015557,131.13751115022373,132.87636493289432],"torque_nm":[2.5591626652180444,-2.5326044092570958,0.0005565138529315416,-2.4588283340666943,-2.4914318424917683],"angle_rad":[-200.25129021211234,135.4051979131365,-133.96993077106998,499.92003759112225,499.91988986179149]},"command":[-1,1,0,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,-1.6269385334386976e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,-3.4694469519536142e-18,0,0,0],"servo_effort":[3.960931048106854,-2.6545190628232804,0.063530067168147963,0.0010235424044716369,0.0016820112800593162,-0.0057285483042309772]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":174,"step":1392,"t":6.96,"sim_time":6.9599999999998738,"vehicle":{"origin_ned":[0.22385241826773705,0.17772055539660145,2.2227047955553276],"origin_quat_xyzw":[0.016063354823531308,0.053921921186490494,0.053304143235145166,0.99699200767174578],"cg_ned":[0.14119985195260346,0.18041442506323202,1.9296907551426559],"linear_velocity_ned":[0.17522054772273674,0.16410889657389874,0.22801416208987565],"angular_velocity_ned":[-0.024812016518998392,0.029041599592560349,0.082909305843620634]},"sensors":{"Odom":[0.22385241826773705,0.17772055539660145,2.2227047955553276,0.17721243821523083,0.16641961220353804,0.23966119541867215,0.016063354823531262,0.053921921186490342,0.053304143235145013,0.99699200767174578,-0.030162042496290776,0.03458800309861372,0.078910866806840466],"Pressure":[14358.402611281052],"DVL":[-0.0067344383354821097,-0.21402510300084099,-0.23103536654101786,8.462680027418088,0.0094667798916407524,0.002319515802076171,0.0015490636664606376,0],"IMU":[0.038001001883784746,0.10600538358567935,0.1088445043660089,-0.019977550132470403,0.04035486637360744,0.21602638568580323,1.0527095622350313,-0.3514804662365465,-9.6623490544479935],"FOG":[0.097292792758530741],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-103.5227591324409,105,0,105,105],"omega_rad_s":[-105.70487521231036,106.09760876255152,0.51309034833781608,105.88598630415798,105.88294513335632],"thrust_n":[-135.37277461743926,134.96111074836961,-0.029441133744749836,130.94389214114128,132.75084972850124],"torque_nm":[2.5382395240769862,-2.5305208265319301,0.00055202125771405949,-2.4551979776463995,-2.4890784324093986],"angle_rad":[-204.48767020746303,139.64950676823398,-133.94921606430273,504.15579973179672,504.15553196877829]},"command":[-0.98593103935658,1,0,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,1.0778494253810949e-21,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[3.9535271225440574,-2.6606407797326375,0.067272629104279683,0.0010215270660705361,0.0016990335979877645,-0.0058223685626245907]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":175,"step":1400,"t":7,"sim_time":6.999999999999873,"vehicle":{"origin_ned":[0.23124115902802495,0.18490635758241278,2.2317725979786229],"origin_quat_xyzw":[0.01548966553198552,0.054566683738500397,0.054916074166877965,0.99687851420601281],"cg_ned":[0.14823348638896208,0.18702288095716199,1.9388542166109333],"linear_velocity_ned":[0.17631773958872288,0.16605308260690327,0.22990946918961591],"angular_velocity_ned":[-0.026703004184012381,0.030066384595349108,0.082575044628795599]},"sensors":{"Odom":[0.23124115902802495,0.18490635758241278,2.2317725979786229,0.17881171235009147,0.1679655145166255,0.24198272321911918,0.01548966553198548,0.054566683738500252,0.054916074166877819,0.99687851420601281,-0.031883233913793205,0.035794184999621767,0.078344825138266877],"Pressure":[14441.803012869264],"DVL":[0.046889322548268095,-0.22382122661314249,-0.26291860623070951,8.3524715845695869,-0.0049392618313542505,0.024468942628228765,-0.010967641129833769,0],"IMU":[0.037097607105392442,0.10729720742670446,0.11205718801014773,0.031098826621866638,0.05770517783458777,0.037135747917025903,1.0798861468414043,-0.33488772082370172,-9.680103513346074],"FOG":[0.098486226782752859],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-101.97137370595269,105,0,105,105],"omega_rad_s":[-104.89756210056899,106.07488011870039,0.50235666741608331,105.86785089067371,105.86472603130174],"thrust_n":[-133.21514268091477,134.85408789235561,-0.029183841129377559,130.75645657841883,132.62701470747265],"torque_nm":[2.4977839252671519,-2.5285141479816677,0.00054719702117582935,-2.4516835608453533,-2.4867565257651125],"angle_rad":[-208.69827567280495,143.89289817783708,-133.92893470289303,508.39082991978165,508.39043859263245]},"command":[-0.97115594005669226,1,0,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,-1.6269385334386976e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,-3.4694469519536142e-18,0,0,0],"servo_effort":[3.9369237083437474,-2.6672781151461247,0.070568563598962825,0.0010207237160578344,0.0017145693713724894,-0.0059108989000176302]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":176,"step":1408,"t":7.04,"sim_time":7.0399999999998721,"vehicle":{"origin_ned":[0.23868211548389032,0.19218854881082784,2.2409100198060341],"origin_quat_xyzw":[0.0148805389248094,0.055232694951533261,0.056518802944770019,0.99676152809154317],"cg_ned":[0.15530996032276786,0.1937061163153152,1.9480914543702406],"linear_velocity_ned":[0.17736924748847907,0.1678606961113617,0.23171441190747777],"angular_velocity_ned":[-0.028518295631892999,0.031008815964805744,0.082238927764448438]},"sensors":{"Odom":[0.23868211548389032,0.19218854881082784,2.2409100198060341,0.18032299048313621,0.16933141736978136,0.24424204049603174,0.014880538924809584,0.055232694951533941,0.056518802944770706,0.99676152809154317,-0.033534122186662643,0.036916339152725589,0.077786423274658484],"Pressure":[14523.884193365144],"DVL":[0.012662187148787061,-0.27537960211118767,-0.26004738494706131,8.346374331778609,0.031587316219311254,-0.018185795483967732,-0.020471289653956996,0],"IMU":[0.036128877357638388,0.10863916599202136,0.11524821090955809,-0.12161127413953868,0.049496541802052929,0.086899903642959964,1.0912794927995859,-0.31553970499223055,-9.7071747404022499],"FOG":[0.11746590163113052],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-100.43131564260408,105,0,105,105],"omega_rad_s":[-103.82187949232096,106.05261808759533,0.49184756464476753,105.85008268713611,105.84688446724276],"thrust_n":[-130.38818022390632,134.75090728287643,-0.028910265757009754,130.57508580051405,132.50482317602922],"torque_nm":[2.4447783791982438,-2.5265795115539329,0.00054206748294393303,-2.4482828587596392,-2.4844654345505477],"angle_rad":[-212.87019172205993,148.13539097114571,-133.90907762014285,512.62514297855682,512.62462497270292]},"command":[-0.95648872040575306,1,0,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,-1.6269385334386976e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,-3.4694469519536142e-18,0,0,0],"servo_effort":[3.913841099506469,-2.6746903215437721,0.073369789280144065,0.0010200722937450868,0.0017285631703064766,-0.0059940889610049196]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":177,"step":1416,"t":7.0800000000000001,"sim_time":7.0799999999998713,"vehicle":{"origin_ned":[0.24617256943508872,0.1995603957501596,2.2501136070901722],"origin_quat_xyzw":[0.01423731747956913,0.055918286254263587,0.058112459393177426,0.99664105179179141],"cg_ned":[0.1624275893024312,0.20045821029808453,1.9573988931401636],"linear_velocity_ned":[0.17838127012836075,0.16951312923252043,0.23343083012172655],"angular_velocity_ned":[-0.030266441306338664,0.031868502084745891,0.081908186843978992]},"sensors":{"Odom":[0.24617256943508872,0.1995603957501596,2.2501136070901722,0.18174964971101043,0.17050249698272099,0.24644068788918322,0.014237317479569392,0.055918286254264621,0.058112459393178495,0.99664105179179141,-0.035124550980016031,0.037954846979471747,0.077241863492285165],"Pressure":[14605.055561806486],"DVL":[0.049317734832705538,-0.20340199706327694,-0.30424360405305106,8.3298741329200734,0.00096661330824355824,0.032649751941754526,-0.023203034736110531,0],"IMU":[0.035097483979189555,0.11002805696547727,0.11841773900537624,0.022892336077090063,0.050043007846415889,0.081587019912735606,1.0805814661180455,-0.32247123264363997,-9.6915142352471264],"FOG":[0.11605420317571223],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-98.908234187879103,105,0,105,105],"omega_rad_s":[-102.57053008656091,106.03081341705025,0.48155834392876812,105.83267413946629,105.82941269115271],"thrust_n":[-127.15115333483591,134.65131284909316,-0.028621863530009697,130.3996725770948,132.38419512619245],"torque_nm":[2.3840841250281732,-2.5247121159204973,0.00053665994118768181,-2.4449938608205279,-2.4822036586161089],"angle_rad":[-216.99488265772771,152.37700360386231,-133.88963593890753,516.85875342592237,516.85810603558843]},"command":[-0.94198318274170578,1,0,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-9.7578195523695395e-21,-3.3616620094155045e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,-1.7347234759768071e-18,0,0,0,0],"servo_effort":[3.8861867217966708,-2.6830377297466508,0.075645738635760157,0.0010195834326976959,0.0017409848021962451,-0.0060716853682106471]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":178,"step":1424,"t":7.1200000000000001,"sim_time":7.1199999999998704,"vehicle":{"origin_ned":[0.25371003107161244,0.2070147200996845,2.2593799989509447],"origin_quat_xyzw":[0.013561258765519979,0.056621787791688513,0.05969729180750237,0.99651708402757322],"cg_ned":[0.16958491482650309,0.20727273735234553,1.966773044530751],"linear_velocity_ned":[0.17935905800587085,0.17100186383643165,0.23506112181512953],"angular_velocity_ned":[-0.031947750373019036,0.0326455098454159,0.08158823027224836]},"sensors":{"Odom":[0.25371003107161244,0.2070147200996845,2.2593799989509447,0.18309499735974602,0.17147141462143645,0.24858031675951286,0.013561258765520064,0.056621787791688874,0.059697291807502752,0.99651708402757322,-0.036655995014515615,0.038909595237017619,0.076716418150931498],"Pressure":[14688.092411020249],"DVL":[0.019376222181481689,-0.23103192871133643,-0.271527714580999,8.4920600243680386,-0.013724552371042743,0.0070863983780428269,0.0022041723544119155,0],"IMU":[0.034005917200408832,0.11146066176508747,0.12156617008858475,-0.014150382469563266,0.052333504116864396,0.031906646898338629,1.0970644272164647,-0.31951525935619368,-9.7223415480836834],"FOG":[0.10534162622283408],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-97.406109433481944,105,0,105,105],"omega_rad_s":[-101.2076983583145,106.00945704444875,0.47148440578788758,105.81561787543144,105.81230312505529],"thrust_n":[-123.68245789438978,134.55505464046317,-0.028320094071045,130.23011794584045,132.26502991256601],"torque_nm":[2.3190460855198087,-2.5229072745086847,0.00053100176383209373,-2.4418147114845086,-2.479969310860612],"angle_rad":[-221.06684434840622,156.61775416589026,-133.87060096770784,521.09167548167068,521.09089640172863]},"command":[-0.92767723269982805,1,0,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,-1.6269385334386973e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[3.8552872486868326,-2.6924109408808548,0.077384961918499931,0.0010185418539346404,0.0017518341134477966,-0.0061438001635794829]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":179,"step":1432,"t":7.1600000000000001,"sim_time":7.1599999999998696,"vehicle":{"origin_ned":[0.26129221009410913,0.21454414366491201,2.2687059437366117],"origin_quat_xyzw":[0.012853666119613879,0.057341530014624317,0.06127364299643185,0.99638961901297074],"cg_ned":[0.17678067050073526,0.21414309250671471,1.9762105243455672],"linear_velocity_ned":[0.18030709211405585,0.17232515556546538,0.23660802865041194],"angular_velocity_ned":[-0.0335573290269323,0.033340393573640208,0.081283108048474731]},"sensors":{"Odom":[0.26129221009410913,0.21454414366491201,2.2687059437366117,0.18436230455350219,0.172235984397133,0.25066257381800222,0.012853666119614115,0.057341530014625379,0.061273642996432981,0.99638961901297074,-0.03812460745354318,0.039780280204259853,0.076214588121112717],"Pressure":[14775.200505016615],"DVL":[0.056357620921724035,-0.20615150198536564,-0.24024025599122212,8.3536019979717508,-0.024133537227323209,0.0094030091863640183,0.0051878545216633111,0],"IMU":[0.032856747060863195,0.11293373556773809,0.12469410151473498,0.010965831263152495,0.13151223100376166,0.19978418611014104,1.1095522760495433,-0.30542342543710588,-9.677377129317895],"FOG":[0.10806191309019732],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-95.927725179404064,105,0,105,105],"omega_rad_s":[-99.777830755988717,105.98854008943006,0.46162124586812525,105.79890668874395,105.79554836454167],"thrust_n":[-120.10361142859668,134.46189099373203,-0.028006388679644046,130.06632879789126,132.14722094449718],"torque_nm":[2.2519427142861881,-2.5211604561324763,0.00052511978774332608,-2.438743664960461,-2.4777603927093219],"angle_rad":[-225.08267183087119,160.85766038875315,-133.85196419689831,525.32392307448049,525.32301039236393]},"command":[-0.91359738266099111,1,0,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,-3.3616620094155045e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,-3.4694469519536142e-18,0,0,0],"servo_effort":[3.8220385110041915,-2.7028484226723415,0.078582487515913443,0.0010170485612040383,0.001761113043121801,-0.0062104096658243905]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":180,"step":1440,"t":7.2000000000000002,"sim_time":7.1999999999998687,"vehicle":{"origin_ned":[0.2689169938461145,0.22214125470301233,2.2780883088191528],"origin_quat_xyzw":[0.012115969170641259,0.05807584790320125,0.062841931314931668,0.99625864656222152],"cg_ned":[0.18401375473101705,0.22106270738407599,1.9857080628129249],"linear_velocity_ned":[0.18122922959513563,0.17348571503135823,0.23807449001516895],"angular_velocity_ned":[-0.035087191255914425,0.033954184891452681,0.08099582899384529]},"sensors":{"Odom":[0.2689169938461145,0.22214125470301233,2.2780883088191528,0.1855548280734943,0.17279753464594644,0.25268903190191772,0.012115969170641509,0.058075847903202443,0.062841931314932958,0.99625864656222152,-0.039523336265231045,0.040566602881401653,0.075740204630040664],"Pressure":[14858.591530599135],"DVL":[0.039499373936847021,-0.25488553694373622,-0.24648227509694506,8.2803197370292914,-0.0080839686162940232,-0.0048982843975450482,-0.0025755277954408614,0],"IMU":[0.03165278455919409,0.11444400631052688,0.1278023033364393,-0.063291435579215544,0.013988623091536423,0.016987218594900488,1.1430922065865217,-0.29398833933234531,-9.6965112082678111],"FOG":[0.12468075839484975],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-94.475007715622553,105,0,105,105],"omega_rad_s":[-98.311702115907551,105.96805384681346,0.45196445332813889,105.78253352871064,105.7791411709169],"thrust_n":[-116.49654966730174,134.37158976452849,-0.027682132052207636,129.90821611169724,132.03066500935518],"torque_nm":[2.1843103062619083,-2.5194673080849088,0.00051903997597889308,-2.4357790520943237,-2.4755749689254092],"angle_rad":[-229.04041371789691,165.0967396527243,-133.83371729489818,529.55550984830779,529.55446203632084]},"command":[-0.89976197824402426,1,0,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,-1.6269385334386973e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[3.7870795383979345,-2.7143620873005232,0.079238283442691418,0.0010160555200370643,0.0017688308801363031,-0.0062714497058604657]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":181,"step":1448,"t":7.2400000000000002,"sim_time":7.2399999999998679,"vehicle":{"origin_ned":[0.27658243012718142,0.22979871955569428,2.2875240865650697],"origin_quat_xyzw":[0.01134976967404607,0.058823086210084634,0.064402635848477996,0.99612415278058353],"cg_ned":[0.19128320833564808,0.22802519030270491,1.995262510426562],"linear_velocity_ned":[0.18212881339220263,0.17448909627578219,0.23946355217371323],"angular_velocity_ned":[-0.036527730966301797,0.034488362683237295,0.0807286190837391]},"sensors":{"Odom":[0.27658243012718142,0.22979871955569428,2.2875240865650697,0.18667581705596822,0.17315977148594824,0.25466115831127495,0.011349769674046125,0.058823086210084932,0.064402635848478329,0.99612415278058353,-0.040843403993640011,0.04126839564113835,0.075296534453474465],"Pressure":[14942.218694273126],"DVL":[0.046438276755964417,-0.2054759030585723,-0.31121881628079873,8.3365387412864624,0.0020673101760224472,-0.0022756263164008736,0.013870509491460622,0],"IMU":[0.030397173814562587,0.11598817858704852,0.13089169644301843,-0.051826185612346809,0.035243996294162187,0.19834850906636603,1.1626491551078542,-0.27591324410138812,-9.692171106523876],"FOG":[0.14806971395535423],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-93.049263960147996,105,0,105,105],"omega_rad_s":[-96.830608971587381,105.94798978019413,0.44250970914883392,105.7664914932367,105.7630744607156],"thrust_n":[-112.91585932843978,134.28392895338396,-0.027348648207008497,129.75569336208562,131.91526727032632],"torque_nm":[2.1171723624082452,-2.51782366787595,0.00051278715388140925,-2.4329192505391055,-2.4734112613186183],"angle_rad":[-232.93912482095092,169.33500899368701,-133.81585210448856,533.78644916844212,533.78526507640595]},"command":[-0.88618346628712374,1,0,1,1],"arm":{"servo_position":[4.8862551400242407e-21,-1.0842021724855039e-21,-3.3616620094155045e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,1.7347234759768071e-18,0,0,0,0],"servo_effort":[3.7508511978113059,-2.7269340792478913,0.079360278069071005,0.0010152833210986985,0.0017750075934475471,-0.0063270474754613835]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":182,"step":1456,"t":7.2800000000000002,"sim_time":7.279999999999867,"vehicle":{"origin_ned":[0.28428671368372216,0.23750935652492733,2.29701039713889],"origin_quat_xyzw":[0.010556862916144256,0.059581605876283132,0.065956284157544759,0.99598612112152551],"cg_ned":[0.1985881958234948,0.23502441372415003,2.0048708403735418],"linear_velocity_ned":[0.1830087521231121,0.17534259261358465,0.24077829270156995],"angular_velocity_ned":[-0.037868755048516139,0.034944824251039834,0.08048308189890821]},"sensors":{"Odom":[0.28428671368372216,0.23750935652492733,2.29701039713889,0.18772851413191086,0.17332800253705058,0.25658028556411022,0.010556862916144334,0.059581605876283569,0.065956284157545245,0.99598612112152551,-0.042075342081479783,0.041885713309623068,0.074886330074837207],"Pressure":[15027.421759414183],"DVL":[0.060319270972699068,-0.23401691941282157,-0.30903106076549103,8.3529321179606963,-0.0032671777155557045,-0.0039847180556956806,-0.022615482869860048,0],"IMU":[0.029093435690038635,0.11756294219939094,0.1339633333830319,-0.10137971249715824,0.094432195182814704,0.13376118551956814,1.1507836889533234,-0.26936828268234569,-9.7009596407015248],"FOG":[0.1287184012256416],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-91.651350675605229,105,0,105,105],"omega_rad_s":[-95.349269405614237,105.92833951593235,0.43325278439963899,105.75077382423424,105.74734129437928],"thrust_n":[-109.39732414727101,134.19869772655983,-0.027007192660842134,129.60867536823139,131.80094559010175],"torque_nm":[2.0511998277613319,-2.5162255823729969,0.0005063848623907901,-2.4301626631543387,-2.4712677298144081],"angle_rad":[-236.77855581378867,173.57248510974981,-133.79836063917872,538.01675412734278,538.01543297536216]},"command":[-0.87287000643433554,1,0,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,-1.6269385334386973e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[-8.6736173798840355e-19,0,3.4694469519536142e-18,0,0,0],"servo_effort":[3.7136632152900284,-2.7405255998231777,0.078963232209252041,0.0010151110910159842,0.0017796834359965173,-0.0063772567459213815]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":183,"step":1464,"t":7.3200000000000003,"sim_time":7.3199999999998662,"vehicle":{"origin_ned":[0.29202817510130952,0.24526618437478839,2.3065444892722082],"origin_quat_xyzw":[0.0097392423080592226,0.060349790654886083,0.06750344190103949,0.99584453367917281],"cg_ned":[0.20592798948816357,0.24205456608846906,2.0145301487397922],"linear_velocity_ned":[0.18387158415129806,0.17605448436119583,0.24202177429658472],"angular_velocity_ned":[-0.039100179952409567,0.035325850377429587,0.080260314798743737]},"sensors":{"Odom":[0.29202817510130952,0.24526618437478839,2.3065444892722082,0.18871615389526478,0.17330860296143949,0.25844760364969183,0.0097392423080593284,0.060349790654886742,0.067503441901040226,0.99584453367917281,-0.043209688315027583,0.042418888470913789,0.074511869157894206],"Pressure":[15111.554503342715],"DVL":[0.049348642539062945,-0.22817897335898987,-0.29634826706327649,8.3016703570005461,0.00031866708043914522,0.01328722208863004,0.0036072135882240994,0],"IMU":[0.027745477973719436,0.11916498294802406,0.13701838109739858,-0.062914116684520613,0.062260319684364421,0.2020431241035186,1.185495173509765,-0.27739582612868346,-9.740188360259415],"FOG":[0.14590800265379633],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-90.28178697556001,105,0,105,105],"omega_rad_s":[-93.877827545649964,105.90909483762097,0.42418953848450847,105.73537390417714,105.73193486604583],"thrust_n":[-105.96384304363121,134.1156969642127,-0.026658948493931356,129.4670773110106,131.68763239870262],"torque_nm":[1.9868220570680857,-2.514669318078989,0.00049985528426121299,-2.4275076995814486,-2.4691431074756744],"angle_rad":[-240.55893765368637,177.80918436763079,-133.78123507964185,542.24643755031752,542.24497892138925]},"command":[-0.85982654262438107,1,0,1,1],"arm":{"servo_position":[4.8862551400242407e-21,-1.0842021724855039e-21,-3.3616620094155045e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[8.6736173798840355e-19,0,-3.4694469519536142e-18,0,0,0],"servo_effort":[3.6757218201522432,-2.7550870688917133,0.078062937320050582,0.0010154132749489375,0.0017828972331045271,-0.0064221169117380577]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":184,"step":1472,"t":7.3600000000000003,"sim_time":7.3599999999998653,"vehicle":{"origin_ned":[0.29980527173890004,0.25306245322633281,2.3161237398916064],"origin_quat_xyzw":[0.0088990929034741904,0.061126053368422265,0.069044703738745605,0.99569937261742059],"cg_ned":[0.21330195616991054,0.24911017931785864,2.0242376534507804],"linear_velocity_ned":[0.18471954267441135,0.17663353925257674,0.24319702934441234],"angular_velocity_ned":[-0.040212487766545339,0.035634030810724582,0.080061006383215325]},"sensors":{"Odom":[0.29980527173890004,0.25306245322633281,2.3161237398916064,0.18964196154378471,0.17310865705927411,0.26026418053619194,0.008899092903474199,0.06112605336842232,0.069044703738745661,0.99569937261742059,-0.044237450261308875,0.042868525176198748,0.074174999904842012],"Pressure":[15198.054660076465],"DVL":[0.045601705199163803,-0.19916323658316964,-0.30080799174596795,8.3322497790264354,0.021987186380758958,0.012305848965564272,0.014743100070643861,0],"IMU":[0.026357583466724309,0.12079099408262754,0.14005810482181813,-0.042231301405038349,0.07718938355940988,-0.033052537404164736,1.1886166106092568,-0.25670685604685578,-9.6823701812138925],"FOG":[0.13678983011597334],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-88.940837833421483,105,0,105,105],"omega_rad_s":[-92.423240357869886,105.89024768125994,0.41531591738315088,105.72028525337447,105.71684849533936],"thrust_n":[-102.62950864981202,134.03473878794799,-0.026305027454131047,129.33081396196567,131.57527393172415],"torque_nm":[1.9243032871839754,-2.5131513522740248,0.00049321926476495717,-2.4249527617868569,-2.4670363862198283],"angle_rad":[-244.28083152152718,182.04512280883489,-133.76446777022122,546.47551200108262,546.4739158332975]},"command":[-0.84705559841353795,1,0,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,-1.6269385334386973e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[-8.6736173798840355e-19,0,0,0,0,0],"servo_effort":[3.6372006761131823,-2.7705605684840058,0.076678981296749923,0.0010156875258142254,0.0017846918933544444,-0.0064618885165933998]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":185,"step":1480,"t":7.4000000000000004,"sim_time":7.3999999999998645,"vehicle":{"origin_ned":[0.30761657960387323,0.26089166386656337,2.3257456530434379],"origin_quat_xyzw":[0.0080387771602207347,0.061908841516113283,0.070580686656548361,0.99555062155321417],"cg_ned":[0.22070954569825491,0.25618613984268312,2.0339906924470403],"linear_velocity_ned":[0.18555458382083942,0.17708865116308281,0.2443070281706147],"angular_velocity_ned":[-0.04119704404697179,0.035872212035074839,0.079885571436853806]},"sensors":{"Odom":[0.30761657960387323,0.26089166386656337,2.3257456530434379,0.19050913152767604,0.17273569865583613,0.2620309580124725,0.0080387771602208093,0.061908841516113859,0.070580686656549013,0.99555062155321417,-0.045150434605656806,0.043235503387115785,0.073877236413344427],"Pressure":[15284.035252975547],"DVL":[0.034674244749121494,-0.24271518649740578,-0.28190906546543398,8.3427728565638954,-0.018793927140088099,0.0049780895286174413,-0.023295041538569063,0],"IMU":[0.024934382724158658,0.12243768756926086,0.14308385571436752,-0.032620453714303867,-0.068329957674512387,0.2390588294875631,1.2081109695788883,-0.24403154520492845,-9.7350169412379071],"FOG":[0.14612612828715349],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-87.628565464762218,105,0,105,105],"omega_rad_s":[-90.990235672970613,105.87179013142917,0.40662795190205819,105.70550152767925,105.70207562162112],"thrust_n":[-99.402405082868043,133.95564628385017,-0.025946464659116337,129.19979953835988,131.46383020425452],"torque_nm":[1.8637950953037763,-2.5116683678221907,0.00048649621235843146,-2.4224962413442483,-2.4649468163297725],"angle_rad":[-247.94502406667362,186.28031615566198,-133.74805121550665,550.70398978722403,550.70225636539385]},"command":[-0.83455776633106871,1,0,1,1],"arm":{"servo_position":[-3.7873622398597949e-21,-1.0842021724855039e-21,-1.6269385334386973e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[-8.6736173798840355e-19,0,3.4694469519536142e-18,0,0,0],"servo_effort":[3.5982285732745494,-2.7868904053517247,0.074830889619605878,0.0010161745570834403,0.0017851196942668959,-0.0064965950828507132]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":186,"step":1488,"t":7.4400000000000004,"sim_time":7.4399999999998636,"vehicle":{"origin_ned":[0.31546078633975089,0.26874757872941862,2.3354078577800506],"origin_quat_xyzw":[0.0071608159687148601,0.062696642890863699,0.072112023809526915,0.9953982668796304],"cg_ned":[0.22815028070905094,0.26327768843809157,2.0437867209639249],"linear_velocity_ned":[0.18637842671292987,0.17742862876448953,0.24535467777049533],"angular_velocity_ned":[-0.04204629781894028,0.036043489487720175,0.079734159585749087]},"sensors":{"Odom":[0.31546078633975089,0.26874757872941862,2.3354078577800506,0.19132083809705772,0.17219754962512954,0.26374877452557532,0.0071608159687148697,0.062696642890863769,0.072112023809527012,0.9953982668796304,-0.045941439689544686,0.04352101192663424,0.073619740149703142],"Pressure":[15370.31543177851],"DVL":[0.037602590464316403,-0.26575608449991073,-0.32636859145729191,8.2625345598715008,0.039298754579332677,-0.041826363601009602,0.003990865767528072,0],"IMU":[0.023480817371176948,0.12410180626150624,0.14609705866547992,0.0047409150182675455,0.059105287611324511,0.080474374109512914,1.2363254605790579,-0.22232694117497026,-9.6980228847293546],"FOG":[0.15864318526587626],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-86.344873368908111,105,0,105,105],"omega_rad_s":[-89.581976097977417,105.85371441756661,0.39812175594257199,105.69101651627457,105.68760979903686],"thrust_n":[-96.286526307624328,133.87825387922902,-0.025584222435789256,129.07394619576237,131.35327509533423],"torque_nm":[1.8053723682679559,-2.5102172602355441,0.00047970417067104865,-2.4201364911705454,-2.4628739080375168],"angle_rad":[-251.55245398788085,190.51477981706637,-133.73197807698037,554.93188296556741,554.9300129121566]},"command":[-0.82233212732293437,1,0,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,-1.6269385334386973e-20,0,-7.5301229010907305e-20,1.3386508698406964e-19],"servo_velocity":[0,0,3.4694469519536142e-18,0,0,2.7755575615628914e-17],"servo_effort":[3.5589078511094807,-2.8039984872652433,0.072544507125508167,0.0010167266518188963,0.0017842446942226181,-0.0065263390749454985]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":187,"step":1496,"t":7.4800000000000004,"sim_time":7.4799999999998628,"vehicle":{"origin_ned":[0.32333668505024882,0.27662422814324605,2.3451081060654411],"origin_quat_xyzw":[0.0062678659469641755,0.063487990900840591,0.073639358672032376,0.99524229900171413],"cg_ned":[0.23562374772069256,0.27038041310655908,2.0536233089832843],"linear_velocity_ned":[0.18719257639002174,0.17766203024547556,0.24634280918478832],"angular_velocity_ned":[-0.04275392159636475,0.036151155773165147,0.079606695528173427]},"sensors":{"Odom":[0.32333668505024882,0.27662422814324605,2.3451081060654411,0.19208021901642405,0.17150219069613562,0.26541837532404672,0.0062678659469642085,0.063487990900840924,0.073639358672032765,0.99524229900171413,-0.046604398921482389,0.043726532952183282,0.073403338927245196],"Pressure":[15457.3716348827],"DVL":[0.026099551535010593,-0.21476691921878274,-0.26227721560095291,8.346056441071827,0.031255164501179149,-0.0052125704937631195,0.0088416218672460935,0],"IMU":[0.02200209591707707,0.12578013630480481,0.1490991998991828,-0.019365094628680569,0.071833331507660692,-0.13751716309460288,1.2336753741784585,-0.21347075859368259,-9.7053529610943361],"FOG":[0.14480189752345241],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-85.089525127566574,105,0,105,105],"omega_rad_s":[-88.200516322884141,105.83601291037246,0.38979352478928475,105.67682414042881,105.6734446930771],"thrust_n":[-93.28308431279082,133.80240756139344,-0.025219191992233457,128.9531634249943,131.24359523385851],"torque_nm":[1.7490578308648279,-2.5087951417761278,0.00047285984985437736,-2.4178718142186435,-2.4608174106348466],"angle_rad":[-255.10416027956686,194.74852889437,-133.71624116973186,559.15920334748228,559.15719761274408]},"command":[-0.81037642978634838,1,0,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,1.0778494253810979e-21,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[3.519316367937027,-2.8218065551152463,0.069845588647248977,0.0010175931173464572,0.0017821262528188242,-0.0065513431224328168]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":188,"step":1504,"t":7.5200000000000005,"sim_time":7.5199999999998619,"vehicle":{"origin_ned":[0.33124316858608788,0.28451591209210186,2.3548442696188858],"origin_quat_xyzw":[0.0053626954075654603,0.064281469419205789,0.075163339821923192,0.99508271341335608],"cg_ned":[0.24312958911736637,0.27749023664622441,2.0634981377946318],"linear_velocity_ned":[0.18799834847262115,0.1777970713097036,0.24727417202774615],"angular_velocity_ned":[-0.043314859370867986,0.036198677276426061,0.079502890012065147]},"sensors":{"Odom":[0.33124316858608788,0.28451591209210186,2.3548442696188858,0.19279037359498441,0.17065767302836946,0.26704042670173334,0.0053626954075654976,0.064281469419206247,0.075163339821923719,0.99508271341335608,-0.047134426442398472,0.043853842391413676,0.073228526890868312],"Pressure":[15543.877676736223],"DVL":[0.050312985287943014,-0.21777264922310685,-0.28004262449962847,8.2381370131429179,0.028386704966180277,-0.0071244691278783447,-0.0012943150061300213,0],"IMU":[0.020503646891838239,0.12746951911007262,0.15209181526213697,-0.025101581160407949,-0.053900146850400434,0.090860858000130482,1.2622911505393197,-0.20073521465529034,-9.6992975587661956],"FOG":[0.13523564261714219],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-83.86217333440031,105,0,105,105],"omega_rad_s":[-86.847121840622137,105.81867811847674,0.38163953342487766,105.6629184515504,105.65957407774607],"thrust_n":[-90.391408191056371,133.72796488051785,-0.024852196245286888,128.83735780029681,131.13478955920138],"torque_nm":[1.6948389035823073,-2.5073993415097102,0.00046597867959912923,-2.4157004587555662,-2.4587773042350261],"angle_rad":[-258.60124546704884,198.98157818683691,-133.70083345924053,563.38596250412309,563.3838223553845]},"command":[-0.79868736508952676,1,0,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,1.0778494253810979e-21,0,-7.5301229010907305e-20,1.3386508698406964e-19],"servo_velocity":[-8.6736173798840355e-19,0,3.4694469519536142e-18,0,0,2.7755575615628914e-17],"servo_effort":[3.4795244747075778,-2.8402410942485337,0.066758918226262481,0.0010184235371153145,0.0017788237848770569,-0.0065717866257858377]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":189,"step":1512,"t":7.5600000000000005,"sim_time":7.5599999999998611,"vehicle":{"origin_ned":[0.33917922417512086,0.29241720022801382,2.3646143369761505],"origin_quat_xyzw":[0.0044481591726003309,0.065075716912754947,0.076684616037813347,0.99491951162463343],"cg_ned":[0.25066749606065253,0.28460340180724086,2.0734089969295657],"linear_velocity_ned":[0.1887968911160828,0.17784157445468693,0.24815143734442197],"angular_velocity_ned":[-0.043725359651948792,0.036189608652156716,0.079422313536633579]},"sensors":{"Odom":[0.33917922417512086,0.29241720022801382,2.3646143369761505,0.1934543437882392,0.16967207395705039,0.26861553953189871,0.0044481591726003803,0.065075716912755668,0.076684616037814193,0.99491951162463343,-0.047527865753616436,0.043904948534877093,0.073095527973029012],"Pressure":[15630.783308859945],"DVL":[0.018358641365888606,-0.23994930719882551,-0.32313866577495887,8.291478053509179,-0.027992747137470832,-0.0024010947578525709,-0.043892927822513056,0],"IMU":[0.018991069563444183,0.12916686239424932,0.15507647853784018,-0.049805830006772217,0.10931467827826147,0.070755636404852038,1.2903931799269712,-0.20138435951776151,-9.7200037630020137],"FOG":[0.14391159317604979],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-82.662367314315347,105,0,105,105],"omega_rad_s":[-85.522488792586714,105.80170268527006,0.3736561348721798,105.64929362963298,105.64599183392787],"thrust_n":[-87.609556338005518,133.65479426307724,-0.02448399232236681,128.72643290223851,131.02686671304625],"torque_nm":[1.6426791813376034,-2.5060273924326988,0.00045907485604437771,-2.4136206169169721,-2.4567537508696171],"angle_rad":[-262.0448492596463,203.2139421971174,-133.68574805822519,567.61217177160029,567.60989878167322]},"command":[-0.78726064108871763,1,0,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,-1.6269385334386973e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,-3.4694469519536142e-18,0,0,0],"servo_effort":[3.439602665306257,-2.859225029550327,0.063312894136405978,0.0010194510913039509,0.0017744163520216612,-0.0065876849162807265]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":190,"step":1520,"t":7.6000000000000005,"sim_time":7.5999999999998602,"vehicle":{"origin_ned":[0.34714392809238936,0.30032293007877525,2.3744164103519849],"origin_quat_xyzw":[0.0035271735163717463,0.065869429292138598,0.078203832878823862,0.99475270185849418],"cg_ned":[0.25823720231503711,0.29171645460651419,2.0833537809700715],"linear_velocity_ned":[0.18958920512896138,0.17780293087069063,0.24897719514079714],"angular_velocity_ned":[-0.043982936219034922,0.036127555381468814,0.079364430914115408]},"sensors":{"Odom":[0.34714392809238936,0.30032293007877525,2.3744164103519849,0.19407510735899375,0.16855343809917472,0.27014428346643427,0.0035271735163717689,0.065869429292139015,0.078203832878824361,0.99475270185849418,-0.047782256538604219,0.04388206646580519,0.073004328867402518],"Pressure":[15717.913365619164],"DVL":[0.030938208077840392,-0.24116890716172212,-0.27492596857903262,8.171128767987808,-0.0039821158165436249,0.012220474518849644,0.035329813870632221,0],"IMU":[0.017470084848842021,0.13086914896429883,0.1580547922741338,0.061137468699358953,0.14776221339151516,0.034743954495475127,1.3102238146299703,-0.17876960700101277,-9.7290982762270861],"FOG":[0.17343460830905971],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-81.489564683473546,105,0,105,105],"omega_rad_s":[-84.226896153259958,105.78507938669213,0.36583975856687284,105.63594398095198,105.63269194918816],"thrust_n":[-84.934735230531345,133.58277416877144,-0.024115274004069109,128.62028955772038,130.91984334724233],"torque_nm":[1.5925262855724627,-2.5046770156644653,0.00045216138757629584,-2.411630429207257,-2.4547470627607941],"angle_rad":[-265.43612938149596,207.44563513658653,-133.67097822355916,571.83784225607269,571.83543829084135]},"command":[-0.77609109222355754,1,0,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,-1.6269385334386973e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[8.6736173798840355e-19,0,0,0,0,0],"servo_effort":[3.3996243339368597,-2.8786962640093359,0.059532180483163298,0.0010200701834970156,0.0017689637287032864,-0.006599388535396552]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":191,"step":1528,"t":7.6400000000000006,"sim_time":7.6399999999998593,"vehicle":{"origin_ned":[0.35513641184475198,0.30822819705335414,2.3842487060684978],"origin_quat_xyzw":[0.0026026958286654587,0.066661369758056782,0.079721651287373588,0.99458229728485381],"cg_ned":[0.2658384457927721,0.29882621885197674,2.0933304914512325],"linear_velocity_ned":[0.19037427722194691,0.1776876348622933,0.24975425443099891],"angular_velocity_ned":[-0.044085774541471265,0.036017067114299625,0.079331115682586148]},"sensors":{"Odom":[0.35513641184475198,0.30822819705335414,2.3842487060684978,0.19465388204681372,0.16730961215825804,0.2716272034000406,0.0026026958286654782,0.066661369758057282,0.079721651287374184,0.99458229728485381,-0.047895938990990712,0.043788464614080577,0.072957247417881496],"Pressure":[15806.735791296744],"DVL":[0.028461366004017878,-0.23022554893548025,-0.28057114493960716,8.1787521522606497,-0.023370216711762887,0.019642213841967605,-0.057911058476796652,0],"IMU":[0.015946499737922271,0.13257345870781045,0.16102842353909619,0.054868478287543522,0.020831191898268084,0.19110928018199386,1.3002902957441336,-0.14747967653392449,-9.6537620154642543],"FOG":[0.17128280518100739],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-80.343150791230599,105,6.3467776565465224,105,105],"omega_rad_s":[-82.960314338036412,105.76880111944408,2.1622150919492986,105.62286393879373,105.61966851430428],"thrust_n":[-82.363593048253662,133.51184419279221,-0.093559307836429545,128.51880832955112,130.8137618045277],"torque_nm":[1.5443173696547565,-2.5033470786148539,0.0017542370219330542,-2.4097276561790832,-2.4527580338348947],"angle_rad":[-268.77624744018061,211.67667093048448,-133.6182962209553,576.06298483878106,576.06045204398288]},"command":[-0.76517286467838663,1,0.060445501490919262,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,1.0778494253810979e-21,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[-8.6736173798840355e-19,0,0,0,0,0],"servo_effort":[3.3607420197822888,-2.8983727252616402,0.055400676038484635,0.001021506962330189,0.0017622301953646104,-0.0066067309533299522]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":192,"step":1536,"t":7.6799999999999997,"sim_time":7.6799999999998585,"vehicle":{"origin_ned":[0.36315584870190543,0.31612834779795124,2.3941095521230644],"origin_quat_xyzw":[0.0016777026875713778,0.067450372475462927,0.081238750643906149,0.99440831551251141],"cg_ned":[0.27347095405414129,0.30592977550893674,2.1033372351351809],"linear_velocity_ned":[0.19115399258646759,0.17750242996936855,0.25048485116221414],"angular_velocity_ned":[-0.044034115252734339,0.035861124435617751,0.07932008882117339]},"sensors":{"Odom":[0.36315584870190543,0.31612834779795124,2.3941095521230644,0.19519449404248307,0.16594851659812984,0.27306481421207096,0.0016777026875713949,0.067450372475463621,0.081238750643906982,0.99440831551251141,-0.04786894016910908,0.043626100815810517,0.072952230515398106],"Pressure":[15893.792358128674],"DVL":[0.054533951361215097,-0.21355681691984829,-0.27561225235856718,8.2243877815022604,0.017535055361011381,0.0046380213517881646,-0.009366624829547263,0],"IMU":[0.014426165666794931,0.13427697918995329,0.16399910747912655,-0.024658990104404054,0.029452156150639501,0.086457307472722567,1.3373523799385376,-0.15293272857716561,-9.7021413580258873],"FOG":[0.1781883995744554],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-79.222446600807487,105,9.4200752028332424,105,105],"omega_rad_s":[-81.722485622861001,105.75286087706145,4.5558798221049397,105.610048068588,105.60691571525301],"thrust_n":[-79.892429209089073,133.4418959529244,-0.059173765192988212,128.42188841979572,130.7086473695388],"torque_nm":[1.4979830476704206,-2.5020355491173318,0.0011095080973685303,-2.4079104078711699,-2.4507871381788529],"angle_rad":[-272.06635852577193,215.90706322197164,-133.4777411543912,580.28761018132741,580.28495096791255]},"command":[-0.75449949143626183,1,0.08971500193174517,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,-1.6269385334386973e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[-8.6736173798840355e-19,0,-3.4694469519536142e-18,-1.0842021724855044e-19,0,0],"servo_effort":[3.3202624456351311,-2.9186946650774992,0.051045720667344287,0.0010225153622761773,0.0017550140066098364,-0.0066106409995437473]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":193,"step":1544,"t":7.7199999999999998,"sim_time":7.7199999999998576,"vehicle":{"origin_ned":[0.37120163734639994,0.32401902174323238,2.4039973577769667],"origin_quat_xyzw":[0.00075513752254433822,0.06823529195526444,0.082755679150662467,0.99423079426630834],"cg_ned":[0.28113465716462477,0.31302449647426167,2.1133721850436626],"linear_velocity_ned":[0.19193498293278702,0.17725480583372019,0.25117034124783677],"angular_velocity_ned":[-0.043831075860019414,0.035660283718098852,0.079322567634652646]},"sensors":{"Odom":[0.37120163734639994,0.32401902174323238,2.4039973577769667,0.19570507349382876,0.16447837340984628,0.27445761317782819,0.00075513752254434288,0.068235291955264857,0.082755679150662981,0.99423079426630834,-0.047703585858846709,0.043394929251184558,0.072980386362011415],"Pressure":[15982.683588908509],"DVL":[0.07532392697486151,-0.23726604498988224,-0.30142829756299339,8.2233644995792297,-0.0039060367800355885,0.026682961056724522,0.017002121066577818,0],"IMU":[0.012914845610382791,0.13597691519675617,0.16696833588883039,-0.044756538027669719,0.061769373650010485,0.13891292012518303,1.3483188538455562,-0.14110192182523471,-9.7079508121726032],"FOG":[0.15336759825038634],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-78.126609204620863,105,11.755961045563996,105,105],"omega_rad_s":[-80.512948263571943,105.73725186291091,7.011140669302053,105.59749102467865,105.59442787645486],"thrust_n":[-77.517272731146861,133.37264246811782,0.12680069690103007,128.32949010629534,130.60446173748565],"torque_nm":[1.4534488637090039,-2.5007370462772092,-0.0023775130668943142,-2.4061779394930372,-2.4488336575778558],"angle_rad":[-275.30760273357737,220.13682537827918,-133.23938350976184,584.51172873007476,584.50894575985592]},"command":[-0.74406294480591295,1,0.11196153376727616,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,-3.3616620094155045e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,-6.9388939039072284e-18,0,0,0],"servo_effort":[3.2774826387900835,-2.9396765396622233,0.046537489878241411,0.0010232010081559322,0.0017476401381005984,-0.0066109837243432668]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":194,"step":1552,"t":7.7599999999999998,"sim_time":7.7599999999998568,"vehicle":{"origin_ned":[0.37927346337445328,0.33189616852056741,2.4139106004551696],"origin_quat_xyzw":[-0.00016212694124295664,0.069014990055294614,0.084272804161431319,0.99404979721404874],"cg_ned":[0.28882975716256132,0.32010804761852157,2.1234335656598646],"linear_velocity_ned":[0.19272381122105531,0.17695191047083372,0.25181201883145787],"angular_velocity_ned":[-0.043481210980172547,0.035415202808059223,0.079329891861153051]},"sensors":{"Odom":[0.37927346337445328,0.33189616852056741,2.4139106004551696,0.19619377470200985,0.16290743440193561,0.27580614698756856,-0.00016212694124295756,0.069014990055295017,0.084272804161431805,0.99404979721404874,-0.047403553925370719,0.043095312927357854,0.073032740054567696],"Pressure":[16070.979930502008],"DVL":[0.055246101745920928,-0.23575022143065147,-0.31616981856705539,8.122707100801227,0.011425192874720836,0.023129323850385665,-0.065421078488928752,0],"IMU":[0.011418128736642594,0.13767046928448431,0.1699372502026939,-0.036693914962549153,0.015233733340562924,-0.050879710786280591,1.3714245402803165,-0.10375889815120026,-9.6731093113822055],"FOG":[0.17208837089782431],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-77.054708723823893,105,13.727322547991722,105,105],"omega_rad_s":[-79.331065568852978,105.72196752150643,9.3635569677214185,105.58518754030321,105.58219947025744],"thrust_n":[-75.233965179211964,133.30379296437113,0.44803183519936701,128.24156606439087,130.50117138019664],"torque_nm":[1.4106368471102244,-2.4994461180819587,-0.0084005969099881332,-2.4045293637073284,-2.4468969633786872],"angle_rad":[-278.50109759105914,224.36597050032418,-132.90493394502209,588.73535071928211,588.73244689339913]},"command":[-0.73385436879832278,1,0.13073640521896879,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,-1.6269385334386973e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[-8.6736173798840355e-19,0,0,0,0,0],"servo_effort":[3.2327377105821542,-2.9611399598729249,0.041914941749180389,0.0010235715627197055,0.001740149063538463,-0.0066084710264858511]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":195,"step":1560,"t":7.7999999999999998,"sim_time":7.7999999999998559,"vehicle":{"origin_ned":[0.38737126660033427,0.33975604229926443,2.4238478262369125],"origin_quat_xyzw":[-0.0010713106749395947,0.069788349953942536,0.085790337624296248,0.99386541165011522],"cg_ned":[0.29655668836759375,0.32717836616267937,2.1335196567895962],"linear_velocity_ned":[0.19352562194781084,0.17660022834706041,0.25241134824753181],"angular_velocity_ned":[-0.042989955234218273,0.035127304494196807,0.079335301964470417]},"sensors":{"Odom":[0.38737126660033427,0.33975604229926443,2.4238478262369125,0.19666754439542422,0.16124384320936563,0.27711102955429834,-0.0010713106749395988,0.069788349953942799,0.085790337624296581,0.99386541165011522,-0.046973459290069582,0.042728619350250248,0.073102073298966105],"Pressure":[16160.452823206997],"DVL":[0.075409505618787009,-0.27207777655810766,-0.31618876147191632,8.1218864379767393,0.0083180374222242993,0.0042063514370063821,0.009133184150182912,0],"IMU":[0.0099413908246047695,0.13935487294376064,0.17290668881109117,-0.034041589220968518,-0.010245789672290444,-0.023817605658302668,1.3815914484805336,-0.097180302731127849,-9.671915369751531],"FOG":[0.1584503275867582],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-76.00578977798007,105,15.467356005074461,105,105],"omega_rad_s":[-78.176070991952315,105.70700148351366,11.558783882677712,105.57313244898965,105.57022509390919],"thrust_n":[-73.038267778116278,133.2351081811959,0.87387524704781494,128.15804159785515,130.39876694708383],"torque_nm":[1.3694675208396803,-2.498158278397423,-0.016385160882146536,-2.4029632799597849,-2.4449768802578218],"angle_rad":[-281.64793208916245,228.59451143119685,-132.47990798980931,592.95848617471984,592.95546462391451]},"command":[-0.72386466455219112,1,0.14730815242928058,1,1],"arm":{"servo_position":[4.8862551400242407e-21,-1.0842021724855039e-21,1.0778494253810979e-21,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[8.6736173798840355e-19,0,0,0,0,0],"servo_effort":[3.1865758192882758,-2.9828790961995812,0.037206623874877498,0.0010232325994487474,0.0017325365902183434,-0.0066032974718534601]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":196,"step":1568,"t":7.8399999999999999,"sim_time":7.8399999999998551,"vehicle":{"origin_ned":[0.39549518841954534,0.34759518915795229,2.4338076526359465],"origin_quat_xyzw":[-0.0019697420074604064,0.070554293880775859,0.087308375523833595,0.99367774418812371],"cg_ned":[0.30431605585064236,0.33423363255262778,2.1436288006837718],"linear_velocity_ned":[0.19434402050470775,0.17620552547753754,0.25296995925324273],"angular_velocity_ned":[-0.04236341004823193,0.034798766131626191,0.079334075129508505]},"sensors":{"Odom":[0.39549518841954534,0.34759518915795229,2.4338076526359465,0.19713197422145434,0.15949555075490054,0.27837291709575662,-0.0019697420074604208,0.070554293880776386,0.087308375523834234,0.99367774418812371,-0.046418668104112146,0.042297172528525891,0.073183089299271531],"Pressure":[16249.211561544296],"DVL":[0.023283923405199251,-0.21499529316377622,-0.30886284042371787,8.1681190471645095,0.01333040784826226,0.0070603146132445643,-0.0041081169178686407,0],"IMU":[0.0084897705153320867,0.1410274246344291,0.17587726337625209,-0.066983356223821539,0.0083072247396736715,0.090752714503060522,1.4289358386998234,-0.087857231207957229,-9.7150773312280538],"FOG":[0.17428728047404499],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-74.978886234375864,105,17.042351011398026,105,105],"omega_rad_s":[-77.047105890489973,105.69234751013435,13.586457634094508,105.5613207031566,105.55849944810844],"thrust_n":[-70.925945239295615,133.1664073920382,1.3751287580946674,128.07881572211488,130.2972639786671],"torque_nm":[1.329861473236793,-2.4968701386007162,-0.025783664214275012,-2.4014777947896544,-2.4430736996000082],"angle_rad":[-284.74916237271049,232.82246076230496,-131.97089775101239,597.18114491812935,597.17800899304996]},"command":[-0.71408463080357965,1,0.16230810487045738,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,-3.3616620094155045e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,-6.9388939039072284e-18,0,0,0],"servo_effort":[3.1395324140790741,-3.0047033252757553,0.032438176486916312,0.0010222712844178143,0.0017247999942465396,-0.0065955090117351487]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":197,"step":1576,"t":7.8799999999999999,"sim_time":7.8799999999998542,"vehicle":{"origin_ned":[0.40364552216952998,0.35541043278390433,2.4437887702231809],"origin_quat_xyzw":[-0.0028548708526052358,0.071311797947412228,0.088826934139591834,0.99348691634932107],"cg_ned":[0.31210857873993875,0.34127224255625066,2.1537594077512554],"linear_velocity_ned":[0.19518131940472316,0.17577289881292421,0.25348960898690859],"angular_velocity_ned":[-0.041608235790866858,0.034432328952313268,0.079323198565058886]},"sensors":{"Odom":[0.40364552216952998,0.35541043278390433,2.4437887702231809,0.19759148368518339,0.15767027033948727,0.27959250821250303,-0.0028548708526052505,0.071311797947412589,0.088826934139592292,0.99348691634932107,-0.045745182635414425,0.041804037976774719,0.073272102930033362],"Pressure":[16340.697827042313],"DVL":[0.026735380633381777,-0.24408242429993895,-0.3483459865640266,8.1372557024515935,-0.0024464590287645318,-0.010681764270956792,0.01551797550653373,0],"IMU":[0.0070681501388460809,0.14268552224081105,0.1788494287538423,-0.082714762116476728,-0.065749174063813434,0.10216490120641537,1.4100644449211397,-0.075976975063599086,-9.69191034752318],"FOG":[0.16220675616686406],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-73.973026145756421,105,18.491445435272119,105,105],"omega_rad_s":[-75.943247650006526,105.677999456249,15.454611127966229,105.54974738312562,105.547017323491],"thrust_n":[-68.892823962005878,133.09756045720067,1.9284342695915035,128.0037665891621,130.19669757870651],"torque_nm":[1.2917404492876106,-2.4955792585725129,-0.036158142554840698,-2.4000706235467897,-2.4411880796007472],"angle_rad":[-287.80580872391175,237.04983083770057,-131.38445007533258,601.40333657221117,601.40008983253449]},"command":[-0.70450501091196593,1,0.17610900414544875,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,1.0778494253810979e-21,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,0,0,0,-2.7755575615628914e-17],"servo_effort":[3.0920310888979707,-3.0264571173068444,0.027629240751637918,0.0010210661973058593,0.001716921009506913,-0.0065854395538133036]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":198,"step":1584,"t":7.9199999999999999,"sim_time":7.9199999999998534,"vehicle":{"origin_ned":[0.41182267354395152,0.36319886114405153,2.4537899434280455],"origin_quat_xyzw":[-0.0037242800832146638,0.072059902945132606,0.090345978027130028,0.99329306067228773],"cg_ned":[0.31993504594336514,0.34829278269348268,2.1639099609346375],"linear_velocity_ned":[0.1960388661255214,0.17530687452347851,0.25397215354916602],"angular_velocity_ned":[-0.040731627389714913,0.03403113900136865,0.079300907510355789]},"sensors":{"Odom":[0.41182267354395152,0.36319886114405153,2.4537899434280455,0.19804960377867639,0.1557754755834459,0.28077056381019372,-0.0037242800832146786,0.072059902945132884,0.090345978027130375,0.99329306067228773,-0.044959582701727049,0.041252854290872366,0.073366584762095052],"Pressure":[16429.931896662645],"DVL":[0.070962046137010529,-0.23852445172050984,-0.31332036219066012,8.0758357751482528,-0.049676901768413113,0.0062399517664447025,0.017969179715468218,0],"IMU":[0.0056811389043435294,0.14432668773903387,0.18182353615678459,0.012138382701224998,-0.0023243325598703152,0.054729913224157725,1.426183382818706,-0.073958078534502009,-9.6904250829965566],"FOG":[0.20141584337087831],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-72.987230775140105,105,19.840290385400134,105,105],"omega_rad_s":[-74.863528791100435,105.66395125178903,17.17834832009439,105.5384076990261,105.53577359515903],"thrust_n":[-66.934827456319113,133.02847674601688,2.51656128007233,127.93275529098311,130.09711639293346],"torque_nm":[1.2550280148059838,-2.4942839389878171,-0.047185524001356186,-2.3987391617059335,-2.4393209323675027],"angle_rad":[-290.81885346176904,241.27663375735699,-130.7266106807273,605.62507056579989,605.62171676763217]},"command":[-0.6951164835727629,1,0.18895514652762033,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,1.0778494253810979e-21,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,3.4694469519536142e-18,0,0,0],"servo_effort":[3.0443853175288806,-3.0479930778918387,0.022806641596882435,0.0010191472998617348,0.001708920031392057,-0.0065733693800860294]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":199,"step":1592,"t":7.96,"sim_time":7.9599999999998525,"vehicle":{"origin_ned":[0.42002713168118627,0.37095781484554757,2.4638100106760676],"origin_quat_xyzw":[-0.004575696025083174,0.072797722160642606,0.091865439747254085,0.99309631740035742],"cg_ned":[0.32779628427688667,0.35529400912648795,2.174079019049874],"linear_velocity_ned":[0.19691733050078461,0.17481148046419437,0.25441950919605183],"angular_velocity_ned":[-0.03974123163225346,0.033598560068087119,0.079266335673224372]},"sensors":{"Odom":[0.42002713168118627,0.37095781484554757,2.4638100106760676,0.1985092076322103,0.15381837284737937,0.28190791408801164,-0.0045756960250831914,0.072797722160642883,0.091865439747254432,0.99309631740035742,-0.044068930185625611,0.040647630628918165,0.073464822996499868],"Pressure":[16519.237594096601],"DVL":[0.035175489661279105,-0.23966436355780835,-0.2959381833506402,8.0906591631802272,0.024573761255766019,-0.00081351087512586851,-0.0045833260268441332,0],"IMU":[0.0043330565246059351,0.14594858623245993,0.18479986954652716,-0.075776615810084991,0.013473426732459902,0.047825096977985967,1.4570164204810692,-0.041705417936174348,-9.7082711503490433],"FOG":[0.19795426385875708],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-72.020508619539271,105,21.106870928245431,105,105],"omega_rad_s":[-73.806947651870928,105.65019689552258,18.774588356053748,105.52729698949189,105.52476322174209],"thrust_n":[-65.047993564644401,132.95909475321699,3.1273790260501939,127.86562983801328,129.99857703227843],"torque_nm":[1.2196498793370825,-2.4929830266228188,-0.058638356738441123,-2.3974805594627489,-2.4374733193552203],"angle_rad":[-293.78923940246847,245.50288137999831,-130.0027711078539,609.84635613903754,609.84289922048708]},"command":[-0.68590960590037398,1,0.20101781836424221,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,-1.6269385334386973e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[2.9968462569925745,-3.069213741092669,0.017991043627673189,0.0010167765819285948,0.0017008303487207957,-0.0065592893778007528]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":200,"step":1600,"t":8,"sim_time":7.9999999999998517,"vehicle":{"origin_ned":[0.4282594472665629,0.37868487597494588,2.473847882700785],"origin_quat_xyzw":[-0.005406997332992206,0.073524444844614512,0.093385233677931043,0.99289683176100951],"cg_ned":[0.33569313607739149,0.36227482901042601,2.1842652176072597],"linear_velocity_ned":[0.19781690736482865,0.17429030240481563,0.25483359165658048],"angular_velocity_ned":[-0.038645117738400507,0.033138012086994469,0.079219223967243249]},"sensors":{"Odom":[0.4282594472665629,0.37868487597494588,2.473847882700785,0.1989726713103189,0.15180589057646587,0.28300543012650548,-0.0054069973329922139,0.073524444844614623,0.093385233677931181,0.99289683176100951,-0.043080729021933432,0.039992581217101093,0.073565634983986883],"Pressure":[16610.300501679176],"DVL":[0.04966944709074194,-0.27494412234684618,-0.3026536517776855,8.1305963676025641,0.021535655785735932,0.0068933229435572995,0.01019715946643736,0],"IMU":[0.003027918688360289,0.1475490363796966,0.18777867006845025,-0.086855008563807429,0.03553799069371915,0.034051098569006122,1.4404511184190509,-0.047517430548322775,-9.6877161783018284],"FOG":[0.19693072699623762],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-71.071861212089956,105,22.304431980841102,105,105],"omega_rad_s":[-72.772477236985807,105.63673045647153,20.259673322243252,105.51641071585121,105.51398124773948],"thrust_n":[-63.228486901019011,132.88937448171436,3.7526091407342155,127.80223131271126,129.90114018888033],"torque_nm":[1.1855341293941066,-2.4916757715321443,-0.07036142138876654,-2.3962918371133362,-2.4356463785415077],"angle_rad":[-296.71786869879872,249.72858532586866,-129.21765549490286,614.06720234839554,614.0636464135107]},"command":[-0.67687486868657099,1,0.21242316172229619,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,1.0778494253810979e-21,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[2.9495984111250242,-3.0900241118153517,0.013205776812724723,0.0010150525611834289,0.0016926766108189915,-0.0065438184437662892]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":201,"step":1608,"t":8.0400000000000009,"sim_time":8.039999999999857,"vehicle":{"origin_ned":[0.43652021670275415,0.38637785824223364,2.4839025398362691],"origin_quat_xyzw":[-0.0062162235180124462,0.074239338008309799,0.094905264515831131,0.99269475168575461],"cg_ned":[0.34362644383495872,0.36923428418499504,2.1944672683814108],"linear_velocity_ned":[0.19873747327263805,0.1737465473475425,0.2552162968102959],"angular_velocity_ned":[-0.037451742117813443,0.032652887097521441,0.079159700121431878]},"sensors":{"Odom":[0.43652021670275415,0.38637785824223364,2.4839025398362691,0.19944200855040964,0.14974468416244816,0.28406402724940344,-0.0062162235180124809,0.074239338008310216,0.094905264515831658,0.99269475168575461,-0.042002875668501659,0.03929203717626701,0.07366815049187099],"Pressure":[16700.499122904883],"DVL":[0.06783875438359975,-0.20166095981330728,-0.32689088547275857,8.0199293828602958,-0.033383540452736983,-0.0089444553677494581,-0.03317584995026028,0],"IMU":[0.0017694222876207955,0.14912601770457129,0.19076014969627444,-0.046939067632553219,0.089577837330438198,0.097160092339089232,1.4781895726048544,-0.025770866693941463,-9.6872580708272196],"FOG":[0.17412233407092942],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-70.140281456443603,105,23.443037369022779,105,105],"omega_rad_s":[-71.759071085252017,105.6235460781638,21.648362783708855,105.50574445543545,105.50342280588718],"thrust_n":[-61.472604340582848,132.8192921829644,4.3867278565977177,127.74239576610128,129.80486840856307],"torque_nm":[1.1526113313859285,-2.4903617284305826,-0.082251147311207209,-2.395169920614399,-2.4338412826605573],"angle_rad":[-299.60560196855869,253.95375697963297,-128.37536894109016,618.28761807143007,618.28396737287255]},"command":[-0.66800268053755807,1,0.22326702256212172,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,-1.6269385334386973e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,-3.4694469519536142e-18,0,0,0],"servo_effort":[2.902782166522424,-3.1103580369706192,0.0084744882336520999,0.0010137711340832134,0.0016845271247298279,-0.0065268644749977905]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":202,"step":1616,"t":8.0800000000000001,"sim_time":8.0799999999998633,"vehicle":{"origin_ned":[0.44481007044603854,0.39403479781168727,2.4939730290213391],"origin_quat_xyzw":[-0.0070015816915602568,0.074941745491019604,0.096425433132554778,0.99249022588727531],"cg_ned":[0.35159704049931978,0.37617153712984175,2.2046839581991224],"linear_velocity_ned":[0.1996787108795284,0.17318308353471168,0.25556948644790778],"angular_velocity_ned":[-0.036169855676921957,0.032146422378658751,0.079088193225571313]},"sensors":{"Odom":[0.44481007044603854,0.39403479781168727,2.4939730290213391,0.19991895503411272,0.14764112194790852,0.28508467081286537,-0.0070015816915602776,0.074941745491019826,0.096425433132555055,0.99249022588727531,-0.040843581427056574,0.038550306857024673,0.07377173535008133],"Pressure":[16793.366411091138],"DVL":[0.052033194688380871,-0.22351723259083803,-0.28284685062748294,8.1392303671374648,0.041249222004371165,-0.059426314943460089,0.0084770649146763393,0],"IMU":[0.00056093338761266192,0.1506776723374984,0.19374449968539012,-0.01878832631242475,0.0094574959271842424,0.055766541257516289,1.5037365228187634,-0.00086548719343043645,-9.684760113359328],"FOG":[0.18734035973500554],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-69.224755691193153,105,24.530547479949135,105,105],"omega_rad_s":[-70.765667423253475,105.61063798462256,22.953521405440071,105.49529389437211,105.49308312049919],"thrust_n":[-59.776776901625695,132.74883464309028,5.0261133853496274,127.68595763022655,129.70982185784325],"torque_nm":[1.1208145669054819,-2.4890406495579436,-0.094239625975305538,-2.3941117055667478,-2.4320591598345609],"angle_rad":[-302.4532576100093,258.17840749348665,-127.4794691357778,622.5076120112634,622.50387093209883]},"command":[-0.6592833875351729,1,0.2336242617138013,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,1.0778494253810979e-21,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,3.4694469519536142e-18,0,0,0],"servo_effort":[2.8565162106654318,-3.1301700770126799,0.0038121682473132162,0.0010119775957974574,0.0016764092211904067,-0.0065087647890639073]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":203,"step":1624,"t":8.120000000000001,"sim_time":8.1199999999998695,"vehicle":{"origin_ned":[0.45312966459514836,0.40165394472062199,2.504058461193813],"origin_quat_xyzw":[-0.0077614522569457809,0.075631086138046463,0.097945640521104452,0.99228340214444433],"cg_ned":[0.35960574351150532,0.38308585846206605,2.2149141479364842],"linear_velocity_ned":[0.20064018913197851,0.17260249404183498,0.25589499803880583],"angular_velocity_ned":[-0.034808445969157262,0.031621714316889947,0.07900530424086305]},"sensors":{"Odom":[0.45312966459514836,0.40165394472062199,2.504058461193813,0.20040505251771856,0.145501290605899,0.28606839290375868,-0.0077614522569458087,0.075631086138046741,0.097945640521104799,0.99228340214444433,-0.039611296388784328,0.037771680530511956,0.073875870036290661],"Pressure":[16884.73804831041],"DVL":[0.056114529904340946,-0.22490683694191083,-0.34052164816549285,8.0151793841545622,0.026235030327436595,-0.016357233762725569,0.008870274229560552,0],"IMU":[-0.00059452312843752853,0.15220230494277881,0.19673189531181046,0.015134989710694088,0.018611918030525223,-0.060202771331608021,1.5172050442123515,-0.0091196019570043071,-9.6871439110553013],"FOG":[0.20603990406114892],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-68.324267132276916,105,25.573240535817817,105,105],"omega_rad_s":[-69.791193486723913,105.59800048637774,24.186145349469356,105.48505482125333,105.48295751082377],"thrust_n":[-58.137571367246345,132.67799657588566,5.6684274937509329,127.6327490811729,129.61605729489742],"torque_nm":[1.090079463135869,-2.4877124357978557,-0.10628301550782999,-2.3931140452719921,-2.4303010742793267],"angle_rad":[-305.26161129204883,262.40254779051463,-126.53304208285006,626.72719270078437,626.72336573581595]},"command":[-0.65070730602168492,1,0.2435546717696935,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,-3.3616620094155045e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,-3.4694469519536142e-18,0,0,0],"servo_effort":[2.8108596323824937,-3.149393613675771,-0.00075896828008754219,0.0010100538389720577,0.0016683805123645162,-0.0064895434877050911]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":204,"step":1632,"t":8.1600000000000001,"sim_time":8.1599999999998758,"vehicle":{"origin_ned":[0.46147967504924503,0.40923375437506226,2.5141580081517181],"origin_quat_xyzw":[-0.0084943925033123899,0.076306851699086506,0.099465789310979658,0.99207442585549843],"cg_ned":[0.36765335142348582,0.38997661612605516,2.2251567708662181],"linear_velocity_ned":[0.20162140849775978,0.17200710089516122,0.2561946251502103],"angular_velocity_ned":[-0.033376636523718667,0.031081684743945549,0.078911708441888384]},"sensors":{"Odom":[0.46147967504924503,0.40923375437506226,2.5141580081517181,0.20090168149766996,0.14333097262402508,0.28701627695350967,-0.0084943925033124541,0.076306851699087089,0.099465789310980407,0.99207442585549843,-0.03831460499950419,0.036960379965977397,0.073980065408720708],"Pressure":[16974.748171840281],"DVL":[0.078683020643298698,-0.2100975519885474,-0.29388291183136078,8.0497837640754533,-0.007668957539034113,-0.016806378730935195,-0.035003425738809137,0],"IMU":[-0.0016942701344376371,0.15369838179864989,0.19972249604288858,-0.053785928451798817,-0.019532246626086151,0.061678393960894744,1.535474327950028,0.016582940764190687,-9.710647445771734],"FOG":[0.21934886106803114],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-67.437802815503844,105,26.576183831155991,105,105],"omega_rad_s":[-68.834569820745884,105.58562798524571,25.355522806420762,105.47502312194341,105.4730413927487],"thrust_n":[-56.551691760670877,132.60677904262312,6.3121761647278518,127.58260181024934,129.52362767108545],"torque_nm":[1.060344220512579,-2.4863771070491834,-0.11835330308864726,-2.3921737839421757,-2.4285680188328529],"angle_rad":[-308.031395603698,266.62618856826396,-125.53877337244248,630.94636850663267,630.94246024359052]},"command":[-0.64226478871908421,1,0.25310651267767609,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,1.0778494253810979e-21,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,6.9388939039072284e-18,0,0,0],"servo_effort":[2.7658672647648159,-3.1679869373708396,-0.0052214721759556715,0.0010076366004951778,0.0016604790227248381,-0.0064696087585219223]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":205,"step":1640,"t":8.1999999999999993,"sim_time":8.199999999999882,"vehicle":{"origin_ned":[0.46986079256500612,0.41677287908163063,2.5242708992680125],"origin_quat_xyzw":[-0.0091991390560680307,0.076968603931133972,0.10098578457834546,0.99186343876695804],"cg_ned":[0.37574064181149253,0.39684326545689252,2.2354108306290232],"linear_velocity_ned":[0.20262182802064987,0.1713989819371165,0.25647009325115988],"angular_velocity_ned":[-0.031883659290606832,0.030529050533616053,0.078808145867332133]},"sensors":{"Odom":[0.46986079256500612,0.41677287908163063,2.5242708992680125,0.2014100814689766,0.1411356497264192,0.28792943394687154,-0.0091991390560680984,0.076968603931134541,0.1009857845783462,0.99186343876695804,-0.036962205395519677,0.036120524789998991,0.074083855005559543],"Pressure":[17067.675071262722],"DVL":[0.10554064354331295,-0.24231428901845425,-0.26458112074737422,7.9791031757896027,-0.022007909159182954,0.014698233284050928,0.0068868847187349425,0],"IMU":[-0.002735982832510437,0.15516452813405629,0.20271644450886012,-0.044145528278686036,0.03997217809105378,0.14196249607257663,1.5564672705570246,0.022593396000568523,-9.66096483578551],"FOG":[0.19584810414556048],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-66.564358292283231,105,27.543527495880614,105,105],"omega_rad_s":[-67.894715699943575,105.57351497775306,26.469447937530397,105.46519477456596,105.46333027991321],"thrust_n":[-55.015982742589713,132.53518804154885,6.9564082626296795,127.53534872181197,129.43258188667437],"torque_nm":[1.0315496764235574,-2.4850347757790416,-0.13043265492430647,-2.3912877885339747,-2.4268609103751446],"angle_rad":[-310.76329991450785,270.84934030247575,-124.4990117003678,635.16514763297482,635.16116273382261]},"command":[-0.63394626945031651,1,0.26231930948457727,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,-1.6269385334386973e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,-3.4694469519536142e-18,0,0,0],"servo_effort":[2.7215975766426745,-3.1859148087593652,-0.0095592508235004675,0.0010046760917336672,0.0016527465371833805,-0.0064492008272266452]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":206,"step":1648,"t":8.2400000000000002,"sim_time":8.2399999999998883,"vehicle":{"origin_ned":[0.47827371865995261,0.42427015971396592,2.5343964177350458],"origin_quat_xyzw":[-0.009874609532889083,0.077615971366032099,0.10250553433690809,0.99165057782758592],"cg_ned":[0.38386837018288716,0.40368533992994649,2.2456753985753726],"linear_velocity_ned":[0.20364089064579341,0.17077999779359621,0.25672307270448108],"angular_velocity_ned":[-0.03033878618456954,0.029966324151003063,0.078695395299083135]},"sensors":{"Odom":[0.47827371865995261,0.42427015971396592,2.5343964177350458,0.20193137294805813,0.13892050195926944,0.28880901442938978,-0.0098746095328891333,0.077615971366032502,0.10250553433690862,0.99165057782758592,-0.035562840881110371,0.035256120621875046,0.074186778328187292],"Pressure":[17162.197449931529],"DVL":[0.10584328637189382,-0.24198310006221324,-0.34988402429331961,7.9571511377581308,-0.039017040129010562,-0.020547050441987458,-0.014610235332428494,0],"IMU":[-0.0037176918819190512,0.15659952468491931,0.20571386504106651,-0.0085306846160441985,-0.010254048364510104,-0.012292097935748425,1.5676235198760056,0.026528705954888803,-9.6935160420111863],"FOG":[0.21580974854336055],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-65.702942887514197,105,28.478714175467235,105,105],"omega_rad_s":[-66.970554232395344,105.5616560575737,27.534444629369844,105.45556584449237,105.45381978353981],"thrust_n":[-53.527431881565157,132.46323343348297,7.6005150180398022,127.49082420896424,129.34296435508247],"torque_nm":[1.0036393477793466,-2.4836856268778065,-0.1425096565882463,-2.3904529539180794,-2.4251805816577963],"angle_rad":[-313.45797043968486,275.07201325093115,-123.41582350429417,639.38353812507876,639.37948130765426]},"command":[-0.62574231321442086,1,0.27122584929016413,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855039e-21,-1.6269385334386973e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,0,0,0,-2.7755575615628914e-17],"servo_effort":[2.6780890873286629,-3.2031436483773068,-0.013755261069253039,0.0010013977187098067,0.0016452384110928185,-0.0064283214021694218]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":207,"step":1656,"t":8.2799999999999994,"sim_time":8.2799999999998946,"vehicle":{"origin_ned":[0.48671916235836066,0.43172461765677955,2.5445338974728915],"origin_quat_xyzw":[-0.010519902868777525,0.078248645939389988,0.10402494964402174,0.99143597418282248],"cg_ned":[0.39203726971407327,0.41050244305228528,2.2559496116194011],"linear_velocity_ned":[0.20467803891877279,0.17015181774433127,0.2569551775551735],"angular_velocity_ned":[-0.028751276229078079,0.029395815688957022,0.078574250811208113]},"sensors":{"Odom":[0.48671916235836066,0.43172461765677955,2.5445338974728915,0.20246657377100558,0.13669041284471836,0.28965620485577936,-0.010519902868777518,0.078248645939389946,0.10402494964402169,0.99143597418282248,-0.034125246644795826,0.034371050989338174,0.074288364840550181],"Pressure":[17254.059236411042],"DVL":[0.042842547859456237,-0.18882934627236259,-0.31982414376374108,8.0007347469548797,-0.014501671858870455,-0.031526587003205993,0.026616113333211313,0],"IMU":[-0.0046377839824107451,0.15800230373151419,0.20871486175201212,-0.12674749694850357,0.01697728413666471,-0.066016875598495062,1.580641312101642,0.042936470422859745,-9.6687716498280381],"FOG":[0.19166982776071206],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-64.852583230509453,105,29.384628696856641,105,105],"omega_rad_s":[-66.061017171678984,105.55004591709992,28.555973397742406,105.44613248060409,105.44450561230755],"thrust_n":[-52.083170976551543,132.39092817085685,8.2440980219658542,127.44886428936873,129.25481461156394],"torque_nm":[0.97655945581034143,-2.4823299032035662,-0.1545768379118598,-2.3896662054256637,-2.423527773966824],"angle_rad":[-316.11601050465043,279.29421745737602,-122.2910389979414,643.60154787271847,643.59742389287055]},"command":[-0.61764364981437581,1,0.27985360663672992,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,-3.3616620094155045e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,-6.9388939039072284e-18,0,0,0],"servo_effort":[2.6353881848929324,-3.2196548374110492,-0.017796166211740683,0.00099791484171635127,0.0016380005745367428,-0.0064070290626134108]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":208,"step":1664,"t":8.3200000000000003,"sim_time":8.3199999999999008,"vehicle":{"origin_ned":[0.49519783730632999,0.43913544682156769,2.5546827198186715],"origin_quat_xyzw":[-0.011134298370752995,0.078866379598575759,0.10554394443166148,0.99121975230652593],"cg_ned":[0.40024805127280144,0.41729424112927394,2.2662326697279997],"linear_velocity_ned":[0.20573271628207498,0.16951593385840716,0.2571679536074149],"angular_velocity_ned":[-0.027130305346740349,0.028819619209076993,0.078445505415672703]},"sensors":{"Odom":[0.49519783730632999,0.43913544682156769,2.5546827198186715,0.20301659538094705,0.13444996358034622,0.29047221178232646,-0.011134298370753042,0.078866379598576092,0.10554394443166192,0.99121975230652593,-0.032658084123685302,0.03346904954574062,0.074388127435491724],"Pressure":[17346.842903749577],"DVL":[0.045584706579158668,-0.20746848969429657,-0.28628204129625601,8.0229087887757533,-0.03004221152354505,-0.009199416533715676,0.0034596122247130602,0],"IMU":[-0.0054949999922780345,0.15937194483522402,0.21171951639298353,0.029997816170874381,0.077958473264893358,0.055718567181173642,1.6008282952935471,0.035120297910705138,-9.6944212532075671],"FOG":[0.20749734848002188],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-64.012326657682252,105,30.263709200685351,105,105],"omega_rad_s":[-65.165049224055892,105.53867934816074,29.538612102146562,105.4368909119044,105.43538357139018],"thrust_n":[-50.68047651703413,132.31828800448309,8.8868833796335895,127.40930781000053,129.16816750239556],"torque_nm":[0.95025893469439005,-2.480967900084059,-0.16662906336812983,-2.3889245214375099,-2.421903140669917],"angle_rad":[-318.73798098879547,283.5159627554882,-121.12629052042168,647.81918461343741,647.81499824777848]},"command":[-0.60964120626364049,1,0.28822580191128905,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,-3.3616620094155045e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,-6.9388939039072284e-18,0,0,0],"servo_effort":[2.5935128941530134,-3.2354253035345697,-0.0216667675983509,0.0009935800473195467,0.0016310666408703948,-0.0063858935832720853]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":209,"step":1672,"t":8.3599999999999994,"sim_time":8.3599999999999071,"vehicle":{"origin_ned":[0.50371045930984371,0.44650200530536288,2.5648423104489688],"origin_quat_xyzw":[-0.011717253603863271,0.079468980720209983,0.10706243520835367,0.99100202928073289],"cg_ned":[0.40850140387644129,0.42406045640453061,2.2765238334523881],"linear_velocity_ned":[0.20680438451474215,0.16887367853183241,0.25736289364588399],"angular_velocity_ned":[-0.025484907234851181,0.028239652942449397,0.078309955224987196]},"sensors":{"Odom":[0.50371045930984371,0.44650200530536288,2.5648423104489688,0.20358226785839673,0.13220342978858834,0.29125827268970961,-0.011717253603863321,0.07946898072021033,0.10706243520835414,0.99100202928073289,-0.031169878427989989,0.032553726166211654,0.07448557695217306],"Pressure":[17441.648931105265],"DVL":[0.060868747453814182,-0.20096067128569939,-0.33058191405783144,8.0199716123873195,-0.0028155939637640581,0.00052227781219533716,-0.021910195332638497,0],"IMU":[-0.0062884307966756623,0.16070766993134572,0.21472788628073683,0.058995110108539001,0.097682749394822799,-0.055264600524780605,1.5771606950482624,0.051430878765802907,-9.668001108839718],"FOG":[0.22071070139114926],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-63.18125089078945,105,31.118028528898542,105,105],"omega_rad_s":[-64.281613769490988,105.52755124210343,30.486208794253216,105.42783744409347,105.42644956139357],"thrust_n":[-49.316772399875198,132.2453306987702,9.5286663125272533,127.37199586640666,129.08305314378183],"torque_nm":[0.92468948249766003,-2.4795999506019415,-0.17866249335988596,-2.3882249224951249,-2.4203072464459088],"angle_rad":[-321.32440096889241,287.73725877285779,-119.92304428730844,652.03645593567342,652.03221196504364]},"command":[-0.60172619895989954,1,0.2963621764657004,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.8431436932253574e-20,1.0778494253810979e-21,0,-7.5301229010907305e-20,1.3386508698406964e-19],"servo_velocity":[0,-3.4694469519536142e-18,0,0,0,0],"servo_effort":[2.5524891006990487,-3.2504302643902943,-0.025357327991010897,0.00098924208998287032,0.0016244615651594598,-0.0063650104317953555]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":210,"step":1680,"t":8.4000000000000004,"sim_time":8.3999999999999133,"vehicle":{"origin_ned":[0.5122577444789127,0.45382380732938965,2.5750121368648919],"origin_quat_xyzw":[-0.012268400635622526,0.080056311024059551,0.10858034090723098,0.99078291415402009],"cg_ned":[0.41679799534280237,0.43080086140271295,2.2868224219426811],"linear_velocity_ned":[0.20789252020242921,0.16822624870605235,0.25754143895693443],"angular_velocity_ned":[-0.023823892699993965,0.027657643039466041,0.078168376293012418]},"sensors":{"Odom":[0.5122577444789127,0.45382380732938965,2.5750121368648919,0.20416433026554318,0.12995478471110525,0.29201565350009284,-0.012268400635622546,0.080056311024059676,0.10858034090723116,0.99078291415402009,-0.029668942320809247,0.031628532460649214,0.074580211384223716],"Pressure":[17534.857983804613],"DVL":[0.08674687147513345,-0.21271613656231103,-0.29177234766682725,7.9530496013604006,-0.0085409400095403064,0.011331923239130992,0.03259171268897558,0],"IMU":[-0.0070175097815362505,0.16200883902261073,0.2177400029604982,-0.061151397133389213,0.0035515862394044605,-0.07824438945030282,1.6191848770548545,0.043675001024157278,-9.6950328804126755],"FOG":[0.19158447957262126],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-62.358465066180599,105,31.949373472199916,105,105],"omega_rad_s":[-63.409697846283791,105.51665658959375,31.402012932176088,105.41896845746264,105.41769957683816],"thrust_n":[-47.989630629203511,132.17207584952169,10.169279020977143,127.33677213301657,128.99949644994615],"torque_nm":[0.89980557429756591,-2.4782264221785315,-0.19067398164332139,-2.387564477494061,-2.4187405584364909],"angle_rad":[-323.87574858416008,291.95811493496524,-118.68262653598005,656.2533692817783,656.24907247547321]},"command":[-0.5938901434874343,1,0.30427974735428492,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.0778494253810979e-21,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[2.5123318892124091,-3.264666615423732,-0.028856221384822474,0.00098461775155661352,0.0016182424837565973,-0.0063441680667452828]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":211,"step":1688,"t":8.4399999999999995,"sim_time":8.4399999999999196,"vehicle":{"origin_ned":[0.52084040717156777,0.46110051514847994,2.5851917056933491],"origin_quat_xyzw":[-0.012787541951035333,0.080628282063781476,0.11009758232337728,0.9905625075020964],"cg_ned":[0.42513847291406764,0.43751527352953073,2.2971278105444326],"linear_velocity_ned":[0.2089966171213451,0.16757471204102345,0.25770496827787254],"angular_velocity_ned":[-0.022155864185726754,0.027075163190662749,0.078021518459623296]},"sensors":{"Odom":[0.52084040717156777,0.46110051514847994,2.5851917056933491,0.20476344776437394,0.12770770917337956,0.29274563027897255,-0.012787541951035396,0.080628282063781864,0.11009758232337781,0.9905625075020964,-0.028163383026533373,0.030696801332122742,0.074671509739924827],"Pressure":[17629.24422381831],"DVL":[0.046213742827883764,-0.20919364548144276,-0.29789354965833093,8.0114685418759439,0.0040606502315973471,-0.0026783277337961028,0.0014223717280717086,0],"IMU":[-0.0076820048302251014,0.16327494489099875,0.22075587024904789,-0.043482548869086618,0.024165841316107887,0.041626664590631711,1.6265713093116207,0.066507105097455374,-9.6679448984163709],"FOG":[0.22040519367999006],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-61.543114882529068,105,32.759281334970311,105,105],"omega_rad_s":[-62.548317060682457,105.50599047979391,32.288779449581284,105.4102804040709,105.40912970482444],"thrust_n":[-46.696772564069583,132.09854489497334,10.80856882590766,127.30348333991635,128.91751838734606],"torque_nm":[0.87556448557630473,-2.4768477167807501,-0.20266066548576861,-2.3869403126234316,-2.4172034697627387],"angle_rad":[-326.39246209628533,296.17854046913709,-117.4062450342005,660.46993195093864,660.46558705174471]},"command":[-0.58612490364313397,1,0.31199315557114582,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.0778494253810979e-21,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,6.9388939039072284e-18,0,0,-2.7755575615628914e-17],"servo_effort":[2.4730699012837896,-3.2781175774093332,-0.032152759783445582,0.00097992107933562002,0.0016124324045970852,-0.0063237758720916951]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":212,"step":1696,"t":8.4800000000000004,"sim_time":8.4799999999999258,"vehicle":{"origin_ned":[0.52945915897794538,0.46833193146516827,2.5953805601417819],"origin_quat_xyzw":[-0.013274645791716149,0.081184853150352274,0.1116140817925057,0.99034090097484917],"cg_ned":[0.43352346402890674,0.44420355039458115,2.3074394286708255],"linear_velocity_ned":[0.21011618793811071,0.16692002592327612,0.25785480870855426],"angular_velocity_ned":[-0.020489158506188303,0.026493650759055225,0.077870114827968531]},"sensors":{"Odom":[0.52945915897794538,0.46833193146516827,2.5953805601417819,0.20538021519582697,0.12546559715661151,0.29344949567189976,-0.013274645791716168,0.081184853150352385,0.11161408179250586,0.99034090097484917,-0.026661047097935195,0.029761747739680645,0.074758951766840595],"Pressure":[17722.566233627243],"DVL":[0.10683508926852427,-0.24556558665086553,-0.30075187771092393,7.9313164699439627,-0.0001707443446458006,0.019157312406023627,0.0074239398136323031,0],"IMU":[-0.0082820088301269329,0.16450561047130072,0.22377546307520937,0.055467937994931826,0.049950910286719344,0.020928291296699444,1.6374154239665697,0.079913098960360085,-9.6903053898244114],"FOG":[0.21807503302869236],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-60.734383023828592,105,33.549089491960643,105,105],"omega_rad_s":[-61.696519225270769,105.49554809924182,33.148855227508506,105.40176980635562,105.40073612211005],"thrust_n":[-45.436067452278046,132.02476077545103,11.446386023129401,127.27197826928038,128.8371365490342],"torque_nm":[0.85192626473021316,-2.4754642645397071,-0.21461973793367634,-2.3863495925490077,-2.4156963102943911],"angle_rad":[-328.87494111806956,300.39854440846108,-116.09500685835799,664.68615110201097,664.68176281204649]},"command":[-0.57842269546503422,1,0.31951513801867282,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.0778494253810979e-21,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,3.4694469519536142e-18,0,0,0,0],"servo_effort":[2.4347176908280779,-3.2907857741389814,-0.035240951743369976,0.00097532887354826305,0.0016070527722284417,-0.006304026388706677]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":213,"step":1704,"t":8.5199999999999996,"sim_time":8.5199999999999321,"vehicle":{"origin_ned":[0.53811470700113839,0.47551799146519336,2.6055782778624414],"origin_quat_xyzw":[-0.013729839911038251,0.0817260276155726,0.11312976313518573,0.99011817708754979],"cg_ned":[0.44195357720661999,0.45086558575165026,2.3177567575753133],"linear_velocity_ned":[0.21125077142920456,0.16626305508205552,0.25799223586514564],"angular_velocity_ned":[-0.018831775285833754,0.025914357458519045,0.077714905727239117]},"sensors":{"Odom":[0.53811470700113839,0.47551799146519336,2.6055782778624414,0.20601514848504468,0.12323156110881456,0.29412855832984725,-0.013729839911038284,0.081726027615572794,0.113129763135186,0.99011817708754979,-0.025169468275659718,0.028826401420207239,0.074842051702096873],"Pressure":[17816.882924993581],"DVL":[0.079463374594170258,-0.2212051941037193,-0.29106163428856741,7.8584010795053967,0.029937759700978322,0.0056957304809161962,0.0099765159420832569,0],"IMU":[-0.0088179273345429156,0.16570058247784814,0.22679872724657785,-0.0020933510944743765,0.090359313441174205,0.087226970694852718,1.6535895270059102,0.077975526786065605,-9.6674674512285055],"FOG":[0.22695741414689474],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-59.931497105801434,105,34.319969785444549,105,105],"omega_rad_s":[-60.853388733631306,105.48532473089917,33.984251011326883,105.39343325450122,105.39251509385996],"thrust_n":[-44.205532110881869,131.95074680943733,12.082578120673629,127.24211002009083,128.75836287668946],"torque_nm":[0.82885372707903493,-2.4740765026769496,-0.22654833976263056,-2.385789562876703,-2.4142193039379274],"angle_rad":[-331.32354799484392,304.61813559565843,-114.74993303893133,668.90203375628357,668.89760672362775]},"command":[-0.57077616291239464,1,0.32685685509947188,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.8431436932253574e-20,-1.6269385334386973e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,-3.4694469519536142e-18,3.4694469519536142e-18,0,0,0],"servo_effort":[2.3972819781239609,-3.3026644224911639,-0.038111109751531695,0.00097015739079793213,0.0016021419983845964,-0.0062849337308902836]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":214,"step":1712,"t":8.5600000000000005,"sim_time":8.5599999999999383,"vehicle":{"origin_ned":[0.54680775238842794,0.48265875535185315,2.6157844689621887],"origin_quat_xyzw":[-0.014153405241233735,0.082251849670661473,0.1146445519045461,0.98989440904797421],"cg_ned":[0.45042940279566168,0.45750130590998289,2.3280793282389629],"linear_velocity_ned":[0.21239991779672857,0.16560457329510353,0.25811846409277667],"angular_velocity_ned":[-0.017191356326726501,0.025338383184937779,0.077556610193924513]},"sensors":{"Odom":[0.54680775238842794,0.48265875535185315,2.6157844689621887,0.2066686807712696,0.12100843080928035,0.29478412426667927,-0.01415340524123376,0.082251849670661611,0.1146445519045463,0.98989440904797421,-0.023695838335730676,0.02789363158168149,0.074920335972978078],"Pressure":[17909.553459650208],"DVL":[0.056373832007516708,-0.20952601452577133,-0.31072378906464648,7.9684958309036844,0.0014309155630584836,-0.013043133505244322,-0.019398346004614337,0],"IMU":[-0.0092904658862877475,0.16685972609515906,0.229825580043028,-0.010576746699662453,0.11621836070888905,0.09192264250818924,1.6668116111093922,0.080624944674971957,-9.6539601716431314],"FOG":[0.23155342846714716],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-59.1337237762055,105,35.072967110343811,105,105],"omega_rad_s":[-60.018048848535521,105.47531575319094,34.796703823254688,105.38526740431389,105.38446297209472],"thrust_n":[-43.003327704110653,131.87652729292819,12.716990836006444,127.21373575321223,128.6812052169835],"torque_nm":[0.80631239445207492,-2.4726848867424032,-0.23844357817512082,-2.3852575453727294,-2.4127725978184409],"angle_rad":[-333.73860932918882,308.83732268692142,-113.37197054909041,673.11758680013543,673.11312560630597]},"command":[-0.56317832167814763,1,0.33402825819375059,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.0778494253810979e-21,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,3.4694469519536142e-18,0,0,0],"servo_effort":[2.3607905975591237,-3.3137586927275144,-0.040746391288493805,0.00096777562642739296,0.001597774785444338,-0.0062665902079804122]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":215,"step":1720,"t":8.5999999999999996,"sim_time":8.5999999999999446,"vehicle":{"origin_ned":[0.55553898875282604,0.48975440043976232,2.6259987739045387],"origin_quat_xyzw":[-0.01454576823453361,0.082762401159295132,0.11615837557883744,0.98966966072710383],"cg_ned":[0.45895151352958591,0.46411066649737587,2.3384067189539386],"linear_velocity_ned":[0.21356319388866341,0.16494528600605105,0.25823465489625963],"angular_velocity_ned":[-0.01557515078762046,0.024766686523338292,0.077395952004823701]},"sensors":{"Odom":[0.55553898875282604,0.48975440043976232,2.6259987739045387,0.20734117173744412,0.11879877172078847,0.29541750151344826,-0.014545768234533638,0.082762401159295285,0.11615837557883768,0.98966966072710383,-0.022246978077281661,0.026966144875383045,0.074993376154992505],"Pressure":[18007.325190916519],"DVL":[0.11263911341251436,-0.22538584057181496,-0.29247169807749485,7.978394069373973,0.03995841449133989,0.0047162466393580781,0.01615373129707811,0],"IMU":[-0.0097006147289318452,0.16798301904110255,0.23285591108684164,-0.027827089994219678,0.097888795715921087,-0.094598956921878766,1.6789970784934489,0.085778519754740143,-9.6384111679786386],"FOG":[0.22538297133312568],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-58.340381262448211,105,35.809015795805983,105,105],"omega_rad_s":[-59.189666348635249,105.46551663856346,35.587724374746593,105.37726897473877,105.37657619373002],"thrust_n":[-41.827759692810211,131.80212685644153,13.34946801538389,127.18671704634723,128.60566710002692],"torque_nm":[0.78427049424019157,-2.4712898785582795,-0.25030252528844793,-2.3847509446190105,-2.4113562581255055],"angle_rad":[-336.12041763800067,313.05611415569899,-111.96200216060845,677.33281698760504,677.32832613589574]},"command":[-0.55562267868998294,1,0.34103824567434271,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.0778494253810979e-21,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,6.9388939039072284e-18,0,0,0],"servo_effort":[2.3252185687646283,-3.3240630939507985,-0.043150200603273708,0.00096596191881041392,0.0015939222234497071,-0.0062492946475060799]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":216,"step":1728,"t":8.6400000000000006,"sim_time":8.6399999999999508,"vehicle":{"origin_ned":[0.56430910100633114,0.4968052137229152,2.6362208617135523],"origin_quat_xyzw":[-0.014907492957665693,0.083257798686437581,0.11767116337370422,0.98944398675310807],"cg_ned":[0.4675204651913894,0.47069364987247247,2.3487385531420788],"linear_velocity_ned":[0.21474018481310597,0.16428583112378942,0.25834190877111374],"angular_velocity_ned":[-0.013989988851911236,0.024200102682971656,0.077233611778143807]},"sensors":{"Odom":[0.56430910100633114,0.4968052137229152,2.6362208617135523,0.20803291410145891,0.11660487788989903,0.2960299867732365,-0.014907492957665722,0.083257798686437748,0.11767116337370445,0.98944398675310807,-0.020829302577099737,0.026046492630989262,0.07506074821113537],"Pressure":[18102.250484176773],"DVL":[0.10032612280714355,-0.1726380884644253,-0.30388029429795049,7.9071272393720156,-0.0058286658604753926,-0.035677381325404024,0.032214790864917749,0],"IMU":[-0.010049633018670678,0.16907054618452386,0.23588958265995788,0.027265312061206123,0.076684174479935668,-0.081199673149289164,1.6901327095908927,0.085564757417321433,-9.645411733860568],"FOG":[0.24366057363393512],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-57.550834223920575,105,36.528947463350001,105,105],"omega_rad_s":[-58.367453381958128,105.45592295205954,36.358635498710406,105.36943474609217,105.3688512786145],"thrust_n":[-40.677273935211687,131.72757071370032,13.979852321641626,127.16091996114177,128.53174843110423],"torque_nm":[0.76269888628521909,-2.4698919508818813,-0.26212223103078047,-2.3842672492714088,-2.4099702830832053],"angle_rad":[-338.46923313530073,317.27451829642644,-110.52085456939757,681.54773094287634,681.54321484756122]},"command":[-0.54810318308495787,1,0.34789473774619051,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.8425084185149169e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,3.4694469519536142e-18,0,0,0],"servo_effort":[2.290572149641743,-3.3335843273814025,-0.045320583717656758,0.00096448478484244173,0.0015906094010331908,-0.0062326933087450513]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":217,"step":1736,"t":8.6799999999999997,"sim_time":8.6799999999999571,"vehicle":{"origin_ned":[0.57311876466102873,0.50381158452154395,2.646450428568027],"origin_quat_xyzw":[-0.015239272732435843,0.083738191189350109,0.11918284645940583,0.98921743262679918],"cg_ned":[0.47613679741744941,0.47725026278991545,2.3590744975149005],"linear_velocity_ned":[0.21593049446645088,0.16362680125871742,0.25844129556996759],"angular_velocity_ned":[-0.012442271847052494,0.023639378162398129,0.0770702634272665]},"sensors":{"Odom":[0.57311876466102873,0.50381158452154395,2.646450428568027,0.2087441432468321,0.11442879749038784,0.29662289031155942,-0.015239272732435846,0.083738191189350122,0.11918284645940586,0.98921743262679918,-0.01944881216934222,0.025137097060605997,0.075122073253714144],"Pressure":[18198.24895620938],"DVL":[0.071130847108786283,-0.21399280175641408,-0.30855883282175339,7.8784757845830073,-0.0020149164097647146,0.00031736933803372977,-0.0045566521462858476,0],"IMU":[-0.010339031965576197,0.17012249480042274,0.23892643109387335,-0.026892600273137265,-0.068023009828440145,0.3103494401083231,1.6771437228425905,0.11349255751101739,-9.6654237246978614],"FOG":[0.24152854121241815],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-56.764500024898936,105,37.233518211308905,105,105],"omega_rad_s":[-57.550671018385522,105.44653034992653,37.110603117211262,105.36176155857467,105.36128482733206],"thrust_n":[-39.550455004376886,131.65288412636028,14.607986507759939,127.13621362372859,128.45944528753193],"torque_nm":[0.74157103133206659,-2.4684915773692553,-0.27389974702049896,-2.3838040054449112,-2.4086145991412238],"angle_rad":[-340.78528563206851,321.49254322819735,-109.04930521950483,685.76233516269519,685.75779813908321]},"command":[-0.54061428595141847,1,0.35460493534579907,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.0778494253810979e-21,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[2.256874452710087,-3.3423289246972838,-0.047254582292557447,0.00096261192461103329,0.0015878383188732876,-0.0062172165809073433]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":218,"step":1744,"t":8.7200000000000006,"sim_time":8.7199999999999633,"vehicle":{"origin_ned":[0.58196864502787848,0.5107739973791523,2.656687196256013],"origin_quat_xyzw":[-0.015541921413746586,0.084203757438188337,0.12069335797202033,0.98899003496167603],"cg_ned":[0.48480103434709559,0.48378053455861603,2.369414259955426],"linear_velocity_ned":[0.21713374205294936,0.16296873949035756,0.25853381412732634],"angular_velocity_ned":[-0.010937940967640523,0.023085147049684902,0.076906551428883668]},"sensors":{"Odom":[0.58196864502787848,0.5107739973791523,2.656687196256013,0.20947503060369391,0.11227232652434636,0.29719749244639648,-0.015541921413746673,0.084203757438188809,0.12069335797202101,0.98899003496167603,-0.018111066379160677,0.024240215945719918,0.075177000639259334],"Pressure":[18293.1085223513],"DVL":[0.080028715650962604,-0.17849876421138128,-0.30970306947862059,7.7715026903572859,0.009063614743958311,-0.053188331592721627,0.034373954345067896,0],"IMU":[-0.010570557309460627,0.17113914944623318,0.24196626795034093,-0.042797867871303907,0.016302371964261372,0.031378639720912926,1.6922653428417824,0.079013774128965125,-9.6628530760473428],"FOG":[0.25505624291832185],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-55.980846021533601,105,37.923411273243659,105,105],"omega_rad_s":[-56.738630361619592,105.43733457813313,37.84466208671882,105.35424631100099,105.35387351919627],"thrust_n":[-38.446021308652107,131.57809237649215,15.233715111284972,127.11247249647165,128.38875074033788],"torque_nm":[0.72086289953722704,-2.4670892320592279,-0.28563215833659322,-2.3833588593088435,-2.4072890763813359],"angle_rad":[-343.06877651541561,325.71019689837868,-107.54808795819419,689.97663601874251,689.97208227404553]},"command":[-0.53315091449079621,1,0.36117534545946339,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.0778494253810979e-21,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[2.2241385923002768,-3.350307987339967,-0.048950015569083037,0.00096062320546637771,0.0015856218848144036,-0.0062029636383483192]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":219,"step":1752,"t":8.7599999999999998,"sim_time":8.7599999999999696,"vehicle":{"origin_ned":[0.59085939633541007,0.5176930248226379,2.6669309110281172],"origin_quat_xyzw":[-0.015816363478119908,0.084654703058297615,0.12220263317555891,0.98876182184659567],"cg_ned":[0.49351368532345785,0.4902845157661852,2.3797575875628327],"linear_velocity_ned":[0.21834956619329229,0.16231216644066815,0.25862042631937571],"angular_velocity_ned":[-0.0094824026370082422,0.022537925519267064,0.076743095548632206]},"sensors":{"Odom":[0.59085939633541007,0.5176930248226379,2.6669309110281172,0.21022568164896496,0.11013702049350296,0.29775507563699882,-0.015816363478119998,0.084654703058298086,0.12220263317555959,0.98876182184659567,-0.016821117135987843,0.023357913860284449,0.07522522608315492],"Pressure":[18390.734531497652],"DVL":[0.10267544893662763,-0.178574884772256,-0.32691797186393012,7.8775910034545218,0.030134930318794696,0.0081542748662738578,0.020662070533324466,0],"IMU":[-0.010746169514997421,0.17212088543830803,0.2450088818368272,-0.1566102331455545,0.011000693157468669,0.14711071711021345,1.7218934177535707,0.090017268303856937,-9.6601053504814125],"FOG":[0.26163094370144996],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-55.199393600042548,105,38.599253553933636,105,105],"omega_rad_s":[-55.930695118196979,105.42833147105254,38.561737382044072,105.34688595864834,105.34661411061772],"thrust_n":[-37.362821743103389,131.50322012204509,15.856886248801358,127.08957601223369,128.31965287827606],"torque_nm":[0.70055290768318856,-2.4656853772883451,-0.2973166171650255,-2.3829295502293819,-2.4059934914676759],"angle_rad":[-345.31988081306645,329.92748708616926,-106.01789779459236,694.19063975992742,694.18607338494098]},"command":[-0.52570851047659573,1,0.36761193860889174,1,1],"arm":{"servo_position":[5.4944645008222292e-22,1.6263032587282569e-20,1.8425084185149169e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,3.4694469519536142e-18,0,0,0,0],"servo_effort":[2.1922952809131897,-3.3575448795444913,-0.050409797620280805,0.00095891361268441648,0.0015839582882202314,-0.0061900193036728817]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":220,"step":1760,"t":8.8000000000000007,"sim_time":8.7999999999999758,"vehicle":{"origin_ned":[0.59979166132217709,0.52456932022908731,2.6771813426315152],"origin_quat_xyzw":[-0.016063623944660814,0.08509125829004896,0.12371060959447452,0.98853281322480335],"cg_ned":[0.50227524556585745,0.49676227715799509,2.3901042649243252],"linear_velocity_ned":[0.21957762122332272,0.16165757825278909,0.25870205403473878],"angular_velocity_ned":[-0.0080805712333820306,0.021998193739301196,0.076580476022611241]},"sensors":{"Odom":[0.59979166132217709,0.52456932022908731,2.6771813426315152,0.21099615948691727,0.10802420491960435,0.29829691214308746,-0.016063623944660901,0.085091258290049432,0.1237106095944752,0.98853281322480335,-0.015583530227340183,0.022492146064724012,0.075266476057777726],"Pressure":[18488.156245388425],"DVL":[0.10691002454735236,-0.22674783234895587,-0.32005069264701508,7.9249911365704291,0.064669307422579078,0.013466419846448393,-0.013161869626712945,0],"IMU":[-0.010868023478815944,0.17306816357727867,0.24805404034514922,-0.1268340671443739,0.10958010927528335,0.19973620040742679,1.7296020615372696,0.096461627658533389,-9.6445283440397187],"FOG":[0.2584258705988971],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-54.419722292649368,105,39.261624752934665,105,105],"omega_rad_s":[-55.126284118624717,105.41951695012014,39.262662517673391,105.33967751182225,105.33950343356354],"thrust_n":[-36.299832979986469,131.42829182187756,16.477354366561254,127.0674073477641,128.25213719089629],"torque_nm":[0.68062186837474659,-2.4642804716602047,-0.30895039437302346,-2.3825138877705774,-2.4047275723293051],"angle_rad":[-347.53874935151174,334.14442140610697,-104.45939486428304,698.40435251461065,698.39977747622788]},"command":[-0.51828306945380354,1,0.37392023574223487,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.0778494253810979e-21,0,6.3476649067237265e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,-6.9388939039072284e-18,0,0,0],"servo_effort":[2.161324827682491,-3.3640454544026657,-0.051631506011903111,0.00095738315512524383,0.0056479506914502995,-0.0061782609170640372]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":221,"step":1768,"t":8.8399999999999999,"sim_time":8.8399999999999821,"vehicle":{"origin_ned":[0.60876607123015325,0.53140361120732871,2.6874382832926704],"origin_quat_xyzw":[-0.016284818425214429,0.085513676276398304,0.12521722677990893,0.98830302133308379],"cg_ned":[0.51108619687049384,0.50321390896673357,2.4004541123635321],"linear_velocity_ned":[0.22081757586144668,0.16100545263278648,0.25877956647867828],"angular_velocity_ned":[-0.0067368558225603279,0.021466361899024303,0.076419230366211094]},"sensors":{"Odom":[0.60876607123015325,0.53140361120732871,2.6874382832926704,0.21178647618619115,0.10593498673101003,0.29882424973377691,-0.016284818425214478,0.085513676276398567,0.12521722677990932,0.98830302133308379,-0.014402382130783816,0.021644716490140676,0.07530050681328912],"Pressure":[18583.613912673434],"DVL":[0.12436396325813014,-0.23009629466581136,-0.33084183443160109,7.9478621942635312,0.059679718318291643,0.040308747116326683,0.0041233798929930779,0],"IMU":[-0.01093844844584594,0.17398152576892639,0.25110149135820919,-0.025902240303557721,0.11619840799149027,0.058443581490394657,1.7324707563711077,0.10041713844414321,-9.6905350129914254],"FOG":[0.23752326657277137],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-53.641465836472271,105,39.911053650997957,105,105],"omega_rad_s":[-54.324872365639273,105.41088702220807,39.948191605004133,105.33261803515755,105.33253839306393],"thrust_n":[-35.256154383681121,131.35333151681709,17.094979616284963,127.04585440631723,128.18618645449385],"torque_nm":[0.66105289469402118,-2.4628749659403208,-0.32053086780534307,-2.3821097701184484,-2.4034909960217594],"angle_rad":[-349.72551098928744,338.36100731151447,-102.87320779770594,702.61778029279242,702.6132004272938]},"command":[-0.5108711032044978,1,0.38010527286664719,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,3.5772318944917241e-20,0,6.3476649067237265e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,6.9388939039072284e-18,0,0,0],"servo_effort":[2.1312226993231604,-3.3698385341006616,-0.052612323335441379,0.00095475778133193663,0.0056340519594058665,-0.0061679413708374689]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":222,"step":1776,"t":8.8800000000000008,"sim_time":8.8799999999999883,"vehicle":{"origin_ned":[0.61778324483313685,0.5381966927809434,2.6977015464167655],"origin_quat_xyzw":[-0.016481143115563784,0.085922230516132361,0.12672242652704377,0.98807245120984666],"cg_ned":[0.51994700777261926,0.50963952006477431,2.4108069836667649],"linear_velocity_ned":[0.22206910093200624,0.16035624981743174,0.2588537748482882],"angular_velocity_ned":[-0.0054551486483489222,0.020942745281802587,0.076259877142202531]},"sensors":{"Odom":[0.61778324483313685,0.5381966927809434,2.6977015464167655,0.21259657462120141,0.10387026592948377,0.2993383020216509,-0.016481143115563823,0.085922230516132556,0.12672242652704407,0.98807245120984666,-0.013281261514383289,0.020817244567444059,0.075327129970971643],"Pressure":[18677.462257758896],"DVL":[0.10686605134839615,-0.20371877174458991,-0.30072953880058351,7.8094419819960219,0.00015455406863591753,-0.042251457477797238,-0.018006808487488441,0],"IMU":[-0.010959927955740072,0.17486158878955582,0.25415096536482545,-0.00071800825391673748,-0.0022812504473615942,0.0024755440624901898,1.7365139591905574,0.10501303398372781,-9.6712316099831792],"FOG":[0.2683946516620484],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-52.864315346749791,105,40.54803417265699,105,105],"omega_rad_s":[-53.525992365685404,105.40243777799441,40.619011448761171,105.32570464556403,105.32571596532328],"thrust_n":[-34.231003532613521,131.27836283282386,17.709629601709832,127.02481137791301,128.12178028383357],"torque_nm":[0.64183131623650358,-2.461469303115448,-0.33205555503205936,-2.3817152133358692,-2.402283380321879],"angle_rad":[-351.8802748931007,342.57725209788026,-101.25993662610558,706.83092898824202,706.82634799533423]},"command":[-0.50346966996904563,1,0.38617175402530468,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.0778494253810979e-21,0,6.3476649067237265e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[2.1019822359053761,-3.3749520485487614,-0.053356968444381696,0.0009516103779472194,0.0056217882676076183,-0.0061590798441483229]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":223,"step":1784,"t":8.9199999999999999,"sim_time":8.9199999999999946,"vehicle":{"origin_ned":[0.62684378783320582,0.54494942099619659,2.7079709656096704],"origin_quat_xyzw":[-0.016653864380433279,0.086317212232006363,0.12822615339680593,0.98784110121959978],"cg_ned":[0.52885813404258586,0.51603923773779226,2.4211627640421294],"linear_velocity_ned":[0.22333188433440032,0.15971043085924028,0.25892544601085082],"angular_velocity_ned":[-0.0042388086827179804,0.020427594468711108,0.076102909866196763]},"sensors":{"Odom":[0.62684378783320582,0.54494942099619659,2.7079709656096704,0.21342635326967213,0.10183074882536096,0.29984026035143763,-0.016653864380433321,0.086317212232006571,0.12822615339680626,0.98784110121959978,-0.012223247633754489,0.020011184396696052,0.075346212388245612],"Pressure":[18776.189688149381],"DVL":[0.12366185941799407,-0.19113360565605433,-0.33585622289035216,7.8705225392541651,0.02479900611882992,0.027361828287067118,-0.030490730635030112,0],"IMU":[-0.010935078974174119,0.17570903759644843,0.25720217855360528,-0.043789009776309493,0.074017121224613736,0.015176428321536109,1.7419278676376877,0.089801151450472821,-9.6239339908397206],"FOG":[0.24965183945690875],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-52.088017147548804,105,41.173038657121488,105,105],"omega_rad_s":[-52.729234598234555,105.39416539076652,41.275754417982078,105.31893451016744,105.31903319634417],"thrust_n":[-33.223710271646851,131.20340805778929,18.321183136964709,127.00417801937526,128.05889491331922],"torque_nm":[0.62294456759337857,-2.4600639010835494,-0.3435221838180883,-2.3813283378632861,-2.4011042796247355],"angle_rad":[-354.00313285101441,346.79316290618192,-99.620155183295765,711.04380438054011,711.03922581816789]},"command":[-0.49607635378617909,1,0.3921241776868713,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.8425084185149169e-20,0,6.3476649067237265e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,3.4694469519536142e-18,0,0,0],"servo_effort":[2.0735662993636006,-3.3793978655840995,-0.053869691585282237,0.00094902308643638454,0.0056108726089650731,-0.0061517439293430811]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":224,"step":1792,"t":8.9600000000000009,"sim_time":8.9600000000000009,"vehicle":{"origin_ned":[0.63594829274935505,0.55166270657290939,2.7182463938138524],"origin_quat_xyzw":[-0.016804308346804877,0.08669892879482452,0.12972835425860207,0.98760896364308581],"cg_ned":[0.53782001896540421,0.52241320756245624,2.431521368357342],"linear_velocity_ned":[0.2246056124803385,0.15906844987634469,0.25899530035687435],"angular_velocity_ned":[-0.0030906629041463022,0.019921148224694391,0.075948739936697318]},"sensors":{"Odom":[0.63594829274935505,0.55166270657290939,2.7182463938138524,0.21427566266060477,0.099816943084590992,0.30033128240642037,-0.016804308346804912,0.086698928794824701,0.12972835425860235,0.98760896364308581,-0.011230890675874048,0.019227870574196504,0.075357624229787853],"Pressure":[18872.957249799256],"DVL":[0.10404966116868211,-0.1815687104071616,-0.29931640681788468,7.8713278009933738,0.022411741103584713,0.016420138378008514,-0.010652718074186926,0],"IMU":[-0.010866630978098977,0.17652462053948692,0.26025483402327093,-0.060654622175809733,0.12637125921684011,0.014813810042827454,1.7482602434887096,0.093025311927203591,-9.6481477620773859],"FOG":[0.26292627754152736],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-51.312374281273556,105,41.786500921766326,105,105],"omega_rad_s":[-51.93424794002722,105.38606611481025,41.919004692308228,105.31230484542155,105.31248719993154],"thrust_n":[-32.233711212605868,131.12848963562203,18.929529542921767,126.98385876346421,127.99750493961757],"torque_nm":[0.60438208523636006,-2.458659180667913,-0.35492867892978319,-2.3809473518149544,-2.3999532176178291],"angle_rad":[-356.09416159816698,351.00874672615834,-97.954413106746387,715.2564121370641,715.25183941698788]},"command":[-0.48868927886927199,1,0.3979666754453936,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.0778494253810979e-21,0,6.3476649067237265e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,-6.9388939039072284e-18,2.1684043449710089e-19,0,0],"servo_effort":[2.0459431318864771,-3.3832004068537667,-0.054153946767111598,0.00094750660249737304,0.0056015422886323048,-0.0061459445603673675]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":225,"step":1800,"t":9,"sim_time":9.0000000000000071,"vehicle":{"origin_ned":[0.645097338614528,0.55833750853293862,2.7285277022816445],"origin_quat_xyzw":[-0.01693385015370057,0.08706770192360265,0.13122897828678984,0.98737602526014356],"cg_ned":[0.54683309348356202,0.52876159340661621,2.4418827391225144],"linear_velocity_ned":[0.22588998316757278,0.15843076720895488,0.25906400653467654],"angular_velocity_ned":[-0.002013019300278222,0.019423591013512279,0.075797755202707637]},"sensors":{"Odom":[0.645097338614528,0.55833750853293862,2.7285277022816445,0.21514431076973972,0.097829186853412187,0.30081248865829557,-0.016933850153700664,0.087067701923603108,0.13122897828679056,0.98737602526014356,-0.010306246873166669,0.018468473666385689,0.075361293673585808],"Pressure":[18968.852623820203],"DVL":[0.12372009611062255,-0.19393072102103864,-0.34250663343723192,7.8389371763394253,-0.021404028728985294,0.0011511611776900009,0.015613400544866827,0],"IMU":[-0.010757404357167454,0.17730914384660468,0.26330862403789546,0.037303121450817059,0.0062977655549246118,-0.1112642708143403,1.7513201718141134,0.090013545578689472,-9.6313583288851081],"FOG":[0.27532138995416627],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-50.537252131521527,105,42.388831679218448,105,105],"omega_rad_s":[-51.140742089894268,105.37813628362454,42.549303304058107,105.30581291591223,105.30607515556653],"thrust_n":[-31.260546567857297,131.05362879881454,19.534567588122883,126.96376395920596,127.93758251198719],"torque_nm":[0.58613524814732443,-2.4572555399777727,-0.36627314227730418,-2.3805705742351129,-2.3988296720997604],"angle_rad":[-358.1534252103362,355.22401039950557,-96.26323767671964,719.46875781493804,719.46419419902179]},"command":[-0.48130716315734789,1,0.40370315884969954,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,3.5772318944917241e-20,0,6.3476649067237265e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,3.4694469519536142e-18,0,0,0],"servo_effort":[2.0191064010823729,-3.3863969160206708,-0.054216263233515354,0.00094604143423009828,0.0055935090671107891,-0.0061416376764289234]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":226,"step":1808,"t":9.0400000000000009,"sim_time":9.0400000000000134,"vehicle":{"origin_ned":[0.65429149096352224,0.5649748290227038,2.7388147799023752],"origin_quat_xyzw":[-0.017043904551102843,0.08742386576871311,0.13272797718273982,0.98714226790502946],"cg_ned":[0.55589777675093122,0.5350845778077653,2.4522468448206989],"linear_velocity_ned":[0.2271847063886544,0.15779785669527538,0.25913220294151296],"angular_velocity_ned":[-0.0010077202986053277,0.018935077739712466,0.075650315184364478]},"sensors":{"Odom":[0.65429149096352224,0.5649748290227038,2.7388147799023752,0.21603207383252235,0.095867673832024589,0.30128497946186439,-0.017043904551102867,0.087423865768713235,0.13272797718274001,0.98714226790502946,-0.0094509243601188578,0.017734032159934934,0.075357195998740356],"Pressure":[19066.680989040829],"DVL":[0.10174526419094956,-0.17864539908702132,-0.31219607957274559,7.7350007128686649,-0.0020621685751312856,0.037782565418942621,-0.011967751075806821,0],"IMU":[-0.010610291546865287,0.17806346603735676,0.26636323255694522,-0.073063351447095665,0.10803350406255074,0.074384912348871152,1.772729202240487,0.086055732101879071,-9.6312873625303634],"FOG":[0.24161061472534801],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-49.7625660302445,105,42.980421261182286,105,105],"omega_rad_s":[-50.34848575906333,105.3703723088602,43.16715545604692,105.29945603309588,105.29979430691131],"thrust_n":[-30.30385171109867,130.9788454984093,20.136207489081475,126.94380861927878,127.87909729004188],"torque_nm":[0.5681972195831001,-2.4558533530951743,-0.37755389042027776,-2.3801964116114775,-2.397733074188285],"angle_rad":[-360.1809775041138,359.4389606230223,-94.547135360185621,723.68084686292639,723.67629546012563]},"command":[-0.47392920028804286,1,0.40933734534459321,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,3.5772318944917241e-20,-1.0842021724855045e-21,6.3476649067237265e-20,-1.436906691722195e-19],"servo_velocity":[0,0,6.9388939039072284e-18,-2.1684043449710089e-19,0,-2.7755575615628914e-17],"servo_effort":[1.9930137852684695,-3.3889911230134762,-0.054058858891339705,0.00094437027751352674,0.005587008866010346,-0.0061388168650680364]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":227,"step":1816,"t":9.0800000000000001,"sim_time":9.0800000000000196,"vehicle":{"origin_ned":[0.66353130211908651,0.57157570796804269,2.749107532848635],"origin_quat_xyzw":[-0.017135916064247872,0.087767765497570774,0.134225305406247,0.98690766898874693],"cg_ned":[0.56501447660686943,0.54138236239646065,2.4626136786293733],"linear_velocity_ned":[0.22848950500304824,0.15717019819346367,0.25920048573012516],"angular_velocity_ned":[-7.6098153833404052e-05,0.018455744690669709,0.075506734241354193]},"sensors":{"Odom":[0.66353130211908651,0.57157570796804269,2.749107532848635,0.2169386973403199,0.093932437211047409,0.30174982047987325,-0.01713591606424791,0.087767765497570954,0.13422530540624728,0.98690766898874693,-0.0086660368656974324,0.01702544589727539,0.075345346345026584],"Pressure":[19163.951808810409],"DVL":[0.15345251990290198,-0.2052881987622148,-0.33188784820510586,7.7770268887479324,-0.01261521267322894,-0.010046126046423473,0.028074815207357655,0],"IMU":[-0.010428237190316355,0.17878849304263508,0.26941833791866193,0.035993305113184132,0.10482318772886146,0.075354229820886673,1.7617842118431313,0.099359225851152672,-9.6790699223231371],"FOG":[0.25804287842503093],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-48.988285354584505,105,43.561647482176873,105,105],"omega_rad_s":[-49.557305190383218,105.36277067902098,43.773036837286206,105.29323155490771,105.29364196028118],"thrust_n":[-29.363349460517075,130.9041583797277,20.73437290316193,126.92391269917414,127.82201686479465],"torque_nm":[0.55056280238469524,-2.4544529696198945,-0.38876949193428617,-2.3798233631095158,-2.3966628162149002],"angle_rad":[-362.17686435079202,363.65360395170666,-92.80659310354531,727.89268462329971,727.88814838731696]},"command":[-0.46655509861509054,1,0.41487283316358925,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.8425084185149169e-20,0,6.3476649067237265e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,-3.4694469519536142e-18,0,0,0],"servo_effort":[1.9676391049314415,-3.3910178552780486,-0.05368867939422161,0.00094345738020242713,0.0055820113156561926,-0.0061376672931808532]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":228,"step":1824,"t":9.120000000000001,"sim_time":9.1200000000000259,"vehicle":{"origin_ned":[0.67281731139697765,0.57814121795711415,2.7594058838973385],"origin_quat_xyzw":[-0.0172113492115278,0.088099755761319912,0.13572092001949748,0.98667220208242201],"cg_ned":[0.57418358996702046,0.54765516858028618,2.4729832567857777],"linear_velocity_ned":[0.22980410808745977,0.15654829699970954,0.25926941848174201],"angular_velocity_ned":[0.0007810002426718337,0.017985722106354383,0.075367275960930707]},"sensors":{"Odom":[0.67281731139697765,0.57814121795711415,2.7594058838973385,0.21786389911809162,0.09202338157780203,0.30220804885531821,-0.017211349211527789,0.088099755761319856,0.1357209200194974,0.98667220208242201,-0.0079522247905391696,0.016343488931702135,0.075325791978957696],"Pressure":[19261.896804115182],"DVL":[0.105028699402162,-0.17654323270390282,-0.30696068617277772,7.7574303660384034,0.0088777560280533848,-0.026675756381117254,-0.0043186936496019627,0],"IMU":[-0.010214218545917694,0.17948517291225025,0.27247361474957227,-0.013336223011534962,0.050426949072435272,-0.0060835891015097177,1.7944992444713388,0.086730989303223677,-9.6152270819470473],"FOG":[0.26947210256773596],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-48.214433525726498,105,44.132868096439964,105,105],"omega_rad_s":[-48.767084905749243,105.35532795808996,44.367396565402622,105.28713688458205,105.28761548297599],"thrust_n":[-28.438844937239409,130.82958491193773,21.329000121584567,126.90400101427015,127.76630688999286],"torque_nm":[0.53322834257323881,-2.4530547170988322,-0.39991875227971063,-2.3794500190175656,-2.3956182541873665],"angle_rad":[-364.14112600756545,367.86794680180003,-91.042079436807882,732.10427633366839,732.09975806124373]},"command":[-0.45918508119739521,1,0.4203130294899044,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.0778494253810979e-21,0,6.3476649067237265e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[1.9429518397505052,-3.3924958617807413,-0.053108376005279317,0.00094283619646724803,0.0055785182399952331,-0.0061380788763299998]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":229,"step":1832,"t":9.1600000000000001,"sim_time":9.1600000000000321,"vehicle":{"origin_ned":[0.6821500452334881,0.58467245913900445,2.7697097717758306],"origin_quat_xyzw":[-0.0172716787934412,0.08842019930067406,0.13721478060555189,0.98643583747279551],"cg_ned":[0.58340550300909055,0.55390323817837184,2.4833556170066236],"linear_velocity_ned":[0.23112824965468376,0.15593266746673876,0.25933951748362044],"angular_velocity_ned":[0.0015632146901419046,0.017525119651428354,0.0752321574715131]},"sensors":{"Odom":[0.6821500452334881,0.58467245913900445,2.7697097717758306,0.21880736266637774,0.090140274896949535,0.30266065608399362,-0.017271678793441235,0.08842019930067424,0.13721478060555217,0.98643583747279551,-0.0073096602608445221,0.015688789452391123,0.075298617046878583],"Pressure":[19359.371802758302],"DVL":[0.13392654514341562,-0.23969447262992638,-0.2863767575425244,7.8011884255116062,0.010866272784499658,0.010935063561486167,-0.0036148995371699981,0],"IMU":[-0.0099712260273701024,0.18015449063543632,0.27552873603876454,-0.0099845467901822169,0.045436800016459701,-0.060493047625459359,1.7905087486302611,0.093859354991213478,-9.6050593231337196],"FOG":[0.28927053191267971],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-47.441089609542814,105,44.694425830927948,105,105],"omega_rad_s":[-47.977767069529555,105.34804078400354,44.950660120770351,105.28116946977826,105.28171230163639],"thrust_n":[-27.530219307528832,130.7551413661333,21.920037830235231,126.88400406726294,127.71193133911552],"torque_nm":[0.51619161201616581,-2.4516589006149996,-0.41100070931691063,-2.3790750762611803,-2.3945987126084165],"angle_rad":[-366.07379942346608,372.08199545377192,-89.254045470688837,736.31562712877633,736.31112945858615]},"command":[-0.45181990104326492,1,0.42566119838979,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.8425084185149169e-20,0,6.3476649067237265e-20,-1.436906691722195e-19],"servo_velocity":[0,0,-3.4694469519536142e-18,0,0,-2.7755575615628914e-17],"servo_effort":[1.9189150465918539,-3.3934577943726381,-0.052325256944967327,0.00094181551519745678,0.0055766631807719355,-0.0061399930361782148]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":230,"step":1840,"t":9.2000000000000011,"sim_time":9.2000000000000384,"vehicle":{"origin_ned":[0.69153001739185649,0.59117055482704561,2.7800191501040934],"origin_quat_xyzw":[-0.017318381609626725,0.088729466286014441,0.13870684923262497,0.98619854261045226],"cg_ned":[0.59268059108569937,0.560126833861322,2.4937308167079122],"linear_velocity_ned":[0.23246165317573639,0.15532383712884976,0.25941125443172469],"angular_velocity_ned":[0.002270498941019996,0.017074108787230244,0.075101559162318546]},"sensors":{"Odom":[0.69153001739185649,0.59117055482704561,2.7800191501040934,0.21976876108175467,0.088282804260954903,0.30310858043117189,-0.017318381609626787,0.088729466286014774,0.13870684923262547,0.98619854261045226,-0.0067381920289058123,0.015061950807883941,0.075263928617718703],"Pressure":[19457.800414117573],"DVL":[0.13409368281235137,-0.16013867478657834,-0.29977416067004836,7.7280286193210062,-0.002614551980207156,-0.05849850709062851,0.028178246445629253,0],"IMU":[-0.0097022464348952842,0.18079746463742,0.2785833750923723,-0.018500863142534713,0.015720871178388978,-0.027875396240950229,1.8120231425804738,0.087916226212998064,-9.6472477198629605],"FOG":[0.28077045843203896],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-46.668387450013157,105,45.246651231013047,105,105],"omega_rad_s":[-47.189352175453003,105.34090586704269,45.523232444729274,105.27532680159474,105.27592990012066],"thrust_n":[-26.637425040990617,130.68084374297715,22.507447717622746,126.86385604185736,127.65885550661169],"torque_nm":[0.49945171951857409,-2.4502658201808218,-0.42201464470542649,-2.3786973007848253,-2.3936035407489689],"angle_rad":[-367.97492057035186,376.29575605524394,-87.442925770679864,740.52674204225104,740.52226745438793]},"command":[-0.44446083285726817,1,0.43092048791440996,1,1],"arm":{"servo_position":[5.4944645008222292e-22,1.6263032587282569e-20,1.0778494253810979e-21,0,6.3476649067237265e-20,-4.9127910940749275e-21],"servo_velocity":[0,3.4694469519536142e-18,-6.9388939039072284e-18,0,0,0],"servo_effort":[1.8955148574223071,-3.3938976095017894,-0.051340164076128965,0.00094133406730713084,0.0055762284097285019,-0.0061434265606442858]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":231,"step":1848,"t":9.2400000000000002,"sim_time":9.2400000000000446,"vehicle":{"origin_ned":[0.70095772936688916,0.5976366483074218,2.7903339862172354],"origin_quat_xyzw":[-0.017352929696290768,0.089027934331410374,0.14019709055484739,0.98596028243514633],"cg_ned":[0.60200921854105383,0.56632623983238295,2.5041089313081781],"linear_velocity_ned":[0.23380404681013409,0.15472235176883731,0.25948506473168975],"angular_velocity_ned":[0.0029032419047214635,0.016632858459391928,0.074975637520446642]},"sensors":{"Odom":[0.70095772936688916,0.5976366483074218,2.7903339862172354,0.220747742628423,0.086450553630019258,0.30355272189426985,-0.017352929696290795,0.089027934331410499,0.14019709055484758,0.98596028243514633,-0.0062372511374270108,0.014463451916288218,0.075221886925274567],"Pressure":[19557.864551682891],"DVL":[0.12629641372642986,-0.20344201342184046,-0.3537417586591296,7.737414346767153,-0.047785744863114932,0.0030091586605088612,-0.03757381204769901,0],"IMU":[-0.0094102490472763433,0.18141514488793525,0.28163720752662719,-0.0095315031840274914,0.099105072141255413,0.077201015902839218,1.7874291497752375,0.075968103138409571,-9.6656928016404215],"FOG":[0.27259258903767514],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-45.896493027638712,105,45.789861370373401,105,105],"omega_rad_s":[-46.401892035496758,105.33391998787391,46.08549945304997,105.26960641477311,105.27026581609371],"thrust_n":[-25.760472069422615,130.60670685336103,23.091203295630223,126.84349561940169,127.6070442117169],"torque_nm":[0.48300885130167409,-2.4488757535005194,-0.43296006179306673,-2.3783155428637817,-2.392632078969692],"angle_rad":[-369.84452662130423,380.50923462383656,-85.609139146990543,744.73762600834766,744.73317682426375]},"command":[-0.43710945740608298,1,0.43609391781307999,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,3.5772318944917241e-20,0,6.3476649067237265e-20,-4.9127910940749275e-21],"servo_velocity":[4.3368086899420177e-19,0,3.4694469519536142e-18,0,0,0],"servo_effort":[1.8727120854320625,-3.3938623016949228,-0.05016393797490637,0.00094099351759418203,0.0055771802208140174,-0.0061485055525906289]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":232,"step":1856,"t":9.2799999999999994,"sim_time":9.2800000000000509,"vehicle":{"origin_ned":[0.71043366990198653,0.60407189761128244,2.8006542608547358],"origin_quat_xyzw":[-0.017376780383105958,0.089315985508691298,0.141685471979002,0.98572101999816142],"cg_ned":[0.61139173904049915,0.57250176255297847,2.5144900526894833],"linear_velocity_ned":[0.23515516544366058,0.15412877835149921,0.25956133969717993],"angular_velocity_ned":[0.0034623292273164544,0.016201442046671045,0.074854495956980169]},"sensors":{"Odom":[0.71043366990198653,0.60407189761128244,2.8006542608547358,0.22174390476298395,0.08464299933449046,0.30399393776720735,-0.017376780383106034,0.0893159855086917,0.14168547197900264,0.98572101999816142,-0.0058058145376818308,0.013893535993726001,0.07517268245971151],"Pressure":[19655.417514066768],"DVL":[0.14760428462281383,-0.17634683343294,-0.34825978211630243,7.7762412507545156,-0.0093842249294913069,0.020533697816111921,0.060930679617987045,0],"IMU":[-0.0090981662073355996,0.1820086040084416,0.28468991383322595,-0.0012069777884999291,0.005230471553892363,-0.020289498604498413,1.8027944536483107,0.065640905975419148,-9.6896891151327846],"FOG":[0.29435878800618187],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-45.125638942732294,105,46.324370370460898,105,105],"omega_rad_s":[-45.615493612240364,105.32707999679401,46.637832716303819,105.26400588539666,105.26471764174082],"thrust_n":[-24.899427008987772,130.53274342577237,23.671292136085473,126.822869458291,127.55645776774507],"torque_nm":[0.46686425641852075,-2.447488939233232,-0.44383672755160264,-2.3779288023429568,-2.3916835831452206],"angle_rad":[-371.68265806494401,384.72243704996589,-83.75308930766397,748.94828386365168,748.94386224655716]},"command":[-0.42976798993078374,1,0.44118447971867519,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.0778494253810979e-21,0,6.3476649067237265e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[1.8504751171270359,-3.3934056345892851,-0.048817221590103169,0.00094073979155785323,0.005579712512735752,-0.0061549332020672349]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":233,"step":1864,"t":9.3200000000000003,"sim_time":9.3200000000000571,"vehicle":{"origin_ned":[0.71995831476128747,0.61047747156129817,2.8109799670797027],"origin_quat_xyzw":[-0.01739136836797045,0.08959400500018945,0.1431719636042281,0.98548071691536665],"cg_ned":[0.62082849533078499,0.57865373147456256,2.5248742873077261],"linear_velocity_ned":[0.23651473248111488,0.15354369687856301,0.25964042687942218],"angular_velocity_ned":[0.0039489869957583072,0.01577998341835635,0.074738203346469481]},"sensors":{"Odom":[0.71995831476128747,0.61047747156129817,2.8109799670797027,0.22275683045149117,0.082859545747588137,0.30443302869401301,-0.017391368367970492,0.089594005000189672,0.14317196360422843,0.98548071691536665,-0.0054425182629648482,0.013352389307944326,0.075116536855481308],"Pressure":[19752.943582530683],"DVL":[0.097726113423218908,-0.16197627390567312,-0.32064695374383789,7.7050116542759906,0.0024131578614117431,-0.017959274550286921,-0.0073541289880538364,0],"IMU":[-0.0087688775990115691,0.18257893203343217,0.28774118117122527,0.00079726951939996724,0.0032357457952011861,0.052472889943975962,1.8187234988731467,0.059922076880445221,-9.6014119565192555],"FOG":[0.286057030937307],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-44.356106478058962,105,46.850482745956896,105,105],"omega_rad_s":[-44.830319359086481,105.32038281242255,47.180590566828222,105.25852282911593,105.25928302288473],"thrust_n":[-24.054408428182604,130.45896551238312,24.247715645940499,126.80192889703403,127.50705724040814],"torque_nm":[0.45102015802842393,-2.446105603357184,-0.45464466836138434,-2.3775361668193891,-2.3907573232576529],"angle_rad":[-373.48936094132523,388.93536909960363,-81.875165406948994,753.15872034868335,753.1543283045155]},"command":[-0.42243910931484724,1,0.44619507377101808,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.0778494253810979e-21,0,6.3476649067237265e-20,-4.9127910940749275e-21],"servo_velocity":[-4.3368086899420177e-19,-3.4694469519536142e-18,-3.4694469519536142e-18,0,0,0],"servo_effort":[1.8287826793309452,-3.3925375031527683,-0.04729558976918867,0.0009405566431339074,0.005583628916186893,-0.0061630132256108739]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":234,"step":1872,"t":9.3599999999999994,"sim_time":9.3600000000000634,"vehicle":{"origin_ned":[0.72953212736907569,0.61685454599567546,2.8213111095089389],"origin_quat_xyzw":[-0.017398098306098671,0.089862380814156761,0.14465653744912019,0.98523933379812545],"cg_ned":[0.63031981923114466,0.58478249966845319,2.5352617548696639],"linear_velocity_ned":[0.23788247439508853,0.15296770546295366,0.25972264252643501],"angular_velocity_ned":[0.0043648300482004524,0.015368634372377397,0.074626737659261186]},"sensors":{"Odom":[0.72953212736907569,0.61685454599567546,2.8213111095089389,0.22378609061160318,0.08109951345145,0.30487075457977147,-0.017398098306098678,0.089862380814156803,0.14465653744912024,0.98523933379812545,-0.0051456086641297853,0.012840102096793496,0.075053654988316468],"Pressure":[19853.427246572246],"DVL":[0.11488851329122654,-0.19829266297423939,-0.31324812926605428,7.7083546800071163,-0.00072121988825839766,0.020876653536199014,0.0068293424545453887,0],"IMU":[-0.0084251954271329556,0.18312723327963132,0.29079070363458753,-0.00030597030469677565,0.082626639614277533,0.044031754691832466,1.8179077682429954,0.062692286999575644,-9.6409789101650976],"FOG":[0.29416056383459882],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-43.58823045295641,105,47.368482332474819,105,105],"omega_rad_s":[-44.046586456920096,105.31382541986544,47.714117058926561,105.2531549013721,105.25395965649665],"thrust_n":[-23.22558072828004,130.38538444634386,24.820485534286114,126.78062951232404,127.45880333042467],"torque_nm":[0.4354796386552508,-2.4447259583689473,-0.46538410376786471,-2.377136803356076,-2.389852562445463],"angle_rad":[-375.26468903017434,393.14803641696727,-79.975742574318616,757.36894010948402,757.36457948837449]},"command":[-0.41512600431387059,1,0.45112840316642683,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.8425084185149169e-20,0,6.3476649067237265e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,-3.4694469519536142e-18,0,0,0],"servo_effort":[1.8076006332162806,-3.3912891979478061,-0.045602883293301838,0.00094229376276085727,0.0055890322629815019,-0.0061725394422266298]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":235,"step":1880,"t":9.4000000000000004,"sim_time":9.4000000000000696,"vehicle":{"origin_ned":[0.73915555913410913,0.62320430040293551,2.8316477034293603],"origin_quat_xyzw":[-0.017398337964725778,0.090121503375047721,0.1461391671751063,0.98499683059533372],"cg_ned":[0.6398660314132627,0.59088844447004352,2.5456525869124644],"linear_velocity_ned":[0.23925810890323185,0.15240141540474869,0.25980826357096992],"angular_velocity_ned":[0.0047117709390973048,0.014967571679845793,0.074520045877369961]},"sensors":{"Odom":[0.73915555913410913,0.62320430040293551,2.8316477034293603,0.22483123998916699,0.079362173663547156,0.30530782256872174,-0.017398337964725844,0.090121503375048054,0.14613916717510686,0.98499683059533372,-0.0049130409246155755,0.012356686971471799,0.074984268622833694],"Pressure":[19952.266522248869],"DVL":[0.1291151035373862,-0.24570669676393486,-0.29496050144371527,7.6553638561454784,0.0097996337914426461,-0.010123572496963969,-0.01012463120635515,0],"IMU":[-0.0080698507083632708,0.18365462299887464,0.29383818340591317,0.068383337634076322,0.052928534298663177,0.0081730575509013775,1.8368313560460734,0.056132229407742519,-9.6373237943068322],"FOG":[0.29116550803278352],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-42.822396295226262,105,47.878644344825759,105,105],"omega_rad_s":[-43.26456743023553,105.30740486915997,48.238741554880477,105.24789979711663,105.24874528897831],"thrust_n":[-22.413149715474109,130.31201078015474,25.389621934819022,126.75893130693345,127.41165721156062],"torque_nm":[0.42024655716513948,-2.4433502021279012,-0.47605541127785672,-2.3767299620050029,-2.3889685727167622],"angle_rad":[-377.00870606994488,397.36044452714481,-78.055182521030204,761.57894769920256,761.57462019736795]},"command":[-0.40783234566882154,1,0.45598708899834056,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.0778494253810979e-21,0,6.3476649067237265e-20,-1.436906691722195e-19],"servo_velocity":[-4.3368086899420177e-19,0,0,0,0,0],"servo_effort":[1.7868873165090133,-3.3896793328499757,-0.043747961439590498,0.00094341146992089778,0.0055958491919821038,-0.0061835119565834228]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":236,"step":1888,"t":9.4399999999999995,"sim_time":9.4400000000000759,"vehicle":{"origin_ned":[0.74882904964846808,0.6295279148788232,2.8419897739072222],"origin_quat_xyzw":[-0.017393411935514379,0.090371764682278047,0.14761982802957482,0.98475316691136927],"cg_ned":[0.64946744132500434,0.59697196812191067,2.5560469253284324],"linear_velocity_ned":[0.24064136018716792,0.15184546353643488,0.25989754188695113],"angular_velocity_ned":[0.0049920331210267319,0.014576995915784447,0.074418034061392496]},"sensors":{"Odom":[0.74882904964846808,0.6295279148788232,2.8419897739072222,0.22589183154993031,0.077646754719009919,0.30574490394664289,-0.017393411935514413,0.090371764682278213,0.1476198280295751,0.98475316691136927,-0.0047424659983455551,0.011902070552171858,0.074908629215855102],"Pressure":[20050.712373390263],"DVL":[0.11899437907263356,-0.20213227513766863,-0.29335653687944013,7.6575103959177158,-0.0076926833884874302,-0.021665989282285927,-0.016149023158003494,0],"IMU":[-0.0077054808027642698,0.1841622232138109,0.2968833322132573,-0.04192890394986664,0.057051186699466044,0.054892044166555264,1.8298427959178154,0.026321398608199546,-9.6396790517225242],"FOG":[0.29388039553555573],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-42.059040609074408,105,48.381237903492121,105,105],"omega_rad_s":[-42.484588787023931,105.30111827398012,48.75478111639822,105.24275524994557,105.24363771475261],"thrust_n":[-21.61735592214151,130.23885363646937,25.955154058754388,126.7367986063627,127.36557957088351],"torque_nm":[0.40532542354015327,-2.4419785056838013,-0.48665913860164484,-2.376314973869301,-2.3881046169540663],"angle_rad":[-378.72148792844445,401.57259883866044,-76.11383407246899,765.78874757965798,765.78445474166904]},"command":[-0.4005622915149944,1,0.46077369431897258,1,1],"arm":{"servo_position":[-1.618957894888786e-21,-1.0842021724855024e-21,-3.3616620094155045e-20,0,6.3476649067237265e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,-6.9388939039072284e-18,-2.1684043449710089e-19,0,0],"servo_effort":[1.766598490134355,-3.3877187180411892,-0.041735072402176651,0.00094464514531014047,0.0056039973719340559,-0.0061959245045163924]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":237,"step":1896,"t":9.4800000000000004,"sim_time":9.4800000000000821,"vehicle":{"origin_ned":[0.75855302743369013,0.63582656814527305,2.8523373555162044],"origin_quat_xyzw":[-0.017384596400993827,0.090613557811003526,0.14909849654621926,0.98450830228925101],"cg_ned":[0.65912434751763871,0.6030334988735051,2.5664449216374718],"linear_velocity_ned":[0.24203195412331746,0.15130050568335315,0.25999070443940425],"angular_velocity_ned":[0.0052080795119437261,0.014197115836697813,0.074320582829623352]},"sensors":{"Odom":[0.75855302743369013,0.63582656814527305,2.8523373555162044,0.22696741217001998,0.07595246283731881,0.3061826325172865,-0.017384596400993903,0.090613557811003928,0.1490984965462199,0.98450830228925101,-0.0046313060508027613,0.011476095853306943,0.074827010167771366],"Pressure":[20150.683023758826],"DVL":[0.15247001692466491,-0.18020417977860878,-0.29543925198581905,7.6797855980372844,-0.014152029373849502,-0.02781117133419507,0.0074473328425540032,0],"IMU":[-0.0073346190414373272,0.18465115943188515,0.29992587208366078,0.048045039058269019,0.065182370733635892,-0.087018575894840786,1.835101426833359,0.051338746405725028,-9.6628798591424125],"FOG":[0.28215820501967909],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-41.298637771025867,105,48.876518269997845,105,105],"omega_rad_s":[-41.707027744595955,105.29496281060858,49.262540534375162,105.23771903223727,105.23863477531307],"thrust_n":[-20.838466365468477,130.16592079269765,26.517118649484654,126.71419938654925,127.32053065646504],"torque_nm":[0.39072124435253397,-2.4406110148630806,-0.49719597467783727,-2.3758912384977977,-2.3872599498087195],"angle_rad":[-380.4031247029979,405.7845046459982,-74.152033647155022,769.99834412288601,769.99408734429039]},"command":[-0.39332035972405588,1,0.46549065019045566,1,1],"arm":{"servo_position":[-1.618957894888786e-21,-1.0842021724855024e-21,1.0778494253810979e-21,1.0842021724855045e-21,6.3476649067237265e-20,-4.9127910940749275e-21],"servo_velocity":[-4.3368086899420177e-19,0,0,2.1684043449710089e-19,0,0],"servo_effort":[1.7467084425145778,-3.3854320335278407,-0.039574314166792614,0.00094587103502550142,0.0056135073996989053,-0.0062097152915999579]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":238,"step":1904,"t":9.5199999999999996,"sim_time":9.5200000000000884,"vehicle":{"origin_ned":[0.76832790984834221,0.64210143509509965,2.8626904913447473],"origin_quat_xyzw":[-0.017373114273209613,0.090847276118668191,0.15057515074367053,0.98426219641962742],"cg_ned":[0.66883703733235611,0.6090734913405127,2.5768467355120044],"linear_velocity_ned":[0.24342960779685793,0.15076720492771037,0.26008793914611722],"angular_velocity_ned":[0.0053626147718454746,0.01382814889982527,0.074227541248735526]},"sensors":{"Odom":[0.76832790984834221,0.64210143509509965,2.8626904913447473,0.22805751262672563,0.074278475556047677,0.30662158785693522,-0.017373114273209648,0.090847276118668371,0.15057515074367084,0.98426219641962742,-0.0045767519188047792,0.01107851942381307,0.074739701419457127],"Pressure":[20250.485828950619],"DVL":[0.11955408158295588,-0.18959399026094392,-0.32757568982788876,7.7392981134776857,-0.031492950700396205,-0.0072380391236130572,0.0097934913912389749,0],"IMU":[-0.0069596851310391519,0.18512255679591594,0.30296553700202367,-0.088463821397004955,0.097110111400793592,-0.1226066621224226,1.8341819352304836,0.070596700367912463,-9.643409979085197],"FOG":[0.28891727612666318],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-40.541707767667091,105,49.364741844102738,105,105],"omega_rad_s":[-40.932310437795969,105.28893571662844,49.762315388765501,105.23278895427619,105.23373435793555],"thrust_n":[-20.07676835483073,130.0932191414758,27.075562420219036,126.69110646088808,127.27647101427269],"torque_nm":[0.37643940665307624,-2.4392478589026716,-0.50766679537910708,-2.3754582461416511,-2.3864338315176132],"angle_rad":[-382.05372269525026,409.9961671320774,-72.170105689943384,774.20774161267377,774.20352214293916]},"command":[-0.38611150254921039,1,0.47014039851526418,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,-1.6269385334386973e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,-3.4694469519536142e-18,0,0,0],"servo_effort":[1.7271892356486593,-3.3828422872514072,-0.037264078099267205,0.000945609457720289,0.0016563582427261772,-0.0062247853550628724]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":239,"step":1912,"t":9.5600000000000005,"sim_time":9.5600000000000946,"vehicle":{"origin_ned":[0.7781541030454584,0.6483536844166472,2.8730492319411138],"origin_quat_xyzw":[-0.017360130362801342,0.091073312566239906,0.15204976967086176,0.98401480941855557],"cg_ned":[0.67860578651784997,0.61509242701587519,2.5872525332830367],"linear_velocity_ned":[0.24483402362458043,0.1502462384760474,0.26018939329014656],"angular_velocity_ned":[0.0054585709049417251,0.013470336378551176,0.074138704119833934]},"sensors":{"Odom":[0.7781541030454584,0.6483536844166472,2.8730492319411138,0.22916165054562759,0.072623953501762789,0.30706229195855134,-0.017360130362801388,0.091073312566240142,0.15204976967086214,0.98401480941855557,-0.0045757688540865021,0.010709027509894151,0.074646985714295122],"Pressure":[20348.141088376728],"DVL":[0.12776895221715034,-0.18817538671662815,-0.31893390010028078,7.6954001071728513,0.015045461209339979,0.0072019281570242909,-0.01391991114252778,0],"IMU":[-0.0065829757480014165,0.18557753637927837,0.30600207319567796,-8.1915473452193362e-05,0.017384255223970933,0.011657805639981603,1.8487102314485435,0.042438858597516366,-9.6290081095962812],"FOG":[0.29915959164073491],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-39.788818124121292,105,49.846153248735725,105,105],"omega_rad_s":[-40.160912171850931,105.28303428940666,50.254391641298518,105.22796286329357,105.22893439438268],"thrust_n":[-19.332565291398229,130.02075508553435,27.630540192416333,126.66749721876957,127.2333618677759],"torque_nm":[0.36248559921371681,-2.4378891578537689,-0.51807262860780634,-2.3750155728519298,-2.385625535020798],"angle_rad":[-383.67340637389066,414.20759137067108,-70.16836303997114,778.41694424605419,778.41276319181895]},"command":[-0.37894112499163135,1,0.47472526903557832,1,1],"arm":{"servo_position":[2.7178507950532318e-21,-1.0842021724855024e-21,-3.3616620094155045e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[8.6736173798840355e-19,0,-3.4694469519536142e-18,0,0,0],"servo_effort":[1.7080048393993625,-3.3799645680317036,-0.034809162382998943,0.00094594406997287124,0.0016649501571586222,-0.0062411119797838328]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":240,"step":1920,"t":9.5999999999999996,"sim_time":9.6000000000001009,"vehicle":{"origin_ned":[0.78803200285156316,0.65458447771939055,2.8834136339460166],"origin_quat_xyzw":[-0.017346749324003801,0.091292061287860132,0.15352233298400994,0.98376610182952051],"cg_ned":[0.68843085872848009,0.62109081446673264,2.5976624867173355],"linear_velocity_ned":[0.24624489713195907,0.14973828434278241,0.26029519989162109],"angular_velocity_ned":[0.0054987935861019214,0.01312412917986109,0.074053869970214903]},"sensors":{"Odom":[0.78803200285156316,0.65458447771939055,2.8834136339460166,0.23027940946364694,0.070988102448320836,0.30750522335329156,-0.017346749324003808,0.09129206128786016,0.15352233298401,0.98376610182952051,-0.0046253463725228136,0.010367505394207046,0.074549152631220528],"Pressure":[20448.297254964771],"DVL":[0.15920688788774479,-0.22248413056575286,-0.31997349254140933,7.698552524407293,-0.013549405529059262,0.025130364149603492,0.018172959533105944,0],"IMU":[-0.0062066600189701554,0.1860172167170801,0.30903523905740266,0.0040845996054846793,-0.017927838698112993,0.18210281117366445,1.8522576695151558,0.031649523289096149,-9.626883149775697],"FOG":[0.3220147102126531],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-39.040577513236514,105,50.3209824325574,105,105],"omega_rad_s":[-39.393356108724412,105.27725588421939,50.739043938862416,105.22323864372463,105.22423285825171],"thrust_n":[-18.606171681625316,129.94853545826584,28.182112183381662,126.64334762591746,127.19117085887474],"torque_nm":[0.3488657190304747,-2.4365350398424841,-0.52841460343840618,-2.3745627679859531,-2.3848344536039012],"angle_rad":[-385.26232031952213,418.41878232875678,-68.147107351479789,782.62595613477811,782.62181446336058]},"command":[-0.37181502393558585,1,0.47924745173864192,1,1],"arm":{"servo_position":[2.7178507950532318e-21,-1.0842021724855024e-21,1.0778494253810979e-21,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,6.9388939039072284e-18,0,0,-2.7755575615628914e-17],"servo_effort":[1.6891571063992146,-3.3767408902319525,-0.032206394129944207,0.00094694121839602335,0.0016739414239787618,-0.0062588222917824817]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":241,"step":1928,"t":9.6400000000000006,"sim_time":9.6400000000001071,"vehicle":{"origin_ned":[0.79796199729246853,0.66079497194566694,2.8937837587137833],"origin_quat_xyzw":[-0.017334018368137496,0.091503922319217404,0.15499282145448018,0.98351603408637478],"cg_ned":[0.69831250536495382,0.62706918961842639,2.6080767726315024],"linear_velocity_ned":[0.24766192154104388,0.14924403069207332,0.26040547441450629],"angular_velocity_ned":[0.0054861167092203561,0.012790064978289668,0.073972855055631559]},"sensors":{"Odom":[0.79796199729246853,0.66079497194566694,2.8937837587137833,0.23141040172197763,0.069370170635746325,0.30795082584839628,-0.017334018368137551,0.091503922319217681,0.15499282145448068,0.98351603408637478,-0.0047224657599162397,0.010053897540186442,0.074446517616174573],"Pressure":[20550.012463443523],"DVL":[0.1645910777531468,-0.19669430025494963,-0.28704112351235028,7.747634787295155,0.012672003408665049,-0.021839365389518185,-0.023102776372069249,0],"IMU":[-0.0058327833579737932,0.18644272305985318,0.31206480624805472,0.12486298180524331,-0.022999672254292627,0.19151768651534737,1.8371197640938612,0.028021044308931452,-9.6057963254604815],"FOG":[0.32084629450321983],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-38.297576448268806,105,50.789457867106591,105,105],"omega_rad_s":[-38.630196559233056,105.27159791223445,51.216537654038852,105.21861422187693,105.21962775873151],"thrust_n":[-17.897893170924576,129.87656697160418,28.730345296518681,126.61863198058498,127.14987114740072],"torque_nm":[0.33558549695483592,-2.4351856307175783,-0.53869397430972532,-2.3740993496359684,-2.3840600840137633],"angle_rad":[-386.82063080854056,422.62974486878562,-66.10662951092705,786.83478130690526,786.83067984975378]},"command":[-0.36473882331684576,1,0.48370912254387227,1,1],"arm":{"servo_position":[2.7178507950532318e-21,-1.8431436932253574e-20,-1.6269385334386973e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,-3.4694469519536142e-18,0,0,0,0],"servo_effort":[1.670601909236586,-3.3732225003112561,-0.029472271311770798,0.00094809416992369211,0.0016833005815544541,-0.0062776051962627625]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":242,"step":1936,"t":9.6799999999999997,"sim_time":9.6800000000001134,"vehicle":{"origin_ned":[0.8079444639786908,0.6669863144344601,2.9041596721131571],"origin_quat_xyzw":[-0.017322918892277817,0.091709295693385082,0.15646121655441561,0.98326456728531964],"cg_ned":[0.70825096522728592,0.63302811620135069,2.6184955710947033],"linear_velocity_ned":[0.24908477143771468,0.14876417699245376,0.26052026862687433],"angular_velocity_ned":[0.0054239549473050945,0.012468395928363621,0.073895365092439491]},"sensors":{"Odom":[0.8079444639786908,0.6669863144344601,2.9041596721131571,0.23255410584720265,0.067769317318315064,0.3083994841196005,-0.017322918892277873,0.091709295693385373,0.15646121655441611,0.98326456728531964,-0.0048636338930694197,0.0097676712201840293,0.074339376044801009],"Pressure":[20648.472366959391],"DVL":[0.12400852341008692,-0.20145003752474774,-0.32643221589487748,7.5344840865198917,-0.010262768814978505,0.0040548582333034258,0.0081172491044832311,0],"IMU":[-0.0054632526160477571,0.18685517207044472,0.31509056035045485,-0.079009565312928506,0.01935856975193409,0.17156353513607964,1.8437055784788423,0.038282358663547407,-9.6102666044105209],"FOG":[0.31011371697671664],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-37.560493775388764,105,51.251805319032592,105,105],"omega_rad_s":[-37.872027737944514,105.26605784019348,51.687130961282811,105.2140875606342,105.21511714525518],"thrust_n":[-17.208031643113532,129.80485431080055,29.275313248901401,126.59333904220479,127.10942550931928],"torque_nm":[0.32265059330837881,-2.4338410183275108,-0.54891212341690143,-2.3736251070413399,-2.3833017282997369],"angle_rad":[-388.34852711987156,426.84048375090549,-64.047209956901384,791.04342370840482,791.03936316443048]},"command":[-0.35771898833703586,1,0.4881124316098342,1,1],"arm":{"servo_position":[2.7178507950532318e-21,-1.8431436932253574e-20,1.0778494253810979e-21,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[4.3368086899420177e-19,-3.4694469519536142e-18,0,0,0,0],"servo_effort":[1.6522852251593656,-3.3694732897524609,-0.026623572727162842,0.00094924811611684268,0.0016929866396158796,-0.0062976043275720138]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":243,"step":1944,"t":9.7200000000000006,"sim_time":9.7200000000001197,"vehicle":{"origin_ned":[0.81797976880716039,0.67315963958849556,2.9145414431348522],"origin_quat_xyzw":[-0.017314361290289029,0.091908579061567366,0.15792749965043323,0.98301166363484982],"cg_ned":[0.71824646372063294,0.6389681857164573,2.6289190632871748],"linear_velocity_ned":[0.25051310901412932,0.14829941321719009,0.2606395991655801],"angular_velocity_ned":[0.0053158200626517334,0.012159428805526763,0.073821099473991542]},"sensors":{"Odom":[0.81797976880716039,0.67315963958849556,2.9145414431348522,0.23371000365040426,0.066184708022257843,0.30885152702229535,-0.017314361290289095,0.091908579061567727,0.15792749965043384,0.98301166363484982,-0.0050452558827486227,0.009508284414819235,0.074228042544099301],"Pressure":[20748.024154690716],"DVL":[0.11790562727900332,-0.17701170258108601,-0.32805088749924471,7.7413262413745221,-0.03157038140377777,0.0038473671025869645,-0.010166963380431866,0],"IMU":[-0.0050998266816560155,0.18725566439023128,0.31811230026889153,-0.050400469506961143,0.040583797299325257,0.014150340083763584,1.8416407984372263,0.038244006149121101,-9.6683909663713443],"FOG":[0.32006089513116065],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-36.830071787873393,105,51.70823115278435,105,105],"omega_rad_s":[-37.119497269916089,105.26063318929812,52.151071328370882,105.20965665462199,105.21069910971048],"thrust_n":[-16.536895406398703,129.73340184606133,29.817092288485831,126.56746169129775,127.06979838941311],"torque_nm":[0.31006678886997574,-2.4325012846136498,-0.55907048040910934,-2.3731399067118328,-2.3825587198014957],"angle_rad":[-389.84622351871508,431.05100363516476,-61.969119039821052,795.25188720447431,795.24786814376603]},"command":[-0.35076258845593711,1,0.49245934431223187,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,-1.6269385334386973e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[4.3368086899420177e-19,0,3.4694469519536142e-18,0,0,0],"servo_effort":[1.6342018580110422,-3.3655044364398132,-0.023663176859621722,0.00095000408675468379,0.0017029932772026064,-0.0063188275903122339]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":244,"step":1952,"t":9.7599999999999998,"sim_time":9.7600000000001259,"vehicle":{"origin_ned":[0.82806826629195074,0.67931606824850577,2.9249291433672053],"origin_quat_xyzw":[-0.017309183512029574,0.092102167458331621,0.1593916520941395,0.98275728649464866],"cg_ned":[0.72829921285316568,0.64489001760978293,2.6393474308144476],"linear_velocity_ned":[0.25194659984461099,0.14785044632928518,0.26076347096255237],"angular_velocity_ned":[0.0051653034470900147,0.011863439379278118,0.073749717180810609]},"sensors":{"Odom":[0.82806826629195074,0.67931606824850577,2.9249291433672053,0.23487757621952016,0.064615544241859946,0.30930725955990873,-0.017309183512029615,0.092102167458331843,0.15939165209413989,0.98275728649464866,-0.0052636713796361534,0.0092751089669078877,0.074112808981410663],"Pressure":[20849.725325252213],"DVL":[0.16835367981706748,-0.16590954906940231,-0.29677139330264751,7.688478652519116,0.0048710292986617956,0.015089367290264799,0.025395218338015044,0],"IMU":[-0.004744113779511683,0.18764528258381816,0.32112983885912999,-0.011144646699824956,-0.0076820629065619019,-0.030332824024244961,1.861708361700583,0.0023436632851400012,-9.6341926863090883],"FOG":[0.32217973518105986],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-36.107089350190996,105,52.158943457493457,105,105],"omega_rad_s":[-36.373302983896664,105.25532153416425,52.608598796648543,105.20531953136894,105.20637178423058],"thrust_n":[-15.88479215832546,129.6622128235889,30.355763668500099,126.54099583191416,127.03095363265619],"torque_nm":[0.29783985296860249,-2.4311664904422918,-0.56917056878437677,-2.3726436718483903,-2.3818303806123033],"angle_rad":[-391.31396134025374,435.26130908366446,-59.872617380828743,799.46017558083395,799.45619844871874]},"command":[-0.34387704143039044,1,0.49675184245231863,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.0778494253810979e-21,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,3.4694469519536142e-18,0,0,0],"servo_effort":[1.6163179553780969,-3.3613575717248239,-0.020601330538153745,0.00095084185194507255,0.0017133080541211637,-0.0063410480676375754]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":245,"step":1960,"t":9.8000000000000007,"sim_time":9.8000000000001322,"vehicle":{"origin_ned":[0.83821029923720947,0.68545670680713755,2.935322846456867],"origin_quat_xyzw":[-0.017308149204096387,0.092290452204733905,0.16085365496059897,0.98250140055309376],"cg_ned":[0.73840941099974811,0.6507942595626377,2.649780854817716],"linear_velocity_ned":[0.25338489781883489,0.14741797761023975,0.26089185466868148],"angular_velocity_ned":[0.0049760671701639565,0.011580691397526339,0.073680884097817353]},"sensors":{"Odom":[0.83821029923720947,0.68545670680713755,2.935322846456867,0.23605629432465844,0.063061053729926361,0.30976693582996728,-0.017308149204096453,0.092290452204734252,0.16085365496059958,0.98250140055309376,-0.0055151665743010912,0.0090674505504312001,0.073993990413653982],"Pressure":[20950.432058578415],"DVL":[0.14731705546088392,-0.17158742614876968,-0.2773407999940572,7.6729204088787082,0.0078185598915882608,0.013721573654901937,0.027976717829948476,0],"IMU":[-0.0043975683053401717,0.18802508721572395,0.32414300283226483,-0.085217573426507709,-0.017705545157168996,0.013198227793889308,1.8718308091713871,0.027411690341417612,-9.6161572499609989],"FOG":[0.31948144176333559],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-35.392367504925282,105,52.60413970259777,105,105],"omega_rad_s":[-35.634189529714718,105.250120501797,53.059944284871349,105.20107425117425,105.20213334077127],"thrust_n":[-15.252022625587649,129.59128965079231,30.891411067024027,126.51394146435911,126.99285534059992],"torque_nm":[0.28597542422976846,-2.4298366809523557,-0.57921395750670057,-2.372136402456734,-2.3811160376362479],"angle_rad":[-392.75201089952941,439.47140456267238,-57.75795621424507,803.66829254504444,803.66435766643247]},"command":[-0.33707016671357415,1,0.5009918066914073,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,-3.3616620094155045e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[4.3368086899420177e-19,0,-3.4694469519536142e-18,0,0,0],"servo_effort":[1.5986201166332128,-3.3570431368399221,-0.017444743981573189,0.00095249163940254445,0.0017239068020863911,-0.0063642853624335943]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":246,"step":1968,"t":9.8399999999999999,"sim_time":9.8400000000001384,"vehicle":{"origin_ned":[0.8484061984014154,0.69158264660734592,2.9457226269824943],"origin_quat_xyzw":[-0.01731194714310838,0.092473820336271717,0.16231348895475023,0.98224397190406076],"cg_ned":[0.74857724248597435,0.65668158724681758,2.6602195146569665],"linear_velocity_ned":[0.25482764847504846,0.14700270942697277,0.26102470016106522],"angular_velocity_ned":[0.0047517980874566225,0.011311463294242322,0.073614231486835532]},"sensors":{"Odom":[0.8484061984014154,0.69158264660734592,2.9457226269824943,0.2372456336445567,0.061520501995796582,0.31023077197456461,-0.017311947143108387,0.092473820336271745,0.16231348895475028,0.98224397190406076,-0.0057960013281780666,0.0088845881747446759,0.073871877774206479],"Pressure":[21050.168011183265],"DVL":[0.13264604660533977,-0.18558405478512774,-0.31149206949627589,7.5451288199706097,0.0011149197889017601,0.016391196194545349,-0.03162119770324872,0],"IMU":[-0.0040614900764528103,0.18839611436562517,0.32715163276247289,-0.0639381136880217,0.064813704296790633,0.2427272508105163,1.8750246297134545,-0.01547714493208531,-9.6312764512459577],"FOG":[0.33331806620685095],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-34.686764610002619,105,53.044012485453919,105,105],"omega_rad_s":[-34.902946441112654,105.24502777038015,53.505331469096241,105.1969189066472,105.19798198943462],"thrust_n":[-14.638876021493722,129.52063437667493,31.424121937923299,126.48630152859221,126.95546878597514],"torque_nm":[0.27447892540300733,-2.4285118945626549,-0.58920228633606198,-2.3716181536611045,-2.3804150397370343],"angle_rad":[-394.16067332723514,443.68129444469287,-55.625377698537875,807.87624172780465,807.87234931179228]},"command":[-0.33035013914288208,1,0.50518107129003731,1,1],"arm":{"servo_position":[2.7178507950532318e-21,-1.8431436932253574e-20,1.0778494253810979e-21,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,3.4694469519536142e-18,0,0,0],"servo_effort":[1.5810841289310287,-3.3525826894616291,-0.014201851863391082,0.00095398876588433156,0.0017347681395722403,-0.0063884515215205081]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":247,"step":1976,"t":9.8800000000000008,"sim_time":9.8800000000001447,"vehicle":{"origin_ned":[0.85865628261764115,0.69769496377917051,2.9561285598440192],"origin_quat_xyzw":[-0.017321190949882867,0.092652654717443189,0.16377113400777019,0.98198496810475511],"cg_ned":[0.75880287724944673,0.66255270434013558,2.6706635872657505],"linear_velocity_ned":[0.25627448646611745,0.14660533545454976,0.26116193349509986],"angular_velocity_ned":[0.0044961731120287613,0.011056042085335432,0.073549383990298714]},"sensors":{"Odom":[0.85865628261764115,0.69769496377917051,2.9561285598440192,0.23844507164737186,0.059993197299298251,0.31069894286570576,-0.01732119094988287,0.092652654717443217,0.16377113400777021,0.98198496810475511,-0.006102448729311487,0.0087257792923184467,0.073746758707392154],"Pressure":[21151.393959132562],"DVL":[0.18513510644496789,-0.18190116434101461,-0.31849877884909683,7.5226821996131124,0.016487330255621439,-0.029291732101015301,0.012362723848149473,0],"IMU":[-0.0037370239978877181,0.18875937459254635,0.33015558241744836,-0.087076328028219227,0.059532092085850571,0.030502597675155521,1.865430384684402,0.01904806242066389,-9.6429911080517421],"FOG":[0.32456606791087739],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-33.991173814747725,105,53.478742853323439,105,105],"omega_rad_s":[-34.180405617250187,105.24004106788412,53.944974975964286,105.19285162341619,105.19391597690563],"thrust_n":[-14.045625455471157,129.45024876732123,31.953984573741895,126.45808123608558,126.91876065239944],"torque_nm":[0.26335547729008424,-2.4271921643872738,-0.59913721075766058,-2.3710890231766051,-2.3797267622324898],"angle_rad":[-395.5402823096552,447.89098301048193,-53.475115250667628,812.08402668425958,812.08017682891614]},"command":[-0.32372546490235932,1,0.50932136050784227,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,-3.3616620094155045e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,-6.9388939039072284e-18,0,0,0],"servo_effort":[1.5636875930608891,-3.3479774100635247,-0.010879837097214039,0.00095550763804910799,0.0017458546699441197,-0.0064137244393777408]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":248,"step":1984,"t":9.9199999999999999,"sim_time":9.9200000000001509,"vehicle":{"origin_ned":[0.86896085824140368,0.70379471897994472,2.9665407189857582],"origin_quat_xyzw":[-0.017336419713031535,0.092827333635648102,0.16522656906302718,0.98172435823773385],"cg_ned":[0.76908647022368082,0.66840834193844068,2.6811132457650135],"linear_velocity_ned":[0.25772503034980593,0.14622653850989722,0.26130344773739023],"angular_velocity_ned":[0.004212830113271844,0.010814705963366016,0.073485942210019597]},"sensors":{"Odom":[0.86896085824140368,0.70379471897994472,2.9665407189857582,0.23965408211897929,0.058478497870894999,0.31117157329884265,-0.017336419713031539,0.092827333635648115,0.16522656906302721,0.98172435823773385,-0.0064308244117722204,0.008590253064742908,0.073618894006907798],"Pressure":[21250.429243104452],"DVL":[0.15598153024563405,-0.18816532362165911,-0.2982983033145491,7.4636936098946993,-0.015746873391120776,-0.00066882926091100376,0.016510094679777633,0],"IMU":[-0.0034251616957869419,0.18911585117204815,0.33315471825631865,-0.076312698045804608,0.12915661369460343,0.073760026769802478,1.8641861410559353,-0.0084142370805349309,-9.611588835937944],"FOG":[0.34469856893113315],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-33.306524299704989,105,53.908504984466703,105,105],"omega_rad_s":[-33.467439633950875,105.2351581707171,54.379080945915788,105.18887055965914,105.18993358493553],"thrust_n":[-13.472524661435214,129.38013466596163,32.481088017192796,126.42928907359232,126.88269932059337],"torque_nm":[0.25260983740191034,-2.425877524986781,-0.60902040032236515,-2.370549170129856,-2.3790506122611252],"angle_rad":[-396.89120574232578,452.10047445100923,-51.307393893783967,816.29165089531455,816.28784359258293]},"command":[-0.31720499333052371,1,0.5134143331853972,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,-3.3616620094155045e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,-6.9388939039072284e-18,-4.3368086899420177e-19,0,0],"servo_effort":[1.5464085165193617,-3.3432444187395336,-0.0074854359094673334,0.0009570364543212374,0.0017571646402896454,-0.0064395945919972367]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":249,"step":1992,"t":9.9600000000000009,"sim_time":9.9600000000001572,"vehicle":{"origin_ned":[0.87932021891880718,0.70988295733178119,2.9769591766435521],"origin_quat_xyzw":[-0.017358098151722304,0.092998230750820185,0.16667977159047792,0.98146211299688912],"cg_ned":[0.77942816078420241,0.67424925844145611,2.6915686586576819],"linear_velocity_ned":[0.25917888465047811,0.14586699656894445,0.26144911707466467],"angular_velocity_ned":[0.0039054053591043685,0.010587740777483149,0.073423485934976218]},"sensors":{"Odom":[0.87932021891880718,0.70988295733178119,2.9769591766435521,0.24087213770452562,0.05697580602635996,0.31164875335252645,-0.017358098151722335,0.092998230750820352,0.1666797715904782,0.98146211299688912,-0.0067774472084120817,0.0084772141920105553,0.073488528230695405],"Pressure":[21350.427171835632],"DVL":[0.16941655152537549,-0.16748700218959137,-0.34927241386372265,7.5535032542193816,0.019824797847518911,-0.015096910151666957,0.014944959152705745,0],"IMU":[-0.0031267421777490148,0.18946649890082645,0.33614891845187311,-0.011954953662959636,0.045305513874994617,0.15356272885442698,1.884661793221543,0.0066566201354999526,-9.6143995345634004],"FOG":[0.35812144957115793],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-32.633778830940088,105,54.333461359001362,105,105],"omega_rad_s":[-32.764959600300131,105.23037690239451,54.807845655957117,105.18497390604519,105.1860331292058],"thrust_n":[-12.919804526279517,129.31029387371248,33.005519474895962,126.39993572465087,126.84725430545706],"torque_nm":[0.24224633486774091,-2.4245680101321088,-0.61885349015429936,-2.3699987948372043,-2.37838601822732],"angle_rad":[-398.21384730318039,456.30977286936428,-49.122430630202395,820.4991177689318,820.49535290960796]},"command":[-0.31079789362800087,1,0.51746153675239392,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,-3.3616620094155045e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,-3.4694469519536142e-18,0,0,0],"servo_effort":[1.5292307874596673,-3.3383983696572606,-0.0040249560856795916,0.00095813616369909513,0.0017686673126107153,-0.0064663925194293889]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":250,"step":2000,"t":10,"sim_time":10.000000000000163,"vehicle":{"origin_ned":[0.88973464496508825,0.71596070819646462,2.987384002494033],"origin_quat_xyzw":[-0.017386617587356934,0.093165714421346538,0.168130717244136,0.98119820480074427],"cg_ned":[0.78982807224883489,0.68007623884630131,2.7020299888219519],"linear_velocity_ned":[0.26063564386381022,0.14552736685508574,0.26159879133514463],"angular_velocity_ned":[0.0035774607392107379,0.01037540805558526,0.073361584132566854]},"sensors":{"Odom":[0.88973464496508825,0.71596070819646462,2.987384002494033,0.24209870819909554,0.055484575350043336,0.31213053379803612,-0.017386617587356983,0.093165714421346801,0.16813071724413647,0.98119820480074427,-0.0071387188763317958,0.0083858369125352581,0.073355884400511814],"Pressure":[21450.969446485033],"DVL":[0.17930277239748071,-0.20742444629214177,-0.29027445676481306,7.5592377521538596,-0.0057499976408682879,0.005181830126125977,0.029602319477076096,0],"IMU":[-0.0028424543067718439,0.18981224195087021,0.33913807199958429,-0.0089612705128195233,0.032052071118641078,0.042386592193053782,1.8853866715748797,0.017572940964066523,-9.6149467803206949],"FOG":[0.32471432099291442],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-31.973936543321887,105,54.753764273855481,105,105],"omega_rad_s":[-32.073914933462405,105.22569513237471,55.231455359591102,105.18115988516314,105.18221295873656],"thrust_n":[-12.387672232816897,129.24072817602124,33.527363273485193,126.3700347460521,126.81239609915076],"torque_nm":[0.2322688543653168,-2.4232636533003982,-0.62863806137784739,-2.369438151488477,-2.3777324268590774],"angle_rad":[-399.50864798943422,460.51888228261481,-46.920434837160371,824.70643064142166,824.70270802018536]},"command":[-0.30451368136497037,1,0.52146442165576645,1,1],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,-3.3616620094155045e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,-6.9388939039072284e-18,0,0,0],"servo_effort":[1.512136098319852,-3.3334465973206684,-0.00050473067704556035,0.0009591081525938737,0.001780350526695192,-0.0064937887894953271]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":251,"step":2008,"t":10.040000000000001,"sim_time":10.04000000000017,"vehicle":{"origin_ned":[0.90020424927065323,0.72202892134891228,2.9978149008873785],"origin_quat_xyzw":[-0.017422283883005815,0.093330195197732876,0.16957947499513545,0.98093258705633135],"cg_ned":[0.80028613450341113,0.68589001894305235,2.712497040238107],"linear_velocity_ned":[0.2620821087230088,0.14520284753059029,0.26172818335899417],"angular_velocity_ned":[0.0032345826765822708,0.01018558250532004,0.073313701207100818]},"sensors":{"Odom":[0.90020424927065323,0.72202892134891228,2.9978149008873785,0.2433261247834021,0.054003688027321306,0.31259032043661739,-0.017422283883005853,0.093330195197733085,0.16957947499513584,0.98093258705633135,-0.0075092998537848524,0.0083217226636737533,0.073235693130899185],"Pressure":[21552.585103034591],"DVL":[0.10779953667065345,-0.21155463379238315,-0.33278225861732669,7.4855430495318362,-0.020188122677430202,-0.027156869126845756,-0.030554309030087785,0],"IMU":[-0.0025727777769252958,0.19015406290499373,0.34212227970638376,0.036923921914159684,0.0099259858279313311,-0.029839537532760571,1.8864778027170874,0.0089257251316751211,-9.6172176347183971],"FOG":[0.34398800742139923],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-31.328078826892504,105,53.460092660695601,103.89325501285114,103.89325501285114],"omega_rad_s":[-31.395301073650032,105.2211107511764,55.276613302415321,104.91523402515114,104.91627894340452],"thrust_n":[-11.876317833451928,129.17162850510212,33.554943636638136,125.6743403674301,126.11197966826758],"torque_nm":[0.22268095937722365,-2.4219680344706651,-0.62915519318696511,-2.3563938818893146,-2.3645996187800167],"angle_rad":[-400.77608773162331,464.72780662337482,-44.70773393095498,828.90886830771706,828.9051876311687]},"command":[-0.29836265549421431,1,0.50914373962567239,0.98945957155096331,0.98945957155096331],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,-3.3616620094155045e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,-6.9388939039072284e-18,0,0,0],"servo_effort":[1.5045189832718384,-3.3163060813650636,0.0042877240989282542,0.00096006950073855351,0.0017903417166797526,-0.0065209188408389763]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":252,"step":2016,"t":10.08,"sim_time":10.080000000000176,"vehicle":{"origin_ned":[0.91072789156942402,0.72808800578342225,3.008249234052315],"origin_quat_xyzw":[-0.01746520620355535,0.093492450890958811,0.17102691959663102,0.98066504014977318],"cg_ned":[0.81080084171587052,0.69169074921586338,2.7229673454699204],"linear_velocity_ned":[0.26346644295268073,0.14487180944230102,0.26176089961908205],"angular_velocity_ned":[0.0028903170266740197,0.010048507504874123,0.073338629834655097]},"sensors":{"Odom":[0.91072789156942402,0.72808800578342225,3.008249234052315,0.24452067592637647,0.052529764615420776,0.31294160087133727,-0.017465206203555395,0.093492450890959061,0.17102691959663149,0.98066504014977318,-0.0078776372031245535,0.0083086796481595705,0.073190093156211819],"Pressure":[21653.827067601916],"DVL":[0.13741765922245874,-0.19033466954457615,-0.31637393098267835,7.5753630117470312,0.0060483661273342598,0.00155166752598423,-0.014165659098802698,0],"IMU":[-0.0023175061764416508,0.1904936079510299,0.34510336256255614,-0.057088495193931797,-0.024111528921371795,0.14769584152213489,1.8972738910596603,-0.0099901039183438126,-9.6333362842467736],"FOG":[0.34620139028045377],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-30.698335760255876,105,51.104259290783801,102.41034221356286,102.41034221356286],"omega_rad_s":[-30.730403503167903,105.21662130867038,54.505805970291341,104.23165284013017,104.23268816895784],"thrust_n":[-11.386105506896946,129.10414466239652,32.521078219672049,123.92944750597339,124.36313150565761],"torque_nm":[0.21348947825431774,-2.4207027124199345,-0.609770216618851,-2.3236771407370007,-2.3318087157310807],"angle_rad":[-402.01669174582474,468.93654973423941,-42.512531814095361,833.09073962817388,833.08710053736047]},"command":[-0.2923651024786274,1,0.48670723134079807,0.9753365925101225,0.9753365925101225],"arm":{"servo_position":[5.4944645008222292e-22,-1.8431436932253574e-20,1.0778494253810979e-21,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,6.9388939039072284e-18,0,0,0],"servo_effort":[1.5163898933700106,-3.2794329709197343,0.010841872222561687,0.00096322122631296143,0.0017963347957835644,-0.0065457941594139054]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":253,"step":2024,"t":10.120000000000001,"sim_time":10.120000000000182,"vehicle":{"origin_ned":[0.92130262007128028,0.73413757636618948,3.018681400212738],"origin_quat_xyzw":[-0.017515221340139747,0.093653748277536392,0.17247511441575647,0.98039508738173786],"cg_ned":[0.82136863955062012,0.69747771397669023,2.7334355666619281],"linear_velocity_ned":[0.26474419741911398,0.14451529476427322,0.26163586717045628],"angular_velocity_ned":[0.0025585500777107477,0.0099875109852867305,0.073487542670126069]},"sensors":{"Odom":[0.92130262007128028,0.73413757636618948,3.018681400212738,0.2456513336890358,0.051059231701903129,0.31311487710771446,-0.017515221340139761,0.093653748277536461,0.17247511441575661,0.98039508738173786,-0.0082325822602558885,0.0083637568001183344,0.073273376088396333],"Pressure":[21754.046969307004],"DVL":[0.15394045667129441,-0.2110313128075367,-0.35205520393119227,7.4950011225500628,0.012185574180265255,-0.012875824840366009,-0.013656401162161722,0],"IMU":[-0.0020754705314039268,0.19083339738947511,0.34808567629003578,0.062212764711026991,-0.074202659125754883,0.20855422630756987,1.8827889131593751,0.00018868701507285517,-9.6509875475036146],"FOG":[0.34008045381699148],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-30.087369678595785,105,48.66576707711738,100.93775403926823,100.93775403926823],"omega_rad_s":[-30.080994399644862,105.21222373644001,53.153813069817645,103.26802068235519,103.26904454754504],"thrust_n":[-10.917697059087631,129.03943712213993,30.770986610412336,121.50332331528608,121.93532480280375],"torque_nm":[0.2047068198578931,-2.4194894460401239,-0.57695599894523131,-2.2781873121616143,-2.2862873400525703],"angle_rad":[-403.23104827771101,473.14511534510842,-40.361902317782615,837.23859228929769,837.23499436128657]},"command":[-0.28654637789138843,1,0.46348349597254646,0.96131194323112601,0.96131194323112601],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,-3.3616620094155045e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[1.5413578542244712,-3.2301308998387048,0.018460439698389855,0.00096947010565967323,0.0017996040382482377,-0.0065693872744999717]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":254,"step":2032,"t":10.16,"sim_time":10.160000000000188,"vehicle":{"origin_ned":[0.93192425745523755,0.74017668210766485,3.0291039085272291],"origin_quat_xyzw":[-0.017571935001269603,0.093815602594614717,0.17392690405780259,0.98012208007726676],"cg_ned":[0.83198463069491801,0.70324961878699765,2.7438945213592461],"linear_velocity_ned":[0.26588941814864869,0.14412199212132853,0.26131734134857842],"angular_velocity_ned":[0.0022507692310598281,0.010012909805007781,0.073790039864784759]},"sensors":{"Odom":[0.93192425745523755,0.74017668210766485,3.0291039085272291,0.24669840926177855,0.049589094991324634,0.31306994515930575,-0.017571935001269672,0.093815602594615077,0.17392690405780326,0.98012208007726676,-0.0085653811819482555,0.0084924914330531363,0.07351738666879204],"Pressure":[21853.337878548158],"DVL":[0.13639041386187467,-0.19915452228288608,-0.32836787349493107,7.5661077749775503,-0.017916110623964504,0.030299947426302456,0.030097968548467226,0],"IMU":[-0.0018447786757731515,0.19117635703105226,0.35107525511393978,0.038798272419735033,0.031661984775995813,0.091225735550326537,1.882782587866773,-0.013115041628453198,-9.6473124488891173],"FOG":[0.35775905959742571],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-29.497136358454416,105,46.155186530608368,99.488748879722621,99.488748879722621],"omega_rad_s":[-29.448987798379228,105.20791479751369,51.383887834992549,102.12239155225224,102.12340112354835],"thrust_n":[-10.471762653580557,128.97818343722315,28.563706718175538,118.65996728735905,119.09320258298807],"torque_nm":[0.19634554975463547,-2.4183409394479347,-0.53556950096579137,-2.2248743866379823,-2.2329975484310265],"angle_rad":[-404.4198205719627,477.35350705780576,-38.275220449846863,841.34354362679619,841.33998634253567]},"command":[-0.28092510817575633,1,0.43957320505341302,0.9475118940925964,0.9475118940925964],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.0778494253810979e-21,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,6.9388939039072284e-18,0,0,0],"servo_effort":[1.5746690064944198,-3.1736714493364659,0.026645384253382552,0.00097857587169025706,0.001801113426998581,-0.0065917992663563447]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":255,"step":2040,"t":10.200000000000001,"sim_time":10.200000000000195,"vehicle":{"origin_ned":[0.94258791889536386,0.74620401863867014,3.0395082517050578],"origin_quat_xyzw":[-0.017634772101989802,0.093979580639834193,0.17538555442938433,0.97984527377192021],"cg_ned":[0.84264319036621449,0.70900484659665786,2.7543360153813925],"linear_velocity_ned":[0.26688929224254543,0.14368609491217568,0.26078722494801093],"angular_velocity_ned":[0.0019760995929110695,0.01012598292406631,0.074260469468523979]},"sensors":{"Odom":[0.94258791889536386,0.74620401863867014,3.0395082517050578,0.24765053246845251,0.04811699558809996,0.31278700834109419,-0.017634772101989798,0.093979580639834179,0.1753855544293843,0.97984527377192021,-0.0088696012614477363,0.0086926695425263781,0.073937984116099142],"Pressure":[21954.684405276152],"DVL":[0.18343187913311454,-0.18495781041779338,-0.28003472335238461,7.4640909199209302,-0.025546377719889938,0.013347769636129382,-0.0053417097108531698,0],"IMU":[-0.001623052704262756,0.19152544122737394,0.35407905166047299,-0.0029274313967550675,-0.035128789458262415,0.18847430957916098,1.8956870867073927,0.01457971006087341,-9.6347807089484867],"FOG":[0.36684360029031049],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-28.928949591105294,105,43.575928424718747,98.07204078276331,98.07204078276331],"omega_rad_s":[-28.836167020576795,105.20369142829185,49.308312752280784,100.86438640481644,100.86537801355755],"thrust_n":[-10.048782279532684,128.92071238214908,26.086328013567687,115.5854590407186,116.02291700373569],"torque_nm":[0.1884146677412378,-2.4172633571652957,-0.48911865025439422,-2.1672273570134744,-2.1754296938200444],"angle_rad":[-405.58374595338069,481.56172834783092,-36.266535782429472,845.3999613395074,845.39644404689454]},"command":[-0.27551380562957423,1,0.41500884214017852,0.93401943602631721,0.93401943602631721],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,-1.6269385334386973e-20,2.1684043449710089e-21,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[4.3368086899420177e-19,0,-3.4694469519536142e-18,4.3368086899420177e-19,0,0],"servo_effort":[1.6129269386543139,-3.113757898248855,0.03503835889345705,0.00099008620967804299,0.0018015079433660452,-0.0066129467835421285]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":256,"step":2048,"t":10.24,"sim_time":10.240000000000201,"vehicle":{"origin_ned":[0.9532883776061587,0.75221808480499985,3.0498855068747268],"origin_quat_xyzw":[-0.017703021207146737,0.09414717140621448,0.17685450121359081,0.97956388181518816],"cg_ned":[0.8533383958457168,0.71474163921649736,2.764751417886131],"linear_velocity_ned":[0.26774004870723289,0.14320564252341833,0.26003951359969391],"angular_velocity_ned":[0.0017415980027881677,0.010322192951608437,0.074902675462016746]},"sensors":{"Odom":[0.9532883776061587,0.75221808480499985,3.0498855068747268,0.24850229277591862,0.046641143170884643,0.31226019406363104,-0.017703021207146796,0.094147171406214786,0.17685450121359139,0.97956388181518816,-0.009140733806132369,0.0089572838301285439,0.074539960250685044],"Pressure":[22055.468905227754],"DVL":[0.15870197518091,-0.17501344842646813,-0.35348954095171564,7.4404067667694065,0.0079924858535260872,0.012567632251160085,-0.0044803533065819042,0],"IMU":[-0.0014076129271685812,0.19188338944674815,0.35710440357415835,-0.060703813449384969,-0.011387414361871422,0.25000657138285465,1.8868760922881991,-0.0047693367956178154,-9.6771278340664093],"FOG":[0.36115261634923462],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-28.383640171815163,105,40.924832714586969,96.693070904797679,96.693070904797679],"omega_rad_s":[-28.244049742410287,105.19955088748789,47.002574096223576,99.543181348615818,99.544150860712179],"thrust_n":[-9.6489690826207006,128.86711149003679,23.470306995037042,112.40872927359892,112.8531275066026],"torque_nm":[0.18091817029913815,-2.4162583404381905,-0.4400682561569445,-2.1076636738799803,-2.1159961407487993],"angle_rad":[-406.72362721937259,485.76978257512656,-34.346274758457618,849.40451490099156,849.40103678932303]},"command":[-0.27032038258871582,1,0.38976031156749497,0.92088638956950175,0.92088638956950175],"arm":{"servo_position":[2.7178507950532318e-21,-1.0842021724855024e-21,-3.3616620094155045e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[4.3368086899420177e-19,0,-6.9388939039072284e-18,0,0,0],"servo_effort":[1.653760593969416,-3.0529218537299241,0.04339795735599887,0.0010046927464910035,0.0018012331984236336,-0.006633091311707316]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":257,"step":2056,"t":10.279999999999999,"sim_time":10.280000000000207,"vehicle":{"origin_ned":[0.96402031379497899,0.75821729359985002,3.0602267409737003],"origin_quat_xyzw":[-0.017775870139983482,0.094319700771276188,0.17833717949451777,0.97927711241360238],"cg_ned":[0.86406431765470126,0.72045822216387823,2.7751320498777154],"linear_velocity_ned":[0.26844395931197984,0.14268128730626145,0.25907623196970286],"angular_velocity_ned":[0.0015529598319115466,0.010592528666028708,0.075713533656730586]},"sensors":{"Odom":[0.96402031379497899,0.75821729359985002,3.0602267409737003,0.24925217051022386,0.045160230282486918,0.31149286766160544,-0.017775870139983541,0.094319700771276507,0.17833717949451838,0.97927711241360238,-0.0093757994148431986,0.009275575490084606,0.075320718339839374],"Pressure":[22155.299400926262],"DVL":[0.1728589179465283,-0.16531273837233595,-0.29361586088307545,7.5217639041285249,0.019255806377084586,0.024304596070734173,0.01257155199260207,0],"IMU":[-0.0011956146433756449,0.19225256824111214,0.36015867054099615,-0.010528896539972313,-0.0092229381495288823,0.30490104058589729,1.8794087601005569,-0.010680467251032045,-9.6445702909548956],"FOG":[0.34923416459051121],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-27.861711267883972,105,38.192106957047258,95.354948389625719,95.354948389625719],"omega_rad_s":[-27.673850400343348,105.19549079405776,44.514998665832302,98.193257580098702,98.194200817353632],"thrust_n":[-9.2722708036296968,128.81730250790477,20.805912275688804,109.21745966014113,109.67102114057332],"torque_nm":[0.17385507756805682,-2.4153244220232146,-0.39011085516916499,-2.047827368627646,-2.0563316463857495],"angle_rad":[-407.84032096229862,489.97767299808027,-32.522483205293391,853.35549359293486,853.35205368378104]},"command":[-0.26534963112270449,1,0.36373435197187864,0.908142365615483,0.908142365615483],"arm":{"servo_position":[-1.618957894888786e-21,-1.0842021724855024e-21,1.0778494253810979e-21,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[-4.3368086899420177e-19,0,6.9388939039072284e-18,0,0,0],"servo_effort":[1.6955362950264272,-2.9932151565311118,0.051480256656503964,0.0010217569688529349,0.0018004410339359552,-0.0066523029424894091]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":258,"step":2064,"t":10.32,"sim_time":10.320000000000213,"vehicle":{"origin_ned":[0.97477845295646381,0.76420003947026727,3.0705232799122304],"origin_quat_xyzw":[-0.017852426280492082,0.094498231532132673,0.17983691350721673,0.9789841978568381],"cg_ned":[0.87481520970788074,0.72615288763116703,2.785469432775634],"linear_velocity_ned":[0.2690071378639019,0.14211537123234053,0.25790438908597035],"angular_velocity_ned":[0.0014156209177826815,0.01092283732603983,0.076685463387464708]},"sensors":{"Odom":[0.97477845295646381,0.76420003947026727,3.0705232799122304,0.24990052623704884,0.043673360479912479,0.31049419853458271,-0.017852426280492117,0.094498231532132854,0.17983691350721709,0.9789841978568381,-0.009573081926110838,0.0096320453298806494,0.076272881537170753],"Pressure":[22257.595638391194],"DVL":[0.16549433332048177,-0.17271267403267235,-0.32238932696546074,7.5943649498397257,-0.0075247573390171399,0.010493898168950393,0.001532738884908455,0],"IMU":[-0.00098414961208724777,0.19263477970055853,0.36324899610444061,-0.015615185980700573,0.022148539604156262,0.23580360477647633,1.8953858748233992,0.013350841347675372,-9.6497336566505876],"FOG":[0.37390824729591571],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-27.36344456587295,105,35.360837165149427,94.059156420204971,94.059156420204971],"omega_rad_s":[-27.126495515266125,105.19150911327782,41.873144233643544,96.83854898908811,96.839462164800665],"thrust_n":[-8.9184085438867378,128.77108754708374,18.153853419764122,106.06998253790495,106.53419410069806],"torque_nm":[0.16722016019787636,-2.4144578915078205,-0.34038475162057735,-1.988812172585718,-1.9975161393880885],"angle_rad":[-408.9347257084903,494.18540278772207,-30.801760201772442,857.25231665435149,857.24891380951135]},"command":[-0.26060423396069476,1,0.3367698777633279,0.89580148971623785,0.89580148971623785],"arm":{"servo_position":[2.7178507950532318e-21,-1.0842021724855024e-21,1.0778494253810979e-21,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,0,0,0,-2.7755575615628914e-17],"servo_effort":[1.7371505450072624,-2.9361952545724295,0.059071775954407969,0.0010413307929014281,0.0017991374530557792,-0.0066701629900737551]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":259,"step":2072,"t":10.359999999999999,"sim_time":10.36000000000022,"vehicle":{"origin_ned":[0.98555765094285552,0.77016474379087285,3.0807668536514075],"origin_quat_xyzw":[-0.017931741336854497,0.094683532662705489,0.18135684635784982,0.97868441061165046],"cg_ned":[0.885585609695412,0.73182404032320858,2.7957554276389733],"linear_velocity_ned":[0.26943710619874489,0.14151093981259785,0.25653322543034862],"angular_velocity_ned":[0.0013331676035090573,0.011299352780793,0.07780814715805151]},"sensors":{"Odom":[0.98555765094285552,0.77016474379087285,3.0807668536514075,0.25044928591042281,0.042180029088454286,0.30927565717691058,-0.017931741336854528,0.094683532662705655,0.18135684635785013,0.97868441061165046,-0.0097320333055537882,0.010012205731183626,0.077386069401597771],"Pressure":[22354.356781270646],"DVL":[0.20010699300136597,-0.16022257466838483,-0.29779501105305395,7.5704230964617851,-0.0010775696032756584,0.0022336574661165477,0.024645666395728211,0],"IMU":[-0.00077032475244696592,0.19303120897895315,0.36638215506885491,-0.0026095389056423925,0.0012637968734731265,0.27187803283687406,1.8929045700372031,-0.0050124164730607325,-9.6648523704497791],"FOG":[0.37766281824330611],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-26.888978349068314,105,32.404635578490762,92.806164692014733,92.806164692014733],"omega_rad_s":[-26.602663707330343,105.18760410551556,39.087519876628733,95.495458129598518,95.49633820682557],"thrust_n":[-8.586928561597361,128.72823801677373,15.554081619432408,103.00393939666854,103.47958928660752],"torque_nm":[0.1610049105299505,-2.4136544628145069,-0.29163903036435773,-1.9313238636875354,-1.940242299123891],"angle_rad":[-410.0077712980775,498.39297504058914,-29.189997294214322,861.09518244109518,861.09181538690814]},"command":[-0.25608550808636488,1,0.30861557693800723,0.88386823516204505,0.88386823516204505],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,-3.3616620094155045e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,-6.9388939039072284e-18,0,0,0],"servo_effort":[1.7778862766083887,-2.8819754338526664,0.066176974996916271,0.0010631563849862206,0.0017974133672433339,-0.0066865913475583983]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":260,"step":2080,"t":10.4,"sim_time":10.400000000000226,"vehicle":{"origin_ned":[0.99635296344507074,0.77610989074120018,3.0909496660635072],"origin_quat_xyzw":[-0.018012837637893214,0.094876118815254096,0.18289989714097105,0.97837706810033453],"cg_ned":[0.896370385940648,0.73747022150594721,2.8059823140945852],"linear_velocity_ned":[0.26974290511125115,0.14087175942799451,0.25497435364742266],"angular_velocity_ned":[0.0013075653398048489,0.011710731357689177,0.079069706151068231]},"sensors":{"Odom":[0.99635296344507074,0.77610989074120018,3.0909496660635072,0.25090254127622719,0.040679943082243118,0.30785110509759789,-0.018012837637893266,0.094876118815254387,0.1828998971409716,0.97837706810033453,-0.0098525571389024638,0.010404415458306372,0.0786482335698757],"Pressure":[22449.682764841586],"DVL":[0.15256394816612726,-0.17054334098413029,-0.28960650021139778,7.4686833149620373,0.017249170223571579,-0.0069555615527992689,0.027642113365432756,0],"IMU":[-0.0005513127729035801,0.19344251162269874,0.36956446172908819,0.040857228353823952,0.00066343607535238915,0.038742519589943555,1.8794250379607533,-0.0036324393102675819,-9.6939451135195416],"FOG":[0.36002217052869229],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-26.438380638755167,105,29.282911054103653,91.595966003689455,91.595966003689455],"omega_rad_s":[-26.102831969689177,105.18377424631382,36.152704215320924,94.17510703421776,94.175951892150664],"thrust_n":[-8.2772520319971559,128.68850283055855,13.032088020357509,100.0426619037945,100.5299908294692],"torque_nm":[0.15519847559994668,-2.412909428072973,-0.24435165038170334,-1.8757999106961476,-1.8849373280525477],"angle_rad":[-411.06040993803128,502.60039278867714,-27.693028070336265,864.88482039870837,864.88148776041999]},"command":[-0.25179410132147778,1,0.27888486718193956,0.87234253336847101,0.87234253336847101],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,-1.6269385334386973e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,-3.4694469519536142e-18,0,0,0],"servo_effort":[1.8172730943572368,-2.8306759695055224,0.072843748301899297,0.0010864898426698867,0.001795554555457399,-0.0067015694281151363]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":261,"step":2088,"t":10.44,"sim_time":10.440000000000232,"vehicle":{"origin_ned":[1.007159729237773,0.78203406519832508,3.101064474825757],"origin_quat_xyzw":[-0.018094725634833279,0.095076287108990548,0.1844687413097508,0.97806153385835848],"cg_ned":[0.90716479994586618,0.74309013678250191,2.8161428784405991],"linear_velocity_ned":[0.26993474760827418,0.14020211290903498,0.253240967473225],"angular_velocity_ned":[0.0013398135961873825,0.012146454651257679,0.080457791794459943]},"sensors":{"Odom":[1.007159729237773,0.78203406519832508,3.101064474825757,0.2512657674123564,0.039173034980126371,0.30623605085464617,-0.018094725634833331,0.095076287108990826,0.18446874130975133,0.97806153385835848,-0.0099351521980349314,0.010798161028842602,0.080046737539423332],"Pressure":[22549.17557075671],"DVL":[0.19928364405456578,-0.16800589679997963,-0.2918631686097265,7.4870057802453509,-0.012143854353602044,0.02411745786133173,-0.0077615982739393831,0],"IMU":[-0.00032438108738188932,0.19386889256302825,0.37280172753421836,-0.060167158647800686,0.020335455006082633,0.13538187855392853,1.8865711925737179,-0.024049998460597698,-9.6561327020426582],"FOG":[0.38684421188515605],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-26.011762702767214,105,25.930506960208302,90.427763366918867,90.427763366918867],"omega_rad_s":[-25.627351965393583,105.18001819028152,33.045064319764293,92.884790516396535,92.885598972145587],"thrust_n":[-7.9887399396399745,128.65159012202164,10.6031082004554,97.199411073305356,97.698197022445001],"torque_nm":[0.14978887386824954,-2.412217314787906,-0.19880827875853874,-1.8224889576244756,-1.8318411941708437],"angle_rad":[-412.0936099051346,506.80765900712049,-26.3173074714725,868.622314586372,868.61901492554045]},"command":[-0.24773107335968775,1,0.24695720914484096,0.86121679397065587,0.86121679397065587],"arm":{"servo_position":[2.7178507950532318e-21,-9.757819552369538e-21,-1.6269385334386973e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[4.3368086899420177e-19,0,0,0,0,0],"servo_effort":[1.8550890039631975,-2.7824816787155391,0.079053931368879699,0.0011121450914305104,0.0017935976252858746,-0.0067149315310609916]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":262,"step":2096,"t":10.48,"sim_time":10.480000000000238,"vehicle":{"origin_ned":[1.0179735961558254,0.78793597216141775,3.1111046171316938],"origin_quat_xyzw":[-0.018176420947783885,0.09528413059418446,0.18606580861212249,0.97773721778602463],"cg_ned":[0.91796452580289756,0.74868266537822104,2.8262304426529523],"linear_velocity_ned":[0.27002296297845707,0.13950635331544736,0.25134653059652129],"angular_velocity_ned":[0.0014299171993591481,0.01259641967363292,0.08196034830963371]},"sensors":{"Odom":[1.0179735961558254,0.78793597216141775,3.1111046171316938,0.25154482822230878,0.037659535933687108,0.30444617205980995,-0.01817642094778393,0.095284130594184696,0.18606580861212293,0.97773721778602463,-0.0099812189853230628,0.011183693776282292,0.081569071392980586],"Pressure":[22645.353004235032],"DVL":[0.16721762406068877,-0.16979005933092894,-0.28037071601645547,7.3963950989031151,-0.012427530778862781,-0.0023632832366798236,0.0037127379831826401,0],"IMU":[-8.6924706533959441e-05,0.19431013903371766,0.37609925342620509,0.089185902610422016,0.03445387249312451,-0.030286231529287611,1.897368993761372,-0.023944168359684104,-9.683759258116277],"FOG":[0.37303184292634933],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.609217645934944,105,22.235950548692564,89.30040701456366,89.30040701456366],"omega_rad_s":[-25.176488700962604,105.17633473468307,29.714962650662223,91.629060188964417,91.629831966950434],"thrust_n":[-7.7207277009832467,128.61719990341004,8.2748614835005583,94.480535600140072,94.990146537013274],"torque_nm":[0.14476364439343592,-2.4115724981889382,-0.15515365281563551,-1.7715100425026262,-1.7810652475689988],"angle_rad":[-413.10835151052731,511.01477662058375,-25.070798313150966,872.30897591419182,872.30570776563115]},"command":[-0.24389731091366612,1,0.21177095760659584,0.85048006680536814,0.85048006680536814],"arm":{"servo_position":[2.7178507950532318e-21,-9.757819552369538e-21,-3.3616620094155045e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[4.3368086899420177e-19,-1.7347234759768071e-18,0,0,0,0],"servo_effort":[1.8913424710082092,-2.737435870922059,0.08480386332023826,0.0011397044111878436,0.0017915523832595227,-0.0067266790377040605]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":263,"step":2104,"t":10.52,"sim_time":10.520000000000245,"vehicle":{"origin_ned":[1.0287905222079863,0.79381445700169306,3.1210640061089796],"origin_quat_xyzw":[-0.018256978206433093,0.095499554908537329,0.18769329322443376,0.97740357347290674],"cg_ned":[0.92876564562985575,0.75424685838033878,2.8362388654768957],"linear_velocity_ned":[0.27001759920756641,0.13878871088142641,0.24930438431092666],"angular_velocity_ned":[0.0015756022709806493,0.013051180880126733,0.083566214189431443]},"sensors":{"Odom":[1.0287905222079863,0.79381445700169306,3.1210640061089796,0.25174581697434784,0.036140292653750655,0.30249682370251302,-0.018256978206433096,0.095499554908537357,0.18769329322443382,0.97740357347290674,-0.0099942517528349498,0.011552739433062899,0.083203227956184178],"Pressure":[22741.598451735586],"DVL":[0.15541646985140509,-0.15954981491761341,-0.28115913416412786,7.345639532963653,-0.010383190752109216,-0.0077341856091637639,0.0070881958887859991,0],"IMU":[0.00016347118743881595,0.19476566638049658,0.37946184440281217,-0.019883686797495175,-0.079919489434171445,0.14712440283742398,1.9060754559504132,-0.022147201372154611,-9.6833633681531861],"FOG":[0.38896743957344615],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.230611829735722,105,17.980001749165684,88.212568527554922,88.212568527554922],"omega_rad_s":[-24.750396209036207,105.17272278010742,26.06459340996663,90.410541013772658,90.411276679831602],"thrust_n":[-7.4725181900835276,128.58503979545881,6.0479973699422098,91.887736964229063,92.407209149429249],"torque_nm":[0.14010971606406614,-2.4109694961648533,-0.11339995068641641,-1.7228950680792949,-1.7326351715517985],"angle_rad":[-414.10562338365446,515.22174850807107,-23.964458304378919,875.94625169886888,875.9430136055887]},"command":[-0.2402915412355783,1,0.17123811189681604,0.84011970026242777,0.84011970026242777],"arm":{"servo_position":[-1.618957894888786e-21,-1.0842021724855024e-21,-1.6269385334386973e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,3.4694469519536142e-18,0,0,0],"servo_effort":[1.9262240013122087,-2.6953629819170923,0.09012334868113217,0.0011684289587612837,0.0017894382094338552,-0.0067370138162237319]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":264,"step":2112,"t":10.56,"sim_time":10.560000000000251,"vehicle":{"origin_ned":[1.0396067596288323,0.79966850922940214,3.1309371151964829],"origin_quat_xyzw":[-0.018335507854788963,0.095722291692502154,0.1893531589193356,0.97706009704219887],"cg_ned":[0.93956462771273541,0.75978193142355832,2.8461625301580042],"linear_velocity_ned":[0.26992790313754572,0.13805317436863945,0.24712743869827039],"angular_velocity_ned":[0.0017752094910329507,0.013501609124461779,0.085264016050009522]},"sensors":{"Odom":[1.0396067596288323,0.79966850922940214,3.1309371151964829,0.25187417669014756,0.034615989402181517,0.30040271018954179,-0.018335507854789015,0.095722291692502431,0.18935315891933613,0.97706009704219887,-0.0099770974998745852,0.011897131851060521,0.084937112205793572],"Pressure":[22836.235403149381],"DVL":[0.22127739599478408,-0.18267894240724328,-0.28620752800280275,7.3961215258785087,-0.0018711896565814243,-0.0061854909228314901,-0.02233906908322077,0],"IMU":[0.00042900053583495461,0.19523455155396918,0.38289381672585265,-0.055862312592610416,0.010201662973064768,0.082201576354419673,1.8960501963880512,-0.022599834964962331,-9.7033117363869295],"FOG":[0.36412097560241158],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-24.875657245207808,105,12.592268817270053,87.162835080447522,87.162835080447522],"omega_rad_s":[-24.34906719739158,105.1691812924329,21.870057661605564,89.230518969884557,89.231219841393951],"thrust_n":[-7.2433556794979008,128.55484734130121,3.9081326491124817,89.419690314637663,89.947756252746686],"torque_nm":[0.13581291899058567,-2.410403387649398,-0.073277487170859024,-1.6766191933994559,-1.6865204297390002],"angle_rad":[-415.08641638480532,519.42857750620749,-23.015676918797865,879.53566247971173,879.53245302452831]},"command":[-0.23691102138293149,1,0.11992636968828622,0.83012223886140502,0.83012223886140502],"arm":{"servo_position":[-1.618957894888786e-21,-1.0842021724855024e-21,-1.6269385334386973e-20,2.1684043449710089e-21,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,0,4.3368086899420177e-19,0,0],"servo_effort":[1.9594511366906504,-2.6564128627681054,0.094951108979094992,0.0011984921363877791,0.0017870839597016444,-0.0067456349510903457]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":265,"step":2120,"t":10.6,"sim_time":10.600000000000257,"vehicle":{"origin_ned":[1.050418779453745,0.80549722053857409,3.1407189674551139],"origin_quat_xyzw":[-0.018411157092083203,0.095951933702828937,0.19104719579266982,0.97670631445331391],"cg_ned":[0.95035823203678815,0.76528722219386136,2.8559963402985176],"linear_velocity_ned":[0.26975768864245048,0.1373010734723,0.2448292655689682],"angular_velocity_ned":[0.0020281530275630161,0.013943420476023639,0.087050719411074826]},"sensors":{"Odom":[1.050418779453745,0.80549722053857409,3.1407189674551139,0.25193057917584699,0.033086962330145499,0.29817775685200382,-0.018411157092083234,0.09595193370282909,0.1910471957926701,0.97670631445331391,-0.0099315317558510835,0.012212835502447164,0.086767340948266811],"Pressure":[22930.325016852523],"DVL":[0.18904813538454684,-0.15336230020659075,-0.29470301618330935,7.3806935798114264,0.0077866500468082136,0.031379771654707997,0.031242982072756123,0],"IMU":[0.0007116961746801686,0.19571559584882045,0.38639912007268618,-0.0045473114279429945,0.015574251092044892,-0.024448498874334049,1.8943751861887921,-0.016779476280634906,-9.6811875260248428],"FOG":[0.3905407074863041],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-24.544448685325008,105,-0.1000458119803303,86.149774814395414,86.149774814395414],"omega_rad_s":[-23.972498552713134,105.16570925385943,15.652020397745698,88.089363824490022,88.090031876177562],"thrust_n":[-7.0325338204886574,128.52650286371548,1.5584357286411514,87.073099845451765,87.608335126780787],"torque_nm":[0.13186000913416235,-2.409871928694665,-0.029220669912021595,-1.632620622102221,-1.6426562836271401],"angle_rad":[-416.05172086577028,523.63526641086708,-22.270418513161168,883.07875845834417,883.07557629200767]},"command":[-0.23375665414595245,1,-0.00095281725695552663,0.82047404585138484,0.82047404585138484],"arm":{"servo_position":[-1.618957894888786e-21,-1.0842021724855024e-21,-3.3616620094155045e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[1.99617475590862,-2.6193751045730904,0.099173760109928788,0.0012301203058260209,0.0017832810177788475,-0.006751839786973011]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":266,"step":2128,"t":10.640000000000001,"sim_time":10.640000000000263,"vehicle":{"origin_ned":[1.0612230289177327,0.81129967098932898,3.1504051560065522],"origin_quat_xyzw":[-0.018483087134363835,0.096188038703954176,0.19277724031409371,0.97634172927164808],"cg_ned":[0.96114321963682803,0.77076204583058294,2.8657357613537306],"linear_velocity_ned":[0.26951281965905938,0.13653471777969739,0.24242205590032104],"angular_velocity_ned":[0.0023323454853884135,0.01437112556694054,0.088920456426327427]},"sensors":{"Odom":[1.0612230289177327,0.81129967098932898,3.1504051560065522,0.25191801024626276,0.031553837788644255,0.29583499329180479,-0.018483087134363859,0.096188038703954301,0.19277724031409396,0.97634172927164808,-0.0098606361713610945,0.012495288395025872,0.088687385116551706],"Pressure":[23021.400237019927],"DVL":[0.16894866591946811,-0.1495629273131619,-0.28034150600129659,7.4379552045945827,0.0036264905393111968,0.032438435721009358,-0.0069670518473336426,0],"IMU":[0.001013558128188308,0.19620752107755032,0.38998180400861243,-0.11114561365972597,-0.00083095516364363811,0.26533896884737229,1.9153539227819056,-0.014146270973345624,-9.6867242332577597],"FOG":[0.39139917632835136],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-24.237723298253641,105,-12.324243899366099,85.171955673072702,85.171955673072702],"omega_rad_s":[-23.620873831177388,105.16230547272447,6.4680059931424143,86.986824717355887,86.987462352679827],"thrust_n":[-6.8395053341672316,128.50002296195504,-0.11241909475055324,84.8434636134741,85.38441064297875],"torque_nm":[0.12824072501563563,-2.4093754305366568,0.002107858026572873,-1.5908149427526397,-1.6009576995558517],"angle_rad":[-417.00253071905678,527.84181797390431,-21.855434553940675,886.5770898647927,886.57393372749016]},"command":[-0.23083545998336802,1,-0.11737375142253428,0.81116148260069243,0.81116148260069243],"arm":{"servo_position":[-1.618957894888786e-21,-1.0842021724855024e-21,-1.6269385334386973e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[2.0223944133328526,-2.586772593303579,0.10331183534014153,0.0012617166702662971,0.0017817940742797357,-0.0067575541730539555]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":267,"step":2136,"t":10.68,"sim_time":10.68000000000027,"vehicle":{"origin_ned":[1.0720174015839548,0.81707567707786832,3.1599914771286111],"origin_quat_xyzw":[-0.018550718603828183,0.096429650940840578,0.19454395490307094,0.97596610743887058],"cg_ned":[0.97191804518046598,0.77620653898417513,2.8753763617002437],"linear_velocity_ned":[0.26926111520839546,0.13578751885518633,0.23990165233043859],"angular_velocity_ned":[0.0026668711558525521,0.014738444700089821,0.090778811231799456]},"sensors":{"Odom":[1.0720174015839548,0.81707567707786832,3.1599914771286111,0.25190142384589853,0.030022438753205712,0.29338626363558651,-0.018550718603828193,0.096429650940840633,0.19454395490307105,0.97596610743887058,-0.0097825886077983898,0.012709336939187002,0.090597462642697663],"Pressure":[23113.471679777718],"DVL":[0.16790286916848429,-0.15681201466139788,-0.29278951114661622,7.2935249573585583,-0.0044200359681582689,-0.0087534564178434159,0.051349823117164357,0],"IMU":[0.0013356236179311947,0.196708123924351,0.39364340840536721,0.0090367574935635193,0.036372936917266209,0.224155306052122,1.9115036434731463,-0.031234825492244489,-9.6871802291913092],"FOG":[0.40874002566871065],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-23.953319736750508,105,-17.31281721627553,84.228043442126634,84.228043442126634],"omega_rad_s":[-23.293919552227585,105.15896933555756,-1.6360435412151726,85.922253231961037,85.922863524823711],"thrust_n":[-6.6634901965108133,128.47310883420582,-0.19722572795141718,82.726318275116753,83.270161473365661],"torque_nm":[0.12494044118457776,-2.4088707906413593,0.0036979823990890724,-1.5511184676584391,-1.5613155276256068],"angle_rad":[-417.93984087592582,532.04823490701665,-21.784756264432161,890.03218729182652,890.02905603247473]},"command":[-0.22812685463571913,1,-0.16488397348833839,0.80217184230596794,0.80217184230596794],"arm":{"servo_position":[-1.618957894888786e-21,-9.757819552369538e-21,-1.6269385334386973e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,-1.7347234759768071e-18,0,0,0,0],"servo_effort":[2.0237704463706265,-2.5605516755045543,0.10806209872529929,0.0012919631063233173,0.0017867947153011757,-0.0067654993831832233]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":268,"step":2144,"t":10.720000000000001,"sim_time":10.720000000000276,"vehicle":{"origin_ned":[1.0828010786169211,0.82282574337312986,3.1694739332729918],"origin_quat_xyzw":[-0.018613736423713719,0.096675422817813897,0.19634700273142813,0.97557944113113093],"cg_ned":[0.98268263881104678,0.78162157171846669,2.884913841587057],"linear_velocity_ned":[0.26899250936473973,0.13505451477142164,0.23728288717878979],"angular_velocity_ned":[0.0030304853178405658,0.015054871244563926,0.092644206172300958]},"sensors":{"Odom":[1.0828010786169211,0.82282574337312986,3.1694739332729918,0.25187060235801795,0.028493620536436216,0.29084282703099867,-0.018613736423713761,0.096675422817814119,0.19634700273142858,0.97557944113113093,-0.0096989998204624617,0.012864191817706818,0.092516073728340698],"Pressure":[23203.156318363188],"DVL":[0.19695586468072959,-0.18139290414106887,-0.27759314112900901,7.4011906840739217,-0.024070479686430845,-0.010141669766505535,-0.013626638997749437,0],"IMU":[0.0016780292783632553,0.19721452499008679,0.39738332552281247,-0.067611974794982599,-0.027942010252935717,0.10473516647218044,1.9236979722201053,-0.024902586007889839,-9.7181539646692752],"FOG":[0.40530817486384085],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-23.688354976024499,105,-21.14429360332867,83.316846211231166,83.316846211231166],"omega_rad_s":[-22.990289353966148,105.15570117192767,-8.4885905264225485,84.894784790912695,84.895371874002336],"thrust_n":[-6.5031459016086384,128.44561135115788,-1.7635404457923627,80.716281274874575,81.260351670466846],"torque_nm":[0.12193398565516196,-2.4083552128342105,0.033066383358606802,-1.5134302739038983,-1.5236315938212537],"angle_rad":[-418.86460746708144,536.25451992450996,-22.009457915992691,893.445550159346,893.44244277507687]},"command":[-0.22560338072404285,1,-0.20137422479360639,0.79349377344029681,0.79349377344029681],"arm":{"servo_position":[-1.618957894888786e-21,-1.0842021724855024e-21,1.0778494253810979e-21,0,-7.5301229010907305e-20,1.3386508698406964e-19],"servo_velocity":[0,0,0,0,0,2.7755575615628914e-17],"servo_effort":[2.0488082192054002,-2.531152574781796,0.11176763053801297,0.0013235197871126166,0.0017853943952148123,-0.0067690604341440795]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":269,"step":2152,"t":10.76,"sim_time":10.760000000000282,"vehicle":{"origin_ned":[1.0935718039110847,0.82854968344783875,3.1788492932318921],"origin_quat_xyzw":[-0.018671677754820551,0.096924573488514756,0.1981872857555759,0.97518141659320356],"cg_ned":[0.99343523261621713,0.78700716228773071,2.8943447808666454],"linear_velocity_ned":[0.26866465966538233,0.13431433693140876,0.23458674117294778],"angular_velocity_ned":[0.0034307404656326785,0.015352143962108985,0.094575849502931436]},"sensors":{"Odom":[1.0935718039110847,0.82854968344783875,3.1788492932318921,0.25178356494343013,0.026964977076756977,0.28821424399025591,-0.018671677754820575,0.096924573488514867,0.19818728575557612,0.97518141659320356,-0.0096030102821573465,0.012986234700401016,0.09450497085023557],"Pressure":[23294.613938287697],"DVL":[0.18946054996094169,-0.1842864781931669,-0.28406757265934429,7.2854148016297193,-0.004110274762649138,-0.011829095164443094,0.0079331359561141054,0],"IMU":[0.0020416712009829227,0.19772489483994654,0.40120358456564059,0.12584104698190801,-0.052531292303330132,0.16027862526321729,1.924039447423457,-0.0086796530411782681,-9.6957475881106365],"FOG":[0.40744217198242327],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-23.446399848394044,105,-24.294391467575373,82.437197136596197,82.437197136596197],"omega_rad_s":[-22.709879684101068,105.15249990260902,-14.234236120115444,83.90341807023988,83.903986095137384],"thrust_n":[-6.3579269245352021,128.41935183297738,-3.9970398615642537,78.807426258840664,79.350344865171294],"torque_nm":[0.11921112983503503,-2.4078628468683259,0.074944497404329763,-1.4776392423532627,-1.4878189662219614],"angle_rad":[-419.77775701198425,540.46067572631716,-22.482581287879917,896.81863995567301,896.81555561295465]},"command":[-0.22329904617518137,1,-0.23137515683405119,0.78511616320567801,0.78511616320567801],"arm":{"servo_position":[-1.618957894888786e-21,-1.0842021724855024e-21,1.0778494253810979e-21,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,3.4694469519536142e-18,0,0,0],"servo_effort":[2.0837808927507071,-2.500645070970871,0.11487855750038511,0.001357320850856536,0.0017807943905342506,-0.0067695260104534694]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":270,"step":2160,"t":10.800000000000001,"sim_time":10.800000000000288,"vehicle":{"origin_ned":[1.1043264821240955,0.83424688509735911,3.1881148922384015],"origin_quat_xyzw":[-0.01872399374782565,0.097176641305763353,0.20006636632979416,0.974771543237827],"cg_ned":[1.0041730716339412,0.79236281928647756,2.9036663891142727],"linear_velocity_ned":[0.26826281422692017,0.13355903158710342,0.23182622863203584],"angular_velocity_ned":[0.0038705477651933937,0.015640078029191425,0.096593585151495714]},"sensors":{"Odom":[1.1043264821240955,0.83424688509735911,3.1881148922384015,0.25162411443879062,0.025435333130119607,0.28550927244359725,-0.018723993747825685,0.09717664130576352,0.20006636632979452,0.974771543237827,-0.0094924402302963111,0.013083252798251063,0.096584863968804155],"Pressure":[23384.810430387592],"DVL":[0.2318148229397608,-0.13856248380231129,-0.30572349437256213,7.4464546316547189,0.013375432812853576,-0.010492147009436705,0.034321229020532099,0],"IMU":[0.0024278744559202156,0.19823798575034793,0.40510763029333408,-0.050505148796751179,0.027732764872619681,0.11308771060023168,1.9496145634366793,-0.047905669094092815,-9.6683578210062731],"FOG":[0.40827498485199565],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-23.229760530538364,105,-26.967383763617093,81.588250828031804,81.588250828031804],"omega_rad_s":[-22.453544076880586,105.14936356992567,-19.052733737684733,82.947155599657194,82.947708159859374],"thrust_n":[-6.2278709239451375,128.39505513842292,-6.5157245931068024,76.994504756773253,77.535333370878931],"torque_nm":[0.11677257982397132,-2.4074072838454299,0.12216983612075258,-1.4436469641894984,-1.4537875007039802],"angle_rad":[-420.68023659883943,544.66670494522543,-23.163944720906994,900.15287793989103,900.14981595922507]},"command":[-0.22123581457655583,1,-0.25683222632016278,0.77703096026696949,0.77703096026696949],"arm":{"servo_position":[-1.618957894888786e-21,-1.0842021724855024e-21,1.0778494253810979e-21,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,3.4694469519536142e-18,0,0,0],"servo_effort":[2.1232920394779473,-2.4711941097959627,0.11740601181705751,0.0013923127815363174,0.0017743259065734281,-0.0067675701422535107]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":271,"step":2168,"t":10.84,"sim_time":10.840000000000295,"vehicle":{"origin_ned":[1.1150617601149975,0.83991658896573096,3.1972685002923313],"origin_quat_xyzw":[-0.018770112827896264,0.097431232965601466,0.20198600177751133,0.97434926632761709],"cg_ned":[1.0148931156154593,0.79768788131809043,2.9128763231130841],"linear_velocity_ned":[0.26778464622316955,0.13278672837622837,0.22901123731714471],"angular_velocity_ned":[0.0043501218977602804,0.015919490456890121,0.098700824890528116]},"sensors":{"Odom":[1.1150617601149975,0.83991658896573096,3.1972685002923313,0.25138793139833499,0.023904268400425165,0.28273669204397761,-0.018770112827896309,0.097431232965601702,0.2019860017775118,0.97434926632761709,-0.009367735076899036,0.01315573897144352,0.098759195230861255],"Pressure":[23470.463498074525],"DVL":[0.23439352350689641,-0.19855567034060506,-0.2838248910175224,7.2814002037292891,0.0020843987815114076,-0.0054707210873574316,-0.0069280780486589448,0],"IMU":[0.002838074196688271,0.19875266049429335,0.40909933037803675,0.063999250711143804,0.057701311061729474,0.083144620848879039,1.9345451519183026,-0.023544518399751375,-9.6860207665673546],"FOG":[0.39741383199271196],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-23.039787516748419,105,-29.281241067020243,80.768947925829977,80.768947925829977],"omega_rad_s":[-22.222379249880508,105.14629015114892,-23.111703446676525,82.024969624605703,82.025509768002209],"thrust_n":[-6.1131743476550513,128.37292935794247,-9.0927811634589641,75.272590443468999,75.810469534617383],"torque_nm":[0.11462201901853224,-2.4069924254614214,0.17048964681485554,-1.4113610708150441,-1.4214463037740763],"angle_rad":[-421.57303412250178,548.8726101327585,-24.020338747246036,903.44964500981177,903.44660484274334]},"command":[-0.21942654777855636,1,-0.27886896254304994,0.769228075484095,0.769228075484095],"arm":{"servo_position":[-1.618957894888786e-21,-1.0842021724855024e-21,-1.6269385334386973e-20,0,-7.5301229010907305e-20,1.3386508698406964e-19],"servo_velocity":[0,0,0,0,0,2.7755575615628914e-17],"servo_effort":[2.1637993567076195,-2.4435337661901815,0.11946017387083939,0.0014284555983345043,0.0017669067833035361,-0.0067635907611464634]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":272,"step":2176,"t":10.880000000000001,"sim_time":10.880000000000301,"vehicle":{"origin_ned":[1.125774329533755,0.84555804378380284,3.206308237953686],"origin_quat_xyzw":[-0.018809488786074222,0.097687919878067672,0.20394789746571737,0.97391402524084014],"cg_ned":[1.025592390165081,0.80298169359340588,2.9219725825039817],"linear_velocity_ned":[0.26723431037069456,0.13199889589589534,0.2261494605723437],"angular_velocity_ned":[0.0048675756367613718,0.016186899845467211,0.10089168342937249]},"sensors":{"Odom":[1.125774329533755,0.84555804378380284,3.206308237953686,0.2510772818635218,0.022371938098467378,0.27990470696861053,-0.018809488786074257,0.097687919878067866,0.20394789746571779,0.97391402524084014,-0.0092310773063581479,0.013201052785834898,0.10102158294893789],"Pressure":[23558.148542816838],"DVL":[0.19863626106938109,-0.1673448148252584,-0.30637803236774852,7.4084372074108575,0.022559738114275741,0.014290885740978417,0.027605451155015507,0],"IMU":[0.0032736267765839529,0.19926770722051559,0.41318244691479455,-0.054055699532643123,-0.010992993986791773,0.30533328340038723,1.9347510206490162,-0.03861685835348392,-9.6668250390241397],"FOG":[0.43709014784145067],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-22.877162032099537,105,-31.314104450898057,79.978209727845893,79.978209727845893],"omega_rad_s":[-22.017398332682774,105.14327783594769,-26.551048029042423,81.135785101986698,81.136315493653242],"thrust_n":[-6.014010634280158,128.3529172271067,-11.600780267669188,73.636957642374725,74.170961391818182],"torque_nm":[0.11276269939275295,-2.4066171980082505,0.21751463001879731,-1.380692955794526,-1.3907055260965913],"angle_rad":[-422.4571799643121,553.07839376385687,-25.024684692405192,906.71027981103282,906.70726102181482]},"command":[-0.21787773363904323,1,-0.29822956619902913,0.76169723550329416,0.76169723550329416],"arm":{"servo_position":[-1.618957894888786e-21,-1.0842021724855024e-21,-1.6269385334386973e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,-3.4694469519536142e-18,0,0,0],"servo_effort":[2.203322705848533,-2.4179356019355129,0.1211329984398473,0.0014656112298656215,0.0017591008408555399,-0.0067578207584347736]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":273,"step":2184,"t":10.92,"sim_time":10.920000000000307,"vehicle":{"origin_ned":[1.1364610004225071,0.85117055393959185,3.2152325351356161],"origin_quat_xyzw":[-0.018841639143735482,0.097946216347625403,0.20595349300674515,0.97346529987251307],"cg_ned":[1.0362680633841561,0.80824366856166796,2.9309534655392131],"linear_velocity_ned":[0.26661076962451463,0.13119589869749029,0.22324919368250698],"angular_velocity_ned":[0.0054165576990541442,0.016440069596872813,0.10314250735398661]},"sensors":{"Odom":[1.1364610004225071,0.85117055393959185,3.2152325351356161,0.25069006176601316,0.020838758554618277,0.27702091897302389,-0.01884163914373552,0.097946216347625598,0.20595349300674556,0.97346529987251307,-0.009084659437416813,0.013219459758992138,0.10334750435066603],"Pressure":[23642.453539902112],"DVL":[0.18832365885594263,-0.13011238411975395,-0.29915914897772433,7.2835678751457467,-0.044444071459029795,0.047173676612388638,-0.011511714752597038,0],"IMU":[0.0037356784979906501,0.19978181325123001,0.41736018328711078,0.013801777735579907,-0.045609805578063649,0.13160864841944941,1.9298689203051242,-0.023878039944469475,-9.7026200932494913],"FOG":[0.41747773603563465],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-22.742168312577032,103.94494445892205,-33.122015195713196,79.214996813575823,79.214996813575823],"omega_rad_s":[-21.839402839193873,104.92177739833465,-29.463339051571769,80.278506106471696,80.279029188756297],"thrust_n":[-5.9304655911928581,127.77579239658191,-13.955487454260592,72.08303221510711,72.612223790873429],"torque_nm":[0.11119622983486611,-2.3957961074359111,0.26166538976738613,-1.3515568540332583,-1.361479196078877],"angle_rad":[-423.33374033725102,557.28072027090764,-26.154372500564612,909.93607743788482,909.93307969199918]},"command":[-0.21659207916740031,0.98995185198973379,-0.3154477637686971,0.75442854108167445,0.75442854108167445],"arm":{"servo_position":[-1.618957894888786e-21,-1.0842021724855024e-21,-1.6269385334386973e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[2.2310581454829759,-2.392903725458281,0.12215782688733118,0.0015030771517336461,0.0017488631539677023,-0.0067491002155364169]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":274,"step":2192,"t":10.960000000000001,"sim_time":10.960000000000313,"vehicle":{"origin_ned":[1.1471178598918403,0.85675308908945347,3.2240402978392568],"origin_quat_xyzw":[-0.018866231691545089,0.098205819882671894,0.20800310606587635,0.9730027698366952],"cg_ned":[1.0469164246988059,0.81347294639240608,2.9398177914035486],"linear_velocity_ned":[0.26587512055391954,0.13036498255012827,0.22032732065858926],"angular_velocity_ned":[0.0059764319170076616,0.016690596753040177,0.10537235622984745]},"sensors":{"Odom":[1.1471178598918403,0.85675308908945347,3.2240402978392568,0.25018864416394682,0.019305145229951939,0.27409257049919661,-0.018866231691545103,0.098205819882671977,0.20800310606587652,0.9730027698366952,-0.0089265231268507838,0.013229498674959716,0.10565474322308553],"Pressure":[23727.649945524958],"DVL":[0.19641045058098494,-0.15368733630869325,-0.2969415028480975,7.2471099472597684,0.010765236995205634,-0.011411575456131362,-0.031282269496186524,0],"IMU":[0.0042249161261619216,0.20029407890173606,0.42163340980748498,-0.048520012131271918,0.0051450092723187707,0.11716594852309371,1.9351034353319794,-0.031524325279272146,-9.6833224930167034],"FOG":[0.43095541235696133],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-22.635465052798679,102.10738808730824,-34.750686452740638,78.478277724337758,78.478277724337758],"omega_rad_s":[-21.689100739903861,104.14954414504544,-31.954885901666188,79.452031024771699,79.452548891065106],"thrust_n":[-5.8625945509652313,125.80369765699119,-16.136340558867889,70.606097349453407,71.130224365936385],"torque_nm":[0.1099236478305981,-2.3588193310685845,0.30255638547877295,-1.3238643253022513,-1.3336917068613077],"angle_rad":[-424.20381059958112,561.46111102768475,-27.390692135247392,913.12828902762078,913.12531208169275]},"command":[-0.2155758576457017,0.97245131511722127,-0.33095891859752991,0.7474121688032167,0.7474121688032167],"arm":{"servo_position":[-1.618957894888786e-21,-1.0842021724855024e-21,-1.6269385334386973e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,1.7347234759768071e-18,0,0,0,0],"servo_effort":[2.2324683826348486,-2.3660977293765395,0.1219633204714768,0.0015405809538788352,0.0017323604892027441,-0.0067341728474132638]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":275,"step":2200,"t":11,"sim_time":11.00000000000032,"vehicle":{"origin_ned":[1.1577396301442384,0.86230398199580316,3.2327310353661125],"origin_quat_xyzw":[-0.018883140487689933,0.098466761190466379,0.21009541552806421,0.97252642139947632],"cg_ned":[1.0575321300542939,0.8186681194733163,2.9485650628098274],"linear_velocity_ned":[0.26499201248573062,0.12949414290246491,0.21739939185464488],"angular_velocity_ned":[0.0065280773422509803,0.016946435936240747,0.10750845344127043]},"sensors":{"Odom":[1.1577396301442384,0.86230398199580316,3.2327310353661125,0.24953781383620807,0.017773145262198101,0.27112660031970898,-0.018883140487689947,0.098466761190466462,0.21009541552806438,0.97252642139947632,-0.0087561008036313309,0.013245860793680175,0.10786910084269931],"Pressure":[23809.353000335374],"DVL":[0.21237353404677589,-0.14242601772764024,-0.27375734307829175,7.4078340391320152,0.0036879951860369245,-0.0138505050162183,0.0030392501243089766,0],"IMU":[0.0047414133037472035,0.20080434313677542,0.42599958830080403,-0.073628292383288912,0.0030505946555012993,0.15437272952287256,1.9517713748325007,-0.045034192013945255,-9.6490665320203313],"FOG":[0.40690181663773339],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-22.557766900551517,100.26207675476515,-36.23705128071385,77.766926523381159,77.766926523381159],"omega_rad_s":[-21.567240215044663,103.00118190866651,-34.116952850736737,78.655229659809862,78.655743676507569],"thrust_n":[-5.8105114582786062,122.90961032816899,-18.151165096854598,69.201589320504496,69.721040175855222],"torque_nm":[0.10894708984272389,-2.3045551936531687,0.34033434556602371,-1.297529799759459,-1.3072695032972856],"angle_rad":[-425.06851582234975,565.60167059798323,-28.718955180359387,916.28812107900853,916.28516475779099]},"command":[-0.21483587524334777,0.95487692147395375,-0.34511477410203667,0.74063739546077301,0.74063739546077301],"arm":{"servo_position":[-1.618957894888786e-21,-1.0842021724855024e-21,1.0778494253810979e-21,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,3.4694469519536142e-18,0,0,0],"servo_effort":[2.2157437104939914,-2.3390442902709552,0.12059644118089943,0.0015753676119095697,0.0017107813751076895,-0.0067113310952774587]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":276,"step":2208,"t":11.040000000000001,"sim_time":11.040000000000326,"vehicle":{"origin_ned":[1.1683201507712093,0.86782116085425931,3.2413047327498625],"origin_quat_xyzw":[-0.018892413576881078,0.098729219947488053,0.21222797299180507,0.97203647324449205],"cg_ned":[1.0681088138114598,0.82382742707495271,2.9571952980875973],"linear_velocity_ned":[0.26394262956938563,0.12857672738013967,0.21447644789402495],"angular_velocity_ned":[0.0070586974172503784,0.017207660440657045,0.10950572545697414]},"sensors":{"Odom":[1.1683201507712093,0.86782116085425931,3.2413047327498625,0.24871726771447869,0.016246279164948502,0.26812948743112636,-0.018892413576881106,0.098729219947488192,0.21222797299180537,0.97203647324449205,-0.0085756155159193211,0.013273647440140509,0.1099440848662875],"Pressure":[23891.765159871618],"DVL":[0.19590256067307213,-0.12911074075147871,-0.22332452046651191,7.1998593888933202,-0.03813563700368891,-0.0083361740343849966,0.027102883510387987,0],"IMU":[0.0052847238551401287,0.20131281242428442,0.43045381754664513,0.0076190136352355196,0.080420439982564332,0.19697532169161736,1.9451205884207567,-0.085829579038440421,-9.6917860224406009],"FOG":[0.41782118095824311],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-22.508686602165568,98.42238824860577,-37.606936370141085,77.079765608067206,77.079765608067206],"omega_rad_s":[-21.474275173780935,101.59979284833129,-36.019556611261557,77.88692976137456,77.887440533599772],"thrust_n":[-5.7742237436345185,119.43214182564338,-20.016431658662107,67.865249733716581,68.380634817409018],"torque_nm":[0.10826669519314722,-2.2393526592308137,0.37530809359991452,-1.272473432507186,-1.2821369028264191],"angle_rad":[-425.92900514668503,569.69026856530877,-30.127627844266939,919.41673391523841,919.41379808061379]},"command":[-0.21436844383014828,0.93735607855815017,-0.35816129876324843,0.73409300579111625,0.73409300579111625],"arm":{"servo_position":[-1.618957894888786e-21,-1.0842021724855024e-21,1.0778494253810979e-21,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,3.4694469519536142e-18,0,0,0],"servo_effort":[2.186942190751676,-2.3127585142115055,0.11810922188922957,0.0016083164696286802,0.0016850060295517202,-0.0066795094987823029]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":277,"step":2216,"t":11.08,"sim_time":11.080000000000332,"vehicle":{"origin_ned":[1.1788528071489459,0.87330235401457512,3.2497617331957844],"origin_quat_xyzw":[-0.018894239002885938,0.098993379251883895,0.21439766028380319,0.97153330455606379],"cg_ned":[1.0786396224702011,0.82894892794005315,2.9657088811713543],"linear_velocity_ned":[0.26271927452303473,0.12760967865828393,0.21156630101262819],"angular_velocity_ned":[0.0075601023371197418,0.017469617871357521,0.11133870297591809]},"sensors":{"Odom":[1.1788528071489459,0.87330235401457512,3.2497617331957844,0.24771696198742563,0.014728853827154978,0.26510715948783881,-0.018894239002885942,0.098993379251883923,0.21439766028380325,0.97153330455606379,-0.0083889130547725125,0.013311921837087957,0.11185288709300902],"Pressure":[23972.807895169863],"DVL":[0.19404664293048035,-0.17365056834691608,-0.28882175793995102,7.3753700504218358,0.058298453768294081,0.007152203509908299,0.014926970257864762,0],"IMU":[0.0058539814148720554,0.20181976428752602,0.43498977173830777,0.023537601056117533,-0.0051397008067327315,0.10177350596385805,1.9385115660127512,-0.051107053710178013,-9.6605268592400346],"FOG":[0.43628243833981878],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-22.486986709296282,96.597488451411678,-38.878477752919444,76.415622273133593,76.415622273133593],"omega_rad_s":[-21.410144614816982,100.03207973096963,-37.715763144150237,77.145928776324681,77.14643634213779],"thrust_n":[-5.7535205901254773,115.6096002034613,-21.750507969889888,66.593065790977363,67.104962741454969],"torque_nm":[0.1078785110648527,-2.1676800038148993,0.40782202443543553,-1.2486199835808258,-1.2582180514022807],"angle_rad":[-426.78643440648517,573.7188370686722,-31.607579928476245,922.51524022927435,922.51232475376037]},"command":[-0.21416177818377413,0.91997608048963497,-0.37027121669447088,0.72776783117270094,0.72776783117270094],"arm":{"servo_position":[-1.618957894888786e-21,-1.0842021724855024e-21,-1.6269385334386973e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,-3.4694469519536142e-18,-8.6736173798840355e-19,0,0],"servo_effort":[2.1504212618256866,-2.2878987655439476,0.11456348844099667,0.001637674167053777,0.0016557132397738024,-0.0066384943893373462]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":278,"step":2224,"t":11.120000000000001,"sim_time":11.120000000000339,"vehicle":{"origin_ned":[1.189330818721495,0.87874522551985601,3.2581026505257737],"origin_quat_xyzw":[-0.018888916772250835,0.099259336737131137,0.21660100965298401,0.97101740226989941],"cg_ned":[1.0891175692397188,0.83403061489210728,2.9741064537978437],"linear_velocity_ned":[0.26132156238130266,0.12659230235722277,0.20867444623032663],"angular_velocity_ned":[0.0080273560904874329,0.017725013412117917,0.11299550232915835]},"sensors":{"Odom":[1.189330818721495,0.87874522551985601,3.2581026505257737,0.24653380772593639,0.013225512505079296,0.26206494511710732,-0.018888916772250849,0.099259336737131193,0.21660100965298415,0.97101740226989941,-0.0082007393592071591,0.01335613601311127,0.11358239123052347],"Pressure":[24053.248717258106],"DVL":[0.2092454032176532,-0.14600865138622773,-0.28143224763277491,7.401142053877467,-0.0057353498231118762,-0.030875428765079069,0.019642375598015922,0],"IMU":[0.0064479813331686222,0.20232536436979767,0.43960035894293631,0.018580761071386693,0.0079509859408445696,0.27275225264835357,1.942982732138361,-0.086492769334459041,-9.7033059677913425],"FOG":[0.42432643622511051],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-22.490870672889525,94.793514354741944,-40.064632808739859,75.773375507886087,75.773375507886087],"omega_rad_s":[-21.374229175231132,98.358998505506634,-39.245480945209856,76.431018308811346,76.431522398420526],"thrust_n":[-5.7479538368552241,111.60727842239174,-23.370438353608996,65.38125755790449,65.89006530066878],"torque_nm":[0.10777413444103547,-2.0926364704198455,0.43819571913016875,-1.2258985792107093,-1.2354387243875398],"angle_rad":[-427.64194423166595,577.68216699283539,-33.151494945955577,925.58470440938936,925.58180915924413]},"command":[-0.21419876831323356,0.90279537480706618,-0.38156793151180818,0.72165119531320077,0.72165119531320077],"arm":{"servo_position":[-1.618957894888786e-21,-1.0842021724855024e-21,-1.6269385334386973e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,-3.4694469519536142e-18,0,0,0],"servo_effort":[2.1092764025153738,-2.2648616476213643,0.11002097557670501,0.0016636011562554585,0.0016234158235998324,-0.0065882947130124726]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":279,"step":2232,"t":11.16,"sim_time":11.160000000000345,"vehicle":{"origin_ned":[1.199747431031132,0.88414746373865016,3.2663283038662985],"origin_quat_xyzw":[-0.018876837588960114,0.09952705579520689,0.21883442275472684,0.97048932275681588],"cg_ned":[1.0995357647520343,0.83907048949552121,2.98238883872299],"linear_velocity_ned":[0.25975381543211562,0.12552542641603001,0.20580473386342882],"angular_velocity_ned":[0.0084577292584138222,0.017965350421065583,0.11447339561095142]},"sensors":{"Odom":[1.199747431031132,0.88414746373865016,3.2663283038662985,0.24516940656594363,0.011740930920471076,0.25900759026913922,-0.018876837588960138,0.099527055795207028,0.21883442275472714,0.97048932275681588,-0.0080162693870761206,0.013399850423171725,0.11512874852273935],"Pressure":[24130.61780122494],"DVL":[0.15707395825016868,-0.12445529585633477,-0.2557431638328892,7.2257365298496055,-0.014646290352042152,0.015140883986011487,-0.020013482790812137,0],"IMU":[0.0070652444530137628,0.20282956479501901,0.44427817263831565,-0.018670584988694151,0.038273176339812399,0.035198871117802844,1.9428990889088531,-0.076567246023903759,-9.7047903739355039],"FOG":[0.45150945175003182],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-22.518178083422441,93.014436259030674,-41.174858191755945,75.15197703439749,75.15197703439749],"omega_rad_s":[-21.365394182682934,96.62328458849403,-40.638597410751515,75.741009939274676,75.741510217065695],"thrust_n":[-5.7568598594549067,107.53820433993903,-24.890679679950754,64.226279170742231,64.732147020959331],"torque_nm":[0.10794112236477954,-2.016341331373857,0.46670024399907667,-1.2042427344514168,-1.2137277566429874],"angle_rad":[-428.49663855049823,581.5770562389032,-34.753417039690426,928.62614290357681,928.6232677320661]},"command":[-0.21445883888973755,0.88585177389553027,-0.39214150658815189,0.71573311461330946,0.71573311461330946],"arm":{"servo_position":[-1.618957894888786e-21,-1.0842021724855024e-21,1.0778494253810979e-21,4.3368086899420178e-21,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,0,8.6736173798840355e-19,0,0],"servo_effort":[2.0656730572552773,-2.2438675791323881,0.10454940830077536,0.0016858506854663796,0.0015885407138521716,-0.006529098313488876]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":280,"step":2240,"t":11.200000000000001,"sim_time":11.200000000000351,"vehicle":{"origin_ned":[1.2100960410428527,0.8895068368168132,3.2744396689113811],"origin_quat_xyzw":[-0.018858465641101888,0.099796341835603972,0.22109431598246215,0.96994966460643806],"cg_ned":[1.1098875631376182,0.84406660950179446,2.9905569849930189],"linear_velocity_ned":[0.2580232812501207,0.12441083682363617,0.20295983596453315],"angular_velocity_ned":[0.0088500753589439082,0.018181762032280575,0.11577563222953816]},"sensors":{"Odom":[1.2100960410428527,0.8895068368168132,3.2744396689113811,0.24362844048510826,0.010279605844960772,0.25593928926063558,-0.018858465641101919,0.099796341835604124,0.22109431598246251,0.96994966460643806,-0.0078407224618112139,0.013435727006185413,0.11649421287642943],"Pressure":[24205.905088213851],"DVL":[0.21643132516922212,-0.14494682109357185,-0.25367186974251288,7.189541035761783,0.0096464750476768953,0.012660154708486313,0.029190752047578879,0],"IMU":[0.0077040679210934309,0.20333205304514881,0.44901579249063361,0.0013505036950967452,-0.02172201802868981,0.2438173180789453,1.9587424830937694,-0.085888853362375145,-9.6841919050955667],"FOG":[0.4458557912937916],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-22.566556271240543,91.262698303846236,-42.21623177753002,74.550459574676722,74.550459574676722],"omega_rad_s":[-21.382078548464175,94.854779684288005,-41.917477225987277,75.07475626729871,75.075252523951136],"thrust_n":[-5.7794006160192382,103.47844537508205,-26.322858867121607,63.124824325170472,63.62762372173966],"torque_nm":[0.10836376155036073,-1.9402208507827887,0.4935536037585303,-1.1835904560969464,-1.1930179447826186],"angle_rad":[-429.35156592172507,585.40170695846314,-36.408408683076388,931.6405255133534,931.63767026262235]},"command":[-0.21491958353562421,0.86916855527472603,-0.40205935026219064,0.71000437690168305,0.71000437690168305],"arm":{"servo_position":[-1.618957894888786e-21,-1.0842021724855024e-21,1.0778494253810979e-21,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[2.0211072012461497,-2.2250226208915378,0.098214466786307297,0.0017049645622541634,0.0015514340163055149,-0.0064611736824461046]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":281,"step":2248,"t":11.24,"sim_time":11.240000000000357,"vehicle":{"origin_ned":[1.2203702763419728,0.89482122554121279,3.2824378404118773],"origin_quat_xyzw":[-0.018834324807641179,0.10006683570054736,0.22337721365316474,0.96939904942313004],"cg_ned":[1.1201666496277889,0.84901711759622034,2.9986119282405164],"linear_velocity_ned":[0.25613889436854309,0.12325087397363191,0.2001415604914929],"angular_velocity_ned":[0.0092042651689390638,0.018365629492991326,0.11690919811654929]},"sensors":{"Odom":[1.2203702763419728,0.89482122554121279,3.2824378404118773,0.24191756796568947,0.0088457347250838134,0.25286369536977782,-0.018834324807641214,0.10006683570054754,0.22337721365316512,0.96939904942313004,-0.00767917652948703,0.013456308282535134,0.11768489054871448],"Pressure":[24285.785589615654],"DVL":[0.23267473419948748,-0.13198861244526255,-0.19935396696144578,7.3136587489828786,0.040422877259921795,-0.002121027910078808,-0.0022151490690233496,0],"IMU":[0.0083625657366595066,0.20383223560512428,0.45380597828868596,0.080122901952851683,-0.039259561852908055,0.24315852161502294,1.9493025922617788,-0.081061367244813637,-9.7141852777285358],"FOG":[0.45170353503772193],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-22.633578559873708,89.539678983354321,-43.194197951106062,73.967945901814261,73.967945901814261],"omega_rad_s":[-21.422399972998679,93.074205998375874,-43.098895155966773,74.431167748332811,74.431660035540659],"thrust_n":[-5.8146097033650621,99.478180129653325,-27.676004492452897,62.07382936434815,62.57315636436342],"torque_nm":[0.10902393193809491,-1.8652158774310001,0.51892508423349182,-1.1638843005815278,-1.1732466818318141],"angle_rad":[-430.20770487343003,589.15529911666215,-38.112295162884827,934.62877742304715,934.62594193239374]},"command":[-0.21555789104641626,0.85275884746051733,-0.41137331382005776,0.70445662763632633,0.70445662763632633],"arm":{"servo_position":[-1.618957894888786e-21,-1.0842021724855024e-21,1.0778494253810979e-21,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,3.4694469519536142e-18,0,0,0],"servo_effort":[1.9765847765357862,-2.2083450683418446,0.091083251031648549,0.0017216059818450703,0.0015123804335371914,-0.0063852122715582502]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":282,"step":2256,"t":11.279999999999999,"sim_time":11.280000000000364,"vehicle":{"origin_ned":[1.2305640427066029,0.90008864061673766,3.2903240027547573],"origin_quat_xyzw":[-0.018804987313382864,0.10033801768717893,0.22567980408144769,0.96883810860664954],"cg_ned":[1.130367088601324,0.85392025743137923,3.0065547614453942],"linear_velocity_ned":[0.25411046353960037,0.12204817711741837,0.1973510778604676],"angular_velocity_ned":[0.0095208724245229182,0.018508892342390795,0.11788321743446192]},"sensors":{"Odom":[1.2305640427066029,0.90008864061673766,3.2903240027547573,0.2400446570412795,0.007443135550340302,0.24978395835661293,-0.018804987313382895,0.10033801768717909,0.22567980408144808,0.96883810860664954,-0.0075364002145589699,0.013454413600313851,0.11870914238863227],"Pressure":[24360.576168955653],"DVL":[0.19460819704523133,-0.11602200564369546,-0.2542875542298324,7.3013634105104668,-0.024953182883163498,0.034733395229778648,0.031635554193447962,0],"IMU":[0.0090387014986914455,0.20432924311108583,0.4586417877296633,-0.0089113330791916589,-0.017843778917525852,0.2571979568989774,1.938686678336178,-0.095308095351221062,-9.6688762386038416],"FOG":[0.46473526793521436],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-22.716837999228133,87.846031187158744,-44.113076704069947,73.403653872055344,73.403653872055344],"omega_rad_s":[-21.484258698913354,91.295844040433209,-44.195506061596689,73.809226516768689,73.809715228285114],"thrust_n":[-5.861435619662358,95.569604523468556,-28.956964606895557,61.07047700941564,61.565670215151428],"torque_nm":[0.10990191786866924,-1.7919300848150352,0.54294308637929167,-1.1450714439265435,-1.1543563165340891],"angle_rad":[-431.06595342356559,592.83768906401315,-39.861475565551139,937.59178184074835,937.58896595904753]},"command":[-0.21635083808788699,0.83662886844913087,-0.42012454003876143,0.69908241782909852,0.69908241782909852],"arm":{"servo_position":[-1.618957894888786e-21,-1.0842021724855024e-21,-1.6269385334386973e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,-3.4694469519536142e-18,0,0,0],"servo_effort":[1.9327575736921059,-2.1938011487700626,0.083222594740736247,0.0017350397477412069,0.0014716378159384371,-0.0063017415608693844]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":283,"step":2264,"t":11.32,"sim_time":11.32000000000037,"vehicle":{"origin_ned":[1.2406715513374273,0.90530723075684816,3.2980994071407022],"origin_quat_xyzw":[-0.018771065020398658,0.10060921799273091,0.22799897032864538,0.96826747435921268],"cg_ned":[1.1404833464317505,0.85877438190969158,3.0143866137965127],"linear_velocity_ned":[0.25194816468945208,0.12080552857166603,0.19458910895841],"angular_velocity_ned":[0.0098008738879404884,0.01860424472848015,0.11870792988063388]},"sensors":{"Odom":[1.2406715513374273,0.90530723075684816,3.2980994071407022,0.23801830470821234,0.0060752288435651025,0.2467027960669948,-0.018771065020398665,0.10060921799273094,0.22799897032864547,0.96826747435921268,-0.0074168248310242622,0.013423430318006073,0.11957654408517385],"Pressure":[24435.200258010209],"DVL":[0.19498539065015699,-0.11284614796060066,-0.26021015341256032,7.3064087338590156,-0.024429425216311664,0.012652299239594871,-0.019128136820747908,0],"IMU":[0.0097303137748014946,0.20482194890584671,0.46351664203646831,-0.062973075881874951,0.074376355143447745,0.11974765681644989,1.9580650634666694,-0.099451820693867016,-9.7040377239537463],"FOG":[0.47540132041435923],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-22.813992964394366,86.181919271617261,-44.976423531207409,72.856890630005111,72.856890630005111],"omega_rad_s":[-21.565428796078209,89.52943318747495,-45.216945789510824,73.207994672471628,73.208480581040192],"thrust_n":[-5.9187781031813316,91.772523116600823,-30.170857502093533,60.11219167368143,60.602360173676843],"torque_nm":[0.11097708943464997,-1.7207348084362653,0.56570357816425376,-1.1271035938815268,-1.1362942532564408],"angle_rad":[-431.92712252730018,596.44919684545584,-41.6527839117254,940.5303830727978,940.52758667314401]},"command":[-0.21727612347042255,0.820780183539212,-0.42834689077340388,0.69387514885719148,0.69387514885719148],"arm":{"servo_position":[2.7178507950532318e-21,-1.0842021724855024e-21,-1.6269385334386973e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[8.6736173798840355e-19,0,0,0,0,0],"servo_effort":[1.8900619132986531,-2.1813177998887703,0.074698305095764403,0.0017458224575348262,0.0014294269606740231,-0.0062115413632330523]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":284,"step":2272,"t":11.359999999999999,"sim_time":11.360000000000376,"vehicle":{"origin_ned":[1.2506873330256945,0.91047528423080382,3.3057653542083845],"origin_quat_xyzw":[-0.018733201494752588,0.10087963102605003,0.23033180411423895,0.96768777362292047],"cg_ned":[1.1505102981129884,0.86357795641391355,3.0221086358833098],"linear_velocity_ned":[0.24966221077517367,0.119525753240125,0.19185606274530589],"angular_velocity_ned":[0.0100455417800141,0.018645251193043673,0.11939394276983341]},"sensors":{"Odom":[1.2506873330256945,0.91047528423080382,3.3057653542083845,0.23584749914442063,0.0047450044265881803,0.2436225626709223,-0.018733201494752633,0.10087963102605027,0.23033180411423948,0.96768777362292047,-0.0073244291785152273,0.013357450354273151,0.12029714514099663],"Pressure":[24506.185578175708],"DVL":[0.21903056592559997,-0.09303239909174256,-0.27219932857131374,7.3230294438106442,0.029517629146719994,-0.0096201184432669114,0.010347290639743791,0],"IMU":[0.010435138534750827,0.20530899517002263,0.46842435710788427,0.012832618936093495,0.031179996957861264,0.12120272206344468,1.9538079266627444,-0.10177617333008546,-9.6559072123403453],"FOG":[0.4942184759983354],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-22.922823529606365,84.547180249093884,-45.787254980988564,72.327040634855805,72.327040634855805],"omega_rad_s":[-21.663635645831558,87.781516814725023,-46.170519723271298,72.62661582334924,72.627100083724699],"thrust_n":[-5.9855179864392607,88.098268394541776,-31.321324235671423,59.196626256183293,59.680681521835808],"torque_nm":[0.11222846224573614,-1.651842532397658,0.58727482941883924,-1.1099367423034365,-1.1190127785344215],"angle_rad":[-432.79193280100526,599.99045638159998,-43.483385817251758,943.44538976965623,943.44261276468478]},"command":[-0.21831260504387015,0.80521124046756076,-0.43606909505703395,0.68882895842719816,0.68882895842719816],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,-1.6269385334386973e-20,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,0,0,0,-2.7755575615628914e-17],"servo_effort":[1.8487413910941564,-2.1707978871755627,0.065575944434665023,0.0017543285498628459,0.0013859658498422108,-0.006115026099733775]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":285,"step":2280,"t":11.4,"sim_time":11.400000000000382,"vehicle":{"origin_ned":[1.2606062443333124,0.91559122659096703,3.3133231802933145],"origin_quat_xyzw":[-0.018692065190282707,0.10114833216654055,0.23267560778867952,0.96709962420580953],"cg_ned":[1.1604432238683924,0.86832955891964092,3.0297219891260592],"linear_velocity_ned":[0.24726263818762328,0.11821165168616542,0.189152107082945],"angular_velocity_ned":[0.01025630491230419,0.018626406122718403,0.1199517228713038]},"sensors":{"Odom":[1.2606062443333124,0.91559122659096703,3.3133231802933145,0.23354140202193449,0.0034550227265933071,0.24054527824876765,-0.018692065190282707,0.10114833216654054,0.23267560778867949,0.96709962420580953,-0.0072627198275992746,0.013251371155247382,0.12088095250496805],"Pressure":[24580.327639355139],"DVL":[0.23486014733671931,-0.088901185306986763,-0.23502574025755593,7.2876526860777036,-0.023335756804157864,0.016921813159059398,0.022749436200268619,0],"IMU":[0.011150828442876357,0.20578882402040227,0.47335915014455471,0.010245917591129975,-0.031448955673062086,0.14099049301487865,1.9497183324089491,-0.12908483234151683,-9.6804115537062785],"FOG":[0.49259606083083129],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-23.041262723826645,82.941438080610197,-46.548229485415568,71.813552952816067,71.813552952816067],"omega_rad_s":[-21.776622622677969,86.056395603817421,-47.06138077451984,72.064311782108859,72.064795909414812],"thrust_n":[-6.0605431827157679,84.552436324361153,-32.410321690791655,58.321643165039099,58.798333334112257],"torque_nm":[0.11363518467592065,-1.5853581810817714,0.60769353170234364,-1.0935308093444833,-1.1024687500146049],"angle_rad":[-433.66101413673317,603.46231019454513,-45.350689486766882,946.33757811809255,946.33482047484119]},"command":[-0.21944059736977756,0.78991845791057325,-0.44331647128967205,0.68393859955062919,0.68393859955062919],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.0778494253810979e-21,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,3.4694469519536142e-18,0,0,0],"servo_effort":[1.80890917213185,-2.1621260744556321,0.055921510180345024,0.0017601589710332286,0.0013414540561906474,-0.0060128776266729139]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":286,"step":2288,"t":11.44,"sim_time":11.440000000000389,"vehicle":{"origin_ned":[1.2704234675066386,0.92065361617033736,3.320774245730215],"origin_quat_xyzw":[-0.018648343542221137,0.10141429473040435,0.23502788812521794,0.96650363264235373],"cg_ned":[1.1702777989134709,0.87302787840512508,3.0372278373672033],"linear_velocity_ned":[0.2447591849137444,0.1168659744173489,0.18647722858951021],"angular_velocity_ned":[0.010434659816374127,0.018543074738280561,0.12039131011877821]},"sensors":{"Odom":[1.2704234675066386,0.92065361617033736,3.320774245730215,0.23110919536180227,0.0022074489429421851,0.23747267404302547,-0.018648343542221158,0.10141429473040448,0.23502788812521824,0.96650363264235373,-0.0072347619399708851,0.013100871108255939,0.12133763098983581],"Pressure":[24651.435535728968],"DVL":[0.19404783174661397,-0.08386725996759814,-0.23091024789553952,7.2016999607762635,0.034168038507484948,-0.039799248587646822,0.015702251579410031,0],"IMU":[0.011874969203874352,0.20625970912437788,0.47831562934003757,0.049226612113022657,-0.030864458666003083,0.12560614202369949,1.9448346991586269,-0.10777596413173907,-9.6850414119887169],"FOG":[0.4863873362238561],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-23.167406623352676,81.364201642435489,-47.261770126629912,71.315942766173279,71.315942766173279],"omega_rad_s":[-21.902201748811741,84.356806591183599,-47.893559944068549,71.520380209295496,71.520866041206133],"thrust_n":[-6.1427681598348141,81.136793507675208,-33.439127594621787,57.485300345131037,57.953242323434466],"torque_nm":[0.11517690299690278,-1.5213148782689108,0.62698364239915871,-1.0778493814712071,-1.0866232935643962],"angle_rad":[-434.53490763078236,606.86573575317925,-47.252279987888272,949.20769491562544,949.20495666913644]},"command":[-0.22064196784145407,0.77489715849938567,-0.45011209644409439,0.67919945491593603,0.67919945491593603],"arm":{"servo_position":[2.7178507950532318e-21,-1.0842021724855024e-21,1.0778494253810979e-21,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[8.6736173798840355e-19,0,0,0,0,0],"servo_effort":[1.7706212621562387,-2.155185143992389,0.045794148418838637,0.0017641742596685394,0.0012960612281415912,-0.0059057319002259493]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":287,"step":2296,"t":11.48,"sim_time":11.480000000000395,"vehicle":{"origin_ned":[1.2801345070090213,0.92566113847691722,3.3281199257468441],"origin_quat_xyzw":[-0.018602737654518402,0.1016764067813332,0.23738634664314523,0.96590039283728124],"cg_ned":[1.1800100797317441,0.87767171219867013,3.0446273410835079],"linear_velocity_ned":[0.24216121045210739,0.11549139414177448,0.18383129536913256],"angular_velocity_ned":[0.010582155437407188,0.01839148987080378,0.12072216151266109]},"sensors":{"Odom":[1.2801345070090213,0.92566113847691722,3.3281199257468441,0.22855997049457738,0.001004061267071824,0.23440624664341714,-0.018602737654518441,0.10167640678133343,0.23738634664314573,0.96590039283728124,-0.0072431470117404681,0.012902403255455549,0.1216763494080024],"Pressure":[24719.6172872723],"DVL":[0.16898515073903575,-0.16350822214382982,-0.21159112075484973,7.2377182118388887,0.022593769505500766,0.001271441819771691,0.0045367658701927736,0],"IMU":[0.012605094425984386,0.20671978697672538,0.48328877645733276,0.024454964949959551,-0.043929303464666322,0.34712421334976173,1.9503044887545575,-0.12564611620564048,-9.6497822924464813],"FOG":[0.45809350706073504],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-23.299517897393027,79.814903897308,-47.930118318482307,70.833777922269334,70.833777922269334],"omega_rad_s":[-22.038287470033413,82.684400412365619,-48.670568252081551,70.994189248065638,70.994678897641037],"thrust_n":[-6.2311466064069991,77.850588091917515,-34.408949770958088,56.685832295534851,57.143542290077384],"torque_nm":[0.11683399887013125,-1.4596985267234532,0.64516780820546427,-1.0628593555412786,-1.0714414179389511],"angle_rad":[-435.41406911454266,610.20179424034052,-49.185891199405717,952.05646049004622,952.05374175523104]},"command":[-0.22190017045136215,0.76014194187912376,-0.45647731731887914,0.67460740878351744,0.67460740878351744],"arm":{"servo_position":[2.7178507950532318e-21,-1.0842021724855024e-21,1.0778494253810979e-21,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[4.3368086899420177e-19,0,0,0,0,-2.7755575615628914e-17],"servo_effort":[1.7338729624556626,-2.1498544574694303,0.035252787161434845,0.0017663027148869907,0.0012499603309036602,-0.0057940431275047034]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":288,"step":2304,"t":11.52,"sim_time":11.520000000000401,"vehicle":{"origin_ned":[1.2897351659987963,0.93061259065975366,3.335361591515094],"origin_quat_xyzw":[-0.018555956959204811,0.10193348630642665,0.2397488671962594,0.96529048555802932],"cg_ned":[1.1896364709619016,0.88225995388363188,3.0519216414376142],"linear_velocity_ned":[0.23947674845041433,0.11409003011323084,0.18121344510994961],"angular_velocity_ned":[0.010700414247158233,0.018168607063013303,0.12095305751697863]},"sensors":{"Odom":[1.2897351659987963,0.93061259065975366,3.335361591515094,0.22590176005795681,-0.00015371951304551717,0.2313464569531633,-0.018555956959204818,0.10193348630642668,0.23974886719625946,0.96529048555802932,-0.0072900059829551431,0.01265304679438862,0.12190568276320839],"Pressure":[24791.325699467394],"DVL":[0.20871165382999396,-0.093189284777162068,-0.26179744566770757,7.2916086433469287,-0.01115114548982795,0.010880090593728284,0.006475246583891309,0],"IMU":[0.013338699644107889,0.20716708468128428,0.48827392374761358,-0.078153656877963662,-0.04043449701396877,0.16690006651860001,1.9720851168145921,-0.12677834450640491,-9.7085297566848681],"FOG":[0.47964199495482551],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-23.436030172165591,78.29300835431998,-48.555289691697233,70.366750133061004,70.366750133061004],"omega_rad_s":[-22.18292269439381,81.040090802776078,-49.395508554660829,70.485185282534474,70.485681087267707],"thrust_n":[-6.3246820449177683,74.69150111457094,-35.320952975875429,55.921678794712086,56.367597057921728],"torque_nm":[0.11858778834220818,-1.4004656458982052,0.66226786829766426,-1.0485314774008514,-1.0568924448360324],"angle_rad":[-436.29887387550502,613.47159524404071,-51.149388060876483,954.88457154649006,954.88187252799867]},"command":[-0.223200287353958,0.74564769861257119,-0.46243133039711654,0.67015952507677146,0.67015952507677146],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.0778494253810979e-21,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[-4.3368086899420177e-19,0,3.4694469519536142e-18,0,0,0],"servo_effort":[1.6986148861282264,-2.1458759332474915,0.024331885081056454,0.0017668955870701168,0.0012031232313331752,-0.0056785402169126928]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":289,"step":2312,"t":11.56,"sim_time":11.560000000000407,"vehicle":{"origin_ned":[1.2992214875845902,0.93550684808148332,3.3425005795643585],"origin_quat_xyzw":[-0.018508713672185043,0.10218429440808278,0.24211350321838229,0.96467447828469344],"cg_ned":[1.1991536580567248,0.88679156359741962,3.0591118322887549],"linear_velocity_ned":[0.23671116535375789,0.11266273461446018,0.17862199351435296],"angular_velocity_ned":[0.010791149521871197,0.017872026669621281,0.12109213069710395]},"sensors":{"Odom":[1.2992214875845902,0.93550684808148332,3.3425005795643585,0.22314003688603756,-0.001264781968718493,0.22829233667922358,-0.018508713672185078,0.10218429440808297,0.24211350321838274,0.96467447828469344,-0.0073770229979402344,0.012350421708184551,0.12203363871230512],"Pressure":[24857.635900969493],"DVL":[0.18190514458044166,-0.13683633974182854,-0.20679605378502514,7.1528074831492603,-0.0030644523394272832,0.023076261450284439,-0.0050228989236553489,0],"IMU":[0.014073256130302591,0.20759954346607853,0.49326673017026185,0.024317489947351174,0.10019125268201393,0.191944688031563,1.9543412310739741,-0.15005533860433531,-9.6698824024704173],"FOG":[0.48179388681111401],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-23.57553444810166,76.798141535239296,-49.138928134154121,69.91481627385437,69.91481627385437],"omega_rad_s":[-22.334292815607924,79.424350375633253,-50.071071727515211,69.992963970674936,69.993468442450208],"thrust_n":[-6.422433554843848,71.65641051681807,-36.176141113037168,55.191610497026637,55.624122410048145],"torque_nm":[0.12042062915332218,-1.3435576971903387,0.678302645869447,-1.0348426968192497,-1.0429522951884025],"angle_rad":[-437.18962214821721,616.67627434230724,-53.140750048561671,957.69270606801126,957.69002706807976]},"command":[-0.2245288995057301,0.73141087176418373,-0.46798979175384875,0.6658553930843274,0.6658553930843274],"arm":{"servo_position":[2.7178507950532318e-21,-1.0842021724855024e-21,1.0778494253810979e-21,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,1.7347234759768071e-18,0,0,0],"servo_effort":[1.6648240492192594,-2.1429118486786294,0.012980798167487161,0.0017653771663507488,0.0011551225004163598,-0.0055591939925361405]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":290,"step":2320,"t":11.6,"sim_time":11.600000000000414,"vehicle":{"origin_ned":[1.308589499639047,0.94034272773922245,3.3495380990190751],"origin_quat_xyzw":[-0.018461715822958299,0.10242753995484882,0.24447846508979271,0.96405292604452431],"cg_ned":[1.208558347957267,0.89126543703341488,3.0661988681289434],"linear_velocity_ned":[0.233863275194233,0.11120704120738688,0.1760528376565717],"angular_velocity_ned":[0.010856384750727517,0.017499502448172447,0.12114682423544484]},"sensors":{"Odom":[1.308589499639047,0.94034272773922245,3.3495380990190751,0.22027357970149958,-0.00232822393901166,0.22523904321429541,-0.018461715822958316,0.10242753995484892,0.24447846508979293,0.96405292604452431,-0.0075054544833724306,0.011992142777943192,0.12206761799394072],"Pressure":[24924.577833893291],"DVL":[0.1794156437502859,-0.099891210980707371,-0.23773141694177308,7.2292965043219111,-0.0025090691820020628,-0.042847353276397541,0.01115870488269244,0],"IMU":[0.01480622358354812,0.20801502456014692,0.49826315730142701,0.095308021917600572,-0.056290190812291585,-0.064422114795472607,1.9685591905742881,-0.13160607655125339,-9.7027412044466725],"FOG":[0.48818151686234329],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-23.716722959942292,75.331691854192528,-49.679951787560228,69.479377245593383,69.479377245593383],"omega_rad_s":[-22.490720614827644,77.837762188019596,-50.699023303855888,69.517559275157296,69.518075058821921],"thrust_n":[-6.5235116845317656,68.742671818112811,-36.974469202821624,54.495294487363687,54.912733983320891],"torque_nm":[0.12231584408497065,-1.2889250965896153,0.69327129755290562,-1.0217867716380691,-1.0296137621872667],"angle_rad":[-438.08654477177305,619.81698605500208,-55.158046219357018,960.48153412183535,960.47887554627789]},"command":[-0.22587355199945039,0.71744468432564312,-0.47314239797676411,0.66170835471993694,0.66170835471993694],"arm":{"servo_position":[2.7178507950532318e-21,-1.0842021724855024e-21,1.0778494253810979e-21,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[4.3368086899420177e-19,0,1.7347234759768071e-18,0,0,-2.7755575615628914e-17],"servo_effort":[1.6324360640470852,-2.1408006159284318,0.0011765133212496108,0.0017632038645740995,0.0011057603567201284,-0.0054359535011106056]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":291,"step":2328,"t":11.640000000000001,"sim_time":11.64000000000042,"vehicle":{"origin_ned":[1.317835373814956,0.94511906809754409,3.3564752982264134],"origin_quat_xyzw":[-0.018415662847077918,0.10266189339217417,0.2468421072579553,0.96342637139092713],"cg_ned":[1.2178474191954545,0.89568048805590994,3.0731836335666629],"linear_velocity_ned":[0.23094086672159639,0.10972528312060231,0.17350576643082111],"angular_velocity_ned":[0.01089794133708964,0.017049845511747312,0.12112393814345641]},"sensors":{"Odom":[1.317835373814956,0.94511906809754409,3.3564752982264134,0.2173106174272299,-0.0033433888814693538,0.22218760333185125,-0.018415662847077924,0.10266189339217421,0.24684210725795541,0.96342637139092713,-0.0076761530671362217,0.011576850804516993,0.12201444155623876],"Pressure":[24990.76273109503],"DVL":[0.18421675577111057,-0.11681589802420574,-0.26781409520287158,7.2513547994483023,-0.0045619024699733567,0.006751603667343945,-0.019262150027641072,0],"IMU":[0.015535062565268602,0.20841133393104824,0.50325944543717249,0.058877801535009627,0.034049956666993217,0.20319995672224853,1.9747711338607286,-0.15000883814376162,-9.6572577880310853],"FOG":[0.50073440670920988],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-23.858357506630966,73.894174444422433,-50.178851591567309,69.060956050128553,69.060956050128553],"omega_rad_s":[-22.65064485665766,76.281058776488678,-51.280449035324011,69.059330921562392,69.059860755636009],"thrust_n":[-6.6270669075705193,65.947638378465911,-37.71541913111939,53.832782226678653,54.233464880325656],"torque_nm":[0.12425750451694728,-1.2365182195962356,0.70716410870848856,-1.009364666750225,-1.016877466506106],"angle_rad":[-438.98980816040159,622.89491413748613,-57.199396218312948,963.25173707661406,963.24909943929629]},"command":[-0.22722245244410444,0.70375404232783267,-0.47789382468159342,0.65772339095360532,0.65772339095360532],"arm":{"servo_position":[2.7178507950532318e-21,-1.0842021724855024e-21,1.0778494253810979e-21,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[0,0,0,0,0,-2.7755575615628914e-17],"servo_effort":[1.6013717495299218,-2.1399490045833551,-0.010879286561885169,0.0017593672111952314,0.0010561388352153995,-0.0053099196346040366]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":292,"step":2336,"t":11.68,"sim_time":11.680000000000426,"vehicle":{"origin_ned":[1.3269555854912296,0.94983481117657886,3.3633133312520664],"origin_quat_xyzw":[-0.018371242852484114,0.10288600355203471,0.24920291583660445,0.96279534401017941],"cg_ned":[1.2270180715221746,0.90003573197140796,3.0800670134591974],"linear_velocity_ned":[0.22795191366314208,0.10822002808531676,0.17098084945436046],"angular_velocity_ned":[0.01091759677269576,0.016522539506987,0.12102964599107478]},"sensors":{"Odom":[1.3269555854912296,0.94983481117657886,3.3633133312520664,0.21425974011181631,-0.0043098802155502689,0.21913937663157332,-0.018371242852484149,0.10288600355203491,0.24920291583660492,0.96279534401017941,-0.0078895964498243779,0.011103791528507869,0.12188036561040654],"Pressure":[25057.338760338651],"DVL":[0.18890915752335907,-0.090039119145667548,-0.22723955482970246,7.260855538221727,0.0020813943341323761,0.016075145354918143,0.027200405288132279,0],"IMU":[0.016257245732206878,0.20878625345071242,0.50825209093919343,-0.063214384494813508,0.01829986462176942,0.36089342164932836,1.9815700750044649,-0.162211190879686,-9.6888226944601659],"FOG":[0.50558442941649673],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-23.999336628584956,72.485163579648429,-50.637571837865956,68.659192874685857,68.659192874685857],"omega_rad_s":[-22.812625787732539,74.754595883828614,-51.816733252318002,68.618413111221358,68.618959783156029],"thrust_n":[-6.7322944031624408,63.267942727570876,-38.399160890280285,53.203721856870857,53.585964270325022],"torque_nm":[0.12623052005929575,-1.1862739261419539,0.71998426669275528,-0.99756978481632863,-1.0047368300685942],"angle_rad":[-439.89951902078116,625.91126292608624,-59.262969903399927,966.00400557007549,966.00138949564609]},"command":[-0.22856511074842817,0.69033489123474689,-0.4822625889320567,0.65389707499700811,0.65389707499700811],"arm":{"servo_position":[2.7178507950532318e-21,-1.0842021724855024e-21,-7.5957679545029377e-21,0,-7.5301229010907305e-20,-4.9127910940749275e-21],"servo_velocity":[4.3368086899420177e-19,0,1.7347234759768071e-18,0,0,0],"servo_effort":[1.571561418950266,-2.140252565874706,-0.023139768557587596,0.0017543922616393886,0.0010063892997676451,-0.0051814802684555265]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":293,"step":2344,"t":11.720000000000001,"sim_time":11.720000000000432,"vehicle":{"origin_ned":[1.3359469111345943,0.95448900029359729,3.3700533584232968],"origin_quat_xyzw":[-0.018329129051609456,0.10309851031746167,0.25155949680570283,0.96216036073275801],"cg_ned":[1.236067815135365,0.90433028527236492,3.0868498961898476],"linear_velocity_ned":[0.22490400961689083,0.10669377219364416,0.1684781864095152],"angular_velocity_ned":[0.010917091390251351,0.015917709336352299,0.12086953760037762]},"sensors":{"Odom":[1.3359469111345943,0.95448900029359729,3.3700533584232968,0.21112930383292339,-0.0052275493632349453,0.21609568545344263,-0.018329129051609491,0.10309851031746188,0.25155949680570333,0.96216036073275801,-0.0081458920784883565,0.010572778501322315,0.12167112340928067],"Pressure":[25122.478658829052],"DVL":[0.19646459773549049,-0.1148183846932662,-0.22304968841114164,7.0414033531566291,-0.00065545696520190127,0.0075182889582899436,0.017440435762861046,0],"IMU":[0.016970269188155168,0.20913756334926525,0.51323782469987922,-0.01055163114099027,-0.02192507365538128,0.23591853843313021,1.9733480181715342,-0.17384384038681719,-9.6549331217306325],"FOG":[0.4994451585166596],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-24.138696136613419,71.104242939720493,-51.05799786979015,68.273714380262604,68.273714380262604],"omega_rad_s":[-22.975353105338215,73.258458939543942,-52.309470173706266,68.194765590403108,68.195331895947305],"thrust_n":[-6.8384406199540511,60.699811697692468,-39.02639498327251,52.607486525885633,52.969622291499817],"torque_nm":[0.12822076162413848,-1.1381214693317336,0.73174490593635944,-0.98639037236035587,-0.99318041796562151],"angle_rad":[-440.8157294029084,628.86724454870762,-61.346997562537538,968.73903147113811,968.73643769605746]},"command":[-0.22989234415822304,0.67718326609257617,-0.48626664637895384,0.65022585124059618,0.65022585124059618],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.0778494253810979e-21,0,-7.5301229010907305e-20,-1.436906691722195e-19],"servo_velocity":[0,0,-1.7347234759768071e-18,0,0,0],"servo_effort":[1.5429227956622416,-2.1415919279950373,-0.035556568227780666,0.0017484101405401754,0.00095663710214591237,-0.0050511321074766134]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":294,"step":2352,"t":11.76,"sim_time":11.760000000000439,"vehicle":{"origin_ned":[1.3448064083575488,0.959080768699068,3.3766965402619564],"origin_quat_xyzw":[-0.01828997621559339,0.10329805594166551,0.25391056504244014,0.96152192557868077],"cg_ned":[1.2449944433801765,0.90856335620379514,3.0935331700790258],"linear_velocity_ned":[0.22180342565172584,0.10514842831090664,0.16599754405220771],"angular_velocity_ned":[0.010898184414873613,0.01523600519163658,0.12064865603079013]},"sensors":{"Odom":[1.3448064083575488,0.959080768699068,3.3766965402619564,0.20792641192771999,-0.0060964622740703606,0.21305724767919931,-0.018289976215593418,0.10329805594166565,0.25391056504244053,0.96152192557868077,-0.0084447805556186611,0.009984058048234835,0.12139196326789106],"Pressure":[25184.781661054309],"DVL":[0.19258621829309891,-0.14051265432994078,-0.22247573112648772,7.2297597314900717,-0.018998107841081392,-0.0037184981714551446,-0.011520919948185755,0],"IMU":[0.017671663647227904,0.20946306184446054,0.51821359234289066,-0.023472719635830801,0.12007000839571226,0.27642177375066079,1.970736377638109,-0.18541969665220126,-9.6611039860877206],"FOG":[0.51485062025628225],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-24.275602126029344,69.751014476503101,-51.441950134421219,67.904141621928574,67.904141621928574],"omega_rad_s":[-23.137650097559892,71.792555790940284,-52.760373585683602,67.788227612248008,67.788816319093172],"thrust_n":[-6.9448081999424902,58.239298050652643,-39.598199327183949,52.043285834056213,52.383677594249498],"torque_nm":[0.1302151537489217,-1.0919868384497371,0.74246623738469919,-0.97581160938855405,-0.98219395489217831],"angle_rad":[-441.73844199425764,631.76407030307109,-63.449776167506528,971.4575021760578,971.4549315480956]},"command":[-0.231196210724089,0.66429537596669619,-0.48992333461353543,0.64670611068503403,0.64670611068503403],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,9.7514668052651336e-21,0,-7.5301229010907305e-20,-1.436906691722195e-19],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[1.5153791621870762,-2.1437488799123612,-0.048129375939882403,0.0017418201665153315,0.0009067454468590022,-0.0049190641123515455]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":295,"step":2360,"t":11.800000000000001,"sim_time":11.800000000000445,"vehicle":{"origin_ned":[1.3535313071763109,0.96360927910484029,3.3832439995212367],"origin_quat_xyzw":[-0.018254415973219997,0.10348329196417168,0.25625493452418852,0.96088053009400631],"cg_ned":[1.2537959189491408,0.91273418723376276,3.1001176869088232],"linear_velocity_ned":[0.21865353104503515,0.10358442204815291,0.16353774699307172],"angular_velocity_ned":[0.010862729487550465,0.014478408403771088,0.12037156072066435]},"sensors":{"Odom":[1.3535313071763109,0.96360927910484029,3.3832439995212367,0.20465519761551218,-0.0069168558331483276,0.21002321271451202,-0.01825441597321999,0.10348329196417164,0.2562549345241884,0.96088053009400631,-0.0087856690563508644,0.0093380974092574336,0.12104770872743595],"Pressure":[25247.433275528474],"DVL":[0.21649324526858091,-0.11599487749547188,-0.20021356000467194,7.2681510846465045,-0.00053778792090434038,-0.0066430733336666813,-0.00057381217865246352,0],"IMU":[0.018359006102721741,0.20976057540399004,0.52317653668174224,-0.029643199457435175,-0.070344383128989121,0.30591960008268904,1.9742720844668096,-0.17772412911032492,-9.68486169423878],"FOG":[0.51712300571332803],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-24.409325716460568,68.425873768865316,-51.790154465990078,67.5506812508807,67.5506812508807],"omega_rad_s":[-23.298468551217649,70.356861187737437,-53.170974906698611,67.398693071306283,67.399306890302555],"thrust_n":[-7.0507557771723617,55.882782836322406,-40.115534382702478,51.510493833118439,51.827538232784569],"torque_nm":[0.13220167082198178,-1.0478021781810452,0.75216626967567168,-0.96582175937097059,-0.97176634186471056],"angle_rad":[-442.66761536977992,634.60294826834922,-65.569668430921027,974.16009911789138,974.15755259432603]},"command":[-0.23246976872819589,0.65167498827490777,-0.49323956634276267,0.64333982143695911,0.64333982143695911],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.0778494253810979e-21,0,-7.5301229010907305e-20,-1.436906691722195e-19],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[1.4888763391726734,-2.1465725092337622,-0.0608548833055709,0.0017343334192355998,0.0008566267545894946,-0.0047855984803278715]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":296,"step":2368,"t":11.84,"sim_time":11.840000000000451,"vehicle":{"origin_ned":[1.3621190533718572,0.96807374727339301,3.3896968400941052],"origin_quat_xyzw":[-0.01822305259857172,0.10365288319147685,0.25859150808943665,0.96023665421817472],"cg_ned":[1.2624704137888094,0.91684208173055093,3.1066042817211037],"linear_velocity_ned":[0.21546082163760111,0.10200403488886758,0.16109888818648507],"angular_velocity_ned":[0.010812768189606619,0.013645932201713663,0.12004218565014498]},"sensors":{"Odom":[1.3621190533718572,0.96807374727339301,3.3896968400941052,0.20132301147055554,-0.0076891332779313376,0.20699477426210608,-0.01822305259857173,0.10365288319147692,0.25859150808943682,0.96023665421817472,-0.0091676642157090538,0.0086352698595135793,0.12064261189364726],"Pressure":[25312.052150043193],"DVL":[0.18587082644151109,-0.09549890788398066,-0.21489698856088346,7.1548213859640386,0.033501619953596511,-0.0020549532635074424,-0.015413451198400634,0],"IMU":[0.019029929039194312,0.21002796338399196,0.52812397885314166,-0.064110227764305777,0.064857763291390536,0.36558311586293174,1.9743994959069648,-0.18050341464782821,-9.701045404595682],"FOG":[0.53911432529067504],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-24.539219610117364,67.128949074766382,-52.103758010802352,67.213262873389795,67.213262873389795],"omega_rad_s":[-23.456876108780623,68.951454411907122,-53.542615300272189,67.026118766425114,67.026760330254007],"thrust_n":[-7.1556937128298355,53.626833607118904,-40.579344007164373,51.008560899342392,51.300685396742999],"torque_nm":[0.13416925711555941,-1.0055031301334794,0.7608627001343321,-0.95641051686266998,-0.96188785118893128],"angle_rad":[-443.6031688428381,637.38508887362798,-67.705092536823798,976.84750174670933,976.84498039154312]},"command":[-0.23370685342968919,0.63932332452158458,-0.49622626676954618,0.64012631307990275,0.64012631307990275],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.0778494253810979e-21,0,-7.5301229010907305e-20,-1.436906691722195e-19],"servo_velocity":[0,0,-3.4694469519536142e-18,0,0,0],"servo_effort":[1.463241851393144,-2.1503327933728498,-0.073665920200443546,0.0017257172235718608,0.00080672875979352523,-0.0046511131706722924]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":297,"step":2376,"t":11.880000000000001,"sim_time":11.880000000000457,"vehicle":{"origin_ned":[1.3705673528661955,0.97247346675775204,3.3960561600210255],"origin_quat_xyzw":[-0.01819645836093934,0.10380551072103192,0.26091926710558072,0.95959076741085358],"cg_ned":[1.27101635041501,0.92088643213994115,3.1129937865032407],"linear_velocity_ned":[0.21223118686907261,0.10040933600421578,0.15868066175078194],"angular_velocity_ned":[0.010750262789625745,0.012740236357274967,0.11966412586518703]},"sensors":{"Odom":[1.3705673528661955,0.97247346675775204,3.3960561600210255,0.19793679294411415,-0.0084138643035239387,0.20397262079339992,-0.018196458360939343,0.10380551072103193,0.26091926710558078,0.95959076741085358,-0.0095895526546279641,0.0078765204368924195,0.12018063778020112],"Pressure":[25373.011403602231],"DVL":[0.17659938977713308,-0.063706987716225127,-0.19739015631631168,7.1570913831970078,0.004977451615027763,0.010473255863684115,-0.03828965652729064,0],"IMU":[0.019682130051144945,0.2102631204356934,0.53305339924622919,0.053321792726600439,-0.014102606041142596,0.18879125072214178,1.9808242878291544,-0.18905154328908155,-9.6509332940427086],"FOG":[0.5168122088133148],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-24.664737034868526,65.860069164551021,-52.384406149823462,66.891534799522589,66.891534799522589],"omega_rad_s":[-23.612051875453201,67.576317406152853,-53.876768337627041,66.670348652921831,66.671020505596132],"thrust_n":[-7.259084636861072,51.467950488934385,-40.990932305833581,50.536780282075483,50.802452433704403],"torque_nm":[0.13610783694114514,-0.96502407166751969,0.76857998073437972,-0.94756463028891524,-0.95254598313195749],"angle_rad":[-444.54498697704258,640.11170338979798,-69.854523441530418,979.52038506527538,979.51789004586783]},"command":[-0.23490225747493834,0.62723875394810502,-0.49889910618879485,0.63706223618592939,0.63706223618592939],"arm":{"servo_position":[5.4944645008222292e-22,7.5894152073985333e-21,1.0778494253810979e-21,0,-7.5301229010907305e-20,-1.436906691722195e-19],"servo_velocity":[0,1.7347234759768071e-18,-3.4694469519536142e-18,0,0,0],"servo_effort":[1.4384828419243394,-2.154679100898877,-0.086503715337778606,0.0017168366121978549,0.00075708801640587227,-0.0045159783617686969]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":298,"step":2384,"t":11.92,"sim_time":11.920000000000464,"vehicle":{"origin_ned":[1.3788741667838023,0.97680780694891656,3.4023230452847271],"origin_quat_xyzw":[-0.018175173254829206,0.10393989204658606,0.26323726782797935,0.95894332613818289],"cg_ned":[1.2794323857265564,0.9248667153511908,3.1192870286454721],"linear_velocity_ned":[0.20897061350948082,0.0988025550934538,0.15628324282218725],"angular_velocity_ned":[0.010676881081146112,0.011763935181174537,0.11924080842992141]},"sensors":{"Odom":[1.3788741667838023,0.97680780694891656,3.4023230452847271,0.1945037699045237,-0.0090917620396113036,0.20095795011604917,-0.018175173254829233,0.10393989204658621,0.26323726782797974,0.95894332613818289,-0.010049852780937462,0.0070637377785024401,0.11966561921983725],"Pressure":[25432.978741388702],"DVL":[0.17093158084308191,-0.098898595417154483,-0.25953870911860272,7.1994052477933961,-0.048469291970841058,-0.031387166190319074,0.045554768642638244,0],"IMU":[0.020313383836305453,0.21046401407154125,0.53796243403665733,-0.016442077132974558,0.04193988680997493,0.099551070211277834,1.9859774841735167,-0.18964522937129891,-9.6643237134266471],"FOG":[0.54579619828449921],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-24.785424318322232,64.619042069333801,-52.633590490830848,66.585253792517307,66.585253792517307],"omega_rad_s":[-23.763283307775762,66.231369487239888,-54.174949066400117,66.331193522279889,66.331898096682337],"thrust_n":[-7.3604447157827755,49.402637744461288,-41.351817007626927,50.094396306581636,50.332153129458526],"torque_nm":[0.13800833842092705,-0.92629945770864908,0.77534656889300491,-0.93926993074840581,-0.94372787117734747],"angle_rad":[-445.49292398519555,642.78400099602118,-72.016496071742239,982.17941709347065,982.17694967653347]},"command":[-0.23605166017449744,0.61541944827936956,-0.50127229038886523,0.63414527421445055,0.63414527421445055],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.0778494253810979e-21,0,-7.5301229010907305e-20,-1.436906691722195e-19],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[1.4145482521145354,-2.1595666120323811,-0.099313367646445758,0.0017075005019024287,0.0007079127013371471,-0.0043804374534173662]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":299,"step":2392,"t":11.960000000000001,"sim_time":11.96000000000047,"vehicle":{"origin_ned":[1.3870377221578944,0.98107621997778138,3.4084985846515923],"origin_quat_xyzw":[-0.018159703338567753,0.10405479367476345,0.26554463549865825,0.9582947728365433],"cg_ned":[1.2877174142038452,0.92878249901929966,3.1254848487527029],"linear_velocity_ned":[0.20568492180772197,0.097185944466892438,0.15390699879416173],"angular_velocity_ned":[0.010594269425419398,0.010720109563611043,0.11877531810780584]},"sensors":{"Odom":[1.3870377221578944,0.98107621997778138,3.4084985846515923,0.19103105396972297,-0.0097236881453815135,0.19795215630162216,-0.018159703338567781,0.1040547936747636,0.26554463549865864,0.9582947728365433,-0.010546775531827403,0.0061991865813705339,0.11910109611978922],"Pressure":[25492.909127628238],"DVL":[0.17803210094345909,-0.064476658503679257,-0.21595598699356666,7.1116207636075952,0.052114269446997208,0.01055029234298655,-0.010011892407892953,0],"IMU":[0.020921552853325063,0.21062870684984691,0.54284886643128949,-0.03196777994107633,-0.0044728308095982154,0.19103251410098271,1.9857727821863393,-0.20668306925066671,-9.6711551993017437],"FOG":[0.54415476616131819],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-24.900913309009244,63.405532158807794,-52.852918905154397,66.293939504274277,66.293939504274277],"omega_rad_s":[-23.909960285319872,64.916436135678197,-54.43873207565472,66.008369899786288,66.009109491245724],"thrust_n":[-7.4593429989041864,47.427362452205628,-41.663744754752102,49.680515932303642,49.888973896574377],"torque_nm":[0.1398626812294535,-0.88926304597885575,0.78119521415160198,-0.93150967373069338,-0.9354182605607696],"angle_rad":[-446.44680792069579,645.40318549350991,-74.18960731679401,984.82525620177421,984.8228177483179]},"command":[-0.23715155532389756,0.6038622110362647,-0.50336113243004188,0.6313708524216598,0.6313708524216598],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.8425084185149169e-20,0,-7.5301229010907305e-20,-1.436906691722195e-19],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[1.3913733106096131,-2.1648951283568287,-0.11206271994894881,0.0016970662880287507,0.00065927129817522313,-0.0042448862467161707]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":300,"step":2400,"t":12,"sim_time":12.000000000000476,"vehicle":{"origin_ned":[1.3950565040006702,0.98527823733329734,3.414583869191766],"origin_quat_xyzw":[-0.018150518176467987,0.1041490384693918,0.26784055855543021,0.95764553550285081],"cg_ned":[1.2958705552243746,0.93263343879911542,3.1315881019374507],"linear_velocity_ned":[0.20237958191748689,0.095561663470822122,0.15155228944286256],"angular_velocity_ned":[0.010504021237594491,0.0096121742864351874,0.11827048202666156]},"sensors":{"Odom":[1.3950565040006702,0.98527823733329734,3.414583869191766,0.18752543953397682,-0.010310617168122637,0.1949565942046205,-0.018150518176468004,0.1041490384693919,0.26784055855543043,0.95764553550285081,-0.011078327466157098,0.0052854065053799734,0.11849038110377148],"Pressure":[25553.300351607297],"DVL":[0.12981036034084451,-0.090245587056867027,-0.18022437409746891,7.2052659710455886,-0.017966493083091128,0.00052662184523069675,0.021132880323904493,0],"IMU":[0.021504597148404699,0.21075536772075718,0.54771061769932983,-0.010791413292955679,-0.031246446818217789,0.047290993081174529,1.9733637816926379,-0.20602285865990558,-9.6435288721563364],"FOG":[0.56093208352981339],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.010925550363844,62.219207261374208,-53.043929668425029,66.017104012488076,66.017104012488076],"omega_rad_s":[-24.051573466372211,63.631274498457969,-54.669718015323383,65.70151642448927,65.702293169676764],"thrust_n":[-7.5554033361194639,45.538612502053233,-41.928622410071114,49.294149691209768,49.472010210340144],"torque_nm":[0.14166381255223995,-0.85384898441349821,0.78616167018883343,-0.92426530671018325,-0.92760019144387773],"angle_rad":[-447.40644474689446,647.97045207538076,-76.372517749180034,987.45854757407074,987.45613953340899]},"command":[-0.23819929095584613,0.59256387867975435,-0.50518028255642888,0.62873432392845785,0.62873432392845785],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.0778494253810979e-21,0,-7.5301229010907305e-20,-1.436906691722195e-19],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[1.3689066838358082,-2.1705689641358963,-0.12472252624347764,0.0016863398315829366,0.0006112226497785796,-0.0041097050654067156]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":301,"step":2408,"t":12.040000000000001,"sim_time":12.040000000000482,"vehicle":{"origin_ned":[1.4029292456158431,0.98941346619313053,3.4205799905365408],"origin_quat_xyzw":[-0.018148049222383944,0.10422151202625145,0.27012428375407799,0.95699602719485199],"cg_ned":[1.3038911393614225,0.93641927471086539,3.1375976576782931],"linear_velocity_ned":[0.19905972441921466,0.093931781290452876,0.14921947063293589],"angular_velocity_ned":[0.010407689295924474,0.0084438970470625367,0.11772889428785561]},"sensors":{"Odom":[1.4029292456158431,0.98941346619313053,3.4205799905365408,0.18399341581712064,-0.010853631214548505,0.19197258416364332,-0.018148049222383975,0.10422151202625163,0.27012428375407849,0.95699602719485199,-0.011642289803953081,0.0043252191416372253,0.11783658817006104],"Pressure":[25611.8145572178],"DVL":[0.19948471156919589,-0.060063387434067063,-0.19444155199363525,7.0397844417088393,-0.027926173117213581,-0.032606824529614525,-0.0023297564918963653,0],"IMU":[0.022060582165990782,0.21084228186844528,0.55254573985458766,-0.055911737526497252,-0.0052716926113205642,0.138923512162657,2.0032602560832,-0.21037087690375461,-9.629669962532919],"FOG":[0.54887665890465476],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.115245822688504,61.059735713483256,-53.208089907075468,65.754251684835467,65.754251684835467],"omega_rad_s":[-24.187704252855859,62.375596172196303,-54.86949981720327,65.410216886995926,65.411032747630401],"thrust_n":[-7.6483007706195476,43.732936976669734,-42.148453482110533,48.934249074309911,49.080304134362983],"torque_nm":[0.14340563944911655,-0.81999256831255751,0.7902835027895726,-0.91751717014331113,-0.920255702519306],"angle_rad":[-448.37162214243915,650.48698513885688,-78.563951857212473,990.07992064379516,990.07754454682038]},"command":[-0.23919281735893813,0.58152129250936435,-0.50674371340071878,0.62623096842700443,0.62623096842700443],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,9.7514668052651336e-21,0,-7.5301229010907305e-20,-1.436906691722195e-19],"servo_velocity":[0,-1.7347234759768071e-18,0,0,0,0],"servo_effort":[1.3470957353877788,-2.1764885219727446,-0.13726236401204098,0.0016756461947613098,0.00056384061247445746,-0.0039749268269071193]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":302,"step":2416,"t":12.08,"sim_time":12.080000000000489,"vehicle":{"origin_ned":[1.4106549170272991,0.99348158402930953,3.4264880375826388],"origin_quat_xyzw":[-0.018152687333178191,0.10427116867287518,0.27239511149157702,0.95634664560590577],"cg_ned":[1.3117786928659152,0.94013982624693815,3.1435143979914364],"linear_velocity_ned":[0.19572998661211882,0.092298178430460093,0.14690877665969293],"angular_velocity_ned":[0.010306837558421897,0.0072193274747663818,0.11715290529115836]},"sensors":{"Odom":[1.4106549170272991,0.99348158402930953,3.4264880375826388,0.18044098666265246,-0.011353917582703934,0.18900126214547644,-0.018152687333178204,0.10427116867287524,0.27239511149157719,0.95634664560590577,-0.012236203614319839,0.003321636547634356,0.11714262614248097],"Pressure":[25669.656052643604],"DVL":[0.16305719793013329,-0.081000522610798278,-0.20529503391529863,7.1603653766415274,0.0043450244105565396,-0.014556455475287612,-0.028925093493321556,0],"IMU":[0.022587688225770394,0.21088785925492501,0.55735240889070925,0.03977311148980895,0.06361936349321505,0.078508796571728351,1.9962714361587408,-0.22927196709050882,-9.6413263506412115],"FOG":[0.56679750446192745],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.213733554902841,59.926785875512095,-53.346798319325856,65.504884667276059,65.504884667276059],"omega_rad_s":[-24.318020182470423,61.149081721447843,-55.039641114818906,65.134016814716105,65.134873564665071],"thrust_n":[-7.7377609535712599,42.006973166214991,-42.325289672209678,48.599737048620703,48.712872800345977],"torque_nm":[0.14508301787946115,-0.78763074686653112,0.79359918135393159,-0.91124506966163832,-0.91336636500648727],"angle_rad":[-449.34211301221438,652.95395680238369,-80.762697220961769,992.68998728645533,992.68764473833744]},"command":[-0.24013079576097943,0.57073129405249612,-0.5080647458983415,0.62385604445024812,0.62385604445024812],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.0778494253810979e-21,0,-7.5301229010907305e-20,-1.436906691722195e-19],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[1.3258810004678543,-2.182533614946319,-0.14965934642873993,0.0016646227945317587,0.00051714120127739974,-0.0038409264021339526]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":303,"step":2424,"t":12.120000000000001,"sim_time":12.120000000000495,"vehicle":{"origin_ned":[1.41823269757797,0.99748232403990422,3.4323090836265275],"origin_quat_xyzw":[-0.018164780389212553,0.1042970351662737,0.27465239147786497,0.95569777286777546],"cg_ned":[1.3195329076023923,0.94379497850923055,3.1493392055125065],"linear_velocity_ned":[0.19239425285196485,0.090662385154127959,0.14462013580183819],"angular_velocity_ned":[0.010203036528130538,0.0059427057942807058,0.11654467253696654]},"sensors":{"Odom":[1.41823269757797,0.99748232403990422,3.4323090836265275,0.17687338907367506,-0.011812737130138527,0.18604333691627839,-0.018164780389212574,0.10429703516627382,0.2746523914778653,0.95569777286777546,-0.012857427316371239,0.0022777833647786025,0.11641123944468544],"Pressure":[25723.766639023779],"DVL":[0.18968654623810163,-0.081716994776388774,-0.18249110516186673,7.1114308137840485,-0.046638158898767594,0.0026146853039558,0.021429940016444778,0],"IMU":[0.023084218649365933,0.21089063866427293,0.56212891839273715,-0.020159891553611649,-0.019589477755055679,-0.035344079011150428,1.9832820950811774,-0.21352591274642685,-9.6416711890445868],"FOG":[0.55682758840387603],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.30630971373516,58.82018732711407,-53.461219436650588,65.268659854958571,65.268659854958571],"omega_rad_s":[-24.442269809587184,59.951429116740677,-55.181623582091341,64.872471905747929,64.873371122590299],"thrust_n":[-7.823558978060003,40.357524368351527,-42.461131920154386,48.289593335409251,48.368790998110818],"torque_nm":[0.14669173083862505,-0.75670358190659115,0.79614622350289488,-0.90542987503892369,-0.90691483121457783],"angle_rad":[-450.31767883489323,655.37252659559135,-82.967602327857705,995.28934121884151,995.28703389130931]},"command":[-0.24101247346414439,0.56019226025822921,-0.50915447082524368,0.62160628433293874,0.62160628433293874],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.0778494253810979e-21,0,-7.5301229010907305e-20,-1.436906691722195e-19],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[1.3052158398989431,-2.1886089193519926,-0.16189674206138621,0.0016530183928277048,0.0004711370382443692,-0.0037078231572484476]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":304,"step":2432,"t":12.16,"sim_time":12.160000000000501,"vehicle":{"origin_ned":[1.4256619766692507,1.0014154776425146,3.4380441909345958],"origin_quat_xyzw":[-0.018184631714807199,0.10429821536131892,0.27689551895311437,0.95504977515599987],"cg_ned":[1.3271536387508873,0.94738468469407155,3.1550729692438715],"linear_velocity_ned":[0.18905672832538564,0.089026218056100975,0.14235386663983704],"angular_velocity_ned":[0.010097786141708023,0.0046185584182773702,0.11590616365098406]},"sensors":{"Odom":[1.4256619766692507,1.0014154776425146,3.4380441909345958,0.17329620549933206,-0.012231416060399462,0.18310002459108476,-0.018184631714807234,0.10429821536131911,0.27689551895311493,0.95504977515599987,-0.013503148337133831,0.0011970161225732822,0.11564500541096914],"Pressure":[25782.116720735707],"DVL":[0.19225676939918299,-0.057608149683579558,-0.20414344588111338,7.2069448046498019,0.011188587825023353,0.0063128198832204472,0.01422612610535323,0],"IMU":[0.023548607040320708,0.21084929397795327,0.56687367424542445,-0.046493245725511806,-0.0027625857402666797,0.084716231149285101,1.9879057604569539,-0.2168772814762456,-9.6545880600662404],"FOG":[0.57233354016329996],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.39294359823532,57.739703110372673,-53.55253744500974,65.045157674110101,65.045157674110101],"omega_rad_s":[-24.560273225581081,58.78235691188609,-55.296844038538609,64.625151046667412,64.626094105782627],"thrust_n":[-7.9055151795286873,38.781530154488209,-42.557937945669742,48.002829914521016,48.047170319755473],"torque_nm":[0.1482284096161629,-0.72715369039665401,0.79796133648130774,-0.90005306089726922,-0.9008844434954153],"angle_rad":[-451.29807268199653,657.74384264640514,-85.177572752701366,997.87855890512992,997.87628852848445]},"command":[-0.2418375580784316,0.54990193438450163,-0.51002416614294988,0.61947769213438186,0.61947769213438186],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.8425084185149169e-20,0,-7.5301229010907305e-20,-1.436906691722195e-19],"servo_velocity":[0,0,3.4694469519536142e-18,0,0,0],"servo_effort":[1.2850534346592,-2.1946837725638302,-0.17393670675387579,0.0016408374762380271,0.00042597156316892201,-0.0035757906433209899]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":305,"step":2440,"t":12.200000000000001,"sim_time":12.200000000000507,"vehicle":{"origin_ned":[1.4329423566648607,1.0052808981376911,3.4436944168013786],"origin_quat_xyzw":[-0.018212498979835484,0.10427389484548122,0.27912393122618129,0.95440300227498498],"cg_ned":[1.3346409047845731,0.95090896940335567,3.1607165917776623],"linear_velocity_ned":[0.18572137688069573,0.087391415058300267,0.14011031024524667],"angular_velocity_ned":[0.0099925462321686521,0.0032516204531904758,0.11523919737510495]},"sensors":{"Odom":[1.4329423566648607,1.0052808981376911,3.4436944168013786,0.16971476213781483,-0.012611358647635608,0.18017255128991738,-0.018212498979835488,0.10427389484548123,0.27912393122618134,0.95440300227498498,-0.014170402567078596,8.2840043487664682e-05,0.11484637328207696],"Pressure":[25836.811980958919],"DVL":[0.16106502702629691,-0.044128235939421306,-0.15450850611994732,7.1007288300387668,-0.018234220605859983,-0.0093669440558008018,0.039422517417115686,0],"IMU":[0.02397942373134683,0.21076264058890254,0.57158518987419649,-0.0043840199044103741,-0.052837747794952886,0.074944259562972015,1.9747573167332795,-0.23226461160298578,-9.6773676953126362],"FOG":[0.57663080394807598],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.468433265605498,56.683502557660319,-53.623569400361696,64.833861070345037,64.833861070345037],"omega_rad_s":[-24.670705572881769,57.641207888322384,-55.387038669239637,64.391586181341367,64.392574250743834],"thrust_n":[-7.982720162796781,37.275523463671995,-42.618227125568829,47.738422073667934,47.747088445955548],"torque_nm":[0.14967600305243967,-0.69891606494384984,0.79909175860441539,-0.89509541388127378,-0.89525790836166652],"angle_rad":[-452.28302064455448,660.06903509132883,-87.391575761046326,1000.4581987190895,1000.4559670739953]},"command":[-0.24255650729148093,0.53984288150152682,-0.51070066095582567,0.61746534352709559,0.61746534352709559],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.0778494253810979e-21,0,-7.5301229010907305e-20,-1.436906691722195e-19],"servo_velocity":[0,0,-3.4694469519536142e-18,0,0,0],"servo_effort":[1.2653431224405309,-2.2006795619867345,-0.18576209564222063,0.0016280202340477022,0.00038166109894391495,-0.0034451829431165018]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":306,"step":2448,"t":12.24,"sim_time":12.240000000000514,"vehicle":{"origin_ned":[1.4400736443254631,1.0090784958464829,3.4492608124614321],"origin_quat_xyzw":[-0.018248593666414594,0.10422334593252804,0.28133710456244815,0.95375778717043491],"cg_ned":[1.3419948758964118,0.95436792297496531,3.1662709894452536],"linear_velocity_ned":[0.18239185546510411,0.08575953972918586,0.13788981461417008],"angular_velocity_ned":[0.0098886043329824425,0.0018469385726471146,0.11454544423338806]},"sensors":{"Odom":[1.4400736443254631,1.0090784958464829,3.4492608124614321,0.16613407589137386,-0.012954069543022913,0.17726210654749619,-0.018248593666414615,0.10422334593252815,0.28133710456244848,0.95375778717043491,-0.014856125158861229,-0.0010609350394357579,0.11401764966212899],"Pressure":[25891.305999650769],"DVL":[0.16737610565798766,-0.088244295667112116,-0.17188609077595196,7.1216568904414714,0.0080388881973680569,-0.016797193612826396,-0.00090896962643532584,0],"IMU":[0.024375381466234382,0.2106296427775329,0.57626208210597074,-0.011555623243720897,0.073677376980946896,0.33901161815939379,1.998377651153628,-0.22872843212899455,-9.6335239343103751],"FOG":[0.57421980053981025],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.529788972022754,55.65019734664849,-53.676487669079492,64.634252724174161,64.634252724174161],"omega_rad_s":[-24.77116038564246,56.526929315893959,-55.454271184695152,64.171281883605189,64.172315919607456],"thrust_n":[-8.0535596797071403,35.835655521658353,-42.645049717425351,47.495323751037994,47.467608440470755],"torque_nm":[0.1510042439945089,-0.67191854103109427,0.79959468220172536,-0.89053732033196242,-0.89001765825882684],"angle_rad":[-453.27216344147911,662.34919668509565,-89.608657834753345,1003.0287996608661,1003.0266085699626]},"command":[-0.24314084735259764,0.53000187949189037,-0.51120464446742375,0.61556431165880154,0.61556431165880154],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.8425084185149169e-20,0,-7.5301229010907305e-20,-7.4301730133147213e-20],"servo_velocity":[0,-1.7347234759768071e-18,3.4694469519536142e-18,0,0,0],"servo_effort":[1.2460183361683483,-2.2064727314961683,-0.19734382582879215,0.0016150582793675982,0.0003382572030070805,-0.0033160875389703776]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":307,"step":2456,"t":12.280000000000001,"sim_time":12.28000000000052,"vehicle":{"origin_ned":[1.4470558414349199,1.0128082327305783,3.4547444219386922],"origin_quat_xyzw":[-0.018293082025700898,0.10414593258570992,0.28353455155213109,0.95311444535899548],"cg_ned":[1.3492158619453309,0.95776169437387204,3.1717370924229402],"linear_velocity_ned":[0.17907153120699976,0.084131986409117246,0.13569271949768916],"angular_velocity_ned":[0.0097871787007369621,0.00040965459789438289,0.11382649021687327]},"sensors":{"Odom":[1.4470558414349199,1.0128082327305783,3.4547444219386922,0.1625588038358565,-0.013261134184501009,0.17436984173615588,-0.018293082025700905,0.10414593258570996,0.2835345515521312,0.95311444535899548,-0.01555718944515787,-0.0022304317899684055,0.1131610603940218],"Pressure":[25945.850050802677],"DVL":[0.17721306134870052,-0.050628383957657418,-0.18554324011444201,7.1368414008559196,0.0020176339737173889,-9.1461739615034728e-05,0.018168464762361725,0],"IMU":[0.0247353382973498,0.2104494217692022,0.58090306768015698,-0.02516474337020283,0.034250326052063129,0.16987642764442207,1.9663479681919147,-0.25450984533668536,-9.6662686770015878],"FOG":[0.5977945195145421],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.577462409699848,54.639315502181915,-53.712400978897577,64.445816590431818,64.445816590431818],"omega_rad_s":[-24.860071417574002,55.438613315469254,-55.500349562865928,63.963724708034718,63.964805449448484],"thrust_n":[-8.1169411962709912,34.458458943313865,-42.641114596141954,47.27248311820226,47.207789869475157],"torque_nm":[0.1521926474300811,-0.64609610518713501,0.79952089867766185,-0.88635905846629237,-0.88514606005265928],"angle_rad":[-454.26506423516457,664.5853811785073,-91.827942360136333,1005.5908804826834,1005.5887318019824]},"command":[-0.24359488009237951,0.52037443335411349,-0.51154667598950077,0.61376968181363634,0.61376968181363634],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.0778494253810979e-21,0,-7.5301229010907305e-20,-7.4301730133147213e-20],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[1.2270410088140904,-2.2120283864707506,-0.20867323187648879,0.001602144107130652,0.00029577254243893093,-0.0031886406180206208]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":308,"step":2464,"t":12.32,"sim_time":12.320000000000526,"vehicle":{"origin_ned":[1.4538891334240194,1.0164701159787883,3.4601462812722277],"origin_quat_xyzw":[-0.018346083785182484,0.10404110969185276,0.28571581923985329,0.9524732748691348],"cg_ned":[1.3563043011555163,0.96109048511334638,3.1771158438144296],"linear_velocity_ned":[0.17576349269609817,0.08251001066087113,0.13351933580115705],"angular_velocity_ned":[0.0096895176675928629,-0.0010551042359303255,0.1130838149015731]},"sensors":{"Odom":[1.4538891334240194,1.0164701159787883,3.4601462812722277,0.15899323207500035,-0.013534199744801688,0.17149685790796126,-0.018346083785182484,0.10404110969185278,0.28571581923985329,0.9524732748691348,-0.016270378507417759,-0.0034218522405499783,0.11227873752737748],"Pressure":[26003.618755144493],"DVL":[0.17541257133554006,-0.053156292312472257,-0.16593959737791689,7.082215037319938,-0.025298062948327909,-0.017644487292945463,-0.010722525959936979,0],"IMU":[0.025058301695104895,0.2102212516089112,0.58550696085539966,-0.012595813534540602,-0.0024682481025964892,0.22506243593296538,1.9743025660576186,-0.23202531319810166,-9.6545113863243408],"FOG":[0.57225085727501468],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.611956501029116,53.650404857925487,-53.732320009633582,64.26804124269988,64.26804124269988],"omega_rad_s":[-24.936551031351101,54.375480471292626,-55.526849550908224,63.768390404906114,63.769518372451166],"thrust_n":[-8.172205389635252,33.140797911015156,-42.608814334676204,47.068855879042751,46.966695495993683],"torque_nm":[0.153228851055661,-0.62138996083153419,0.79891526877517893,-0.88254104773205155,-0.88062554054988162],"angle_rad":[-455.26123962298664,666.77860903405292,-94.048619620323691,1008.1449391345145,1008.1428347446667]},"command":[-0.24392339524789636,0.51095623674214752,-0.51173638104412933,0.61207658326380843,0.61207658326380843],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.0778494253810979e-21,0,-7.5301229010907305e-20,-7.4301730133147213e-20],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[1.208370778793342,-2.2172976349205737,-0.2197383439174693,0.0015900888857217511,0.00025423025542965376,-0.0030628574034123938]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":309,"step":2472,"t":12.359999999999999,"sim_time":12.360000000000532,"vehicle":{"origin_ned":[1.4605738796117573,1.0200641933631587,3.4654674174040223],"origin_quat_xyzw":[-0.018407671494685661,0.10390842380889018,0.28788048710320818,0.95183455612670165],"cg_ned":[1.3632607497051346,0.96435454438540802,3.182408198706292],"linear_velocity_ned":[0.17247058688435707,0.080894758414818455,0.1313699554250054],"angular_velocity_ned":[0.0095968171935622588,-0.0025421405429079118,0.11231881670376238]},"sensors":{"Odom":[1.4605738796117573,1.0200641933631587,3.4654674174040223,0.15544135734329476,-0.013774953149991068,0.16864421557576406,-0.018407671494685685,0.10390842380889032,0.28788048710320857,0.95183455612670165,-0.016992412883296813,-0.0046313617407237329,0.11137273614915841],"Pressure":[26055.827891683384],"DVL":[0.15358336915344839,-0.037892802285255954,-0.16470574453636772,7.1088770240390025,0.022148037351418987,-0.0018989604223786846,-0.0015483974328732962,0],"IMU":[0.025343432138680851,0.20994455825029865,0.59007267065397384,0.04595562757833449,-0.058170919411074801,0.15148630207025135,1.9708426613674861,-0.25513305756027743,-9.638598927274348],"FOG":[0.59623867509697015],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.633807749756446,52.683022055050053,-53.737187580971955,64.100422726844698,64.100422726844698],"omega_rad_s":[-25.000183900284398,53.336843494416819,-55.535163821960886,63.584750141476924,63.585925640058726],"thrust_n":[-8.2190036345677466,31.879797640933187,-42.55029031788623,46.883411208176334,46.74340145897839],"torque_nm":[0.15410631814814527,-0.59774620576749715,0.79781794346036683,-0.87906396015330623,-0.87643877735584497],"angle_rad":[-456.26018189332541,668.92987172517257,-96.269938643466517,1010.691452479652,1010.6893942772724]},"command":[-0.24413150237863282,0.50174306719095285,-0.51178273886639958,0.61048021644614003,0.61048021644614003],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.8425084185149169e-20,0,-5.9122899718350197e-21,-7.4301730133147213e-20],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[1.1899715068367966,-2.2222233640355245,-0.23052306299898989,0.0015780097045343571,0.00021365488744229199,-0.0029390944155955174]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":310,"step":2480,"t":12.4,"sim_time":12.400000000000539,"vehicle":{"origin_ned":[1.4671106044804965,1.0235905499619633,3.4707088472178569],"origin_quat_xyzw":[-0.018477870682067368,0.10374751384046728,0.29002816525682862,0.95119855184116864],"cg_ned":[1.3700858725324787,0.96755416509572345,3.1876151233510872],"linear_velocity_ned":[0.16919542859157718,0.079287282286754718,0.12924484473051062],"angular_velocity_ned":[0.009510217840191874,-0.0040462455903794662,0.11153280383024823]},"sensors":{"Odom":[1.4671106044804965,1.0235905499619633,3.4707088472178569,0.15190689376681976,-0.013985097086351971,0.16581293053330218,-0.018477870682067389,0.1037475138404674,0.29002816525682895,0.95119855184116864,-0.017719982363497457,-0.0058551366614514964,0.11044501924801897],"Pressure":[26107.744390803608],"DVL":[0.19397178395659692,-0.088074056308660137,-0.14941266414310836,7.1782753703750277,-0.013537251034117286,0.0043061946506385545,-0.02045728091067767,0],"IMU":[0.02559004504945879,0.20961891898808421,0.59459919827968544,-0.075650093975868332,-0.02461725605735151,0.050620730833293381,1.9830327831797885,-0.24682063366908349,-9.6759403417722254],"FOG":[0.59035475207318444],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.64357352892711,51.736718093208083,-53.727890434640621,63.942461205220035,63.942461205220035],"omega_rad_s":[-25.050882805604054,52.322076324473564,-55.526540859121688,63.412273752769003,63.413496874615731],"thrust_n":[-8.2572107786816336,30.672787695214332,-42.467484623650797,46.715135614054617,46.537000291411339],"torque_nm":[0.15482270210028062,-0.57511476928526861,0.79626533669345256,-0.87590879276352418,-0.87256875546396262],"angle_rad":[-457.26137450553114,671.04013469296683,-98.49120079363783,1013.2308761909134,1013.2288660800151]},"command":[-0.24422450979930579,0.49273064850674364,-0.51169419461562493,0.60897582100209557,0.60897582100209557],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.8425084185149169e-20,0,-5.9122899718350197e-21,-7.4301730133147213e-20],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[1.1718054276170129,-2.2267574336552345,-0.2410178097493017,0.001565553370580575,0.00017405953765985271,-0.0028173629861517856]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":311,"step":2488,"t":12.44,"sim_time":12.440000000000545,"vehicle":{"origin_ned":[1.4734999888696889,1.0270493052539063,3.4758715763627999],"origin_quat_xyzw":[-0.018556659905147776,0.10355811138010208,0.2921584923453846,0.95056550710144261],"cg_ned":[1.3767804341823793,0.97068968044431225,3.1927375940088134],"linear_velocity_ned":[0.16594041882423516,0.077688556908946188,0.12714424273319108],"angular_velocity_ned":[0.0094308066428902652,-0.0055621823790368737,0.1107269999267918]},"sensors":{"Odom":[1.4734999888696889,1.0270493052539063,3.4758715763627999,0.14839330404428319,-0.014166343445064023,0.16300397279046758,-0.01855665990514779,0.10355811138010215,0.29215849234538482,0.95056550710144261,-0.018449736373753391,-0.0070893507584398503,0.10949746496199728],"Pressure":[26160.709712561202],"DVL":[0.14755828220357331,-0.086817047264381178,-0.17031779567888697,7.2154795621750694,-0.0074548126386154,0.023584865177981414,0.016916897032765391,0],"IMU":[0.025797612563712428,0.20924406124063008,0.5990856336934498,-0.040686641002494479,0.018964153272789188,-0.014198073280781071,1.9786160260886936,-0.23766676847361254,-9.6799698787201773],"FOG":[0.61343180417668974],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.641821775038537,50.811053650659616,-53.705266796654747,63.793667818634376,63.793667818634376],"omega_rad_s":[-25.088786665895029,51.330596999464916,-55.502113784456817,63.250433601572318,63.251704230337097],"thrust_n":[-8.2868619633303737,29.517267966795796,-42.362178128352603,46.563037311581198,46.346605661194474],"torque_nm":[0.15537866181244453,-0.55344877437742124,0.79429083990661153,-0.87305694959214752,-0.86899885614739647],"angle_rad":[-458.26430279627454,673.11033937568743,-100.71175467657798,1015.7636447824991,1015.7616846660774]},"command":[-0.24420782642893843,0.48391479667294873,-0.51147873139671185,0.6075587411298512,0.6075587411298512],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.8425084185149169e-20,0,-5.9122899718350197e-21,-7.4301730133147213e-20],"servo_velocity":[0,-1.7347234759768071e-18,0,0,0,0],"servo_effort":[1.15384356759676,-2.2308529579251806,-0.25121127122457171,0.001553140532287798,0.00013546185244530003,-0.0026977863520142474]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":312,"step":2496,"t":12.48,"sim_time":12.480000000000551,"vehicle":{"origin_ned":[1.4797428620193553,1.0304406107289175,3.4809565983464466],"origin_quat_xyzw":[-0.018643970776113104,0.10334004057933854,0.29427113431568763,0.94993564933384755],"cg_ned":[1.3833452908191919,0.97376146100885963,3.1977765959011153],"linear_velocity_ned":[0.16270776351954599,0.076099486819713721,0.12506836242920241],"angular_velocity_ned":[0.0093596314528097552,-0.007084732822292608,0.10990257729557217]},"sensors":{"Odom":[1.4797428620193553,1.0304406107289175,3.4809565983464466,0.14490380850961579,-0.014320403768202346,0.16021827093926291,-0.018643970776113111,0.10334004057933859,0.29427113431568774,0.94993564933384755,-0.019178305219192858,-0.0083302210709068469,0.10853189698026205],"Pressure":[26211.396852360831],"DVL":[0.13402996406143788,-0.083920243415278428,-0.14319989590409032,7.1849396538153512,0.005581100305820829,-0.0048828900527983559,-0.0022774770101093643,0],"IMU":[0.025965765159018876,0.20881986041971881,0.60353115383048472,0.015307636357140809,-0.039451799998785106,0.13139559601384276,1.9433842433696968,-0.24646404644706782,-9.6694580843361884],"FOG":[0.60081572085073398],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.629133646791662,49.905574517443604,-53.670101137669214,63.653561670942224,63.653561670942224],"omega_rad_s":[-25.114191867678873,50.361850375153246,-55.462920226408926,63.098706850809315,63.100024666370082],"thrust_n":[-8.3081090994037989,28.410877152533253,-42.236016354976535,46.426148514977321,46.171353631082162],"torque_nm":[0.15577704561382125,-0.53270394660999831,0.79192530665581018,-0.8704902846558249,-0.86571288058279072],"angle_rad":[-459.26846139280258,675.14140458494694,-102.93099201339305,1018.2901717676675,1018.2882635394609]},"command":[-0.24408698711230153,0.4752911858804153,-0.51114382035875439,0.6062243968661164,0.6062243968661164],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.8425084185149169e-20,0,-5.9122899718350197e-21,-4.9127910940749275e-21],"servo_velocity":[0,0,0,0,-1.3877787807814457e-17,1.3877787807814457e-17],"servo_effort":[1.136055029340594,-2.2344640676471821,-0.26109020172808184,0.0015407140193252431,0.0024606916350060006,-0.002579968854537045]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":313,"step":2504,"t":12.52,"sim_time":12.520000000000557,"vehicle":{"origin_ned":[1.4858401938709858,1.0337646479793003,3.485964893840674],"origin_quat_xyzw":[-0.018739688426996373,0.10309321763242281,0.29636578283788922,0.94930918847272194],"cg_ned":[1.3897813827389585,0.97676991220168663,3.2027331222670057],"linear_velocity_ned":[0.15949948618842263,0.074520917178174537,0.12301739350051347],"angular_velocity_ned":[0.0092976757027873596,-0.0086087267172011029,0.10906063370969372]},"sensors":{"Odom":[1.4858401938709858,1.0337646479793003,3.485964893840674,0.14144140146412726,-0.014448974294983871,0.15745671522357479,-0.018739688426996391,0.10309321763242291,0.2963657828378895,0.94930918847272194,-0.019902332405621767,-0.0095740175038038881,0.10755005405846452],"Pressure":[26263.097242423893],"DVL":[0.13214000184099031,-0.062338185485954371,-0.14334152086369784,7.0684737777138009,0.0060689597811668522,0.020591466086060269,-0.005040271640754968,0],"IMU":[0.026094291992093989,0.20834633738591185,0.60793501976807207,-0.056169918468350108,0.047625566289681939,0.15150625650637395,1.9647872928005841,-0.27132733635702783,-9.6344867410024442],"FOG":[0.62383551650210456],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.606098273859367,49.019819708046796,-53.623138767591797,63.52167003085912,63.52167003085912],"omega_rad_s":[-25.127504234564086,49.415296770404574,-55.409917797368166,62.956576956698953,62.957941440630186],"thrust_n":[-8.3211894251882565,27.351371895812118,-42.090529744924062,46.303526204706969,46.01040340266465],"torque_nm":[0.15602230172227982,-0.51283822304647719,0.78919743271732612,-0.86819111633825563,-0.86269506379996219],"angle_rad":[-460.27335937407361,677.13422729956972,-105.14834416511792,1020.8108498873302,1020.8089954237912]},"command":[-0.24386760260818444,0.46685542579092187,-0.51069655969135042,0.60496828600818209,0.60496828600818209],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.8425084185149169e-20,0,-5.9122899718350197e-21,-4.9127910940749275e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[1.1184181274196525,-2.2375614515583484,-0.27064721698948113,0.0015280909623289936,6.1356758425266451e-05,-0.0024654191846431939]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":314,"step":2512,"t":12.56,"sim_time":12.560000000000564,"vehicle":{"origin_ned":[1.4917930872439062,1.0370216270369361,3.490897429970333],"origin_quat_xyzw":[-0.018843652250826449,0.10281764958231286,0.29844215400848229,0.94868631718550456],"cg_ned":[1.3960897271875508,0.97971547192160735,3.2076081732184427],"linear_velocity_ned":[0.1563174333871527,0.072953634880992213,0.12099149275800845],"angular_velocity_ned":[0.0092458737947694481,-0.010129055879981934,0.10820222421475957]},"sensors":{"Odom":[1.4917930872439062,1.0370216270369361,3.490897429970333,0.13800885649066441,-0.01455373151123068,0.15472014677967205,-0.01884365225082647,0.10281764958231299,0.29844215400848267,0.94868631718550456,-0.02061847766451097,-0.010817081081082567,0.10655362225636938],"Pressure":[26314.76817240582],"DVL":[0.16974767261850579,-0.056924751009470718,-0.1536977003636549,7.0532038451691683,0.0023166164873262072,0.031568641193231876,0.014659935459972469,0],"IMU":[0.02618314021799073,0.20782365482566276,0.61229657417057703,-0.0076765915604222815,-0.0011144184629244755,0.0027080708300667028,1.9627790237670431,-0.24210768437190677,-9.6594977730289031],"FOG":[0.60005239268605803],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.573303289459833,48.153321506495928,-53.56508315424567,63.39753075175333,63.39753075175333],"omega_rad_s":[-25.129203440820504,48.490405273165486,-55.343996111578356,62.823535099325625,62.824945541172085],"thrust_n":[-8.32640138536531,26.336613024248571,-41.927148876969575,46.194253469487549,45.862938094245564],"torque_nm":[0.15612002597559957,-0.49381149420466075,0.78613404144317944,-0.86614225255289168,-0.85993008926710435],"angle_rad":[-461.27852380893376,679.08968312917887,-107.36327922641115,1023.3260513916113,1023.3242525441132]},"command":[-0.24355526942342698,0.45860306196662787,-0.51014364908805399,0.60378600715955555,0.60378600715955555],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.8425084185149169e-20,0,-5.9122899718350197e-21,-4.9127910940749275e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[1.1009138074980482,-2.2401091374376634,-0.27987195144561744,0.0015157093155082123,2.5890931584846548e-05,-0.0023525673992763978]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":315,"step":2520,"t":12.6,"sim_time":12.60000000000057,"vehicle":{"origin_ned":[1.4976027702914259,1.0402117847998213,3.4957551595091925],"origin_quat_xyzw":[-0.018955656663177303,0.10251343302681115,0.30049998694683056,0.9480672112115679],"cg_ned":[1.4022714114956967,0.98259860834881163,3.2124027544362836],"linear_velocity_ned":[0.1531632872582977,0.0713983750497863,0.11899078750273871],"angular_velocity_ned":[0.0092050917684250392,-0.011640701498434242,0.10732832606685946]},"sensors":{"Odom":[1.4976027702914259,1.0402117847998213,3.4957551595091925,0.13460873983811164,-0.014636324353224695,0.15200936113391939,-0.018955656663177327,0.10251343302681126,0.30049998694683089,0.9480672112115679,-0.021323441831289303,-0.0120558349022667,0.10554419403942499],"Pressure":[26367.006996274951],"DVL":[0.14380057321532275,-0.023221561050320902,-0.17697668180654208,7.0714745024047403,-0.00074195642048602783,0.0035504968684053851,-0.03511258973005979,0],"IMU":[0.026232414045849344,0.20725211352948195,0.61661523832122733,0.051013692630405283,-0.020030408224047867,0.13530009692385692,1.9675742706394606,-0.23745003083728269,-9.6316251930117911],"FOG":[0.61237489920450605],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.531339294604123,47.305604921371867,-53.496599947175028,63.280696148867605,63.280696148867605],"omega_rad_s":[-25.119819762617784,47.586648005099875,-55.265984678291488,62.699082571290667,62.700538075345484],"thrust_n":[-8.3240881335215171,25.364554308521747,-41.747214510521573,46.097441878718364,45.728167058877546],"torque_nm":[0.15607665250352848,-0.47558539328478278,0.78276027207227961,-0.86432703522596932,-0.85740313235395416],"angle_rad":[-462.28350215551899,681.00862651928276,-109.57529948010341,1025.8361284028865,1025.8343869901926]},"command":[-0.24315561232956309,0.45052957067973209,-0.50949142806833358,0.60267329665588198,0.60267329665588198],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.8425084185149169e-20,0,-5.9122899718350197e-21,-4.9127910940749275e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[1.0835168973503304,-2.2420861277862585,-0.28875827766595619,0.0015033176932909161,-8.500840262994075e-06,-0.0022421199329607012]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":316,"step":2528,"t":12.640000000000001,"sim_time":12.640000000000576,"vehicle":{"origin_ned":[1.5032705890346725,1.043335383783097,3.500539020410951],"origin_quat_xyzw":[-0.019075452269962618,0.10218075205875937,0.30253904250009933,0.94745202981075805],"cg_ned":[1.4083275867794547,0.98541981798870726,3.2171178760114931],"linear_velocity_ned":[0.15003857204592913,0.069855823906327705,0.11701537349799424],"angular_velocity_ned":[0.0091761411759458712,-0.013138765137626339,0.10643987871755836]},"sensors":{"Odom":[1.5032705890346725,1.043335383783097,3.500539020410951,0.1312434122747064,-0.014698365271387577,0.14932510594229859,-0.019075452269962646,0.1021807520587595,0.30253904250009972,0.94745202981075805,-0.022013983062529021,-0.01328681461566354,0.10452330651449376],"Pressure":[26412.894830201938],"DVL":[0.14304403781142994,-0.053019269470608317,-0.14893025353718259,7.1350146424499643,0.024715053756786995,-0.012120437720484791,0.049619915083248201,0],"IMU":[0.026242372411642737,0.20663214753022716,0.62089050902571219,-0.011754018831869883,0.020613013211427153,0.04433099349174574,1.9694699385664911,-0.22801102889940383,-9.6675602721613245],"FOG":[0.62100707620007523],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.481134512630572,46.475926457499554,-53.418551419943746,63.17073028201559,63.17073028201559],"omega_rad_s":[-25.099980176991487,46.703449242347162,-55.176704141562404,62.582731828105807,62.584231320890943],"thrust_n":[-8.3146659999643369,24.433181294551215,-41.552050812402499,46.012232254972027,45.605325793395991],"torque_nm":[0.15589998749933132,-0.45812214927283534,0.7791009527325472,-0.86272935478072554,-0.85509985862617488],"angle_rad":[-463.28786468987823,682.89189020900994,-111.78393974902586,1028.3414133473782,1028.3397311483975]},"command":[-0.24267747154886257,0.4426278710238053,-0.508748108761369,0.60162600268586275,0.60162600268586275],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.8425084185149169e-20,0,-5.9122899718350197e-21,-4.9127910940749275e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[1.066208817429547,-2.2434646461486687,-0.29729998653481476,0.0014905817603041794,-4.1814872638606344e-05,-0.002134280488465568]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":317,"step":2536,"t":12.68,"sim_time":12.680000000000582,"vehicle":{"origin_ned":[1.5087979987316589,1.0463927104963688,3.5052499345562365],"origin_quat_xyzw":[-0.019202746907441393,0.10181987643804807,0.30455910229584626,0.94684091614277921],"cg_ned":[1.4142594603499092,0.98817962336103327,3.2217545505055729],"linear_velocity_ned":[0.14694457747132664,0.068326596419971242,0.11506525855795929],"angular_velocity_ned":[0.0091597720673367924,-0.014618420700665212,0.10553777744989472]},"sensors":{"Odom":[1.5087979987316589,1.0463927104963688,3.5052499345562365,0.12791498404380777,-0.014741408569755036,0.14666800443437297,-0.01920274690744141,0.10181987643804816,0.30455910229584654,0.94684091614277921,-0.022686895618268622,-0.014506623379097193,0.10349243819001235],"Pressure":[26464.851024272117],"DVL":[0.16193809557362229,-0.047764495550916559,-0.14472888439086837,7.2030795378275627,0.019452568951364768,0.0055308772546078305,0.01231234313608435,0],"IMU":[0.026213426973754953,0.20596431969210338,0.62512195615599886,-0.027960390277150506,-0.055697215623532033,0.14104066613884836,1.9606543473286537,-0.23254035973949208,-9.6641212411468018],"FOG":[0.62821967585127692],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.429658934746936,45.658842178526626,-53.335762709089593,63.059993931462969,63.059993931462969],"omega_rad_s":[-25.071932229655406,45.838991571568627,-55.077988109884579,62.472491316748339,62.474033552975818],"thrust_n":[-8.2996144369104741,23.539202395696638,-41.344447342614039,45.935472213648744,45.491365404785668],"torque_nm":[0.15561777069207142,-0.44136004491931191,0.77520838767401312,-0.86129010400591388,-0.85296310133973141],"angle_rad":[-464.29123800548922,684.74026007087195,-113.98878699872645,1030.8421958090303,1030.8405745558634]},"command":[-0.24218722794997083,0.43484611598596784,-0.50795964484847234,0.60057137077583778,0.60057137077583778],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.8425084185149169e-20,-4.3368086899420178e-21,-5.9122899718350197e-21,-4.9127910940749275e-21],"servo_velocity":[0,0,0,-8.6736173798840355e-19,0,0],"servo_effort":[1.0489813730957076,-2.2441745767186343,-0.30548908535190378,0.0014780318839945883,-7.4055728559697538e-05,-0.0020289855467496257]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":318,"step":2544,"t":12.720000000000001,"sim_time":12.720000000000589,"vehicle":{"origin_ned":[1.5141865504437715,1.0493840717963925,3.5098887959487381],"origin_quat_xyzw":[-0.019337206576949734,0.101431161139626,0.30655996820606257,0.94623399742619985],"cg_ned":[1.4200682825861612,0.99087856845657574,3.2263137807135189],"linear_velocity_ned":[0.14388219815679315,0.06681115938680085,0.11313992993370828],"angular_velocity_ned":[0.0091566580666891575,-0.016074856925703405,0.10462293270611629]},"sensors":{"Odom":[1.5141865504437715,1.0493840717963925,3.5098887959487381,0.12462525252547976,-0.014766924483153504,0.14403809045340304,-0.019337206576949727,0.10143116113962596,0.30655996820606246,0.94623399742619985,-0.023339002038242688,-0.015711873263020912,0.10245306965916792],"Pressure":[26509.966387021777],"DVL":[0.10859577088621936,-0.069284013195619179,-0.15952080499281218,6.9607823787141117,-0.0052779380757189956,-0.005258219033674497,0.0076301100442122249,0],"IMU":[0.02614614114426057,0.20524931994311701,0.62930922115579802,-0.10237339566237429,0.002661256019197783,0.033190619687282555,1.9342527473367119,-0.26969642055287762,-9.7023164954794137],"FOG":[0.62371781562217254],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.37923988265814,44.852398469590113,-53.249798975305339,62.935654210120518,62.935654210120518],"omega_rad_s":[-25.038595615274573,44.99091609024142,-54.972021890923386,62.362289091591919,62.363872643831101],"thrust_n":[-8.2808507309741248,22.678927681425826,-41.127675870966286,45.857789609692034,45.377052596148047],"torque_nm":[0.15526595120576486,-0.42522989402673422,0.77114392258061781,-0.85983355518172555,-0.85081973617777595],"angle_rad":[-465.293362636643,686.55443027573108,-116.18951544181647,1033.3385837471571,1033.3370251180629]},"command":[-0.2417070465015061,0.42716569971038204,-0.50714094262195564,0.59938718295352877,0.59938718295352877],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.8425084185149169e-20,0,-5.9122899718350197e-21,-7.4301730133147213e-20],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[1.0318599160529212,-2.2440630557299657,-0.3133077048320434,0.0014652192716142604,-0.00010523946950377203,-0.001926326992422238]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":319,"step":2552,"t":12.76,"sim_time":12.760000000000595,"vehicle":{"origin_ned":[1.5194378745155748,1.0523097897768738,3.5144564454191993],"origin_quat_xyzw":[-0.019478456498118909,0.10101504601379248,0.30854146261639315,0.94563138487352405],"cg_ned":[1.4257553307530091,0.99351721255771019,3.230796533924253],"linear_velocity_ned":[0.14085195202530715,0.06530983581461039,0.11123823694179631],"angular_velocity_ned":[0.0091674004740570584,-0.017503311704526237,0.10369627625263374]},"sensors":{"Odom":[1.5194378745155748,1.0523097897768738,3.5144564454191993,0.12137573648512504,-0.014776295398068642,0.14143469731631275,-0.01947845649811893,0.10101504601379259,0.30854146261639348,0.94563138487352405,-0.023967171150606703,-0.016899214002162911,0.1014066868302417],"Pressure":[26560.553959235251],"DVL":[0.12242045546769123,-0.031626595080072227,-0.11528572810221775,7.0317277998290084,-0.023939553055676379,0.017782086816087724,0.041054751796741014,0],"IMU":[0.026041229035101365,0.20448796385124232,0.63345201712145893,-0.0070411010040071081,-0.079505157754591188,0.16347282280344749,1.9387312205998721,-0.24264489945451265,-9.6712338900198933],"FOG":[0.6410823778106185],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.330366532535965,44.056032734808205,-53.160927346554033,62.797863150914921,62.797863150914921],"omega_rad_s":[-25.002119990385246,44.157427776975702,-54.860378949024437,62.247458141922458,62.249081382411859],"thrust_n":[-8.2597862203965917,21.84948328382324,-40.904087314072946,45.772016174445909,45.255359193097071],"torque_nm":[0.15487099163243612,-0.40967781157168592,0.76695163713886783,-0.85822530327086077,-0.84853798487057008],"angle_rad":[-466.29407765037161,688.33501401956607,-118.3858722414605,1035.8304674923727,1035.8289731040495]},"command":[-0.24124158602415205,0.41958126414103053,-0.50629454615765745,0.59807488715157064,0.59807488715157064],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.8425084185149169e-20,0,-5.9122899718350197e-21,-7.4301730133147213e-20],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[1.0148632400166959,-2.243007718553701,-0.32073956772286405,0.0014522377273643156,-0.00013537131646921134,-0.0018264106744673471]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":320,"step":2560,"t":12.800000000000001,"sim_time":12.800000000000601,"vehicle":{"origin_ned":[1.5245536683561398,1.0551701988207016,3.5189536506491885],"origin_quat_xyzw":[-0.019626083359783941,0.10057205620870575,0.31050342852524432,0.94503317361665995],"cg_ned":[1.4313218969154842,0.99609612547078608,3.2352037216921872],"linear_velocity_ned":[0.1378541053101347,0.063822847674503289,0.10935863565126282],"angular_velocity_ned":[0.0091923234581790785,-0.01889889240209908,0.10275874357380371]},"sensors":{"Odom":[1.5245536683561398,1.0551701988207016,3.5189536506491885,0.1181678306632635,-0.014770826599195586,0.138856709349855,-0.019626083359783948,0.10057205620870578,0.31050342852524443,0.94503317361665995,-0.024568371851125665,-0.01806506613049496,0.10035474485911626],"Pressure":[26607.411224160922],"DVL":[0.12902142391257107,-0.031342303535549093,-0.074782682661081928,7.1155674170027954,0.021622425274718644,0.0071428380046121443,-0.0022145992008588515,0],"IMU":[0.025899552452292543,0.20368119349381875,0.63755012829875013,-0.042143205171666857,-0.092475348405154562,0.37613908958375031,1.9328176159590036,-0.24069447961819382,-9.6522512881492162],"FOG":[0.61743282117456455],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.283485959095543,43.269185679416353,-53.069346133654022,62.646978451680852,62.646978451680852],"omega_rad_s":[-24.964117696693208,43.337117071834875,-54.744193455649317,62.124950391002017,62.126611482693754],"thrust_n":[-8.2374776301916715,21.048560314861142,-40.675371590223591,45.673497862599042,45.121771820305653],"torque_nm":[0.15445270556609389,-0.39466050590364643,0.76266321731669229,-0.85637808492373213,-0.84603322163073091],"angle_rad":[-467.29329536655609,690.08256186406072,-120.5776571207895,1038.3175889977717,1038.3161603971207]},"command":[-0.2407951043723385,0.41208748266110812,-0.50542234413003828,0.59663789001600809,0.59663789001600809],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.8425084185149169e-20,0,-5.9122899718350197e-21,-7.4301730133147213e-20],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.99797124726281972,-2.240804884941892,-0.32774716851130103,0.0014391514928357972,-0.00016440498745186774,-0.0017291625928645058]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":321,"step":2568,"t":12.84,"sim_time":12.840000000000607,"vehicle":{"origin_ned":[1.5295356941647342,1.0579656492013874,3.5233810930657592],"origin_quat_xyzw":[-0.019779642850102763,0.10010281588926452,0.3124457276373227,0.94443944181770922],"cg_ned":[1.4367692794252771,0.99861588427307313,3.2395361895875427],"linear_velocity_ned":[0.13488874323909303,0.062350350093111934,0.10749940042353172],"angular_velocity_ned":[0.0092311209856009019,-0.020256160100835668,0.10181120986706162]},"sensors":{"Odom":[1.5295356941647342,1.0579656492013874,3.5233810930657592,0.11500299900165079,-0.014751748193282201,0.13630275965628072,-0.01977964285010278,0.10010281588926462,0.31244572763732298,0.94443944181770922,-0.025139692026331685,-0.019205076153980961,0.099298585115888502],"Pressure":[26653.661631095394],"DVL":[0.15407659462301154,-0.045930601637657553,-0.13278045232064448,7.074141202121714,0.016735547397833443,-0.050696056615532781,0.010979659060826331,0],"IMU":[0.025722115898499463,0.20283010718100541,0.64160340635298962,-0.053025571437427567,-0.048619122191381578,0.014332498615166223,1.9114259769546686,-0.21978677931749604,-9.6795970171913055],"FOG":[0.63478643399135104],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.239005113798953,42.491216055787945,-52.975319860853716,62.483487301062226,62.483487301062226],"omega_rad_s":[-24.925823207032007,42.528816702060446,-54.62431070107818,61.992863599010278,61.994560481619544],"thrust_n":[-8.214731420123039,20.274226101496655,-40.442781337710905,45.559349958265557,44.973566534958245],"torque_nm":[0.15402621412730702,-0.38014173940306228,0.75830215008207968,-0.85423781171747926,-0.8432543725304672],"angle_rad":[-468.29098365810876,691.79757386693882,-122.76470818371234,1040.7995954210489,1040.7982340765284]},"command":[-0.24037147727427574,0.40467824815036141,-0.50452685581765444,0.59508083143868784,0.59508083143868784],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.8425084185149169e-20,0,-5.9122899718350197e-21,-4.9127910940749275e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.98118082327287282,-2.2373354337088061,-0.33430685772393021,0.001425960295819887,-0.00019231161319305441,-0.0016347054953520686]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":322,"step":2576,"t":12.880000000000001,"sim_time":12.880000000000614,"vehicle":{"origin_ned":[1.5343857668063183,1.0606965027448683,3.5277393636156216],"origin_quat_xyzw":[-0.019938658768205313,0.099608035111466695,0.31436824075279268,0.94385025212358342],"cg_ned":[1.4420987777353604,1.0010770713049617,3.243794709546882],"linear_velocity_ned":[0.13195585515483768,0.060892458093238795,0.10565861941199635],"angular_velocity_ned":[0.0092841820885852071,-0.021570945564834947,0.10085459786332493]},"sensors":{"Odom":[1.5343857668063183,1.0606965027448683,3.5277393636156216,0.11188218996522727,-0.014720221778595185,0.13377135135297957,-0.01993865876820532,0.099608035111466736,0.31436824075279279,0.94385025212358342,-0.025678376145324217,-0.020316358043002941,0.09823959606083392],"Pressure":[26701.841775954665],"DVL":[0.1202202744877692,-0.0065070070553937681,-0.12509826126099244,7.1131969718296242,-0.050177871630688105,-0.014325878806281857,0.015013879353616285,0],"IMU":[0.025510060934645983,0.20193593271080104,0.6456117686785533,-0.01340713125699591,0.019488186198005297,0.17605115049721276,1.9118055055025993,-0.2499975534629352,-9.6754878150073136],"FOG":[0.65319830937274526],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.197296424048872,41.721523765623509,-52.879022809729882,62.307956913595923,62.307956913595923],"omega_rad_s":[-24.888202437184205,41.731520116008475,-54.501372470901451,61.850101835326896,61.851832224774462],"thrust_n":[-8.1921759015244806,19.524809352964606,-40.207264630415423,45.427961380361815,44.80924829131974],"torque_nm":[0.15360329815358406,-0.36609017536808641,0.75388621182028925,-0.851774275881784,-0.84017340546224517],"angle_rad":[-469.28715342786114,693.48050709869585,-124.94689269382813,1043.276076928983,1043.2747842215401]},"command":[-0.2399742516576083,0.39734784538689055,-0.50360974104504652,0.59340911346281833,0.59340911346281833],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.8425084185149169e-20,0,-5.9122899718350197e-21,-4.9127910940749275e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.96451559551820609,-2.2328049101446217,-0.34046099919195499,0.0014130393729530053,-0.00021915963148635037,-0.0015431625167476952]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":323,"step":2584,"t":12.92,"sim_time":12.92000000000062,"vehicle":{"origin_ned":[1.539105742030507,1.0633631281342026,3.5320289627717356],"origin_quat_xyzw":[-0.02010262164733059,0.099088493526022961,0.31627086820642364,0.94326565344954771],"cg_ned":[1.4473116891511817,1.0034802727623049,3.2479799757647179],"linear_velocity_ned":[0.12905535841446608,0.059449255843681763,0.10383433694695006],"angular_velocity_ned":[0.0093518812168950794,-0.022839433526855028,0.099889800687860547]},"sensors":{"Odom":[1.539105742030507,1.0633631281342026,3.5320289627717356,0.1088061850729054,-0.014677341499175668,0.13126093810586068,-0.020102621647330621,0.099088493526023114,0.31627086820642414,0.94326565344954771,-0.026181846702550055,-0.021396333970136967,0.097179100034243959],"Pressure":[26747.271111444239],"DVL":[0.12405788237248966,-0.079372311424191544,-0.11072151170399132,7.1296937746726465,-0.031329018658274116,0.0034107760624488143,0.0026957766847933917,0],"IMU":[0.025264658998761118,0.20099999440604197,0.64957519626936688,-0.038362248394334865,-0.032319620326578057,0.013792672589955271,1.8910540991459821,-0.20925199154178944,-9.6640812484989809],"FOG":[0.65454118039998832],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.15870048371918,40.959568767117155,-52.780527150940408,62.121001369284393,62.121001369284393],"omega_rad_s":[-24.852028148780295,40.944357079840216,-54.375837944873879,61.696133247375968,61.697894660372107],"thrust_n":[-8.1703111633721797,18.798859316526375,-39.969497792239558,45.278606557120327,44.628188424626906],"torque_nm":[0.15319333431322837,-0.35247861218486959,0.74942808360449187,-0.84897387294600646,-0.83677853296175453],"angle_rad":[-470.28184965673751,695.1317815818237,-127.12409929617732,1045.746593221284,1045.745370435935]},"command":[-0.23960667127351601,0.3900911311154015,-0.50267168715181343,0.59162858446937516,0.59162858446937516],"arm":{"servo_position":[5.4944645008222292e-22,7.5894152073985333e-21,1.8425084185149169e-20,-4.3368086899420178e-21,-5.9122899718350197e-21,-7.4301730133147213e-20],"servo_velocity":[0,1.7347234759768071e-18,0,-8.6736173798840355e-19,0,0],"servo_effort":[0.94797233736994613,-2.227212318183887,-0.34621004891526241,0.0014000847618631149,-0.00024494263418458533,-0.0014542753789617727]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":324,"step":2592,"t":12.960000000000001,"sim_time":12.960000000000626,"vehicle":{"origin_ned":[1.5436975108964004,1.065965900523979,3.5362503017955111],"origin_quat_xyzw":[-0.020270991561142468,0.098545035448636104,0.31815352885397458,0.94268568195730984],"cg_ned":[1.4524093062805967,1.0058260775115928,3.2520926045264082],"linear_velocity_ned":[0.12618709759721999,0.05802078809136705,0.10202460871808733],"angular_velocity_ned":[0.0094345003014676045,-0.024058087658602217,0.098917668351314963]},"sensors":{"Odom":[1.5436975108964004,1.065965900523979,3.5362503017955111,0.10577561698647797,-0.014624133163323561,0.12876996940793753,-0.020270991561142468,0.098545035448636104,0.31815352885397458,0.94268568195730984,-0.026647722937724272,-0.022442624082203249,0.096118333195740105],"Pressure":[26792.577970333452],"DVL":[0.10563684958887802,-0.013456632025746158,-0.12258374516388294,7.0882793664689396,-0.0075442296792435221,0.015344393611198921,-0.00066525555860921673,0],"IMU":[0.024987302969192767,0.20002370466373032,0.65349372945596018,0.03486658800621785,-0.039692760366058781,0.20882733953995597,1.8776570127264463,-0.21840096031199485,-9.6855536716007542],"FOG":[0.65419672900619685],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.123525692562943,40.204815598013006,-52.679891760780571,61.923257370792918,61.923257370792918],"omega_rad_s":[-24.817931047955426,40.16655323019571,-54.248035108800963,61.530817428013712,61.532607207661883],"thrust_n":[-8.1495430655392127,18.095092213403799,-39.729961732807091,45.111173109615976,44.430360635777902],"torque_nm":[0.15280393247886026,-0.33928297900132126,0.74493678249013306,-0.84583449580529968,-0.83306926192083564],"angle_rad":[-471.27514489145801,696.75178480493241,-129.29623189489158,1048.2106920157478,1048.2095403341871]},"command":[-0.23927167326250423,0.38290300569536195,-0.50171325486457685,0.58974530829326588,0.58974530829326588],"arm":{"servo_position":[-5.3475572240328153e-22,-1.0842021724855024e-21,1.0778494253810979e-21,0,-5.9122899718350197e-21,-7.4301730133147213e-20],"servo_velocity":[2.1684043449710089e-19,0,8.6736173798840355e-19,0,0,0],"servo_effort":[0.93154341354823955,-2.2205682399236695,-0.35155680010243479,0.0013869057730370223,-0.00026967500244450465,-0.0013682829795024511]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":325,"step":2600,"t":13,"sim_time":13.000000000000632,"vehicle":{"origin_ned":[1.5481629917194932,1.0685051994116483,3.540403703859976],"origin_quat_xyzw":[-0.020443201296511476,0.097978564508054949,0.32001615909757536,0.94211036207767418],"cg_ned":[1.4573929123142679,1.0081150740842169,3.2561331338409829],"linear_velocity_ned":[0.12335080374743687,0.056607023269900775,0.10022748969735022],"angular_velocity_ned":[0.009532226189900489,-0.025223679819623909,0.097939020435550653]},"sensors":{"Odom":[1.5481629917194932,1.0685051994116483,3.540403703859976,0.10279091471015997,-0.014561549879019487,0.12629686686696112,-0.020443201296511497,0.097978564508055033,0.32001615909757569,0.94211036207767418,-0.027073846167985326,-0.023453063879759654,0.095058454289861663],"Pressure":[26837.647013498732],"DVL":[0.12835642302266603,-0.026190841611481337,-0.10215285657554637,7.0561213683535131,0.0034022623128791415,-0.0371140083902688,0.016889473107588707,0],"IMU":[0.024679497611153924,0.19900855508419701,0.65736746353612519,-0.056555274477576266,0.010867537557347224,0.064047536275778055,1.8775962002753137,-0.22338584980734394,-9.6865381042226346],"FOG":[0.67066426089144249],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.09204094003395,39.456785389736126,-52.577125989921335,61.715401004321777,61.715401004321777],"omega_rad_s":[-24.786432860037074,39.397413020405601,-54.118190403718827,61.354289385542636,61.356104726728645],"thrust_n":[-8.1302054213786636,17.412365149031029,-39.488985253939695,44.92598257383078,44.216161099932457],"torque_nm":[0.15244135165084996,-0.32648184654433177,0.74041847351136936,-0.84236217325932716,-0.82905302062373365],"angle_rad":[-472.26713435973784,698.34087507794754,-131.46320516467256,1050.6679219102448,1050.666842404474]},"command":[-0.2389718184765138,0.3757789084736774,-0.50073453323734607,0.5877657238506836,0.5877657238506836],"arm":{"servo_position":[-5.3475572240328153e-22,-1.0842021724855024e-21,1.0778494253810979e-21,0,-5.9122899718350197e-21,-7.4301730133147213e-20],"servo_velocity":[2.1684043449710089e-19,0,0,0,0,0],"servo_effort":[0.91523258861018419,-2.2128923893537911,-0.35650726054376319,0.0013740979702723825,-0.00029336662892130391,-0.0012850457694074035]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":326,"step":2608,"t":13.040000000000001,"sim_time":13.040000000000639,"vehicle":{"origin_ned":[1.5525041282999723,1.0709814107960476,3.5444894098219217],"origin_quat_xyzw":[-0.020618659803314558,0.097390038659361591,0.32185871204840444,0.94153970745602933],"cg_ned":[1.4622637824666673,1.0103478517710864,3.2601020278320219],"linear_velocity_ned":[0.12054632520804399,0.055208016967365138,0.098441208070628936],"angular_velocity_ned":[0.0096451399232692914,-0.026333271426645412,0.096954642486077172]},"sensors":{"Odom":[1.5525041282999723,1.0709814107960476,3.5444894098219217,0.099852555419675165,-0.014490477273832836,0.12384024778879145,-0.020618659803314579,0.097390038659361688,0.32185871204840477,0.94153970745602933,-0.027458279854921712,-0.024425678685634236,0.094000540934224552],"Pressure":[26883.684334215355],"DVL":[0.12474318965667765,-0.084210260388814989,-0.10797378823906727,7.0041223434340765,-0.0035679060149108391,0.046369798406590654,0.018567050053544198,0],"IMU":[0.024342849631965469,0.19795610862407864,0.66119654467107736,-0.062372080593583637,-0.058040600838029956,0.078563807750312825,1.8792371001086972,-0.21284898937747859,-9.6662328335385563],"FOG":[0.64729745486972567],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.064480662326179,38.714977181362116,-52.472246978781016,61.498088302899397,61.498088302899397],"omega_rad_s":[-24.757968987256927,38.636297538699708,-53.98645629679897,61.166871419256715,61.168709393304155],"thrust_n":[-8.1125753492775079,16.749642580524952,-39.246791678642573,44.723646600545152,43.986265875076818],"torque_nm":[0.15211078779895329,-0.31405579838484288,0.73587734397454829,-0.83856837376022175,-0.82474248515769033],"angle_rad":[-473.2579321408906,699.89938429776419,-133.62494103917768,1053.1178414089036,1053.11683503586]},"command":[-0.2387093396412017,0.3687140683939249,-0.49973568551220016,0.58569607907523236,0.58569607907523236],"arm":{"servo_position":[-5.3475572240328153e-22,-1.0842021724855024e-21,1.0778494253810979e-21,0,-5.9122899718350197e-21,-3.960726061361107e-20],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.89903800296008918,-2.2042261125674179,-0.36106197331030665,0.0013611899247299426,-0.00031599828937991468,-0.0012046576870972771]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":327,"step":2616,"t":13.08,"sim_time":13.080000000000645,"vehicle":{"origin_ned":[1.5567228891099762,1.0733949298248064,3.5485075852310155],"origin_quat_xyzw":[-0.020796755554403454,0.096780465329285623,0.32368115633529765,0.94097372201486151],"cg_ned":[1.4670231862655909,1.0125250023301766,3.2639996824099438],"linear_velocity_ned":[0.11777352499735312,0.053823831800328244,0.096664108204020591],"angular_velocity_ned":[0.0097732221761348843,-0.027384216381188022,0.095965268014603519]},"sensors":{"Odom":[1.5567228891099762,1.0733949298248064,3.5485075852310155,0.096960949594938659,-0.014411740418588066,0.12139884144054174,-0.020796755554403464,0.096780465329285664,0.32368115633529781,0.94097372201486151,-0.027799306878778407,-0.025358685461631052,0.092945572526872272],"Pressure":[26926.498560158965],"DVL":[0.091688879694501096,-0.0048458514930183813,-0.11519298391414262,7.1567718491353514,-0.0075383078095150819,0.032924889908159616,-0.0098385523901216472,0],"IMU":[0.02397905780881809,0.19686799210096673,0.66498116503782112,-0.0069051169750676128,-0.050795029110015828,-0.035241270653996154,1.8570012828744946,-0.21378620978957827,-9.6562296668015986],"FOG":[0.67218561670545662],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.041046095395707,37.978865564108489,-52.365294649873221,61.271941346260604,61.271941346260604],"omega_rad_s":[-24.732904688488571,37.882593603279147,-53.852945074092631,60.968998651210946,60.970856229360201],"thrust_n":[-8.0968843099891679,16.105963336846454,-39.003546270158822,44.504952203574383,43.741516637747736],"torque_nm":[0.1518165808122969,-0.30198681256587101,0.73131649256547793,-0.83446785381701971,-0.82015343695777021],"angle_rad":[-474.24766809380196,701.42761941824915,-135.78136658392822,1055.5600246137215,1055.5590922108679]},"command":[-0.23848615328948292,0.36170348156293797,-0.49871709190355451,0.5835422985358153,0.5835422985358153],"arm":{"servo_position":[-1.618957894888786e-21,-1.0842021724855024e-21,1.0778494253810979e-21,0,-5.9122899718350197e-21,-3.960726061361107e-20],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.88296710167417425,-2.1946079565712795,-0.36522310690520032,0.0013487373532995051,-0.00033755487645706204,-0.0011270762889894167]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":328,"step":2624,"t":13.120000000000001,"sim_time":13.120000000000651,"vehicle":{"origin_ned":[1.5608212642973811,1.075746161824976,3.5524583261707141],"origin_quat_xyzw":[-0.020976860145276412,0.09615089630514842,0.32548347509295134,0.94041240098138756],"cg_ned":[1.4716723878734586,1.0146471200138989,3.2678264297617954],"linear_velocity_ned":[0.11503227055207615,0.052454530489526988,0.094894646831963969],"angular_velocity_ned":[0.0099163449822017927,-0.028374182715883736,0.094971592957176901]},"sensors":{"Odom":[1.5608212642973811,1.075746161824976,3.5524583261707141,0.094116429191236251,-0.014326095844589885,0.11897148146026726,-0.02097686014527643,0.096150896305148489,0.32548347509295161,0.94041240098138756,-0.028095455199415989,-0.026250500265374895,0.091894440769718241],"Pressure":[26970.994419783729],"DVL":[0.093868437299413743,-0.022749514043000237,-0.11101211492523365,7.0949638532149724,0.042492141533815773,-0.030474679465354333,0.017576126474553616,0],"IMU":[0.023589902423459222,0.19574588850678129,0.66872155828137769,-0.1171275065621153,-0.010752311557407813,0.04623480139342593,1.8535335640676152,-0.24026103471810967,-9.7073587728729169],"FOG":[0.67844930880530541],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.021906464624557,37.247923801050412,-52.25630809707166,61.037565692687309,61.037565692687309],"omega_rad_s":[-24.711547099248811,37.135705290966399,-53.717742639874714,60.761176298216164,60.763050373992932],"thrust_n":[-8.0833263772918293,15.48042992308525,-38.759375881319528,44.270794887094624,43.482853943303063],"torque_nm":[0.15156236957422184,-0.29025806105784846,0.72673829777474108,-0.83007740413302433,-0.81530351143693247],"angle_rad":[-475.2364853416633,702.92586327900199,-137.93241273124639,1057.9940647158915,1057.9932069977206]},"command":[-0.23830387109166246,0.35474213143857536,-0.49767912473401582,0.58131014945416482,0.58131014945416482],"arm":{"servo_position":[-5.3475572240328153e-22,-1.0842021724855024e-21,1.0778494253810979e-21,0,-5.9122899718350197e-21,-3.960726061361107e-20],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.86700568317986415,-2.1840754893351275,-0.36900317652454495,0.0013363794251278712,-0.00035806656655196483,-0.0010522233932046001]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":329,"step":2632,"t":13.16,"sim_time":13.160000000000657,"vehicle":{"origin_ned":[1.5648012623846046,1.0780355233629648,3.5563416652118227],"origin_quat_xyzw":[-0.021158332060529292,0.095502422392272704,0.32726566498085885,0.93985573192179894],"cg_ned":[1.4762126462794825,1.0167148016192855,3.2715825429477055],"linear_velocity_ned":[0.1123224372007713,0.051100177222622577,0.093131396832397434],"angular_velocity_ned":[0.010074278343609666,-0.029301146456898651,0.093974289189862073]},"sensors":{"Odom":[1.5648012623846046,1.0780355233629648,3.5563416652118227,0.091319253800544009,-0.014234233487709956,0.1165571083722223,-0.021158332060529306,0.095502422392272773,0.32726566498085907,0.93985573192179894,-0.028345495016006611,-0.027099732788953893,0.090847964708285156],"Pressure":[27014.400068415409],"DVL":[0.093600406623279495,-0.033859773651193165,-0.082100360828608665,7.1228361777587041,-0.013128910032198935,-0.013799242845573592,0.0057167153693495256,0],"IMU":[0.023177234134657075,0.19459152913539013,0.67241799498363475,-0.16688675090583885,-0.066320654341168267,0.11884026349607069,1.8568552156306604,-0.21867125772026416,-9.6612870107899678],"FOG":[0.69127565860072349],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.007189639024439,36.521633428623367,-52.145327643751372,60.795548866510359,60.795548866510359],"omega_rad_s":[-24.694150444665112,36.395050569231849,-53.580917290787127,60.543950806301126,60.54583821694596],"thrust_n":[-8.0720620132300418,14.872202906216694,-38.514381839570873,44.022132550999828,43.211271496189077],"torque_nm":[0.15135116274806334,-0.27885380449156305,0.72214465949195394,-0.8254149853312468,-0.81021134055354527],"angle_rad":[-476.2245380786556,704.39437520482886,-140.07801343074203,1060.4195761153196,1060.418793670729]},"command":[-0.23816371084785182,0.3478250802726035,-0.49662216803572734,0.57900522730009862,0.57900522730009862],"arm":{"servo_position":[-5.3475572240328153e-22,-1.0842021724855024e-21,-3.2589592645609199e-21,0,-5.9122899718350197e-21,-3.960726061361107e-20],"servo_velocity":[0,0,-8.6736173798840355e-19,0,0,0],"servo_effort":[0.85116046481099883,-2.1726691943472209,-0.37241124317185814,0.0013241878163875059,-0.00037755025891909075,-0.00098013000344710573]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":330,"step":2640,"t":13.200000000000001,"sim_time":13.200000000000664,"vehicle":{"origin_ned":[1.5686649075954398,1.0802634431731251,3.5601575772996785],"origin_quat_xyzw":[-0.021340520144998553,0.09483616872126599,0.32902773543889346,0.93930369562467175],"cg_ned":[1.4806452157508088,1.0187286464598595,3.2752682405875961],"linear_velocity_ned":[0.10964391039731215,0.049760833301241578,0.091373047609445562],"angular_velocity_ned":[0.010246690689460266,-0.030163367040222398,0.09297399121906634]},"sensors":{"Odom":[1.5686649075954398,1.0802634431731251,3.5601575772996785,0.088569618073576439,-0.014136787302223315,0.11415476737610672,-0.021340520144998557,0.094836168721266018,0.32902773543889352,0.93930369562467175,-0.028548424056722907,-0.027905163413558053,0.089806880378019066],"Pressure":[27056.704385354613],"DVL":[0.10809508594420464,-0.011020851983549461,-0.07274239964310808,7.0860064028443048,0.022222942276146102,0.023582196791904937,0.033105943330949968,0],"IMU":[0.022742963823177812,0.19340668688215967,0.6760707788217114,-0.0059922639877969079,-0.018010545611071391,-0.043583418871919744,1.8364609280550792,-0.20870660205346026,-9.6728658091023458],"FOG":[0.6695264335834975],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-24.99699588732825,35.799465818336458,-52.032392905788384,60.546459384210621,60.546459384210621],"omega_rad_s":[-24.680922254677252,35.660054706664511,-53.442525016755631,60.317889899048645,60.31978744550544],"thrust_n":[-8.0632224750743848,14.280493116603671,-38.268647731145784,43.759953030015062,42.927784836276274],"torque_nm":[0.15118542140764471,-0.26775924593631878,0.71753714495898346,-0.8204991193127823,-0.80489596568018007],"angle_rad":[-477.21198958228945,705.83339141996498,-142.21810506839199,1062.8361955963737,1062.8354888868712]},"command":[-0.2380666274983643,0.34094729350796626,-0.49554659910274651,0.5766329465162916,0.5766329465162916],"arm":{"servo_position":[-5.3475572240328153e-22,-1.0842021724855024e-21,1.0778494253810979e-21,0,-5.9122899718350197e-21,-4.9127910940749275e-21],"servo_velocity":[-2.1684043449710089e-19,0,0,0,0,0],"servo_effort":[0.8354319374273812,-2.1604303837411138,-0.37545432333861767,0.0013116417903925853,-0.00039601452034930854,-0.000910862416711015]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":331,"step":2648,"t":13.24,"sim_time":13.24000000000067,"vehicle":{"origin_ned":[1.5724142368495944,1.0824303630488206,3.5639059855166346],"origin_quat_xyzw":[-0.021522767344307366,0.094153289734225112,0.33076970770985081,0.93875626707873738],"cg_ned":[1.48497134617174,1.0206892562839696,3.2788836914121751],"linear_velocity_ned":[0.10699658577342458,0.048436560306958976,0.089618401806326894],"angular_velocity_ned":[0.010433146027747199,-0.030959407486614653,0.091971300940278]},"sensors":{"Odom":[1.5724142368495944,1.0824303630488206,3.5639059855166346,0.085867652873035105,-0.01403432814228788,0.11176360468520706,-0.021522767344307366,0.094153289734225112,0.33076970770985081,0.93875626707873738,-0.028703485982817526,-0.028665753166175725,0.088771843128639699],"Pressure":[27098.315314755499],"DVL":[0.08443532074805507,-0.02798418451313231,-0.10786064419116886,7.1231011631676449,-0.011531142521963992,-0.039048438924479643,0.0029939711313578953,0],"IMU":[0.022289051585742504,0.19219316924816357,0.67968024217550482,-0.030834972224867481,-0.026422140901887829,0.038185657843617805,1.8184303371049848,-0.19849226126536218,-9.7112135158917354],"FOG":[0.68692019939055371],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-24.991389565761562,35.080898532795096,-51.917546541890829,60.290848330398063,60.290848330398063],"omega_rad_s":[-24.672027343048985,34.930149237806745,-53.302614595643938,60.08356938171746,60.085473847366643],"thrust_n":[-8.0569126748083733,13.704559286573812,-38.022246858676212,43.485252849999036,42.633410017392592],"torque_nm":[0.15106711265265699,-0.25696048662325899,0.71291712860017908,-0.81534849093748218,-0.79937643782611123],"angle_rad":[-478.19901045551813,707.24312530252348,-144.3526260958499,1065.2435828631551,1065.2429522218308]},"command":[-0.23801323395963392,0.33410379555042946,-0.49445282420848408,0.57419855552760057,0.57419855552760057],"arm":{"servo_position":[-5.3475572240328153e-22,-1.0842021724855024e-21,-3.2589592645609199e-21,0,-5.9122899718350197e-21,-4.9127910940749275e-21],"servo_velocity":[0,0,-8.6736173798840355e-19,0,0,0],"servo_effort":[0.81982427109233358,-2.1474034709269714,-0.37814139264482693,0.0012989995168709982,-0.00041346357189946608,-0.00084416792893195734]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":332,"step":2656,"t":13.280000000000001,"sim_time":13.280000000000676,"vehicle":{"origin_ned":[1.5760512970138885,1.0845367388517837,3.5675867668116359],"origin_quat_xyzw":[-0.021704414282493287,0.093454964319628506,0.33249161404191308,0.93821341635923872],"cg_ned":[1.4891922835625262,1.0225972353880539,3.2824290188472158],"linear_velocity_ned":[0.10438037356367526,0.04712742306747518,0.087866377475560614],"angular_velocity_ned":[0.010633112175404276,-0.031688127060088028,0.090966793042441138]},"sensors":{"Odom":[1.5760512970138885,1.0845367388517837,3.5675867668116359,0.083213432997713443,-0.013927366733883614,0.10938286933156434,-0.021704414282493298,0.093454964319628547,0.33249161404191324,0.93821341635923872,-0.028810163658049226,-0.029380638895773342,0.087743435284982588],"Pressure":[27140.952123893647],"DVL":[0.11512236879858043,-0.024622453957482106,-0.08718434679222184,7.0913827058769474,-0.019343354567902812,-0.0020437766096846979,0.017642308516910361,0],"IMU":[0.021817496117893433,0.19095281164044167,0.68324674222957904,-0.028231242248811933,-0.044411747605604096,0.043419182089415614,1.8143424515438682,-0.18342903146099235,-9.7054811945932045],"FOG":[0.68684542530408554],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-24.990401709110987,34.365404914343259,-51.800834751489802,60.029248032635834,60.029248032635834],"omega_rad_s":[-24.667589894373744,34.204769459998126,-53.161231135936013,59.841564050200269,59.843472218382345],"thrust_n":[-8.0532127553572099,13.143704580093578,-37.775247404874541,43.199022037730643,42.329148925478762],"torque_nm":[0.15099773916294773,-0.24644446087675465,0.70828588884139787,-0.80998166320744969,-0.79367154235272697],"angle_rad":[-479.18577696300616,708.62376758578046,-146.48151682563883,1067.6414206483273,1067.64086627955]},"command":[-0.23800382580105703,0.32728957061279296,-0.49334128334752192,0.5717071241203413,0.5717071241203413],"arm":{"servo_position":[-5.3475572240328153e-22,-1.0842021724855024e-21,1.0778494253810979e-21,0,-5.9122899718350197e-21,-4.9127910940749275e-21],"servo_velocity":[-2.1684043449710089e-19,0,0,0,0,0],"servo_effort":[0.80433747808076272,-2.1336305568768119,-0.38048114545165579,0.0012862749574306903,-0.00042991131835875185,-0.00078006633088435642]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":333,"step":2664,"t":13.32,"sim_time":13.320000000000682,"vehicle":{"origin_ned":[1.5795781421728632,1.086583041424414,3.5711997575392163],"origin_quat_xyzw":[-0.021884802905121761,0.092742391039630598,0.33419349698779888,0.93767510944736199],"cg_ned":[1.4933092706084392,1.0244531906027809,3.2859043054774992],"linear_velocity_ned":[0.10179519372993188,0.045833483528872052,0.086115999084342101],"angular_velocity_ned":[0.010845957843216554,-0.032348675750503576,0.089961027105061542]},"sensors":{"Odom":[1.5795781421728632,1.086583041424414,3.5711997575392163,0.080606975866592462,-0.013816354744174759,0.10701190144469451,-0.021884802905121764,0.092742391039630598,0.33419349698779888,0.93767510944736199,-0.028868183155782403,-0.030049123006260659,0.086722178420427634],"Pressure":[27180.280212591042],"DVL":[0.099661015701360711,-0.0092504396688767865,-0.090313245891702185,7.0607997057780745,0.0039058184913079753,-0.018290886746962817,-0.0058840117525318161,0],"IMU":[0.021330324002081923,0.18968747100807648,0.68677065735640608,-0.056556309566605262,-0.07797607130929203,-0.032791471210472156,1.8180568788737554,-0.18505825026692849,-9.7200814150435821],"FOG":[0.69110832478711759],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-24.994031661879735,33.652454069639717,-51.682308358830063,59.762172070398179,59.762172070398179],"omega_rad_s":[-24.667695451211813,33.483352021621798,-53.018418780290709,59.592441307623517,59.594349977930214],"thrust_n":[-8.0521795856942138,12.597273723548861,-37.527716093524241,42.90223354622843,42.015979274168537],"torque_nm":[0.15097836723176652,-0.23619888231654118,0.70364467675357945,-0.80441687899178316,-0.78779961139066024],"angle_rad":[-480.17246944858789,709.9754864520728,-148.6047193472744,1070.0294145194803,1070.0289364992668]},"command":[-0.23803839677980698,0.32049956256799733,-0.49221246056028634,0.56916354352760168,0.56916354352760168],"arm":{"servo_position":[-5.3475572240328153e-22,-1.0842021724855024e-21,1.0778494253810979e-21,0,-5.9122899718350197e-21,-4.9127910940749275e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.78898535576460826,-2.1191588481191728,-0.38248522543115487,0.001273365456074639,-0.00044538231952265212,-0.00071859566822678785]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":334,"step":2672,"t":13.359999999999999,"sim_time":13.360000000000689,"vehicle":{"origin_ned":[1.5829968308715339,1.0885697574219224,3.5747447586906387],"origin_quat_xyzw":[-0.022063280044994787,0.092016783518248005,0.33587540877322003,0.93714130898495462],"cg_ned":[1.4973235470842388,1.0262577312362755,3.28930959728098],"linear_velocity_ned":[0.099240978901428745,0.044554803391001013,0.084366397733458665],"angular_velocity_ned":[0.011070959627117615,-0.032940468812651551,0.088954532794820712]},"sensors":{"Odom":[1.5829968308715339,1.0885697574219224,3.5747447586906387,0.078048252244655614,-0.013701692342757452,0.10465013147402302,-0.022063280044994797,0.092016783518248046,0.33587540877322025,0.93714130898495462,-0.028877492475583612,-0.03067065468068712,0.085708522955351585],"Pressure":[27220.782407841412],"DVL":[0.061161941517913043,-0.013740276568977921,-0.067544805062940111,7.0549788429702991,-0.02007295891121132,-0.017741390724832804,0.021660598179939629,0],"IMU":[0.020829579223979995,0.18839901984272947,0.6902523837662381,-0.10603041304936128,-0.045808559178074922,0.026694166460261799,1.7677398649282103,-0.18764206902842165,-9.6790766814078548],"FOG":[0.68338276791850405],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.002244021162507,32.941508270579909,-51.562019275761649,59.490118015322665,59.490118015322665],"omega_rad_s":[-24.67239170736902,32.765332371794052,-52.874221343456732,59.33675787421727,59.338663877557217],"thrust_n":[-8.0538473852945014,12.064650325653924,-37.27971915671219,42.595837295756098,41.694849334146639],"torque_nm":[0.1510096384742719,-0.22621219360601116,0.69899473418835356,-0.79867194929542684,-0.78177842501524941],"angle_rad":[-481.15927081012194,711.29842752650745,-150.72217750253515,1072.4072925049356,1072.4068907819433]},"command":[-0.23811660972535723,0.3137286501959991,-0.49106685024534907,0.56657255252688254,0.56657255252688254],"arm":{"servo_position":[-5.3475572240328153e-22,-1.0842021724855024e-21,1.0778494253810979e-21,0,-5.9122899718350197e-21,-4.9127910940749275e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.77376788895302895,-2.1040270966290668,-0.38416189673117895,0.0012603556528913899,-0.00045988778308517968,-0.00065969555314017859]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":335,"step":2680,"t":13.4,"sim_time":13.400000000000695,"vehicle":{"origin_ned":[1.5863094233954429,1.0904973899851311,3.5782215408022848],"origin_quat_xyzw":[-0.022239200818553399,0.091279365997803674,0.33753741064728621,0.93661197499472326],"cg_ned":[1.5012363502074815,1.0280114689534321,3.2926449076153359],"linear_velocity_ned":[0.096717669668739112,0.043291439805067909,0.082616800152833389],"angular_velocity_ned":[0.011307305591515555,-0.033463208133351949,0.087947824227810389]},"sensors":{"Odom":[1.5863094233954429,1.0904973899851311,3.5782215408022848,0.075537178729561158,-0.01358372415744033,0.10229706832277807,-0.022239200818553424,0.091279365997803757,0.33753741064728648,0.93661197499472326,-0.028838277387319138,-0.031244844904662138,0.084702861043399441],"Pressure":[27262.326997710192],"DVL":[0.075550484513877622,0.00071902146240418463,-0.09942756574271959,7.1126181452354871,0.0092369847008441554,-0.010068510731373223,-0.017787663898168993,0],"IMU":[0.020317313087437974,0.18708934048861001,0.69369233225873395,-0.035653031531250878,0.0098842788404999785,0.018481006266220193,1.7621811066781419,-0.18042747253338115,-9.6808125054002048],"FOG":[0.69763430248177483],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.014974275290097,32.23202259583072,-51.44002293237881,59.213569233489082,59.213569233489082],"omega_rad_s":[-24.681690990848388,32.050142988449629,-52.728684169952054,59.075057804719663,59.076958017053336],"thrust_n":[-8.0582293992146674,11.54525514570618,-37.031324786288543,42.280756856670081,41.366674654898873],"torque_nm":[0.15109180123527505,-0.21647353398199093,0.69433733974291012,-0.79276419106256413,-0.77562514977935404],"angle_rad":[-482.14636504651151,712.59271378822518,-152.83383692328681,1074.77480461402,1074.7744790111126]},"command":[-0.23823785024085806,0.30697164376981639,-0.4899049803083696,0.56393875460465792,0.56393875460465792],"arm":{"servo_position":[-5.3475572240328153e-22,-1.0842021724855024e-21,1.0778494253810979e-21,0,-5.9122899718350197e-21,-4.9127910940749275e-21],"servo_velocity":[0,0,8.6736173798840355e-19,0,0,0],"servo_effort":[0.75869519265146246,-2.0882819742557479,-0.38552216726361704,0.0012471481950258321,-0.00047344857007441748,-0.00060336977264646133]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":336,"step":2688,"t":13.44,"sim_time":13.440000000000701,"vehicle":{"origin_ned":[1.5895179791937986,1.0923664594020552,3.5816298486590625],"origin_quat_xyzw":[-0.02241193195005645,0.090531369136038001,0.33917957230064383,0.93608706552466181],"cg_ned":[1.5050489150148427,1.0297150176571295,3.2959102210952032],"linear_velocity_ned":[0.094225214072766128,0.042043447399548482,0.080866528467441176],"angular_velocity_ned":[0.011554102160747847,-0.033916834514729551,0.086941397893976424]},"sensors":{"Odom":[1.5895179791937986,1.0923664594020552,3.5816298486590625,0.073073630482240609,-0.013462747715526623,0.099952296983044864,-0.022411931950056477,0.090531369136038112,0.33917957230064422,0.93608706552466181,-0.028750928409416249,-0.031771430643378985,0.083705530990902041],"Pressure":[27300.759156226253],"DVL":[0.087956642486506142,0.019118049122949378,-0.053758819379214548,7.0981034850054305,0.0026892396527913188,-0.024287725377266981,0.014315017473789883,0],"IMU":[0.019795574418646364,0.18576031995304865,0.69709092526191152,0.053374980878277009,-0.025968936431269227,-0.086629844674096193,1.7521174972310447,-0.18039680191437002,-9.6945100999160392],"FOG":[0.68375392865013584],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.032129194611461,31.52344139053946,-51.316379660936342,58.932994535050867,58.932994535050867],"omega_rad_s":[-24.695571354899954,31.337211435897878,-52.581854777337654,58.807871619561453,58.80976297446135],"thrust_n":[-8.0653185826386764,11.038544487744479,-36.782603945905478,41.957887202213257,41.032336903909552],"torque_nm":[0.15122472342447521,-0.20697270914520899,0.68967382398572763,-0.78671038504149882,-0.7693563169483042],"angle_rad":[-483.13393586115558,713.85844541288191,-154.93964510030477,1077.131722312291,1077.1314725286279]},"command":[-0.23840123042487105,0.30022325133847105,-0.48872742534225089,0.56126661461953209,0.56126661461953209],"arm":{"servo_position":[-5.3475572240328153e-22,-1.0842021724855024e-21,1.0778494253810979e-21,0,-5.9122899718350197e-21,-4.9127910940749275e-21],"servo_velocity":[0,0,8.6736173798840355e-19,0,0,0],"servo_effort":[0.74378124784013422,-2.0719682446196126,-0.38657783349579516,0.0012337509769430751,-0.00048608831772553541,-0.00054956857144901252]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":337,"step":2696,"t":13.48,"sim_time":13.480000000000707,"vehicle":{"origin_ned":[1.5926245542491861,1.09417750366434,3.5849694056866088],"origin_quat_xyzw":[-0.022580855009430217,0.089774025796411361,0.34080197137708723,0.9355665372301637],"cg_ned":[1.5087624746975825,1.0313689933278232,3.2991054972025098],"linear_velocity_ned":[0.091763569907170842,0.040810875682064283,0.079114992612425106],"angular_velocity_ned":[0.011810369652329062,-0.034301561866885259,0.085935740434441146]},"sensors":{"Odom":[1.5926245542491861,1.09417750366434,3.5849694056866088,0.070657437642399429,-0.013339008917934507,0.097615471859784281,-0.022580855009430224,0.089774025796411375,0.34080197137708734,0.9355665372301637,-0.028616069274068574,-0.032250295126991298,0.082716821175452135],"Pressure":[27339.885647005594],"DVL":[0.080208861499459785,0.022323032663206701,-0.07922167121009363,7.0345056361289116,-0.01111238661928636,-0.024551566520669092,-0.0106976959398505,0],"IMU":[0.019266399925053732,0.18441384473269123,0.70044859418343697,-0.0009476923203312268,-0.030640707342560376,0.089154809545166039,1.7649225764830254,-0.17145875163183324,-9.6706826921090023],"FOG":[0.71400033776820093],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.053588037746458,30.815195549387745,-51.191152414593326,58.648850730236539,58.648850730236539],"omega_rad_s":[-24.713978570947795,30.625957343636081,-52.433783330016574,58.535716195413563,58.537595695411781],"thrust_n":[-8.0750888855464229,10.544008042034292,-36.533630991485772,41.628094463976382,40.692683394148389],"torque_nm":[0.15140791660399538,-0.19770015078814299,0.68500558109035825,-0.78052677119955716,-0.76298781364028234],"angle_rad":[-484.12216534160194,715.09569950135426,-157.03955148465684,1079.4778379747688,1079.4776635883679]},"command":[-0.23860560035949008,0.29347805285131184,-0.48753478490088881,0.55856048314510987,0.55856048314510987],"arm":{"servo_position":[-5.3475572240328153e-22,-1.0842021724855024e-21,1.0778494253810979e-21,0,-5.9122899718350197e-21,-4.9127910940749275e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.72903761611894791,-2.055127825994552,-0.38733939994229349,0.0012205360107035315,-0.00049782161993805149,-0.00049809877165427725]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":338,"step":2704,"t":13.52,"sim_time":13.520000000000714,"vehicle":{"origin_ned":[1.5956311984041431,1.095931078928517,3.5882399180529045],"origin_quat_xyzw":[-0.022745369566784853,0.089008567056799465,0.342404692349211,0.93505034613704496],"cg_ned":[1.5123782607108711,1.0329740138791768,3.3022306736970091],"linear_velocity_ned":[0.08933269206852025,0.039593775340429585,0.077361685880035447],"angular_velocity_ned":[0.012075058170242315,-0.034617834022637586,0.084931199330044879]},"sensors":{"Odom":[1.5956311984041431,1.095931078928517,3.5882399180529045,0.06828838862430614,-0.013212713785029884,0.095286309714806838,-0.022745369566784867,0.08900856705679952,0.34240469234921123,0.93505034613704496,-0.028434496296638662,-0.032681444179323144,0.081736850371075989],"Pressure":[27377.605045928722],"DVL":[0.078457850604678053,-0.0028621364098719926,-0.075615314669287989,7.0603485765055041,-0.0042064338598782744,0.015732000502072033,-0.0023014755034642671,0],"IMU":[0.018731804720103603,0.18305179609065403,0.70376577553844299,0.0049449256679082523,-0.10092752766854472,0.18438508065592554,1.7400272873502638,-0.16535011851204304,-9.7065797977376764],"FOG":[0.68588824170694684],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.079198831128984,30.106697514835666,-51.064404649701714,58.361584038758025,58.361584038758025],"omega_rad_s":[-24.736826065582498,29.915789429896787,-52.284522238439735,58.259095204693878,58.26095993157562],"thrust_n":[-8.087495013134518,10.061167583435317,-36.284483452614253,41.292216061792267,40.348528049281377],"torque_nm":[0.15164053149627221,-0.18864689218941225,0.68033406473651736,-0.77422905115860519,-0.75653490092402575],"angle_rad":[-485.11123266789997,716.30452969890018,-159.13350758722726,1081.812964348195,1081.8128648189268]},"command":[-0.23884951267741891,0.28673045252224444,-0.48632766333049249,0.55582460989293359,0.55582460989293359],"arm":{"servo_position":[-5.3475572240328153e-22,-1.0842021724855024e-21,1.0778494253810979e-21,0,-5.9122899718350197e-21,-4.9127910940749275e-21],"servo_velocity":[0,0,0,8.6736173798840355e-19,0,0],"servo_effort":[0.71440177819226847,-2.0378056718227384,-0.38781821239731351,0.0012073279414720577,-0.00050867564197501123,-0.00044907185460705998]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":339,"step":2712,"t":13.56,"sim_time":13.56000000000072,"vehicle":{"origin_ned":[1.5985399536004412,1.0976277593590087,3.5914410785400461],"origin_quat_xyzw":[-0.022904895253092018,0.088236219123361229,0.34398781855597582,0.93453845083728893],"cg_ned":[1.5158975023967227,1.0345306997249781,3.3052856699666666],"linear_velocity_ned":[0.086932524266823935,0.038392212996200589,0.075606185756880495],"angular_velocity_ned":[0.012347034179990888,-0.034866285600789776,0.083927640441854065]},"sensors":{"Odom":[1.5985399536004412,1.0976277593590087,3.5914410785400461,0.065966244975906863,-0.013084049878448908,0.092964589147524368,-0.022904895253092042,0.088236219123361312,0.34398781855597615,0.93453845083728893,-0.028207103810193184,-0.033064971030516185,0.080765233486735838],"Pressure":[27416.326435035207],"DVL":[0.065518958009109382,0.013735596511439931,-0.086011292885823168,7.0317103310954163,0.0023565910907161732,-0.0035336282478898645,0.046097153775237619,0],"IMU":[0.018193774212682125,0.18167604648621327,0.70704289272017129,-0.029241236236833463,-0.11384584248486991,0.1440460643446328,1.7101488388112871,-0.17016755698465832,-9.6925522221889029],"FOG":[0.71773808646601145],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.108807480646757,29.397551189507791,-50.93632832482578,58.071630071319618,58.071630071319618],"omega_rad_s":[-24.764001782038655,29.206150789911074,-52.13415486806386,57.978499690018083,57.980346813854872],"thrust_n":[-8.1024765427422523,9.5896106792357134,-36.035283151864498,40.951060841587868,40.000652606701898],"torque_nm":[0.15192143517641726,-0.17980520023566962,0.67566155909745929,-0.76783239077977261,-0.75001223637566072],"angle_rad":[-486.10131294325998,717.48496652369874,-161.22146756168155,1084.1369340377512,1084.1369087107159]},"command":[-0.23913149981568341,0.27997667799531228,-0.48510788880786454,0.55306314353637731,0.55306314353637731],"arm":{"servo_position":[-5.3475572240328153e-22,-1.0842021724855024e-21,1.0778494253810979e-21,0,-5.9122899718350197e-21,-4.9127910940749275e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.69980314791372522,-2.0200325379482971,-0.38802259882431578,0.0011940903056254183,-0.00051866445815538663,-0.00040236346202883423]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":340,"step":2720,"t":13.6,"sim_time":13.600000000000726,"vehicle":{"origin_ned":[1.6013528514855599,1.0992681380538627,3.5945725702580171],"origin_quat_xyzw":[-0.023058875309509556,0.087458199967509628,0.34555143592647991,0.93403081140669619],"cg_ned":[1.5193214276270661,1.0360396731402781,3.308270390287908],"linear_velocity_ned":[0.084563044246181829,0.037206219712759649,0.073848147165953601],"angular_velocity_ned":[0.012625090001266432,-0.035047792106700323,0.082925599981936188]},"sensors":{"Odom":[1.6013528514855599,1.0992681380538627,3.5945725702580171,0.063690738218178153,-0.012953128362293115,0.090650146615859156,-0.023058875309509574,0.087458199967509684,0.34555143592648013,0.93403081140669619,-0.027935120572885927,-0.033401076892278364,0.079802210887124511],"Pressure":[27453.354873445172],"DVL":[0.082697097699117608,-0.02952923989730585,-0.06862895284878455,7.1278064323513277,-0.0057717805690907118,0.0024615103754431497,-0.02201280010370912,0],"IMU":[0.017654255314153905,0.18028845632309151,0.71028036278805207,0.043268304355491782,0.0023967804578166677,-0.12603825336089586,1.7101423617609868,-0.13582160867009382,-9.7158386507234251],"FOG":[0.70848020655412802],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.142227379513571,28.687263338329828,-50.807075984414986,57.779413652159995,57.779413652159995],"omega_rad_s":[-24.795370069347999,28.496520429186738,-51.982798784332637,57.694408326093857,57.696235112696762],"thrust_n":[-8.1199594472096077,9.1289852319297111,-35.786193824835706,40.605409392093357,39.64980696199418],"torque_nm":[0.15224923963518011,-0.17116847309868213,0.67099113421566958,-0.76135142610175055,-0.74343388053739112],"angle_rad":[-487.0925762816176,718.63701938426402,-163.30338987450634,1086.4495990083251,1086.4496471175578]},"command":[-0.23944978456679591,0.27321203179361742,-0.48387691413728556,0.55028013002057141,0.55028013002057141],"arm":{"servo_position":[-5.3475572240328153e-22,-1.0842021724855024e-21,1.0778494253810979e-21,0,-5.9122899718350197e-21,-4.9127910940749275e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.6854595035142208,-2.0018561665123489,-0.38796630592383319,0.0011804627854787627,-0.00052781657348645588,-0.00035786661321068436]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":341,"step":2728,"t":13.640000000000001,"sim_time":13.640000000000732,"vehicle":{"origin_ned":[1.6040719103656784,1.1008528276972125,3.5976340700907938],"origin_quat_xyzw":[-0.023206779732694329,0.086675715195107875,0.34709563986507408,0.93352738714860928],"cg_ned":[1.5226512634741145,1.0375015573565023,3.3111847266857257],"linear_velocity_ned":[0.082224233951542214,0.036035815576374731,0.072087294709306096],"angular_velocity_ned":[0.012907988429040314,-0.035163452867263849,0.081925705900626103]},"sensors":{"Odom":[1.6040719103656784,1.1008528276972125,3.5976340700907938,0.061461556939244287,-0.012820020766882875,0.088342867997462965,-0.023206779732694343,0.086675715195107916,0.34709563986507425,0.93352738714860928,-0.027619960358994916,-0.033690095696838146,0.078848088828162771],"Pressure":[27489.082980818112],"DVL":[0.037540888607766269,0.0036351927498173087,-0.063589025887417744,7.0590851600707483,-0.0077846342818118043,0.03131670189417491,-0.0035241299086827306,0],"IMU":[0.017115148441607071,0.17889086899950599,0.71347861016169045,-0.039559738100315871,0.021406203602531024,0.013060058650876796,1.6920756707801925,-0.15381750125785226,-9.7115240434011021],"FOG":[0.72027946414595478],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.179229734231757,27.975107027776392,-50.676678887299147,57.485351794843581,57.485351794843581],"omega_rad_s":[-24.830763178707329,27.786308578490843,-51.830545622178334,57.407288252632299,57.409092070474792],"thrust_n":[-8.1398502037770939,8.6789280083929565,-35.537341402917136,40.256015760189825,39.296710127533629],"torque_nm":[0.1526221913208205,-0.16272990015736796,0.66632515130469638,-0.7548002955035592,-0.73681331489125568],"angle_rad":[-488.08518663690575,719.76067534112985,-165.37923713721744,1088.7508301050175,1088.7509507774728]},"command":[-0.23980218794506436,0.26642959074072753,-0.48263503702189664,0.54747954090327222,0.54747954090327222],"arm":{"servo_position":[-5.3475572240328153e-22,3.2526065174565154e-21,9.7514668052651336e-21,0,-5.9122899718350197e-21,-4.9127910940749275e-21],"servo_velocity":[0,8.6736173798840355e-19,0,0,0,0],"servo_effort":[0.67138275808561154,-1.9833162651590039,-0.38766059126690322,0.0011667884216877659,-0.00053615870187548385,-0.00031560086772304736]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":342,"step":2736,"t":13.68,"sim_time":13.680000000000739,"vehicle":{"origin_ned":[1.6066991327464826,1.1023824604910577,3.6006252520042001],"origin_quat_xyzw":[-0.023348107513308555,0.085889954298420085,0.34862053518965391,0.93302813680523122],"cg_ned":[1.5258882363834523,1.0389169762958825,3.314028561730058],"linear_velocity_ned":[0.079916077802540633,0.034881015444271114,0.070323420965131972],"angular_velocity_ned":[0.013194461026207483,-0.035214580875913837,0.080928568717936841]},"sensors":{"Odom":[1.6066991327464826,1.1023824604910577,3.6006252520042001,0.059278352667727019,-0.012684765810023578,0.086042687030850856,-0.023348107513308583,0.085889954298420182,0.3486205351896543,0.93302813680523122,-0.027263198687963876,-0.033932485352030362,0.077903133299675853],"Pressure":[27524.876704363822],"DVL":[0.039534267889750896,0.023567542609612652,-0.063446897689258347,7.1090925382221979,0.0005343570419640677,0.0011908306954215521,0.025612668302528785,0],"IMU":[0.016578300101625861,0.17748510625570132,0.71663806564112142,-0.019532989645795477,-0.0036812949281044109,0.1119897607575812,1.6904207802511351,-0.15423970948891355,-9.730962921462682],"FOG":[0.72787833677754332],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.219567781469291,27.260314383899566,-50.545167898875327,57.189852590972976,57.189852590972976],"omega_rad_s":[-24.869984773974267,27.074858721199544,-51.677464843528902,57.11759579982796,57.119374126581349],"thrust_n":[-8.1620377355444145,8.2390725899979245,-35.288820869995682,39.903608287377644,38.942051491240171],"torque_nm":[0.15303820754145778,-0.15448261106246111,0.66166539131241919,-0.74819265538833102,-0.73016346546075339],"angle_rad":[-489.07930059170241,720.8558963180642,-167.44897509817577,1091.0405166115013,1091.0407088713091]},"command":[-0.24018635982351705,0.25962204175142445,-0.48138255141786024,0.54466526277117122,0.54466526277117122],"arm":{"servo_position":[-5.3475572240328153e-22,-1.0842021724855024e-21,9.7514668052651336e-21,0,-5.9122899718350197e-21,-4.9127910940749275e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.65758505630826436,-1.9644564078364437,-0.38711916120923401,0.0011529941623575903,-0.00054372286980050436,-0.00027549338988449445]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":343,"step":2744,"t":13.720000000000001,"sim_time":13.720000000000745,"vehicle":{"origin_ned":[1.6092365031440048,1.103857688208568,3.6035457900166885],"origin_quat_xyzw":[-0.02348238896164067,0.08510208753778957,0.3501262358931071,0.93253301874233319],"cg_ned":[1.5290335722873281,1.0402865542920434,3.3168017711675004],"linear_velocity_ned":[0.077638566333935149,0.033741826558202195,0.068556384124956751],"angular_velocity_ned":[0.013483177810643118,-0.035202670580292299,0.079934807429589139]},"sensors":{"Odom":[1.6092365031440048,1.103857688208568,3.6035457900166885,0.057140755875443566,-0.012547369826209558,0.08374958133195394,-0.023482388961640694,0.085102087537789653,0.35012623589310743,0.93253301874233319,-0.026866580827466929,-0.034128781226264768,0.076967594904053221],"Pressure":[27560.504792832879],"DVL":[0.044757559603182541,-0.0060507153508643982,-0.065228389496230194,7.1413344301781274,0.010523212513066904,0.013470636475674336,-6.5817194578002158e-05,0],"IMU":[0.016045495712947305,0.17607296481641946,0.71975916522137384,-0.03760474208107141,-0.0070641418822228984,0.17754914093908658,1.678746036662381,-0.12698029079950834,-9.7194283834421142],"FOG":[0.70900420220684268],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.26297669810419,26.542062241014388,-50.412572920619674,56.893317501168632,56.893317501168632],"omega_rad_s":[-24.912813139478494,26.361452493668082,-51.523610815316964,56.825777375571327,56.827527803774949],"thrust_n":[-8.186395229353419,7.8090583845148904,-35.040706056607497,39.548890347498649,38.586492961030146],"torque_nm":[0.15349491055037665,-0.14641984470965422,0.65701323856139071,-0.74154169401559966,-0.72349674301931532],"angle_rad":[-490.07506629047492,721.92261657446704,-169.51257192664914,1093.3185658360737,1093.3188286090381]},"command":[-0.24059977807718275,0.25278154515251799,-0.48011974210113972,0.54184111905874888,0.54184111905874888],"arm":{"servo_position":[-5.3475572240328153e-22,-1.0842021724855024e-21,9.7514668052651336e-21,0,-5.9122899718350197e-21,-2.2260025853842999e-20],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.64408665607265836,-1.945310181476529,-0.3863511254723187,0.0011391951420011239,-0.00055052581823718586,-0.00023744565453921713]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":344,"step":2752,"t":13.76,"sim_time":13.760000000000751,"vehicle":{"origin_ned":[1.6116859859667245,1.1052791818312131,3.6063953610305397],"origin_quat_xyzw":[-0.023609187288718768,0.084313262603763123,0.35161286451091145,0.93204199129390419],"cg_ned":[1.5320884967170509,1.0416109159116125,3.3195042263624286],"linear_velocity_ned":[0.075391688109198177,0.032618253333403992,0.06678609877649519],"angular_velocity_ned":[0.013772847679609934,-0.035129416644554497,0.078944974470700632]},"sensors":{"Odom":[1.6116859859667245,1.1052791818312131,3.6063953610305397,0.055048351270451712,-0.01240782294717257,0.081463567092320333,-0.023609187288718803,0.084313262603763248,0.35161286451091195,0.93204199129390419,-0.026431947732394587,-0.034279675705268034,0.07604164788972971],"Pressure":[27592.938598634795],"DVL":[0.076957643289825892,0.008423948741953742,-0.073635596334470102,7.1616450021043425,0.021651749491104825,0.016705832346983321,-0.013569898058832651,0],"IMU":[0.015518453599414443,0.17465621214027999,0.72284234822257198,0.022615311219161757,-0.00662020928503608,0.1168191821578797,1.6589487183744451,-0.1324383663892271,-9.7211664282328343],"FOG":[0.72008713736045615],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.309178854113117,25.819467273171878,-50.278925236513743,56.596140913493663,56.596140913493663],"omega_rad_s":[-24.959004318667855,25.645307705032039,-51.369027779704773,56.532270101313529,56.533990343271391],"thrust_n":[-8.212781768262257,7.388535176334365,-34.793057027059206,39.192542175593438,38.23066918581187],"torque_nm":[0.15398965815491733,-0.13853503455626931,0.65236981925736015,-0.73486016579237701,-0.71682504723397256],"angle_rad":[-491.072622488516,722.96074016139744,-171.56999772161041,1095.5849027296078,1095.5852348479118]},"command":[-0.24103979861060112,0.24589968831592263,-0.47884690701441657,0.53901086584279678,0.53901086584279678],"arm":{"servo_position":[-5.3475572240328153e-22,-1.0842021724855024e-21,9.7514668052651336e-21,0,-5.9122899718350197e-21,-2.2260025853842999e-20],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.63088002064259685,-1.9259336835823717,-0.38537287480911225,0.0011252935790574221,-0.00055660341798113432,-0.00020136991891189237]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":345,"step":2760,"t":13.800000000000001,"sim_time":13.800000000000757,"vehicle":{"origin_ned":[1.6140495231314673,1.1066476307788113,3.6091736475219336],"origin_quat_xyzw":[-0.02372809973173122,0.083524600855005404,0.35308055123031712,0.93155501323219148],"cg_ned":[1.5350542347567451,1.0428906857496147,3.3221357965225304],"linear_velocity_ned":[0.073175432757596429,0.031510293525275582,0.065012535264323879],"angular_velocity_ned":[0.014062166886326371,-0.03499672379480049,0.077959620284438577]},"sensors":{"Odom":[1.6140495231314673,1.1066476307788113,3.6091736475219336,0.053000686847514897,-0.012266083279186213,0.07918469754207573,-0.023728099731731227,0.083524600855005432,0.35308055123031723,0.93155501323219148,-0.025961294009016277,-0.034385989432841289,0.075125445442301639],"Pressure":[27627.015620385544],"DVL":[0.074040620265577423,-0.065445736462769175,-0.049143191224689561,7.1488448607235178,0.031385704727234384,-0.030423521763446631,-0.044932936198039536,0],"IMU":[0.014998819477859169,0.17323658107868267,0.72588805494786079,0.0040208354733805157,-0.022419543409568941,0.02273665563105344,1.6456518611296593,-0.12567621175847579,-9.7358937483736412],"FOG":[0.71663313978703147],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.357890986657011,25.091609063919165,-50.144262202423739,56.298711388913055,56.298711388913055],"omega_rad_s":[-25.008297685503589,24.925587312971246,-51.21375539381048,56.237502671837312,56.239190564700685],"thrust_n":[-8.2410456951562931,6.9771744765273933,-34.545927440061099,38.835221988667847,37.875189183225459],"torque_nm":[0.15451960678418056,-0.13082202143488864,0.6477361395011455,-0.72816041228752215,-0.7101597971854775],"angle_rad":[-492.07209779767584,723.97013859187268,-173.6212242406603,1097.8394695342813,1097.8398697413941]},"command":[-0.24150372368244771,0.2389677053706587,-0.47756440192784516,0.53617820370393388,0.53617820370393388],"arm":{"servo_position":[-5.3475572240328153e-22,-1.0842021724855024e-21,9.7514668052651336e-21,0,-5.9122899718350197e-21,-2.2260025853842999e-20],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.61799123218149765,-1.9063684200183375,-0.38419734868222599,0.0011112649084869116,-0.00056198728333760155,-0.00016724324131876084]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":346,"step":2768,"t":13.84,"sim_time":13.840000000000764,"vehicle":{"origin_ned":[1.6163290317341803,1.1079637427417972,3.6118803400730073],"origin_quat_xyzw":[-0.023838759544715593,0.082737193872076911,0.35452943404137383,0.93107204377096753],"cg_ned":[1.5379320111760819,1.0441264881671157,3.3246963509176273],"linear_velocity_ned":[0.070989794472839471,0.030417938603882085,0.063235718946420175],"angular_velocity_ned":[0.01434981429721246,-0.034806683345386051,0.076979303076648756]},"sensors":{"Odom":[1.6163290317341803,1.1079637427417972,3.6118803400730073,0.05099728382395792,-0.012122080618933341,0.07691306220680956,-0.023838759544715621,0.082737193872077008,0.35452943404137421,0.93107204377096753,-0.025456759412487311,-0.034448648921671453,0.074219131399681393],"Pressure":[27659.920036774209],"DVL":[0.095036118822277083,-0.017641594405978449,-0.075961539913862036,7.0677222157613526,-0.01526870371957465,0.01415790451133744,-0.0053820315607012682,0],"IMU":[0.014488159721083216,0.17181576574832733,0.72889672659653648,0.067442308874905404,-0.17048993177504607,-0.090125597419143555,1.6246133113960768,-0.12860348391883758,-9.7009656217343085],"FOG":[0.7246631549474104],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.408807172843499,24.357469216638236,-50.008610107485069,56.001411011095726,56.001411011095726],"omega_rad_s":[-25.060414376190028,24.201387842862385,-51.057827415497343,55.941895792573646,55.943549302841689],"thrust_n":[-8.271023348861803,6.5746682401627243,-34.299362767102131,38.477566290373204,37.520637570270083],"torque_nm":[0.1550816877911588,-0.12327502950305108,0.64311305188316514,-0.72145436794449769,-0.70351195444256398],"angle_rad":[-493.0736099909808,724.95064842138083,-175.66622469758551,1100.0822254575899,1100.0826924133626]},"command":[-0.24198863974136667,0.23197589730131654,-0.47627247721414351,0.53334677153424503,0.53334677153424503],"arm":{"servo_position":[-5.3475572240328153e-22,-1.0842021724855024e-21,9.7514668052651336e-21,0,-5.9122899718350197e-21,-4.9127910940749275e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.60543524915385083,-1.8866575178802456,-0.38283718634192343,0.0010973425210991678,-0.00056670274214823944,-0.00013492915026876466]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":347,"step":2776,"t":13.880000000000001,"sim_time":13.88000000000077,"vehicle":{"origin_ned":[1.6185264020697654,1.1092282432612273,3.6145151396631205],"origin_quat_xyzw":[-0.023940837433257253,0.081952100439656297,0.35595965841177135,0.93059304269906173],"cg_ned":[1.5407230505181693,1.0453189470661679,3.3271857609382711],"linear_velocity_ned":[0.068834767076496023,0.029341174804799863,0.061455724195571236],"angular_velocity_ned":[0.014634476429723172,-0.034561549817844782,0.076004563334057501]},"sensors":{"Odom":[1.6185264020697654,1.1092282432612273,3.6145151396631205,0.049037635433514241,-0.01197572396794427,0.074648781037239056,-0.023940837433257266,0.081952100439656339,0.35595965841177157,0.93059304269906173,-0.024920592074454954,-0.034468684767717424,0.073322821377976133],"Pressure":[27694.298284642457],"DVL":[0.10697008267897913,-0.034715279705702838,-0.057246318909094443,7.0225091009333802,-0.0054004850300368194,-0.0035272222367854489,0.014254283469653507,0],"IMU":[0.013987955881818405,0.17039541784697387,0.73186880436600799,-0.089517221702689942,-0.058301659836368432,0.045361123523804892,1.586069786802909,-0.11522455217879352,-9.6848320032412758],"FOG":[0.75371859699417543],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.461610017414166,23.615931897689112,-49.871995118426135,55.704616100917519,55.704616100917519],"omega_rad_s":[-25.11505871856129,23.471727680305648,-50.901272792204701,55.645862535523328,55.64747976274014],"thrust_n":[-8.3025396487582555,6.1807291982746619,-34.053401966253524,38.120190514783644,37.167575500039],"torque_nm":[0.15567261841421731,-0.11588867246764992,0.63850128686725371,-0.71475357215219326,-0.6968920406257314],"angle_rad":[-494.0772652983286,725.9020683079782,-177.70497354133215,1102.31314635941,1102.313678645336]},"command":[-0.24249152397537302,0.22491363712084869,-0.47497138208024892,0.53052015334207159,0.53052015334207159],"arm":{"servo_position":[-5.3475572240328153e-22,3.2526065174565154e-21,9.7514668052651336e-21,0,-5.9122899718350197e-21,-4.9127910940749275e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.59322524504210217,-1.8668433423532651,-0.38130555256606763,0.0010832452004495615,-0.00057078274534332616,-0.00010442902729397016]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":348,"step":2784,"t":13.92,"sim_time":13.920000000000776,"vehicle":{"origin_ned":[1.6206434958821487,1.1104418750897844,3.6170777598190824],"origin_quat_xyzw":[-0.024034042439749787,0.081170343890398608,0.3573713769166858,0.93011797049481348],"cg_ned":[1.5434285771016203,1.0464686856858727,3.3296039020747221],"linear_velocity_ned":[0.066710345362143972,0.028279983452721588,0.059672674640797438],"angular_velocity_ned":[0.01491485742917488,-0.034263716306279494,0.075035923849110744]},"sensors":{"Odom":[1.6206434958821487,1.1104418750897844,3.6170777598190824,0.047121211994146123,-0.011826907951184806,0.072392005058879716,-0.024034042439749794,0.081170343890398636,0.35737137691668591,0.93011797049481348,-0.024355126334264288,-0.034447219013427177,0.072436606896115543],"Pressure":[27724.331410092149],"DVL":[0.054505522556540446,-0.0078924545663610537,-0.05796515128294364,7.1723665835439716,0.045922233911103415,-0.014468234063695531,-0.011518557292939735,0],"IMU":[0.013499600502550986,0.16897714326786259,0.7348047286497027,0.036581306743412867,-0.033781392608240167,0.082486495118950232,1.6135368585460708,-0.13302881222284338,-9.6878859768252266],"FOG":[0.70922884910202921],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.515976416530755,22.865761585593823,-49.734441317884325,55.40869717516712,55.40869717516712],"omega_rad_s":[-25.171921205327685,22.735534191470986,-50.744116726638119,55.349808811566334,55.351387991255514],"thrust_n":[-8.335409731615206,5.7950920578442764,-33.808078953200379,37.763689642696932,36.816541747034741],"torque_nm":[0.15628893246778508,-0.10865797608458018,0.63390148037250715,-0.70806918080056758,-0.69031015775690152],"angle_rad":[-495.0831577966722,726.82415561066625,-179.73744629123757,1104.5322244592751,1104.5328205838812]},"command":[-0.24300929920505482,0.21776915795803642,-0.47366134588461262,0.52770187785873446,0.52770187785873446],"arm":{"servo_position":[-5.3475572240328153e-22,-1.0842021724855024e-21,9.7514668052651336e-21,-4.3368086899420178e-21,-5.9122899718350197e-21,-4.9127910940749275e-21],"servo_velocity":[0,-8.6736173798840355e-19,0,-8.6736173798840355e-19,0,0],"servo_effort":[0.58136933744518871,-1.8469642704042202,-0.3796154282939091,0.0010690953356228402,-0.00057425671187211788,-7.559807955601861e-05]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":349,"step":2792,"t":13.960000000000001,"sim_time":13.960000000000782,"vehicle":{"origin_ned":[1.6226821445375947,1.1116053975695388,3.6195679286149534],"origin_quat_xyzw":[-0.024118122907526289,0.080392909301058177,0.35876474885081289,0.92964678844362292],"cg_ned":[1.5460498150390882,1.047576326409581,3.331950655744838],"linear_velocity_ned":[0.064616524907306391,0.027234341150709045,0.057886737605337406],"angular_velocity_ned":[0.015189677011105306,-0.033915737807714286,0.074073896253770241]},"sensors":{"Odom":[1.6226821445375947,1.1116053975695388,3.6195679286149534,0.045247457327332444,-0.011675505972328006,0.070142912519190082,-0.02411812290752631,0.080392909301058246,0.35876474885081322,0.92964678844362292,-0.023762801950850232,-0.034385480389604595,0.071560559296154402],"Pressure":[27756.722118227604],"DVL":[0.073146573771008125,-0.005842818377101342,-0.054964249353545977,7.135815179343421,0.017640491529981914,0.033091604105702437,-0.0025987726783317068,0],"IMU":[0.013024392659446958,0.16756249849878282,0.73770493822186567,0.022460573645854263,-0.083990096579926898,0.08026565359781436,1.587546117961435,-0.11910290052545837,-9.7572537498850256],"FOG":[0.73422622802592519],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.57157427013933,22.105583859763914,-49.595972149881625,55.114019308549679,55.114019308549679],"omega_rad_s":[-25.230680684402277,21.991627422507374,-50.586381713459815,55.054133605392458,55.055673111358772],"thrust_n":[-8.369440146339759,5.4175147253036986,-33.563424080151051,37.408638926252053,36.468053231353039],"torque_nm":[0.1569270027438705,-0.10157840109944434,0.62931420150283213,-0.70141197986722614,-0.68377599808786937],"angle_rad":[-496.09136891771976,727.71662237687906,-181.76361941186374,1106.7394680540685,1106.7401264584057]},"command":[-0.24353880257275551,0.21052937009298966,-0.47234259190363453,0.52489542198618744,0.52489542198618744],"arm":{"servo_position":[-5.3475572240328153e-22,3.2526065174565154e-21,9.7514668052651336e-21,0,-5.9122899718350197e-21,-4.9127910940749275e-21],"servo_velocity":[0,8.6736173798840355e-19,0,0,0,0],"servo_effort":[0.5698809515012554,-1.8270613386149936,-0.37777974027395861,0.0010550708043144225,-0.00057715712491193173,-4.8431811386111115e-05]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":350,"step":2800,"t":14,"sim_time":14.000000000000789,"vehicle":{"origin_ned":[1.6246441474595759,1.1127195859360284,3.6219853905199471],"origin_quat_xyzw":[-0.024192867118703297,0.079620741056915689,0.36013993996321814,0.9291794586716895],"cg_ned":[1.5485879882597022,1.0486424905902501,3.3342259110392032],"linear_velocity_ned":[0.062553300476631352,0.026204220331546173,0.056098123500685278],"angular_velocity_ned":[0.015457689220777402,-0.03352027422225979,0.073118972435653046]},"sensors":{"Odom":[1.6246441474595759,1.1127195859360284,3.6219853905199471,0.043415797114805664,-0.011521383473369019,0.067901707549569437,-0.024192867118703304,0.079620741056915703,0.36013993996321825,0.9291794586716895,-0.023146112457804499,-0.034284774016080932,0.070694729780828441],"Pressure":[27786.34826751742],"DVL":[0.062116935700177497,-0.027216139933200482,-0.095705832501310914,7.148788326414989,0.0032944366159361376,0.0048211166201520828,-0.039228581242648435,0],"IMU":[0.012563534407503291,0.16615298747652851,0.74056986983441053,-0.061951669957562912,-0.10316604442777806,0.15617082364715162,1.5800123537756079,-0.092815538994244343,-9.7187017615919782],"FOG":[0.74017989982172816],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.628065212414931,21.333841559358333,-49.456607031582571,54.820941789920106,54.820941789920106],"omega_rad_s":[-25.291005366599251,21.238696887058286,-50.42808722257498,54.759229190360614,54.760727536413327],"thrust_n":[-8.4044292399645961,5.0477784063802238,-33.319463706308092,37.055594059795965,36.122606032977863],"torque_nm":[0.15758304824933619,-0.094645845119629188,0.62473994449327663,-0.69479238862117454,-0.67729886311833498],"angle_rad":[-497.10196699640903,728.57913054937285,-183.78347019886903,1108.9349012468767,1108.935620310094]},"command":[-0.24407681154680885,0.2031794434224603,-0.47101530506269113,0.52210420752304865,0.52210420752304865],"arm":{"servo_position":[-5.3475572240328153e-22,3.2526065174565154e-21,9.7514668052651336e-21,0,-5.9122899718350197e-21,-2.2260025853842999e-20],"servo_velocity":[0,8.6736173798840355e-19,0,0,0,0],"servo_effort":[0.55876633425639333,-1.8071721071016129,-0.37581059537361572,0.001040960578894087,-0.0005795102944552257,-2.2793262433842327e-05]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":351,"step":2808,"t":14.040000000000001,"sim_time":14.040000000000795,"vehicle":{"origin_ned":[1.6265312709066679,1.1137852304589042,3.6243299081056835],"origin_quat_xyzw":[-0.024258103470490681,0.078854740860325734,0.36149712197737327,0.92871594422726578],"cg_ned":[1.5510443205089979,1.0496677984009146,3.3364295663949348],"linear_velocity_ned":[0.060520668016098178,0.025189590049953192,0.054307083544446223],"angular_velocity_ned":[0.015717687130539226,-0.033080091238766034,0.072171625366327846]},"sensors":{"Odom":[1.6265312709066679,1.1137852304589042,3.6243299081056835,0.041625640063771875,-0.011364398273751349,0.065668619489768418,-0.024258103470490691,0.078854740860325775,0.36149712197737344,0.92871594422726578,-0.022507603403951741,-0.034146485023331868,0.069839150787205137],"Pressure":[27815.091156797534],"DVL":[0.083303692128213577,-0.0035297864654177504,-0.06727307655425227,7.0722672281039172,0.006771537835220845,-0.0063915494719222858,-0.017050338259229195,0],"IMU":[0.012118128378613023,0.16475005893489808,0.74339995751075238,-0.046817329978634359,-0.034144468953996587,0.22874568910785048,1.5504054400409009,-0.093129234029049421,-9.7642636667108587],"FOG":[0.74945666781196163],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.685112987477574,20.548762164204224,-49.316367367612983,54.52981810148291,54.52981810148291],"omega_rad_s":[-25.352556749778881,20.475273506239077,-50.2692509828967,54.465481239240908,54.466937080104813],"thrust_n":[-8.4401695267177104,4.6856886271504816,-33.076221983239513,36.705091555007733,35.780675931410784],"torque_nm":[0.15825317862595709,-0.087856661759071544,0.62017916218574098,-0.68822046665639502,-0.67088767371395253],"angle_rad":[-498.11500693433385,729.41128611205647,-185.79697668303029,1111.118563681531,1111.1193417264985]},"command":[-0.24462012369026259,0.19570249680194499,-0.46967968921536174,0.51933160096650388,0.51933160096650388],"arm":{"servo_position":[-5.3475572240328153e-22,-1.0842021724855024e-21,9.7514668052651336e-21,0,-5.9122899718350197e-21,-2.2260025853842999e-20],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.5480323259123957,-1.7873312968674475,-0.37372027610362196,0.0010268503184352419,-0.00058134998852558007,1.3124677842311982e-06]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":352,"step":2816,"t":14.08,"sim_time":14.080000000000801,"vehicle":{"origin_ned":[1.6283452466557973,1.1148031356286334,3.6266012636201328],"origin_quat_xyzw":[-0.024313700711050313,0.078095765599675696,0.36283647236496058,0.92825620906885664],"cg_ned":[1.553420035363144,1.0506528686961001,3.3385615311239838],"linear_velocity_ned":[0.058518623061964266,0.024190415724367247,0.052513905628408422],"angular_velocity_ned":[0.015968503788799167,-0.03259806102012245,0.071232316610002691]},"sensors":{"Odom":[1.6283452466557973,1.1148031356286334,3.6266012636201328,0.03987637681712633,-0.011204397916218616,0.063443899676649429,-0.024313700711050341,0.078095765599675779,0.36283647236496097,0.92825620906885664,-0.021849874290984603,-0.033972079474886577,0.068993843455574716],"Pressure":[27844.575499330098],"DVL":[0.049395026242221245,-0.004555060177198038,-0.082139702054674538,7.119135744971123,0.015116047109887003,-0.030093062503974859,0.010419684962495004,0],"IMU":[0.011689175207678121,0.16335510351779595,0.74619563239235431,-0.038303943827059893,-0.053321351380152204,-0.093508439283802092,1.5342778398404826,-0.080887529755236248,-9.7470895450408062],"FOG":[0.72992352628971535],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.7423782167625,19.74829162062716,-49.175270054107017,54.240996000423394,54.240996000423394],"omega_rad_s":[-25.414991279526525,19.699690935484725,-50.109888612381575,54.173268841796258,54.174680973489657],"thrust_n":[-8.4764486225977684,4.3310753777132431,-32.833720347444711,36.357649125622238,35.442718835675898],"torque_nm":[0.1589334116737082,-0.081207663332123328,0.61563225651458842,-0.68170592110541706,-0.66455097816892295],"angle_rad":[-499.13052997670951,730.21263189779347,-187.80411755917399,1113.2905102781754,1113.2913455771304]},"command":[-0.24516550682630953,0.18807896781549677,-0.4683359052772097,0.51658091428974662,0.51658091428974662],"arm":{"servo_position":[-5.3475572240328153e-22,-1.0842021724855024e-21,9.7514668052651336e-21,0,-5.9122899718350197e-21,-4.9127910940749275e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.53768706471717054,-1.7675746271899309,-0.37152179236681288,0.0010127282412517075,-0.0005827074446618963,2.4027722122136731e-05]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":353,"step":2824,"t":14.120000000000001,"sim_time":14.120000000000807,"vehicle":{"origin_ned":[1.6300877709319135,1.1157741192498154,3.6287992604699864],"origin_quat_xyzw":[-0.024359567891028357,0.077344625521805418,0.36415817399117095,0.92780021808063295],"cg_ned":[1.5557163562446543,1.0515983188870488,3.3406217268966159],"linear_velocity_ned":[0.056547162822063964,0.023206660389391662,0.050718914745190795],"angular_velocity_ned":[0.016209024770288027,-0.032077134604066831,0.070301486454147841]},"sensors":{"Odom":[1.6300877709319135,1.1157741192498154,3.6287992604699864,0.038167385525513124,-0.011041227963906903,0.061227822770385965,-0.024359567891028364,0.077344625521805432,0.36415817399117106,0.92780021808063295,-0.021175550264330635,-0.03376309259638479,0.068158812309229072],"Pressure":[27871.167128800174],"DVL":[0.040255526956917954,-0.0020598247413024327,-0.04681130477524037,7.0448318727622858,0.0072920635575258064,0.00030008958562906555,0.038881514279293421,0],"IMU":[0.011277571690705502,0.16196945123976697,0.74895732240895485,-0.060245323911767845,-0.017173205749374462,0.0042622149346708132,1.5330541501775445,-0.086322947452414714,-9.7277517588667237],"FOG":[0.73674599703224097],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.799522467541411,18.930025416907135,-49.033330688586673,53.95481695173936,53.95481695173936],"omega_rad_s":[-25.477961800901909,18.910036404329986,-49.950013541107126,53.882964495223817,53.884331854898434],"thrust_n":[-8.5130500678715908,3.9837943091941628,-32.591977512754099,36.013765792224923,35.109171316938486],"torque_nm":[0.15961968877259233,-0.074696143297390549,0.61109957836413942,-0.6752581086042172,-0.65829696219259659],"angle_rad":[-500.14856353675509,730.98263860499083,-189.80487209506597,1115.4508109711173,1115.4517017513153]},"command":[-0.24570973778610869,0.18028595635149652,-0.46698410179606353,0.51385539954037485,0.51385539954037485],"arm":{"servo_position":[-5.3475572240328153e-22,-1.0842021724855024e-21,9.7514668052651336e-21,0,-5.9122899718350197e-21,-4.9127910940749275e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.52773349056567809,-1.7479358517830321,-0.36922559770948365,0.00099851976672275995,-0.00058360837476281475,4.5362329216721488e-05]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":354,"step":2832,"t":14.16,"sim_time":14.160000000000814,"vehicle":{"origin_ned":[1.6317605034359586,1.1166990115223467,3.6309237245523343],"origin_quat_xyzw":[-0.024395654165808685,0.076602082553864609,0.36546241478789332,0.92734793706765473],"cg_ned":[1.5579345064187911,1.0525047648491108,3.3426100890966142],"linear_velocity_ned":[0.054606281792579217,0.02223828440426321,0.048922467222156443],"angular_velocity_ned":[0.016438187961616911,-0.031520338835068142,0.069379558436141825]},"sensors":{"Odom":[1.6317605034359586,1.1166990115223467,3.6309237245523343,0.036498029799188869,-0.010874728225573933,0.059020681508751088,-0.024395654165808692,0.076602082553864623,0.36546241478789337,0.92734793706765473,-0.020487281688654456,-0.03352112652622917,0.067334049914996447],"Pressure":[27900.155416898586],"DVL":[0.077510564862232179,0.022918249014905905,-0.04327037839476873,7.1484645537006939,0.0089240763497293457,0.014412147065090381,0.011499000162771961,0],"IMU":[0.010884109336855834,0.16059436909623698,0.75168545206317416,0.019599223575430418,-0.0019890525958876776,0.14170947021233099,1.5103263717845496,-0.095291534054157259,-9.7717392520582909],"FOG":[0.76673410569604794],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.856208429994808,18.091104203241127,-48.890563074627721,53.671616013760421,53.671616013760421],"omega_rad_s":[-25.541119589947183,18.104084896497241,-49.78963734014588,53.594933877791306,53.596255543041906],"thrust_n":[-8.5497545616498254,3.6437282892298213,-32.351009873586911,35.67392197816087,34.780450870879115],"torque_nm":[0.16030789803093423,-0.068319905423059143,0.60658143512975449,-0.66888603709051642,-0.65213345382898358],"angle_rad":[-501.16912110512038,731.72069348959235,-191.79922005419937,1117.599550438671,1117.6004948880159]},"command":[-0.24624960409518865,0.17229623050705836,-0.4656244102345497,0.51115824775009921,0.51115824775009921],"arm":{"servo_position":[-5.3475572240328153e-22,-1.0842021724855024e-21,1.0778494253810975e-21,0,-5.9122899718350197e-21,-4.9127910940749275e-21],"servo_velocity":[0,0,4.3368086899420177e-19,0,0,0],"servo_effort":[0.51817624558190234,-1.7284469318538416,-0.36684431746932017,0.00098441664335033145,-0.00058408720209915084,6.5383468292969473e-05]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":355,"step":2840,"t":14.200000000000001,"sim_time":14.20000000000082,"vehicle":{"origin_ned":[1.6333650664897288,1.1175786540931929,3.632974505476311],"origin_quat_xyzw":[-0.024421948439146249,0.075868848796406735,0.3667493874578,0.92689933273040603],"cg_ned":[1.5600757089749366,1.0533728208430826,3.3445265680890848],"linear_velocity_ned":[0.052695976852623859,0.021285247136488741,0.047124951154108315],"angular_velocity_ned":[0.016654987059436691,-0.030930768933300035,0.068466941882086768]},"sensors":{"Odom":[1.6333650664897288,1.1175786540931929,3.632974505476311,0.034867663959841692,-0.010704735717540895,0.056822788974446217,-0.02442194843914627,0.075868848796406804,0.36674938745780034,0.92689933273040603,-0.019787737705969123,-0.033247847451005098,0.066519540495967866],"Pressure":[27925.95283242912],"DVL":[0.076225013382426016,-0.011880426741524251,-0.070206555471893556,7.1084950360200985,0.013236877729835958,0.0086450337017662821,0.021889880428370794,0],"IMU":[0.010509473349167046,0.15923105885365049,0.75438044233228096,-0.0071553105734416811,-0.008435544522778643,0.076881374840243266,1.4987491700843436,-0.083616173453614426,-9.7312450920801901],"FOG":[0.76765081155001846],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.912101383756529,17.228072889291447,-48.746978722008478,53.391721871351926,53.391721871351926],"omega_rad_s":[-25.604115425865093,17.279210180274855,-49.628769504692578,53.309535913462426,53.310811101146655],"thrust_n":[-8.5863406389747645,3.3107898024968025,-32.11083130505282,35.338579882940159,34.456956485682269],"torque_nm":[0.16099388698077685,-0.062077308796815049,0.60207808696974041,-0.66259837280512801,-0.64606793410654251],"angle_rad":[-502.19220220710201,732.42608591864359,-193.78714161516532,1119.736827833568,1119.7378241062049]},"command":[-0.24678191794053836,0.16407688465991854,-0.46425694020960456,0.50849258925097074,0.50849258925097074],"arm":{"servo_position":[-5.3475572240328153e-22,-1.0842021724855024e-21,1.0778494253810975e-21,0,-5.9122899718350197e-21,-4.9127910940749275e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.50901877685719354,-1.7091381522675622,-0.36438819365520708,0.00097019382461849626,-0.00058416809786086322,8.4177996120117724e-05]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":356,"step":2848,"t":14.24,"sim_time":14.240000000000826,"vehicle":{"origin_ned":[1.6349030443803267,1.1184138992023771,3.6349514776632024],"origin_quat_xyzw":[-0.024438479001221789,0.075145585219723907,0.36801928933984024,0.92645437256234631],"cg_ned":[1.5621411869054835,1.0542030994668632,3.346371130402074],"linear_velocity_ned":[0.050816246427240565,0.020347506124148738,0.045326783214870679],"angular_velocity_ned":[0.01685846599218958,-0.030311563051572642,0.067564039690334907]},"sensors":{"Odom":[1.6349030443803267,1.1184138992023771,3.6349514776632024,0.033275638595315793,-0.010531086706753101,0.054634475316991296,-0.024438479001221813,0.075145585219723976,0.36801928933984057,0.92645437256234631,-0.019079594856491838,-0.032944963467692913,0.065715269395635462],"Pressure":[27953.716235886412],"DVL":[0.062925350011576536,0.028763606531314798,-0.016226322118894826,7.0594032558002402,0.0058252708746132243,0.0060369942880607189,-0.023226773910036868,0],"IMU":[0.010154241794259474,0.15788065518752387,0.75704271094794318,0.07086695791902356,0.030224177153964561,0.082280607203952055,1.5059644787624247,-0.080570274997524047,-9.7167294245837521],"FOG":[0.7569990032500743],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.966867593435797,16.336666453516447,-48.602584965266828,53.115456406216545,53.115456406216545],"omega_rad_s":[-25.666600325863428,16.432258058176753,-49.467417028795886,53.027122478366209,53.028350542961476],"thrust_n":[-8.6225851493874028,2.9849231457808285,-31.871452578187082,35.008183329103353,34.139069034415861],"torque_nm":[0.16167347155101386,-0.055967308983390529,0.59758973584100783,-0.65640343742068796,-0.64010754439529727],"angle_rad":[-503.21779240212885,733.09798854826249,-195.76861728219671,1121.8627565048284,1121.8638027266802]},"command":[-0.24730350088986472,0.1555872995572995,-0.46288176157396976,0.50586148958301469,0.50586148958301469],"arm":{"servo_position":[-5.3475572240328153e-22,-1.0842021724855024e-21,1.0778494253810975e-21,0,-5.9122899718350197e-21,-4.9127910940749275e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.50026498473209868,-1.6900363358974171,-0.36186854086650677,0.00095596626690752911,-0.00058388181184969182,0.00010184035401102498]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":357,"step":2856,"t":14.280000000000001,"sim_time":14.280000000000832,"vehicle":{"origin_ned":[1.6363759829970832,1.1192056096530705,3.6368545412366888],"origin_quat_xyzw":[-0.024445314340504131,0.074432901435749169,0.36927232217834888,0.92601302467279556],"cg_ned":[1.5641321631418572,1.0549962115641056,3.3481437599676211],"linear_velocity_ned":[0.048967088431373609,0.019425016540969127,0.043528412900247539],"angular_velocity_ned":[0.017047590950139472,-0.029665879854707526,0.066671248661151705]},"sensors":{"Odom":[1.6363759829970832,1.1192056096530705,3.6368545412366888,0.031721328575707031,-0.01035359227329509,0.052456087707742398,-0.024445314340504152,0.074432901435749224,0.36927232217834915,0.92601302467279556,-0.01836561398282802,-0.03261412088510162,0.064921210129818718],"Pressure":[27976.836164265882],"DVL":[0.050207880168099746,0.00027304839738101321,-0.037416192041178083,7.085252252602956,-0.0042168155102187757,0.018237875407852745,0.0074561824789039942,0],"IMU":[0.0098188833679782803,0.15654422667248752,0.75967267245432779,-0.028591063186005763,0.078815621201714398,0.22377276792788076,1.4603458463731704,-0.08452856311837792,-9.7655906375608197],"FOG":[0.76618826336385437],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-26.020167436974802,15.41149643217989,-48.457393355727689,52.843134352094744,52.843134352094744],"omega_rad_s":[-25.728224945046499,15.559362730357238,-49.305585511422926,52.748038227949117,52.749218658660602],"thrust_n":[-8.6582629453646671,2.6661070403659104,-31.632882656945839,34.683156782249448,33.827152857452432],"torque_nm":[0.16234243022558756,-0.04998950700686082,0.59311654981773454,-0.65030918966717721,-0.63425911607723318],"angle_rad":[-504.24586329738867,733.73543219231726,-197.74362779572436,1123.9774637126088,1123.9785579868214]},"command":[-0.24781111844737908,0.14677615649695133,-0.46149898434026371,0.50326794621042614,0.50326794621042614],"arm":{"servo_position":[-5.3475572240328153e-22,-1.0842021724855024e-21,1.0778494253810975e-21,0,-5.9122899718350197e-21,-4.9127910940749275e-21],"servo_velocity":[0,0,4.3368086899420177e-19,0,0,0],"servo_effort":[0.49192501796031118,-1.6711432594815223,-0.35928903491136926,0.00094176706901420747,-0.00058324260175175269,0.00011839879318315991]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":358,"step":2864,"t":14.32,"sim_time":14.320000000000839,"vehicle":{"origin_ned":[1.6377853860358345,1.1199546589627776,3.6386836232260227],"origin_quat_xyzw":[-0.024442566393873173,0.073731349745450606,0.37050869223260191,0.92557525787635564],"cg_ned":[1.5660498608127877,1.0557527661673809,3.349844458787266],"linear_velocity_ned":[0.047148516711541709,0.018517732015115102,0.041730286284933346],"angular_velocity_ned":[0.0172213168782307,-0.028997662072824719,0.065789017977041023]},"sensors":{"Odom":[1.6377853860358345,1.1199546589627776,3.6386836232260227,0.030203971153170809,-0.010171904904033092,0.050287987594556278,-0.024442566393873173,0.073731349745450606,0.37050869223260191,0.92557525787635564,-0.017649121299176809,-0.032257502611522826,0.064137314332049625],"Pressure":[28000.960330458071],"DVL":[0.025467579924027126,0.0057739969963923436,-0.025183302706009974,7.1764148229974243,-0.020843336523978503,-0.015069340071850535,0.0071930742273290313,0],"IMU":[0.0095037463456678021,0.15522276791480569,0.7622707379732625,0.019410836966870262,-0.016736492334640529,0.033030494179800599,1.4941428043291753,-0.086120126809271405,-9.7147142337087686],"FOG":[0.76545011242876648],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-26.071625988631212,14.445619360606464,-48.311409229046937,52.575062780645034,52.575062780645034],"omega_rad_s":[-25.78863040686246,14.65568237949247,-49.14327997738642,52.472620274455757,52.473752692807331],"thrust_n":[-8.6931412870561413,2.354360805318545,-31.395130946282805,34.363911411390802,33.521549385011134],"torque_nm":[0.16299639913230268,-0.044144265099722718,0.58865870524280262,-0.64432333896357763,-0.62852905096895895],"angle_rad":[-505.27637234999526,734.33727150864479,-199.71215412858788,1126.0810903321326,1126.0822307443909]},"command":[-0.24830119989172583,0.13757732724387109,-0.46010865932425654,0.50071488362519079,0.50071488362519079],"arm":{"servo_position":[-5.3475572240328153e-22,3.2526065174565154e-21,1.0778494253810975e-21,0,-5.9122899718350197e-21,-4.9127910940749275e-21],"servo_velocity":[0,8.6736173798840355e-19,0,0,0,0],"servo_effort":[0.4840689335875849,-1.6526338136370826,-0.35669227999098657,0.00092753166744338864,-0.00058233194248359199,0.0001339164982021959]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":359,"step":2872,"t":14.359999999999999,"sim_time":14.360000000000845,"vehicle":{"origin_ned":[1.6391327061401815,1.1206619316849966,3.6404386791525827],"origin_quat_xyzw":[-0.024430397465090816,0.073041410888993144,0.37172861029271081,0.92514104236321326],"cg_ned":[1.5678955037166895,1.0564733704358928,3.3514732467443764],"linear_velocity_ned":[0.045360543953186158,0.017625608465559921,0.03993286347310538],"angular_velocity_ned":[0.017378664400410367,-0.028311059292809276,0.064917738510765793]},"sensors":{"Odom":[1.6391327061401815,1.1206619316849966,3.6404386791525827,0.028722764244546166,-0.0099856443167966082,0.048130547612842342,-0.02443039746509083,0.073041410888993186,0.37172861029271104,0.92514104236321326,-0.016933547121260953,-0.031877460080631526,0.063363470143884937],"Pressure":[28024.021101691007],"DVL":[0.041717735454205047,0.019749220326255812,-0.043078891553648149,7.0907787811806866,-0.024991746216821573,-0.0078656004813974275,-0.022005116461907778,0],"IMU":[0.0092090343209237681,0.15391717904778679,0.7648373133166787,-0.0078117930191659302,-0.021860020113212093,0.038999969377513211,1.4521352999703967,-0.064754527651414623,-9.7280707450529569],"FOG":[0.7633649105040009],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-26.120651901868694,13.430075985251865,-48.164583139449789,52.311542431803026,52.311542431803026],"omega_rad_s":[-25.8473908557262,13.715075641626688,-48.980488269150904,52.201198258403949,52.202282424345164],"thrust_n":[-8.7269413202034674,2.0497805630992447,-31.158186261856748,34.050844208195358,33.222579585657257],"torque_nm":[0.16363014975381507,-0.038433385558110843,0.58421599240981403,-0.63845332890366324,-0.62292336723107378],"angle_rad":[-506.30926129086055,734.90213885955313,-201.67417709153648,1128.1737905519242,1128.1749751758698]},"command":[-0.24876811335113042,0.12790548557382728,-0.45871031561380754,0.49820516601717169,0.49820516601717169],"arm":{"servo_position":[-5.3475572240328153e-22,-1.0842021724855024e-21,1.0778494253810975e-21,0,-5.9122899718350197e-21,-4.9127910940749275e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.4766269602627492,-1.6344672233676103,-0.35407457555793187,0.00091342058630147327,-0.00058115257455025723,0.00014854816464732835]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":360,"step":2880,"t":14.4,"sim_time":14.400000000000851,"vehicle":{"origin_ned":[1.6404193563408285,1.1213283174195574,3.6421196928993851],"origin_quat_xyzw":[-0.024409003582795692,0.072363509053969391,0.37293228611893336,0.92471035090540488],"cg_ned":[1.5696703154892298,1.0571586305092051,3.3530301634597612],"linear_velocity_ned":[0.043603145748267291,0.016748645679306319,0.038136657692792383],"angular_velocity_ned":[0.017519485336728483,-0.027608732240436695,0.06405703425606657]},"sensors":{"Odom":[1.6404193563408285,1.1213283174195574,3.6421196928993851,0.02727706859027567,-0.0097949052901359947,0.045984157878754754,-0.024409003582795706,0.072363509053969419,0.37293228611893353,0.92471035090540488,-0.016220613131638962,-0.031475824705879063,0.062599059647804101],"Pressure":[28048.458610329268],"DVL":[0.062034913749681279,0.042801900769257994,-0.06397742839959264,7.1752254452391284,-0.02495512761533198,-0.0018363693768918524,-0.0044395849794642709,0],"IMU":[0.0089348472005460061,0.15262828215912111,0.76737279156040317,0.01069731583121716,-0.071367248873583644,0.050787671836725376,1.4553365068159472,-0.071268018939130637,-9.7805999781092492],"FOG":[0.77182602707330616],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-26.166910355316642,12.352289251690108,-48.016933089403992,52.052865132292894,52.052865132292894],"omega_rad_s":[-25.904078542825864,12.729437262376445,-48.817199302271511,51.934093974389263,51.935129784186699],"thrust_n":[-8.759379126813581,1.7525402295895107,-30.922040363453998,33.744327478299375,32.930555259909177],"torque_nm":[0.16423835862775468,-0.032860129304803323,0.57978825681476254,-0.63270614021811333,-0.61744791112329689],"angle_rad":[-507.34445441013997,735.42837843768621,-203.62967694354603,1130.2557315701802,1130.2569584729458]},"command":[-0.24920867005063468,0.11764085001609627,-0.45730412466099041,0.49574157268850372,0.49574157268850372],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-5.9122899718350197e-21,-4.9127910940749275e-21],"servo_velocity":[1.0842021724855044e-19,0,4.3368086899420177e-19,0,0,0],"servo_effort":[0.4691586724523929,-1.6166045350868428,-0.35143156831726852,0.0008991496358152607,-0.00057970942634222962,0.00016227177428845184]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":361,"step":2888,"t":14.44,"sim_time":14.440000000000857,"vehicle":{"origin_ned":[1.6416467248601831,1.1219546972185641,3.6437266762346736],"origin_quat_xyzw":[-0.024378584389976334,0.071698027799689076,0.37411990707848081,0.92428316687061041],"cg_ned":[1.5713755168329695,1.0578091536236063,3.3545152689725803],"linear_velocity_ned":[0.041876224657057821,0.015886856801017601,0.036342166531391724],"angular_velocity_ned":[0.017644353787168394,-0.02689261759106186,0.063205601126038277]},"sensors":{"Odom":[1.6416467248601831,1.1219546972185641,3.6437266762346736,0.025866224343793359,-0.0096000902144604376,0.043849178761827444,-0.024378584389976338,0.07169802779968909,0.37411990707848092,0.92428316687061041,-0.015510907335232015,-0.031054400039518908,0.061842704557555375],"Pressure":[28068.319335758944],"DVL":[0.055627392949990417,0.020957571055989839,-0.035754475208646476,7.1170270429592515,-0.01393976574689625,-0.010112017832820449,-0.035785032630687615,0],"IMU":[0.0086812455814345608,0.15135682906201431,0.76987751266909799,-0.0056107262068435682,-0.042134614413236252,0.087515398090103752,1.4438892340914244,-0.082141566488647705,-9.7199858052835086],"FOG":[0.77491267137456876],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-26.210578913587216,11.195545932739334,-47.868885681967029,51.799316551293728,51.799316551293728],"omega_rad_s":[-25.958421720604193,11.687944824186818,-48.653509439798988,51.671621141763971,51.672608619948299],"thrust_n":[-8.7902716970426891,1.4630008363943712,-30.686824200691117,33.444715865992798,32.645773703461522],"torque_nm":[0.16481759431955043,-0.027431265682394457,0.57537795376295853,-0.62708842248736496,-0.61210825693990356],"angle_rad":[-508.38186201267473,735.91395000007435,-205.5786355377698,1132.3270932674623,1132.3283605149438]},"command":[-0.24962456108178302,0.10662424697846985,-0.45589414935206696,0.49332682429803548,0.49332682429803548],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,-1.0905549195899114e-21,0,-5.9122899718350197e-21,-4.9127910940749275e-21],"servo_velocity":[2.1684043449710089e-19,0,0,0,0,0],"servo_effort":[0.46171161685451223,-1.599042649905065,-0.34876905976535511,0.0008848915938835276,-0.00057802765703222968,0.00017515768093177508]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":362,"step":2896,"t":14.48,"sim_time":14.480000000000864,"vehicle":{"origin_ned":[1.6428161659582541,1.1225419502913228,3.6452596676790141],"origin_quat_xyzw":[-0.024339361119126598,0.071045303014882127,0.37529165554971128,0.92385947724456075],"cg_ned":[1.573012326033115,1.0584255446496647,3.3559286427430131],"linear_velocity_ned":[0.040179757481016702,0.015040160952032058,0.03454988669762267],"angular_velocity_ned":[0.017752713197413603,-0.026165772660174749,0.062363869377999051]},"sensors":{"Odom":[1.6428161659582541,1.1225419502913228,3.6452596676790141,0.024489571657155443,-0.009401081134082433,0.041725964197914495,-0.024339361119126612,0.071045303014882155,0.37529165554971144,0.92385947724456075,-0.014806872568742758,-0.030614985268026192,0.061094499673385136],"Pressure":[28088.994521084329],"DVL":[0.050701239737487004,-0.0062823205756175025,0.0061726073764103995,7.1361381674895386,0.016955273980321199,0.028768725393844116,0.0046086282950153577,0],"IMU":[0.0084482143138017701,0.15010350180761137,0.77235179861359571,-0.020231533413781595,0.067077783382119449,0.15881013292449658,1.4318040469337898,-0.062864246067054305,-9.764061680793974],"FOG":[0.76214701538931273],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-26.251520470592091,9.9323383971394321,-47.720545315195032,51.551204755063679,51.551204755063679],"omega_rad_s":[-26.010236588641284,10.574966693485939,-48.489561537324946,51.414093569627305,51.415032861355535],"thrust_n":[-8.8194964348012697,1.181666324893651,-30.452716664464639,33.152358151592345,32.368528064646696],"torque_nm":[0.16536555815252379,-0.022156243591755952,0.57098843745871197,-0.62160671534235656,-0.60690990121212551],"angle_rad":[-509.42138622732961,736.3562796727399,-207.52104027823711,1134.3880680515365,1134.3893737133487]},"command":[-0.25001448067230564,0.094593699020375538,-0.45448138395423843,0.49096385481013027,0.49096385481013027],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-5.9122899718350197e-21,-4.9127910940749275e-21],"servo_velocity":[-1.0842021724855044e-19,0,-4.3368086899420177e-19,0,0,0],"servo_effort":[0.45465490360734406,-1.5818008869508757,-0.34609339740020956,0.00087072885409730533,-0.00057612157027172857,0.00018726964410547116]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":363,"step":2904,"t":14.52,"sim_time":14.52000000000087,"vehicle":{"origin_ned":[1.6439289974479034,1.1230909605445081,3.6467187346550767],"origin_quat_xyzw":[-0.024291586791682071,0.070405618704535183,0.37644772003680504,0.92343926803286036],"cg_ned":[1.5745819622658195,1.0590084069138059,3.3572703859590787],"linear_velocity_ned":[0.038513792373945921,0.014208542506516774,0.032760386630758476],"angular_velocity_ned":[0.017844079571081861,-0.025431194439874034,0.061532318354619225]},"sensors":{"Odom":[1.6439289974479034,1.1230909605445081,3.6467187346550767,0.023146547210225646,-0.0091977733225206571,0.039614948240449831,-0.024291586791682081,0.070405618704535211,0.37644772003680521,0.92343926803286036,-0.014110880444542782,-0.030159367997468951,0.060354607144318818],"Pressure":[28111.484899035335],"DVL":[0.025243832921170106,0.061313584221771592,-0.031100384163394581,7.13619325598322,-0.0020949935601057407,-0.023353502315114971,0.049818356623175408,0],"IMU":[0.0082356416308762993,0.14886891292316429,0.77479597627510277,-0.091777650470455427,-0.083080567612614467,0.04936611068739645,1.3991173296913113,-0.063265561567602477,-9.7869958275191458],"FOG":[0.76419744241726639],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-26.289462173224539,8.5144620423003428,-47.571893467877814,51.308800498498698,51.308800498498698],"omega_rad_s":[-26.059306906196944,9.3654148100859089,-48.325442431976583,51.1618180560016,51.162709420146548],"thrust_n":[-8.8469087320790187,0.90906435708079747,-30.219825257563421,32.867586135738918,32.099096318964634],"torque_nm":[0.16587953872648159,-0.017044956695264953,0.56662172357931428,-0.6162672400451048,-0.60185805598058706],"angle_rad":[-510.46292104982518,736.75196805533756,-209.45688293153634,1136.4388607675926,1136.4402029217358]},"command":[-0.25037583022118609,0.081090114688574688,-0.4530656520750268,0.48865524284284473,0.48865524284284473],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,-1.0905549195899114e-21,0,-5.9122899718350197e-21,-4.9127910940749275e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.44799685080950158,-1.5648941814661672,-0.34340901848538913,0.00085637483176963854,-0.00057400139683983452,0.00019862099872350309]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":364,"step":2912,"t":14.56,"sim_time":14.560000000000876,"vehicle":{"origin_ned":[1.6449865025628112,1.1236026168628337,3.6481039745696009],"origin_quat_xyzw":[-0.024235544604308063,0.069779207511781835,0.37758829627711582,0.92302252360996317],"cg_ned":[1.5760856469930304,1.0595583433630384,3.3585406228400481],"linear_velocity_ned":[0.036878392935045703,0.01339199651497951,0.030974247415707534],"angular_velocity_ned":[0.017918049586223637,-0.024691829838829674,0.060711487258906925]},"sensors":{"Odom":[1.6449865025628112,1.1236026168628337,3.6481039745696009,0.021836611059836072,-0.0089900746139558278,0.037516576410676745,-0.024235544604308087,0.069779207511781904,0.37758829627711615,0.92302252360996317,-0.013425233705674264,-0.02968933842888315,0.059623266688062136],"Pressure":[28131.279675680595],"DVL":[0.027310305203646721,-0.032482609571260319,0.0012638495257406256,7.1490359929382699,-0.017748474703399072,0.0086039587238218845,0.042453729558052808,0],"IMU":[0.0080433222772886039,0.14765360570851765,0.77721038060265091,2.4076974946801721e-05,-0.07182629570263982,0.1894890217200445,1.3944954702322347,-0.075010390301381069,-9.7758809655667172],"FOG":[0.75676002046126001],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-26.324144606133938,6.845055544223718,-47.422903057984406,51.072355672493309,51.072355672493309],"omega_rad_s":[-26.105398794134437,8.0140731815288344,-48.161200942677247,50.915087148767284,50.915930951445418],"thrust_n":[-8.8723516937219955,0.64567263940050279,-29.988208963800254,32.590707497703285,31.837733933074688],"torque_nm":[0.16635659425728747,-0.01210636198875943,0.56227891807125485,-0.61107576558193666,-0.59695751124515051],"angle_rad":[-511.50635139341034,737.09619539588334,-211.38615785123108,1138.4796882051585,1138.4810649424228]},"command":[-0.25070613910603751,0.065191005183083031,-0.45164669579032768,0.48640338735707916,0.48640338735707916],"arm":{"servo_position":[-5.3475572240328153e-22,-1.0842021724855024e-21,-1.0905549195899114e-21,0,2.7613274080490159e-21,3.7608262858091081e-21],"servo_velocity":[-1.0842021724855044e-19,0,-4.3368086899420177e-19,0,0,0],"servo_effort":[0.44175178532330406,-1.5483367506139041,-0.34072204717987425,0.00084222086676643019,-0.00032595368117710629,0.00020989545012034557]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":365,"step":2920,"t":14.6,"sim_time":14.600000000000882,"vehicle":{"origin_ned":[1.6459899337696582,1.1240778155496194,3.6494155145831204],"origin_quat_xyzw":[-0.024171549515193198,0.069166258231201649,0.378713587268105,0.92260922591032679],"cg_ned":[1.5775246041509614,1.0600759567107862,3.3597395020508531],"linear_velocity_ned":[0.035273613258299384,0.01259051161100129,0.029192111481097523],"angular_velocity_ned":[0.0179737063818604,-0.023950015011899358,0.059901861218211568]},"sensors":{"Odom":[1.6459899337696582,1.1240778155496194,3.6494155145831204,0.020559453314339698,-0.008777901565239235,0.035431309839437194,-0.024171549515193222,0.069166258231201719,0.37871358726810539,0.92260922591032679,-0.012752178106412611,-0.029205875104959863,0.058900671731935542],"Pressure":[28150.218768752955],"DVL":[0.012508827596173569,0.053743209450395395,-0.019837574812569026,7.1286004216697325,-0.017092506442896366,0.030567982805904271,0.035219484370514267,0],"IMU":[0.0078709598974298182,0.14645806990164167,0.77959535585932171,-0.03976363364772284,0.0038499411342178581,0.045571709155112383,1.3819242243687382,-0.056119647637252405,-9.7213810487830088],"FOG":[0.77812177298199736],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-26.355316399605371,4.6587168556385139,-47.27356278308401,50.842110837700353,50.842110837700353],"omega_rad_s":[-26.148269634486596,6.4177358286998993,-47.996860220868946,50.674179949333855,50.674976654325469],"thrust_n":[-8.8956621934097111,0.39102137492802169,-29.757893013267594,32.321999511499648,31.584684597315317],"torque_nm":[0.16679366612643209,-0.0073316507799004085,0.55796049399876746,-0.60603749084061853,-0.59221283619966214],"angle_rad":[-512.55155260063736,737.38118747415479,-213.30886067987655,1140.51077854856,1140.5121879766307]},"command":[-0.25100301332957498,0.04436873195846204,-0.45022440745794295,0.48421057940667001,0.48421057940667001],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,2.7613274080490159e-21,-4.9127910940749275e-21],"servo_velocity":[1.0842021724855044e-19,0,0,0,0,-1.7347234759768071e-18],"servo_effort":[0.43588053909151164,-1.5319295222397404,-0.33799314198356667,0.0008279806839230217,-0.00034200227602407035,0.00021983542250110752]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":366,"step":2928,"t":14.640000000000001,"sim_time":14.640000000000889,"vehicle":{"origin_ned":[1.6469405092299545,1.1245174551395474,3.6506535128667714],"origin_quat_xyzw":[-0.024099949577711239,0.068566922954016216,0.37982379727605958,0.92219935617509752],"cg_ned":[1.5789000524842709,1.0605618428144801,3.3608671994750217],"linear_velocity_ned":[0.033698919847802059,0.011803568778435634,0.027414733868594041],"angular_velocity_ned":[0.018010295297871681,-0.023208199807241155,0.059102999553720947]},"sensors":{"Odom":[1.6469405092299545,1.1245174551395474,3.6506535128667714,0.019313931097503456,-0.0085612013260716897,0.033359616796272432,-0.024099949577711256,0.068566922954016271,0.37982379727605986,0.92219935617509752,-0.012093797972994957,-0.028710142649598366,0.058186111666656395],"Pressure":[28165.620584084922],"DVL":[0.028769209468841567,0.0038721535073308472,0.019431141337366779,7.1639570199042932,-0.034061107404472948,-0.0039679593304680523,0.0176826479553189,0],"IMU":[0.0077181687699092987,0.14528275647416852,0.78195124367725821,0.024212187693201971,-0.064556821966770137,0.028296968059911689,1.3658701409862164,-0.049728968584027484,-9.7854052838889274],"FOG":[0.78484177357264118],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-26.382735180294279,-1.7267069917026281,-47.123920935274839,50.61829403031993,50.61829403031993],"omega_rad_s":[-26.187673736611686,3.7315344557646331,-47.832450983475297,50.439362069013413,50.440112221023028],"thrust_n":[-8.9166745951514166,0.10211539788427682,-29.528903381963236,32.061718487156433,31.340171625421799],"torque_nm":[0.16718764865908908,-0.0019146637103301903,0.55366693841181081,-0.60115722163418328,-0.58762821797665865],"angle_rad":[-513.59839022511778,737.58373823757563,-215.22498817495628,1142.5323708368803,1142.53381108385]},"command":[-0.25126414457423124,-0.016444828492405982,-0.44879924700261753,0.4820789907649517,0.4820789907649517],"arm":{"servo_position":[-5.3475572240328153e-22,-1.0842021724855024e-21,-1.0905549195899114e-21,0,2.7613274080490159e-21,3.7608262858091081e-21],"servo_velocity":[-1.0842021724855044e-19,0,-4.3368086899420177e-19,0,0,0],"servo_effort":[0.42969548923347306,-1.5157646079292837,-0.3352961522011666,0.00081369557442710291,-0.00035763516245706709,0.00022926773573254809]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":367,"step":2936,"t":14.68,"sim_time":14.680000000000895,"vehicle":{"origin_ned":[1.6478394044465861,1.1249224266007147,3.6518181603975441],"origin_quat_xyzw":[-0.024021120233369605,0.067981307587375944,0.38091913123824367,0.9217928959685826],"cg_ned":[1.5802132009535097,1.0610165863207541,3.3619239181117715],"linear_velocity_ned":[0.032155845474198204,0.011032394083848139,0.025642386367069434],"angular_velocity_ned":[0.018028393136084526,-0.022469774399915186,0.058318216798923815]},"sensors":{"Odom":[1.6478394044465861,1.1249224266007147,3.6518181603975441,0.018101176955396342,-0.0083398551205555779,0.031301957703568972,-0.024021120233369619,0.067981307587375986,0.38091913123824389,0.9217928959685826,-0.011452453212353171,-0.028204867240308573,0.057482648778862069],"Pressure":[28183.089768988513],"DVL":[0.02391014200469177,0.037450307644423191,-0.022131958322228147,7.1364067529725874,-0.027536317427710962,-0.019104829520346304,-0.016912457899959116,0],"IMU":[0.0075844767488454463,0.14412805613365337,0.78427838159395635,0.01042314734327604,0.019827036788546852,0.12279384109309534,1.3777911862089658,-0.038406343724709649,-9.7340487344531255],"FOG":[0.78734160367542438],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-26.406190731175126,-5.2096466729320676,-46.973985238600505,50.401122785792943,50.401122785792943],"omega_rad_s":[-26.223373242059104,0.21375790678653567,-47.667996943297197,50.210886374136507,50.211590590533802],"thrust_n":[-8.935229084341179,-0.0035964106765618287,-29.301275754866875,31.810113624145547,31.104386871235306],"torque_nm":[0.16753554533139711,6.7432700185534296e-05,0.54939892040375393,-0.59643963045272907,-0.58320725383566208],"angle_rad":[-514.64672015392694,737.65201164781138,-217.13453818646477,1144.5447144421203,1144.5461836595023]},"command":[-0.25148753077309643,-0.049615682599353027,-0.44737128798667147,0.48001069319802803,0.48001069319802803],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.5754812818930019e-21,3.7608262858091081e-21],"servo_velocity":[2.1684043449710089e-19,0,0,0,0,0],"servo_effort":[0.42692230695117428,-1.5004806912030453,-0.3325093225727675,0.00079968206948616987,-0.00056308365363080793,0.00023773240075007439]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":368,"step":2944,"t":14.720000000000001,"sim_time":14.720000000000901,"vehicle":{"origin_ned":[1.648687930736622,1.1252938285599892,3.6529096416493614],"origin_quat_xyzw":[-0.023935520229642539,0.067409503552349009,0.3819999498335454,0.92138975902130082],"cg_ned":[1.5814654398156924,1.0614409211680267,3.3629098580922077],"linear_velocity_ned":[0.030648404329852452,0.010280229359654381,0.023875519326523403],"angular_velocity_ned":[0.018018315371997332,-0.021733272531306049,0.057555484952769513]},"sensors":{"Odom":[1.648687930736622,1.1252938285599892,3.6529096416493614,0.016928664820433398,-0.0081125507823131202,0.029258877314669463,-0.023935520229642557,0.067409503552349065,0.38199994983354568,0.92138975902130082,-0.010834961779062662,-0.027682041558516585,0.056797331366113243],"Pressure":[28197.70552287301],"DVL":[0.045595957890361735,-0.0040328782830968361,-0.020668966809804221,7.1381617871424003,0.016763776316224176,-0.013329141241041944,-0.023160010132269419,0],"IMU":[0.007469269797308796,0.14299440013214368,0.78657743929022605,-0.021690356295074549,0.024279239838800724,0.23319382493280522,1.3598581039342492,-0.031906063569872738,-9.7895520782673522],"FOG":[0.77078287831197834],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-26.42503526659106,-7.1618903389836639,-46.823366179271865,50.190810653656008,50.190810653656008],"omega_rad_s":[-26.255045646790897,-2.8818992672332966,-47.503395380978198,49.988995535176066,49.989654496346617],"thrust_n":[-8.9511157516100184,-0.16036189840580933,-29.07495888718454,31.567329734418124,30.877602445523664],"torque_nm":[0.16783342034268786,0.0030067855951089258,0.54515547913471019,-0.59188743252033993,-0.57895504585356894],"angle_rad":[-515.69638750228341,737.58874882656016,-219.03750671218805,1146.5480686175563,1146.5495649832887]},"command":[-0.25166700253896246,-0.068208479418892035,-0.44593682075497015,0.47800772051100959,0.47800772051100959],"arm":{"servo_position":[-5.3475572240328153e-22,-1.0842021724855024e-21,1.0778494253810975e-21,-2.1684043449710089e-21,-1.5754812818930019e-21,3.7608262858091081e-21],"servo_velocity":[-2.1684043449710089e-19,0,0,-4.3368086899420177e-19,0,0],"servo_effort":[0.42392162679662471,-1.4820027701463032,-0.32903263537279248,0.00078563565441961932,-0.00055853919921360095,0.00024492323802724134]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":369,"step":2952,"t":14.76,"sim_time":14.760000000000908,"vehicle":{"origin_ned":[1.6494873565068791,1.1256328124797179,3.6539281734206637],"origin_quat_xyzw":[-0.023843819981552532,0.066851786995948126,0.38306651742349734,0.92098987728051007],"cg_ned":[1.5826580577183076,1.0618354897693791,3.3638252986165043],"linear_velocity_ned":[0.029170240250289456,0.0095416362435946731,0.022116709304261628],"angular_velocity_ned":[0.017968618687265327,-0.020995157749521872,0.056802678046841387]},"sensors":{"Odom":[1.6494873565068791,1.1256328124797179,3.6539281734206637,0.015791002730964076,-0.0078787102540096438,0.027230969281075469,-0.023843819981552543,0.066851786995948154,0.38306651742349751,0.92098987728051007,-0.010244992422387338,-0.027131064035301088,0.056117355909971252],"Pressure":[28214.455139136666],"DVL":[0.04601808612517172,-0.0015861968679314869,-0.01195687944956385,7.0886001011130073,-0.0033615551730844339,0.0012277131913931102,0.011870548177221092,0],"IMU":[0.007371668945738985,0.14188273078732422,0.78884887903220824,-0.00078870817582205738,0.016722650341074608,0.04049289237168173,1.3338263399420489,-0.030132603573004509,-9.7688052325924062],"FOG":[0.78576457333452654],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-26.437909183810575,-8.7004932983989747,-46.670872308613568,49.987508243381953,49.987508243381953],"omega_rad_s":[-26.282024873853441,-5.5120306598707041,-47.33829663626225,49.773908254367925,49.774522494334285],"thrust_n":[-8.9638855783695561,-0.48800557006672257,-28.849399558792928,31.333396932722835,30.660145914277919],"torque_nm":[0.16807285459442922,0.0091501044387510503,0.54092624172736747,-0.58750119248855337,-0.57487773589271107],"angle_rad":[-516.74721647452009,737.41237673484284,-220.93388144942685,1148.5427018187629,1148.5442235353687]},"command":[-0.25178961127438643,-0.082861840937133086,-0.44448449817727209,0.47607150707982815,0.47607150707982815],"arm":{"servo_position":[5.4944645008222292e-22,-1.0842021724855024e-21,-1.0905549195899114e-21,0,-1.5754812818930019e-21,3.7608262858091081e-21],"servo_velocity":[2.1684043449710089e-19,0,-4.3368086899420177e-19,0,-8.6736173798840355e-19,0],"servo_effort":[0.41758403587244097,-1.4627127116504068,-0.32550602177906762,0.00077127960797517339,-0.00039835111132397106,0.00025158934989042233]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":370,"step":2960,"t":14.800000000000001,"sim_time":14.800000000000914,"vehicle":{"origin_ned":[1.6502387516638708,1.1259403718492746,3.6548740390577361],"origin_quat_xyzw":[-0.02374677317375478,0.066308467626655515,0.38411882685755078,0.92059328953583941],"cg_ned":[1.5837921191996904,1.0622007548355321,3.3646705969893684],"linear_velocity_ned":[0.027716998333272784,0.0088134005548405839,0.02036742021253235],"angular_velocity_ned":[0.017876788597675039,-0.020258725240601134,0.056045023900489745]},"sensors":{"Odom":[1.6502387516638708,1.1259403718492746,3.6548740390577361,0.014682595021766904,-0.0076381789522053187,0.02521874605060689,-0.023746773173754784,0.066308467626655529,0.38411882685755089,0.92059328953583941,-0.0096843907482704154,-0.026552459524674315,0.055427607669571582],"Pressure":[28228.082682724271],"DVL":[0.014152745508973871,0.015826351321468719,-0.02650125155088533,7.1645355979457026,-0.0066613245288224959,0.043460643239713076,-0.013407988586950376,0],"IMU":[0.0072906271835459545,0.14079412514148881,0.79109256938606209,0.038526552032596792,0.085790497366107402,-0.030661199787069299,1.3200482965411522,-0.063869897222922481,-9.7649391889204828],"FOG":[0.78159413551546031],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-26.444541268799089,-9.9921163951208758,-46.517715930259442,49.79138008811578,49.79138008811578],"omega_rad_s":[-26.30370592394938,-7.7334935775154117,-47.172528101792004,49.565824701291746,49.566394569131681],"thrust_n":[-8.9731264989990667,-0.89875814329057946,-28.624346976083164,31.108465626214659,30.452167117227265],"torque_nm":[0.16824612185623253,0.016851715186698368,0.53670650580155943,-0.58328373049152482,-0.57097813344801129],"angle_rad":[-517.79900523102538,737.14028227930544,-222.82363570918352,1150.5288907821539,1150.5304360691123]},"command":[-0.25185277398856276,-0.09516301328686548,-0.44302586600247085,0.47420361988681692,0.47420361988681692],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,-1.0905549195899114e-21,0,-1.5754812818930019e-21,-5.759824041329097e-22],"servo_velocity":[1.0842021724855044e-19,0,-4.3368086899420177e-19,0,0,0],"servo_effort":[0.40752439442142696,-1.4436433839495528,-0.32205175822844795,0.00075633347289529192,-0.00055024578484788795,0.00025726154028171542]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":371,"step":2968,"t":14.84,"sim_time":14.84000000000092,"vehicle":{"origin_ned":[1.6509430556914686,1.1262173974943894,3.6557475732289162],"origin_quat_xyzw":[-0.023645162193223844,0.065779811923608988,0.3851566907822157,0.92020011203750862],"cg_ned":[1.5848685712601371,1.0625370909554979,3.3654461564265459],"linear_velocity_ned":[0.026286736012004406,0.0080939349733260054,0.018628587814548611],"angular_velocity_ned":[0.017743236062153288,-0.019526605998463488,0.055277682096628922]},"sensors":{"Odom":[1.6509430556914686,1.1262173974943894,3.6557475732289162,0.01360031393122031,-0.0073911156783363777,0.023222697225981213,-0.023645162193223851,0.065779811923609002,0.38515669078221582,0.92020011203750862,-0.0091539424789391644,-0.025948265694370698,0.054723173795925929],"Pressure":[28242.716621693053],"DVL":[0.018472839834060749,0.0040646696337699861,-0.030851003448192027,7.1318069091050038,0.030240177633730065,0.019163710426813856,0.0047333916141710829,0],"IMU":[0.0072249867613127933,0.13972961041130078,0.79330798075528497,0.069496016381029257,0.035812227861953427,0.034114355248715394,1.327433183943312,-0.046458488003519316,-9.7268030539408432],"FOG":[0.80165237136140577],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-26.444630196860434,-11.103697237767616,-46.36608112076366,49.602589540217579,49.602589540217579],"omega_rad_s":[-26.319571972601153,-9.6118956481251718,-47.006811924578912,49.364934587764147,49.36546032699566],"thrust_n":[-8.9784877128050287,-1.3411002647644963,-28.400654634795263,30.892698077433643,30.253777034853066],"torque_nm":[0.1683466446150943,0.02514562996433431,0.53251227440241122,-0.57923808895188089,-0.56725831940349503],"angle_rad":[-518.85152973402705,736.78731430007144,-224.70675850072669,1152.5069200095602,1152.5084870976793]},"command":[-0.25185362092248031,-0.10574949750254872,-0.44158172495965392,0.47240561466873882,0.47240561466873882],"arm":{"servo_position":[-5.3475572240328153e-22,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.5754812818930019e-21,-5.759824041329097e-22],"servo_velocity":[-1.0842021724855044e-19,-8.6736173798840355e-19,0,0,0,0],"servo_effort":[0.3968473364953094,-1.4249888251102674,-0.31865643584309844,0.00074108990678109347,-0.00054621639335516081,0.00026309572487724474]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":372,"step":2976,"t":14.880000000000001,"sim_time":14.880000000000926,"vehicle":{"origin_ned":[1.6516011382928029,1.1264647197364914,3.6565491500210059],"origin_quat_xyzw":[-0.023539760110627635,0.065266030996862207,0.38617988413396204,0.9198104815570054],"cg_ned":[1.5858883170067513,1.0628448343184376,3.366152409630832],"linear_velocity_ned":[0.024878877741981071,0.0073827113226554086,0.016900818439319037],"angular_velocity_ned":[0.017569900170580976,-0.018801428872659082,0.05449958192192015]},"sensors":{"Odom":[1.6516011382928029,1.1264647197364914,3.6565491500210059,0.012542471627823844,-0.0071378359192770732,0.021243286391845962,-0.023539760110627653,0.065266030996862248,0.38617988413396231,0.9198104815570054,-0.0086539256922532545,-0.025321571384516944,0.054003029008137117],"Pressure":[28256.014062361781],"DVL":[0.031002681361584832,-0.0091692245825374837,-0.022568123611832407,7.0776612169335058,0.025492538841659727,0.015936221792084617,-0.0077831046278306797,0],"IMU":[0.0071735623739697879,0.13869011120776567,0.79549449886427204,0.0035392889567590329,-0.049379887666971267,-0.049611700829794166,1.3241247587668454,-0.050759956527058156,-9.7769113249670614],"FOG":[0.78736075583282816],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-26.438173085841459,-12.08008109979315,-46.216099824621857,49.421294918763792,49.421294918763792],"omega_rad_s":[-26.329260008703063,-11.208481740555015,-46.841774883688544,49.171418595134092,49.17190041817819],"thrust_n":[-8.9797247971663605,-1.7848620826113462,-28.179061088045096,30.686258598344207,30.065063252641536],"torque_nm":[0.16836983994686924,0.033466164048962743,0.52835739540084548,-0.5753673487189539,-0.56371993598702885],"angle_rad":[-519.90454873795056,736.36577715949306,-226.58326671967541,1154.4770813810578,1154.4786685099607]},"command":[-0.25179212462706152,-0.11504839142660142,-0.44015333166306531,0.47067899922632184,0.47067899922632184],"arm":{"servo_position":[7.3453638394706939e-24,3.2526065174565154e-21,-1.0905549195899114e-21,-2.1684043449710089e-21,-1.5754812818930019e-21,-5.759824041329097e-22],"servo_velocity":[0,8.6736173798840355e-19,-4.3368086899420177e-19,-4.3368086899420177e-19,0,0],"servo_effort":[0.38594062453949368,-1.406959227978948,-0.31533684099484244,0.00071949411777986387,-0.00054217126821283024,0.00026822074949509799]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":373,"step":2984,"t":14.92,"sim_time":14.920000000000933,"vehicle":{"origin_ned":[1.6522138319780948,1.1266831350244293,3.6572791754188443],"origin_quat_xyzw":[-0.023431317623842731,0.064767269303858191,0.38718817900453789,0.91942454188502165],"cg_ned":[1.586852254886852,1.0631243153162484,3.3667898086450059],"linear_velocity_ned":[0.023493609956281719,0.0066798305675475084,0.015184515848978323],"angular_velocity_ned":[0.017359364830046128,-0.018086048821594598,0.053711050275633429]},"sensors":{"Odom":[1.6522138319780948,1.1266831350244293,3.6572791754188443,0.011508207222052411,-0.0068786924361543727,0.019280944022863421,-0.023431317623842738,0.064767269303858205,0.387188179004538,0.91942454188502165,-0.0081845491564073551,-0.024676073306764072,0.053267571675991832],"Pressure":[28268.554954492552],"DVL":[0.036083342354894549,0.043563084641412314,0.031466253812010646,7.0747519783867263,0.0019414956918957114,-0.0082711943561265319,0.057247868477447776,0],"IMU":[0.0071351611625087661,0.13767641827426361,0.79765150092570525,0.0174765575886149,-0.02207840654518739,0.16397195115055063,1.2992259280219096,-0.050457595679826314,-9.7651864726038262],"FOG":[0.77591889986256646],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-26.425236243021708,-12.950148830141194,-46.067858679370339,49.247657375007726,49.247657375007726],"omega_rad_s":[-26.332543652831362,-12.570946375480824,-46.677872835439388,48.985451448452025,48.985889598396689],"thrust_n":[-8.9766888009766355,-2.2121899181248157,-27.960104931091848,30.489312395961843,29.886100609891809],"torque_nm":[0.16831291501831197,0.041478560964840289,0.52425196745797209,-0.57167460742428478,-0.56036438643547137],"angle_rad":[-520.95780965254585,735.88581730820022,-228.45319832529248,1156.4396738564817,1156.4412792747987]},"command":[-0.25166891660020674,-0.12333475076324946,-0.43874151123209848,0.46902530833340689,0.46902530833340689],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.5754812818930019e-21,-5.759824041329097e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.37524275332862661,-1.3897209314105998,-0.31211509893464451,0.00068593935045630264,-0.00053810985282425397,0.00027259579859311578]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":374,"step":2992,"t":14.960000000000001,"sim_time":14.960000000000939,"vehicle":{"origin_ned":[1.6527819470958565,1.1268734212126696,3.6579380837761639],"origin_quat_xyzw":[-0.023320557596325665,0.06428359334198297,0.38818136751505111,0.91904243489328807],"cg_ned":[1.5877613008169824,1.0633758770889707,3.3673588192390098],"linear_velocity_ned":[0.022131504270859519,0.0059857445237056096,0.013479985593158694],"angular_velocity_ned":[0.017114735988458949,-0.017383728067801751,0.052913173096515144]},"sensors":{"Odom":[1.6527819470958565,1.1268734212126696,3.6579380837761639,0.010496997662026603,-0.0066140061283097313,0.017336104985357283,-0.023320557596325679,0.064283593341983011,0.38818136751505139,0.91904243489328807,-0.0077460775235565979,-0.024016122026664116,0.052517961141224208],"Pressure":[28281.068702203829],"DVL":[0.047076670038423363,0.020111181397990438,0.012669659577486548,7.1360754525219052,0.0036975671846407993,-0.022449893893745462,0.011017369815167863,0],"IMU":[0.0071085864048153332,0.13668916311096549,0.79977840489660701,-0.0020912467222485827,-0.059959107667793825,0.019437079972253052,1.3016046504129042,-0.036822187113034477,-9.7570128030652494],"FOG":[0.82265670290937065],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-26.405856592057962,-13.734624395861358,-45.921211222297863,49.081830710196222,49.081830710196222],"omega_rad_s":[-26.329288240331046,-13.744741596309396,-46.515381766559976,48.8072028450947,48.80759764467868],"thrust_n":[-8.9692960116012017,-2.6157443179543254,-27.744110530701629,30.30202630725552,29.716952078856046],"torque_nm":[0.16817430021752253,0.0490452059616436,0.52020207245065564,-0.56816299326104103,-0.5571928514785508],"angle_rad":[-522.01105306218722,735.35577431541117,-230.31660549110595,1158.3950032795574,1158.3966252472899]},"command":[-0.2514843484957901,-0.13080594662725104,-0.4373448687837892,0.46744600676377351,0.46744600676377351],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.5754812818930019e-21,-5.759824041329097e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.36458547025496502,-1.3732782069788123,-0.30898459333505962,0.00065240105912281964,-0.0005339753859057839,0.00027692513547725959]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":375,"step":3000,"t":15,"sim_time":15.000000000000945,"vehicle":{"origin_ned":[1.6533062766390842,1.127036339351283,3.6585263367943219],"origin_quat_xyzw":[-0.023208167236346076,0.063814982190931249,0.38915925633257786,0.91866430334054872],"cg_ned":[1.5886163954531207,1.0635998846116803,3.3678599180022069],"linear_velocity_ned":[0.020793198056326762,0.005301040342686112,0.011787480345353976],"angular_velocity_ned":[0.016839638698224815,-0.016697810520690505,0.05210634830600043]},"sensors":{"Odom":[1.6533062766390842,1.127036339351283,3.6585263367943219,0.009508341676545717,-0.006344189415823839,0.015409189103208034,-0.023208167236346087,0.063814982190931291,0.38915925633257809,0.91866430334054872,-0.0073384068924809793,-0.023346503821161855,0.051754713650707503],"Pressure":[28289.063702911095],"DVL":[-0.011816970839580963,0.014560086595006254,-0.01587277745348898,7.1774909360707451,-0.030906948249260085,0.020401383946811645,-0.010285996620026603,0],"IMU":[0.007092642551817574,0.13572879437779467,0.80187465725699225,-0.027838470261258033,0.041250254744241807,0.12356606764972911,1.2885567123083688,-0.049451634218202034,-9.78796460345289],"FOG":[0.78486855949801781],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-26.380094546650188,-14.447634859305269,-45.776179314191076,48.923959221674863,48.923959221674863],"omega_rad_s":[-26.319421490964672,-14.768367427612375,-46.354469051913249,48.636835196609667,48.637187088524833],"thrust_n":[-8.9575075615643573,-2.9940076360427073,-27.531276259148417,30.124564843215015,29.557668687755932],"torque_nm":[0.16795326677933164,0.056137643175800757,0.51621142985903279,-0.56483559081028156,-0.5542062878954237],"angle_rad":[-523.06401559466849,734.78228963287359,-232.17354851843714,1160.3433821146289,1160.3450189072692]},"command":[-0.25123899568238273,-0.13759652246957399,-0.43596361251610549,0.46594246877785583,0.46594246877785583],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,-1.0905549195899114e-21,0,-1.5754812818930019e-21,-5.759824041329097e-22],"servo_velocity":[0,0,-4.3368086899420177e-19,0,0,0],"servo_effort":[0.35381962417221574,-1.357695730507158,-0.30595976916112599,0.00061842218454806995,-0.00052979070919380972,0.00028127426910040687]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":376,"step":3008,"t":15.040000000000001,"sim_time":15.040000000000951,"vehicle":{"origin_ned":[1.6537876012666732,1.1271726317558228,3.6590444224773755],"origin_quat_xyzw":[-0.023094789959651415,0.063361331341326765,0.39012167836513617,0.91829028549633651],"cg_ned":[1.5894185063053841,1.063796725337196,3.3682935916433108],"linear_velocity_ned":[0.019479382128291641,0.004626253934247428,0.0101072529617919],"angular_velocity_ned":[0.016537900891439521,-0.016031082539618841,0.051292395501822768]},"sensors":{"Odom":[1.6537876012666732,1.1271726317558228,3.6590444224773755,0.0085418153318344361,-0.0060697455001759264,0.013500601861734865,-0.023094789959651432,0.063361331341326807,0.39012167836513645,0.91829028549633651,-0.006961117276009717,-0.022671756301585539,0.050979818772468322],"Pressure":[28299.73150513494],"DVL":[0.032143882006209143,0.066705268080540017,0.048486297870795746,7.2531456371821275,-0.013280085879167298,0.011387401635012855,0.034765412965070235,0],"IMU":[0.0070861538379854202,0.13479557837351933,0.80393975986159949,0.011088763161317006,-0.0068148182706610147,-0.013003939486763802,1.2874570508474812,-0.056767721606617312,-9.7971354693285022],"FOG":[0.80197918940126434],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-26.348114212775339,-15.10016357758696,-45.632599464825105,48.774181843282079,48.774181843282079],"omega_rad_s":[-26.302944487788508,-15.670492497732097,-46.19522342481492,48.474504169574097,48.474813742918258],"thrust_n":[-8.9413372923521131,-3.347378128528633,-27.321697665499716,29.957083369257749,29.40829933292358],"torque_nm":[0.16765007423160211,0.062763339909911869,0.51228183122811977,-0.56169531317358279,-0.55140561249231723],"angle_rad":[-524.11643262372968,734.17069215229674,-234.02409297504838,1162.2851291683664,1162.2867790823516]},"command":[-0.25093442107405084,-0.14381108169130438,-0.43459618537928674,0.46451601755506744,0.46451601755506744],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.5754812818930019e-21,-4.9127910940749275e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.34328511578799681,-1.342969078760639,-0.30304225585553124,0.00058379610791937247,-0.0005255655239284001,0.00028564912576729671]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":377,"step":3016,"t":15.08,"sim_time":15.080000000000958,"vehicle":{"origin_ned":[1.6542266906556311,1.1272830205244584,3.6594928543158374],"origin_quat_xyzw":[-0.022981022147868048,0.062922455352533269,0.39106850968863838,0.91792050743152853],"cg_ned":[1.5901686285118153,1.0639668073160464,3.3686603366178622],"linear_velocity_ned":[0.018190744511319992,0.003961884971068844,0.0084395406703747424],"angular_velocity_ned":[0.01621346886133173,-0.015386302903919182,0.050473639527886312]},"sensors":{"Odom":[1.6542266906556311,1.1272830205244584,3.6594928543158374,0.0075969478397147194,-0.0057911745152599047,0.011610732038306874,-0.022981022147868062,0.06292245535253331,0.3910685096886386,0.91792050743152853,-0.0066137782533084513,-0.021996486104988625,0.050195773856059243],"Pressure":[28309.046251056632],"DVL":[0.034749241690613025,0.01444688891427549,0.0078766796795965589,7.1289208185978294,-0.00044300929284729612,0.010623271553216407,0.00081976966264314893,0],"IMU":[0.007087973641291918,0.13388960104523537,0.80597330759167762,-0.0290385418092605,-0.090214140214265437,-0.071056614127709916,1.2618794412621261,-0.060292637704388356,-9.7596954581974895],"FOG":[0.78940865940342497],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-26.310113610252774,-15.701492271447702,-45.489984451844528,48.632632947243259,48.632632947243259],"omega_rad_s":[-26.279926486061235,-16.47247058989236,-46.037554325050209,48.320359130558352,48.320627134268101],"thrust_n":[-8.9208482704067169,-3.6769781229704628,-27.115253996722529,29.799731906912626,29.268888693258841],"torque_nm":[0.16726590507012595,0.068943339805696183,0.50841101243854747,-0.55874497325461192,-0.54879166299860327],"angle_rad":[-525.1680411740067,733.52534068383193,-235.86830393964456,1164.2205693282372,1164.2222306871313]},"command":[-0.25057251057383595,-0.14953802163283525,-0.43323794716042408,0.4631679328308882,0.4631679328308882],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,-2.1684043449710089e-21,-1.0333801956502496e-21,-4.9127910940749275e-21],"servo_velocity":[0,0,0,-4.3368086899420177e-19,0,0],"servo_effort":[0.33306710100560399,-1.3291486738419147,-0.30024521826565914,0.00054848374592403142,-0.00052132484026563668,0.00029013637859893023]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":378,"step":3024,"t":15.120000000000001,"sim_time":15.120000000000964,"vehicle":{"origin_ned":[1.6546242997492879,1.127368208347812,3.6598721711775459],"origin_quat_xyzw":[-0.022867414294891357,0.062498089438738143,0.39199967592632634,0.91755507968384564],"cg_ned":[1.5908677809746508,1.0641105586134405,3.3689606595540971],"linear_velocity_ned":[0.016927671935541979,0.003308461278458962,0.0067846353425132528],"angular_velocity_ned":[0.015869953209543101,-0.014765978720897507,0.049652542817912058]},"sensors":{"Odom":[1.6546242997492879,1.127368208347812,3.6598721711775459,0.0066731958929747365,-0.005508701767807535,0.0097399755466362307,-0.022867414294891364,0.062498089438738164,0.39199967592632651,0.91755507968384564,-0.0062960490678725337,-0.021324889256286689,0.049405196235676747],"Pressure":[28315.463332653777],"DVL":[-0.0026707256683484344,0.056666701163011944,-0.038868990242312933,7.1986012250668843,0.01423687307771372,-0.048653982543753999,-0.026921433745520276,0],"IMU":[0.007096983304342123,0.13301077150615978,0.80797500238916509,-0.011422683265923791,-0.071761507526670182,-0.081205182929599745,1.2593025807822009,-0.05460111879886332,-9.7550225744523136],"FOG":[0.82135326744436865],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-26.266277154118644,-16.259354065868926,-45.347670482672719,48.499438277522472,48.499438277522472],"omega_rad_s":[-26.250480854464399,-17.191353118392836,-45.881187003451693,48.174542821696868,48.174770171212671],"thrust_n":[-8.896134156736716,-3.9845690421673789,-26.911605651883711,29.652650974812822,29.139480839120736],"torque_nm":[0.16680251543881344,0.074710669540638361,0.50459260597281974,-0.55598720577774052,-0.54636526573351385],"angle_rad":[-526.21858211110975,732.84984343408541,-237.70623867376275,1166.1500333105039,1166.1517044715706]},"command":[-0.25015502051541566,-0.15485099110351358,-0.43188257602545449,0.46189941216688069,0.46189941216688069],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-2.202285662861212e-22,-4.9127910940749275e-21],"servo_velocity":[0,0,0,0,2.7105054312137611e-20,0],"servo_effort":[0.3232064752086059,-1.316126726759256,-0.29755541941463898,0.00051250170173121519,-0.00051707397337753369,0.00029476209265505931]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":379,"step":3032,"t":15.16,"sim_time":15.16000000000097,"vehicle":{"origin_ned":[1.6549811338279172,1.1274288949126468,3.6601829417984124],"origin_quat_xyzw":[-0.022754479616257331,0.062087910186473722,0.39291513940922029,0.9171941006619605],"cg_ned":[1.5915169607624138,1.0642284359170531,3.3691950859503113],"linear_velocity_ned":[0.015689033260442957,0.0026668270934420328,0.0051431447502731532],"angular_velocity_ned":[0.015510122622890537,-0.01417170939971754,0.048830620087395582]},"sensors":{"Odom":[1.6549811338279172,1.1274288949126468,3.6601829417984124,0.0057695292743055494,-0.0052213289402260358,0.0078888655233901612,-0.022754479616257341,0.062087910186473749,0.39291513940922046,0.9171941006619605,-0.0060074072703939505,-0.020659938933356409,0.048609759209075579],"Pressure":[28324.893812466042],"DVL":[0.028878388981825272,0.036886638725817558,0.0084073267184579317,7.2458921608813647,0.0050088335921594698,0.016068749738239196,-0.036427507354174375,0],"IMU":[0.0071120896824678551,0.13215886683628397,0.80994462663055045,0.035368950731309794,0.078833826054447081,-0.0010568031374734235,1.2672115186378163,-0.051731975052239164,-9.7812620138921069],"FOG":[0.80621161189912538],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-26.215949743490139,-16.779160688482946,-45.205086207176464,48.374686292079936,48.374686292079936],"omega_rad_s":[-26.214559963030375,-17.840774765613222,-45.725725000718633,48.037184091461953,48.037371856750347],"thrust_n":[-8.8671685313789244,-4.2721224359389494,-26.71026196853753,29.51594992383502,29.020120030665989],"torque_nm":[0.16625940996335484,0.080102295673855281,0.50081741191007867,-0.55342406107190678,-0.54412725057498723],"angle_rad":[-527.26779828427561,732.14720483646852,-239.53794035906677,1168.073857265626,1168.0755366262988]},"command":[-0.24967571184276324,-0.15980153036650424,-0.43052463054453777,0.46071129801980892,0.46071129801980892],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945089125e-23,-5.759824041329097e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.31406257318535874,-1.3040555335089503,-0.29505084024014527,0.00049541918704634898,-0.00052243420044503438,0.00029956087591981469]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":380,"step":3040,"t":15.200000000000001,"sim_time":15.200000000000976,"vehicle":{"origin_ned":[1.6552978592084759,1.1274657754955797,3.6604257707676675],"origin_quat_xyzw":[-0.022642691835664714,0.061691533472393388,0.39381490744829201,0.91683765295484709],"cg_ned":[1.5921171551163511,1.0643209241030507,3.3693641657692481],"linear_velocity_ned":[0.01447542793956706,0.0020375445555074218,0.003515666542155483],"angular_velocity_ned":[0.015137313848449154,-0.01360570439281104,0.048010886300687811]},"sensors":{"Odom":[1.6552978592084759,1.1274657754955797,3.6604257707676675,0.0048856563918594914,-0.0049293403565051378,0.006058113936879498,-0.022642691835664731,0.061691533472393437,0.39381490744829228,0.91683765295484709,-0.0057475908995488116,-0.02000543603854503,0.047812617515752998],"Pressure":[28330.09500321015],"DVL":[0.012504172400293818,0.019339792932102456,0.0065200272250954764,7.0725707788928007,-0.0056851877185357478,0.017421676619244313,0.016245154481460158,0],"IMU":[0.007132227894794999,0.13133352616267627,0.8118820611900599,-0.01671279945978105,-0.056978800792830901,-0.12362178170965182,1.2456956180633971,-0.055509619506225343,-9.7679849809530239],"FOG":[0.81358333093079049],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-26.158499962928921,-17.265679651130309,-45.061528348878539,48.258360220093827,48.258360220093827],"omega_rad_s":[-26.171851961564201,-18.431561288705861,-45.570677249043065,47.908370948973456,47.908520340441811],"thrust_n":[-8.8337631559517273,-4.5415561667919508,-26.510639608449637,29.389695188415072,28.910792748246067],"torque_nm":[0.1656330591740949,0.085154178127349101,0.49707449265843073,-0.55105678478278264,-0.54207736402961382],"angle_rad":[-528.31542345591458,731.41995137603465,-241.3634343051603,1169.9923816388284,1169.9940676425147]},"command":[-0.24912857107551353,-0.16443504429647915,-0.42915741284646225,0.45960343066756026,0.45960343066756026],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945089125e-23,-5.759824041329097e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.30580611672005792,-1.2930940049626234,-0.29272931608340252,0.00048587130927497414,-0.00053303837166401781,0.00030450186438466664]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":381,"step":3048,"t":15.24,"sim_time":15.240000000000983,"vehicle":{"origin_ned":[1.6555751315292333,1.1274795501978241,3.6606013023051025],"origin_quat_xyzw":[-0.022532495166154798,0.061308509647631751,0.39469905809277928,0.91648579195045143],"cg_ned":[1.5926693773047325,1.0643885385965299,3.3694684771688959],"linear_velocity_ned":[0.013287341413571456,0.0014216206813485979,0.0019030253141793707],"angular_velocity_ned":[0.014754001352727751,-0.013070250376742006,0.047197504364114164]},"sensors":{"Odom":[1.6555751315292333,1.1274795501978241,3.6606013023051025,0.00402166720897848,-0.0046323297014003754,0.0042486614928526102,-0.022532495166154812,0.061308509647631786,0.3946990580927795,0.91648579195045143,-0.005517145274164725,-0.019364606681030402,0.04701797034262907],"Pressure":[28335.893776409557],"DVL":[0.0038878690993628673,0.00026541742037284807,0.0037811599488692545,7.1406249775597948,-0.017402488229365968,-0.02368445124788213,0.0036176838028564558,0],"IMU":[0.0071563418435271553,0.13053424923007062,0.81378734034756639,0.049775105427160786,-0.027980886331377817,-0.015968532835025778,1.2605177356130435,-0.058951192303273968,-9.7310750615908432],"FOG":[0.8287958931199948],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-26.093815185897807,-17.724893069479233,-44.916069768405002,48.150347292535159,48.150347292535159],"omega_rad_s":[-26.122125929606526,-18.973032737221445,-45.415414389853566,47.788130676412131,47.788243038140045],"thrust_n":[-8.7957883379819091,-4.7949721553193543,-26.312003926700307,29.27387375587848,28.811417162033838],"torque_nm":[0.16492103133716085,0.089905727912237873,0.49335007362563077,-0.54888513292272156,-0.54021407178813452],"angle_rad":[-529.36118105550975,730.6702131092178,-243.18272314688301,1171.905949056671,1171.9076401982386]},"command":[-0.2485125255799791,-0.16880850542361175,-0.42777209303242858,0.45857473611938243,0.45857473611938243],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945089125e-23,-5.759824041329097e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.29854348843098133,-1.2829572909404086,-0.2904988202592817,0.00047652677658620448,-0.00054369511263577166,0.00030954918647866102]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":382,"step":3056,"t":15.280000000000001,"sim_time":15.280000000000989,"vehicle":{"origin_ned":[1.6558135994729701,1.1274709314833837,3.6607102286352129],"origin_quat_xyzw":[-0.022424322892883337,0.060938335960649619,0.39556775083818108,0.91613853944147838],"cg_ned":[1.5931746691427788,1.0644318190328323,3.3695086382553638],"linear_velocity_ned":[0.012125648786544927,0.00081908193387484403,0.0003063471799803279],"angular_velocity_ned":[0.014361460925822616,-0.012567118060800537,0.046394931706134616]},"sensors":{"Odom":[1.6558135994729701,1.1274709314833837,3.6607102286352129,0.0031775353798593874,-0.004330682154362487,0.0024616392419531644,-0.022424322892883347,0.060938335960649646,0.3955677508381813,0.91613853944147838,-0.0053171053388288061,-0.018739451072599514,0.046230239763691158],"Pressure":[28342.12437945385],"DVL":[0.024388506777553734,0.011258542640910437,0.023814705014164578,7.1736662456274694,-0.0027794366667755143,0.02679768388331949,-0.012776991896111903,0],"IMU":[0.0071833604810576874,0.12976043376020072,0.81566067495138306,0.077304180569592637,-0.027935033992622434,0.17735273146032504,1.230305806538575,-0.057736482903514935,-9.7673922952350285],"FOG":[0.81632090510655786],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-26.0214467587518,-18.162824529351905,-44.767650609134833,48.050387579765868,48.050387579765868],"omega_rad_s":[-26.065053441440849,-19.473563933705012,-45.259155406781254,47.676402994057419,47.676479785651807],"thrust_n":[-8.7530623204849629,-5.0346939793992096,-26.113445239685582,29.168353133568196,28.721820451078678],"torque_nm":[0.16411991850909308,0.094400512113735194,0.48962709824410489,-0.54690662125440359,-0.53853413345772527],"angle_rad":[-530.40478266365528,729.89976970960811,-244.99578081806649,1173.8149013057205,1173.8165961364859]},"command":[-0.24782330246430284,-0.17297928123192291,-0.42635857722985554,0.457622738854913,0.457622738854913],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945089125e-23,-5.759824041329097e-22],"servo_velocity":[0,-8.6736173798840355e-19,0,0,0,0],"servo_effort":[0.29284782969876183,-1.2737823930941863,-0.28843927322157736,0.00046730323813273149,-0.0005543386549707117,0.00031469238593288449]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":383,"step":3064,"t":15.32,"sim_time":15.320000000000995,"vehicle":{"origin_ned":[1.6560139007437025,1.1274406039802782,3.6607532890895755],"origin_quat_xyzw":[-0.022318613789910222,0.060580476275506764,0.39642122552507714,0.91579588191142536],"cg_ned":[1.5936340901318025,1.0644512758932296,3.36948531057772],"linear_velocity_ned":[0.010990584559672334,0.000228743001679456,-0.0012735003675241211],"angular_velocity_ned":[0.013959937954456368,-0.012097690935407879,0.045607679259387315]},"sensors":{"Odom":[1.6560139007437025,1.1274406039802782,3.6607532890895755,0.002352252889886722,-0.0040250106777947265,0.00069770867126829378,-0.022318613789910235,0.060580476275506799,0.39642122552507736,0.91579588191142536,-0.0051489336751304659,-0.018130952356880153,0.045453838668804626],"Pressure":[28345.146939823659],"DVL":[-0.021490685977174889,0.012692383141994877,-0.00080833353999821937,7.2306659007776677,-0.0017992150334258709,-0.00034315479491037334,0.0028290005317498142,0],"IMU":[0.0072121824964760071,0.12901142471775282,0.81750245079835704,0.064105216444566529,-0.046925382248483014,0.10443434992119827,1.2375927898338881,-0.067890179231000838,-9.7788047330318211],"FOG":[0.83308016156285081],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.941596851111694,-18.5839641347008,-44.61486788207646,47.958199975156262,47.958199975156262],"omega_rad_s":[-26.000462820980811,-19.940515249664951,-45.100928994026908,47.573047495574031,47.573090259690289],"thrust_n":[-8.7055197121921761,-5.2630619142191515,-25.913821082206319,29.072903982098556,28.641759866005934],"torque_nm":[0.16322849460360331,0.098682410891609104,0.48588414529136853,-0.54511694966434798,-0.53703299748761124],"angle_rad":[-531.44593018172088,729.11008792974337,-246.80254594682913,1175.7195758236285,1175.7212729552805]},"command":[-0.24706282715344469,-0.17699013461619809,-0.4249035036388234,0.45674476166815486,0.45674476166815486],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945089125e-23,-5.759824041329097e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.28817207301545378,-1.2651186449275302,-0.2864678530137062,0.00045834647791484192,-0.00056496561277263424,0.0003199281828466298]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":384,"step":3072,"t":15.359999999999999,"sim_time":15.360000000001001,"vehicle":{"origin_ned":[1.6561766292457989,1.1273892512309707,3.6607312168039727],"origin_quat_xyzw":[-0.022215822746215932,0.060234366027114336,0.39725979950974699,0.91545777076962753],"cg_ned":[1.5940486841921413,1.0644474107834561,3.3693991473442129],"linear_velocity_ned":[0.0098807691734520524,-0.00034790519232078882,-0.0028374843700038187],"angular_velocity_ned":[0.013549485043851582,-0.011663315041403194,0.044839436430857957]},"sensors":{"Odom":[1.6561766292457989,1.1273892512309707,3.6607312168039727,0.0015459288429241834,-0.0037129580325852124,-0.0010441997345040734,-0.022215822746215936,0.06023436602711435,0.39725979950974705,0.91545777076962753,-0.0050140865406519495,-0.017539930224039949,0.044692351762289209],"Pressure":[28346.981840670545],"DVL":[0.012384438137407573,0.00095021229864051052,0.037397330171654967,7.1512075417325791,0.010879114233871078,-0.0027831060008534558,-0.041015417270467112,0],"IMU":[0.0072416598739424619,0.12828653189811082,0.81931322215710256,0.044809732565014471,-0.071980116618904563,0.097184576279009352,1.2181209291364008,-0.081238317202956073,-9.7726905036421883],"FOG":[0.8297781838485595],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.854171088673002,-18.992424780285653,-44.456137925193588,47.874131148380108,47.874131148380108],"omega_rad_s":[-25.928264414155773,-20.380275730721085,-44.939537716542979,47.478015896306552,47.478026227247717],"thrust_n":[-8.6531286357269703,-5.4823400133509388,-25.71176497417057,28.987447679669941,28.571147421253904],"torque_nm":[0.1622461619198807,0.10279387525033011,0.48209559326569829,-0.54351464399381144,-0.5357090141485108],"angle_rad":[-532.48432134529321,728.30236319908875,-248.60291290703276,1177.620305699837,1177.6220038070182]},"command":[-0.24623020084450478,-0.18088023600272052,-0.42339178976374847,0.45594410617504866,0.45594410617504866],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945089125e-23,-5.759824041329097e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.28499116764884008,-1.2565456691899446,-0.28444485580441803,0.00044938782759321714,-0.00057530172177721554,0.00032508302056695758]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":385,"step":3080,"t":15.4,"sim_time":15.400000000001008,"vehicle":{"origin_ned":[1.6563022396909113,1.1273176805379972,3.6606447332961682],"origin_quat_xyzw":[-0.022116419744664814,0.059899427662646013,0.39808383832283389,0.91512413377067314],"cg_ned":[1.5944193725687033,1.0644208414462029,3.3692507904623938],"linear_velocity_ned":[0.0087918699947271434,-0.00090891644056285558,-0.0043848048706470596],"angular_velocity_ned":[0.013129338437811366,-0.011264333366080828,0.044092567543511804]},"sensors":{"Odom":[1.6563022396909113,1.1273176805379972,3.6606447332961682,0.00075716920478698969,-0.0033898396295261642,-0.0027636900333273358,-0.022116419744664828,0.059899427662646054,0.39808383832283412,0.91512413377067314,-0.0049136722492583336,-0.016965928703102536,0.043948064062527881],"Pressure":[28350.654519920692],"DVL":[0.023178046066259044,0.019371650440477766,0.019378955670786902,7.1362587867660778,-0.0098151954716523375,-0.0078689077136712138,0.0093273736457957276,0],"IMU":[0.0072706078248400184,0.12758505775304391,0.82109364939849472,0.0088019497154759371,-0.0094583193185910353,0.1168769190443574,1.2199561085791526,-0.064233243545540733,-9.7896083125895288],"FOG":[0.82895684505285672],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.754559870947674,-19.392176195631183,-44.291129281564096,47.798717501571318,47.798717501571318],"omega_rad_s":[-25.847193798379493,-20.798551997304209,-44.773957952094804,47.391478776672933,47.391458293508776],"thrust_n":[-8.5950468404040787,-5.6947488734966996,-25.506117065813473,28.912143370546925,28.510156292444545],"torque_nm":[0.16115712825757647,0.10677654137806311,0.47823969498400259,-0.54210268819775487,-0.53456543048333516],"angle_rad":[-533.51962715026036,727.477551256006,-250.39673097035731,1179.5174276023395,1179.5191254241258]},"command":[-0.24528152258045405,-0.18468739233934461,-0.42182027887203905,0.4552258809673459,0.4552258809673459],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945089125e-23,-5.759824041329097e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.2829717609265906,-1.248259252130012,-0.28251491286404928,0.00044065007342910877,-0.0005855899958506994,0.00033035022622528208]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":386,"step":3088,"t":15.44,"sim_time":15.440000000001014,"vehicle":{"origin_ned":[1.6563910135657323,1.1272266392847454,3.6604946694482972],"origin_quat_xyzw":[-0.022020906587168782,0.059575103204819138,0.39889374760947027,0.91479487584336983],"cg_ned":[1.5947469055183849,1.0643721022769479,3.369040997912323],"linear_velocity_ned":[0.0077207898855784695,-0.0014586286729460032,-0.0059116364128230636],"angular_velocity_ned":[0.012697276412269294,-0.010899895308202389,0.043369018560451715]},"sensors":{"Odom":[1.6563910135657323,1.1272266392847454,3.6604946694482972,-1.8948657296019122e-05,-0.0030561099704359087,-0.0044578827977206211,-0.022020906587168793,0.059575103204819173,0.39889374760947049,0.91479487584336983,-0.0048488567001625949,-0.016406612088370333,0.04322281787897659],"Pressure":[28351.974966078244],"DVL":[0.010288321249493769,0.019025815861921619,-0.015554248638283972,7.2603051325214425,-0.023104213800317411,-0.0012527595182685628,-0.029976026558133324,0],"IMU":[0.0072977991322377683,0.12690637063584073,0.82284448338211269,-0.1785890834162025,0.004749138484240599,0.10553956622050867,1.2018200521021858,-0.045359760108704655,-9.7860711191976488],"FOG":[0.82746039836245755],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.640235768876767,-19.78200030715033,-44.117309110259143,47.731112951692005,47.731112951692005],"omega_rad_s":[-25.755255718547989,-21.199237374859742,-44.602844359168287,47.313393858007821,47.313344161862382],"thrust_n":[-8.5300192283267151,-5.9017391669846822,-25.295278076846301,28.846819627386981,28.458675542322204],"torque_nm":[0.15993786053112594,0.11065760938096278,0.47428646394086821,-0.54087786801350601,-0.53360016641854124],"angle_rad":[-534.55144685231596,726.63641684425602,-252.18380357364111,1181.4112817084092,1181.4129780484075]},"command":[-0.24419272160835015,-0.18840000292524126,-0.42016484866913473,0.4545820281113524,0.4545820281113524],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945089125e-23,-5.759824041329097e-22],"servo_velocity":[0,0,0,0,0,-4.3368086899420177e-19],"servo_effort":[0.28264308765400448,-1.2409154229909485,-0.28081995246479385,0.00043171109226907708,-0.00059571990442804589,0.0003361807103604025]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":387,"step":3096,"t":15.48,"sim_time":15.48000000000102,"vehicle":{"origin_ned":[1.6564431924932383,1.1271166892106437,3.6602818790310949],"origin_quat_xyzw":[-0.021929814186557265,0.059260866155053889,0.39968993551676413,0.91446989476904084],"cg_ned":[1.5950319846093792,1.0643015211637243,3.3687705589409487],"linear_velocity_ned":[0.0066670844578471528,-0.0020019666760354889,-0.0074197202213140707],"angular_velocity_ned":[0.012251803301845839,-0.010569327932107145,0.042668066449035147]},"sensors":{"Odom":[1.6564431924932383,1.1271166892106437,3.6602818790310949,-0.00078549130224466379,-0.0027149002505703138,-0.0061291756290381442,-0.021929814186557279,0.05926086615505393,0.39968993551676435,0.91446989476904084,-0.004820092987734355,-0.015860314041803138,0.042515860730647295],"Pressure":[28352.006570298297],"DVL":[0.048538912296537347,-0.01136593579154822,-0.0028946504109345628,7.242451167361148,-0.019976221043852979,0.034055597640270614,0.011059491873890515,0],"IMU":[0.0073219738680231237,0.12624992476677024,0.82456648447921421,-0.027614077809269472,0.064342570848707648,0.088172283018260786,1.204639924961501,-0.079543332481030488,-9.7694044944307699],"FOG":[0.8202482531270644],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.513380181047303,-20.15969881539095,-43.932988684462501,47.671272366096353,47.671272366096353],"omega_rad_s":[-25.651497435517804,-21.584289581462066,-44.424597383104171,47.243541897221782,47.243464526873858],"thrust_n":[-8.4575390636636634,-6.1038645221099674,-25.077436306369226,28.791193036849268,28.416475041960144],"torque_nm":[0.15857885744369374,0.11444745978956192,0.47020193074442296,-0.53983486944092374,-0.53280890703675277],"angle_rad":[-535.579320080804,725.77961413330377,-253.96387274365941,1183.3021999799078,1183.303893704466]},"command":[-0.24298457315283145,-0.19199713157515191,-0.41840941604249998,0.45401211777234624,0.45401211777234624],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945089125e-23,5.0821976835259476e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.28303630747648767,-1.2333248693052965,-0.27908403584581937,0.00042273849243392667,-0.00060551043775894115,0.00034143055801966643]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":388,"step":3104,"t":15.52,"sim_time":15.520000000001026,"vehicle":{"origin_ned":[1.6564590585131176,1.1269882520981656,3.6600071439256512],"origin_quat_xyzw":[-0.021843582389485326,0.058956244143776947,0.40047262799855732,0.91414916365371257],"cg_ned":[1.5952752817992115,1.0642093441298004,3.3684401949884655],"linear_velocity_ned":[0.0056294988154650021,-0.0025391020743869138,-0.008910188352451158],"angular_velocity_ned":[0.011800024856850071,-0.010265226977555733,0.041969122369244667]},"sensors":{"Odom":[1.6564590585131176,1.1269882520981656,3.6600071439256512,-0.0015432796622670232,-0.0023703637432029544,-0.0077789140315846694,-0.02184358238948533,0.05895624414377696,0.40047262799855743,0.91414916365371257,-0.0048146376660609504,-0.015327257538707921,0.041808099029426345],"Pressure":[28354.987504660872],"DVL":[0.031827120088689001,-4.2959841241922009e-05,0.0034063395628615364,7.1977823997615191,0.064815117970884836,0.00014964787495903048,-0.0017823270270513878,0],"IMU":[0.0073420540245281102,0.12561520653400202,0.82626003051986063,0.026282125109583335,-0.031368788985730423,0.055561171900329234,1.2097174588362603,-0.065348340561583965,-9.7462709530890841],"FOG":[0.8233234107505325],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.375993967994969,-20.520693921763598,-43.73969671261144,47.620448931314669,47.620448931314669],"omega_rad_s":[-25.535997797124079,-21.953879630973702,-44.238263346347686,47.182196363856214,47.182092785016664],"thrust_n":[-8.3777519820045612,-6.3007453115154979,-24.851682697249622,28.745600793329903,28.38389921915411],"torque_nm":[0.15708284966258551,0.11813897459091557,0.46596905057343052,-0.53898001487493563,-0.53219811035913955],"angle_rad":[-536.60277343558744,724.90775617114252,-255.7366266730819,1185.1905173006858,1185.1922073360297]},"command":[-0.2416761330285235,-0.19543518020727235,-0.41656854012010897,0.4535280850601397,0.4535280850601397],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945089125e-23,5.0821976835259476e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.27420802552317042,-1.2258888981751597,-0.27736225110519641,0.00041287224601359442,-0.00061484240573197297,0.00034646127980965987]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":389,"step":3112,"t":15.56,"sim_time":15.560000000001033,"vehicle":{"origin_ned":[1.6564389605606711,1.1268416362393032,3.6596712138094754],"origin_quat_xyzw":[-0.021762454570736538,0.05866082803546669,0.40124177631683589,0.91383277450710876],"cg_ned":[1.595477425196409,1.0640958258546422,3.3680505937970677],"linear_velocity_ned":[0.0046074783498155662,-0.0030698373396138168,-0.010383712235309005],"angular_velocity_ned":[0.011346670655048243,-0.0099841153693083651,0.041266503816292675]},"sensors":{"Odom":[1.6564389605606711,1.1268416362393032,3.6596712138094754,-0.0022927067017484504,-0.0020242748120208038,-0.0094078363095046642,-0.021762454570736538,0.058660828035466683,0.40124177631683589,0.91383277450710876,-0.0048261088863211033,-0.014808523885458051,0.041094648377046392],"Pressure":[28354.325822217987],"DVL":[0.03036732828734939,0.038183826527174516,-0.0048925982530763912,7.2126520478092715,0.026351937201786437,-0.0042260885517942538,0.020121185101452572,0],"IMU":[0.0073573329472654278,0.12500166594825135,0.82792492324021161,0.049916873572990142,0.057375298328093842,0.093753295078691845,1.1901967079320943,-0.059303374958212487,-9.7628449872509169],"FOG":[0.82177257289214845],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.231143490559209,-20.853113922926827,-43.542926836795928,47.579238141524989,47.579238141524989],"omega_rad_s":[-25.409881135050945,-22.304004568958533,-44.045086235408256,47.129769860802654,47.129641489872675],"thrust_n":[-8.2914876854393569,-6.4896482502090196,-24.619572766235219,28.710548687086529,28.361431927521874],"torque_nm":[0.15546539410198795,0.12168090469141912,0.46161698936691042,-0.53832278788287247,-0.53177684864103525],"angle_rad":[-537.62136188737043,724.02154962678355,-257.50176798641638,1187.0765831629258,1187.0782684927049]},"command":[-0.24029660467199246,-0.1986010849802555,-0.41469454130281835,0.45313560134785702,0.45313560134785702],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945089125e-23,5.0821976835259476e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.26460609948839869,-1.2186575526105525,-0.27562976899327812,0.00040395407213289145,-0.0006235527280124938,0.00035110815730361592]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":390,"step":3120,"t":15.6,"sim_time":15.600000000001039,"vehicle":{"origin_ned":[1.6563833066070544,1.1266770661246788,3.659274828422447],"origin_quat_xyzw":[-0.02168659115947167,0.058374236493748427,0.40199731575487913,0.91352082538031165],"cg_ned":[1.5956390653462427,1.0639611786115517,3.3676024331939884],"linear_velocity_ned":[0.0036025019316666424,-0.0035963597496054328,-0.011840187062474057],"angular_velocity_ned":[0.010894895940866064,-0.0097230470314228646,0.040559491042437071]},"sensors":{"Odom":[1.6563833066070544,1.1266770661246788,3.659274828422447,-0.0030344062712134162,-0.0016806453659978487,-0.011015969279962333,-0.02168659115947167,0.058374236493748434,0.40199731575487913,0.91352082538031165,-0.0048502014762679358,-0.014304389450415457,0.040375347711809818],"Pressure":[28351.796629356508],"DVL":[0.017334552218962327,-0.0038915695730500841,0.017367369496045636,7.1617819045400504,0.0024384804274690591,0.018156508110290914,0.00049847997205358782,0],"IMU":[0.0073672736963481394,0.12440873943475905,0.82956094084182896,-0.053526781314056984,0.085091376212546602,-0.0095822595705221808,1.1957961195992197,-0.065390389371990112,-9.8145061147532626],"FOG":[0.83933964480541468],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-25.080385633341514,-21.158573358071532,-43.342465913431916,47.547986998765353,47.547986998765353],"omega_rad_s":[-25.2743953096981,-22.631905736379487,-43.846100513091287,47.08668015162425,47.086528367496541],"thrust_n":[-8.1996822413181327,-6.6684725070761752,-24.382355795253552,28.686528929997312,28.349564686216571],"torque_nm":[0.15374404202471501,0.12503385950767831,0.45716917116100414,-0.53787241743744962,-0.5315543378665607],"angle_rad":[-538.63468772085753,723.12183969117996,-259.25904760733619,1188.9607639855283,1188.9624436491988]},"command":[-0.23886081555563346,-0.2015102224578241,-0.41278538965173256,0.45283797141681287,0.45283797141681287],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945089125e-23,-5.759824041329097e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.25260191273834021,-1.2119213672467117,-0.27394862406200488,0.00039539647381560926,-0.00063174567766883225,0.0003548214570720715]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":391,"step":3128,"t":15.640000000000001,"sim_time":15.640000000001045,"vehicle":{"origin_ned":[1.656292580836962,1.1264946960310496,3.6588187636649439],"origin_quat_xyzw":[-0.02161610349093087,0.058096091029275085,0.40273918700226907,0.91321341182099303],"cg_ned":[1.5957609160983313,1.0638055710200214,3.3670964253009807],"linear_velocity_ned":[0.0026158855596511012,-0.0041181953171337011,-0.013278080185992804],"angular_velocity_ned":[0.010445478782005401,-0.0094826899191714185,0.039848893675076359]},"sensors":{"Odom":[1.656292580836962,1.1264946960310496,3.6588187636649439,-0.003767578803529458,-0.001340174241097382,-0.012601667269990246,-0.021616103490930887,0.058096091029275133,0.40273918700226946,0.91321341182099303,-0.0048870386722374383,-0.013815828255966865,0.039651021485375457],"Pressure":[28352.147947662794],"DVL":[0.012229590267033016,-0.010875491381211119,0.0055506327065940157,7.2008418155566263,-0.022925798839015365,0.0028105993833767713,0.0011195810170041827,0],"IMU":[0.0073714293398427378,0.1238358304980466,0.83116787881112952,-0.037132162239933625,0.025430035960511726,0.068963619600459228,1.1900602974017016,-0.06695371505586542,-9.74951203781694],"FOG":[0.82217663313570633],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-24.926591010221625,-21.438205638559349,-43.138176965869327,47.526513002849001,47.526513002849001],"omega_rad_s":[-25.13142900113661,-22.936020663752668,-43.641972028209373,47.053198422426689,47.053024576471799],"thrust_n":[-8.1036635975250384,-6.8357863675386312,-24.140874926945546,28.673837626791567,28.3485770229499],"torque_nm":[0.15194369245359449,0.12817099439134938,0.45264140488022903,-0.53763445550234201,-0.53153581918031056],"angle_rad":[-539.64241926594013,722.20955456934996,-261.00824923017808,1190.8434401085538,1190.8451132000628]},"command":[-0.23739610485925358,-0.20417338703389856,-0.41083978062732696,0.45263345716999048,0.45263345716999048],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945089125e-23,-3.0493186101153358e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.24007949564546663,-1.2060586131132791,-0.27230704538801859,0.00038645280372254736,-0.00063911751690487863,0.00035829451844278051]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":392,"step":3136,"t":15.68,"sim_time":15.680000000001051,"vehicle":{"origin_ned":[1.6561672717917229,1.1262947444160383,3.6583038636395737],"origin_quat_xyzw":[-0.021551152965280474,0.057825966383405723,0.40346731301661809,0.91291063787472781],"cg_ned":[1.5958437307194475,1.0636292228489121,3.3665333470851442],"linear_velocity_ned":[0.0016483828504889799,-0.0046340040041068483,-0.014696085413257889],"angular_velocity_ned":[0.0099965564848953394,-0.0092672949476724237,0.039133220539662859]},"sensors":{"Odom":[1.6561672717917229,1.1262947444160383,3.6583038636395737,-0.0044912890913334337,-0.0010014725646815791,-0.014163458139600339,-0.021551152965280491,0.057825966383405772,0.40346731301661837,0.91291063787472781,-0.0049408556527645343,-0.013344298324253982,0.038919667196169683],"Pressure":[28350.168418783232],"DVL":[0.023482285829237413,0.013104528260191373,0.014174615384305039,7.2826671010381698,0.01892794973536624,0.0079794113591728812,-0.0096248889934257807,0],"IMU":[0.0073692168722060726,0.12328229889948883,0.83274548445068597,0.11763608508533623,-0.013858405049106574,0.16403540993049967,1.1810889723591536,-0.075408784866661138,-9.7798683637987409],"FOG":[0.810890321062678],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-24.768568129566578,-21.693105306785718,-42.931162556375043,47.513985344306406,47.513985344306406],"omega_rad_s":[-24.982117192216773,-23.215835448454776,-43.433382893014368,47.029253894622265,47.029059321276669],"thrust_n":[-8.0042431316167981,-6.9907802955299614,-23.896003892003929,28.672363277622196,28.35833455497664],"torque_nm":[0.150079558717815,0.13107713054118678,0.44805007297507371,-0.53760681145541622,-0.53171877290581193],"angle_rad":[-540.64428592886827,721.28565779145958,-262.74918166479006,1192.7249949810068,1192.7266606479359]},"command":[-0.23589112504349122,-0.20660100292176875,-0.40886821482261942,0.45251414613625146,0.45251414613625146],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945089125e-23,-3.3881317890157468e-23],"servo_velocity":[5.4210108624275222e-20,0,0,0,0,0],"servo_effort":[0.22699906799761299,-1.2012175741269069,-0.27075872038273302,0.00037719997782268544,-0.00064565749833012836,0.00036100997862248088]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":393,"step":3144,"t":15.720000000000001,"sim_time":15.720000000001058,"vehicle":{"origin_ned":[1.6560078903321749,1.1260774463833159,3.6577310118064892],"origin_quat_xyzw":[-0.02149188530716159,0.057563408166033281,0.4041816017597209,0.91261261535505889],"cg_ned":[1.5958882947875983,1.0634323886666102,3.3659140100631979],"linear_velocity_ned":[0.00070103107484575868,-0.0051432507127666645,-0.016093472793470467],"angular_velocity_ned":[0.0095516508144211937,-0.0090752620057714482,0.038410948569954105]},"sensors":{"Odom":[1.6560078903321749,1.1260774463833159,3.6577310118064892,-0.0052049428141933253,-0.0006662313245734536,-0.01570048438539445,-0.0214918853071616,0.057563408166033316,0.40418160175972107,0.91261261535505889,-0.0050080016170579132,-0.012891282328139724,0.038180232366205297],"Pressure":[28346.121939270241],"DVL":[0.026673130989996921,0.028604951081664234,0.023865244304328893,7.1681858854764888,-0.016079634338774136,0.011215989641675252,0.0073857323974189015,0],"IMU":[0.0073600527939969356,0.12274744001028069,0.8342934709041776,-0.091119011166365615,-0.041707130715134988,0.11185234920237315,1.1810191943543307,-0.060863254945075433,-9.7909659776621769],"FOG":[0.8341062995055013],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-24.606096881150986,-21.924357382862297,-42.721880386431941,47.510057864213728,47.510057864213728],"omega_rad_s":[-24.826978594125606,-23.471257757266006,-43.221057249630299,47.014642150654531,47.01442818246187],"thrust_n":[-7.9018266286977603,-7.132928564830415,-23.648635795162321,28.681857313347976,28.378560929290931],"torque_nm":[0.14815924928808299,0.13374241059057029,0.44341192115929351,-0.53778482462527455,-0.53209801742420493],"angle_rad":[-541.64004550915502,720.35112498153887,-264.48168343453239,1194.6058055464268,1194.6074629896523]},"command":[-0.23434377982048557,-0.20880340364630759,-0.40687505129935181,0.45247674156394024,0.45247674156394024],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945089125e-23,-3.3881317890157468e-23],"servo_velocity":[5.4210108624275222e-20,0,0,0,0,0],"servo_effort":[0.21925423998501101,-1.197169777936385,-0.26929976614817902,0.0003675095493093792,-0.00065125098186753977,0.00036133223519679798]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":394,"step":3152,"t":15.76,"sim_time":15.760000000001064,"vehicle":{"origin_ned":[1.6558150338439948,1.1258430009009117,3.6571011209584894],"origin_quat_xyzw":[-0.021438346524180411,0.05730798212196949,0.40488191966091008,0.91231947453461359],"cg_ned":[1.5958954406108092,1.0632153415334953,3.3652392526712029],"linear_velocity_ned":[-0.00022501054069271157,-0.0056454527002061175,-0.017469651861917495],"angular_velocity_ned":[0.0091151381372278004,-0.0089030125766213809,0.037679171480450691]},"sensors":{"Odom":[1.6558150338439948,1.1258430009009117,3.6571011209584894,-0.0059076929446891472,-0.0003369874542259757,-0.017212051804153923,-0.021438346524180415,0.057307982121969504,0.40488191966091019,0.91231947453461359,-0.0050826391211127248,-0.012457593851941184,0.037430528644918228],"Pressure":[28341.504921895226],"DVL":[-0.007044552302664011,0.013424117072554313,0.047861999123567311,7.2585439389215614,-0.022362236796442617,-0.023885860625220072,0.0063129992790104178,0],"IMU":[0.007343544165820416,0.12223050678989965,0.83581147160938052,0.026094016413835693,0.017066259015135456,-0.0089410260164547936,1.1682869298599359,-0.070216656623658863,-9.8022228206377431],"FOG":[0.83528862184139696],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-24.441211385010032,-22.131888857081673,-42.511518318419959,47.51441324246867,47.51441324246867],"omega_rad_s":[-24.66695330994083,-23.702302411640886,-43.005821723328104,47.009114135312338,47.008882107279149],"thrust_n":[-7.7970807728741596,-7.2618096298988188,-23.39976601015028,28.702018942390886,28.408942973283217],"torque_nm":[0.14619526449139053,0.13615893056060288,0.43874561269031781,-0.5381628551698292,-0.53266768074906035],"angle_rad":[-542.62948520505699,719.40693160652711,-266.205623580951,1196.4862394927143,1196.4878879664755]},"command":[-0.23277344176200029,-0.2107798938769683,-0.40487160303257103,0.4525182213568445,0.4525182213568445],"arm":{"servo_position":[-2.6370517928190542e-22,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-3.3881317890157468e-23],"servo_velocity":[-5.4210108624275222e-20,0,0,0,0,0],"servo_effort":[0.22103536571422502,-1.194346101132912,-0.26883713489066663,0.00038739296001978797,-0.00066797477691903149,0.00036057800206239514]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":395,"step":3160,"t":15.800000000000001,"sim_time":15.80000000000107,"vehicle":{"origin_ned":[1.655589384674891,1.125591578086552,3.6564151324800243],"origin_quat_xyzw":[-0.02139047886007666,0.057059283741991901,0.40556810876370408,0.91203135620811826],"cg_ned":[1.5958660412001442,1.062978378217978,3.3645099407179857],"linear_velocity_ned":[-0.0011289081318790297,-0.0061398835464270985,-0.0188236911991575],"angular_velocity_ned":[0.008690431567182938,-0.0087478968593449752,0.036938414267741353]},"sensors":{"Odom":[1.655589384674891,1.125591578086552,3.6564151324800243,-0.0065987508969688555,-1.5190379753223654e-05,-0.018697136480733893,-0.021390478860076678,0.057059283741991949,0.40556810876370442,0.91203135620811826,-0.0051606787005175781,-0.012043955310940433,0.036671600520279998],"Pressure":[28337.368327356864],"DVL":[0.011704373062977943,0.0010033293477322153,0.011738707185943295,7.1335417455333499,-0.058057085152603806,-0.0070398545713022346,0.0012300107950601791,0],"IMU":[0.0073195062096040936,0.12173072310668268,0.83729907902648504,0.038208099891710492,-0.015011084541649157,-0.080924903960426758,1.1568675185315163,-0.051665323137371676,-9.7981335228415887],"FOG":[0.83655871786292901],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-24.276110638715618,-22.315833986455775,-42.301257102458656,47.52678941418133,47.52678941418133],"omega_rad_s":[-24.503426292958416,-23.908998761023927,-42.788648495287028,47.012409802875752,47.012161048764938],"thrust_n":[-7.6909331522694835,-7.3770620548113843,-23.150515139723723,28.732533479824657,28.449156851725537],"torque_nm":[0.14420499660505284,0.13831991352771347,0.43407215886981987,-0.53873500274671227,-0.53342169096985392],"angle_rad":[-543.61244041208124,718.45405260233372,-267.92090783879263,1198.3666542714814,1198.3682930834018]},"command":[-0.23120105370205352,-0.21253175225195975,-0.40286911526151103,0.45263608965886981,0.45263608965886981],"arm":{"servo_position":[-2.6370517928190542e-22,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-3.3881317890157468e-23],"servo_velocity":[-1.0842021724855044e-19,0,0,0,0,0],"servo_effort":[0.22486233180923154,-1.1916256473016256,-0.26859095945149752,0.00037926752567684941,-0.00068458310416190057,0.00036068889831394744]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":396,"step":3168,"t":15.84,"sim_time":15.840000000001076,"vehicle":{"origin_ned":[1.6553316661349182,1.1253233722349416,3.6556740751738257],"origin_quat_xyzw":[-0.021348177046485742,0.05681692104726193,0.40624007541667029,0.91174837205500892],"cg_ned":[1.5958009987415434,1.0627218366295559,3.363727027045635],"linear_velocity_ned":[-0.0020099025940454188,-0.0066253061475389672,-0.020152552444560972],"angular_velocity_ned":[0.0082789299567577052,-0.008608477524459382,0.036193131941514786]},"sensors":{"Odom":[1.6553316661349182,1.1253233722349416,3.6556740751738257,-0.0072770525533724243,0.00029911318965734532,-0.020152617633711227,-0.021348177046485752,0.056816921047261965,0.40624007541667051,0.91174837205500892,-0.0052407399004620984,-0.011650396429209033,0.035908108758216414],"Pressure":[28333.862542531591],"DVL":[-0.0061852565726688751,0.014326960788193933,0.031348976045961707,7.2484811471431074,-0.0075992705408990148,0.019138894016802729,0.0083651015686774417,0],"IMU":[0.0072878567426092351,0.12124729656378465,0.83875603268537158,-0.052822571394993384,-0.050895871716811536,-0.03284142717894728,1.1734403347436466,-0.057395492446388627,-9.7755981491349591],"FOG":[0.85041644921991932],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-24.111130170469917,-22.479840935719881,-42.090364825437256,47.546195214859509,47.546195214859509],"omega_rad_s":[-24.337599930568171,-24.092327158413276,-42.570093420947337,47.02409994976761,47.023835796229136],"thrust_n":[-7.5841710201701389,-7.4789687315478837,-22.901509797248533,28.772838790657506,28.498645177691159],"torque_nm":[0.14220320662819011,0.14023066371652285,0.42940330869841009,-0.53949072732482839,-0.53434959708170926],"angle_rad":[-544.58879958724594,717.49344287678741,-269.62747289113986,1200.247394038478,1200.2490225494096]},"command":[-0.22962981114733252,-0.21409372319733222,-0.40086061738511669,0.45282090680818582,0.45282090680818582],"arm":{"servo_position":[2.7839590696084681e-22,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-3.3881317890157468e-23],"servo_velocity":[0,-8.6736173798840355e-19,0,0,0,0],"servo_effort":[0.22836069098163375,-1.1890081045255156,-0.26830355680358231,0.00037057366792465424,-0.00070072675229466118,0.00036057343311096473]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":397,"step":3176,"t":15.880000000000001,"sim_time":15.880000000001083,"vehicle":{"origin_ned":[1.6550426383968162,1.1250386188636896,3.65487905649807],"origin_quat_xyzw":[-0.02131130244198751,0.056580514585271476,0.40689780345112403,0.91147059815670539],"cg_ned":[1.5957012453524198,1.0624461038626567,3.3628915436338844],"linear_velocity_ned":[-0.0028673108645659137,-0.0071005600533716471,-0.021455373142713705],"angular_velocity_ned":[0.0078822306288482292,-0.008483344257025429,0.035447229128070239]},"sensors":{"Odom":[1.6550426383968162,1.1250386188636896,3.65487905649807,-0.0079414318335579576,0.00060577685608041091,-0.021577535855748509,-0.02131130244198752,0.056580514585271503,0.40689780345112425,0.91147059815670539,-0.0053212562905342077,-0.011277125772284503,0.035144180288263917],"Pressure":[28327.932964973159],"DVL":[-0.033866223898833342,0.031696025290238766,0.018081119125357363,7.1755276045540519,-0.020654159663432294,0.0058952660889496078,-0.012173286020242298,0],"IMU":[0.0072485918460622667,0.12077942956522569,0.84018224705743838,-0.050955332212001783,-0.02460890114346545,0.074120680509415532,1.1716588803666232,-0.057917776356175329,-9.7512932040051581],"FOG":[0.83233593805045114],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-23.946400018188712,-22.627970028396167,-41.878101399704754,47.571514821518178,47.571514821518178],"omega_rad_s":[-24.170325019675392,-24.254350033192157,-42.35026170217499,47.043463701468113,47.043185457028798],"thrust_n":[-7.4773440580469206,-7.5685453975073411,-22.652883976221606,28.822055894595596,28.556533829628783],"torque_nm":[0.14020020108837983,0.1419102262032626,0.42474157455415512,-0.54041354802366748,-0.53543500930553978],"angle_rad":[-545.55849082314319,716.52599217061572,-271.32526668734511,1202.1287781729675,1202.1303957964431]},"command":[-0.22806095255417821,-0.21550447646091586,-0.39883906094956906,0.45306204591922072,0.45306204591922072],"arm":{"servo_position":[-2.6370517928190542e-22,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-3.3881317890157468e-23],"servo_velocity":[-1.0842021724855044e-19,0,0,0,0,0],"servo_effort":[0.23139432085089318,-1.1862601871998943,-0.26794855354622366,0.00036113108131440426,-0.00071626640734443196,0.0003602734193296309]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":398,"step":3184,"t":15.92,"sim_time":15.920000000001089,"vehicle":{"origin_ned":[1.6547230960235735,1.1247375858449478,3.6540312048378856],"origin_quat_xyzw":[-0.021279679770488169,0.056349698316218597,0.40754134480028104,0.91119807890870508],"cg_ned":[1.5955677382895592,1.0621516098449517,3.3620045437421804],"linear_velocity_ned":[-0.0037005229243762192,-0.0075646253066840689,-0.022731589527876],"angular_velocity_ned":[0.007501855193203651,-0.0083707963276744343,0.034704114915087937]},"sensors":{"Odom":[1.6547230960235735,1.1247375858449478,3.6540312048378856,-0.0085907713209464713,0.0009045141182603873,-0.022971256057854182,-0.02127967977048819,0.056349698316218645,0.40754134480028137,0.91119807890870508,-0.0054004309452612845,-0.010924114766815908,0.034383465745990952],"Pressure":[28323.585149975119],"DVL":[0.026650477873045978,0.028398983272802797,0.018186922206654473,7.2282889779040476,0.017388535321319471,-0.017486781896850715,0.024678749417903392,0],"IMU":[0.007201791229134431,0.12032631808954192,0.84157779145550615,-0.012880466362411419,0.0017779238536354981,0.1082097251825463,1.1520818541344207,-0.053505276144110714,-9.7352518532919898],"FOG":[0.84370412525049221],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-23.782169229773352,-22.763862986171578,-41.663825911312557,47.602493290150925,47.602493290150925],"omega_rad_s":[-24.002252144683755,-24.397734025762006,-42.128999193639373,47.06989218351675,47.069601133189401],"thrust_n":[-7.3708649440811378,-7.6472497834792987,-22.404492100897787,28.879456638898493,28.622101196181671],"torque_nm":[0.13820371770152134,0.14338593344023684,0.42008422689183367,-0.54148981197934676,-0.53666439742840644],"angle_rad":[-546.52147135336588,715.55249294467978,-273.01423512640162,1204.0110994368774,1204.0127056382601]},"command":[-0.22649684980736526,-0.21679869510639599,-0.39679834201250053,0.45335707895381833,0.45335707895381833],"arm":{"servo_position":[-2.6370517928190542e-22,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-3.3881317890157373e-23],"servo_velocity":[-5.4210108624275222e-20,0,0,0,0,0],"servo_effort":[0.23387550546713401,-1.1834992547308485,-0.26753894210715107,0.00035400490122145651,-0.00073107166528491854,0.00035977363383585519]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":399,"step":3192,"t":15.960000000000001,"sim_time":15.960000000001095,"vehicle":{"origin_ned":[1.6543738700772648,1.1244205683700998,3.6531316648793402],"origin_quat_xyzw":[-0.021253094079823225,0.056124126973381622,0.40817080998161492,0.91093083065755442],"cg_ned":[1.5954014563172811,1.0618388231431337,3.3610670981977835],"linear_velocity_ned":[-0.0045090821361891634,-0.0080165852975256462,-0.023981000400559015],"angular_velocity_ned":[0.0071393881241657185,-0.0082687636018128445,0.033966654591603515]},"sensors":{"Odom":[1.6543738700772648,1.1244205683700998,3.6531316648793402,-0.0092240360899346046,0.0011949353970660934,-0.024333531904094839,-0.021253094079823238,0.056124126973381649,0.40817080998161515,0.91093083065755442,-0.0054760804072963012,-0.01059114937498546,0.033629109960345585],"Pressure":[28315.4916326241],"DVL":[0.031788358393600419,0.0464082766966534,0.032657266307519604,7.2366812034978665,0.042380856252113651,0.014255063897122775,-0.0085367403304741213,0],"IMU":[0.0071476285620718739,0.11988716247515772,0.84294287025613091,0.0212335881764051,-0.096882382589120603,0.12460852586121192,1.1622234183872897,-0.061299203080310859,-9.7429351032355296],"FOG":[0.83545646091355308],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-23.618838900457781,-22.890808516593513,-41.447017132365431,47.638804486486308,47.638804486486308],"omega_rad_s":[-23.833946994736742,-24.525431264520272,-41.906014619370247,47.10286024497708,47.102557643841699],"thrust_n":[-7.2650829688426279,-7.7167787620732913,-22.156045945805669,28.944418308525172,28.694734988483276],"torque_nm":[0.13622030566579929,0.14468960178887419,0.4154258614838563,-0.542707843284847,-0.53802628103406147],"angle_rad":[-547.47772227612563,714.57362382771407,-274.6943145588682,1205.8946282073509,1205.8962225027528]},"command":[-0.22494132286150267,-0.21800770015803345,-0.39473349649871842,0.45370289987129819,0.45370289987129819],"arm":{"servo_position":[2.7839590696084681e-22,-1.0842021724855024e-21,1.0778494253810975e-21,-1.0842021724855045e-21,-1.6940658945088655e-23,-3.3881317890157373e-23],"servo_velocity":[5.4210108624275222e-20,0,0,-2.1684043449710089e-19,0,0],"servo_effort":[0.23575433135075724,-1.1807132479150659,-0.26707211001398401,0.00035128782330376754,-0.00074505781910892915,0.00035907357805929868]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":400,"step":3200,"t":16,"sim_time":16.000000000001101,"vehicle":{"origin_ned":[1.6539958260209309,1.1240878807484496,3.652181576504347],"origin_quat_xyzw":[-0.021231285013677215,0.055903481873807177,0.40878635854334744,0.91066884558544259],"cg_ned":[1.5952033920285709,1.0615082453968006,3.3600802747685869],"linear_velocity_ned":[-0.0052927218089198523,-0.0084556847667435729,-0.02520382178350019],"angular_velocity_ned":[0.0067965197446927675,-0.0081747855099573233,0.033237188475724204]},"sensors":{"Odom":[1.6539958260209309,1.1240878807484496,3.652181576504347,-0.0098403401573138542,0.0014765260847085402,-0.025664566930018357,-0.021231285013677218,0.055903481873807184,0.40878635854334755,0.91066884558544259,-0.0055455930136916751,-0.010277849459634327,0.03288377571320255],"Pressure":[28307.584322034578],"DVL":[-0.017005963525757999,-0.019561747220919936,0.026761782278114585,7.3115383935213272,-0.026907424341440677,-0.026775466351330698,-0.025211576775508351,0],"IMU":[0.0070863855281218567,0.11946117314367113,0.84427780305684674,0.062397863487394886,0.05729510279569635,0.21764259843755349,1.1333363722292329,-0.059758328577540133,-9.7630884864410596],"FOG":[0.83391173517036055],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-23.456925774739208,-23.011680526325001,-41.227238824430543,47.680419800257042,47.680419800257042],"omega_rad_s":[-23.665957493867051,-24.640449008177129,-41.680956188403101,47.141980673160049,47.141667740945756],"thrust_n":[-7.1603262803537993,-7.7789145427281108,-21.907198822650848,29.01649513435013,28.774001977409348],"torque_nm":[0.13425611775663374,0.14585464767615211,0.41075997792470342,-0.54405928376906509,-0.53951253707642532],"angle_rad":[-548.42724676308194,713.58994362540284,-276.36542816816245,1207.7796168499406,1207.7811988048973]},"command":[-0.22339929309275436,-0.2191588621554762,-0.39264036975648137,0.45409923619292419,0.45409923619292419],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,2.1345230270808515e-21],"servo_velocity":[0,0,0,0,0,4.3368086899420177e-19],"servo_effort":[0.23694994537049713,-1.1779217514178955,-0.26655273485603415,0.00034811704226722038,-0.00075816891624465148,0.00035818273152565013]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":401,"step":3208,"t":16.039999999999999,"sim_time":16.040000000001093,"vehicle":{"origin_ned":[1.6535898632079249,1.1237398475744007,3.6511820654580043],"origin_quat_xyzw":[-0.021213940899752808,0.055687478635798898,0.40938818910952712,0.91041209573045057],"cg_ned":[1.5949745446385992,1.0611604047739231,3.3590451295888553],"linear_velocity_ned":[-0.0060513567534362985,-0.0088813326414115702,-0.026400395894344095],"angular_velocity_ned":[0.0064750152526301544,-0.0080859132206141122,0.032517473824775787]},"sensors":{"Odom":[1.6535898632079249,1.1237398475744007,3.6511820654580043,-0.010438951766019628,0.0017486211636382773,-0.026964729299933168,-0.021213940899752821,0.055687478635798933,0.4093881891095274,0.91041209573045057,-0.0056058699016425344,-0.0099835825805397131,0.032149591297269658],"Pressure":[28298.367994923734],"DVL":[-0.0071581354385330895,-0.032811062383348431,0.011528306261187223,7.2763409183289278,-0.0019648928902320241,0.031462348075855143,-0.027438637536927657,0],"IMU":[0.0070184677935061033,0.11904757962128082,0.84558300410743636,0.023725536531531258,0.03666836186870271,-0.12780869553784688,1.1406663050548489,-0.037653676660821492,-9.7877100357120597],"FOG":[0.84721039913491258],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-23.297115620948716,-23.128930057240634,-41.004142050099993,47.72741185029161,47.72741185029161],"omega_rad_s":[-23.498873227362662,-24.745689086081203,-41.453459268872216,47.187009505071721,47.186687420652476],"thrust_n":[-7.0569380915769564,-7.835412590835463,-21.657597087444596,29.095417311766575,28.859649374071598],"torque_nm":[0.13231758921706799,0.14691398607816494,0.40607994538958625,-0.54553907459562334,-0.5411184257638425],"angle_rad":[-549.37007071484334,712.6018929089272,-278.02748466181282,1209.6663055679285,1209.6678747958665]},"command":[-0.22187729162808301,-0.22027552435467271,-0.39051563857238092,0.45454677952658673,0.45454677952658673],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-3.3881317890157373e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.23739654919075087,-1.1751370917979174,-0.26598561281423511,0.00034454831930889684,-0.00077038612671130905,0.00035711437387442096]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":402,"step":3216,"t":16.080000000000002,"sim_time":16.080000000001085,"vehicle":{"origin_ned":[1.6531569148528846,1.1233767953611917,3.6501342394089691],"origin_quat_xyzw":[-0.021200693010606904,0.055475875941720418,0.40997652986183097,0.91016053681030351],"cg_ned":[1.5947159127851844,1.0607958494729095,3.3579627041419826],"linear_velocity_ned":[-0.0067850708453889089,-0.0092930897219878159,-0.027571074479096836],"angular_velocity_ned":[0.0061766646481907304,-0.0079986948459159039,0.031808776104859743]},"sensors":{"Odom":[1.6531569148528846,1.1233767953611917,3.6501342394089691,-0.011019275317045215,0.0020104197473971592,-0.028234436099103515,-0.021200693010606914,0.055475875941720446,0.4099765298618312,0.91016053681030351,-0.0056533575318944516,-0.009707417748801973,0.031428237812041016],"Pressure":[28291.987676584024],"DVL":[0.001686904004613968,-0.012732033100386765,0.035092687006774828,7.1595827370872849,-0.0016279378661583049,-0.020041151761458622,0.023817885801837361,0],"IMU":[0.0069444216468008968,0.11864564156514956,0.84685896273767558,0.028084046810032418,0.0010456075860538153,0.11702835078023081,1.1388468032828563,-0.065228475848725986,-9.7980734463925501],"FOG":[0.83995738180417856],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-23.140270358469206,-23.244593211300863,-40.777461252630218,47.779913377280991,47.779913377280991],"omega_rad_s":[-23.33337175452165,-24.843836618009014,-41.223180926512782,47.237822042064884,47.237491936896525],"thrust_n":[-6.955303454972074,-7.8879216539883235,-21.406916431466069,29.181059646470278,28.951574816936624],"torque_nm":[0.1304119397807264,0.14789853101228109,0.40137968308998884,-0.54714486837131782,-0.54284202781756175],"angle_rad":[-550.30624553058647,711.60980092506463,-279.68037860531581,1211.5549275863148,1211.5564837467718]},"command":[-0.22038352722351623,-0.22137707820286537,-0.38835677383457351,0.45504679406934279,0.45504679406934279],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,-8.6736173798840355e-19],"servo_effort":[0.23705946569919908,-1.1723671157624613,-0.26537273433276276,0.00034083208703622302,-0.00078169425241118124,0.00035587251749308319]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":403,"step":3224,"t":16.120000000000001,"sim_time":16.120000000001077,"vehicle":{"origin_ned":[1.6526979497196765,1.1229990486958585,3.6490391959759512],"origin_quat_xyzw":[-0.021191111503280079,0.055268485671785356,0.41055162897538766,0.9099141120075338],"cg_ned":[1.5944284887185789,1.0604151444840908,3.3568340345234695],"linear_velocity_ned":[-0.007494112310452627,-0.0096905230564111895,-0.028715727668589687],"angular_velocity_ned":[0.0059031313934491637,-0.0079091241119733646,0.031111770154076984]},"sensors":{"Odom":[1.6526979497196765,1.1229990486958585,3.6490391959759512,-0.01158075315855011,0.0022610909406368777,-0.029473660354867023,-0.021191111503280086,0.055268485671785376,0.41055162897538783,0.9099141120075338,-0.0056840966442301636,-0.0094479801900765707,0.030720842473050965],"Pressure":[28284.6885869611],"DVL":[0.018530503602727077,0.02871010843838747,0.015257414376354167,7.261045737832923,-0.010360752280362057,-0.0085670423253213206,-0.029968434998611428,0],"IMU":[0.0068649487585809464,0.11825466363457209,0.84810622362347921,0.02933882402032531,0.060267937217456977,-0.0059671129112216642,1.1512634366800645,-0.038924740068168151,-9.8005109461996458],"FOG":[0.85331320767744645],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-22.987418050295499,-23.360370899666666,-40.547045464555495,47.837993344058319,47.837993344058319],"omega_rad_s":[-23.170247120753118,-24.937310319379872,-40.989826410644099,47.294365457935029,47.294028407505451],"thrust_n":[-6.8558637774448057,-7.9379443098728455,-21.154890199484221,29.273373750142706,29.049762007485782],"torque_nm":[0.1285474458270901,0.1488364558101159,0.39665419124032919,-0.54887575781517584,-0.5446830376403583],"angle_rad":[-551.23585231458912,710.61389551328966,-281.32399184639752,1213.445712965452,1213.4472557619981]},"command":[-0.21892779095519524,-0.22247972285396825,-0.38616233775767139,0.45559993661007925,0.45559993661007925],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[5.4210108624275222e-20,0,0,0,0,0],"servo_effort":[0.23590281325597742,-1.1696681044237136,-0.26471889416233996,0.00033697872351322279,-0.00079210442120618643,0.00035444114838148954]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":404,"step":3232,"t":16.16,"sim_time":16.16000000000107,"vehicle":{"origin_ned":[1.6522139690191686,1.1226069330702388,3.6478980469015094],"origin_quat_xyzw":[-0.021184704028388845,0.055065184518634097,0.41111374279118773,0.90967275668636982],"cg_ned":[1.5941132473206729,1.0600188734282887,3.3556601772480597],"linear_velocity_ned":[-0.0081790097294278958,-0.010073213563924471,-0.029833801949655379],"angular_velocity_ned":[0.0056558583020208377,-0.0078127597834132239,0.03042648392636102]},"sensors":{"Odom":[1.6522139690191686,1.1226069330702388,3.6478980469015094,-0.01212294076654705,0.0024998938932895647,-0.030681998482485102,-0.021184704028388852,0.055065184518634118,0.41111374279118784,0.90967275668636982,-0.0056938652921957392,-0.0092034611423233818,0.030027904917310427],"Pressure":[28273.658525383969],"DVL":[0.0079087916727419941,0.068720589394677456,0.034158330212541561,7.1624963891311149,-0.018054074611492506,0.015264298957915153,0.0094852192277712251,0],"IMU":[0.0067809170612309422,0.11787401525186758,0.84932536192944363,0.032756509488093319,-0.045629242889966948,0.10229473544511784,1.1390829611441085,-0.033507545812474247,-9.7598731548959492],"FOG":[0.84005217567107715],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-22.839476897869517,-23.477536868896312,-40.312927827345533,47.901345026854052,47.901345026854052],"omega_rad_s":[-23.010363050197231,-25.028213340407724,-40.753192585845326,47.356533478956635,47.356190490391235],"thrust_n":[-6.7590860609436154,-7.9867982015751604,-20.901352205402443,29.37223214182314,29.154126501490477],"torque_nm":[0.12673286364269279,0.14975246627953426,0.39190035385129579,-0.55072935265918399,-0.54663987190294649],"angle_rad":[-552.15900580028313,709.61431479007194,-282.95819642737155,1215.338888834199,1215.3404180119312]},"command":[-0.21751882759875729,-0.22359558922758394,-0.38393264597471938,0.45620328597003862,0.45620328597003862],"arm":{"servo_position":[-2.6370517928190542e-22,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[-5.4210108624275222e-20,0,0,0,0,0],"servo_effort":[0.23384954117766588,-1.1669906733477093,-0.26401865369577571,0.00033335303055574727,-0.00080160323728644203,0.00035282916528900989]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":405,"step":3240,"t":16.199999999999999,"sim_time":16.200000000001062,"vehicle":{"origin_ned":[1.6517060066245539,1.1222007631290321,3.6467118950557262],"origin_quat_xyzw":[-0.021180916125328051,0.054865917555274805,0.4116631258449277,0.90943640278058624],"cg_ned":[1.5937711433810888,1.0596076265775196,3.3544421867231287],"linear_velocity_ned":[-0.0088402677664790041,-0.010441152661344058,-0.030925690272167343],"angular_velocity_ned":[0.0054361779774477264,-0.0077051860517134262,0.029752444449989337]},"sensors":{"Odom":[1.6517060066245539,1.1222007631290321,3.6467118950557262,-0.012645556183781654,0.0027257702498431693,-0.03186001941536773,-0.021180916125328058,0.054865917555274819,0.41166312584492787,0.90943640278058624,-0.0056784660202846751,-0.0089720040807302979,0.029349412946012045],"Pressure":[28266.941417342725],"DVL":[-0.023589589809050633,0.0036795833831526781,0.039053911485056277,7.2240646764919578,-0.058221105597989382,0.0033037129544953685,0.02744483399588599,0],"IMU":[0.0066933619832260901,0.1175031371216195,0.85051696149282519,-0.033357445682924779,-0.0031351516452822088,0.034325716271293841,1.1528473452469803,-0.064082488360580489,-9.7588680606877478],"FOG":[0.86047009721505996],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-22.697652109363187,-23.596936991480234,-40.07525812241694,47.969986207344455,47.969986207344455],"omega_rad_s":[-22.854676985613711,-25.118285359620995,-40.513185372886205,47.424215784496617,47.423867785104946],"thrust_n":[-6.665481432832201,-8.0355816593154366,-20.646253091303755,29.477521936527822,29.264599971548833],"torque_nm":[0.12497777686560378,0.15066715611216444,0.38711724546194548,-0.55270353630989666,-0.5487112494665406],"angle_rad":[-553.07585703405687,708.61112096310444,-284.58285876303279,1217.2346773861334,1217.2361927286684]},"command":[-0.21616811532726843,-0.2247327332521927,-0.38166912497539945,0.45685701149851859,0.45685701149851859],"arm":{"servo_position":[2.7839590696084681e-22,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[1.0842021724855044e-19,0,0,0,-1.7347234759768071e-18,0],"servo_effort":[0.23078870602461768,-1.1642184059294507,-0.26325855517037083,0.0003303990700197542,-0.00079689364135072927,0.00035151968068687786]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":406,"step":3248,"t":16.240000000000002,"sim_time":16.240000000001054,"vehicle":{"origin_ned":[1.6511751320874946,1.121780841484781,3.6454818372689997],"origin_quat_xyzw":[-0.021179136614688746,0.054670702170587233,0.41220002062601863,0.90920498320914467],"cg_ned":[1.5934031126909989,1.0591819966772584,3.3531811189413983],"linear_velocity_ned":[-0.0094782682924297729,-0.010794157298704464,-0.031990747847955477],"angular_velocity_ned":[0.0052448470361617832,-0.0075818727500328188,0.029088619257112498]},"sensors":{"Odom":[1.6511751320874946,1.121780841484781,3.6454818372689997,-0.013148079810119357,0.0029377237975951598,-0.033007259998406133,-0.021179136614688749,0.054670702170587247,0.41220002062601874,0.90920498320914467,-0.0056339202838575075,-0.0087512616890057879,0.028684758081625163],"Pressure":[28255.35649366643],"DVL":[0.0088598497895458865,0.0036279448705831292,0.025531853518404195,7.218725411274141,0.020835421255286576,0.030663475311900057,0.0051419591708643944,0],"IMU":[0.006603478843509712,0.11714155257429291,0.85168159199264704,0.028061432606903726,-0.03358373928437805,0.017959346843004733,1.1133602739430322,-0.075728872671110087,-9.7294238396791215],"FOG":[0.86745748766066932],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-22.563281370980437,-23.719034076982684,-39.834365543627804,48.043993547239928,48.043993547239928],"omega_rad_s":[-22.704288349424996,-25.208883552907871,-40.269835053297705,47.49737814248499,47.497025970018079],"thrust_n":[-6.5756294129757036,-8.0851591470029796,-20.389676375035961,29.589204261916823,29.38119783703775],"torque_nm":[0.12329305149329446,0.15159673400630586,0.38230643203192421,-0.55479757991094036,-0.55089745944445778],"angle_rad":[-553.9865987225254,707.60431540103559,-286.19784422844839,1219.1332984074297,1219.1347997334994]},"command":[-0.21488839400933749,-0.22589556263793031,-0.37937490993931244,0.45756184330704691,0.45756184330704691],"arm":{"servo_position":[-2.6370517928190542e-22,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[-5.4210108624275222e-20,0,0,0,0,0],"servo_effort":[0.2266564574877703,-1.1614946287407915,-0.26243817663126362,0.00032724263335718782,-0.00081789532004405865,0.00034901992929754934]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":407,"step":3256,"t":16.280000000000001,"sim_time":16.280000000001046,"vehicle":{"origin_ned":[1.6506224593520082,1.1213474749536436,3.6442090079977962],"origin_quat_xyzw":[-0.02117870900824232,0.054479633333199336,0.41272464746138443,0.90897843605582862],"cg_ned":[1.5930100796475324,1.0587425886053123,3.3518780766181067],"linear_velocity_ned":[-0.010093340675097203,-0.011131964289086969,-0.033027906583379542],"angular_velocity_ned":[0.0050820443575035129,-0.0074385366872608211,0.028433494364118041]},"sensors":{"Odom":[1.6506224593520082,1.1213474749536436,3.6442090079977962,-0.013629866401557699,0.0031348912557628366,-0.034122837814879195,-0.021178709008242331,0.054479633333199363,0.4127246474613846,0.90897843605582862,-0.005556747739364671,-0.0085386299837679307,0.028032783615172009],"Pressure":[28243.157023264263],"DVL":[-0.0015250184926250928,0.041211002972346762,0.059276020081021889,7.2566539427087235,0.042466131857934387,0.004507894313800288,-0.0014340664038378791,0],"IMU":[0.0065126054115049884,0.11678888636205767,0.85281978600245267,-0.027411487378389714,0.015833135926264751,-0.0030664821039220087,1.1098039153009078,-0.063748524910672885,-9.8059677565011114],"FOG":[0.86462949730754546],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-22.437651636179279,-23.844273276259589,-39.590993483462363,48.122687988598159,48.122687988598159],"omega_rad_s":[-22.56038135633889,-25.301073439049638,-40.023381656050347,47.575823603353399,47.57546799245555],"thrust_n":[-6.4901434839527576,-8.1362171077760426,-20.131922250036702,29.707022180548694,29.503726303996476],"torque_nm":[0.12169019032411423,0.15255407077080083,0.37747354218818818,-0.55700666588528802,-0.55319486819993391],"angle_rad":[-554.8914696344483,706.59385212415702,-287.80302396390761,1221.0349672046216,1221.0364543641917]},"command":[-0.21369192034456455,-0.22708831691675799,-0.37705708079487965,0.45831131417712534,0.45831131417712534],"arm":{"servo_position":[-2.6370517928190542e-22,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[-5.4210108624275222e-20,0,0,0,0,0],"servo_effort":[0.22141331322160671,-1.1587103433164414,-0.26154700077966403,0.00032384396330007798,-0.00082465251689846331,0.00034675505251744636]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":408,"step":3264,"t":16.32,"sim_time":16.320000000001038,"vehicle":{"origin_ned":[1.6500491290971548,1.1209009661658882,3.6428945428457467],"origin_quat_xyzw":[-0.021178942584745696,0.054292875779578934,0.4132371963408501,0.90875670869101643],"cg_ned":[1.5925929456075349,1.0582900075630635,3.350534172116642],"linear_velocity_ned":[-0.010686195547636964,-0.011454700296361855,-0.034037320544993734],"angular_velocity_ned":[0.0049476184008233363,-0.007271643425125705,0.027785194398969072]},"sensors":{"Odom":[1.6500491290971548,1.1209009661658882,3.6428945428457467,-0.014090741594370378,0.0033166220714999878,-0.03520713448591542,-0.021178942584745702,0.054292875779578947,0.41323719634085021,0.90875670869101643,-0.0054441939530651684,-0.0083317606842816787,0.027391883283777854],"Pressure":[28232.628049138249],"DVL":[-0.018188398432373364,-0.045341847164094187,0.046473558439296611,7.1881568978283585,0.005990983683149799,0.01839261876593477,0.0088089141646021437,0],"IMU":[0.0064221944631662068,0.11644485939532934,0.85393201899102888,-0.02423303647582245,-0.005001683139089233,0.049713360810868412,1.1218084596961804,-0.054133450807335615,-9.7745070884324594],"FOG":[0.86361042723152259],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-22.321915797242252,-23.972500999885931,-39.345916089854178,48.205969865614293,48.205969865614293],"omega_rad_s":[-22.424158900649584,-25.395575448899731,-39.774254644356333,47.659321042988815,47.658962616747708],"thrust_n":[-6.409633514793498,-8.1892220840827861,-19.873471728858586,29.83070587443078,29.631973239571245],"torque_nm":[0.12018062840237806,0.15354791407655224,0.37262759491609854,-0.55932573514557715,-0.55559949824196098],"angle_rad":[-555.79075651512608,705.57964999625005,-289.39828327637008,1222.9398895426175,1222.9413624125434]},"command":[-0.21258967425945002,-0.22830953333224696,-0.37472301037956363,0.45910447491061229,0.45910447491061229],"arm":{"servo_position":[-2.6370517928190542e-22,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[-1.0842021724855044e-19,0,0,0,0,0],"servo_effort":[0.21506064121277871,-1.1557760607952441,-0.2605804425006833,0.00032025973612755663,-0.00083053429090631571,0.00034429441334585568]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":409,"step":3272,"t":16.359999999999999,"sim_time":16.36000000000103,"vehicle":{"origin_ned":[1.6494561878400282,1.1204417011616938,3.6415395655156808],"origin_quat_xyzw":[-0.021179351403451979,0.054110547442101281,0.41373775528981671,0.90853979196146872],"cg_ned":[1.5921525817410551,1.0578248532071695,3.3491505120073275],"linear_velocity_ned":[-0.011257616774788273,-0.011762509818322954,-0.035019141444004052],"angular_velocity_ned":[0.0048238691896036832,-0.0070987949977229965,0.02713565462703527]},"sensors":{"Odom":[1.6494561878400282,1.1204417011616938,3.6415395655156808,-0.014530804471132258,0.0034898255441160012,-0.036260493604165778,-0.021179351403451983,0.054110547442101295,0.41373775528981677,0.90853979196146872,-0.0053200588345212931,-0.008129013567185801,0.026751120889368107],"Pressure":[28220.798860863259],"DVL":[-0.0017586365337366396,-0.0013402116692180707,0.05113578123908985,7.2591243573002568,0.012211429944823229,0.0171695085589697,-0.003990429461752789,0],"IMU":[0.0063332705122938352,0.11610927507911885,0.8550185186929925,0.099807561564538544,-0.0068439156159015163,-0.069702389671343651,1.1175520056215507,-0.055131650851677934,-9.7583432800089831],"FOG":[0.86566242003742999],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-22.214631902641731,-24.101393075378056,-39.101071857642509,48.293883838143294,48.293883838143294],"omega_rad_s":[-22.296325691167471,-25.492380604277749,-39.523227589040225,47.747730926527225,47.747370195888323],"thrust_n":[-6.3344330252798375,-8.2441501476638983,-19.615174645782339,29.960105689834059,29.765832589456995],"torque_nm":[0.11877061922399698,0.1545778152686981,0.36778452460841882,-0.56175198168438867,-0.55810936105231879],"angle_rad":[-556.68478747995914,704.56161245184887,-290.98353050607341,1224.8482641440496,1224.8497226235684]},"command":[-0.2115679228823022,-0.22953707690836245,-0.37239116054897625,0.45994175083945993,0.45994175083945993],"arm":{"servo_position":[-2.6370517928190542e-22,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[-5.4210108624275222e-20,0,0,0,0,0],"servo_effort":[0.20733582945681012,-1.1528992746678675,-0.25958332248443999,0.00031608717901549025,-0.00083559339901643169,0.0003416948078689637]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":410,"step":3280,"t":16.399999999999999,"sim_time":16.400000000001022,"vehicle":{"origin_ned":[1.6488444912615763,1.1199702109713268,3.6401451909993634],"origin_quat_xyzw":[-0.021179825365508696,0.053932613610386738,0.41422628746848211,0.90832773323108318],"cg_ned":[1.5916898291624819,1.0573477172146408,3.3477281952428766],"linear_velocity_ned":[-0.011808313216175257,-0.012055650614953114,-0.035973578527725467],"angular_velocity_ned":[0.0047045462643071209,-0.0069266544912045709,0.026483080173824999]},"sensors":{"Odom":[1.6488444912615763,1.1199702109713268,3.6401451909993634,-0.014950581942708999,0.0036572333762305929,-0.037283253541878628,-0.021179825365508692,0.053932613610386732,0.414226287468482,0.90832773323108318,-0.0051932112438096362,-0.0079300858103657206,0.026107645039416684],"Pressure":[28209.433409184083],"DVL":[-0.012946823493176829,0.024107891460780184,0.036911982936727705,7.1656078210004273,-0.019372752006626411,-0.030793967011291699,-0.0121047771297613,0],"IMU":[0.006246026123279614,0.1157819700454719,0.85607918939691519,0.03927466649939116,0.023969418469110375,-0.057968017232359705,1.1182628519944853,-0.050564357445100315,-9.7425048394703158],"FOG":[0.82097827150623892],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-22.10871499167801,-24.225208820773364,-38.860218137617196,48.386461593419362,48.386461593419362],"omega_rad_s":[-22.175037232502344,-25.589495257180442,-39.272144324092849,47.840969996074875,47.840607377134731],"thrust_n":[-6.2634231775374012,-8.2997002038885981,-19.358904002144261,30.095156945891091,29.905250859411609],"torque_nm":[0.11743918457882625,0.15561937882291124,0.36297945004020488,-0.56428419273545793,-0.56072345361396769],"angle_rad":[-557.57385936789387,703.53969093699823,-292.55873099563576,1226.7602854952447,1226.761729501809]},"command":[-0.21055919039693344,-0.23071627448355583,-0.37009731559635423,0.46082344374685108,0.46082344374685108],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.19955477116307055,-1.1502607120643233,-0.25859738919610858,0.00031172921578216699,-0.00083992448069874397,0.0003390156138869509]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":411,"step":3288,"t":16.440000000000001,"sim_time":16.440000000001014,"vehicle":{"origin_ned":[1.6482148583023517,1.1194870359848528,3.6387125413131343],"origin_quat_xyzw":[-0.021180293475457995,0.053759037164579832,0.4147027626785848,0.90812057553949299],"cg_ned":[1.5912055039297508,1.0568591797025204,3.346268330115997],"linear_velocity_ned":[-0.012338833273114164,-0.012334410593835476,-0.036899885933012293],"angular_velocity_ned":[0.0045887203948680906,-0.0067546096749972568,0.025828589841983485]},"sensors":{"Odom":[1.6482148583023517,1.1194870359848528,3.6387125413131343,-0.015350386722383133,0.0038190720873880063,-0.038274834093126583,-0.021180293475458006,0.053759037164579866,0.41470276267858502,0.90812057553949299,-0.0050639351911644058,-0.0077338720306891918,0.025462540009627242],"Pressure":[28199.23149789028],"DVL":[-0.0082694207201826457,0.025932785729320732,0.040072640449161749,7.253544807497974,0.011077931624401722,-0.019466431339950702,0.0073982100826316044,0],"IMU":[0.0061605803488741801,0.1154628088418085,0.85711394675998254,-0.056441680675783409,-0.0040695170696591143,0.034337347278831941,1.1210053536804521,-0.052829643410651737,-9.7332488242782471],"FOG":[0.85406166422489238],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-22.00399081978167,-24.344508766842001,-38.623220195836836,48.483603397379738,48.483603397379738],"omega_rad_s":[-22.058610230544684,-25.68541558582907,-39.022405640427138,47.938967486102257,47.938603320204557],"thrust_n":[-6.1955925387477233,-8.3548896750177573,-19.106019566785584,30.235788474543632,30.050181314781799],"torque_nm":[0.11616736010151982,0.15665418140658294,0.35823786687722964,-0.56692103389769333,-0.56344089965215882],"angle_rad":[-558.4581941013156,702.51390953541954,-294.12391596838592,1228.6761453091283,1228.6775747751228]},"command":[-0.20956181733125401,-0.23185246444611429,-0.36784019234130322,0.46174860378456895,0.46174860378456895],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.19183588335918725,-1.1478701667563918,-0.25760931878510934,0.00030716041366898091,-0.00084353350722467734,0.00033619327291959549]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":412,"step":3296,"t":16.48,"sim_time":16.480000000001006,"vehicle":{"origin_ned":[1.6475680940822035,1.1189927135448825,3.6372427658987956],"origin_quat_xyzw":[-0.021180688612732982,0.05358979863332098,0.41516716868536641,0.90791835203288351],"cg_ned":[1.5907004017923081,1.0563598098097222,3.3447720554429603],"linear_velocity_ned":[-0.0128496929576844,-0.012599071387012344,-0.037797632085967085],"angular_velocity_ned":[0.0044764550698699283,-0.0065817679878810657,0.025173083380861383]},"sensors":{"Odom":[1.6475680940822035,1.1189927135448825,3.6372427658987956,-0.015730638479057663,0.0039752803793730975,-0.039234933987186658,-0.021180688612732989,0.053589798633320994,0.41516716868536652,0.90791835203288351,-0.004931629121242947,-0.0075398346714362864,0.02481677606129724],"Pressure":[28183.846005072846],"DVL":[0.035021631258512868,0.0096272795796505176,0.02908043671205791,7.2629606036396162,-0.025687328959485702,-0.014478309343429479,0.0010026456772191101,0],"IMU":[0.0060770614436226672,0.11515169124667725,0.85812274793001864,0.0019002885433319966,0.047458838445780707,0.038945669330178595,1.1215665523022296,-0.051158796246169383,-9.7121597321404298],"FOG":[0.86281508245193583],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-21.900415654440067,-24.460004935659036,-38.389962417248448,48.584793498727372,48.584793498727372],"omega_rad_s":[-21.945871389923479,-25.779365341330355,-38.774917212973072,48.041518285520723,48.041152846307455],"thrust_n":[-6.130237837309962,-8.409200394698555,-18.857361039684857,30.381765535335781,30.200406648833756],"torque_nm":[0.11494195944956179,0.15767250740059793,0.35357551949409111,-0.56965810378754589,-0.56625762466563301],"angle_rad":[-559.33795817296209,701.48433513718135,-295.67916088416064,1230.5960295110915,1230.5974443809955]},"command":[-0.20857538718514351,-0.23295242795865748,-0.36561868968808048,0.46271231903549875,0.46271231903549875],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.18408112500939794,-1.1457433465172449,-0.25663658074325191,0.00030232413178326212,-0.00084648375160907736,0.00033329028627115709]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":413,"step":3304,"t":16.52,"sim_time":16.520000000000998,"vehicle":{"origin_ned":[1.6469049891609349,1.1184877666692383,3.6357370122138093],"origin_quat_xyzw":[-0.021180933006438984,0.053424890803152075,0.41561950795591157,0.90772108806953133],"cg_ned":[1.5901752963475877,1.0558501638743392,3.3432405093276572],"linear_velocity_ned":[-0.013341461109981216,-0.012849976166844402,-0.038667008432170559],"angular_velocity_ned":[0.0043679968230601832,-0.0064073985156566935,0.024517272255811171]},"sensors":{"Odom":[1.6469049891609349,1.1184877666692383,3.6357370122138093,-0.016091839900699342,0.00412578221135846,-0.040163865893333567,-0.021180933006438991,0.053424890803152089,0.41561950795591174,0.90772108806953133,-0.0047956698423131071,-0.0073476837041729056,0.024171137453525688],"Pressure":[28171.670137602909],"DVL":[0.026841847988755677,-0.0035593312330341985,0.055225023160805402,7.224779559259761,-0.008072517279580008,-0.0020812183368864013,-0.0098102477222357792,0],"IMU":[0.0059956285111605803,0.11484853036047435,0.85910558502378742,-0.042996758513300135,0.026677070220921754,0.0047448602482910648,1.1141737974443064,-0.032102538155418331,-9.7381595900297473],"FOG":[0.85388675665452407],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-21.79817538572027,-24.572188729768556,-38.16028970096044,48.689970776818129,48.689970776818129],"omega_rad_s":[-21.836080257859244,-25.870998355687256,-38.530238723359041,48.148428571615192,48.148062078782729],"thrust_n":[-6.0669118809192479,-8.4623902100036332,-18.613409611151976,30.53288570806917,30.355733049281966],"torque_nm":[0.11375459776723588,0.15866981643756811,0.34900143020909952,-0.57249160702629698,-0.56916999467403684],"angle_rad":[-560.21328133342661,700.45105524920621,-297.22456921788233,1232.52011563316,1232.5215158611395]},"command":[-0.20760167034019306,-0.23402084504541482,-0.36343133048533754,0.4637140073982679,0.4637140073982679],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.17629620215399314,-1.143841338246268,-0.25567693619094906,0.00029737673949079642,-0.00084881013404771995,0.00033032083740579585]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":414,"step":3312,"t":16.559999999999999,"sim_time":16.56000000000099,"vehicle":{"origin_ned":[1.6462263175126981,1.1179727034216536,3.6341964193835747],"origin_quat_xyzw":[-0.021180941247632954,0.05326431667156073,0.41605979467626897,0.90752880260150237],"cg_ned":[1.589630938528753,1.0553307839697175,3.3416748226829931],"linear_velocity_ned":[-0.013814702569715493,-0.013087490314276543,-0.039508185181488978],"angular_velocity_ned":[0.0042634525576275943,-0.006230888007632448,0.023861733072005946]},"sensors":{"Odom":[1.6462263175126981,1.1179727034216536,3.6341964193835747,-0.016434502698135969,0.0042705305848414806,-0.041061922469605314,-0.021180941247632971,0.053264316671560771,0.4160597946762693,0.90752880260150237,-0.004655596148241398,-0.0071571032108503031,0.023526253344044776],"Pressure":[28156.997525055096],"DVL":[0.022864298562594976,0.012089951234790324,0.028329087307574562,7.2627374217700913,0.0096170304977517482,-0.012760642336165764,-0.068974255895818862,0],"IMU":[0.0059164639214802145,0.1145532513650416,0.86006247808622927,-0.093120044709971039,0.014265837286814544,-0.19345214503126296,1.1032539440567493,-0.048357186893796693,-9.7531696501923957],"FOG":[0.86726119942792257],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-21.697411096159509,-24.681430140269544,-37.934088222943835,48.799117184660666,48.799117184660666],"omega_rad_s":[-21.728784838096665,-25.960211428744998,-38.288705285221972,48.259562117082233,48.259194747513149],"thrust_n":[-6.0053369509534757,-8.5143737733288791,-18.374416115291456,30.689017422904538,30.51603786329045],"torque_nm":[0.1126000678303777,0.15964450824991649,0.34452030216171481,-0.57541907667946024,-0.57217570993669598],"angle_rad":[-561.08427060920076,699.41416533703671,-298.76026145063469,1234.4485748371446,1234.4499603851621]},"command":[-0.20664201043961436,-0.23506123943113852,-0.36127703069470318,0.46475349699676827,0.46475349699676827],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,-3.4694469519536142e-18,0],"servo_effort":[0.16849494678236032,-1.1421574977801974,-0.25473132619529221,0.00029225461578656929,-0.00083768897147046674,0.00032774260058335161]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":415,"step":3320,"t":16.600000000000001,"sim_time":16.600000000000982,"vehicle":{"origin_ned":[1.6455328358787713,1.1174480172585328,3.6326221190711467],"origin_quat_xyzw":[-0.021180622962224987,0.053108088537461448,0.4164880523975627,0.90734150921960699],"cg_ned":[1.5890680568531004,1.0548021972616712,3.3400761201278693],"linear_velocity_ned":[-0.014269973989354943,-0.013311990925735193,-0.040321309472161983],"angular_velocity_ned":[0.0041628208113894394,-0.0060517389504251753,0.023206932675558328]},"sensors":{"Odom":[1.6455328358787713,1.1174480172585328,3.6326221190711467,-0.016759143557125412,0.004409507050741863,-0.041929372361156084,-0.021180622962225001,0.053108088537461476,0.41648805239756292,0.90734150921960699,-0.0045110901236212631,-0.0069677728141377456,0.022882625582455723],"Pressure":[28142.679178677321],"DVL":[0.0027223428664229273,0.0026507330348954136,0.056194894905304806,7.2445530902409612,0.033464329282315644,0.0062490251760623583,-0.0096576536308487591,0],"IMU":[0.0058397673876784684,0.11426579208985489,0.8609934695852739,0.029531715470958467,-0.031188543167856637,-0.20851153273075396,1.1027324031939156,-0.050065560015120733,-9.766864888681928],"FOG":[0.83968857247556783],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-21.59825148499192,-24.78801123147241,-37.711275417189036,48.912199893019753,48.912199893019753],"omega_rad_s":[-21.623722829813744,-26.047034204055219,-38.050511323086141,48.374816867428841,48.37444876272167],"thrust_n":[-5.9453457823620512,-8.5651525068624519,-18.140489207593689,30.850070752538617,30.681240129579383],"torque_nm":[0.11147523341928849,0.160596609503671,0.34013417264238166,-0.57843882661009893,-0.57527325242961336],"angle_rad":[-561.95101947145292,698.37376175005454,-300.2863680918266,1236.3815736637355,1236.3829445000131]},"command":[-0.20569763319039924,-0.2360762974425944,-0.35915500397322891,0.46583047517161669,0.46583047517161669],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.16067664607307328,-1.1406897193138237,-0.25380171884259384,0.00028690850776668444,-0.00085174685552563516,0.00032421177627006204]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":416,"step":3328,"t":16.640000000000001,"sim_time":16.640000000000974,"vehicle":{"origin_ned":[1.6448252827558356,1.116914187887643,3.6310152365131354],"origin_quat_xyzw":[-0.021179885959796987,0.052956226437834757,0.41690431205928213,0.90715921706091451],"cg_ned":[1.5884873578182961,1.0542649157458814,3.33844552098356],"linear_velocity_ned":[-0.014707820850018915,-0.013523858210806726,-0.041106502928683494],"angular_velocity_ned":[0.0040659874904086877,-0.0058696049230712579,0.022553247700118691]},"sensors":{"Odom":[1.6448252827558356,1.116914187887643,3.6310152365131354,-0.017066281653966297,0.0045427355177078731,-0.042766455944894491,-0.021179885959796994,0.052956226437834777,0.4169043120592823,0.90715921706091451,-0.0043620089703963836,-0.0067793866824776032,0.022240645044594332],"Pressure":[28129.055266827872],"DVL":[0.0009637314954362864,0.0064160221187518594,0.074314063905041722,7.1989163413213575,0.021832172245178812,-0.0098504373612296348,0.016694524216573775,0],"IMU":[0.0057657486765129769,0.11398610280199233,0.86189861963450531,0.061451831531903763,0.026445215997912833,0.064190497480123898,1.1044171774422165,-0.049169009461299422,-9.7582228572621563],"FOG":[0.8802983500465722],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-21.500788866562427,-24.892137924419742,-37.491798118718407,49.029169111924929,49.029169111924929],"omega_rad_s":[-21.520750080065781,-26.131559643694587,-37.815766127061501,48.494108387936514,48.493739659724],"thrust_n":[-5.8868394690445678,-8.6147699807904488,-17.91165315667314,31.015977149503438,30.851279936207881],"torque_nm":[0.11037824004458568,0.16152693713982089,0.33584349668762142,-0.58154957155318943,-0.57846149880389774],"angle_rad":[-562.81361374857761,697.32993807187336,-301.80302537451166,1238.3192750087035,1238.3206311064389]},"command":[-0.20476941777678503,-0.23706798023256898,-0.35706474398779436,0.46694446773261838,0.46694446773261838],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.15285185268280388,-1.1394386090179291,-0.25289005533084064,0.00028145690682159494,-0.00085242459623584928,0.00032108750324684509]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":417,"step":3336,"t":16.68,"sim_time":16.680000000000966,"vehicle":{"origin_ned":[1.6441043773014519,1.116371682193616,3.6293768912767046],"origin_quat_xyzw":[-0.0211786391691496,0.052808756303555936,0.41730861038505468,0.90698193157256946],"cg_ned":[1.5878895263562731,1.0537194362019333,3.3367841399368499],"linear_velocity_ned":[-0.015128777342386917,-0.013723472226492468,-0.041863877545066756],"angular_velocity_ned":[0.0039727501477291541,-0.0056842863817833222,0.021900985604861083]},"sensors":{"Odom":[1.6441043773014519,1.116371682193616,3.6293768912767046,-0.017356438723084743,0.0046702805597742935,-0.043573400154785238,-0.02117863916914961,0.052808756303555957,0.4173086103850549,0.90698193157256946,-0.0042083687538889483,-0.0065916683262728527,0.021600614967598596],"Pressure":[28113.242887315206],"DVL":[-0.044952207996045775,0.01475754586077983,0.071011958201688374,7.2754935130259843,-0.022762636290757473,-0.018834329927022934,0.033268966567154244,0],"IMU":[0.0056946205206677555,0.11371414532454911,0.8627780020307203,-0.057069846409773868,0.014544995220573459,-0.015010157221842041,1.1029577020300581,-0.051183457808865608,-9.7740157508449563],"FOG":[0.86127463368688273],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-21.40507584682798,-24.993952000625203,-37.275627614388533,49.149960858723979,49.149960858723979],"omega_rad_s":[-21.419789042132994,-26.213900874305711,-37.584530122121656,48.617358868147058,48.61698960213954],"thrust_n":[-5.8297575780579027,-8.6632839266150121,-17.687885022966821,31.18667623114111,31.026104878903894],"torque_nm":[0.10930795458858568,0.16243657362403144,0.33164784418062787,-0.58475017933389606,-0.58173946647944796],"angle_rad":[-563.67213512684259,696.28278362646256,-303.31037271854694,1240.2618385594542,1240.263179895715]},"command":[-0.20385786520788554,-0.23803763810119241,-0.35500597727989081,0.46809486532118078,0.46809486532118078],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.1450353290463996,-1.138405082859264,-0.25199885514002762,0.00027576008551721891,-0.00085266008787187719,0.00031792660303786287]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":418,"step":3344,"t":16.719999999999999,"sim_time":16.720000000000958,"vehicle":{"origin_ned":[1.6433708184039404,1.1158209551589888,3.6277081979737229],"origin_quat_xyzw":[-0.021176795128421334,0.052665708084772056,0.41770098865849337,0.90680965511717804],"cg_ned":[1.587275226400545,1.0531662403558903,3.3350930876291818],"linear_velocity_ned":[-0.015533360516189669,-0.01391120560463905,-0.042593525374818544],"angular_velocity_ned":[0.0038828385496557159,-0.0054957167386708054,0.02125040130042808]},"sensors":{"Odom":[1.6433708184039404,1.1158209551589888,3.6277081979737229,-0.017630132718021659,0.0047922422996010692,-0.044350406945588262,-0.021176795128421352,0.052665708084772098,0.4177009886584937,0.90680965511717804,-0.0040503227423492614,-0.0064043764232882923,0.020962770365943333],"Pressure":[28099.093721167086],"DVL":[-0.04993297725896579,0.021772279461393547,0.04600149538859466,7.2674272965080551,0.045742764299926755,-0.011297335312690671,-0.017704383480060787,0],"IMU":[0.0056265923654103987,0.11344989174219676,0.8636317011684107,-0.021865244878248126,-0.046436655106721896,0.090141813579964869,1.1080387508768001,-0.045026831183130278,-9.7731283273157992],"FOG":[0.86915588932642451],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-21.311125788282052,-25.093545080783784,-37.062753571066764,49.274498419518743,49.274498419518743],"omega_rad_s":[-21.320793891369032,-26.294166581097077,-37.356837239729153,48.744490976530301,48.744121235851296],"thrust_n":[-5.7740582276953702,-8.7107501224578829,-17.469137350570715,31.362107959037409,31.205662084852474],"torque_nm":[0.10826359176928821,0.16332656479608534,0.32754632532320094,-0.58803952423195149,-0.58510616409098382],"angle_rad":[-564.52666298385566,695.23238327106935,-304.80855131227736,1242.2094209178006,1242.2107474725644]},"command":[-0.20296310274554336,-0.23898614362651224,-0.35297860543873111,0.46928093732874993,0.46928093732874993],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.13724134918977918,-1.1375926132276273,-0.2511302585264773,0.00026994910380450526,-0.00085241854522727064,0.00031473722939584828]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":419,"step":3352,"t":16.760000000000002,"sim_time":16.76000000000095,"vehicle":{"origin_ned":[1.6426252839447681,1.115262450655631,3.6260102668458445],"origin_quat_xyzw":[-0.02117427198665393,0.052527114006768467,0.41808149183663124,0.90664238742936121],"cg_ned":[1.5866451014929532,1.0526057951139267,3.3333734711071563],"linear_velocity_ned":[-0.01592207539274686,-0.014087427987849153,-0.043295537048527365],"angular_velocity_ned":[0.0037959340253901335,-0.0053039469015550601,0.020601714447641344]},"sensors":{"Odom":[1.6426252839447681,1.115262450655631,3.6260102668458445,-0.017887883602898991,0.0049087517428911291,-0.045097672301316179,-0.021174271986653941,0.052527114006768495,0.4180814918366314,0.90664238742936121,-0.0038881394339930386,-0.0062173088628443883,0.020327298105936486],"Pressure":[28084.593644324887],"DVL":[0.014716788449346476,0.013156173528220516,0.039969470219052602,7.1801830195886902,-0.010758371776609972,0.014283817920466339,0.016101206230490561,0],"IMU":[0.0055618651568250738,0.11319332294681951,0.8644598097569377,-0.020393959074254703,-0.022970638517926138,0.082718844708600664,1.1040516337445503,-0.063563929581666678,-9.7545589466670677],"FOG":[0.86500958457904975],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-21.218917817502959,-25.190972210842592,-36.853179370464723,49.402691733524939,49.402691733524939],"omega_rad_s":[-21.22372834419588,-26.372449198474492,-37.132708730906643,48.875422797918695,48.875052626007005],"thrust_n":[-5.7197056194174971,-8.7572144467782316,-17.255351812216372,31.542206502360006,31.389891992515903],"torque_nm":[0.10724448036407809,0.16419777087709184,0.32353784647905703,-0.59141637191925001,-0.58856047485967322],"angle_rad":[-565.3772751253972,694.17881786593296,-306.2977033888418,1244.1621754934108,1244.1634872487282]},"command":[-0.20208493159526628,-0.23991402105564372,-0.35098266067109257,0.47050182603357088,0.47050182603357088],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,1.7330294100822983e-20,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,3.4694469519536142e-18,0],"servo_effort":[0.12948588897673458,-1.1370021193874114,-0.25028661837056015,0.0002639553179382562,-0.00085178380885845325,0.00031152592754793966]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":420,"step":3360,"t":16.800000000000001,"sim_time":16.800000000000942,"vehicle":{"origin_ned":[1.6418684300919717,1.1146966019873779,3.624284203908144],"origin_quat_xyzw":[-0.021170995094918557,0.052393006945770253,0.41845016792052203,0.90648012595818017],"cg_ned":[1.5859997752839035,1.0520385527158105,3.3316263938250441],"linear_velocity_ned":[-0.016295412541715286,-0.014252502955698021,-0.043970000964345363],"angular_velocity_ned":[0.0037116854511077164,-0.0051091292837064642,0.019955118708852825]},"sensors":{"Odom":[1.6418684300919717,1.1146966019873779,3.624284203908144,-0.018130210014990919,0.0050199652270575025,-0.045815384957351109,-0.021170995094918564,0.052393006945770274,0.4184501679205222,0.90648012595818017,-0.0037221814241727843,-0.0060303040729058378,0.019694348728603286],"Pressure":[28068.140313350115],"DVL":[-0.027987353591482779,-0.014020029989054876,0.062905547041788731,7.2905738687997728,-0.016556172960139889,-0.018469309032158814,0.028247518974361934,0],"IMU":[0.0055006270090584659,0.11294442706590088,0.86526242715448443,-0.030703285446172738,-0.032852473283746533,-0.041687797294511483,1.101711778559104,-0.049511847734697169,-9.7689374782966851],"FOG":[0.86476772781126821],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-21.12839948635677,-25.286256828943216,-36.646914473100352,49.5344449018177,49.5344449018177],"omega_rad_s":[-21.128551622569873,-26.448818977447985,-36.912159707051345,49.010067121960311,49.009696545217047],"thrust_n":[-5.6666623187211949,-8.8027087773392214,-17.046465656926053,31.726899276655015,31.578727336797645],"torque_nm":[0.10624991847602241,0.16505078957511046,0.31962123106736351,-0.5948793614372816,-0.59210113756495586],"angle_rad":[-566.22404782981675,693.12216507167443,-307.77797187912824,1246.1202523004233,1246.1215492396909]},"command":[-0.20122285225101685,-0.240821493608983,-0.34901823307714624,0.47175661811254954,0.47175661811254954],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.12178628092938779,-1.1366349997377694,-0.2494700046179831,0.00025784087489272371,-0.00085072157949256247,0.0003083018664788254]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":421,"step":3368,"t":16.84,"sim_time":16.840000000000934,"vehicle":{"origin_ned":[1.6411008908928739,1.1141238324541225,3.6225311111914689],"origin_quat_xyzw":[-0.021166898241971963,0.052263419017366711,0.41880706751465763,0.90632286611957547],"cg_ned":[1.5853398521506423,1.0514649510323264,3.3298529557569139],"linear_velocity_ned":[-0.016653847194971205,-0.014406786363784639,-0.04461700326580071],"angular_velocity_ned":[0.0036297187048856825,-0.0049115012467134357,0.019310790516341558]},"sensors":{"Odom":[1.6411008908928739,1.1141238324541225,3.6225311111914689,-0.018357626336080547,0.0051260601474462809,-0.046503726400259814,-0.021166898241971977,0.052263419017366745,0.4188070675146579,0.90632286611957547,-0.0035528879745254835,-0.0058432371342429382,0.019064047303040572],"Pressure":[28051.220903501056],"DVL":[0.0015958152726522085,0.048216016033133684,0.045511217182151467,7.3498734646012398,-0.03439548118577488,-0.0014190399118449752,-0.046854337778705325,0],"IMU":[0.0054430497195870819,0.11270319798529389,0.86603965817185447,0.083247390990210349,-0.041084272899605236,0.0040033231409647291,1.0952664485616792,-0.044938751087131426,-9.7133527304082055],"FOG":[0.86735679180647429],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-21.039491503114853,-25.379401973125134,-36.443973476968758,49.669653761844074,49.669653761844074],"omega_rad_s":[-21.035210504631191,-26.52332340555645,-36.695203031205452,49.148330446565943,49.147959476800345],"thrust_n":[-5.6148850133703245,-8.8472504439814408,-16.842415482846867,31.916105435778729,31.772091720112289],"torque_nm":[0.10527909400069359,0.16588594582465205,0.31579529030337883,-0.59842697692085134,-0.59572671975210545],"angle_rad":[-567.06705547502327,692.06250026170881,-309.24950026045076,1248.0837977229155,1248.0850798302497]},"command":[-0.20037610955347479,-0.24170859022023936,-0.34708546168541676,0.47304432154137216,0.47304432154137216],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.11415600821223523,-1.1364933457127218,-0.2486828524903712,0.00025149371317705012,-0.00084929497545066426,0.00030507191863187859]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":422,"step":3376,"t":16.879999999999999,"sim_time":16.880000000000926,"vehicle":{"origin_ned":[1.6403231896001933,1.1135445979541998,3.6207520895916003],"origin_quat_xyzw":[-0.021162058316043866,0.052138269092102424,0.41915225233945591,0.90617060068326472],"cg_ned":[1.5846659232995521,1.0508854106611427,3.3280542479751474],"linear_velocity_ned":[-0.016997553495071951,-0.014550794613380002,-0.045236917074625141],"angular_velocity_ned":[0.003541943529202569,-0.004727684163915973,0.018670767213832835]},"sensors":{"Odom":[1.6403231896001933,1.1135445979541998,3.6207520895916003,-0.018571967128880748,0.0052321748557430979,-0.047162906656870951,-0.02116205831604388,0.052138269092102459,0.41915225233945613,0.90617060068326472,-0.0033982779848405185,-0.0056607120176900951,0.018436430133338295],"Pressure":[28036.994760076665],"DVL":[-0.0031854241058190229,0.029323491764141063,0.057890756761204525,7.2140282541884311,-0.035076178274623351,0.0020710899344848028,-0.0096853230012279821,0],"IMU":[0.0053889491419642005,0.11246954414834807,0.86679160971800695,0.044605512584768824,-0.035877226984507196,-0.044829876513812129,1.0764216411808849,-0.0645135123082273,-9.7468587548544328],"FOG":[0.85300675836437412],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-20.950337448410195,-25.470076507660636,-36.244193264122181,49.808211135569223,49.808211135569223],"omega_rad_s":[-20.943308584575604,-26.595929625512802,-36.481817553727879,49.290113291910941,49.289741948605879],"thrust_n":[-5.5641616773854858,-8.8908075721821689,-16.64311447879259,32.109782565286622,31.969850387887202],"torque_nm":[0.10432803145097787,0.16670264197841569,0.31205839647736106,-0.60205842309912416,-0.59943469477288502],"angle_rad":[-567.90636575500662,690.99989815587855,-310.71243208189441,1250.0529542613156,1250.0542215212749]},"command":[-0.19952702331819233,-0.24257215721581557,-0.34518279299163984,0.47436391557684976,0.47436391557684976],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[-2.7105054312137611e-20,0,0,0,0,0],"servo_effort":[0.10866079399423623,-1.1377960738049131,-0.24819209884016138,0.00024507221071061919,-0.0008479262017877929,0.00030218139343663158]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":423,"step":3384,"t":16.920000000000002,"sim_time":16.920000000000918,"vehicle":{"origin_ned":[1.6395356850619729,1.1129594100806919,3.6189482398886748],"origin_quat_xyzw":[-0.021156771954786626,0.052017293712002192,0.41948580659380336,0.90602331659934587],"cg_ned":[1.5839785706384162,1.0503003329276888,3.3262313483048804],"linear_velocity_ned":[-0.017326889988655027,-0.014684933932430064,-0.045829956016953804],"angular_velocity_ned":[0.0034461820231099028,-0.0045626279133580607,0.01803630284620247]},"sensors":{"Odom":[1.6395356850619729,1.1129594100806919,3.6189482398886748,-0.018774202094600626,0.005339905258697146,-0.047793135277529125,-0.021156771954786633,0.052017293712002213,0.41948580659380347,0.90602331659934587,-0.0032636478815305063,-0.0054842472024677052,0.017812175597037492],"Pressure":[28017.58322996652],"DVL":[0.032127346513255682,0.012017864972192706,0.061655868396025708,7.2080597617409605,-0.012008649406298902,-0.016964361266208577,0.020007516883459933,0],"IMU":[0.0053375882445582659,0.11224322812560882,0.86751840311006578,-0.071100506866155433,-0.019895934996074685,0.14908427753527745,1.0853404975019307,-0.045997174308603346,-9.7577054194713497],"FOG":[0.88254631471850042],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-20.855561742333233,-25.557481014131287,-36.04687523814458,49.950018404227187,49.950018404227187],"omega_rad_s":[-20.850751975067791,-26.666321981706698,-36.271769850884318,49.435314887818571,49.434943259939516],"thrust_n":[-5.5133770032832823,-8.9331571099923597,-16.448278193703299,32.307868656016367,32.171885253324149],"torque_nm":[0.10337581881156153,0.16749669581235677,0.30840521613193694,-0.605772537300307,-0.60322284849982799],"angle_rad":[-568.74199014114367,689.93444177502124,-312.16690526418773,1252.0278604025773,1252.0291128019976]},"command":[-0.19862439754603078,-0.24340458108696464,-0.34330357369661507,0.47571446099263986,0.47571446099263986],"arm":{"servo_position":[1.4287063540015875e-22,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[2.7105054312137611e-20,0,0,0,0,0],"servo_effort":[0.10344997868826887,-1.1393491629987049,-0.2477520689036497,0.00023852121393424703,-0.00084642686609719695,0.00029935184112682401]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":424,"step":3392,"t":16.960000000000001,"sim_time":16.96000000000091,"vehicle":{"origin_ned":[1.6387387148350643,1.1123687661154114,3.6171206578374195],"origin_quat_xyzw":[-0.021151337157828166,0.051900224208402325,0.41980782780691894,0.90588099404700484],"cg_ned":[1.583278359639205,1.0497101047041981,3.3243853291138077],"linear_velocity_ned":[-0.017642264241300606,-0.014809555005057474,-0.046396237395185801],"angular_velocity_ned":[0.0033430508664793299,-0.0044154365096852706,0.017407989390006953]},"sensors":{"Odom":[1.6387387148350643,1.1123687661154114,3.6171206578374195,-0.018964804522321903,0.0054490395763246774,-0.048394608336148545,-0.021151337157828177,0.051900224208402353,0.41980782780691911,0.90588099404700484,-0.0031479957216734474,-0.0053137020859900831,0.01719199977743122],"Pressure":[28003.000270882469],"DVL":[-0.0014582334735235604,0.015777225958527361,0.042958062825861579,7.2890378514175493,0.0067134897705542571,-0.00076914456391163411,-0.0052287192296435123,0],"IMU":[0.0052882238817486419,0.11202400549528385,0.86822018957281444,0.023551247497949363,0.0024773114836511758,0.054088382650326922,1.08535878602173,-0.063887670903737148,-9.7943623046185202],"FOG":[0.84732690826764356],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-20.755202311235983,-25.641938538667429,-35.851730470645471,50.094963096675293,50.094963096675293],"omega_rad_s":[-20.755853469110036,-26.734339534099679,-36.064776918808995,49.583830216421767,49.58345844787258],"thrust_n":[-5.4616425577341117,-8.9741768475080921,-16.257579221226127,32.510266682236562,32.378102453991936],"torque_nm":[0.10240579795751462,0.16826581589077674,0.30482961039798984,-0.60956750029193552,-0.60708942101234886],"angle_rad":[-569.57386225448261,688.86622381558652,-313.61304687688107,1254.0086505151626,1254.0098880457585]},"command":[-0.19766859344034268,-0.24420893846349931,-0.34144505210138543,0.47709488663500282,0.47709488663500282],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[-2.7105054312137611e-20,0,0,0,0,0],"servo_effort":[0.098476431989435773,-1.141126428101964,-0.24735812119133946,0.00023199301633732432,-0.00084473775342178885,0.00029658228133654888]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":425,"step":3400,"t":17,"sim_time":17.000000000000902,"vehicle":{"origin_ned":[1.6379326101348615,1.1117731431764952,3.6152704337035164],"origin_quat_xyzw":[-0.021146034462917761,0.051786803091240625,0.42011842381793613,0.90574360733091297],"cg_ned":[1.5825658404596106,1.0491150989029561,3.3225172580849418],"linear_velocity_ned":[-0.017944041375556337,-0.014925004890101713,-0.04693587760989032],"angular_velocity_ned":[0.0032331134760347309,-0.0042852293567131484,0.01678630938335799]},"sensors":{"Odom":[1.6379326101348615,1.1117731431764952,3.6152704337035164,-0.019144210384499215,0.0055593449302359932,-0.048967517153462169,-0.021146034462917764,0.051786803091240632,0.42011842381793618,0.90574360733091297,-0.0030503522281169313,-0.0051489092766978497,0.016576503872865449],"Pressure":[27985.343463140995],"DVL":[-0.037012753184741565,0.021782224061225396,0.022199733103841046,7.2416973968670835,-0.017796707392522336,0.024062585555662735,-0.026460579265124164,0],"IMU":[0.0052401546226999128,0.11181163868774158,0.8688971466857196,-0.011839495601423148,0.069233611943478823,-0.18057968202419841,1.0891721781992549,-0.052017370487342895,-9.7412069760609246],"FOG":[0.84244924660392606],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-20.649361287221492,-25.723734942919979,-35.658519704039968,50.242927146637676,50.242927146637676],"omega_rad_s":[-20.657502924318241,-26.799971326137097,-35.86056072076466,49.73554888427195,49.735177152179602],"thrust_n":[-5.4083905498138778,-9.0138455652549681,-16.070702733394057,32.716871132138429,32.588400423781941],"torque_nm":[0.10140732280901023,0.16900960434853066,0.3013256762511386,-0.61344133372759557,-0.61103250794591146],"angle_rad":[-570.40186190823465,687.79533980355222,-315.05097273953356,1255.9954546439164,1255.9966773039657]},"command":[-0.19666058368782371,-0.24498795183733313,-0.33960494956228537,0.47850406806321594,0.47850406806321594],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,-8.6736173798840355e-19,0,0,0,0],"servo_effort":[0.093714036654870575,-1.1431144847888466,-0.24700856659035675,0.0002253320468336692,-0.00084292400468865029,0.00029387179511610226]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":426,"step":3408,"t":17.039999999999999,"sim_time":17.040000000000894,"vehicle":{"origin_ned":[1.6371176970141637,1.1111729989981909,3.6133986522506025],"origin_quat_xyzw":[-0.021141128375301448,0.051676783771057354,0.42041771090216445,0.90561112574320901],"cg_ned":[1.5818415493944369,1.0485156746979403,3.3206281982306103],"linear_velocity_ned":[-0.018232555604454061,-0.01503162359731381,-0.047448994374621398],"angular_velocity_ned":[0.0031168769876451057,-0.0041711663729195898,0.016171651105854251]},"sensors":{"Odom":[1.6371176970141637,1.1111729989981909,3.6133986522506025,-0.019312826932309797,0.005670585329859733,-0.049512050592172091,-0.021141128375301462,0.051676783771057382,0.42041771090216468,0.90561112574320901,-0.0029698035451390919,-0.0049896881660851178,0.015966187067195263],"Pressure":[27967.345001585822],"DVL":[-0.0036944774830100502,0.012156093921852511,0.0639446335682929,7.3074281095077609,0.016963064959620959,0.023974232184919373,-0.0041671743555821393,0],"IMU":[0.0051927177061799525,0.1116058975365347,0.86954947403767324,-0.093600447950000873,0.071233328329163764,-0.10827034078572881,1.0790580331628419,-0.05220193677511667,-9.7728614961671987],"FOG":[0.86426204372825555],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-20.53814730617848,-25.803115303040258,-35.467043201962433,50.393786737823675,50.393786737823675],"omega_rad_s":[-20.554986730826212,-26.863294166001236,-35.658860770672945,49.89035496735989,49.889983467166942],"thrust_n":[-5.3532728988181209,-9.0522019154859095,-15.887357329241427,32.927567900202504,32.80266928104102],"torque_nm":[0.10037386685283978,0.16972878591536081,0.29788794992327677,-0.61739189812879702,-0.6150500490195191],"angle_rad":[-571.22583394081505,686.7218835743239,-316.4807879283764,1257.9883982917579,1257.9896060870756]},"command":[-0.19560140291598552,-0.24574395526705009,-0.33778136382821367,0.47994082607451122,0.47994082607451122],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.08913549083483506,-1.1452986721321818,-0.24670109725493744,0.00021866135287554076,-0.00084101856683512942,0.00029121875957936267]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":427,"step":3416,"t":17.080000000000002,"sim_time":17.080000000000886,"vehicle":{"origin_ned":[1.6362942993730407,1.1105687736853702,3.6115063955667246],"origin_quat_xyzw":[-0.021136867108588323,0.051569931617663073,0.42070581204320323,0.90548351432527596],"cg_ned":[1.5811060110386055,1.0479121792848451,3.3187192108402406],"linear_velocity_ned":[-0.018508052853706422,-0.015129661834683752,-0.04793553539456355],"angular_velocity_ned":[0.0029948394062898906,-0.0040723103232486674,0.015564309703839438]},"sensors":{"Odom":[1.6362942993730407,1.1105687736853702,3.6115063955667246,-0.019470936410539541,0.0057824915185584807,-0.050028216659741755,-0.021136867108588329,0.051569931617663094,0.4207058120432034,0.90548351432527596,-0.0029053566688545061,-0.0048357917507967987,0.015361462552927807],"Pressure":[27950.643691771926],"DVL":[0.018596571237926435,0.014198640855715748,0.034072165566737839,7.2894545677940128,-0.03522996257584781,0.01282432152022768,-0.036104592252229957,0],"IMU":[0.0051452902281913402,0.11140656084447784,0.87017738947545531,-0.050715795708711771,-0.040896405660249255,-0.067627775078847541,1.0703590604066351,-0.053361968373528024,-9.7796809641489979],"FOG":[0.8706057034566832],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-20.421705001364039,-25.880306666978136,-35.277148712142406,50.547394435702842,50.547394435702842],"omega_rad_s":[-20.447868075318738,-26.924434936796839,-35.459443156916862,50.048123763752322,50.047752698746628],"thrust_n":[-5.2960942974419334,-9.0893201429905641,-15.707283330582408,33.142226112608149,33.020783809668508],"torque_nm":[0.099301768077036265,0.17042475268107307,0.29451156244842014,-0.62141673961140276,-0.61913969643128464],"angle_rad":[-572.0456011749643,685.64594470157556,-317.902587672484,1259.9876021605567,1259.9887951049816]},"command":[-0.19449242858441942,-0.2464791111140775,-0.33597284487754669,0.48140375653050327,0.48140375653050327],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.084712952109080003,-1.1476929949446535,-0.24643226777390942,0.00021195182405648477,-0.00083897163852051976,0.00028860117002602655]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":428,"step":3424,"t":17.120000000000001,"sim_time":17.120000000000879,"vehicle":{"origin_ned":[1.6354627440847651,1.1099608945771517,3.6095947478898753],"origin_quat_xyzw":[-0.021133484536820537,0.051466028911057934,0.42098285498139476,0.90536073446509258],"cg_ned":[1.5803597410341463,1.0473049506198779,3.3167913611730486],"linear_velocity_ned":[-0.018770771593239723,-0.015219370905768668,-0.048395437307966131],"angular_velocity_ned":[0.0028671157944886849,-0.0039874377725672566,0.014964467293468359]},"sensors":{"Odom":[1.6354627440847651,1.1099608945771517,3.6095947478898753,-0.019618675398808443,0.0058947894805090884,-0.05051603483794747,-0.021133484536820551,0.051466028911057969,0.42098285498139504,0.90536073446509258,-0.002856032925412675,-0.0046864991723908718,0.014762624962469426],"Pressure":[27931.376525521548],"DVL":[-0.016412828359450491,0.0045743615225128671,0.068083652699708147,7.2689943444608724,0.0088802737649463954,-0.010885370428718226,0.0060519107496630233,0],"IMU":[0.0050972895920443056,0.11121342689298525,0.87078112506918681,-0.060200127615760796,-0.0068065701270023753,0.048162965259521413,1.0834574294970816,-0.043708365149145861,-9.7637124826670068],"FOG":[0.88930124891762741],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-20.300204056715707,-25.955599440197467,-35.088796012471043,50.703502873171118,50.703502873171118],"omega_rad_s":[-20.335908864944066,-26.983571090164428,-35.26212508384819,50.208693400793607,50.208322972246975],"thrust_n":[-5.236768631665166,-9.1253096274097061,-15.53027249837894,33.360658836981656,33.24257297766794],"torque_nm":[0.098189411843721874,0.17109955551393202,0.29119260934460517,-0.62551235319340615,-0.62329824333127404],"angle_rad":[-572.86097366878903,684.56760654701941,-319.31645893371046,1261.9931811601157,1261.9943592756135]},"command":[-0.19333527673062578,-0.24719618514473779,-0.33417900964258135,0.48289050355401064,0.48289050355401064],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.08040979001794453,-1.1501393756812981,-0.24617372797298234,0.00020520896161447077,-0.00083681243788270214,0.0002859981441112849]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":429,"step":3432,"t":17.16,"sim_time":17.160000000000871,"vehicle":{"origin_ned":[1.6346233601671389,1.1093497753222246,3.6076647884512196],"origin_quat_xyzw":[-0.021131202360611327,0.051364878069185195,0.42124897072901518,0.90524274437715202],"cg_ned":[1.5796032438891845,1.046694314633444,3.3148457119178523],"linear_velocity_ned":[-0.019021004708095816,-0.015301070882767574,-0.048828834764114357],"angular_velocity_ned":[0.0027339903724429575,-0.003915511240059886,0.014372281938678799]},"sensors":{"Odom":[1.6346233601671389,1.1093497753222246,3.6076647884512196,-0.019756320497133113,0.0060072113860000966,-0.050975717757259689,-0.021131202360611338,0.051364878069185216,0.4212489707290154,0.90524274437715202,-0.0028208825017485934,-0.0045413414888946955,0.014169942100978793],"Pressure":[27917.649587197233],"DVL":[-0.054644330456811864,-0.0057744865680239808,0.037680846599736376,7.1892402744426898,-0.020459342259383756,0.0091155473211585788,0.0070462482993755918,0],"IMU":[0.0050481721789960984,0.11102632100743669,0.87136092392064146,-0.080142809010453245,-0.078876126950052708,0.12603487929516391,1.0939645426391484,-0.050905259903223268,-9.7749226706466708],"FOG":[0.85346941768695017],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-20.173819865727548,-26.029236762871857,-34.901982029544016,50.861964806129976,50.861964806129976],"omega_rad_s":[-20.219008698957118,-27.040909967317123,-35.066781810557039,50.371895661400892,50.371526056754917],"thrust_n":[-5.1752850767779321,-9.1603004404058446,-15.356171449877889,33.58267415538068,33.467858406786767],"torque_nm":[0.097036595189586225,0.17175563325760962,0.28792821468521046,-0.62967514041338779,-0.62752234512725202],"angle_rad":[-573.67175522873299,683.48694457323859,-320.72248275980036,1264.0052434515485,1264.0064067678481]},"command":[-0.19213161776883381,-0.24789749297973196,-0.33239982885280017,0.48439966482028551,0.48439966482028551],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,-8.6736173798840355e-19,0,0,0,0],"servo_effort":[0.076230156686036901,-1.1527282001411159,-0.24594703374634153,0.00019844609048429342,-0.0008345405699147244,0.00028344394252963461]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":430,"step":3440,"t":17.199999999999999,"sim_time":17.200000000000863,"vehicle":{"origin_ned":[1.6337764752463895,1.1087358117708792,3.6057175893310101],"origin_quat_xyzw":[-0.021130226799019446,0.051266294040612843,0.42150429360808062,0.90512949961909661],"cg_ned":[1.5788370126321816,1.0460805847383881,3.3128833196418461],"linear_velocity_ned":[-0.019259036128779012,-0.015375069470192156,-0.049235890133119055],"angular_velocity_ned":[0.002595975223645255,-0.0038556812872567996,0.013787888091024086]},"sensors":{"Odom":[1.6337764752463895,1.1087358117708792,3.6057175893310101,-0.019884219680620398,0.0061194897629799887,-0.051407488032269508,-0.021130226799019453,0.051266294040612857,0.42150429360808078,0.90512949961909661,-0.0027989491364803216,-0.0044001477247758445,0.013583659569233625],"Pressure":[27894.938909115132],"DVL":[0.026935614876786123,-0.0085409615460801929,0.028327505470943724,7.2670113185796801,-0.0055922285828091702,0.014308834896877256,-0.0076207333518594923,0],"IMU":[0.0049974329530061007,0.11084507882196741,0.87191703969912082,0.015569547362367001,0.056022474316508995,0.062132551052929079,1.0879422067908064,-0.036199027187911813,-9.7978056960207009],"FOG":[0.87070452078995531],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-20.042732374878057,-26.101358829054295,-34.716617081842941,51.022655571482339,51.022655571482339],"omega_rad_s":[-20.097161531224781,-27.096643818497618,-34.873302433216885,50.537574766840429,50.537206158076216],"thrust_n":[-5.111684005910611,-9.1944140335654403,-15.184842765751815,33.808098753457649,33.696471289230502],"torque_nm":[0.095844075110823962,0.17239526312935199,0.28471580185784656,-0.63390185162733115,-0.63180883667307197],"angle_rad":[-574.47774788106062,682.4040262224446,-322.12073560672775,1266.0238907605544,1266.0250393145297]},"command":[-0.19088316547502912,-0.2485843698005171,-0.3306344483985042,0.48593005306173653,0.48593005306173653],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.072159582961321272,-1.155468470613034,-0.24575470008906292,0.00019164567690132742,-0.0008321776321323363,0.00028094279470431603]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":431,"step":3448,"t":17.240000000000002,"sim_time":17.240000000000855,"vehicle":{"origin_ned":[1.6329224153838515,1.1081193816124855,3.6037542151832671],"origin_quat_xyzw":[-0.021130747808730175,0.05117010294406691,0.42174896049512101,0.90502095356020462],"cg_ned":[1.5780615290587179,1.0454640622622744,3.3109052342392302],"linear_velocity_ned":[-0.019485144410286037,-0.015441664354829262,-0.049616772914932425],"angular_velocity_ned":[0.0024535795936634817,-0.0038070930972543913,0.013211370358820453]},"sensors":{"Odom":[1.6329224153838515,1.1081193816124855,3.6037542151832671,-0.020002708384074787,0.0062313564255975108,-0.051811573490713095,-0.021130747808730189,0.051170102944066945,0.42174896049512128,0.90502095356020462,-0.0027892682545519547,-0.0042627438364298076,0.01300397304752098],"Pressure":[27876.682449645577],"DVL":[-0.022039672239596797,0.028751939942701463,0.06877113521892983,7.3354478803068925,0.021746334082289917,-0.00085674331745967073,-0.032210348144423383,0],"IMU":[0.0049446056616124561,0.11066954303727812,0.87244973484803656,0.090189262415197521,0.028595030932601198,0.065729341235280306,1.0784509350766585,-0.043960725109135727,-9.7526710914215577],"FOG":[0.89447443793938186],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-19.907131848412813,-26.172075988898662,-34.532620416548021,51.185451646554775,51.185451646554775],"omega_rad_s":[-19.970428404063977,-27.150939859928485,-34.681581959290789,50.705583904055146,50.705216449058234],"thrust_n":[-5.0460417137752351,-9.2277557744587337,-15.016157287029479,34.036769008860695,33.928252223699594],"torque_nm":[0.094613282133285667,0.17302042077110125,0.28155294913180279,-0.63818941891613812,-0.63615472919436733],"angle_rad":[-575.27875499401728,681.31891181874846,-323.51128961646896,1268.0492187939956,1268.0503526290793]},"command":[-0.18959173188964584,-0.24925786656093965,-0.32888209920521927,0.48748049187195025,0.48748049187195025],"arm":{"servo_position":[7.3453638394706939e-24,3.2526065174565154e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,8.6736173798840355e-19,0,0,0,0],"servo_effort":[0.068182476433260183,-1.1583512097463935,-0.24559581762333255,0.00018480758287273784,-0.00082974448820726508,0.00027849584125031292]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":432,"step":3456,"t":17.280000000000001,"sim_time":17.280000000000847,"vehicle":{"origin_ned":[1.6320615053859886,1.1075008447389514,3.6017757229436533],"origin_quat_xyzw":[-0.02113293898547371,0.051076142115719612,0.42198310997362981,0.90491705779778198],"cg_ned":[1.5772772638768993,1.0448450369014417,3.3089124986260212],"linear_velocity_ned":[-0.019699605468408234,-0.015501140917722124,-0.049971661690606413],"angular_velocity_ned":[0.0023073177272287253,-0.0037688897308577754,0.012642767513643851]},"sensors":{"Odom":[1.6320615053859886,1.1075008447389514,3.6017757229436533,-0.020112111625171174,0.0063425452221688335,-0.052188208833396553,-0.021132938985473724,0.051076142115719654,0.42198310997363009,0.90491705779778198,-0.0027908649331830349,-0.0041289606697085968,0.012431032620604226],"Pressure":[27860.83485954157],"DVL":[-0.025066091745728533,0.043761314867152512,0.065261910051942776,7.2541668915723472,-0.0086306478975044561,-0.0089546903820537475,0.0083225006081208055,0],"IMU":[0.0048892629789179468,0.11049956331955819,0.87295927867478562,0.06771442804393793,0.025465434060983234,-0.10191813937734785,1.0817020144609084,-0.04556263786900111,-9.7663275013736754],"FOG":[0.88559405418800718],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-19.767216397551394,-26.241477597129329,-34.34992699508318,51.350229466415968,51.350229466415968],"omega_rad_s":[-19.83891877950623,-27.203941105092284,-34.491524979138831,50.87578235898993,50.875416202585249],"thrust_n":[-4.9784598447054638,-9.2604153081589242,-14.849997073999159,34.268527262978239,34.16304765477355],"torque_nm":[0.093346122088227443,0.17363278702797982,0.27843744513748425,-0.64253488618084209,-0.64055714352700399],"angle_rad":[-576.07458352248511,680.23165555128639,-324.89421294333789,1270.0813175304841,1270.0824366961269]},"command":[-0.18825920378620375,-0.24991883425837455,-0.32714216185793504,0.48904980444205681,0.48904980444205681],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,-1.0905549195899114e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.06429723982595259,-1.1613691435754538,-0.24546909646960005,0.00017797064810756594,-0.00082724265522975051,0.00027610217744783737]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":433,"step":3464,"t":17.32,"sim_time":17.320000000000839,"vehicle":{"origin_ned":[1.631194069095588,1.1068805436196065,3.5997831615034519],"origin_quat_xyzw":[-0.021136957443104221,0.05098426014096917,0.42220688159644182,0.90481776252488244],"cg_ned":[1.5764846768500418,1.0442237871931783,3.3069061483981907],"linear_velocity_ned":[-0.01990269149544651,-0.01555377305742066,-0.050300743217749078],"angular_velocity_ned":[0.0021577021361505388,-0.0037402123687580173,0.012082082633343571]},"sensors":{"Odom":[1.631194069095588,1.1068805436196065,3.5997831615034519,-0.020212742432432707,0.006452792471109762,-0.052537635075423,-0.021136957443104221,0.050984260140969177,0.42220688159644182,0.90481776252488244,-0.0028027595645599012,-0.0039986287967218436,0.011864952355572115],"Pressure":[27841.17244821251],"DVL":[-0.01261674256202794,-0.033462333680050818,0.079212834143049846,7.3361470900668238,0.012694362552408441,-0.019839621953602466,0.029766285340648131,0],"IMU":[0.0048310166892760473,0.11033499615927421,0.87344594568553779,-0.075798086526837283,0.034426144003641843,-0.038617450159915842,1.0627448288437349,-0.031087488516150331,-9.7528110687147205],"FOG":[0.87466267245769969],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-19.623193693548735,-26.309634353303327,-34.168486720797119,51.516866269236203,51.516866269236203],"omega_rad_s":[-19.702777828789799,-27.255767507174486,-34.303047744073631,51.048033865610712,51.047669140401041],"thrust_n":[-4.9090581165529823,-9.2924671791525935,-14.686256878090015,34.503219663881076,34.400707806795097],"torque_nm":[0.092044839685368432,0.17423375960911117,0.27536731646418777,-0.64693536869777013,-0.64501327137740816],"angle_rad":[-576.86504563908056,679.14230641966742,-326.26957018740848,1272.1202714252761,1272.1213759764451]},"command":[-0.18688755898617843,-0.25056794622193646,-0.32541415924568684,0.49063682161177335,0.49063682161177335],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.060488283979041206,-1.1645132775678131,-0.24537339394954494,0.00017111766799601867,-0.000824679892593438,0.00027376241585200305]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":434,"step":3472,"t":17.359999999999999,"sim_time":17.360000000000831,"vehicle":{"origin_ned":[1.6303204298902381,1.1062588042214885,3.5977775713605467],"origin_quat_xyzw":[-0.021142944366151314,0.05089431768856241,0.42242041534415736,0.9047230167465703],"cg_ned":[1.5756842169147989,1.0436005809550395,3.3048872116352541],"linear_velocity_ned":[-0.020094672064660927,-0.01559982437326163,-0.050604204427084361],"angular_velocity_ned":[0.0020051497743375953,-0.0037201468377942291,0.0115292948155196]},"sensors":{"Odom":[1.6303204298902381,1.1062588042214885,3.5977775713605467,-0.020304872218704629,0.0065618433494584235,-0.052860097255735233,-0.021142944366151325,0.050894317688562438,0.42242041534415753,0.9047230167465703,-0.0028239883070853072,-0.0038714720860529819,0.01130581934155158],"Pressure":[27820.666811084458],"DVL":[-0.0096619220879179367,0.043926461421670046,0.044989402269442189,7.2437688644489624,0.02097618824363762,0.00096325238560248869,-0.018099722199251458,0],"IMU":[0.0047695173541039658,0.11017570676317939,0.87391001438238292,0.092045202330727688,0.064320000072044345,-0.005109093430223411,1.0709526368537032,-0.048937782865044979,-9.7493540859207446],"FOG":[0.87738801063879746],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-19.475276262314338,-26.376610727329336,-33.988264277314045,51.685240242574245,51.685240242574245],"omega_rad_s":[-19.562176951974472,-27.306519971212914,-34.116079209363257,51.22220550187474,51.221842328456809],"thrust_n":[-4.8379688445481595,-9.3239733513681582,-14.524844529135336,34.740693628570604,34.64108639926345],"torque_nm":[0.090711915835278017,0.17482450033815297,0.27234083492128758,-0.65138800553569887,-0.64952036998618978],"angle_rad":[-577.64995994341803,678.05090907863917,-327.63742288238905,1274.1661595616704,1274.167249558368]},"command":[-0.18547882154585082,-0.25120581645075557,-0.32369775502203851,0.49224038326261188,0.49224038326261188],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,1.7330294100822983e-20,-4.3706900078321748e-21],"servo_velocity":[-1.3552527156068805e-20,0,0,0,3.4694469519536142e-18,0],"servo_effort":[0.056735711551422624,-1.1677466313928404,-0.24530077530846239,0.00016425262585612827,-0.00082203443330468046,0.00027146709634402624]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":435,"step":3480,"t":17.400000000000002,"sim_time":17.400000000000823,"vehicle":{"origin_ned":[1.6294409111669814,1.1056359370889477,3.5957599842834207],"origin_quat_xyzw":[-0.021151025799448754,0.050806188468978976,0.42262385119947804,0.9046327684304869],"cg_ned":[1.5748763222946138,1.0429756757154116,3.3028567087520488],"linear_velocity_ned":[-0.02027581337540988,-0.015639546825445404,-0.050882243579458988],"angular_velocity_ned":[0.0018501064603415975,-0.0037078090177177199,0.010984363864536885]},"sensors":{"Odom":[1.6294409111669814,1.1056359370889477,3.5957599842834207,-0.020388772923684829,0.0066694480240158159,-0.053155847928015171,-0.021151025799448765,0.050806188468978997,0.42262385119947821,0.9046327684304869,-0.0028535892103069794,-0.0037472577549277097,0.010753700715194006],"Pressure":[27802.698822941729],"DVL":[-0.042599786865492068,0.019787840410076935,0.046986660243510156,7.3077356005599459,0.015501514873031948,0.012683804961194645,0.019262283154356765,0],"IMU":[0.0047044536696910456,0.11002157138022935,0.87435176631222611,-0.064890839694081506,0.025055771180061272,-0.083362699395665499,1.0810760222729794,-0.048727255541978841,-9.7785347303710601],"FOG":[0.86405502903847486],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-19.323676078482524,-26.442481093197422,-33.809248845332384,51.855229707129794,51.855229707129794],"omega_rad_s":[-19.417305309439719,-27.35628968675589,-33.930565343834814,51.398166665355674,51.397805151129667],"thrust_n":[-4.765332105985145,-9.3549896566550057,-14.365684399421795,34.98079767418448,34.884038123180304],"torque_nm":[0.089349976987221483,0.17540605606228135,0.26935658248915867,-0.65588995639095893,-0.65407571480963067],"angle_rad":[-578.42915231345569,676.95750438063772,-328.99783010703175,1276.2190557601539,1276.2201312669113]},"command":[-0.18403501027126212,-0.25183315326854688,-0.32199284614602269,0.49385933054409331,0.49385933054409331],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[1.3552527156068805e-20,0,4.3368086899420177e-19,0,-3.4694469519536142e-18,0],"servo_effort":[0.053029276666989263,-1.1710881205064259,-0.24525593024884018,0.00015737674777435506,-0.00080703926108411338,0.00026965401754448684]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":436,"step":3488,"t":17.440000000000001,"sim_time":17.440000000000815,"vehicle":{"origin_ned":[1.6285558358291825,1.1050122367689732,3.5937314231011381],"origin_quat_xyzw":[-0.021161311516710305,0.050719757375930936,0.42281732882518297,0.9045469648126383],"cg_ned":[1.5740614206363088,1.0423493192129001,3.3008156519187648],"linear_velocity_ned":[-0.020446378562869148,-0.015673179829749917,-0.05113507130254534],"angular_velocity_ned":[0.0016930954341216932,-0.0037023643443126432,0.010447226416869125]},"sensors":{"Odom":[1.6285558358291825,1.1050122367689732,3.5937314231011381,-0.020464731504438935,0.0067753571276327872,-0.05342514564131283,-0.021161311516710319,0.050719757375930964,0.42281732882518319,0.9045469648126383,-0.0028905858095507309,-0.0036258460186764248,0.010208641830277018],"Pressure":[27784.067571752956],"DVL":[-0.0023602431762205049,0.0089012074280377211,0.066618714644127081,7.2411273425613816,0.01648200062255464,0.019173398432759895,-0.019014994542978648,0],"IMU":[0.0046355529274062623,0.10987247289454924,0.87477148521856218,-0.015694661138569859,-0.050037008869559016,-0.10903468763234044,1.0905284168549674,-0.0383002480628718,-9.7532135287707327],"FOG":[0.86208053397041273],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-19.168617633836359,-26.507287966422634,-33.63141807439608,52.026714905487893,52.026714905487893],"omega_rad_s":[-19.268367224520325,-27.405153216831316,-33.746461920718467,51.575788963683934,51.575429203665315],"thrust_n":[-4.6912939242696003,-9.3855624344650526,-14.208710964897115,35.223382498872894,35.129417169843741],"torque_nm":[0.087961761080055031,0.17597929564621972,0.26641333059182093,-0.66043842185386692,-0.65867657193457019],"angle_rad":[-579.20245654044163,675.86212984449276,-330.35084902312673,1278.2790286680563,1278.2800897534175]},"command":[-0.18255826317939389,-0.25245036158497747,-0.32029921975615316,0.49549252290940848,0.49549252290940848],"arm":{"servo_position":[7.5107999619814722e-23,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[1.3552527156068805e-20,0,0,0,0,0],"servo_effort":[0.049359231951708452,-1.1745391138514205,-0.24523909072989677,0.00015053869447116409,-0.00081660912933679804,0.0002670297023894829]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":437,"step":3496,"t":17.48,"sim_time":17.480000000000807,"vehicle":{"origin_ned":[1.6276655262253692,1.1043879819682969,3.591692901442415],"origin_quat_xyzw":[-0.021173894739916124,0.050634919968780188,0.42300098722028767,0.90446555261765504],"cg_ned":[1.5732399291006298,1.0417217498421907,3.2987650446927548],"linear_velocity_ned":[-0.020606629197502457,-0.015700952430572925,-0.051362906966968637],"angular_velocity_ned":[0.0015346389555245068,-0.0037029851075073032,0.0099178020022665445]},"sensors":{"Odom":[1.6276655262253692,1.1043879819682969,3.591692901442415,-0.020533026656291694,0.0068793269190518267,-0.053668256089308461,-0.02117389473991613,0.050634919968780202,0.42300098722028778,0.90446555261765504,-0.0029340053672294976,-0.0035071024338269776,0.0096706699359511775],"Pressure":[27763.579147924542],"DVL":[-0.0078183743517229419,0.019001095372001484,0.079199343069216763,7.2901481103745356,0.0056135625774187013,0.0073232281921585957,0.0095223645825844305,0],"IMU":[0.0045625810631431995,0.1097282995799501,0.87516945621269071,0.095482440542518948,-0.035335803268843564,0.073678206985524297,1.0917394872659087,-0.055478758903176079,-9.7153961684015382],"FOG":[0.88311847534684063],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-19.010333931355817,-26.571061941940666,-33.454754929971159,52.199577140865259,52.199577140865259],"omega_rad_s":[-19.115580559844901,-27.453171298778202,-33.563731791131644,51.754945897729144,51.754587975964583],"thrust_n":[-4.6160050034312725,-9.4157274812183527,-14.053866062874315,35.468299413485219,35.377078098675362],"torque_nm":[0.086550093814336371,0.17654489027284412,0.26350998867889341,-0.66503061400284791,-0.66332021435016308],"angle_rad":[-579.96971490308567,674.76482029425392,-331.69653518424821,1280.3461418405611,1280.3471885766201]},"command":[-0.18105079934624588,-0.25305773278038729,-0.31861671361877297,0.49713882991300246,0.49713882991300246],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,3.2462537703521064e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,4.3368086899420177e-19,0,0,0],"servo_effort":[0.045717025868151233,-1.1780946204235021,-0.24524954954486528,0.00014367222474658038,-0.00081381334913926842,0.00026488847867773234]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":438,"step":3504,"t":17.52,"sim_time":17.520000000000799,"vehicle":{"origin_ned":[1.626770305045496,1.1037634369917091,3.5896454255857471],"origin_quat_xyzw":[-0.02118885261467094,0.050551583165611834,0.42317496443321789,0.90438847816702561],"cg_ned":[1.5724122549670716,1.0410931976705786,3.2967058839968368],"linear_velocity_ned":[-0.020756793740069085,-0.015723048526132138,-0.051565842354393959],"angular_velocity_ned":[0.0013751690777160973,-0.0037087772949915068,0.0093959963282390993]},"sensors":{"Odom":[1.626770305045496,1.1037634369917091,3.5896454255857471,-0.020593862292028482,0.0069811182882990423,-0.053885317376946261,-0.021188852614670951,0.050551583165611862,0.42317496443321811,0.90438847816702561,-0.0029828802566676366,-0.0033907823863146632,0.0091397968357876773],"Pressure":[27745.101426057325],"DVL":[-0.029160830193390386,0.0066214996603172968,0.065032158519955655,7.3453469346598457,0.021575884093032589,-0.007477333998393159,-0.0012709984650346423,0],"IMU":[0.0044853423717619856,0.10958894669912086,0.87554596513305705,-0.0081919844053003985,0.039563453968538435,-0.16054362920745299,1.0656899690638444,-0.047476696167727178,-9.732015796356368],"FOG":[0.89170484931809635],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-18.849063481181016,-26.633835734650294,-33.279254670610072,52.373686308234667,52.373686308234667],"omega_rad_s":[-18.959174244865697,-27.500393171376217,-33.382345886976999,51.935510419989093,51.935154410295439],"thrust_n":[-4.5396190774840353,-9.4455131870464299,-13.901099800973537,35.715393361458489,35.626871338625541],"torque_nm":[0.085117857702825678,0.17710337225712058,0.26064562126825386,-0.66966362552734671,-0.66800383759922899],"angle_rad":[-580.73077865192511,673.66560840966497,-333.03494283056568,1282.4204537852404,1282.4214862472224]},"command":[-0.17951489029696205,-0.25365557842524089,-0.31694528257723875,0.4987970124593778,0.4987970124593778],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,-1.0905549195899114e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,-4.3368086899420177e-19,0,0,0],"servo_effort":[0.042094929347109587,-1.1817445363314021,-0.24528148210301881,0.00013682035075923373,-0.0008109677556643912,0.00026278031313016497]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":439,"step":3512,"t":17.559999999999999,"sim_time":17.560000000000791,"vehicle":{"origin_ned":[1.6258704985885037,1.1031388560089816,3.5875899983812189],"origin_quat_xyzw":[-0.021206248900184133,0.050469670437892508,0.42333939721663644,0.90431568721200928],"cg_ned":[1.5715787967783985,1.0404638859806645,3.2946391650017435],"linear_velocity_ned":[-0.020897097974954579,-0.015739644372280578,-0.051743944846998201],"angular_velocity_ned":[0.0012147781500273054,-0.0037185912026307995,0.0088817099029856999]},"sensors":{"Odom":[1.6258704985885037,1.1031388560089816,3.5875899983812189,-0.020647309523094921,0.0070805001185906035,-0.054076463951389743,-0.021206248900184153,0.050469670437892557,0.42333939721663683,0.90431568721200928,-0.0030362630221062049,-0.003276218034896387,0.0086160245783813427],"Pressure":[27725.570976374569],"DVL":[-0.044574067782960795,0.029132680359529935,0.054898659922447579,7.2499058264078169,-0.00012618526747227104,0.0075421678895238884,-0.010878742173419139,0],"IMU":[0.0044036790380055611,0.10945432815648204,0.87590129804584504,0.042337562058213707,0.031157029166610846,-0.09218258835375881,1.0719825405355938,-0.045609231082605776,-9.7547739805545959],"FOG":[0.85806001459193681],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-18.685053372869103,-26.695714995071352,-33.104982408888461,52.548837197133892,52.548837197133892],"omega_rad_s":[-18.799387420466047,-27.546879312953461,-33.202299654900592,52.117332687086716,52.116978649902073],"thrust_n":[-4.4622920939293191,-9.4749557721794915,-13.750383464439086,35.964470225789434,35.878618368917856],"torque_nm":[0.083667976761174725,0.17765542072836549,0.2578196899582329,-0.67433381673355186,-0.67272409441720982],"angle_rad":[-581.48550843027692,672.56452472217961,-334.3661255403245,1284.5020174515057,1284.5030357173109]},"command":[-0.17795288926542002,-0.25424490471496525,-0.3152855467513187,0.5004651161631799,0.5004651161631799],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.038488869446821665,-1.185368137230322,-0.24531115567737422,0.00012997216896573039,-0.00080805074730126974,0.00026068188474729845]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":440,"step":3520,"t":17.600000000000001,"sim_time":17.600000000000783,"vehicle":{"origin_ned":[1.6249664367795331,1.102514483784907,3.5855276133805272],"origin_quat_xyzw":[-0.021226136073291917,0.050389125119615831,0.42349442089727418,0.90424712478722324],"cg_ned":[1.5707399431141893,1.0398340300389677,3.2925658758887812],"linear_velocity_ned":[-0.021027800387212716,-0.015750948832854109,-0.051897449947348018],"angular_velocity_ned":[0.0010536667534193757,-0.0037313973792869586,0.008374841737110705]},"sensors":{"Odom":[1.6249664367795331,1.102514483784907,3.5855276133805272,-0.020693513974514008,0.0071772505975145132,-0.054241994556247244,-0.021226136073291924,0.050389125119615845,0.42349442089727435,0.90424712478722324,-0.0030932282867278033,-0.0031629029435911891,0.0080993516954551079],"Pressure":[27705.464926795503],"DVL":[0.011929033910948045,0.06058854446974106,0.068787225544175545,7.3297267137773163,0.001368251431375879,0.015314927528345922,-0.00048344884349749292,0],"IMU":[0.0043174701563426319,0.10932438423918107,0.87623574108054203,-0.0065684711371128551,-0.050485215562125561,-0.043554823338808286,1.0622360407445761,-0.044553102433656885,-9.7817661749899187],"FOG":[0.88820795469806335],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-18.518551989199281,-26.75683845517764,-32.932033662853534,52.724902558258208,52.724902558258208],"omega_rad_s":[-18.636466972971313,-27.592715619393974,-33.023621371643117,52.300261442172591,52.299909417418299],"thrust_n":[-4.3841806345722913,-9.5041090839581504,-13.601715665568324,36.215335577383669,36.132139523017464],"torque_nm":[0.082203386898230466,0.17820204532421535,0.25503216872940615,-0.67903754207594369,-0.6774776160565773],"angle_rad":[-582.23377463051429,671.46159674082276,-335.69013748678753,1286.5908796608653,1286.5918838103639]},"command":[-0.1763671618018979,-0.2548270329064537,-0.31363841583670032,0.50214192912626865,0.50214192912626865],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.034894573067920848,-1.1890416376050479,-0.24535612208303431,0.00012312309026760325,-0.00080502647461700133,0.00025862065484109095]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":441,"step":3528,"t":17.640000000000001,"sim_time":17.640000000000775,"vehicle":{"origin_ned":[1.6240584491917915,1.1018905514776023,3.5834592530227884],"origin_quat_xyzw":[-0.021248551564597953,0.050309901640063374,0.42364016947752586,0.90418273576662966],"cg_ned":[1.5698960723146471,1.0392038370693262,3.2904869944402897],"linear_velocity_ned":[-0.021149156189757181,-0.015757158082404514,-0.052026630925375607],"angular_velocity_ned":[0.00089238913813569954,-0.003746478789706199,0.0078752817655953905]},"sensors":{"Odom":[1.6240584491917915,1.1018905514776023,3.5834592530227884,-0.020732747153290421,0.0072711559043192493,-0.054382220313380136,-0.02124855156459796,0.050309901640063388,0.42364016947752597,0.90418273576662966,-0.0031528628115211409,-0.0030508035487465117,0.0075897680057945794],"Pressure":[27686.198773885018],"DVL":[-0.0099393038729544761,-0.0053680628588169896,0.067441641599914351,7.311468331523268,-0.019101313447409451,-0.028836045175079747,-0.00088948872251122719,0],"IMU":[0.0042266311173629377,0.10919906247528696,0.8765495800512203,-0.095238680440533366,0.057383643445405697,0.12997758419148414,1.0835368410271473,-0.048161396899987365,-9.7684358918729757],"FOG":[0.88315418850167271],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-18.349813167333426,-26.817233096212675,-32.760420161341941,52.90177681857358,52.90177681857358],"omega_rad_s":[-18.47066643609212,-27.637976815134607,-32.84634042353283,52.484158997918378,52.483809006888791],"thrust_n":[-4.3054410230207312,-9.5330201804318655,-13.455096527924386,36.467817497706378,36.387264607810607],"torque_nm":[0.080727019181638715,0.17874412838309747,0.25228305989858224,-0.68377157808199462,-0.68226121139644902],"angle_rad":[-582.97545767302768,670.35684867835278,-337.007034094723,1288.687081501939,1288.6880716161584]},"command":[-0.17476012540317548,-0.25540221996393025,-0.31200400153658991,0.50382644589117698,0.50382644589117698],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.031306824497999146,-1.1928081719154393,-0.24542572538685903,0.00011633208781044507,-0.00080197097900997481,0.00025660625982649841]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":442,"step":3536,"t":17.68,"sim_time":17.680000000000767,"vehicle":{"origin_ned":[1.6231468638312969,1.1012672757307265,3.5813858884262353],"origin_quat_xyzw":[-0.021273516733835377,0.050231962615794754,0.42377677558703575,0.90412246509562832],"cg_ned":[1.569047552535191,1.0385735066103035,3.2884034873131665],"linear_velocity_ned":[-0.021261419201744403,-0.015758460944021342,-0.052131769389417278],"angular_velocity_ned":[0.00073149102990551006,-0.0037631333630228038,0.007382914112315531]},"sensors":{"Odom":[1.6231468638312969,1.1012672757307265,3.5813858884262353,-0.020765274510413489,0.0073620095060727593,-0.054497459590791809,-0.021273516733835384,0.050231962615794767,0.42377677558703586,0.90412246509562832,-0.0032142695627720773,-0.0029398903648470169,0.0070872553534546811],"Pressure":[27666.860455211132],"DVL":[-0.039198901533470505,0.0074735042978109527,0.059503343860180462,7.3555727596553035,-0.0063389486670092565,-0.029714071433896608,0.047699487343868134,0],"IMU":[0.0041311129912538916,0.10907831145398757,0.8768431001126874,0.0099181942044487097,0.0089643093253913668,0.14957211062191525,1.0817212646089909,-0.035781846540420117,-9.7840078839058915],"FOG":[0.88405246506137047],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-18.179095456546023,-26.876899974001855,-32.590137430284926,53.079357738433728,53.079357738433728],"omega_rad_s":[-18.302245383737969,-27.682712109008104,-32.670474327757454,52.668898189015835,52.668550239900384],"thrust_n":[-4.2262287292955092,-9.5617187007029472,-13.310516300869541,36.721756597845761,36.643835017428778],"torque_nm":[0.079241788674290783,0.17928222563818028,0.2495721806413039,-0.68853293620960809,-0.68707190657678963],"angle_rad":[-583.71044825811668,669.25030236143039,-338.31687168114757,1290.7906588031926,1290.7916349637023]},"command":[-0.17313424244329545,-0.25597047594287481,-0.31038226124080881,0.50551769274698788,0.50551769274698788],"arm":{"servo_position":[4.1226681729642708e-23,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[1.3552527156068805e-20,0,0,0,0,0],"servo_effort":[0.027721094044037699,-1.196663903054197,-0.24551965568769379,0.00010955494417916687,-0.00079888979746758155,0.0002546396438823948]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":443,"step":3544,"t":17.719999999999999,"sim_time":17.720000000000759,"vehicle":{"origin_ned":[1.6222320070429466,1.1006448590125151,3.5793084791193479],"origin_quat_xyzw":[-0.021301037061045556,0.050155278609653735,0.42390437035578765,0.90406625788211736],"cg_ned":[1.5681947418076585,1.0379432308123528,3.2863163097390782],"linear_velocity_ned":[-0.021364841766644407,-0.015755038804574625,-0.052213154238047559],"angular_velocity_ned":[0.00057152034927274999,-0.003780675984722232,0.0068976165682299697]},"sensors":{"Odom":[1.6222320070429466,1.1006448590125151,3.5793084791193479,-0.020791358274694225,0.0074496104576508631,-0.054588036504369483,-0.021301037061045559,0.050155278609653742,0.42390437035578776,0.90406625788211736,-0.0032765623748396561,-0.002830147383333299,0.0065917877336732896],"Pressure":[27646.211179094829],"DVL":[0.0045632785266598481,0.013681570442726495,0.041997792750104172,7.3485157264148118,0.0091471948776192628,0.004435636168965737,0.022507432594908245,0],"IMU":[0.0040309019692230707,0.10896208052265748,0.87711658541191895,0.066316927642681392,0.10960013386874669,-0.076921607937848496,1.0576082112854983,-0.051271036041536169,-9.7555043554791343],"FOG":[0.87990349605667317],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-18.00666476432437,-26.935835355638119,-32.421183539711684,53.257545126318,53.257545126318],"omega_rad_s":[-18.131469684769407,-27.726951942412871,-32.496033353780192,52.854359750065534,52.854013841866326],"thrust_n":[-4.1466981838920445,-9.5902214196537159,-13.167959385640854,36.97700231460319,36.901700647031177],"torque_nm":[0.077750590947975831,0.17981665161850724,0.246899238480766,-0.69331879339880997,-0.69190688713183468],"angle_rad":[-584.43864761099053,668.14197808933011,-339.61970708930517,1292.9016424922831,1292.902604780762]},"command":[-0.17149204537451782,-0.25653176529179161,-0.30877317656868269,0.50721471548874286,0.50721471548874286],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.024132869543689466,-1.20060822851432,-0.24563767762650082,0.00010282434472224117,-0.00079573793046743002,0.00025272176447143605]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":444,"step":3552,"t":17.760000000000002,"sim_time":17.760000000000751,"vehicle":{"origin_ned":[1.6213142033207999,1.1000234899103292,3.5772279727844363],"origin_quat_xyzw":[-0.02133110228295268,0.050079827688790136,0.42402308331621885,0.90401405948638991],"cg_ned":[1.5673379881028746,1.0373131947686902,3.2842264052029404],"linear_velocity_ned":[-0.021459675021410395,-0.015747064412206416,-0.052271082681787824],"angular_velocity_ned":[0.00041301874906451074,-0.0037984460093427449,0.0064192626346968136]},"sensors":{"Odom":[1.6213142033207999,1.1000234899103292,3.5772279727844363,-0.020811256085907611,0.0075337677500474159,-0.054654281961000944,-0.021331102282952687,0.05007982768879015,0.42402308331621902,0.90401405948638991,-0.0033388773115784263,-0.0027215702580921275,0.0061033321206272638],"Pressure":[27627.070114423099],"DVL":[-0.029434623937950599,-0.023214099328730163,0.063788942267945084,7.3002537380718735,0.0014543458554420999,0.0058560144260122746,-0.00056217896622796156,0],"IMU":[0.0039260187356551998,0.10885031907858111,0.87737031878990945,-0.026936997408451249,-0.025708315430009582,0.035097623962557993,1.0576711001739536,-0.028937615050899201,-9.7511986791070413],"FOG":[0.87274218705994622],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-17.832794745987499,-26.994028935858694,-32.253556118849168,53.436240879528746,53.436240879528746],"omega_rad_s":[-17.958612121004659,-27.770711976464671,-32.323022899420579,53.040430465679329,53.040086591186515],"thrust_n":[-4.0670027598201965,-9.6185349590050429,-13.027406444769566,37.233410599176466,37.160717497467481],"torque_nm":[0.076256301746628702,0.18034753048134455,0.24426387083942944,-0.69812644873455876,-0.6967634530775153],"angle_rad":[-585.15996774977248,667.03189528813516,-340.91559745755933,1295.0200588677296,1295.0210073656683]},"command":[-0.16983614043797618,-0.25708598986532089,-0.30717672494142068,0.50891657980503568,0.50891657980503568],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,-1.0905549195899114e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,-8.6736173798840355e-19,0,0,0],"servo_effort":[0.020539004994415931,-1.2046377149613934,-0.24577976337834129,9.6154154555728785e-05,-0.00079255437554811084,0.0002508533395940702]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":445,"step":3560,"t":17.800000000000001,"sim_time":17.800000000000743,"vehicle":{"origin_ned":[1.6203937751823474,1.099403343747243,3.5751453050054383],"origin_quat_xyzw":[-0.021363687001580176,0.050005595320017471,0.42413304235914656,0.90396581555585565],"cg_ned":[1.5664776294057476,1.0366835768269997,3.2821347052086325],"linear_velocity_ned":[-0.021546167182482121,-0.015734703042171179,-0.052305856046798632],"angular_velocity_ned":[0.000256497193902747,-0.0038157967849901634,0.0059477262830258818]},"sensors":{"Odom":[1.6203937751823474,1.099403343747243,3.5751453050054383,-0.02082521354535365,0.0076143008442228783,-0.054696530776179926,-0.021363687001580197,0.050005595320017519,0.42413304235914695,0.90396581555585565,-0.0034003807052384117,-0.0026141407000487174,0.0056218523026142601],"Pressure":[27607.566241953802],"DVL":[-0.0010801225065610251,0.018709209964406844,0.053886583148942922,7.3472492609751967,-0.031466609382622017,0.0097040841833987233,-0.047596407406871155,0],"IMU":[0.0038165172769424618,0.10874297687951628,0.87760458160081212,-0.0052522107645795084,-0.013196607684967956,0.046925318112220255,1.0658820972202427,-0.027057519341679662,-9.7501653997892213],"FOG":[0.88060335436917681],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-17.657759873758017,-27.051471021543509,-32.087256021215197,53.615348967008792,53.615348967008792],"omega_rad_s":[-17.783950750407627,-27.813997325696509,-32.151445855423297,53.227001994637497,53.226660142427633],"thrust_n":[-3.987293753046286,-9.6466586605325215,-12.888836373268726,37.490842029502197,37.420746518282925],"torque_nm":[0.074761757869617862,0.18087484988498478,0.24166568199878866,-0.70295328805316626,-0.70163899721780509],"angle_rad":[-585.87433172857686,665.92007301169974,-342.20460007653139,1297.1459298137399,1297.146864602242]},"command":[-0.16816914165483826,-0.25763305734803343,-0.30559291448776377,0.51062237111436948,0.51062237111436948],"arm":{"servo_position":[7.3453638394706939e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.01693733768650325,-1.2087473988710662,-0.24594466960790617,8.9509383235966656e-05,-0.0007893234952003127,0.00024903278247001792]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":446,"step":3568,"t":17.84,"sim_time":17.840000000000735,"vehicle":{"origin_ned":[1.6194710430409267,1.0987845831397556,3.573061399007174],"origin_quat_xyzw":[-0.021398751225842869,0.049932574169051037,0.42423437366742184,0.90392147207699236],"cg_ned":[1.5656139938211782,1.0360545489056461,3.2800421290170485],"linear_velocity_ned":[-0.021624564125021752,-0.015718111880084644,-0.052317783432144591],"angular_velocity_ned":[0.00010244994003455249,-0.0038321072230188174,0.0054828772679723636]},"sensors":{"Odom":[1.6194710430409267,1.0987845831397556,3.573061399007174,-0.020833469131417651,0.0076910400873657801,-0.054715124415104843,-0.021398751225842876,0.049932574169051051,0.424234373667422,0.90392147207699236,-0.0034602686038770454,-0.0025078445264038133,0.0051473043347934483],"Pressure":[27586.779978685066],"DVL":[-0.016889956201141476,0.0058681219175899108,0.072880560876783351,7.281317063941235,-0.00080865740217708065,0.0056899275320511731,-0.0036525165587355381,0],"IMU":[0.0037024837273024105,0.10864000412872073,0.87781965347893975,0.01185915118921153,-0.032709289508464544,-0.023064689673689284,1.0854678630982046,-0.0393709646825013,-9.7641595369537253],"FOG":[0.89096831295031986],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-17.481838260976399,-27.108150913789675,-31.922287154960266,53.794775560244325,53.794775560244325],"omega_rad_s":[-17.60776822856721,-27.856806142632323,-31.981304543538212,53.413969929404786,53.413630085118108],"thrust_n":[-3.9077198266214097,-9.6745870637159328,-12.752227955312652,37.749160868403983,37.681652249318091],"torque_nm":[0.073269746749151432,0.18139850744467376,0.23910427416211222,-0.70779676628257493,-0.70653097967471434],"angle_rad":[-586.58167383084833,664.80653027183519,-343.48677233593929,1299.2792729711045,1299.2801941307455]},"command":[-0.16649369772358474,-0.25817286584561594,-0.304021782428193,0.51233119581185071,0.51233119581185071],"arm":{"servo_position":[-9.5952951056153132e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.013325137450061697,-1.2129333280162578,-0.24613111639495408,8.2960809879898556e-05,-0.00078604659205315053,0.00024725710412639947]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":447,"step":3576,"t":17.879999999999999,"sim_time":17.880000000000727,"vehicle":{"origin_ned":[1.6185463250196424,1.098167358516845,3.5709771654878275],"origin_quat_xyzw":[-0.021436240884851968,0.049860763768646961,0.42432720164434884,0.90388097543747969],"cg_ned":[1.5647473996843875,1.0354262768208842,3.2779495834556758],"linear_velocity_ned":[-0.021695109128005173,-0.015697440020953485,-0.05230717772377539],"angular_velocity_ned":[-4.864414235594465e-05,-0.0038467827186448424,0.005024584486659287]},"sensors":{"Odom":[1.6185463250196424,1.098167358516845,3.5709771654878275,-0.020836254924703566,0.0077638267790556773,-0.05471040695109991,-0.021436240884851975,0.049860763768646975,0.42432720164434895,0.90388097543747969,-0.0035177670072883793,-0.002402673144063595,0.0046796399269448345],"Pressure":[27569.263361499339],"DVL":[0.0021651492198159657,-0.0023859038984003211,0.050490139674959231,7.3548197268227229,-0.0017138545518498222,-0.019977307248553417,-0.01844821465144534,0],"IMU":[0.0035840351530685489,0.10854135130348579,0.87801581208509338,0.035105503660815177,0.061109480293887304,-0.11588242325769235,1.0533581269092629,-0.030474003197397619,-9.7350376634122959],"FOG":[0.87516526914297543],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-17.305310611852637,-27.164055332118167,-31.758656602501205,53.974428006653071,53.974428006653071],"omega_rad_s":[-17.43035107247654,-27.89913094476276,-31.812602002309902,53.601233155672936,53.600895302962485],"thrust_n":[-3.828426468351525,-9.7023108126948294,-12.617560896347779,38.008234209867247,37.943301902817602],"torque_nm":[0.071782996281591099,0.18191832773802805,0.23657926680652089,-0.71265439143501097,-0.71143691067783021],"angle_rad":[-587.28193973524401,663.69128628635292,-344.76217173255839,1301.4201018822159,1301.4210094929506]},"command":[-0.16481248201764417,-0.25870528887731586,-0.30246339621429719,0.51404217149193399,0.51404217149193399],"arm":{"servo_position":[7.3453638394706939e-24,3.2526065174565154e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,8.6736173798840355e-19,0,0,0,0],"servo_effort":[0.0097016960945705347,-1.2171908419018309,-0.24633573099155401,7.6476006243952571e-05,-0.00078273840423357332,0.0002455143381399388]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":448,"step":3584,"t":17.920000000000002,"sim_time":17.920000000000719,"vehicle":{"origin_ned":[1.6176199367312649,1.0975518086387752,3.5688935024057882],"origin_quat_xyzw":[-0.021476088398871929,0.049790170156345029,0.42441164890794902,0.90384427245744148],"cg_ned":[1.5638781556765031,1.0347989205854151,3.2758579626819495],"linear_velocity_ned":[-0.021758041675806302,-0.015672829461777525,-0.052274358449934714],"angular_velocity_ned":[-0.00019632750587302169,-0.0038592576185010213,0.0045727182733962474]},"sensors":{"Odom":[1.6176199367312649,1.0975518086387752,3.5688935024057882,-0.020833795375751564,0.0078325134935326932,-0.054682728063628235,-0.021476088398871936,0.04979017015634505,0.42441164890794919,0.90384427245744148,-0.0035721377783268313,-0.0022986204489895321,0.0042188081240452126],"Pressure":[27547.044930915872],"DVL":[-0.045280182004090674,0.030400388638480876,0.049287811371607801,7.3906534762094687,-0.013578385123599598,-0.042184792970938231,0.02279483664647116,0],"IMU":[0.0034613182139840428,0.10844696898227568,0.87819333299319813,-0.026024311921192027,0.056821549914200999,-0.033156556278926053,1.0750937883562188,-0.034753739051945259,-9.7396353503546695],"FOG":[0.86847175320933945],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-17.128458697922731,-27.219170048410682,-31.596372165410013,54.154215750978899,54.154215750978899],"omega_rad_s":[-17.251988852598675,-27.940960021400166,-31.645342153525075,53.788693346731364,53.788357468006332],"thrust_n":[-3.7495554655763859,-9.7298176273860957,-12.48481592595885,38.267931396111166,38.205564831712408],"torque_nm":[0.070304164979557257,0.18243408051348933,0.23409029861172848,-0.71752371367708445,-0.71635434059460756],"angle_rad":[-587.97508665312284,662.5743606727566,-346.03085590472818,1303.5684261085662,1303.569320249665]},"command":[-0.1631281780754546,-0.25923019093724459,-0.30091783014676204,0.51575443572360857,0.51575443572360857],"arm":{"servo_position":[-1.1249656330723097e-24,3.2526065174565154e-21,-1.0905549195899114e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,8.6736173798840355e-19,-4.3368086899420177e-19,0,0,0],"servo_effort":[0.0060646654825521531,-1.2215214890407566,-0.24656197761501364,7.0107699210183132e-05,-0.0007793792695738632,0.00024381901430208457]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":449,"step":3592,"t":17.960000000000001,"sim_time":17.960000000000711,"vehicle":{"origin_ned":[1.6166921910753216,1.0969380611374786,3.5668112947833186],"origin_quat_xyzw":[-0.02151821330519909,0.049720805533230633,0.42448783626346603,0.90381131042803364],"cg_ned":[1.5630065609587454,1.0341726346970375,3.273768147970511],"linear_velocity_ned":[-0.02181359884598073,-0.015644414801226646,-0.052219649510838594],"angular_velocity_ned":[-0.00034016280800203602,-0.0038689954638136746,0.0041271479169586543]},"sensors":{"Odom":[1.6166921910753216,1.0969380611374786,3.5668112947833186,-0.0208263084879802,0.0078969650372174988,-0.054632440819547608,-0.0215182133051991,0.049720805533230654,0.4244878362634662,0.90381131042803364,-0.0036226778533250143,-0.0021956837508571767,0.0037647529269083549],"Pressure":[27528.184671868439],"DVL":[-0.01672597636873973,-0.021322720643333504,0.064970975828519767,7.3455069911920283,-0.0042734261321285853,0.042552223088714196,0.013662952585979169,0],"IMU":[0.0033345077399640818,0.1083568077614244,0.87835248952808065,0.032718081733122177,-0.037534159574254281,-0.018225642445077999,1.0475610737467409,-0.032014902796828663,-9.747412837581324],"FOG":[0.85906152909236011],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-16.9515659160942,-27.273480131644444,-31.435444087127145,54.33405013371236,54.33405013371236],"omega_rad_s":[-17.072973663491911,-27.982278687613672,-31.479530245449034,53.976254784965725,53.975920861945376],"thrust_n":[-3.6712445252165637,-9.7570931554572908,-12.353975127713193,38.528123793068161,38.468312311419957],"torque_nm":[0.06883583484781057,0.18294549666482424,0.23163703364462246,-0.72240232112002811,-0.72128085583912438],"angle_rad":[-588.66108343803978,661.45577358639412,-347.29288267671672,1305.7242513389044,1305.7251320889177]},"command":[-0.16144348491518287,-0.25974742982518517,-0.29938518178216328,0.51746714413059391,0.51746714413059391],"arm":{"servo_position":[-1.1249656330723097e-24,-1.0842021724855024e-21,-1.0905549195899114e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,-8.6736173798840355e-19,0,0,0,0],"servo_effort":[0.0024147105905851,-1.2259235060839917,-0.24680950167220755,6.3862076146250309e-05,-0.00077601752071934941,0.00024216905102383582]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":450,"step":3600,"t":18,"sim_time":18.000000000000703,"vehicle":{"origin_ned":[1.6157633979844752,1.0963262330503345,3.5647314145489535],"origin_quat_xyzw":[-0.021562522910488616,0.04965268786315935,0.4245558826812586,0.90378203714968552],"cg_ned":[1.5621329052957995,1.0335475684219164,3.2716810075322433],"linear_velocity_ned":[-0.021862013772140108,-0.015612324023818104,-0.052143379766981614],"angular_velocity_ned":[-0.00047973599186200899,-0.0038754932642284228,0.003687744930975804]},"sensors":{"Odom":[1.6157633979844752,1.0963262330503345,3.5647314145489535,-0.020814005465523942,0.0079570586405739718,-0.05455990220080207,-0.021562522910488623,0.049652687863159371,0.42455588268125877,0.90378203714968552,-0.0036687248244137859,-0.0020938640280674637,0.0033174160024935966],"Pressure":[27505.921997191559],"DVL":[-0.0022708281383776383,0.029047746599104765,0.046249437224333778,7.3666134349539467,0.009601640032528648,0.025617644772044458,0.027815011487487377,0],"IMU":[0.0032038052093568471,0.10827081809063628,0.87849355260903916,0.016994784219705832,0.003493957641544664,-0.02114104792978946,1.0655777666872972,-0.032492185293709369,-9.7235871968707439],"FOG":[0.8750550440699244],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-16.774915204573432,-27.326968642732172,-31.275884550632156,54.513843973486473,54.513843973486473],"omega_rad_s":[-16.893599151292545,-28.023069604033665,-31.315173151269878,54.163824036186,54.163492050359494],"thrust_n":[-3.5936267534834085,-9.7841211952418004,-12.225022140687138,38.788684418674791,38.731417138332624],"torque_nm":[0.067380501627813907,0.18345227241078371,0.22921916513788387,-0.7272878328501523,-0.72621407134373683],"angle_rad":[-589.33991066476005,660.33554583181433,-348.54831011963165,1307.8875794859298,1307.8884469226684]},"command":[-0.15976109718641365,-0.26025684421649686,-0.29786556714887769,0.51917946641415691,0.51917946641415691],"arm":{"servo_position":[4.6322114302950351e-25,-1.0842021724855024e-21,1.0778494253810975e-21,-2.7105054312137611e-22,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,-5.4210108624275222e-20,0,0],"servo_effort":[-0.0012480725425784724,-1.2303949736335231,-0.2470779116550591,5.7707660455935291e-05,-0.00077258579370225833,0.00024056636869811203]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":451,"step":3608,"t":18.039999999999999,"sim_time":18.040000000000695,"vehicle":{"origin_ned":[1.6148338641679381,1.0957164313780561,3.5626547203234944],"origin_quat_xyzw":[-0.021608913021026206,0.049585840488617125,0.42461590529015214,0.90375640095974508],"cg_ned":[1.5612574691899019,1.0329238660555009,3.2695973962850271],"linear_velocity_ned":[-0.021903516513474216,-0.015576678610621293,-0.05204588398553333],"angular_velocity_ned":[-0.00061465712094570658,-0.0038782816685884588,0.0032543807046088802]},"sensors":{"Odom":[1.6148338641679381,1.0957164313780561,3.5626547203234944,-0.020797091070500082,0.0080126846400120771,-0.054465474150365664,-0.021608913021026216,0.049585840488617146,0.42461590529015236,0.90375640095974508,-0.003709657348304635,-0.0019931653137447501,0.0028767343009084732],"Pressure":[27487.54821057136],"DVL":[-0.014591258046067713,0.013693568572914509,0.059698580478625154,7.3601010263958253,-0.016531404672952825,0.017098036467709882,-0.0097414231355103312,0],"IMU":[0.0030694371016303039,0.1081889502088457,0.87861679062498887,-0.018524703795042542,-0.0001516913123628743,-0.016048238388215192,1.0595877170484684,-0.035808656933314982,-9.7478300900910959],"FOG":[0.8772325306473413],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-16.598787897418006,-27.37961849295727,-31.117707654156767,54.69351240005615,54.69351240005615],"omega_rad_s":[-16.714159545990245,-28.063313589298915,-31.152279439247341,54.351309928001591,54.350979860985312],"thrust_n":[-3.5168301740679482,-9.8108842494836441,-12.097942175506295,39.049487986134238,38.99475371595949],"torque_nm":[0.065940565763774037,0.18395407967781832,0.22683641579074307,-0.73217789974001712,-0.7311516321742404],"angle_rad":[-590.01156067053,659.21369895008434,-349.79719661720253,1310.058408776079,1310.0592629766165]},"command":[-0.15808369426112387,-0.26075827136149782,-0.29635912051577873,0.52089059428624906,0.52089059428624906],"arm":{"servo_position":[2.5808035111652547e-24,3.2526065174565154e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,8.6736173798840355e-19,0,0,-3.4694469519536142e-18,0],"servo_effort":[-0.0049231862221830233,-1.2349341673832257,-0.2473664720705909,5.1719451248571926e-05,-0.00075674358799258576,0.00023944136686160822]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":452,"step":3616,"t":18.080000000000002,"sim_time":18.080000000000688,"vehicle":{"origin_ned":[1.6139038928367755,1.0951087536280701,3.5605820572770619],"origin_quat_xyzw":[-0.021657268692519833,0.04952029169824354,0.42466801937462567,0.90373435075985309],"cg_ned":[1.5603805240287021,1.0323016671710612,3.2675181556899955],"linear_velocity_ned":[-0.021938333690310109,-0.01553759385816323,-0.051927499924083263],"angular_velocity_ned":[-0.00074456258444032582,-0.0038769268743502226,0.0028269305036568142]},"sensors":{"Odom":[1.6139038928367755,1.0951087536280701,3.5605820572770619,-0.020775763788181613,0.0080637472764673052,-0.054349520699398454,-0.021657268692519847,0.049520291698243575,0.42466801937462595,0.90373435075985309,-0.0037448984403904559,-0.0018935941233673577,0.0024426437461943914],"Pressure":[27467.720585219697],"DVL":[-0.0007880166358900341,0.00033137909939826363,0.052497299777605054,7.3223889092299705,-0.0024270248901343285,-0.0039465173289260263,0.021536944102130567,0],"IMU":[0.0029316531735797857,0.108111154012587,0.87872246931364362,-0.023890187669150922,0.0071746948047199787,-0.24401266484062226,1.0417580892733067,-0.015881909001090114,-9.7384880595215666],"FOG":[0.88573910380434195],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-16.423463600127818,-27.43141112961651,-30.960929487620948,54.872972114561719,54.872972114561719],"omega_rad_s":[-16.534948771946137,-28.102989716739227,-30.990859591196646,54.538623474411374,54.538295308263471],"thrust_n":[-3.4409773331275537,-9.8373635934112613,-11.972722137244707,39.310410805627221,39.25819794077556],"torque_nm":[0.064518324996141629,0.18445056737646115,0.22448854007333832,-0.73707020260551037,-0.73609121138954192],"angle_rad":[-590.67603755692119,658.09025529072119,-351.03960093983943,1312.2367338397216,1312.2375748804059]},"command":[-0.15641393904883635,-0.26125153456777628,-0.29486599512019951,0.52259973442439733,0.52259973442439733],"arm":{"servo_position":[2.5808035111652547e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.0086078090189420867,-1.2395402830252606,-0.24767482974966093,4.5836729838117628e-05,-0.00076562338152602377,0.00023749182923088144]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":453,"step":3624,"t":18.120000000000001,"sim_time":18.12000000000068,"vehicle":{"origin_ned":[1.6129737834038573,1.0945032883613259,3.5585142569402142],"origin_quat_xyzw":[-0.021707465007601828,0.049456074314330294,0.42471233840141276,0.90371583602699079],"cg_ned":[1.5595023322082782,1.0316811068498086,3.2654441135472205],"linear_velocity_ned":[-0.021966688279465744,-0.015495179774117872,-0.051788572092094615],"angular_velocity_ned":[-0.00086911425967403904,-0.0038710306476855494,0.0024052716091105416]},"sensors":{"Odom":[1.6129737834038573,1.0945032883613259,3.5585142569402142,-0.020750216160000053,0.0081101637604668736,-0.054212411732949439,-0.021707465007601835,0.049456074314330314,0.42471233840141293,0.90371583602699079,-0.0037739147579577319,-0.0017951600436302752,0.0020150774681646768],"Pressure":[27446.803017561462],"DVL":[-0.0068515910245446256,0.041020158893833911,0.03992920626209271,7.4182600665737528,-0.00068626555115359274,-0.012927697568702209,-0.002180824830309559,0],"IMU":[0.0027907247058031855,0.10803737898721498,0.87881085170745354,0.032731143818468734,0.017089805095035542,-0.027685014906461577,1.0441293405770369,-0.019057733553715171,-9.762233702678385],"FOG":[0.86601156875928198],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-16.24921741522515,-27.482328056709385,-30.805566886328307,55.052141882178567,55.052141882178567],"omega_rad_s":[-16.356259072706116,-28.142075940022906,-30.83092567905728,54.725677748378772,54.725351465855084],"thrust_n":[-3.3661847458439147,-9.8635397067980897,-11.849350330904446,39.57133073804679,39.521627165583865],"torque_nm":[0.063115963984573406,0.1849413695024642,0.22217531870445842,-0.74196245133837724,-0.74103050935469761],"angle_rad":[-591.3333571467715,656.96523806658979,-352.27558231391134,1314.4225457938676,1314.4233737503416]},"command":[-0.15475445157357284,-0.26173645768294651,-0.29338635129836482,0.52430611316360543,0.52430611316360543],"arm":{"servo_position":[-1.4359855433920754e-23,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[-3.3881317890172014e-21,0,0,0,-3.4694469519536142e-18,0],"servo_effort":[-0.012299080411538836,-1.2442122268702571,-0.24800282284728456,4.0145040541707764e-05,-0.00074968969309904105,0.00023645361999114731]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":454,"step":3632,"t":18.16,"sim_time":18.160000000000672,"vehicle":{"origin_ned":[1.6120438311957048,1.0939001157368144,3.5564521370480819],"origin_quat_xyzw":[-0.021759367902242206,0.049393225229654385,0.42474897402249334,0.90370080683639242],"cg_ned":[1.5586231473054728,1.0310623158981049,3.2633760838206864],"linear_velocity_ned":[-0.021988799201654044,-0.015449541052113536,-0.051629447476221862],"angular_velocity_ned":[-0.00098800458516376034,-0.0038602344857826434,0.0019892839261245496]},"sensors":{"Odom":[1.6120438311957048,1.0939001157368144,3.5564521370480819,-0.020720634577628863,0.0081518660461544264,-0.054054518767886514,-0.021759367902242213,0.049393225229654412,0.42474897402249351,0.90370080683639242,-0.0037962230701273064,-0.001697874415187597,0.001593965732489974],"Pressure":[27428.746273345354],"DVL":[-0.024140264317926177,-0.01840209147160669,0.083502085549705313,7.2825027206481492,0.00025877721862447754,-0.028605850545977782,0.027374353705098841,0],"IMU":[0.0026469426140135676,0.10796757409078458,0.87888219802021117,0.0081639771321342508,0.016401316058380227,0.074020324004874877,1.0702117344708271,-0.024837426282364551,-9.7967341169053466],"FOG":[0.87762572031428387],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-16.076320557222196,-27.532349840079309,-30.651638653146239,55.230942419037227,55.230942419037227],"omega_rad_s":[-16.178380275004294,-28.180549173064936,-30.672491484428512,54.912388017951564,54.912063602747018],"thrust_n":[-3.2925626702055486,-9.889392328459051,-11.727816526009894,39.832127369471706,39.784920379853396],"torque_nm":[0.06173555006635404,0.18542610615860722,0.2198965598626855,-0.74685238817759458,-0.74596725712225154],"angle_rad":[-591.98354690111137,655.83867139682548,-353.50520048761217,1316.6158323295272,1316.6166472767659]},"command":[-0.15310781483068758,-0.26221285561980295,-0.29192036812520228,0.52600897541940217,0.52600897541940217],"arm":{"servo_position":[2.5808035111652532e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,4.3368086899420177e-19,2.7105054312137611e-20,0,0],"servo_effort":[-0.015993320658031922,-1.2489482478364429,-0.24834947337100316,3.4652218776018819e-05,-0.00075854164062498031,0.00023458558951832645]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":455,"step":3640,"t":18.199999999999999,"sim_time":18.200000000000664,"vehicle":{"origin_ned":[1.6111143271265564,1.0932993080762863,3.5543965014149776],"origin_quat_xyzw":[-0.021812835034575161,0.049331785000627557,0.42477803605955705,0.90368921388815504],"cg_ned":[1.5577432141918912,1.0304454210504235,3.2613148665057388],"linear_velocity_ned":[-0.022004882497998948,-0.015400777073068028,-0.051450476995110787],"angular_velocity_ned":[-0.0011009541982306944,-0.0038442164073714154,0.0015788488683963532]},"sensors":{"Odom":[1.6111143271265564,1.0932993080762863,3.5543965014149776,-0.02068719978795611,0.0081888006042875518,-0.053876216493205051,-0.021812835034575179,0.049331785000627591,0.42477803605955738,0.90368921388815504,-0.0038113861815794146,-0.0016017500447625306,0.0011792352825075033],"Pressure":[27407.62909488504],"DVL":[-0.019880533574034798,0.024771230073720167,0.062115345702790134,7.3419753070678455,0.011806984313273511,0.007804932472877878,0.012470434408731048,0],"IMU":[0.0025006155293485132,0.10790168777854674,0.87893676549632882,-0.019121800220148148,0.11235149789637187,-0.15666473471830017,1.0495856669088495,-0.024965425840730044,-9.7559124462949534],"FOG":[0.8681649781982278],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-15.905036930987109,-27.581455241954647,-30.499166221905746,55.409296098460608,55.409296098460608],"omega_rad_s":[-16.001598161060556,-28.218385203584152,-30.515572747674685,55.098671533564961,55.09834897048205],"thrust_n":[-3.2202145430410649,-9.9149003767856225,-11.608112103015751,40.092681772918716,40.047958020560841],"torque_nm":[0.060379022682019966,0.18590438206473042,0.21765210193154533,-0.75173778324222584,-0.75089921288551587],"angle_rad":[-592.62664578584156,654.71058034846726,-354.72851580393899,1318.8165777935033,1318.817379805854]},"command":[-0.15147654219987722,-0.26268052611385379,-0.29046824973243568,0.52770758189010103,0.52770758189010103],"arm":{"servo_position":[2.5808035111652532e-24,-1.0842021724855024e-21,-1.0905549195899114e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,-8.6736173798840355e-19,-4.3368086899420177e-19,0,0,0],"servo_effort":[-0.019684840669463882,-1.2537480758767645,-0.24871479180424613,2.9322340472637837e-05,-0.00075492971037324687,0.00023319328104848847]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":456,"step":3648,"t":18.240000000000002,"sim_time":18.240000000000656,"vehicle":{"origin_ned":[1.6101855573801216,1.0927009303784938,3.5523481397480761],"origin_quat_xyzw":[-0.021867716628015343,0.049271797362505643,0.42479963253448189,0.90368100851612121],"cg_ned":[1.5568627691960923,1.0298305451512495,3.2592612474228204],"linear_velocity_ned":[-0.022015149953000909,-0.015348983434340983,-0.05125201727616157],"angular_velocity_ned":[-0.0012077131303577103,-0.0038226953521966296,0.0011738524373798226]},"sensors":{"Odom":[1.6101855573801216,1.0927009303784938,3.5523481397480761,-0.020650087555824152,0.008220927991547335,-0.05367788446005025,-0.021867716628015357,0.049271797362505677,0.42479963253448211,0.90368100851612121,-0.003819017389429984,-0.0015068030322940684,0.00077081197888167075],"Pressure":[27387.901178100328],"DVL":[-0.018679736419224564,0.010709409233281187,0.034044625890652755,7.3327322176560212,0.023908707093870038,-0.016935809858325008,-0.00020772616933436788,0],"IMU":[0.0023520678640798071,0.10783966786607525,0.87897480835840902,-0.064564269687116899,0.037775225135233806,0.11758876769350379,1.0433827055187535,-0.0091848353277800519,-9.7500189406126303],"FOG":[0.89722126612067865],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-15.735623842692013,-27.629622576396848,-30.348171851997684,55.587127626317439,55.587127626317439],"omega_rad_s":[-15.826193390737339,-28.255558794792034,-30.360187029127921,55.284447613855434,55.284126888982605],"thrust_n":[-3.149236724375299,-9.9400420369023816,-11.49022990754627,40.352876775917963,40.310622154140724],"torque_nm":[0.059048188582036872,0.18637578819191972,0.2154418107664926,-0.75661643954846192,-0.75582416539013852],"angle_rad":[-593.26270408345044,653.58099098106709,-355.94558927849124,1321.0247632687897,1321.0255524200197]},"command":[-0.14986308421611441,-0.26313926263235093,-0.28903020811426366,0.52940121548873753,0.52940121548873753],"arm":{"servo_position":[2.5808035111652532e-24,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,4.3368086899420177e-19,0,0,0],"servo_effort":[-0.02336802586907016,-1.2586091500969474,-0.24909804410528555,2.4186688654559368e-05,-0.00075131762825611027,0.00023183843099503586]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":457,"step":3656,"t":18.280000000000001,"sim_time":18.280000000000648,"vehicle":{"origin_ned":[1.60925780313025,1.0921050408596193,3.5503078275372228],"origin_quat_xyzw":[-0.021923856358837833,0.049213308793226572,0.42481386967773438,0.90367614270235574],"cg_ned":[1.555982040288203,1.0292178073297018,3.257215998098447],"linear_velocity_ned":[-0.022019808756116678,-0.015294251247330037,-0.051034427104749966],"angular_velocity_ned":[-0.00130806153905694,-0.0037954281215153329,0.00077418200334101637]},"sensors":{"Odom":[1.60925780313025,1.0921050408596193,3.5503078275372228,-0.02060946753038995,0.0082482223711792205,-0.053459903591686911,-0.021923856358837836,0.049213308793226586,0.42481386967773449,0.90367614270235574,-0.003818778257008053,-0.0014130502184388054,0.0003686178153848715],"Pressure":[27369.152031440124],"DVL":[-0.011281032491429012,0.013569152419666018,0.054506390354272766,7.298499981266267,-0.0087112390031484181,0.012768283271025631,0.036598926003196017,0],"IMU":[0.002201637835575249,0.10778146152005483,0.87899657770865169,0.11155742966700735,0.029660429166935211,0.085111117148089138,1.0417254439280563,-0.022421442209524776,-9.7356953619676752],"FOG":[0.89282652510071858],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-15.56833078142378,-27.676829870834695,-30.198680160874243,55.764363103357191,55.764363103357191],"omega_rad_s":[-15.652440473425887,-28.292043932675924,-30.206353680485506,55.469637642660182,55.469318743518642],"thrust_n":[-3.079718292970016,-9.9647949279324397,-11.374164204710763,40.612596899401538,40.572796504981014],"torque_nm":[0.057744717993187818,0.18683990489873323,0.21326557883832678,-0.76148619186377886,-0.76073993446839405],"angle_rad":[-593.89178316429525,652.44993038211715,-357.15648266828566,1323.2403666597293,1323.2411430230809]},"command":[-0.14826981696594077,-0.26358885591271136,-0.28760647772261183,0.53108917241292564,0.53108917241292564],"arm":{"servo_position":[2.5808035111652562e-24,-1.0842021724855024e-21,-1.0905549195899114e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[-6.7762635780344027e-21,0,0,0,0,0],"servo_effort":[-0.027036718066203974,-1.2635299063786032,-0.24949875190817344,1.9259222479885958e-05,-0.00074764404411425543,0.00023052214800318454]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":458,"step":3664,"t":18.32,"sim_time":18.32000000000064,"vehicle":{"origin_ned":[1.6083313401823167,1.0915116914647605,3.5482763258735144],"origin_quat_xyzw":[-0.021981092259333253,0.049156368036045957,0.42482085194984537,0.90367456908623855],"cg_ned":[1.5551012472129573,1.0286073231462536,3.2551798755706489],"linear_velocity_ned":[-0.022019063018961952,-0.01523666809879299,-0.050798070481996221],"angular_velocity_ned":[-0.0014018113620818074,-0.0037622139222414797,0.00037973023356625932]},"sensors":{"Odom":[1.6083313401823167,1.0915116914647605,3.5482763258735144,-0.02056550509180833,0.008270673868367967,-0.053222659316498104,-0.02198109225933326,0.049156368036045978,0.42482085194984548,0.90367456908623855,-0.0038103835629348152,-0.0013205107645213742,-2.742564407484351e-05],"Pressure":[27348.653131375839],"DVL":[-0.016144855043682349,0.034113486753239219,0.025311482300717985,7.3438044739859949,0.010674647561165117,0.010137531434408487,-0.0040008166548959881,0],"IMU":[0.0020496754281988348,0.10772701518880423,0.87900232145574586,-0.066473351283728901,-0.058474027951552585,0.10270498262170263,1.0738147939711857,-0.023593610397698847,-9.7283120901458489],"FOG":[0.88883718957217062],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-15.403396622468239,-27.723053532686531,-30.050716815396498,55.940931365301232,55.940931365301232],"omega_rad_s":[-15.480606482206504,-28.327813628238381,-30.054093904977275,55.65416511164922,55.653848027327832],"thrust_n":[-3.0117407825838116,-9.9891359556496369,-11.259910667770761,40.871728588481133,40.834366633370593],"torque_nm":[0.056470139673446468,0.18729629916843069,0.21112332502070177,-0.76634491103402125,-0.76564437437569854],"angle_rad":[-594.5139552153812,651.31742670199537,-358.36125854852781,1325.4633627726791,1325.464126420932]},"command":[-0.14669901545207847,-0.26402908126368124,-0.28619730300377616,0.53277077490763081,0.53277077490763081],"arm":{"servo_position":[-3.1300514379006758e-23,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.030684299463678361,-1.268507333161774,-0.24991642071614187,1.4523937888451306e-05,-0.00074392348023951717,0.00022924373988935282]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":459,"step":3672,"t":18.359999999999999,"sim_time":18.360000000000632,"vehicle":{"origin_ned":[1.6074064387105989,1.0909209282743286,3.5462543813276448],"origin_quat_xyzw":[-0.022039257397886626,0.049101025648117476,0.42482068206893969,0.90367624097357635],"cg_ned":[1.5542206016488667,1.0279992047472246,3.2531536222436079],"linear_velocity_ned":[-0.022013112302268,-0.015176317636240244,-0.050543314940380633],"angular_velocity_ned":[-0.0014887823269746127,-0.0037228791411245596,-9.6082505003806621e-06]},"sensors":{"Odom":[1.6074064387105989,1.0909209282743286,3.5462543813276448,-0.02051836291450377,0.0082882796362377248,-0.052966539310316127,-0.022039257397886643,0.049101025648117511,0.42482068206893997,0.90367624097357635,-0.0037935740663509561,-0.0012292148875761692,-0.00041739765006591003],"Pressure":[27327.937550380113],"DVL":[0.00081383832152572347,0.020771489936990153,0.057681764723719123,7.3242286075211833,0.010492713877890832,0.04402351878595881,0.014828076778901623,0],"IMU":[0.0018965407834153015,0.10767627439052196,0.87899228427619946,-0.0036090319447841419,-0.028477665964180221,0.070158385896068071,1.0472068233517788,-0.030824984021876816,-9.7345726845305478],"FOG":[0.87022610528218813],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-15.241051206549828,-27.768268948987089,-29.904308523447817,56.116762977016847,56.116762977016847],"omega_rad_s":[-15.310949770303036,-28.362839992514584,-29.903430419876553,55.837955662863287,55.837640384182272],"thrust_n":[-2.9453779632819383,-10.013041385674809,-11.147466114088921,41.130160374132537,41.095219907558239],"torque_nm":[0.055225836811536345,0.1877445259814027,0.20901498963916729,-0.77119050701498526,-0.77053537326671717],"angle_rad":[-595.12930290506529,650.18350919025806,-359.55998037734099,1327.693723403127,1327.6944744086607]},"command":[-0.14515286863380789,-0.26445970427606752,-0.28480293831855064,0.53444536168587475,0.53444536168587475],"arm":{"servo_position":[-3.1300514379006758e-23,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,-3.4694469519536142e-18,0],"servo_effort":[-0.034316193624192422,-1.2734732500993367,-0.25034970117424854,9.986343080117464e-06,-0.00072766556376413093,0.00022847892403258765]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":460,"step":3680,"t":18.400000000000002,"sim_time":18.400000000000624,"vehicle":{"origin_ned":[1.6064833630174054,1.0903327918375587,3.5442427258571487],"origin_quat_xyzw":[-0.022098180474186772,0.049047333537863662,0.42481346109445606,0.903681112320881],"cg_ned":[1.5533403073799357,1.0273935609895724,3.2511379657644581],"linear_velocity_ned":[-0.022002152422623992,-0.015113281262809464,-0.050270530971417746],"angular_velocity_ned":[-0.0015688310001171471,-0.0036772947339211853,-0.00039392918669221377]},"sensors":{"Odom":[1.6064833630174054,1.0903327918375587,3.5442427258571487,-0.020468199455463923,0.0083010535085009975,-0.052691933670756953,-0.022098180474186782,0.049047333537863683,0.42481346109445622,0.903681112320881,-0.0037681490673990977,-0.0011391925537108691,-0.00080137407158583263],"Pressure":[27309.622219654011],"DVL":[-0.014923236743743563,0.037474949923436987,0.060937488794606344,7.3944068847264424,-0.035451715183224146,0.003503419549168611,0.011085886501424072,0],"IMU":[0.0017426027411723943,0.1076291834092578,0.87896670770720819,0.0017091357777506509,-0.076529595288801447,0.054003698763421461,1.0619313106108228,-0.025920214690016811,-9.7367995030608121],"FOG":[0.88610555258336365],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-15.081522402543314,-27.812450962598827,-29.759479748392732,56.291790075748004,56.291790075748004],"omega_rad_s":[-15.143722193666575,-28.39709420806048,-29.754386520292389,56.02093695931643,56.020623479117759],"thrust_n":[-2.8806970332026647,-10.036486813686196,-11.036827739261845,41.387782670257636,41.355245475960849],"torque_nm":[0.054013069372549967,0.18818412775661617,0.20694052011115963,-0.77602092506733067,-0.7754108526742659],"angle_rad":[-595.7379190889867,649.04820823459943,-360.75271253819722,1329.9314174190263,1329.9321558538986]},"command":[-0.14363354669088871,-0.26488048535808406,-0.28342361665135934,0.53611228643569531,0.53611228643569531],"arm":{"servo_position":[-3.1300514379006758e-23,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,4.3368086899420177e-19,0,0,0],"servo_effort":[-0.037941579842651521,-1.2784697639945217,-0.25079636172544845,5.4630557796316207e-06,-0.00073638629861901526,0.00022687643473759053]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":461,"step":3688,"t":18.440000000000001,"sim_time":18.440000000000616,"vehicle":{"origin_ned":[1.6055623711068752,1.0897473178707104,3.5422420766073457],"origin_quat_xyzw":[-0.02215768716864068,0.048995344483089329,0.42479928851287985,0.90368913770016679],"cg_ned":[1.5524605604856256,1.0267904975305737,3.2491336188436337],"linear_velocity_ned":[-0.021986373439414456,-0.015047637691704386,-0.049980093068824123],"angular_velocity_ned":[-0.0016418623994485996,-0.0036253810399860427,-0.00077332233057472342]},"sensors":{"Odom":[1.6055623711068752,1.0897473178707104,3.5422420766073457,-0.02041516544207329,0.0083090278826378067,-0.052399236059489249,-0.022157687168640691,0.048995344483089349,0.42479928851288001,0.90368913770016679,-0.0037339770616924275,-0.001050467603854937,-0.0011794322222090485],"Pressure":[27291.569148999901],"DVL":[-0.046236975481892553,-0.0039947210191388291,0.061338176573879633,7.3848516064945944,0.0091767629131374231,-0.0039906839715717971,0.04647005164828024,0],"IMU":[0.0015882359949028026,0.10758568559892169,0.87892583018601922,-0.031904311096684172,0.019358538374164593,0.073193580635837863,1.0459181871068872,-0.03905045522212873,-9.7592967641949127],"FOG":[0.87417395772913564],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-14.925013958787074,-27.855576834131515,-29.616256582720961,56.46594784654188,56.46594784654188],"omega_rad_s":[-14.979164203236898,-28.430547525190036,-29.606985996227319,56.203038890247257,56.202727203491328],"thrust_n":[-2.8177570634940787,-10.059447872330518,-10.927993069238632,41.644488049285904,41.614334822628649],"torque_nm":[0.052832944940513986,0.18861464760619723,0.20489987004822441,-0.78083415092411068,-0.78026877792428728],"angle_rad":[-596.33990645005281,647.91155537644363,-361.93952035500962,1332.1764108441525,1332.1771367801825]},"command":[-0.14214299008368642,-0.26529120794410965,-0.28205958650210439,0.53777093187182745,0.53777093187182745],"arm":{"servo_position":[-3.1300514379006758e-23,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.041552563020526977,-1.2835145371208989,-0.25125891516988502,9.108698052266534e-07,-0.00073256848907912481,0.00022575038991834621]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":462,"step":3696,"t":18.48,"sim_time":18.480000000000608,"vehicle":{"origin_ned":[1.6046437143389982,1.0891645378113992,3.5402531358466121],"origin_quat_xyzw":[-0.022217601199886711,0.048945111673545212,0.42477826225664844,0.9037002722996208],"cg_ned":[1.5515815495159746,1.0261901169304413,3.2471412791942083],"linear_velocity_ned":[-0.021965962054847486,-0.014979463443639729,-0.049672377528608466],"angular_velocity_ned":[-0.0017078140198310947,-0.0035670977184085518,-0.0011478741601739137]},"sensors":{"Odom":[1.6046437143389982,1.0891645378113992,3.5402531358466121,-0.020359407767949454,0.0083122499331834861,-0.052088841419886192,-0.022217601199886722,0.048945111673545233,0.42477826225664866,0.9037002722996208,-0.0036909776099582456,-0.0009630636314779485,-0.0015516515946286196],"Pressure":[27269.618731423529],"DVL":[-0.0096432194733671959,0.0013394652275127844,0.069322351760903816,7.3136999968141447,-0.013360544779702135,-0.024272195477073887,0.0057568837014562229,0],"IMU":[0.0014338187897568783,0.10754572348277837,0.87886988696691126,-0.10573268329342668,-0.0061955865678645951,-0.077979048437363405,1.055560583281457,0.0024651166169888297,-9.7374336842154214],"FOG":[0.88672923686783067],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-14.771711662683773,-27.897622918016644,-29.474667239263692,56.63917244868432,56.63917244868432],"omega_rad_s":[-14.817501955425305,-28.463171283203909,-29.461253820697856,56.384193403539456,56.383883507310756],"thrust_n":[-2.7566082934194558,-10.081900234547996,-10.820960461300695,41.900171077721659,41.872381421995719],"torque_nm":[0.051686405501614803,0.18903562939777496,0.20289300864938803,-0.78562820770728115,-0.78510715166241973],"angle_rad":[-596.93537696795545,646.77358330352854,-363.12047012994458,1334.4286669461119,1334.4293804549648]},"command":[-0.14068296821603593,-0.26569164683825375,-0.28071111656441611,0.53942068998746973,0.53942068998746973],"arm":{"servo_position":[-3.1300514379006758e-23,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.045142388820558696,-1.2886048681850721,-0.25173644749929691,-3.6511804978139624e-06,-0.00072874393524057293,0.0002246594616566253]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":463,"step":3704,"t":18.52,"sim_time":18.5200000000006,"vehicle":{"origin_ned":[1.6037276371290599,1.08858447927128,3.5382765908253995],"origin_quat_xyzw":[-0.022277745226563811,0.04889668825999563,0.4247504787353148,0.90371447192072007],"cg_ned":[1.5507034556702453,1.0255925187339765,3.2451616293861947],"linear_velocity_ned":[-0.021941100032387903,-0.014908833185960318,-0.049347764346895397],"angular_velocity_ned":[-0.0017666543254780938,-0.0035024445357582997,-0.0015176662706022285]},"sensors":{"Odom":[1.6037276371290599,1.08858447927128,3.5382765908253995,-0.020301069040998137,0.0083107803440369971,-0.051761147684552131,-0.022277745226563818,0.048896688259995637,0.42475047873531491,0.90371447192072007,-0.0036391211543208069,-0.00087700564502024157,-0.0019181122134783275],"Pressure":[27251.746596513774],"DVL":[0.012767551232421258,0.0037541031735977438,0.054974756420211601,7.3368654838474292,0.0083632999663944066,0.023611261891668293,-0.015671972990300147,0],"IMU":[0.0012797309107769842,0.10750923873139788,0.87879911007908762,-0.036448612638775815,0.064881982161765356,-0.12898619743926459,1.0482821217971039,-0.01441686376359335,-9.7412263754713226],"FOG":[0.87672758994585931],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-14.621785280958859,-27.938564820275431,-29.334741083687739,56.811402542541067,56.811402542541067],"omega_rad_s":[-14.658946283416753,-28.49493654812402,-29.317216177130799,56.564334545727839,56.564026439248522],"thrust_n":[-2.6972922141914535,-10.10381937599386,-10.715729116783537,42.154728523004195,42.129280892212122],"torque_nm":[0.05057422901608976,0.18944661329988491,0.20091992093969133,-0.79040115980632875,-0.78992401672897739],"angle_rad":[-597.52445132087212,645.63432585648582,-364.2956291915861,1336.6881463177263,1336.6888474709983]},"command":[-0.1392550979138939,-0.26608156971690888,-0.27937848651131181,0.54106097659562924,0.54106097659562924],"arm":{"servo_position":[-3.1300514379006758e-23,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.048703744633527411,-1.2937383620997247,-0.25222875436056919,-8.1772446927525966e-06,-0.00072484714749961965,0.00022360661070213651]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":464,"step":3712,"t":18.559999999999999,"sim_time":18.560000000000592,"vehicle":{"origin_ned":[1.6028143766512095,1.0880071664693285,3.5363131136686805],"origin_quat_xyzw":[-0.022337941732087307,0.048850126920098845,0.42471603288033233,0.90373169296725253],"cg_ned":[1.5498264529679104,1.0249977995363118,3.2431953367365223],"linear_velocity_ned":[-0.021911964636515187,-0.014835819828955045,-0.049006635821210121],"angular_velocity_ned":[-0.0018183823702267515,-0.0034314591037994972,-0.0018827751473465351]},"sensors":{"Odom":[1.6028143766512095,1.0880071664693285,3.5363131136686805,-0.020240287737719315,0.0083046931602101855,-0.051416554469229506,-0.022337941732087318,0.048850126920098859,0.42471603288033249,0.90373169296725253,-0.0035784270664448751,-0.00079231892548006224,-0.0022788941904631141],"Pressure":[27232.970838000965],"DVL":[-0.019216378738930832,-0.0086467828676050178,0.02094185415478314,7.3640667452897919,-0.025657615676786146,-0.025423750589276085,-0.03062915992475989,0],"IMU":[0.0011263517179410129,0.10747617215569376,0.87871372831876926,-0.024474848822141588,-0.011548166584248072,0.051040475100232283,1.059328943828922,0.012254670382969537,-9.7610971745118018],"FOG":[0.87988304252986826],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-14.475386792226237,-27.978377317604494,-29.196507840257077,56.982578767143636,56.982578767143636],"omega_rad_s":[-14.503691706512544,-28.525814022607697,-29.174900263711486,56.743398503122073,56.743092187774003],"thrust_n":[-2.6398416782438177,-10.125180508256255,-10.612298912585537,42.408059433945319,42.38493110518214],"torque_nm":[0.049497031467071587,0.18984713452980481,0.19898060461097886,-0.79515111438647479,-0.79471745822216522],"angle_rad":[-598.10725825092334,644.49381804099585,-365.46506593963733,1338.9548069626078,1338.9554958319131]},"command":[-0.13786082659263083,-0.26646073635813805,-0.27806197943101979,0.54269122635374889,0.54269122635374889],"arm":{"servo_position":[-9.9063150159350787e-23,-1.0842021724855024e-21,-1.0905549195899114e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[-1.3552527156068805e-20,0,-4.3368086899420177e-19,0,0,0],"servo_effort":[-0.0522297589619551,-1.2989119971934269,-0.25273509099827773,-1.2712709451637606e-05,-0.0007209388056274472,0.00022258846057587815]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":465,"step":3720,"t":18.600000000000001,"sim_time":18.600000000000584,"vehicle":{"origin_ned":[1.6019041625556178,1.0874326206639191,3.5343633612610765],"origin_quat_xyzw":[-0.02239801392587561,0.048805479405503414,0.42467501817527287,0.90375189244062271],"cg_ned":[1.5489507084456675,1.0244060530444941,3.2412430531908978],"linear_velocity_ned":[-0.021878728879873174,-0.014760495145018392,-0.04864937796037265],"angular_velocity_ned":[-0.0018630271756731706,-0.0033542182173775287,-0.0022432747019740908]},"sensors":{"Odom":[1.6019041625556178,1.0874326206639191,3.5343633612610765,-0.020177199083924267,0.008294075689994419,-0.051055464461071481,-0.022398013925875614,0.048805479405503421,0.42467501817527287,0.90375189244062271,-0.0035089640018086525,-0.00070903037732981771,-0.0026340803050847812],"Pressure":[27212.556035255315],"DVL":[-0.02202448116792095,-0.0050323147067282943,0.037005077164965101,7.3538073620866857,-0.0094021043450073644,0.027898688749070203,0.029321271013365232,0],"IMU":[0.00097405813342910715,0.10744646367877801,0.87861396720692919,0.021106418855131918,-0.076296052403346748,0.1955199350092876,1.038046815605971,-0.019762652316215192,-9.7386816189299541],"FOG":[0.88946022084708498],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-14.332648941602738,-28.017034878065044,-29.059998353106216,57.152643745732036,57.152643745732036],"omega_rad_s":[-14.351915272470441,-28.555774105776912,-29.034334266399934,56.921323560451476,56.921019039803269],"thrust_n":[-2.5842809696552624,-10.145958621215518,-10.510670380085385,42.66006518902207,42.639232202813723],"torque_nm":[0.048455268181036175,0.19023672414779097,0.19707506962660096,-0.79987622229416366,-0.79948560380275735],"angle_rad":[-598.68393388600487,643.35209604071883,-366.62884988377226,1341.2286043794802,1341.2292810365373]},"command":[-0.13650141849145464,-0.26682890360061945,-0.27676188907720206,0.54431089281649558,0.54431089281649558],"arm":{"servo_position":[-9.9063150159350787e-23,-1.0842021724855024e-21,1.0778494253810975e-21,0,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,-8.6736173798840355e-19,4.3368086899420177e-19,0,0,0],"servo_effort":[-0.055714850969434036,-1.3041229492439532,-0.25325491533505518,-1.7245154665506698e-05,-0.00071696778727504669,0.00022160629776320955]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":466,"step":3728,"t":18.640000000000001,"sim_time":18.640000000000576,"vehicle":{"origin_ned":[1.6009972166957378,1.086860860544044,3.5324279751308363],"origin_quat_xyzw":[-0.022457786580382878,0.048762796124260314,0.42462752669739207,0.90377502792836073],"cg_ned":[1.5480763823304937,1.0238173701224818,3.2393054152062035],"linear_velocity_ned":[-0.021841560510668937,-0.014682929629094392,-0.048276378588717868],"angular_velocity_ned":[-0.0019006463012011352,-0.0032708358656636785,-0.0025992322777091299]},"sensors":{"Odom":[1.6009972166957378,1.086860860544044,3.5324279751308363,-0.020111934455497683,0.0082790275482940087,-0.050678281448586479,-0.022457786580382891,0.048762796124260342,0.42462752669739229,0.90377502792836073,-0.0034308478947993621,-0.00062716837722163403,-0.0029837517666907861],"Pressure":[27193.720411694791],"DVL":[0.0093393406803559224,-0.014489320958571564,0.084034951895335885,7.2612067755853191,-0.013694129903276597,0.002149277236363446,-0.020446910650354439,0],"IMU":[0.0008232227770803833,0.10742005231567493,0.87850004898128875,0.027453899383041727,0.074587625133860982,-0.1907796782856086,1.0502069649694055,-0.00928180916679857,-9.7385223796765441],"FOG":[0.87691928569686151],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-14.193684754144455,-28.054510922327967,-28.925243910911,57.321542468940528,57.321542468940528],"omega_rad_s":[-14.203775448138646,-28.584786525267091,-28.895547336386919,57.098050234529261,57.097747514367384],"thrust_n":[-2.5306259022093722,-10.166128234371925,-10.410844670803382,42.910649724859844,42.892086835172769],"torque_nm":[0.04744923566642574,0.19061490439447359,0.19520333757756336,-0.80457468234112228,-0.80422662815948953],"angle_rad":[-599.2546210142458,642.20919724010139,-367.78705168451853,1343.5094916494363,1343.5101561661563]},"command":[-0.135177950039471,-0.2671858183078854,-0.27547851343724761,0.54591945208514792,0.54591945208514792],"arm":{"servo_position":[3.646212140133727e-23,3.2526065174565154e-21,1.0778494253810975e-21,3.9704669402545327e-25,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[2.7105054312137611e-20,0,0,0,0,0],"servo_effort":[-0.059153401015438679,-1.3093684006560644,-0.25378798213061016,-2.172120300119067e-05,-0.00071299008135705796,0.00022065891704562234]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":467,"step":3736,"t":18.68,"sim_time":18.680000000000568,"vehicle":{"origin_ned":[1.6000937528762835,1.0862919026230653,3.530507581380752],"origin_quat_xyzw":[-0.022517086882717897,0.048722125731474615,0.42457364916571511,0.90380105758769202],"cg_ned":[1.5472036282332839,1.0232318388278607,3.2373830436828483],"linear_velocity_ned":[-0.021800622852785275,-0.0146031934618048,-0.047888027503669467],"angular_velocity_ned":[-0.0019313279698875462,-0.0031814609476314435,-0.0029507104638431731]},"sensors":{"Odom":[1.6000937528762835,1.0862919026230653,3.530507581380752,-0.020044621702468929,0.0082596605344079626,-0.050285410758835629,-0.022517086882717911,0.048722125731474643,0.42457364916571538,0.90380105758769202,-0.0033442413609166624,-0.00054675970946114181,-0.0033279899744518096],"Pressure":[27177.735479885538],"DVL":[-0.014799242035324758,-0.0066806807213479306,0.049892861724898305,7.3687485726878972,0.014197320523816243,-0.0020650104321359502,-0.013775494321353131,0],"IMU":[0.00067421208312044509,0.10739687617871108,0.87837219260317689,-0.11303887308300278,-0.066061726763970707,0.042599998487712558,1.0553703044342879,0.00047643533417516398,-9.7437461571712003],"FOG":[0.8814370491841258],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-14.058585914123887,-28.090778268511119,-28.792276431976187,57.489221567628718,57.489221567628718],"omega_rad_s":[-14.059411036270845,-28.612820548396794,-28.758569362029505,57.273521120665258,57.273220209025247],"thrust_n":[-2.478883937251529,-10.185663538049965,-10.312823377262859,43.159719343789625,43.143400029702157],"torque_nm":[0.04647907382346618,0.19098119133843688,0.19336543832367864,-0.80924473769605543,-0.80893875055691544],"angle_rad":[-599.81946831753442,641.06516024399866,-368.93974318468099,1345.797419521758,1345.7980719703341]},"command":[-0.13389129442022749,-0.26753122160486781,-0.27421215649501129,0.54751639588217826,0.54751639588217826],"arm":{"servo_position":[3.646212140133727e-23,-1.0842021724855024e-21,-1.0905549195899114e-21,3.9704669402545327e-25,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,-4.3368086899420177e-19,0,0,0],"servo_effort":[-0.062539638680191384,-1.3146452104072945,-0.25433351768785251,-2.6199099677053386e-05,-0.00070897841771823866,0.00021974598062934409]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":468,"step":3744,"t":18.719999999999999,"sim_time":18.72000000000056,"vehicle":{"origin_ned":[1.5991939771158818,1.0857257617048006,3.5286027905552007],"origin_quat_xyzw":[-0.022575745060457675,0.048683515608303356,0.42451347495977482,0.90382994009966156],"cg_ned":[1.5463325933238168,1.0226495444226762,3.2354765439511421],"linear_velocity_ned":[-0.021756076641599627,-0.014521355969147257,-0.047484710850912014],"angular_velocity_ned":[-0.0019552173345654179,-0.0030861390345716068,-0.0032977752786221399]},"sensors":{"Odom":[1.5991939771158818,1.0857257617048006,3.5286027905552007,-0.019975353860772149,0.0082360734943594787,-0.049877259261431391,-0.022575745060457689,0.04868351560830339,0.42451347495977504,0.90382994009966156,-0.0032492637107767951,-0.00046772112159231233,-0.0036668751062217072],"Pressure":[27158.523768706891],"DVL":[-0.026856562723381234,0.010384783953830018,0.043708793152291203,7.3846523502638552,0.0056701456231970293,-0.0014091362829902567,-0.017407745970976558,0],"IMU":[0.00052738558444141628,0.10737687389916964,0.87823061379913991,-0.021664004774709339,-0.13912236268196904,0.005797762051760625,1.0242367766441214,0.00066189071574008964,-9.7236278174172437],"FOG":[0.87732218248337379],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-13.927423539703994,-28.125809915483593,-28.661127823067186,57.655629715483855,57.655629715483855],"omega_rad_s":[-13.918940365200719,-28.639845113137056,-28.623430800360566,57.447680896556683,57.447381803502118],"thrust_n":[-2.429054359335983,-10.204538401484701,-10.216608308537976,43.40718167237354,43.393080491235303],"torque_nm":[0.045544769237549694,0.19133509502783816,0.19156140578508707,-0.81388465635700402,-0.81362025921066183],"angle_rad":[-600.37862956358981,639.92002489445713,-370.08699743577637,1348.0923364969583,1348.0929769499537]},"command":[-0.13264212894956184,-0.26786485633793899,-0.2729631221244494,0.54910123538556055,0.54910123538556055],"arm":{"servo_position":[3.646212140133727e-23,-1.0842021724855024e-21,-1.0905549195899114e-21,3.9704669402545327e-25,-1.6940658945088655e-23,-2.2022856628611659e-21],"servo_velocity":[0,0,-4.3368086899420177e-19,0,0,0],"servo_effort":[-0.065882752677453374,-1.3199071987894917,-0.25488148540800276,-3.0692747729060658e-05,-0.00070491082835918387,0.00021885494462672611]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":469,"step":3752,"t":18.760000000000002,"sim_time":18.760000000000552,"vehicle":{"origin_ned":[1.5982980994267471,1.0851624538418509,3.5267141967337463],"origin_quat_xyzw":[-0.022633590286724344,0.048647032781542351,0.42444709151975896,0.90386163393115737],"cg_ned":[1.5454634178839017,1.0220705693659133,3.2335865077128041],"linear_velocity_ned":[-0.021708103557550436,-0.014437488311312889,-0.047066728697093378],"angular_velocity_ned":[-0.001972888027248289,-0.0029831137070212709,-0.0036405675878818096]},"sensors":{"Odom":[1.5982980994267471,1.0851624538418509,3.5267141967337463,-0.019903801699764089,0.0082080479911742794,-0.049454225485860981,-0.022633590286724351,0.048647032781542358,0.42444709151975907,0.90386163393115737,-0.0031449195422695929,-0.00038848865175816592,-0.0040004430453537722],"Pressure":[27140.338224047035],"DVL":[-0.021239108024369378,-0.0048038065687045989,0.10685610297004064,7.3626339078004701,0.0026022619312154834,0.023419916915290627,0.0061503968588937329,0],"IMU":[0.00038312120393690626,0.1073600190857852,0.87807552597303762,0.023715612573192768,-0.0086186523111772724,-0.083912583789721121,1.0400572945938673,0.0035035552317493001,-9.7501044120855465],"FOG":[0.87602884589035268],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-13.800512291123457,-28.159712820001509,-28.531947203116456,57.82071608459718,57.82071608459718],"omega_rad_s":[-13.782515830736264,-28.665856774656454,-28.490187083386157,57.62047605165894,57.620178778654591],"thrust_n":[-2.3811472246717225,-10.222745176181951,-10.122217418647043,43.652928416240314,43.641058278722269],"torque_nm":[0.044646510462594796,0.19167647205341154,0.18979157659963211,-0.81849240780450583,-0.81826984272604264],"angle_rad":[-600.93226362095277,638.77383185480983,-371.22888909852082,1350.3941889066982,1350.394817436968]},"command":[-0.13143345039165197,-0.26818774114287153,-0.27173283050587099,0.55067348651997317,0.55067348651997317],"arm":{"servo_position":[3.646212140133727e-23,-1.0842021724855024e-21,1.0778494253810975e-21,3.9704669402545327e-25,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.069279058294849247,-1.3248240307099657,-0.25535967078766819,-3.5429356104589341e-05,-0.00070070797674585625,0.000217891551442514]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":470,"step":3760,"t":18.800000000000001,"sim_time":18.800000000000544,"vehicle":{"origin_ned":[1.5974063362433348,1.0846019970850485,3.524842377371916],"origin_quat_xyzw":[-0.022690450166503916,0.048612767965927367,0.42437458482493362,0.90389609691412942],"cg_ned":[1.5445962355122196,1.0214949932916237,3.2317135134499146],"linear_velocity_ned":[-0.021656854190589797,-0.014351660471074499,-0.046634454116934836],"angular_velocity_ned":[-0.0019845807268285302,-0.0028721987210866525,-0.0039791062810500535]},"sensors":{"Odom":[1.5974063362433348,1.0846019970850485,3.524842377371916,-0.019829983475760586,0.0081756445473707626,-0.049016715528545467,-0.022690450166503937,0.048612767965927409,0.42437458482493401,0.90389609691412942,-0.003031217035564829,-0.00030875665653968566,-0.004328714077061117],"Pressure":[27119.088117327559],"DVL":[-0.062633508345517064,0.039534748437373077,0.057785426535619272,7.4138799995669045,0.004249911122508717,-0.0053330864145832496,-0.010123161649185093,0],"IMU":[0.0002418196974239188,0.10734632724395261,0.87790714166266781,-0.024088659489417536,-0.030445587455293126,0.058946621101045094,1.0621834277700803,-0.0019835739917498743,-9.73396792910766],"FOG":[0.86772184416920595],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-13.678381692285253,-28.192719982552326,-28.404965988898176,57.984430497104242,57.984430497104242],"omega_rad_s":[-13.650431301756814,-28.690935820154209,-28.358960524601809,57.79185419476277,57.791558714706142],"thrust_n":[-2.335220996956997,-10.240337985835877,-10.029717122585319,43.89686327008188,43.887252856116795],"torque_nm":[0.043785393692943687,0.19200633723442273,0.18805719604847473,-0.82306618631403516,-0.82288599105218985],"angle_rad":[-601.4805389818531,637.62661987426839,-372.36549673222265,1352.7029209654718,1352.7035376452932]},"command":[-0.13027030183128813,-0.26850209507192691,-0.27052348560855405,0.55223267140099275,0.55223267140099275],"arm":{"servo_position":[3.646212140133727e-23,-1.0842021724855024e-21,-1.0905549195899114e-21,3.9704669402545327e-25,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,-8.6736173798840355e-19,0,0,0],"servo_effort":[-0.072592654117284702,-1.3297743924027297,-0.25584843015692837,-4.0200649585050512e-05,-0.00069641316886727693,0.0002169551290595911]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":471,"step":3768,"t":18.84,"sim_time":18.840000000000536,"vehicle":{"origin_ned":[1.5965188949155042,1.0840444084424457,3.5229878943470925],"origin_quat_xyzw":[-0.022746157611465156,0.048580808183206571,0.42429604068940796,0.90393328694404929],"cg_ned":[1.5437311740728776,1.0209228929969918,3.2298581238574213],"linear_velocity_ned":[-0.021602470494427671,-0.014263944525521556,-0.046188287850194278],"angular_velocity_ned":[-0.0019904477798896917,-0.0027537962792767538,-0.004313377127937985]},"sensors":{"Odom":[1.5965188949155042,1.0840444084424457,3.5229878943470925,-0.01975404413300462,0.0081390365510821249,-0.048565139879096705,-0.02274615761146517,0.048580808183206599,0.42429604068940818,0.90393328694404929,-0.0029085621418108382,-0.00022866305632852961,-0.0046517177508894596],"Pressure":[27102.699865777777],"DVL":[-0.042291857089462238,0.014833970324664335,0.062717279820698621,7.3977330085257167,0.021282042152065552,-0.018052174982560822,-0.017032848755502907,0],"IMU":[0.00010386886241320975,0.10733581201408632,0.87772567235946408,-0.07422427116753702,-0.014508830503398285,0.049853703719719422,1.0474673284606411,0.00015142649271683318,-9.7169086374926223],"FOG":[0.86327401767864886],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-13.561042616284556,-28.224823285352979,-28.280186461255447,58.146727611895621,58.146727611895621],"omega_rad_s":[-13.5229139381031,-28.715144558292469,-28.229844853326831,57.961765291531798,57.961471557447709],"thrust_n":[-2.2913091045714817,-10.257359026174361,-9.9391530741668284,44.13890251566189,44.131576484853213],"torque_nm":[0.042962045710715276,0.19232548174076927,0.18635912014062803,-0.82760442216866059,-0.82746705909099794],"angle_rad":[-602.0236346524905,636.47842476145115,-373.49690325249446,1355.0184748444583,1355.01907974454]},"command":[-0.12915278682175768,-0.2688078408128855,-0.26933510915481379,0.55377835820852972,0.55377835820852972],"arm":{"servo_position":[3.646212140133727e-23,-1.0842021724855024e-21,1.0778494253810975e-21,3.9704669402545327e-25,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,-1.7347234759768071e-18,0],"servo_effort":[-0.07581763482696087,-1.3347565779302748,-0.25634808763310635,-4.4927248835786014e-05,-0.00067930163435917304,0.00021649406802220648]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":472,"step":3776,"t":18.879999999999999,"sim_time":18.880000000000528,"vehicle":{"origin_ned":[1.5956359721047659,1.0834897038667797,3.5211512939716836],"origin_quat_xyzw":[-0.022800552169939745,0.048551234263255284,0.42421154481216783,0.90397316205755485],"cg_ned":[1.5428683557685567,1.0203543423366708,3.2280208855834132],"linear_velocity_ned":[-0.021545093007613536,-0.01417441498190331,-0.045728630957239245],"angular_velocity_ned":[-0.0019906695415381642,-0.0026283425328729013,-0.0046433639660199482]},"sensors":{"Odom":[1.5956359721047659,1.0834897038667797,3.5211512939716836,-0.019676130068076888,0.0080984099037442539,-0.048099909102933491,-0.022800552169939755,0.048551234263255305,0.424211544812168,0.90397316205755485,-0.0027774047483535196,-0.00014834583555808681,-0.004969486391121815],"Pressure":[27084.91869555839],"DVL":[-0.051929508734237781,-0.015159783392776984,0.067388611948002247,7.3510837095424,0.0078366880679360748,0.02648347003756734,0.025739438677902682,0],"IMU":[-3.0361007272867902e-05,0.10732848178870434,0.87753132829667135,0.055680487581408089,0.023646104052572798,0.0053035882608539779,1.0430684388526459,-0.013261960276422348,-9.7326996090733626],"FOG":[0.88038639350426295],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-13.448470800638386,-28.256007328527726,-28.157608063896362,58.307564450918584,58.307564450918584],"omega_rad_s":[-13.400110386394166,-28.738519373021347,-28.10290295259535,58.130161826997288,58.129869781596319],"thrust_n":[-2.2494163113469567,-10.273831880690661,-9.8505481812446529,44.378965795105536,44.373944717566204],"torque_nm":[0.042176555837755453,0.19263434776294988,0.18469777839833729,-0.83210560865822891,-0.83201146345436638],"angle_rad":[-602.56173684503267,635.3292804428736,-374.62319459393865,1357.3407907713688,1357.3413839602822]},"command":[-0.12808067429179415,-0.26910483170026406,-0.26816769584663203,0.55531013762779602,0.55531013762779602],"arm":{"servo_position":[3.646212140133727e-23,-1.0842021724855024e-21,1.0778494253810975e-21,3.9704669402545327e-25,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,4.3368086899420177e-19,0,0,0],"servo_effort":[-0.078948434189800798,-1.3397687507136968,-0.25685866420843551,-4.9633722038104915e-05,-0.00068801923684226086,0.00021515537096280694]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":473,"step":3784,"t":18.920000000000002,"sim_time":18.92000000000052,"vehicle":{"origin_ned":[1.5947577534892456,1.0829378984961524,3.5193331069359188],"origin_quat_xyzw":[-0.022853480783789241,0.048524120484119901,0.42412118274349603,0.90401568044783687],"cg_ned":[1.5420078972294473,1.0197894121508235,3.2262023291795026],"linear_velocity_ned":[-0.021484860162720731,-0.014083147712215475,-0.045255887212748709],"angular_velocity_ned":[-0.0019854512266592439,-0.0024963063181038967,-0.0049690522492164034]},"sensors":{"Odom":[1.5947577534892456,1.0829378984961524,3.5193331069359188,-0.019596388109294153,0.0080539620475023038,-0.047621435991682226,-0.022853480783789248,0.048524120484119922,0.42412118274349619,0.90401568044783687,-0.0026382353217230528,-6.7944716487200406e-05,-0.0052820583076491207],"Pressure":[27067.224780360604],"DVL":[-0.038795556083452892,0.018483769081724263,0.0025044630874543339,7.3172165840096852,0.0084237209581796493,0.01036712589324295,-0.015465133036686207,0],"IMU":[-0.0001605188027723109,0.10732433971556805,0.87732431829363478,0.036998302222148192,0.0064124191758265087,-0.15693699188575622,1.0464949542492363,-0.0064005544606097614,-9.732285798303872],"FOG":[0.86859734674614075],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-13.340611386484625,-28.286252767108909,-28.037228537067175,58.466899741417436,58.466899741417436],"omega_rad_s":[-13.282102172305825,-28.761077678179948,-27.978176055345592,58.296998546293381,58.296708128415958],"thrust_n":[-2.2095253705126887,-10.289766493701157,-9.7639096606708335,44.616975822361113,44.614276100392118],"torque_nm":[0.041428600697112919,0.19293312175689667,0.18307330613757811,-0.83656829666927091,-0.83651767688235223],"angle_rad":[-603.09503612053663,634.17921983574058,-375.7444586925622,1359.669807124824,1359.6703886687444]},"command":[-0.12705344177604405,-0.26939288349627533,-0.26702122416254453,0.55682761658492796,0.55682761658492796],"arm":{"servo_position":[3.646212140133727e-23,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402545327e-25,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.081979874826272725,-1.3448088213717373,-0.2573799599373327,-5.4272558345457703e-05,-0.00068405948543186104,0.00021428890085874473]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":474,"step":3792,"t":18.960000000000001,"sim_time":18.960000000000512,"vehicle":{"origin_ned":[1.593884413486262,1.0823890068968947,3.5175338482248062],"origin_quat_xyzw":[-0.022904798493975195,0.04849953422633279,0.42402503983802364,0.90406080048641724],"cg_ned":[1.5411499095970786,1.0192281702196981,3.2244029690240383],"linear_velocity_ned":[-0.021421908029343479,-0.013990219830318729,-0.044770461096963268],"angular_velocity_ned":[-0.0019750231784760298,-0.002358184640961799,-0.0052904269604294868]},"sensors":{"Odom":[1.593884413486262,1.0823890068968947,3.5175338482248062,-0.019514964549149989,0.0080059010799419569,-0.047130133682110976,-0.022904798493975202,0.048499534226332804,0.42402503983802375,0.90406080048641724,-0.0024915818392352777,1.2401872617329668e-05,-0.0055894753700122361],"Pressure":[27047.746834548168],"DVL":[-0.0075827553685496527,-0.033560653537300707,0.063298745011236279,7.3407293721642972,0.0083591448470072393,0.015637115959989061,0.030469147841054825,0],"IMU":[-0.00028627417714250795,0.10732338367955427,0.87710484957549895,-0.042232595150619265,-0.0043474655471583169,-0.025781120213370666,1.0522611541409481,0.010029317861133306,-9.7485109980807039],"FOG":[0.87744838670764513],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-13.237376808787152,-28.315535374832603,-27.91904453750443,58.624694561166805,58.624694561166805],"omega_rad_s":[-13.168915756082736,-28.782822304120142,-27.855690425385852,58.462232530535331,58.461943679509034],"thrust_n":[-2.1716014900883711,-10.305162299039901,-9.6792340969473383,44.852858511569394,44.852492349442592],"torque_nm":[0.040717527939156957,0.19322179310699822,0.18148563931776263,-0.8409910970919261,-0.84098423155204871],"angle_rad":[-603.62372502501842,633.02827550375468,-376.86078477939702,1362.0054605267753,1362.0060304894319]},"command":[-0.1260702553217824,-0.2696717654745962,-0.26589566226194694,0.55833042439206482,0.55833042439206482],"arm":{"servo_position":[3.646212140133727e-23,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402545327e-25,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.084908187650871464,-1.3498730345340735,-0.25791087180903033,-5.9013675723041742e-05,-0.00068003692458992032,0.00021345030880219609]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":475,"step":3800,"t":19,"sim_time":19.000000000000504,"vehicle":{"origin_ned":[1.5930161150968092,1.0818430432822788,3.5157540171014809],"origin_quat_xyzw":[-0.02295436909704612,0.048477535674782454,0.42392320121562072,0.90410848073964933],"cg_ned":[1.5402944986925708,1.0186706812069071,3.2226233033153622],"linear_velocity_ned":[-0.021356366968578903,-0.013895709698653575,-0.044272757235838213],"angular_velocity_ned":[-0.0019596373488755753,-0.0022145005993833605,-0.0056074734251609524]},"sensors":{"Odom":[1.5930161150968092,1.0818430432822788,3.5157540171014809,-0.019432003496009598,0.0079544419961621159,-0.046626414793051407,-0.022954369097046137,0.048477535674782489,0.42392320121562099,0.90410848073964933,-0.0023380058675743975,9.2555356981176333e-05,-0.0058917834079967217],"Pressure":[27031.93027086202],"DVL":[-0.02741275802752316,0.00034952707002372345,0.026548981366491409,7.4891642207991964,-0.0082794564802479778,-0.012457921746350992,0.00040150023047698749,0],"IMU":[-0.00040731899106454504,0.10732560632543325,0.87687312761804903,-0.0070503774606380173,-0.022258215579068562,-0.026494310192379095,1.0494868359202825,0.01506338725524186,-9.7058896086342941],"FOG":[0.85558010058573242],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-13.138650029631153,-28.343826996029204,-27.803052063899482,58.780911483201329,58.780911483201329],"omega_rad_s":[-13.060529969116871,-28.803744910673451,-27.735461875438542,58.625822987292445,58.625535645841005],"thrust_n":[-2.1355956631263142,-10.320010678490034,-9.5965108748016466,45.086542698581091,45.088518054534134],"torque_nm":[0.040042418683618408,0.19350020022168818,0.17993457890253087,-0.84537267559839557,-0.84540971352251504],"angle_rad":[-604.14799605895985,631.87648015906893,-377.97226288787022,1364.3476859315724,1364.3482443743358]},"command":[-0.12513000028220145,-0.26994120948599243,-0.26479097203713792,0.55981820460191745,0.55981820460191745],"arm":{"servo_position":[3.646212140133727e-23,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,8.656676720938947e-21,-3.3881317890156997e-23],"servo_velocity":[0,0,0,2.7105054312137611e-20,1.7347234759768071e-18,0],"servo_effort":[-0.087729046602080862,-1.354960176381605,-0.25845157888170023,-6.3782369997499727e-05,-0.00067596269205414078,0.0002126407496486151]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":476,"step":3808,"t":19.039999999999999,"sim_time":19.040000000000497,"vehicle":{"origin_ned":[1.5921530098114249,1.0813000217378856,3.5139940970518673],"origin_quat_xyzw":[-0.023002065743100448,0.048458177540918405,0.4238157517186209,0.9041586799871707],"cg_ned":[1.5394417652195209,1.018117006635167,3.2208638140251571],"linear_velocity_ned":[-0.021288363277612198,-0.013799696156301151,-0.043763182192435232],"angular_velocity_ned":[-0.0019395673169498385,-0.0020658035681883754,-0.0059201774537000536]},"sensors":{"Odom":[1.5921530098114249,1.0813000217378856,3.5139940970518673,-0.019347647166033315,0.0078998084801569658,-0.046110693241419191,-0.023002065743100465,0.048458177540918433,0.42381575171862118,0.9041586799871707,-0.0021781026912253273,0.00017237684770480822,-0.006189032374408026],"Pressure":[27014.985750966105],"DVL":[-0.038794870721492583,0.018717222933215181,0.060662606670808056,7.3829202519583292,-0.018353093187989181,-0.013798600378410755,0.008965395164278956,0],"IMU":[-0.00052336863484880901,0.1073309950641514,0.87662935599019731,0.076836993311403895,-0.043316800012776671,0.078813937906029724,1.0298389917140462,-0.0037479651215842113,-9.7049979249203275],"FOG":[0.87442820736865179],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-13.044286671193726,-28.371096749783863,-27.689247610855727,58.935514949459041,58.935514949459041],"omega_rad_s":[-12.956882250101854,-28.823828639316211,-27.617499232091276,58.787731134447554,58.787445250628117],"thrust_n":[-2.1014473648583794,-10.334296864029593,-9.5157247664814868,45.317960065474708,45.322280599715882],"torque_nm":[0.039402138091094614,0.19376806620055487,0.17841983937152789,-0.84971175122765075,-0.84979276124467285],"angle_rad":[-604.66803992187931,630.72386704675068,-379.07898351700504,1366.6964167075284,1366.6969636895924]},"command":[-0.12423130163041643,-0.27020092142651297,-0.26370712010338787,0.5612906185662766,0.5612906185662766],"arm":{"servo_position":[3.646212140133727e-23,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,-2.2022856628611659e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.090437867230689292,-1.3600674615377639,-0.25900208856838275,-6.8484017241973301e-05,-0.00067187705929943914,0.00021186063033884484]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":477,"step":3816,"t":19.080000000000002,"sim_time":19.080000000000489,"vehicle":{"origin_ned":[1.5912952375032685,1.0807599564090369,3.5122545557282159],"origin_quat_xyzw":[-0.023047771474409302,0.048441504812013619,0.42370277590059929,0.90421135722558665],"cg_ned":[1.5385918049275182,1.0175672048453586,3.2191249668502562],"linear_velocity_ned":[-0.02121801885391816,-0.013702259095947668,-0.043242142951950509],"angular_velocity_ned":[-0.0019151030326293407,-0.0019126624132385355,-0.0062285235046529086]},"sensors":{"Odom":[1.5912952375032685,1.0807599564090369,3.5122545557282159,-0.019262036178747326,0.007842229898821872,-0.04558338277034784,-0.023047771474409312,0.04844150481201364,0.42370277590059952,0.90421135722558665,-0.0020124929707767661,0.00025172737561460456,-0.0064812736056700801],"Pressure":[26996.580992647967],"DVL":[-0.027190528246975928,0.027906295557310789,0.040196249373032698,7.4068304997147436,-0.0066841945094171388,0.0088789878041924414,-0.031269004219093184,0],"IMU":[-0.00063416321534205265,0.10733953207415264,0.87637373627273674,-0.06713378933902088,0.062122385459919181,-0.049067502753766347,1.0691143539425705,0.031609540837015788,-9.7712041861700349],"FOG":[0.89878824336513441],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-12.954113411129599,-28.397311143457259,-27.577626218221212,59.088471511904132,59.088471511904132],"omega_rad_s":[-12.857871990586746,-28.843049892056747,-27.501806320025768,58.947920278086798,58.947635806571149],"thrust_n":[-2.0690861348629928,-10.348001212581245,-9.4368574013707782,45.5470452868339,45.553710313699725],"torque_nm":[0.038795365028681125,0.19402502273589833,0.1769410762757021,-0.85400709912813555,-0.85413206838186984],"angle_rad":[-605.18404393300955,629.57047024469341,-380.18103740198768,1369.0515847194563,1369.0521202980833]},"command":[-0.12337250867742476,-0.27045058231864055,-0.26264405922115441,0.5627473477324203,0.5627473477324203],"arm":{"servo_position":[3.646212140133727e-23,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,-2.2022856628611659e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.093031179876834583,-1.3651927423870023,-0.25956182448949766,-7.314131662923437e-05,-0.00066775369750264016,0.00021110978634571872]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":478,"step":3824,"t":19.120000000000001,"sim_time":19.120000000000481,"vehicle":{"origin_ned":[1.5904429264057245,1.0802228616800145,3.5105358449300983],"origin_quat_xyzw":[-0.023091379705979742,0.048427554531975912,0.42358435799327421,0.90426647168229801],"cg_ned":[1.5377447088255196,1.0170213309718752,3.2174072112021141],"linear_velocity_ned":[-0.02114544916488377,-0.013603479027541346,-0.042710046530038272],"angular_velocity_ned":[-0.0018865533159564136,-0.0017556660901741213,-0.0065324967508033982]},"sensors":{"Odom":[1.5904429264057245,1.0802228616800145,3.5105358449300983,-0.01917530750548151,0.0077819404232354217,-0.045044896456951276,-0.023091379705979756,0.04842755453197594,0.42358435799327449,0.90426647168229801,-0.0018418245603622823,0.00033046936725740608,-0.0067685621013285537],"Pressure":[26980.758331702669],"DVL":[-0.034450768475218309,0.023576558322389612,0.042380335891252445,7.3092654093865983,0.045847029945378197,-0.0084687788346235141,-0.029049872089547863,0],"IMU":[-0.00073946861262616406,0.10735119430700368,0.87610646793496727,-0.088301342720547599,-0.013622061229182794,0.21148963290424783,1.0489302072152558,0.0088385487230166291,-9.7247244583481436],"FOG":[0.88099620044933147],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-12.867930538427943,-28.422433828340598,-27.468182922081013,59.239749413343361,59.239749413343361],"omega_rad_s":[-12.763363948152319,-28.861379667853271,-27.388383347177164,59.106355709573819,59.106072612486635],"thrust_n":[-2.0384330679770004,-10.361100177731197,-9.3598883225158911,45.773735896075394,45.782740364739887],"torque_nm":[0.038220620024568754,0.19427062833245995,0.17549790604717297,-0.85825754805141385,-0.85842638183887288],"angle_rad":[-605.6961905909825,628.41632490004918,-381.27851534383166,1371.4131204098494,1371.4136446406537]},"command":[-0.12255171941359946,-0.27068984598419615,-0.26160174211505727,0.56418808965088918,0.56418808965088918],"arm":{"servo_position":[3.646212140133727e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,-8.6736173798840355e-19,0,-2.7105054312137611e-20,0,0],"servo_effort":[-0.095505418992418184,-1.37033312118729,-0.26013055099634241,-7.7721672674424934e-05,-0.00066359768287679573,0.00021038889158443453]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":479,"step":3832,"t":19.16,"sim_time":19.160000000000473,"vehicle":{"origin_ned":[1.5895961929450149,1.0796887520969447,3.5088384009852711],"origin_quat_xyzw":[-0.023132794289458577,0.048416354849911761,0.42346058192295444,0.90432398285618953],"cg_ned":[1.5369005635382949,1.0164794370620502,3.2157109804571564],"linear_velocity_ned":[-0.021070755121308547,-0.013503424875674208,-0.042167280656973283],"angular_velocity_ned":[-0.0018541327511024477,-0.0015955067154927757,-0.006832081105880238]},"sensors":{"Odom":[1.5895961929450149,1.0796887520969447,3.5088384009852711,-0.019087624169492383,0.0077191781735459642,-0.044495618849084463,-0.02313279428945858,0.048416354849911768,0.42346058192295449,0.90432398285618953,-0.0016667641494221529,0.00040832650620641991,-0.0070509537588718677],"Pressure":[26964.562669501807],"DVL":[0.0052796444581792897,-0.00030799646909156209,0.027980730671825684,7.4554942174446177,0.0035651847853100534,-0.012589282216936178,-0.007825175921323738,0],"IMU":[-0.0008390773984965098,0.1073659518074158,0.87582774828563303,0.088797663133331386,0.025050091532579224,0.071641557930150992,1.0484862563943018,0.010934837697544336,-9.773664458247044],"FOG":[0.87800279409327797],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-12.785514729752006,-28.446427649755094,-27.360912160648216,59.389318364329398,59.389318364329398],"omega_rad_s":[-12.673191239413283,-28.878784862147768,-27.277228105873991,59.263004572463132,59.262722820169301],"thrust_n":[-2.0094020447505336,-10.373567486186795,-9.2847960708519128,45.997973047339734,46.009304444115195],"torque_nm":[0.037676288339072508,0.19450439036600245,0.17408992632847339,-0.86246199463762008,-0.86267445832715994],"angle_rad":[-606.20465625643862,627.26146741711068,-382.37150809625882,1373.7809528754005,1373.7814658126613]},"command":[-0.1217668069500191,-0.27091835856909613,-0.26058011581569729,0.5656125558507562,0.5656125558507562],"arm":{"servo_position":[3.646212140133727e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.097858424170533739,-1.3751741987785742,-0.26065299428145772,-8.2233193381030126e-05,-0.0006594265621581415,0.00020966259851396606]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":480,"step":3840,"t":19.199999999999999,"sim_time":19.200000000000465,"vehicle":{"origin_ned":[1.5887551391526287,1.0791576394131812,3.5071626500402884],"origin_quat_xyzw":[-0.023171924932615079,0.048407914381850672,0.42333153164349657,0.90438385104804242],"cg_ned":[1.5360594532452265,1.0159415741908195,3.2140366953454378],"linear_velocity_ned":[-0.020993967855961963,-0.013402087458816624,-0.041614106916874755],"angular_velocity_ned":[-0.0018174244243755655,-0.0014334285671981474,-0.0071272484069315259]},"sensors":{"Odom":[1.5887551391526287,1.0791576394131812,3.5071626500402884,-0.01899931198153226,0.0076541863052075948,-0.043935754710595264,-0.023171924932615093,0.0484079143818507,0.42333153164349679,0.90438385104804242,-0.0014879990029031199,0.00048418348380371883,-0.0073284953551909695],"Pressure":[26949.382885116996],"DVL":[-0.028758409175525895,-0.012659326149083132,0.065203452180393792,7.4256999485061073,-0.001595698695835174,0.024649475208165482,-0.00792635082257254,0],"IMU":[-0.00093280954265037466,0.10738374451444249,0.87553777260328769,0.0065774451711481463,0.038490092260251192,0.053326835312482557,1.0420526444686056,0.0007715062777558946,-9.7456754930614817],"FOG":[0.88914298265992642],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-12.706618656065009,-28.469185909841784,-27.25573534756651,59.537104868381178,59.537104868381178],"omega_rad_s":[-12.587157478988722,-28.895213894762023,-27.168320326604274,59.417825863916391,59.417545443600552],"thrust_n":[-1.981900600157471,-10.385365282355696,-9.2115489491814166,46.21969190867793,46.233307265049937],"torque_nm":[0.037160636252952586,0.19472559904416936,0.1727165427971516,-0.86661922328771135,-0.86687451121968628],"angle_rad":[-606.70960993720246,626.10593585815252,-383.46010600833438,1376.1550097736801,1376.1555114708149]},"command":[-0.1210154157720477,-0.27113510390325507,-0.2595784318815858,0.56702004636553505,0.56702004636553505],"arm":{"servo_position":[1.7198739296202534e-22,-1.0842021724855024e-21,1.0778494253810979e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[2.7105054312137611e-20,0,-1.7347234759768071e-18,0,0,0],"servo_effort":[-0.10010713839316442,-1.3789026928321064,-0.26111831850373635,-8.6708029060220847e-05,-0.00065633402917502715,0.00020936860262364614]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":481,"step":3848,"t":19.240000000000002,"sim_time":19.240000000000457,"vehicle":{"origin_ned":[1.5879198519209941,1.0786295320498114,3.5055090096889954],"origin_quat_xyzw":[-0.023208686352781272,0.048402219278727822,0.4231972915268063,0.9044460373571479],"cg_ned":[1.5352214603263248,1.0154077930584602,3.2123847650870494],"linear_velocity_ned":[-0.020915153574552946,-0.013299503317382633,-0.041050854270447731],"angular_velocity_ned":[-0.0017764059512301177,-0.0012703787658581455,-0.0074179509156636746]},"sensors":{"Odom":[1.5879198519209941,1.0786295320498114,3.5055090096889954,-0.018910600378654663,0.0075872163398677311,-0.043365605838186161,-0.023208686352781283,0.048402219278727843,0.42319729152680652,0.9044460373571479,-0.0013062420102244255,0.00055741785995719567,-0.007601216563131865],"Pressure":[26930.38667490039],"DVL":[0.012261969473863446,0.0070482352151541453,0.030731514217634918,7.3583896499204728,-0.02469046208348635,0.029959471391528863,-0.013620354941153196,0],"IMU":[-0.0010205133012544717,0.10740447620925943,0.87523673481180275,0.053103831516477185,0.0064746211049242705,0.068525717088731966,1.0562821977409744,0.0018688395539271513,-9.7447078540645684],"FOG":[0.86845417450449558],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-12.630964131360578,-28.490573913985994,-27.15252358901029,59.683009472325708,59.683009472325708],"omega_rad_s":[-12.505036636715751,-28.910583073741812,-27.061601499008251,59.570758151028798,59.570479080141538],"thrust_n":[-1.9558300000084972,-10.396431654569167,-9.1400890208204899,46.438793361799064,46.454627731167214],"torque_nm":[0.036671812500159315,0.19493309352317192,0.17137666914038421,-0.87072737553373247,-0.87102426995938542],"angle_rad":[-607.21121211444222,624.94977114182143,-384.54439770278702,1378.5352166237628,1378.5357071343394]},"command":[-0.12029489648914836,-0.27133879918081899,-0.25859546275247897,0.56840961402214962,0.56840961402214962],"arm":{"servo_position":[3.6462121401337282e-23,3.2526065174565154e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,8.6736173798840355e-19,0,0,0,0],"servo_effort":[-0.10227056601967079,-1.3823201927985962,-0.26163231559011629,-9.1163893909085311e-05,-0.00065629781374907823,0.0002093756062179335]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":482,"step":3856,"t":19.280000000000001,"sim_time":19.280000000000449,"vehicle":{"origin_ned":[1.5870904057949169,1.0781044386638501,3.5038778832277426],"origin_quat_xyzw":[-0.023243003964183911,0.048399244351828276,0.42305794626513066,0.90451050298756763],"cg_ned":[1.5343866636781462,1.0148781417359876,3.2107555837094428],"linear_velocity_ned":[-0.020834410131108802,-0.013195754132167732,-0.040477933342897572],"angular_velocity_ned":[-0.0017314750884669914,-0.0011069757152328275,-0.0077041351862242391]},"sensors":{"Odom":[1.5870904057949169,1.0781044386638501,3.5038778832277426,-0.018821605113149772,0.0075185225535914146,-0.042785587484308073,-0.023243003964183918,0.048399244351828297,0.42305794626513082,0.90451050298756763,-0.0011222229362434972,0.00062793988921379222,-0.0078691427335268634],"Pressure":[26914.019052748292],"DVL":[-0.023578299403203058,-0.0014467010507562984,0.05629526184781912,7.2706975110931369,0.041230174808259024,-0.0035773821061423046,-0.0026484215985445193,0],"IMU":[-0.0011020660416834729,0.10742803950760596,0.87492482784199777,0.0041600695611741772,-0.039355464646205075,0.04006105908599665,1.0590931684664051,0.021936774957507687,-9.7159317328761183],"FOG":[0.86528792974265945],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-12.558244648544065,-28.510543328560868,-27.051226083903739,59.826990478626179,59.826990478626179],"omega_rad_s":[-12.42657247956781,-28.924812311596149,-26.957008326703601,59.721742563651283,59.721464887653035],"thrust_n":[-1.9310851695425044,-10.406706000577998,-9.0703548717420333,46.655176853080484,46.673160413144572],"torque_nm":[0.036207846928921955,0.19512573751083745,0.17006915384516313,-0.87478456599525889,-0.87512175774646062],"angle_rad":[-607.70961353551434,623.79301753182233,-385.62446926945319,1380.9214964929054,1380.9219758718461]},"command":[-0.11960232998613396,-0.27152898408153209,-0.25763072460860703,0.56978086170120168,0.56978086170120168],"arm":{"servo_position":[1.7198739296202534e-22,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[2.7105054312137611e-20,0,0,0,0,0],"servo_effort":[-0.10435089490939359,-1.385748524580027,-0.26215284100678776,-9.5661507189688378e-05,-0.00065729859658270723,0.00020936722667772722]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":483,"step":3864,"t":19.32,"sim_time":19.320000000000441,"vehicle":{"origin_ned":[1.5862668638820256,1.077582369138357,3.5022696589799045],"origin_quat_xyzw":[-0.023274814693801826,0.048398954518150683,0.42291358086786462,0.90457720915355766],"cg_ned":[1.5335551390617337,1.0143526658490545,3.2091495296478616],"linear_velocity_ned":[-0.020751789190524783,-0.013090871385337873,-0.039895697527067231],"angular_velocity_ned":[-0.0016827949430780684,-0.00094403483026486517,-0.0079857470157072737]},"sensors":{"Odom":[1.5862668638820256,1.077582369138357,3.5022696589799045,-0.018732472688782434,0.0074483580045336534,-0.042196034815655301,-0.023274814693801833,0.048398954518150697,0.42291358086786474,0.90457720915355766,-0.00093667222763414552,0.00069535289489657123,-0.008132298904345428],"Pressure":[26897.910954095365],"DVL":[-0.010888688755027865,0.022177906643085336,0.058730287612095325,7.3756077486429543,0.037443678831184143,0.0033270708398628239,-0.0087860795333842487,0],"IMU":[-0.0011773744765548105,0.10745431915302052,0.87460224369180017,0.069697245488618331,0.028394747448640789,-0.098771164688592247,1.0446507081355036,0.021217514720842802,-9.7317580581245444],"FOG":[0.89661539584210759],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-12.488135601773699,-28.529071119264529,-26.951815745948927,59.969020364664352,59.969020364664352],"omega_rad_s":[-12.351481559357175,-28.937838769791977,-26.854488281877316,59.870731303741181,59.870455089639414],"thrust_n":[-1.9075556842539725,-10.416141056362692,-9.0022941446928879,46.868759908257658,46.888812229813517],"torque_nm":[0.03576666907976199,0.19530264480680049,0.1687930152129917,-0.87878924827983129,-0.87916522930900365],"angle_rad":[-608.20495406729196,622.63572208590301,-386.70040452274287,1383.3137703618245,1383.3142386663617]},"command":[-0.11893462477879714,-0.27170543923109075,-0.25668395948522787,0.57113352728251765,0.57113352728251765],"arm":{"servo_position":[1.7198739296202534e-22,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[2.7105054312137611e-20,0,0,0,0,0],"servo_effort":[-0.10635123508738827,-1.3889098432075295,-0.26270826463032626,-0.00010013655348224867,-0.00065850150943008831,0.00020967274351395133]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":484,"step":3872,"t":19.359999999999999,"sim_time":19.360000000000433,"vehicle":{"origin_ned":[1.585449277402867,1.0770633339844324,3.5006847132215206],"origin_quat_xyzw":[-0.023304064864016257,0.048401300031740237,0.42276428091158547,0.90464611727534705],"cg_ned":[1.5327269606761207,1.0138314102689094,3.2075669678129288],"linear_velocity_ned":[-0.020667340239554213,-0.012984888335273899,-0.039304505071907234],"angular_velocity_ned":[-0.0016305674402306686,-0.00078234868172855217,-0.0082627197113102659]},"sensors":{"Odom":[1.585449277402867,1.0770633339844324,3.5006847132215206,-0.018643336483766287,0.0073769778716880454,-0.041597289428588487,-0.023304064864016278,0.048401300031740278,0.42276428091158585,0.90464611727534705,-0.00075032861272668274,0.00075930403628867034,-0.0083906984821299248],"Pressure":[26882.0890081617],"DVL":[-0.0010269861468576238,0.0079030708966644769,0.037672877030869661,7.4139514228850469,0.017082087811924641,-0.022068606952939444,-0.010633233500982759,0],"IMU":[-0.0012463748345083758,0.10748318154457884,0.87426917370957891,-0.10365378315844127,0.017395231977285038,-0.13613701914768578,1.0519668671100668,0.023599923501754327,-9.7147262560948811],"FOG":[0.87999176401494894],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-12.420293866844009,-28.546105303770194,-26.854227105313239,60.109030188913984,60.109030188913984],"omega_rad_s":[-12.279456254846057,-28.949602913044288,-26.753985548778047,60.017672116159183,60.017397454127689],"thrust_n":[-1.8851267302271391,-10.424692351256306,-8.9358534122513493,47.079453383494361,47.101481077726412],"torque_nm":[0.035346126191758857,0.19546298158605574,0.16754725147971281,-0.88273975094051949,-0.88315277020737026],"angle_rad":[-608.69736168568215,621.4779342786228,-387.77228513044992,1385.7119572264612,1385.7124145170251]},"command":[-0.11828851301756199,-0.27186766955971614,-0.25575454386012608,0.57246695418013316,0.57246695418013316],"arm":{"servo_position":[1.7198739296202534e-22,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[2.7105054312137611e-20,0,0,0,0,0],"servo_effort":[-0.10827822506977941,-1.3919962365250584,-0.26328459571748708,-0.00010459822208678621,-0.00065973471850778987,0.00021011486833944968]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":485,"step":3880,"t":19.400000000000002,"sim_time":19.400000000000425,"vehicle":{"origin_ned":[1.5846376869475425,1.0765473457019419,3.4991234061283558],"origin_quat_xyzw":[-0.023330713430631023,0.048406223306075205,0.42261013246755919,0.90471718856878802],"cg_ned":[1.5319021996007258,1.0133144170346411,3.2060082467836595],"linear_velocity_ned":[-0.020581153427529978,-0.012877892673897088,-0.038704786881044173],"angular_velocity_ned":[-0.0015752891619564401,-0.00062246024486358668,-0.0085349877261411029]},"sensors":{"Odom":[1.5846376869475425,1.0765473457019419,3.4991234061283558,-0.018554273671456598,0.0073046345445278958,-0.040989791561402665,-0.023330713430631041,0.048406223306075247,0.42261013246755957,0.90471718856878802,-0.00056392793998256919,0.00081982599521217183,-0.0086443553144045261],"Pressure":[26868.838798634097],"DVL":[-0.035757173915359361,-0.011952781769400565,0.070529824545044154,7.3877974906998638,0.0042085655753954275,-0.035161636934225061,-0.0022334022911741891,0],"IMU":[-0.0013090329187747142,0.10751448983542296,0.87392580879673787,-0.030869700234066055,-0.061215529044795366,0.16841751709080016,1.0642354844358224,0.017992376078383304,-9.7272116185573534],"FOG":[0.87911170871075961],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-12.354359177875196,-28.56163730681088,-26.758431777362663,60.246999273576385,60.246999273576385],"omega_rad_s":[-12.210166221935664,-28.960057236850808,-26.65544868890554,60.162519285939574,60.162246284738828],"thrust_n":[-1.8636795323559638,-10.432322988696505,-8.8709819127856395,47.28717498672242,47.311083985573497],"torque_nm":[0.034943991231674333,0.1956060560380595,0.16633091086473076,-0.8866345310010455,-0.88708282472950306],"angle_rad":[-609.18695153453575,620.31970572799617,-388.84019058434643,1388.1159740902433,1388.1164204313156]},"command":[-0.11766056359881139,-0.27201559339819886,-0.25484220740345392,0.57378094546263225,0.57378094546263225],"arm":{"servo_position":[1.7198739296202534e-22,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.11013167813072602,-1.3950995898375558,-0.26387451570345827,-0.00010898016344012008,-0.00066098539864361617,0.00021060367907390953]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":486,"step":3888,"t":19.440000000000001,"sim_time":19.440000000000417,"vehicle":{"origin_ned":[1.5838321230804959,1.0760344191608786,3.4975860804106746],"origin_quat_xyzw":[-0.023354732896219074,0.048413661216367997,0.42245122201409724,0.90479038394413147],"cg_ned":[1.5310809233936395,1.0128017246706975,3.2044736978501183],"linear_velocity_ned":[-0.020493314876507192,-0.012769972549508658,-0.038096975955892856],"angular_velocity_ned":[-0.0015174557019185786,-0.00046489958173138546,-0.0088024879620938381]},"sensors":{"Odom":[1.5838321230804959,1.0760344191608786,3.4975860804106746,-0.018465356573240173,0.0072315752781464291,-0.040373983447534935,-0.023354732896219081,0.048413661216368011,0.42245122201409741,0.90479038394413147,-0.00037819530444442421,0.00087695831841508212,-0.0088932845546875975],"Pressure":[26851.299415404013],"DVL":[0.0090117013497915087,0.022754341309613749,0.041884054430675471,7.3777597428562789,0.006196893212981237,-0.024891990232282789,-0.027726367198410894,0],"IMU":[-0.0013653438056955881,0.1075481088557072,0.87357233934234935,-0.056941691630884118,-0.040036562616260873,0.21681147650220062,1.0361966038808319,0.0074796869778333613,-9.7257243765560801],"FOG":[0.86450161760105848],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-12.28996037672829,-28.57566606169533,-26.664409722402588,60.382918613079852,60.382918613079852],"omega_rad_s":[-12.143261905893137,-28.969168525122974,-26.55883562332399,60.305239571372276,60.304968351358852],"thrust_n":[-1.8430923921226117,-10.43900652259898,-8.8076359463541554,47.491861493022945,47.5175579527846],"torque_nm":[0.034557982352298976,0.19573137229873089,0.16514317399414039,-0.89047240299418051,-0.89095421161471133],"angle_rad":[-609.67382509697279,619.16108961303939,-389.90419854091283,1390.5257364213694,1390.5261718820627]},"command":[-0.11704724168312657,-0.27214920058757458,-0.25394675926097704,0.57507541536266527,0.57507541536266527],"arm":{"servo_position":[1.7198739296202534e-22,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.11191207492703362,-1.3982181246519205,-0.26447776736907058,-0.00011333707978001296,-0.00066222226883174394,0.00021114031499617391]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":487,"step":3896,"t":19.48,"sim_time":19.480000000000409,"vehicle":{"origin_ned":[1.5830326067367178,1.0755245715733337,3.4960730613132656],"origin_quat_xyzw":[-0.023376109167657696,0.048423545345140477,0.42228763637804489,0.90486566402899438],"cg_ned":[1.5302631963087503,1.0122933681704507,3.2029636350395188],"linear_velocity_ned":[-0.020403904604586427,-0.012661216397378118,-0.037481502633566803],"angular_velocity_ned":[-0.0014575604125328209,-0.00031018316569067609,-0.0090651621732754286]},"sensors":{"Odom":[1.5830326067367178,1.0755245715733337,3.4960730613132656,-0.018376651848077793,0.0071580399720365959,-0.039750304412784265,-0.023376109167657703,0.048423545345140491,0.42228763637804501,0.90486566402899438,-0.00019384348598451312,0.00093074687148390228,-0.0091375049189813713],"Pressure":[26837.006999196492],"DVL":[-0.017214485668191566,0.0071684327825777714,0.0010630433554473309,7.428129333076849,-0.0031948491381704565,0.026659938612312226,0.0027746175592694693,0],"IMU":[-0.0014153313764408498,0.10758390540628332,0.87320895511601815,-0.03743135455195376,0.029085329309283973,0.12784129662184826,1.0541054038476139,0.018256172123628046,-9.7292186019311409],"FOG":[0.88367800645288852],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-12.226721581344757,-28.588191603852277,-26.572143169099274,60.516781402663156,60.516781402663156],"omega_rad_s":[-12.078378776383722,-28.976913585962897,-26.46411118573543,60.445809043810904,60.445539732008982],"thrust_n":[-1.8232419290446908,-10.444723951925971,-8.7457771863295903,47.693464089781067,47.720854626849068],"torque_nm":[0.034185786169587958,0.19583857409861197,0.16398332224367981,-0.89425245168339518,-0.89476602425342011],"angle_rad":[-610.15806952116316,618.00214020425733,-390.9643851346575,1392.9411585784037,1392.9415832328079]},"command":[-0.11644496744137864,-0.27226849146525978,-0.25306803018189783,0.57635029907298241,0.57635029907298241],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.11361986845314191,-1.4013520709067371,-0.26509414457144587,-0.00011758138077759526,-0.00066346874270049828,0.00021172292287327063]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":488,"step":3904,"t":19.52,"sim_time":19.520000000000401,"vehicle":{"origin_ned":[1.5822391493995256,1.0750178221943152,3.4945846577468274],"origin_quat_xyzw":[-0.023394840644796865,0.048435800728708164,0.42211946271988487,0.90494298927172701],"cg_ned":[1.5294490799010196,1.0117893794891728,3.2014783559949844],"linear_velocity_ned":[-0.020312976727949364,-0.012551685809647798,-0.036858753221351057],"angular_velocity_ned":[-0.0013959578990827286,-0.00015892086360319471,-0.0093229539644939588]},"sensors":{"Odom":[1.5822391493995256,1.0750178221943152,3.4945846577468274,-0.018288243773797747,0.0070842617770065976,-0.039119137360687818,-0.023394840644796872,0.048435800728708185,0.42211946271988504,0.90494298927172701,-1.1567585491957305e-05,0.00098107047669265205,-0.0093770353434175259],"Pressure":[26821.162956392149],"DVL":[-0.059736450320171393,0.02441233725355451,0.036086980472723962,7.3930901157004296,-0.028024662362938373,-0.011562236398508587,0.018431851716050943,0],"IMU":[-0.001459047721812101,0.10762174517863117,0.87283584518069668,-0.073376675131638355,0.072106027507944537,0.018224699149832938,1.0540794268670832,0.023386486984410298,-9.7409032595439768],"FOG":[0.87472429201562452],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-12.164263189882993,-28.599209518815272,-26.481611256641436,60.648576094485286,60.648576094485286],"omega_rad_s":[-12.015141077401459,-28.983275237918765,-26.371244744339354,60.584209386148686,60.583942113698747],"thrust_n":[-1.804004129296179,-10.449461273414006,-8.6853714020302455,47.891943629949502,47.920931187259455],"torque_nm":[0.033825077424303365,0.19592739887651264,0.16285071378806715,-0.89797394306155331,-0.89851745976111486],"angle_rad":[-610.63975711115097,616.84291254859022,-392.02082520985959,1395.3621541072089,1395.3625680345883]},"command":[-0.11585012561793326,-0.27237342398871689,-0.25220582149182319,0.57760548661414557,0.57760548661414557],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.11525588810453458,-1.4045579806674098,-0.26573384688467272,-0.00012176833295932498,-0.00066470976479231529,0.00021235938087932801]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":489,"step":3912,"t":19.559999999999999,"sim_time":19.560000000000393,"vehicle":{"origin_ned":[1.581451753334695,1.0745141920798422,3.493121163261276],"origin_quat_xyzw":[-0.02341093736716543,0.048450344966262944,0.42194678856061713,0.90502232000521543],"cg_ned":[1.5286386335149424,1.0112897879683258,3.2000181427533576],"linear_velocity_ned":[-0.0202205949870497,-0.01244145841625215,-0.036229135208239643],"angular_velocity_ned":[-0.0013330746272526878,-1.1636471592794094e-05,-0.0095758083667520592]},"sensors":{"Odom":[1.581451753334695,1.0745141920798422,3.493121163261276,-0.018200199600643244,0.0070104661087840494,-0.038480893499515001,-0.023410937367165433,0.048450344966262951,0.42194678856061724,0.90502232000521543,0.00016795724971344918,0.001027917594390316,-0.0096118939355085645],"Pressure":[26805.618046340151],"DVL":[-0.053951151108924983,0.038931941915699937,0.050258413484224919,7.4275740963932622,0.039875721939579799,0.012787816981445021,-0.022463884268845796,0],"IMU":[-0.0014965723359749716,0.10766149038078106,0.87245319792592291,-0.050893104120066777,-0.008768211098045358,-0.01890384644554239,1.051203949924121,0.037220712369754487,-9.7336405157905173],"FOG":[0.90430272746660911],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-12.102202805862945,-28.608707928610624,-26.392782451805395,60.778276828512993,60.778276828512993],"omega_rad_s":[-11.953164451786025,-28.988237199723702,-26.280204683198672,60.720420597998704,60.720155500556807],"thrust_n":[-1.7852550518496497,-10.453205145648926,-8.6263841507391952,48.087258120158992,48.117743513976372],"torque_nm":[0.033473532222180934,0.19599759648091739,0.16174470282635994,-0.90163608975298115,-0.9022076908870571],"angle_rad":[-611.11894493784587,615.68346235921751,-393.07359236473962,1397.7886357837995,1397.7890390687692]},"command":[-0.11525907434155186,-0.2724638850343869,-0.25135983287433711,0.57884073170012373,0.57884073170012373],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.1168204188781143,-1.4077802053241917,-0.2663869166241008,-0.00012585774232930244,-0.00066594714308274613,0.00021304273131925825]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":490,"step":3920,"t":19.600000000000001,"sim_time":19.600000000000385,"vehicle":{"origin_ned":[1.5806704123042081,1.0740137043527127,3.4916828542822014],"origin_quat_xyzw":[-0.023424421895027893,0.048467091100374435,0.42176970167968653,0.90510361632477188],"cg_ned":[1.527831913671843,1.0107946194123785,3.1985832604701296],"linear_velocity_ned":[-0.020126831538141082,-0.012330626378763747,-0.035593074566301612],"angular_velocity_ned":[-0.001269394690977264,0.00013122417476081678,-0.0098236746509080073]},"sensors":{"Odom":[1.5806704123042081,1.0740137043527127,3.4916828542822014,-0.018112572499623059,0.0069368694430587364,-0.037836008765476235,-0.023424421895027903,0.048467091100374456,0.42176970167968669,0.90510361632477188,0.00034407890805582091,0.0010713702088446064,-0.0098421004817593142],"Pressure":[26793.532400196949],"DVL":[-0.013416512905188277,0.01698429088244768,0.047301110737846527,7.4681761694956297,0.030411219567534242,0.019114077500256007,0.030427760577566951,0],"IMU":[-0.0015280112707210889,0.10770300567627646,0.87206120102005991,-0.014135104811261562,0.077918386741353637,0.037704434400706137,1.0546439623764607,0.0085500236544526157,-9.7571851988995046],"FOG":[0.87216021083697925],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-12.040157570073598,-28.616688842009598,-26.305639944939738,60.90588112793413,60.90588112793413],"omega_rad_s":[-11.892058492390094,-28.991787748797602,-26.190962601467852,60.854427785563374,60.854165000753476],"thrust_n":[-1.7668715218040325,-10.455945321233367,-8.5687833444568433,48.279372992745401,48.311258547957415],"torque_nm":[0.033128841033825608,0.19604897477312561,0.16066468770856587,-0.90523824361397631,-0.90583609777420171],"angle_rad":[-611.59567455300692,614.52384590297493,-394.12275899683004,1400.220515686108,1400.2209084187632]},"command":[-0.11466816733403427,-0.27253989373342474,-0.25052990423752131,0.58005601074222979,0.58005601074222979],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[-2.7105054312137611e-20,0,0,0,0,0],"servo_effort":[-0.11831456068711443,-1.4110126402881704,-0.26705206909787127,-0.00012988936917082954,-0.00066719033597975586,0.00021377106292424735]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":491,"step":3928,"t":19.640000000000001,"sim_time":19.640000000000377,"vehicle":{"origin_ned":[1.5798951120446554,1.0735163840786095,3.4902699899301064],"origin_quat_xyzw":[-0.02343532907068939,0.048485948354094283,0.42158829003995163,0.9051868380973852],"cg_ned":[1.5270289740796144,1.0103038959073736,3.1971739573280265],"linear_velocity_ned":[-0.020031755240697988,-0.012219283125860398,-0.034950994069005939],"angular_velocity_ned":[-0.0012053878441742223,0.00026924132606256067,-0.010066507802036721]},"sensors":{"Odom":[1.5798951120446554,1.0735163840786095,3.4902699899301064,-0.018025412811250589,0.0068636766349864861,-0.037184915942766468,-0.023435329070689414,0.048485948354094338,0.42158829003995213,0.9051868380973852,0.00051617487334213407,0.0011115153630976437,-0.010067677347468846],"Pressure":[26780.612787991005],"DVL":[-0.038219062193015754,0.032805354949706995,0.057215578697079779,7.4048710556885968,-0.0085439187373586491,-0.03759440779301769,-0.010318046563655224,0],"IMU":[-0.0015534960786004752,0.10774615928381248,0.8716600413145541,0.0095263080606248635,-0.015833450139976807,0.032891431315029571,1.0645900479112251,0.018164581596693357,-9.7163549028500462],"FOG":[0.85762859000414871],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-11.977747797900328,-28.623154736197247,-26.220168584300364,61.03138925245073,61.03138925245073],"omega_rad_s":[-11.831429544925445,-28.993919284212794,-26.103493704454806,60.986221764421245,60.985961429178637],"thrust_n":[-1.7487319081257306,-10.457674697150262,-8.5125397953239705,48.468262789231311,48.501452630743628],"torque_nm":[0.032788723277357448,0.19608140057156739,0.15961012116232448,-0.90877992729808732,-0.90940223682644317],"angle_rad":[-612.06997180913743,613.36411981691526,-395.16839645221881,1402.6577054304544,1402.6580877063868]},"command":[-0.11407378855143169,-0.27260147367806903,-0.24971589127905108,0.58125132621381648,0.58125132621381648],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.11974016982576885,-1.41425529289311,-0.26772934906925594,-0.00013382264903934044,-0.00066842488727732337,0.00021454506929750853]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":492,"step":3936,"t":19.68,"sim_time":19.680000000000369,"vehicle":{"origin_ned":[1.5791258306930083,1.0730222580669522,3.488882812157672],"origin_quat_xyzw":[-0.023443705524981567,0.048506822471368054,0.42140264173189707,0.90527194499021535],"cg_ned":[1.5262298657379938,1.0098176357978925,3.195790464685889],"linear_velocity_ned":[-0.019935433020562453,-0.012107522421320608,-0.034303312674583482],"angular_velocity_ned":[-0.0011415097508614316,0.00040202155663588107,-0.010304267162440725]},"sensors":{"Odom":[1.5791258306930083,1.0730222580669522,3.488882812157672,-0.017938768152895163,0.0067910824986926266,-0.036528044099040959,-0.023443705524981571,0.048506822471368061,0.42140264173189712,0.90527194499021535,0.00068365208734290253,0.0011484455175994022,-0.010288648128633978],"Pressure":[26763.463089067081],"DVL":[-0.015245706118013796,0.0035132580219245186,0.049051111251439232,7.3489927650434757,0.015447441167141805,0.003471328717003504,0.0023081630771646456,0],"IMU":[-0.0015731826289840816,0.10779082314083606,0.87124990477436937,0.074908291663491777,-0.070899049529451738,0.00076560798486105183,1.0579627453187523,0.028970001269604875,-9.7403615415564797],"FOG":[0.86486195898526153],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-11.914598759018791,-28.628107805633199,-26.13635338824156,61.154802626001974,61.154802626001974],"omega_rad_s":[-11.770883755353283,-28.994626831767654,-26.01777581022511,61.115797631296893,61.115539879987899],"thrust_n":[-1.7307169784167573,-10.458388239907478,-8.4576265147029481,48.653909002622235,48.688309252675865],"torque_nm":[0.032450943345314204,0.19609477949826523,0.15858049715068032,-0.91226079379916691,-0.91290579848767262],"angle_rad":[-612.54184680459207,612.20434098007274,-396.21057514749413,1405.1001163664757,1405.1004882867026]},"command":[-0.11347236913351229,-0.27264864576793524,-0.24891765131658627,0.58242669167620931,0.58242669167620931],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,-4.3368086899420177e-19],"servo_effort":[-0.12109913904893321,-1.4175069844585777,-0.26841838713109961,-0.00013765814017112666,-0.00066962976882907357,0.00028351221025335046]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":493,"step":3944,"t":19.719999999999999,"sim_time":19.720000000000361,"vehicle":{"origin_ned":[1.5783625392470682,1.0725313546281769,3.4875215459099183],"origin_quat_xyzw":[-0.023449609109750556,0.048529616119765778,0.42121284491396649,0.90535889649980839],"cg_ned":[1.5254346370259655,1.0093358536453232,3.1944329972540273],"linear_velocity_ned":[-0.019837929350174765,-0.011995439379454392,-0.033650444374557276],"angular_velocity_ned":[-0.0010781974385178127,0.00052920416078076384,-0.010536916658747343]},"sensors":{"Odom":[1.5783625392470682,1.0725313546281769,3.4875215459099183,-0.017852683772752991,0.0067192682723068694,-0.035865817542615308,-0.023449609109750566,0.048529616119765799,0.42121284491396666,0.90535889649980839,0.00084595473709511769,0.0011822592092995785,-0.010505037038412291],"Pressure":[26751.347443546427],"DVL":[-0.040672782055138544,-0.027418604376899792,0.016203523885588295,7.403130050888679,-0.039236095675646461,-0.015369900241504244,0.026614182473638351,0],"IMU":[-0.0015872497376867229,0.10783687311780152,0.8708309764109442,0.036200360820138326,0.016213074426510349,-0.15248970522375005,1.0457951239901695,0.02007867288602317,-9.7609305180868038],"FOG":[0.88247757147211148],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-11.85034371065009,-28.63154938515363,-26.054179784989376,61.276123811843426,61.276123811843426],"omega_rad_s":[-11.710029313428022,-28.993907014850741,-25.93378861368279,61.243153765169424,61.24289872822218],"thrust_n":[-1.7127105357583547,-10.458082227979521,-8.404018182615987,48.836298526051678,48.87181753322033],"torque_nm":[0.032113322545469156,0.196089041774616,0.15757534092404971,-0.91568059736346885,-0.91634657874788117],"angle_rad":[-613.01129392016867,611.04456643154765,-397.24936465616099,1407.5476597248291,1407.5480213956573]},"command":[-0.11286041629190563,-0.27268142271574886,-0.2481350455713274,0.58358213154136596,0.58358213154136596],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,1.0778494253810979e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,-1.7347234759768071e-18,0,0,0],"servo_effort":[-0.12239246889309455,-1.4207671225937757,-0.26911876914534383,-0.00014137651196326041,-0.00067085068954817124,0.00021622684834472682]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":494,"step":3952,"t":19.760000000000002,"sim_time":19.760000000000353,"vehicle":{"origin_ned":[1.5776052020158966,1.0720437033284904,3.486186399322599],"origin_quat_xyzw":[-0.023453108314878287,0.048554229271493103,0.42101898776216851,0.90544765197881028],"cg_ned":[1.5246433337877399,1.008858560196696,3.1931017533030319],"linear_velocity_ned":[-0.019739306716794001,-0.011883129593244009,-0.032992797653226463],"angular_velocity_ned":[-0.0010158699436634401,0.00065045613371287182,-0.010764426475511173]},"sensors":{"Odom":[1.5776052020158966,1.0720437033284904,3.486186399322599,-0.017767203047620129,0.0066484034806176132,-0.035198655123505194,-0.023453108314878294,0.048554229271493117,0.42101898776216862,0.90544765197881028,0.001002560190916139,0.0012130583501591906,-0.010716871034668127],"Pressure":[26739.403246811806],"DVL":[-0.046265991320068311,-0.012102490826040415,0.050398825420956091,7.4245820277444112,-0.010603329178309605,-0.017475415954853475,-0.030866707115975795,0],"IMU":[-0.0015958977865565729,0.10788418918036759,0.87040344023494365,-0.0046078886552276899,-0.042400904858442272,-0.071591863752577409,1.0484003232147379,0.016940212926476884,-9.7473334798479225],"FOG":[0.86835966469474901],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-11.784624045234791,-28.633480878631865,-25.973632488103402,61.395356185457366,61.395356185457366],"omega_rad_s":[-11.648479054319717,-28.991757544687314,-25.851512903976431,61.368291036228797,61.368038839122896],"thrust_n":[-1.6946001758126783,-10.456753883779795,-8.3516906157183399,49.015422458549892,49.051970957263642],"torque_nm":[0.031773753296487725,0.19606413532087114,0.15659419904471886,-0.91903917109781053,-0.91972445544869341],"angle_rad":[-613.47829196775479,609.88485331910749,-398.28483376582074,1410.0002467298345,1410.000598262679]},"command":[-0.11223451471652182,-0.27269981789173203,-0.24736792845812763,0.58471767795673679,0.58471767795673679],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.12362339667013503,-1.4240352792000885,-0.26983053395301115,-0.00014502842299827763,-0.00067206321117127478,0.00021713292347191047]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":495,"step":3960,"t":19.800000000000001,"sim_time":19.800000000000345,"vehicle":{"origin_ned":[1.5768537771554187,1.071559334817479,3.4848775642066738],"origin_quat_xyzw":[-0.023454281531832148,0.048580559409799697,0.42082115842621132,0.90553817067315157],"cg_ned":[1.52385599955868,1.0083857625517432,3.1917969151214614],"linear_velocity_ned":[-0.019639613471667473,-0.01177067407666782,-0.0323307571926362],"angular_velocity_ned":[-0.00095489854971458009,0.00076545554971762261,-0.010986768248504895]},"sensors":{"Odom":[1.5768537771554187,1.071559334817479,3.4848775642066738,-0.017682360272776119,0.0065786446554687173,-0.034526948284959287,-0.023454281531832159,0.048580559409799724,0.42082115842621159,0.90553817067315157,0.0011529849165366937,0.0012409147816329319,-0.010924174397736412],"Pressure":[26724.711874757202],"DVL":[0.0049639143174615291,-0.041306770695323874,0.026353553275515865,7.3814945220377108,-0.025820105727969171,-0.014152518837064894,0.0042590684062902709,0],"IMU":[-0.0015993472117833455,0.10793265510557688,0.86996747921980899,-0.053305232933969555,-0.099748556237836544,0.073144563106417412,1.0757769371989785,0.040732281640360649,-9.7434478262554283],"FOG":[0.87373373812963429],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-11.717091720988028,-28.633902547758208,-25.894696457372604,61.512503668803717,61.512503668803717],"omega_rad_s":[-11.585852193587558,-28.988176449621879,-25.770930345031886,61.491212185343478,61.490962947938421],"thrust_n":[-1.6762778015440596,-10.454401016079172,-8.3006207643530932,49.191275063978672,49.228765563456456],"torque_nm":[0.03143020877895112,0.1960200190514845,0.1556366393316205,-0.9223364074496001,-0.92303935431480888],"angle_rad":[-613.94280441112755,608.72525887456834,-399.31705051723549,1412.4577886846005,1412.4581301957703]},"command":[-0.11159134972369551,-0.27270383378817342,-0.24661615673688195,0.58583336827432109,0.58583336827432109],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.12479177341829339,-1.4273306385565692,-0.27055588805924541,-0.00014855750621999738,-0.00067324230866561542,0.00021808089095182016]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":496,"step":3968,"t":19.84,"sim_time":19.840000000000337,"vehicle":{"origin_ned":[1.5761082177486956,1.0710782814675373,3.4835952186035444],"origin_quat_xyzw":[-0.023453215740106458,0.048608500102244608,0.42061944514468286,0.90563041178807435],"cg_ned":[1.5230726770773286,1.0079174658409069,3.1905186512592896],"linear_velocity_ned":[-0.019538856886554431,-0.011658108284044875,-0.031664647720419443],"angular_velocity_ned":[-0.00089556201911451512,0.00087383787692387957,-0.011203910367866797]},"sensors":{"Odom":[1.5761082177486956,1.0710782814675373,3.4835952186035444,-0.017598164530119947,0.0065101385062486389,-0.033851017167452882,-0.023453215740106465,0.048608500102244628,0.42061944514468302,0.90563041178807435,0.0012967719321858721,0.0012658014783581684,-0.011126965474454463],"Pressure":[26712.02345775412],"DVL":[-0.015141068405949806,-0.016289192470769324,0.030836173971471287,7.4783957955342304,0.019413099241377019,0.015570444520379702,0.013872358661904978,0],"IMU":[-0.0015978373080122346,0.1079821547456687,0.86952327551602715,0.068154942441852551,0.0028191196800942458,-0.1662474033663168,1.0576300965194081,0.026851361117768861,-9.7296861025268448],"FOG":[0.87422706124380012],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-11.647403043129394,-28.632831680774196,-25.817368354912229,61.627544508340485,61.627544508340485],"omega_rad_s":[-11.521774745471188,-28.983165981237644,-25.69202573920531,61.611915312629307,61.611669150235066],"thrust_n":[-1.6576397863862538,-10.451025520748709,-8.2507887081284128,49.363843235108028,49.402186919101965],"torque_nm":[0.031080745994742261,0.19595672851403836,0.15470228827740773,-0.92557206065827557,-0.92629100473316195],"angle_rad":[-614.40477964295701,607.56584033196657,-400.34608227398968,1414.9201969286723,1414.9205285391613]},"command":[-0.11092764802980376,-0.27269363505499233,-0.24587969861821171,0.5869289953175284,0.5869289953175284],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.12590451437708688,-1.4306637795378199,-0.27129685086510469,-0.00015200452389110337,-0.00067444212987087494,0.00021907070337279905]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":497,"step":3976,"t":19.879999999999999,"sim_time":19.880000000000329,"vehicle":{"origin_ned":[1.5753684720234067,1.0706005767572793,3.4823395258434306],"origin_quat_xyzw":[-0.023450006175249845,0.048637942427923644,0.42041393619319606,0.90572433445353662],"cg_ned":[1.5222934076457577,1.0074536724296195,3.1892671157698129],"linear_velocity_ned":[-0.019437093934680221,-0.011545526005693673,-0.03099485892559176],"angular_velocity_ned":[-0.00083821672249714623,0.00097537641489515818,-0.01141583168069458]},"sensors":{"Odom":[1.5753684720234067,1.0706005767572793,3.4823395258434306,-0.017514649298266176,0.006443015002779647,-0.033171262141159057,-0.023450006175249855,0.048637942427923672,0.42041393619319622,0.90572433445353662,0.0014335203423113849,0.0012878389959451516,-0.011325266863754695],"Pressure":[26699.594662596955],"DVL":[-0.011151580758846018,0.010196339989918155,-0.0023101104804501837,7.4553323075078746,-0.045150689979348554,-0.022523394200579531,-0.0053264206911649214,0],"IMU":[-0.0015916244151640967,0.10803257430517527,0.86907101047598867,0.018794480014128506,0.061313389981854226,-0.139967065504669,1.0625494010955792,0.026472289386498992,-9.7219287628474795],"FOG":[0.86676670213321561],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-11.57522685974206,-28.630282842668393,-25.741638729643878,61.74046824250631,61.74046824250631],"omega_rad_s":[-11.455880426054913,-28.976733326109429,-25.614786633333981,61.730393884130983,61.730150908100512],"thrust_n":[-1.6385872789320091,-10.446632167989231,-8.2021758736313473,49.53310692548483,49.572217525327382],"torque_nm":[0.030723511479975169,0.19587435314979806,0.15379079763058776,-0.92874575485284072,-0.92947907859988865],"angle_rad":[-614.86415126130896,606.40665470183365,-401.37199587444286,1417.3873825817366,1417.3877044170665]},"command":[-0.11024025580706723,-0.27266936040636564,-0.24515846409184644,0.58800445945244106,0.58800445945244106],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.12697159711568742,-1.4339952821693203,-0.27204786433198613,-0.0001553231308823245,-0.00067560963650346666,0.00022010574292242278]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":498,"step":3984,"t":19.920000000000002,"sim_time":19.920000000000321,"vehicle":{"origin_ned":[1.5746344834179129,1.0701262543714454,3.4811106331009514],"origin_quat_xyzw":[-0.023444756050564144,0.04866877679596119,0.42020471971363293,0.90581989772211424],"cg_ned":[1.5215182301300454,1.0069943807259811,3.1880424470112816],"linear_velocity_ned":[-0.019334386262604725,-0.011433027313916112,-0.0303217820952567],"angular_velocity_ned":[-0.0007832028659606041,0.0010698926971414609,-0.01162251987051466]},"sensors":{"Odom":[1.5746344834179129,1.0701262543714454,3.4811106331009514,-0.017431849598351253,0.006377388679886224,-0.032488086956137988,-0.023444756050564151,0.048668776795961211,0.4202047197136331,0.90581989772211424,0.0015628770758259354,0.0013071660940626798,-0.011519104882825941],"Pressure":[26688.686279818266],"DVL":[-0.025154204781594882,0.0021427619720119535,0.020663864146108664,7.3504463081439644,0.010764883614184905,-0.0031965532751445881,0.01676898784122972,0],"IMU":[-0.0015809798889710044,0.1080838053758017,0.86861086444684577,0.041996592935885417,-0.094286354664683603,0.033210124079057893,1.0551703793239975,0.016763576001017477,-9.7593113806748413],"FOG":[0.87791575111463216],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-11.50024849448068,-28.626258836198382,-25.667490522614532,61.851282587713072,61.851282587713072],"omega_rad_s":[-11.387814019814062,-28.968884243629091,-25.539198721830537,61.846646373022928,61.846406689207349],"thrust_n":[-1.6190272650226496,-10.44122458559357,-8.1547626147731389,49.699054309877361,49.738849231195417],"torque_nm":[0.030356761219174681,0.19577296097987948,0.15290179902699638,-0.93185726831020044,-0.93260342308491428],"angle_rad":[-615.32083845983618,605.24775873552471,-402.39485761703622,1419.8592566140587,1419.8595688040862]},"command":[-0.10952617613791124,-0.27263103653522269,-0.24445229069156699,0.58905983416869589,0.58905983416869589],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,-1.7347234759768071e-18,0],"servo_effort":[-0.12798348877873567,-1.4373292993971463,-0.2728085527984217,-0.00015856517175538292,-0.00066316906551446388,0.00022165746427132952]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":499,"step":3992,"t":19.960000000000001,"sim_time":19.960000000000313,"vehicle":{"origin_ned":[1.5739061910542067,1.0696553478377935,3.479908671543257],"origin_quat_xyzw":[-0.023437575755305272,0.048700893445184398,0.41999188361708589,0.90591706061654853],"cg_ned":[1.5207471809454589,1.0065395851269179,3.1868447678074001],"linear_velocity_ned":[-0.019230794720880372,-0.011320712778056061,-0.029645802897706387],"angular_velocity_ned":[-0.00073083452027565923,0.0011572451906936751,-0.011823969140643167]},"sensors":{"Odom":[1.5739061910542067,1.0696553478377935,3.479908671543257,-0.017349799330613529,0.0063133588637316971,-0.031801889983071319,-0.023437575755305275,0.048700893445184405,0.419991883617086,0.90591706061654853,0.0016845344249285061,0.0013239248920917436,-0.011708507523062997],"Pressure":[26676.307104749176],"DVL":[-0.012620509693223519,0.0038505458870080069,0.0037492394895535484,7.3813399909787822,0.0030699431879211425,0.014877318041513311,0.0089574188323201399,0],"IMU":[-0.001566188231002748,0.1081357451362526,0.86814301664954219,0.070761537416426712,0.086957015544096378,-0.03583095197327759,1.063329439911411,0.025160985416552893,-9.7362671751426006],"FOG":[0.85940025769778272],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-11.422168803529791,-28.620760319708726,-25.594907086052409,61.959996195292874,61.959996195292874],"omega_rad_s":[-11.317233158916606,-28.959622560693212,-25.465246375238944,61.960675397285101,61.960439104813496],"thrust_n":[-1.5988731655853368,-10.43480512812525,-8.1085287635458414,49.861680430088178,49.902080897568588],"torque_nm":[0.029978871854725069,0.19565259615234845,0.15203491431648453,-0.93490650806415343,-0.93566401682941103],"angle_rad":[-615.77474651256,604.08920899760085,-403.4147331958481,1422.3357300323387,1422.3360327110067]},"command":[-0.10878256003361707,-0.27257866971151168,-0.24376101986716581,0.59009520185993214,0.59009520185993214],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.12894287846116481,-1.4406653557624831,-0.2735787343455971,-0.0001616528964673885,-0.00067792440033288327,0.00022229551020371891]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":500,"step":4000,"t":20,"sim_time":20.000000000000306,"vehicle":{"origin_ned":[1.5731835301859869,1.069187890207538,3.4787337565934386],"origin_quat_xyzw":[-0.023428582084024138,0.0487341828634364,0.419775515539897,0.90601578215579603],"cg_ned":[1.5199802940737321,1.0060892760066595,3.1856741857135074],"linear_velocity_ned":[-0.019126380132331637,-0.011208682796445178,-0.028967300185831553],"angular_velocity_ned":[-0.0006813980122549509,0.0012373272363850624,-0.012020178583263147]},"sensors":{"Odom":[1.5731835301859869,1.069187890207538,3.4787337565934386,-0.017268532147923264,0.0062510108483962963,-0.031113062911213494,-0.023428582084024145,0.04873418286343642,0.41977551553989717,0.90601578215579603,0.0017982293288710308,0.0013382583783584383,-0.011893502886369724],"Pressure":[26664.144060536899],"DVL":[-0.031158175084574108,-0.020626471156816512,0.019618915893580492,7.37079387279939,-0.012365264289152003,-0.054586193108075352,-0.029420206359531926,0],"IMU":[-0.001547545337857688,0.10818829643466366,0.86766764516674633,0.02795928890968109,0.0081364234166270977,-0.16247623158249172,1.0627519142820296,0.014353469772838037,-9.7225460535041837],"FOG":[0.88403807291861491],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-11.340702016808969,-28.613787438694523,-25.52387015511032,62.066618056809901,62.066618056809901],"omega_rad_s":[-11.243809099445862,-28.948950514132406,-25.392912721726134,62.072486548007021,62.072253738430753],"thrust_n":[-1.5780451456517663,-10.427375133464409,-8.0634536802747139,50.02098535543098,50.061916508403336],"torque_nm":[0.029588346480970622,0.19551328375245769,0.15118975650515087,-0.93789347541433088,-0.93866093453256272],"angle_rad":[-616.22576731011043,602.93106193652955,-404.43168765215165,1424.8167140185772,1424.8170073236254]},"command":[-0.10800668587437112,-0.27251226132090023,-0.24308447766771732,0.59111064816009429,0.59111064816009429],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.12985226703323821,-1.444002945608162,-0.27435795963431081,-0.00016465004813320623,-0.00067906433257432924,0.00022344842159732558]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":501,"step":4008,"t":20.039999999999999,"sim_time":20.040000000000298,"vehicle":{"origin_ned":[1.572466432670274,1.0687239137165592,3.4775859881906745],"origin_quat_xyzw":[-0.023417897363726001,0.048768536216580428,0.41955570279210502,0.90611602138632164],"cg_ned":[1.5192176010724316,1.0056434397399632,3.1845307932741371],"linear_velocity_ned":[-0.019021203177972887,-0.011097037042542271,-0.028286646381534573],"angular_velocity_ned":[-0.00063514906850641332,0.0013100713099042653,-0.012211153681783913]},"sensors":{"Odom":[1.572466432670274,1.0687239137165592,3.4775859881906745,-0.01718808074158857,0.0061904144229606665,-0.03042199112725081,-0.023417897363726001,0.048768536216580435,0.41955570279210508,0.90611602138632164,0.0019037485958913378,0.0013503110609630166,-0.012074120122753723],"Pressure":[26650.973833839325],"DVL":[-0.05242483939416509,0.0080532778866159171,0.074260298837339547,7.4584046458449649,-0.0082840802901045056,-0.0020974634996376177,0.0071738256269610447,0],"IMU":[-0.0015253565574767621,0.10824136780500092,0.86718492692372962,-0.1042602252444083,-0.048666247064885225,0.060988179616813958,1.0678914037270284,0.01113318324258135,-9.7230587572000431],"FOG":[0.87252113664388042],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-11.255578441873297,-28.605339615046301,-25.454360025996621,62.171157662437622,62.171157662437622],"omega_rad_s":[-11.167227429855387,-28.936868981423132,-25.322179522283122,62.182087555313103,62.181858312041776],"thrust_n":[-1.556470410717401,-10.418935097852602,-8.019516186838791,50.176972892217513,50.218363872320431],"torque_nm":[0.029183820200951272,0.19535503308473631,0.15036592850322736,-0.94081824172907846,-0.94159432260600828],"angle_rad":[-616.67377991568981,601.77337394340975,-405.44578532111842,1427.3021200288406,1427.3024041014887]},"command":[-0.10719598516069806,-0.27243180585758381,-0.24242247643806306,0.59210626345178685,0.59210626345178685],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,1.0778494253810979e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,-1.7347234759768071e-18,0,-1.7347234759768071e-18,-4.3368086899420177e-19],"servo_effort":[-0.13071472214924484,-1.4473418004814302,-0.27514628578496991,-0.00016751941944001181,-0.00066646324499039825,0.00030326417523489959]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":502,"step":4016,"t":20.080000000000002,"sim_time":20.08000000000029,"vehicle":{"origin_ned":[1.5717548274040327,1.0682634494606758,3.4764654510792523],"origin_quat_xyzw":[-0.023405648615707816,0.04880384577412903,0.41933253228907419,0.90621773741996758],"cg_ned":[1.5184591310585054,1.005202058723949,3.1834146683118072],"linear_velocity_ned":[-0.018915325111294141,-0.010985874767133507,-0.027604205944179352],"angular_velocity_ned":[-0.00059231525896466877,0.0013754461637807954,-0.012396905723500539]},"sensors":{"Odom":[1.5717548274040327,1.0682634494606758,3.4764654510792523,-0.017108477682751339,0.0061316252550572192,-0.02972905228739724,-0.023405648615707837,0.048803845774129072,0.41933253228907452,0.90621773741996758,0.0020009250930239481,0.0013602290666549785,-0.012250389246516056],"Pressure":[26640.554913446529],"DVL":[-0.038652119445718655,-0.0020444120558926896,0.048039513408111752,7.4494906695357752,-0.02415509223450972,-0.019089560404306184,-0.030710388350191076,0],"IMU":[-0.0014999348139668129,0.10829487350927929,0.86669503763011235,-0.0016515521174976021,0.059438486824278346,-0.049558169506753784,1.0571635655751879,0.018137368661290974,-9.7313675112532536],"FOG":[0.86423693547224856],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-11.166542314916667,-28.595414437197473,-25.38635621924686,62.273624789414065,62.273624789414065],"omega_rad_s":[-11.087188617885177,-28.923377424021304,-25.253027359664635,62.289487706121818,62.289262104045079],"thrust_n":[-1.5340834646828099,-10.409484624537468,-7.9766946825767553,50.329649629911813,50.371433676931652],"torque_nm":[0.028764064962802687,0.19517783671007757,0.14956302529831417,-0.94368093056084656,-0.94446438144246858],"angle_rad":[-617.11865115623959,600.6162014061216,-406.45708978163123,1429.791859865376,1429.7921348499899]},"command":[-0.10634802204682539,-0.27233728035426163,-0.24177482113568438,0.59308214085156252,0.59308214085156252],"arm":{"servo_position":[3.6462121401337282e-23,3.2526065174565154e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,8.6736173798840355e-19,0,0,0,0],"servo_effort":[-0.13153346643829225,-1.4506814291943277,-0.27594318997615347,-0.00017025058023681307,-0.0006813028565526881,0.00022586825320830683]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":503,"step":4024,"t":20.120000000000001,"sim_time":20.120000000000282,"vehicle":{"origin_ned":[1.5710486407676532,1.0678065270537607,3.4753722151074489],"origin_quat_xyzw":[-0.023391966704017775,0.048840005323952308,0.41910609048888975,0.90632088946950395],"cg_ned":[1.5177049107023051,1.0047651113929197,3.182325874223606],"linear_velocity_ned":[-0.018808806948920103,-0.010875294862878948,-0.026920336599531639],"angular_velocity_ned":[-0.00055309335659930125,0.0014334563629189018,-0.012577452087093995]},"sensors":{"Odom":[1.5710486407676532,1.0678065270537607,3.4753722151074489,-0.017029755507242523,0.0060746837084770643,-0.029034617392599774,-0.023391966704017785,0.048840005323952329,0.41910609048888997,0.90632088946950395,0.0020896391164330289,0.0013681579095136045,-0.01242234127314012],"Pressure":[26630.487532767242],"DVL":[0.0062064313527042218,0.0037141594925960242,0.035188120368941922,7.395572549662675,-0.018493380909117924,-0.00095203325451145187,-0.012101580391104099,0],"IMU":[-0.0014715987170641404,0.10834873355158343,0.8661981517355819,-0.078312033842638878,0.040956925663884841,0.081473522464599046,1.0634739313773676,-0.013371763856598809,-9.7548902404692193],"FOG":[0.87285700799052368],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-11.073353611648814,-28.58400792156521,-25.319837078111707,62.374029296277364,62.374029296277364],"omega_rad_s":[-11.003408334808626,-28.908473833896707,-25.185435596593749,62.394697334364118,62.39447543960496],"thrust_n":[-1.5108263087950733,-10.399022395195672,-7.9349671257862848,50.47902417552789,50.521138669003776],"torque_nm":[0.028327993289907625,0.19498166990991889,0.14878063360849286,-0.94648170329114811,-0.94727135004382079],"angle_rad":[-617.56023622146699,599.45960076705455,-407.46566380772009,1432.2858457265461,1432.2861117702903]},"command":[-0.10546051058713156,-0.27222864687204962,-0.24114130550582577,0.59403837425026063,0.59403837425026063],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.13231114428489441,-1.4540214821128803,-0.2767485050644089,-0.0001728796146256218,-0.00068241508690609844,0.00022713228056449818]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":504,"step":4032,"t":20.16,"sim_time":20.160000000000274,"vehicle":{"origin_ned":[1.5703477970545834,1.0673531743012175,3.4743063355349482],"origin_quat_xyzw":[-0.023376985473470002,0.048876910569799502,0.41887646334899042,0.9064254368758452],"cg_ned":[1.5169549642170088,1.0043325722573893,3.1812644602835958],"linear_velocity_ned":[-0.018701710672217788,-0.010765394695281056,-0.026235388024120562],"angular_velocity_ned":[-0.000517648983454662,0.0014841435331233435,-0.012752815407203997]},"sensors":{"Odom":[1.5703477970545834,1.0673531743012175,3.4743063355349482,-0.016951946578775249,0.0060196161439424493,-0.028339049512633867,-0.023376985473470006,0.048876910569799509,0.41887646334899048,0.9064254368758452,0.0021698194704098924,0.0013742431163997024,-0.012590007252978902],"Pressure":[26621.421494468228],"DVL":[-0.037476433799397663,-0.0056150151322486939,0.041552230677117712,7.299398987463622,-0.0081982690944876809,0.0043244502507419616,-0.01899845912129227,0],"IMU":[-0.0014406706651859723,0.10840287365517981,0.86569444242863924,0.026414227258352914,-0.069914768741955569,0.028629483402007792,1.0540254452432272,-0.010529026065861393,-9.7072110453320377],"FOG":[0.87075261070247068],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-10.975787440997674,-28.571115287378664,-25.254778972561219,62.472381107568729,62.472381107568729],"omega_rad_s":[-10.915617952714632,-28.892154821081803,-25.119382204300265,62.497727531462154,62.497509401249232],"thrust_n":[-1.4866486770761624,-10.38754624220106,-7.8943109241983827,50.625106662082352,50.667493164380801],"torque_nm":[0.027874662695178045,0.19476649204126989,0.14801832982871971,-0.94922074991404426,-0.95001549683213982],"angle_rad":[-617.99837928648776,598.30362858148192,-408.47156931693394,1434.7839902424189,1434.7842474949034]},"command":[-0.1045313089618826,-0.2721058598797968,-0.24052170450058305,0.59497505816732121,0.59497505816732121],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.13305084041826612,-1.4573621646607529,-0.27756224551450642,-0.00017537663937774531,-0.00068351499400061573,0.00022843241612777998]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":505,"step":4040,"t":20.199999999999999,"sim_time":20.200000000000266,"vehicle":{"origin_ned":[1.5696522188706408,1.0669034168717597,3.4732678533515284],"origin_quat_xyzw":[-0.023360840873624451,0.048914459520368304,0.41864373625982426,0.90653133914604511],"cg_ned":[1.5162093133167469,1.0039044119540792,3.1802304619548729],"linear_velocity_ned":[-0.018594098696710058,-0.010656270766021936,-0.025549701374951529],"angular_velocity_ned":[-0.00048611798739391706,0.0015275841728326037,-0.012923024422933509]},"sensors":{"Odom":[1.5696522188706408,1.0669034168717597,3.4732678533515284,-0.016875083408966301,0.0059664346813567996,-0.027642703337511208,-0.023360840873624472,0.048914459520368346,0.41864373625982465,0.90653133914604511,0.0022414410097718425,0.0013786299507180778,-0.012753419384509737],"Pressure":[26609.606697597694],"DVL":[-0.0078490089694295204,-0.010687486149031776,0.026621396204680549,7.4108261446814083,0.0062297468503568964,0.0091998102063464565,-0.023593108905528411,0],"IMU":[-0.0014074749331303409,0.10845722521567275,0.86518408158602422,0.038042776200727872,0.0480107167774695,-0.18039877802309104,1.0583883017440598,0.015593017336659321,-9.7267578764826741],"FOG":[0.84078135823043543],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-10.873633155752069,-28.556729371980925,-25.191156863255387,62.568690316802375,62.568690316802375],"omega_rad_s":[-10.823564361420875,-28.874415460495744,-25.054843684739939,62.598589899987296,62.598375582618068],"thrust_n":[-1.4615080858612168,-10.37505303348069,-7.8547028891761519,50.767908350946207,50.810512631852838],"torque_nm":[0.02740327660989782,0.19453224437776293,0.14727567917205289,-0.95189828158024148,-0.95269711184724093],"angle_rad":[-618.4329141353661,597.14834157382188,-409.47486731203742,1437.2862064986648,1437.2864551115877]},"command":[-0.10355841100716257,-0.27196885116172309,-0.23991577965005129,0.59589228873145117,0.59589228873145117],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.13375547490818379,-1.4607031628407103,-0.27838397041647339,-0.00017774715980122088,-0.00068463116466670551,0.00022976597046338643]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":506,"step":4048,"t":20.240000000000002,"sim_time":20.240000000000258,"vehicle":{"origin_ned":[1.5689618275481176,1.0664572779888373,3.4722567956214578],"origin_quat_xyzw":[-0.023343670134839463,0.048952552856377701,0.41840799398768702,0.90663855598616527],"cg_ned":[1.5154679772160737,1.0034805972929559,3.1792239012283559],"linear_velocity_ned":[-0.018486034151747075,-0.010548018017265853,-0.024863610743199288],"angular_velocity_ned":[-0.00045860492096567898,0.0015638877434831912,-0.013088114420634766]},"sensors":{"Odom":[1.5689618275481176,1.0664572779888373,3.4722567956214578,-0.016799198870523641,0.0059151378967115791,-0.026945926481373998,-0.023343670134839466,0.048952552856377715,0.41840799398768708,0.90663855598616527,0.0023045242199397865,0.0013814611075487074,-0.012912611500522265],"Pressure":[26598.970343276334],"DVL":[-0.012492415929837512,-0.01783281956491397,0.036831577748699156,7.3688927043988217,-0.013496555146117145,0.023733156345941454,0.03006890190568242,0],"IMU":[-0.0013723358724390176,0.10851172526128532,0.86466723973766513,0.074247374693264714,0.020103487647748813,0.041124101140296965,1.0742561968063922,0.016229396832776855,-9.7048819290159685],"FOG":[0.86256372125404346],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-10.766695531215822,-28.540842107951878,-25.128944407365978,62.662966445994122,62.662966445994122],"omega_rad_s":[-10.727010174395273,-28.855249348259861,-24.991795099912625,62.697296224321924,62.697085759177291],"thrust_n":[-1.4353699829866999,-10.361538727515107,-7.816119264035791,50.907441127766369,50.950213147404241],"torque_nm":[0.026913187181000629,0.19427885114090829,0.14655223620067109,-0.95451452114561941,-0.95531649651382955],"angle_rad":[-618.86366478572893,595.9937966995991,-410.47561782275272,1439.7924080498015,1439.7926481765917]},"command":[-0.10253995744015068,-0.27181754388525597,-0.23932328007015216,0.59679015662851542,0.59679015662851542],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.13442831573788411,-1.4640439108601899,-0.27921325182238094,-0.00018001067336473372,-0.0006857147946722228,0.00023113318692092227]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":507,"step":4056,"t":20.280000000000001,"sim_time":20.28000000000025,"vehicle":{"origin_ned":[1.5682765434005415,1.0660147780312459,3.4712731758020339],"origin_quat_xyzw":[-0.023325610844627059,0.048991094091325703,0.41816932062183804,0.90674704734514033],"cg_ned":[1.5147309725561144,1.0030610913182618,3.1782447868984929],"linear_velocity_ned":[-0.018377582020635219,-0.010440729790392664,-0.02417744312815848],"angular_velocity_ned":[-0.0004351615273587786,0.0015931767365822203,-0.013248125273273653]},"sensors":{"Odom":[1.5682765434005415,1.0660147780312459,3.4712731758020339,-0.016724335714243907,0.0058657121668727677,-0.02624905806498495,-0.02332561084462707,0.048991094091325731,0.41816932062183826,0.90674704734514033,0.0023591338162746592,0.0013828474990705308,-0.013067617279230977],"Pressure":[26589.513948648186],"DVL":[-0.083519670857084449,0.0085976549168171081,0.01094830193351236,7.369348758849112,0.020283663377489228,-0.0027816574076068947,-0.015937060107286155,0],"IMU":[-0.0013355761037907178,0.10856631595762675,0.8641440860315116,0.0061860457978481914,-0.091248797228423287,-0.047247100440200321,1.0511918716520752,0.015558900449706661,-9.7242001115346888],"FOG":[0.85692558010633491],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-10.654791249605839,-28.523442626625727,-25.068112941026129,62.755219356386426,62.755219356386426],"omega_rad_s":[-10.625733044327811,-28.834648229371581,-24.930209924687279,62.793858485996061,62.793651903705637],"thrust_n":[-1.4082076390339731,-10.346998124648623,-7.7785356400964369,51.043717848255191,51.086611023972189],"torque_nm":[0.026403893231886997,0.19400621483716171,0.14584754325180818,-0.95706970965478488,-0.95787395669947861],"angle_rad":[-619.29044610545759,594.84005121224186,-411.47387984685287,1442.3025089265159,1442.3027407219793]},"command":[-0.10147420237719847,-0.27165183453929265,-0.23874393277167741,0.59766875577510881,0.59766875577510881],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,-8.6736173798840355e-19,0,0,0,-4.3368086899420177e-19],"servo_effort":[-0.13507126339863973,-1.4673967553459974,-0.2800528352813984,-0.00018213749979242914,-0.00068679325147437344,0.00031946391993522189]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":508,"step":4064,"t":20.32,"sim_time":20.320000000000242,"vehicle":{"origin_ned":[1.5675962850580911,1.065575933052755,3.470316994244909],"origin_quat_xyzw":[-0.023306798973174815,0.049029987359029303,0.41792779957232395,0.90685677358987227],"cg_ned":[1.5139983134185424,1.0026458534328873,3.1772931145927887],"linear_velocity_ned":[-0.018268805483300052,-0.010334495452947876,-0.023491529404687309],"angular_velocity_ned":[-0.00041565155624983163,0.0016154701103246343,-0.013403103686953716]},"sensors":{"Odom":[1.5675962850580911,1.065575933052755,3.470316994244909,-0.01665059496277143,0.0058181304262031027,-0.025552430091116022,-0.023306798973174819,0.04902998735902931,0.41792779957232401,0.90685677358987227,0.0024053782127987605,0.0013826898540617444,-0.013218472784617187],"Pressure":[26578.238004991861],"DVL":[-0.0061981836291124422,0.0086624987234458963,0.027349055895218671,7.4072429217373976,-0.0014174759109202839,0.024797779790826924,0.014106078636311553,0],"IMU":[-0.001297514787586866,0.10862093891793625,0.8636147881802827,-0.13062600652489403,-0.055725795408693615,-0.12777866513413474,1.0851379145478541,-0.00097180309837535846,-9.7411830397581287],"FOG":[0.85895146092098418],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-10.537749151921567,-28.504494851581196,-25.008606347640086,62.845458573106114,62.845458573106114],"omega_rad_s":[-10.519524860413119,-28.812596847897964,-24.870054146244279,62.888288669929288,62.888085994588181],"thrust_n":[-1.3800020172086713,-10.331421360698293,-7.7419234552622473,51.176754549404336,51.21971975445139],"torque_nm":[0.025875037822662591,0.19371415051309304,0.14516106478616711,-0.95956414780133126,-0.96036974539596376],"angle_rad":[-619.71306439360808,593.6871628222774,-412.4697111849481,1444.8164236389759,1444.8166472589821]},"command":[-0.10035951573258635,-0.27147137953886852,-0.23817720331085795,0.59852817688672488,0.59852817688672488],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.13568796385272391,-1.4708003175885229,-0.28091061269267265,-0.00018414943539752632,-0.00068792227778441883,0.00023398423255221036]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":509,"step":4072,"t":20.359999999999999,"sim_time":20.360000000000234,"vehicle":{"origin_ned":[1.5669209698483839,1.065140754518545,3.469388238518452],"origin_quat_xyzw":[-0.023287368092394546,0.049069137823181432,0.41768351352309419,0.9069676955281385],"cg_ned":[1.5132700112848392,1.0022348394568972,3.1763688670996215],"linear_velocity_ned":[-0.018159771261221414,-0.010229404841272211,-0.022806180708411495],"angular_velocity_ned":[-0.00040005862693961514,0.001630945779020425,-0.01355310059908423]},"sensors":{"Odom":[1.5669209698483839,1.065140754518545,3.469388238518452,-0.016578023776401052,0.0057723535626441657,-0.024856365124501432,-0.023287368092394546,0.049069137823181432,0.41768351352309419,0.9069676955281385,0.0024434091080004234,0.0013810833810806553,-0.013365213335874371],"Pressure":[26569.337566261045],"DVL":[-0.03621995133524479,-0.0077241385312142082,0.028650744078916844,7.4563106544936693,-0.0087815926604246537,0.030636727811873286,0.033385931981370853,0],"IMU":[-0.0012584658582857726,0.1086755352870161,0.86307951245306325,0.079869277995208807,0.020087790435351655,0.10230313132468204,1.0562022463486362,0.0084277028296305713,-9.6969628221499704],"FOG":[0.87571561586459712],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-10.415412408479664,-28.483954151297368,-24.950358139562073,62.933693595840388,62.933693595840388],"omega_rad_s":[-10.40819204264041,-28.789067969743822,-24.811280640006341,62.980598758127094,62.980400010344241],"thrust_n":[-1.3507419192818313,-10.314789893153979,-7.7062461259297521,51.306565478352965,51.349555317070774],"torque_nm":[0.025326410986534341,0.19340231049663709,0.14449211486118282,-0.96199810271911812,-0.96280416219507692],"angle_rad":[-620.1313179567295,592.53519015368056,-413.46316794678029,1447.3340671770814,1447.334282778384]},"command":[-0.099194403890282515,-0.27127575382187968,-0.23762245847201974,0.59936851043657513,0.59936851043657513],"arm":{"servo_position":[3.6462121401337282e-23,3.2526065174565154e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,8.6736173798840355e-19,0,0,0,0],"servo_effort":[-0.13628072318744813,-1.474204445372264,-0.28177614451402333,-0.00018601286621190369,-0.00068905076775295732,0.00023546439626479339]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":510,"step":4080,"t":20.400000000000002,"sim_time":20.400000000000226,"vehicle":{"origin_ned":[1.5662505151783577,1.0647092502948763,3.4684868836215115],"origin_quat_xyzw":[-0.023267449815947687,0.049108454632899291,0.41743654429465421,0.90707977430321307],"cg_ned":[1.512546074936729,1.0018280016669945,3.1754720150558549],"linear_velocity_ned":[-0.018050547335168098,-0.010125545304638491,-0.022121696718205082],"angular_velocity_ned":[-0.00038837692961479824,0.0016398447594587941,-0.013698174693510071]},"sensors":{"Odom":[1.5662505151783577,1.0647092502948763,3.4684868836215115,-0.016506654337639235,0.0057283309105312513,-0.024161176910823316,-0.02326744981594769,0.049108454632899305,0.41743654429465432,0.90707977430321307,0.0024734197358166139,0.0013781725031855633,-0.0135078774339434],"Pressure":[26562.09708509831],"DVL":[-0.0013196202911773675,0.0016983509996709863,0.014048330075939506,7.4475583400904553,0.017406326707166509,-0.016853446000286942,0.0085124532687859931,0],"IMU":[-0.0012187363525982806,0.10873005148363774,0.86253842360163557,0.047174575678430114,0.031685960202142614,-0.18947875691757796,1.0612887908588975,0.029774589534328832,-9.7271981078295298],"FOG":[0.86538165528650879],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-10.287635154518455,-28.461803633958816,-24.893334725686092,63.019932979734385,63.019932979734385],"omega_rad_s":[-10.291554729782961,-28.764035960183158,-24.753844489612174,63.070800430455364,63.070605626091563],"thrust_n":[-1.3204238265655206,-10.297086467929258,-7.6714688030534823,51.433163378375355,51.476134804980418],"torque_nm":[0.024757946748103509,0.1930703712736736,0.14384004005725282,-0.96437181334453803,-0.96517752759338316],"angle_rad":[-620.54499767246534,591.38419289645049,-414.45430438972767,1449.8553550036961,1449.8555627437734]},"command":[-0.097977477662080523,-0.27106479651389348,-0.23707937833986753,0.60018983790223224,0.60018983790223224],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.13685271354565598,-1.477608557743489,-0.28264899706468327,-0.00018776257571901476,-0.0006901856227636364,0.00023697569629085429]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":511,"step":4088,"t":20.440000000000001,"sim_time":20.440000000000218,"vehicle":{"origin_ned":[1.5655848390548015,1.0642814246775114,3.4676128926951804],"origin_quat_xyzw":[-0.023247173120778272,0.049147851337967868,0.41718697276467814,0.90719297142680566],"cg_ned":[1.5118265105741824,1.0014252890968816,3.174602517673994],"linear_velocity_ned":[-0.017941191739236473,-0.010022988768693019,-0.021438344010437364],"angular_velocity_ned":[-0.00038056822858708895,0.0016424296562371266,-0.013838390417605578]},"sensors":{"Odom":[1.5655848390548015,1.0642814246775114,3.4676128926951804,-0.01643650709992503,0.0056860013563781314,-0.023467144012017958,-0.02324717312077829,0.049147851337967903,0.41718697276467848,0.90719297142680566,0.0024956410114508301,0.0013740912859806225,-0.013646505258934686],"Pressure":[26550.712024477838],"DVL":[-0.037985212641412774,-0.014745201492238817,0.016357892394404935,7.2776087908818266,-0.0074075069444578413,-0.045795441105886604,-0.0089581815652143588,0],"IMU":[-0.0011786248378796264,0.10878443938779091,0.86199168477500054,-0.013288518579589147,0.032700380027281949,0.039231989196705647,1.0527304446933012,0.011917198832426847,-9.7262981206507622],"FOG":[0.86207865162663988],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-10.154281273874586,-28.438025157057293,-24.837503094803232,63.104183814349639,63.104183814349639],"omega_rad_s":[-10.169445891578446,-28.737476932546134,-24.697703892973408,63.158904799555309,63.158713948494423],"thrust_n":[-1.2890517189353854,-10.278295488548377,-7.6375591207622211,51.556559838821471,51.599473926276573],"torque_nm":[0.02416971973003848,0.19271804041028207,0.14320423351429165,-0.96668549697790251,-0.96749013611768575],"angle_rad":[-620.95388751994108,590.23423172477715,-415.44317304741651,1452.3802030382665,1452.3804030750982]},"command":[-0.096707440703567488,-0.27083833482911707,-0.23654764852193555,0.60099222680332987,0.60099222680332987],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,-8.6736173798840355e-19,0,0,-1.7347234759768071e-18,0],"servo_effort":[-0.13740647440323692,-1.481023089265969,-0.28352971967450685,-0.00018940272247936895,-0.00067718965665154122,0.00023900918671262013]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":512,"step":4096,"t":20.48,"sim_time":20.48000000000021,"vehicle":{"origin_ned":[1.5649238607400426,1.063857278645038,3.4667662189144841],"origin_quat_xyzw":[-0.023226663346339757,0.049187245425584246,0.41693487874568985,0.90730724888681225],"cg_ned":[1.5111113224520456,1.0010266484563768,3.1737603244954204],"linear_velocity_ned":[-0.017831753447511537,-0.0099217910246441575,-0.02075636147087713],"angular_velocity_ned":[-0.00037652652637578602,0.0016389511414287394,-0.01397382440847709]},"sensors":{"Odom":[1.5649238607400426,1.063857278645038,3.4667662189144841,-0.016367604893332787,0.0056452947030999588,-0.022774512719502524,-0.023226663346339767,0.049187245425584267,0.41693487874569002,0.90730724888681225,0.0025103398263445782,0.0013689148878851718,-0.013781145368001894],"Pressure":[26543.498451533134],"DVL":[-0.021673010415427074,-0.0073647100468049679,-0.01365757767673734,7.4314912506715753,-0.0014422906940302583,0.025088788422493558,0.011247390005405953,0],"IMU":[-0.0011384199972098272,0.10883865466290338,0.86143945728615534,0.032304916745649309,0.071118860649879059,0.039234730940749217,1.0574803139885647,0.0075902734706862676,-9.7489522155266819],"FOG":[0.84796875296388219],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-10.015222727230046,-28.412607228480692,-24.782844280341234,63.186433298489717,63.186433298489717],"omega_rad_s":[-10.041710097105746,-28.709370158590886,-24.642822870244807,63.24491737748702,63.244730483472068],"thrust_n":[-1.2566368010024918,-10.258404164479035,-7.6044889862854541,51.676757496039677,51.719577733396875],"torque_nm":[0.023561940018796721,0.19234507808398191,0.14258416849285227,-0.96893920305074399,-0.96974208250119143],"angle_rad":[-621.35776506569118,589.08536819753533,-416.42982490443524,1454.9085275350735,1454.9087200268948]},"command":[-0.095383073592667109,-0.27059625931886372,-0.23602708838420222,0.60177555522371162,0.60177555522371162],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-6.7722931110941484e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,-1.0842021724855044e-19,0,0],"servo_effort":[-0.13794583397502239,-1.4844550738762357,-0.2844200379086172,-0.00019089732731506962,-0.00069248342781526686,0.00024008120720481551]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":513,"step":4104,"t":20.52,"sim_time":20.520000000000202,"vehicle":{"origin_ned":[1.56426749980267,1.0634368096515097,3.4659468045638326],"origin_quat_xyzw":[-0.023206042976930404,0.049226558016617336,0.41668034181283325,0.90742256876381999],"cg_ned":[1.5104005123810127,1.0006320234998221,3.1729453744755602],"linear_velocity_ned":[-0.017722298115682659,-0.0098220370067613368,-0.020076025204003856],"angular_velocity_ned":[-0.00037626761968600429,0.0016295979471971482,-0.014104439353998055]},"sensors":{"Odom":[1.56426749980267,1.0634368096515097,3.4659468045638326,-0.016299983295443542,0.0056061796267855542,-0.022083572691959961,-0.023206042976930425,0.049226558016617385,0.41668034181283364,0.90742256876381999,0.0025176449877637713,0.0013627707327748676,-0.013911746688580223],"Pressure":[26534.918967413578],"DVL":[-0.048623676366613883,0.0016232114421033139,-0.0146658265821605,7.4068484970381743,-0.0052799492801514783,0.020424653681921284,-0.0015208772599438691,0],"IMU":[-0.0010984022167848039,0.10889265686317523,0.86088190235455764,0.022181156735921824,0.015972464944008249,0.011608756302298406,1.0594147652131334,0.00043265954878662048,-9.7493759955071315],"FOG":[0.86923603110140391],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-9.8703044049664754,-28.385536514096998,-24.729306566807285,63.26668326737753,63.26668326737753],"omega_rad_s":[-9.9081957059331867,-28.679695712210478,-24.589163580711368,63.328841207195794,63.328658268134902],"thrust_n":[-1.2231956614614223,-10.237400414138259,-7.5722289064467798,51.793755966509394,51.83644947347625],"torque_nm":[0.022934918652401676,0.19195125776509236,0.14197929199587714,-0.97113292437205112,-0.97193342762767965],"angle_rad":[-621.75640181005554,587.93766469763443,-417.41430951718337,1457.440244885225,1457.4404299902908]},"command":[-0.09400289909491881,-0.27033844299139997,-0.23551720539816462,0.60253984064169075,0.60253984064169075],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.13841293656298234,-1.48788701921502,-0.28531686478950341,-0.00019225008574823394,-0.00069366984520773708,0.00024167548359599314]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":514,"step":4112,"t":20.559999999999999,"sim_time":20.560000000000194,"vehicle":{"origin_ned":[1.5636156756399102,1.0630200118928324,3.465154580650919],"origin_quat_xyzw":[-0.023185432610506776,0.049265714073298703,0.41642344210254817,0.90753889282993117],"cg_ned":[1.5096940794702074,1.0002413546447524,3.1721575956973931],"linear_velocity_ned":[-0.017612897059355613,-0.009723806840961375,-0.019397603947159194],"angular_velocity_ned":[-0.00037973258632337855,0.0016146484731108313,-0.014230263258556003]},"sensors":{"Odom":[1.5636156756399102,1.0630200118928324,3.465154580650919,-0.016233677820804225,0.005568591389028512,-0.021394606583883091,-0.023185432610506779,0.049265714073298716,0.41642344210254822,0.90753889282993117,0.0025178082050630883,0.0013557882734100751,-0.014038310401784278],"Pressure":[26526.546373698944],"DVL":[-0.022060341691051425,-0.0089132689251893646,0.016176161872569223,7.43069105122935,-0.01237969357894287,-0.00086815233252830336,-0.023575964313352075,0],"IMU":[-0.00105884508763757,0.10894641062555721,0.86031918281435593,-0.088819487808092512,-0.044676034762948291,-0.019468237967892474,1.0748359686531006,0.0012876873914459894,-9.7438568353579491],"FOG":[0.83876666695393476],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-9.7192836152474076,-28.356839380447564,-24.67679182367586,63.344940913916801,63.344940913916801],"omega_rad_s":[-9.7687216442812996,-28.64844774116586,-24.536668141287858,63.41068133608313,63.410502343511304],"thrust_n":[-1.1887421608389668,-10.215282459222298,-7.5407372849385643,51.907558248615643,51.950096156006111],"torque_nm":[0.022288915515730628,0.19153654611041812,0.14138882409259812,-0.97326671716154312,-0.97406430292511459],"angle_rad":[-622.1495625184001,586.79118408377519,-418.39667446656358,1459.9752716492073,1459.9754495255472]},"command":[-0.092564605859499119,-0.27006513695664347,-0.23501706498738914,0.6032851515611124,0.6032851515611124],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.13886278337982594,-1.4913196574730683,-0.28621985670493871,-0.0001935069119787277,-0.00069485138970851287,0.00024329588647714566]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":515,"step":4120,"t":20.600000000000001,"sim_time":20.600000000000186,"vehicle":{"origin_ned":[1.5629683088568229,1.0626068750759836,3.4643894672478641],"origin_quat_xyzw":[-0.023164947847461134,0.049304643729965819,0.41616425864037554,0.90765618332504738],"cg_ned":[1.508992019829245,0.999854579253315,3.1713969056989186],"linear_velocity_ned":[-0.017503626801533282,-0.0096271750344411357,-0.018721357117979034],"angular_velocity_ned":[-0.00038678387575183913,0.0015944664020386972,-0.014351393186952834]},"sensors":{"Odom":[1.5629683088568229,1.0626068750759836,3.4643894672478641,-0.016168724977187649,0.0055324317656527096,-0.020707887772568233,-0.023164947847461145,0.04930464372996584,0.41616425864037571,0.90765618332504738,0.0025112037295219342,0.0013480934051800563,-0.014160893731683508],"Pressure":[26519.633357002171],"DVL":[-0.010622445894356531,-0.032927574393187116,0.049324071988258167,7.4885383576151945,-0.00749567477075745,0.0037862660798195914,0.00766046514784848,0],"IMU":[-0.0010200088180856246,0.10899988549577731,0.85975145978279444,0.027815572700561383,-0.0044043608023828958,-0.12282975017625442,1.0692089878346085,0.013964614418579347,-9.7718031749799561],"FOG":[0.85405901769200876],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-9.5620359031436948,-28.326485999326998,-24.625259695698507,63.421213182348922,63.421213182348922],"omega_rad_s":[-9.6231171169117093,-28.615615526280447,-24.485279838392849,63.490444119182591,63.490269057972775],"thrust_n":[-1.1532978022668678,-10.192044996361123,-7.5099738596688619,52.018169673364469,52.060527010167078],"torque_nm":[0.021624333792503777,0.19110084368177108,0.14081200986879117,-0.97534068137558372,-0.97613488144063276],"angle_rad":[-622.53700485544209,585.64598951561618,-419.3769649954728,1462.51352462114,1462.5136954262953]},"command":[-0.091067008601368529,-0.26977605713644759,-0.23452628281617627,0.60401155411760876,0.60401155411760876],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.13930327528020739,-1.4947525134753221,-0.28712860283908825,-0.00019465481981749061,-0.00069605306233809538,0.00024494008431530796]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":516,"step":4128,"t":20.640000000000001,"sim_time":20.640000000000178,"vehicle":{"origin_ned":[1.5623253216510098,1.0621973840814101,3.4636513738573287],"origin_quat_xyzw":[-0.023144698335336004,0.049343282677497623,0.41590286899170109,0.90777440311899449],"cg_ned":[1.5082943264708057,0.99947163175310083,3.1706632118338409],"linear_velocity_ned":[-0.017394565521430667,-0.0095322139644290933,-0.018047535740490422],"angular_velocity_ned":[-0.00039726403177469229,0.0015694346103678413,-0.014467931448793188]},"sensors":{"Odom":[1.5623253216510098,1.0621973840814101,3.4636513738573287,-0.016105162055174333,0.0054975952617262744,-0.020023681388305577,-0.023144698335336014,0.049343282677497644,0.41590286899170126,0.90777440311899449,0.0024982335542331783,0.0013398100206140349,-0.014279556097137859],"Pressure":[26511.872430109554],"DVL":[-0.033954654443948643,0.032144348421027091,0.0042664652118023193,7.4186367793957881,-0.020617522780741679,-0.025162014408714108,-0.0027212855071165865,0],"IMU":[-0.00098213821608457582,0.10905305584393636,0.859178892001627,0.028211736282890771,-0.038000730706911616,-0.15195671116222997,1.0671526565195066,0.00039531910225562052,-9.725819840496909],"FOG":[0.84997698830943691],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-9.3984470617690263,-28.294439402277494,-24.57467368911615,63.495506295855087,63.495506295855087],"omega_rad_s":[-9.4712291939306859,-28.58117924279178,-24.434947891249056,63.56813653459988,63.567965382851249],"thrust_n":[-1.1168936852180347,-10.167676379659456,-7.47990243181897,52.125596768228355,52.167752424822325],"torque_nm":[0.020941756597838149,0.1906439321186148,0.14024817059660569,-0.97735493940428197,-0.97814535796541857],"angle_rad":[-622.91848007549697,584.50214479451904,-420.35522421965214,1465.0549208647458,1465.0550847555]},"command":[-0.089509019635895484,-0.26947085145026184,-0.23404451132491572,0.60471910757957226,0.60471910757957226],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,8.656676720938947e-21,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,1.7347234759768071e-18,0],"servo_effort":[-0.13973607426094212,-1.4981850391305072,-0.28804278457058663,-0.00019563119063184276,-0.00069727005744502806,0.00024660723243848467]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":517,"step":4136,"t":20.68,"sim_time":20.68000000000017,"vehicle":{"origin_ned":[1.5616866379545555,1.0617915188343607,3.4629401997782101],"origin_quat_xyzw":[-0.023124787286894963,0.049381572322467031,0.41563934918496392,0.9078935157478526],"cg_ned":[1.5076009892404469,0.99909244374189077,3.1699564116312549],"linear_velocity_ned":[-0.017285793291076771,-0.0094389931484139614,-0.017376381131191266],"angular_velocity_ned":[-0.00041099700279267415,0.0015399527372473585,-0.014579987269517276]},"sensors":{"Odom":[1.5616866379545555,1.0617915188343607,3.4629401997782101,-0.016043027064372037,0.0054639704589328425,-0.019342242941569832,-0.023124787286894974,0.049381572322467052,0.41563934918496415,0.9078935157478526,0.0024793249179613239,0.0013310594878029785,-0.014394361060486565],"Pressure":[26504.79016470908],"DVL":[-0.0029260222132750716,-0.026169547508813146,-0.02294571535371713,7.480796514253627,-0.026746197220871692,0.0084673257695846663,0.0087609893613384525,0],"IMU":[-0.00094546169185444557,0.10910590076930785,0.85860163572423176,-0.0016878639180502126,-0.033017294791484887,0.041453016477223423,1.0588293081918083,0.014511627673660932,-9.7497891276268902],"FOG":[0.87825630162850976],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-9.2284006580523474,-28.260659272720854,-24.524996650310143,63.567825889075834,63.567825889075834],"omega_rad_s":[-9.3129168290306819,-28.545111780664634,-24.385625308007267,63.643765795394174,63.643598524436278],"thrust_n":[-1.0795690139903247,-10.142159982154709,-7.4504894931294192,52.229846605372792,52.27178327543357],"torque_nm":[0.020241919012318591,0.19016549966540083,0.1396966779961766,-0.97930962385073994,-0.98009593641437953],"angle_rad":[-623.29373360188868,583.35971468443665,-421.33149331374409,1467.5993777293859,1467.5995348614949]},"command":[-0.087889530076689024,-0.2691491359306748,-0.2335713966696204,0.60540786561024607,0.60540786561024607],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.14016359840384521,-1.5016162826463433,-0.28896168998925098,-0.00019654805395788021,-0.00069849243991669183,0.00024829524364890546]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":518,"step":4144,"t":20.719999999999999,"sim_time":20.720000000000162,"vehicle":{"origin_ned":[1.5610521835521591,1.0613892541793184,3.4622558344895538],"origin_quat_xyzw":[-0.023105311024413832,0.049419459918400147,0.41537377361067751,0.90801348546167759],"cg_ned":[1.5069119947419773,0.99871694409116341,3.1692763931715167],"linear_velocity_ned":[-0.01717739186479186,-0.0093475796207613902,-0.016708125359559525],"angular_velocity_ned":[-0.0004277904480026693,0.0015064330757479634,-0.01468767528581294]},"sensors":{"Odom":[1.5610521835521591,1.0613892541793184,3.4622558344895538,-0.01598235912652532,0.0054314411348377568,-0.018663818754974384,-0.023105311024413846,0.049419459918400181,0.41537377361067773,0.90801348546167759,0.0024549255558768989,0.0013219597745913513,-0.014505375329513369],"Pressure":[26499.589606020367],"DVL":[-0.011949839450017697,-0.0064715945675091107,0.0217750762502101,7.4649503961306465,0.015552625337352391,0.021562862623212532,0.013853292564282565,0],"IMU":[-0.00091019033468350862,0.10915840397886165,0.85801984454527258,-0.02383731727493512,-0.056445726488451607,-0.20612453849186854,1.0610399547106255,0.013465649062670322,-9.7270596554110202],"FOG":[0.8325727629313141],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-9.0517775490339698,-28.225100185554009,-24.476192014357522,63.638176763781196,63.638176763781196],"omega_rad_s":[-9.1480461510551034,-28.507379498440987,-24.337267846618364,63.717338963876365,63.717175538363804],"thrust_n":[-1.0413700151395873,-10.115474779739284,-7.4217035488509575,52.330926183601804,52.372630278274556],"torque_nm":[0.019525687783867266,0.18966515212011156,0.13915694154095545,-0.98120486594253375,-0.98198681771764795],"angle_rad":[-623.66250539085172,582.21876518378951,-422.30581163773303,1470.1468128500942,1470.1469633780162]},"command":[-0.086207405228894946,-0.26881047795765722,-0.23310659061292879,0.60607787394077328,0.60607787394077328],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,1.0842021724855044e-19,0,0],"servo_effort":[-0.14058663607837715,-1.5050453642262587,-0.2898846808464815,-0.00019736870075176584,-0.00069973481606027126,0.00025000143685691503]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":519,"step":4152,"t":20.760000000000002,"sim_time":20.760000000000154,"vehicle":{"origin_ned":[1.5604218861754078,1.0609905597958305,3.4615981580442461],"origin_quat_xyzw":[-0.023086358591815674,0.049456898683571525,0.41510621497235678,0.90813427724698093],"cg_ned":[1.5062273262694714,0.99834505905335524,3.1686230354748659],"linear_velocity_ned":[-0.017069444793024423,-0.0092580376646606653,-0.016042990804801635],"angular_velocity_ned":[-0.00044743696835212272,0.0014693010711516346,-0.014791114008549711]},"sensors":{"Odom":[1.5604218861754078,1.0609905597958305,3.4615981580442461,-0.01592319803299632,0.0053998868314044761,-0.017988645576593423,-0.023086358591815685,0.049456898683571546,0.41510621497235695,0.90813427724698093,0.0024255031128318353,0.0013126267607280148,-0.014612667269493097],"Pressure":[26489.875077395041],"DVL":[-0.021553134516236881,-0.026013781813865922,0.017213115486669369,7.4321429111602235,-0.0075788597841527352,0.015646375317835026,-0.036438560015446993,0],"IMU":[-0.00087651711858675342,0.1092105537003823,0.8574336693389607,-0.075009880015548161,0.044446010033640147,-0.036572463149254192,1.0766661811362075,0.014231755832619578,-9.6896480334953612],"FOG":[0.85562836762565997],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-8.868451032275976,-28.187713851263194,-24.428221954598257,63.706562676348852,63.706562676348852],"omega_rad_s":[-8.976485820820816,-28.467943174576373,-24.289832849930384,63.788862668912252,63.788703046972238],"thrust_n":[-1.0023489657758227,-10.087596085480321,-7.3935143681143733,52.428841926844207,52.470303527515092],"torque_nm":[0.018794043108296674,0.18914242660275601,0.13862839440214453,-0.9830407861283289,-0.98381819114090807],"angle_rad":[-624.02453011124021,581.07936376679243,-423.27821682106833,1472.6971441352957,1472.6972882119271]},"command":[-0.084461438402628347,-0.26845441763107802,-0.2326497329009358,0.60672916834617951,0.60672916834617951],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.14100554854155839,-1.5084712490125338,-0.29081120457060095,-0.00019805625453520872,-0.00070098702330098747,0.00025172446653881831]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":520,"step":4160,"t":20.800000000000001,"sim_time":20.800000000000146,"vehicle":{"origin_ned":[1.5597956755543436,1.0605954001491782,3.4609670414592268],"origin_quat_xyzw":[-0.023068011438646615,0.049493847892527983,0.41483674421695294,0.90825585685782184],"cg_ned":[1.5055469637267997,0.99797671237416241,3.1679962088877844],"linear_velocity_ned":[-0.016962037688256919,-0.0091704286771931293,-0.015381189908310697],"angular_velocity_ned":[-0.00046971756285005013,0.0014289909582108045,-0.01489042679581248]},"sensors":{"Odom":[1.5597956755543436,1.0605954001491782,3.4609670414592268,-0.015865584430844272,0.0053691847538206673,-0.01731695033192223,-0.023068011438646611,0.049493847892527976,0.41483674421695288,0.90825585685782184,0.0023915397252283173,0.0013031740530662457,-0.014716308471862711],"Pressure":[26484.60599008682],"DVL":[-0.0021931929471604716,0.0159718209424007,0.027292790577371825,7.4894503781212869,0.0013990543816655232,0.019678877342354215,0.0096029615857886469,0],"IMU":[-0.00084461626362261372,0.10926234260979077,0.85684325814434603,-0.06635306666969705,0.038754111027907399,0.033006370004109123,1.0609057759369853,0.010485736642999635,-9.7539977214042786],"FOG":[0.83624487493268806],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-8.6782815479607116,-28.148447882734551,-24.381048582818156,63.772986461684624,63.772986461684624],"omega_rad_s":[-8.7981024783258679,-28.426758561868795,-24.243278602291593,63.858342911524431,63.858187044926979],"thrust_n":[-0.96256335589967745,-10.058495983652032,-7.3658925730111751,52.523599355118833,52.564812162351899],"torque_nm":[0.018048062923118956,0.18859679969347562,0.13811048574395957,-0.98481748790847845,-0.98559022804409835],"angle_rad":[-624.37953714588014,579.94157959180075,-424.24874480910927,1475.2502897447105,1475.2504275211297]},"command":[-0.082650300456768674,-0.26808045602604336,-0.23220046269350625,0.60736177582556783,0.60736177582556783],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.14142135938290856,-1.5118927799244357,-0.29174045187975561,-0.00019866747666381302,-0.00070225663471731317,0.0002534613453504684]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":521,"step":4168,"t":20.84,"sim_time":20.840000000000138,"vehicle":{"origin_ned":[1.5591734834562407,1.0602037344542425,3.4603623471206943],"origin_quat_xyzw":[-0.023050343146261521,0.049530272935098762,0.41456543046065597,0.90837819084937588],"cg_ned":[1.5048708835622109,0.99761182540414794,3.1673957754825115],"linear_velocity_ned":[-0.016855257519660816,-0.0090848113020387603,-0.014722925107300845],"angular_velocity_ned":[-0.00049440274548924728,0.0013859448396757112,-0.014985741518041733]},"sensors":{"Odom":[1.5591734834562407,1.0602037344542425,3.4603623471206943,-0.015809559417496708,0.0053392096615944027,-0.016648950032671667,-0.023050343146261532,0.049530272935098783,0.41456543046065619,0.90837819084937588,0.0023535305690329661,0.0012937132692148901,-0.014816373573064883],"Pressure":[26477.844890029301],"DVL":[-0.012240271486592205,-0.029649243943583266,0.021812633752367389,7.4337641725683596,0.01589292476808412,-0.014624649293380195,0.03018219177922276,0],"IMU":[-0.0008146427020747142,0.10931376773633175,0.85624875603437856,-0.017253965963160586,-0.060533078443119441,0.010443456284024518,1.0693026573196909,0.0053905763914613566,-9.7451560331156681],"FOG":[0.85985183721619229],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-8.4811132558647468,-28.107245402621743,-24.334634059229771,63.837449777704457,63.837449777704457],"omega_rad_s":[-8.6127559961285804,-28.383776541336715,-24.197564038020797,63.925784866974617,63.92563270133089],"thrust_n":[-0.92207513737179925,-10.028143489109839,-7.3388094481213297,52.615202744667833,52.656164022253535],"torque_nm":[0.017288908825721237,0.18802769042080947,0.13760267715227492,-0.98653505146252207,-0.98730307541725382],"angle_rad":[-624.72725039951581,578.80548369819667,-425.21742989363179,1477.8061680596636,1477.8062996848807]},"command":[-0.080772507198711874,-0.26768805145354041,-0.23175841961171212,0.6079757121686139,0.6079757121686139],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.14183398894006158,-1.5153081903839216,-0.29267138882866928,-0.00019917420516905811,-0.0007035315001906713,0.00025520920622479262]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":522,"step":4176,"t":20.879999999999999,"sim_time":20.88000000000013,"vehicle":{"origin_ned":[1.5585552437147105,1.0598155166758496,3.4597839292027417],"origin_quat_xyzw":[-0.023033419212683752,0.049566145352799386,0.41429234095439421,0.90850124659285192],"cg_ned":[1.5041990587247711,0.99725031721730195,3.1668215894707061],"linear_velocity_ned":[-0.016749192271737056,-0.0090012411732112822,-0.014068388332074296],"angular_velocity_ned":[-0.00052125504434533945,0.0013406081041696433,-0.015077187377485224]},"sensors":{"Odom":[1.5585552437147105,1.0598155166758496,3.4597839292027417,-0.015755164533213944,0.0053098356069751895,-0.015984851174226069,-0.023033419212683755,0.049566145352799393,0.41429234095439427,0.90850124659285192,0.0023119784483959854,0.0012843529594093633,-0.0149129376467492],"Pressure":[26471.959045852604],"DVL":[-0.026021858398708859,0.024052311135236898,0.017361936577689453,7.3993822656608454,0.00044498888320072339,-0.020578603210333505,-0.0051301977945374302,0],"IMU":[-0.00078673166588245067,0.1093648303771506,0.85565030506614626,0.04129421183421042,0.030023999785415773,-0.1373853322369443,1.0649289536427011,0.0085499813421743807,-9.7414240520865985],"FOG":[0.83290308417873826],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-8.2767692416929926,-28.06404656194114,-24.288939873568292,63.899952927751279,63.899952927751279],"omega_rad_s":[-8.420294986399032,-28.338943542834595,-24.152648446089611,63.991192706618065,63.991044181588087],"thrust_n":[-0.88095017488403249,-9.9965049099009438,-7.312236744853112,52.70365481718769,52.744365316686853],"torque_nm":[0.016517815779075611,0.18743446706064273,0.13710443896599586,-0.98819352782226921,-0.98895684968787856],"angle_rad":[-625.06738792755209,577.67114919344681,-426.18430473353709,1480.3646976461557,1480.3648232668704]},"command":[-0.078826373730409446,-0.26727663392324896,-0.2313232368911266,0.6085709802642979,0.6085709802642979],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,8.656676720938947e-21,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,1.7347234759768071e-18,0],"servo_effort":[-0.14224205184077821,-1.5187163499502589,-0.29360328225585092,-0.00019962990937563951,-0.00070482375623604333,0.00025696521056753786]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":523,"step":4184,"t":20.920000000000002,"sim_time":20.920000000000122,"vehicle":{"origin_ned":[1.5579408922095741,1.059430695560738,3.4592316340840483],"origin_quat_xyzw":[-0.023017296915521727,0.049601442862040872,0.41401754104878868,0.90862499228923965],"cg_ned":[1.5035314585983717,0.99689210472275247,3.1662734976185729],"linear_velocity_ned":[-0.016643931827170579,-0.0089197711816402774,-0.01341776127320682],"angular_velocity_ned":[-0.0005500317266055833,0.0012934297929520179,-0.015164896608296541]},"sensors":{"Odom":[1.5579408922095741,1.059430695560738,3.4592316340840483,-0.01570244183730533,0.0052809368034672718,-0.015324850200681459,-0.023017296915521738,0.049601442862040886,0.41401754104878885,0.90862499228923965,0.002267392485869095,0.0012752009342345768,-0.01500607805398347],"Pressure":[26466.036916055429],"DVL":[-0.042635732020556386,0.016863878576802171,-0.005834332149840582,7.4290246618381426,-0.013577624751747253,0.020530547288862531,0.00065181698021819215,0],"IMU":[-0.00076099842773195677,0.10941553605416618,0.85504804422259639,-0.020307717589676273,-0.022852408654691049,-0.015976297969739844,1.0699501109197838,0.011174722447088512,-9.6987929662519026],"FOG":[0.85565261949839899],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-8.0650423689144066,-28.018788117567038,-24.243926750025871,63.960494833552907,63.960494833552907],"omega_rad_s":[-8.220550807406255,-28.292201935869876,-24.108491033386009,64.054569433482342,64.054424482980664],"thrust_n":[-0.83925754406492592,-9.9635441597817973,-7.2861463988826971,52.788956437882064,52.829420385376643],"torque_nm":[0.015736078951217362,0.18681645299590874,0.13661524497905053,-0.98979293321028872,-0.99055163222581211],"angle_rad":[-625.39966135142333,576.5386514207305,-427.14940035766392,1482.9257972106614,1482.9259169710297]},"command":[-0.076809927322994354,-0.26684560111968608,-0.23089454047643687,0.60914756984336105,0.60914756984336105],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.14264463297768301,-1.5221149523221302,-0.29453482456860325,-0.00019999598003383188,-0.00070611641507688705,0.00025872583574963683]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":524,"step":4192,"t":20.960000000000001,"sim_time":20.960000000000115,"vehicle":{"origin_ned":[1.5573303668020644,1.0590492146978077,3.4587053007666739],"origin_quat_xyzw":[-0.023002025258435269,0.04963614930610228,0.41374109415158022,0.90874939698814972],"cg_ned":[1.5028680489493749,0.99653710277803831,3.1657513396590282],"linear_velocity_ned":[-0.016539567034423594,-0.0088404513974278294,-0.012771215070659198],"angular_velocity_ned":[-0.00058048721251966178,0.0012448556805403396,-0.015249003111355601]},"sensors":{"Odom":[1.5573303668020644,1.0590492146978077,3.4587053007666739,-0.015651434114468718,0.0052523891573043897,-0.014669132980790938,-0.023002025258435276,0.049636149306102294,0.41374109415158034,0.90874939698814972,0.002220281209937891,0.0012663615690217248,-0.015095873829782325],"Pressure":[26459.10044633715],"DVL":[-0.026290309713638296,-0.00013921247978893828,0.035717642412619863,7.3730052239936192,-0.01942030163474533,0.022955977660257011,0.0021461929398663084,0],"IMU":[-0.00073753825522933391,0.10946589441161136,0.85444210932455977,0.043988826999466497,0.011314805552655077,-0.065497066212077487,1.068239845374932,-0.025620896456960571,-9.7268041329819681],"FOG":[0.8625251972915231],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-7.8456852223550388,-27.97140258875821,-24.199555162742538,64.019073013885219,64.019073013885219],"omega_rad_s":[-8.0133304972988721,-28.243489978027633,-24.065050883261733,64.115916784486885,64.115775336896462],"thrust_n":[-0.79706884459684813,-9.9292227832543052,-7.2605105050615695,52.871106471118857,52.911331470761347],"torque_nm":[0.014945040836190904,0.18617292718601822,0.13613457196990444,-0.99133324633347863,-0.99208746507677525],"angle_rad":[-625.72377501407448,575.4080681218669,-428.11274616058944,1485.4893855512064,1485.4894995926161]},"command":[-0.074720811641476564,-0.26639431036912581,-0.2304719539308813,0.60970545727509728,0.60970545727509728],"arm":{"servo_position":[3.6462121401337282e-23,3.2526065174565154e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,8.6736173798840355e-19,0,0,0,0],"servo_effort":[-0.14304045323333781,-1.5255020523730596,-0.2954648589342907,-0.00020029165544941332,-0.00070740414455991983,0.00026048756460586824]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":525,"step":4200,"t":21,"sim_time":21.000000000000107,"vehicle":{"origin_ned":[1.5567236072847328,1.0586710125991212,3.4582047613129787],"origin_quat_xyzw":[-0.022987644932198688,0.049670254624651397,0.41346306171758856,0.90887443059044781],"cg_ned":[1.5022087918870266,0.99618522430803269,3.1652549487255452],"linear_velocity_ned":[-0.016436189776209063,-0.008763328753313324,-0.012128910033353004],"angular_velocity_ned":[-0.00061237406586234287,0.0011953301584246756,-0.015329640506673181]},"sensors":{"Odom":[1.5567236072847328,1.0586710125991212,3.4582047613129787,-0.015602184141241329,0.0052240705408233418,-0.014017874603698223,-0.022987644932198709,0.049670254624651439,0.4134630617175889,0.90887443059044781,0.0021711531152166404,0.0012579377940492738,-0.015182403660310286],"Pressure":[26456.427494771382],"DVL":[-0.031576514508095378,0.017293609448225559,-0.012597754437664196,7.3908630219466307,0.016150636462690049,0.015905384981684232,-0.0037045218232941188,0],"IMU":[-0.00071642637308504478,0.10951591915846698,0.85383263301494239,-0.051437130954125804,0.082807586282650572,-0.11186706481614793,1.0618045452646112,0.0076138797494600579,-9.709309147702168],"FOG":[0.86697676477694074],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-7.6184033330171532,-27.921819623805206,-24.155784687288754,64.075683279917854,64.075683279917854],"omega_rad_s":[-7.7984090304407392,-28.192742045406131,-24.022286739111824,64.175235072390606,64.175097050778518],"thrust_n":[-0.75445766316943663,-9.893500181702839,-7.2353011731491668,52.950101469008828,52.990098468450867],"torque_nm":[0.014146081184426939,0.18550312840692823,0.1356618969965469,-0.99281440254391573,-0.9935643462834538],"angle_rad":[-626.0394248278219,574.27947959825599,-429.07436989303784,1488.0553815032447,1488.0554899640983]},"command":[-0.072556222219210986,-0.26592209165528768,-0.2300550922598929,0.61024460266588432,0.61024460266588432],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.1434264682676063,-1.5288752143422191,-0.29639207632328146,-0.00020056054476968598,-0.0007086880351173479,0.00026224631840717795]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":526,"step":4208,"t":21.039999999999999,"sim_time":21.040000000000099,"vehicle":{"origin_ned":[1.5561205552936681,1.0582960228253331,3.4577298412797255],"origin_quat_xyzw":[-0.022974188385917086,0.049703754777154642,0.41318350327785558,0.90900006383283549],"cg_ned":[1.5015536458427174,0.99583638041643374,3.1647841517836328],"linear_velocity_ned":[-0.016333892061242271,-0.0086884476975469457,-0.011490995514358612],"angular_velocity_ned":[-0.00064544811264002802,0.0011452910085562572,-0.015406939448043916]},"sensors":{"Odom":[1.5561205552936681,1.0582960228253331,3.4577298412797255,-0.015554734490947835,0.0051958621246483852,-0.013371239257792182,-0.022974188385917096,0.049703754777154663,0.41318350327785575,0.90900006383283549,0.0021205091115043522,0.0012500315259859306,-0.015265744010959658],"Pressure":[26449.921019549744],"DVL":[-0.012421036621339924,-0.042465701421472754,-0.011235758849655466,7.3772269423294441,0.0094531906271908151,0.0057602656412542213,-0.0417939233771773,0],"IMU":[-0.0006977181603225165,0.10956562801882219,0.85321974481630725,-0.030669007578569184,-0.010497105517595667,0.14001947251496163,1.0732191537999047,0.017304010253650807,-9.7045594576168792],"FOG":[0.84984049672191231],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-7.3828386720665797,-27.869966791488075,-24.112573044653697,64.130319758547046,64.130319758547046],"omega_rad_s":[-7.5755194678628754,-28.13988914280295,-23.980156584791875,64.232523064103717,64.232388386427004],"thrust_n":[-0.71149898504411468,-9.8563340409873899,-7.2104902638445383,53.02593545608508,53.065718715821959],"torque_nm":[0.013340605969577151,0.1848062632685136,0.1351966924470851,-0.99423628980159529,-0.99498222592166197],"angle_rad":[-626.34629677558235,573.15296885482019,-430.03429763948867,1490.6237038797658,1490.6238068952732]},"command":[-0.070312749257776946,-0.26542825515702928,-0.22964355280622567,0.61076495008140042,0.61076495008140042],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.14379908131022126,-1.5322315670680149,-0.29731484903739142,-0.00020081878236665802,-0.0007099547403135218,0.00026399743959535277]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":527,"step":4216,"t":21.080000000000002,"sim_time":21.080000000000091,"vehicle":{"origin_ned":[1.5555211541727167,1.0579241741297938,3.4572803601673003],"origin_quat_xyzw":[-0.022961679962168531,0.049736651603588374,0.41290247647229872,0.90912626827279652],"cg_ned":[1.5009025655510775,0.99549048049634281,3.1643387700721388],"linear_velocity_ned":[-0.016232766438099223,-0.00861584966343624,-0.01085760987308592],"angular_velocity_ned":[-0.000679467952839196,0.0010951643276188782,-0.015481029303647455]},"sensors":{"Odom":[1.5555211541727167,1.0579241741297938,3.4572803601673003,-0.015509128549813973,0.0051676500089003962,-0.012729379981922195,-0.022961679962168548,0.049736651603588408,0.41290247647229905,0.90912626827279652,0.0020688392277596634,0.0012427399547925916,-0.015345971183286528],"Pressure":[26446.365909761837],"DVL":[0.0010105557764744678,-0.0084935207804290643,0.0066105968910843242,7.490497225682903,0.021355394148920275,-0.00068599931293535695,-0.035090058274253336,0],"IMU":[-0.00068144951613986499,0.10961504262102484,0.85260357118515095,0.0032904164587787845,-0.038049885622717466,-0.0074216499608672284,1.0979381570143627,0.021591707276058227,-9.6891285183399276],"FOG":[0.83217790411371617],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-7.1385519570347764,-27.815769480932609,-24.069875550152855,64.182974670901288,64.182974670901288],"omega_rad_s":[-7.3443405239327015,-28.084859381955432,-23.938617115158728,64.287777842233268,64.287646421552566],"thrust_n":[-0.66826857937737172,-9.8176807280817027,-7.1860490722904524,53.098599727528615,53.138186692568119],"torque_nm":[0.01253003586332572,0.184081513651532,0.13473842010544598,-0.9955987448911614,-0.99634100048565233],"angle_rad":[-626.64406495977767,572.02862172208279,-430.99255377561173,1493.1942714063823,1493.1943691083607]},"command":[-0.067986209114616919,-0.26491209029459628,-0.22923691000145577,0.61126642543715515,0.61126642543715515],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.14415446531413753,-1.5355681446927534,-0.29823161882896615,-0.00020102537730641584,-0.00071118884061922133,0.00026573670081537061]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":528,"step":4224,"t":21.120000000000001,"sim_time":21.120000000000083,"vehicle":{"origin_ned":[1.5549253488477515,1.0575553906302231,3.4568561318732156],"origin_quat_xyzw":[-0.022950136072492692,0.049768952678729786,0.41262003708077127,0.90925301627378685],"cg_ned":[1.5002555020543982,0.99514743234827596,3.1639186195503877],"linear_velocity_ned":[-0.016132905029899135,-0.0085455732241618582,-0.01022888015749423],"angular_velocity_ned":[-0.0007141972578685688,0.0010453672960436102,-0.0155520354348132]},"sensors":{"Odom":[1.5549253488477515,1.0575553906302231,3.4568561318732156,-0.015465408998024208,0.0051393245324102181,-0.012092438462684169,-0.022950136072492695,0.0497689526787298,0.41262003708077138,0.90925301627378685,0.0020166228941113197,0.0012361590770855208,-0.015423158545238234],"Pressure":[26441.714197525438],"DVL":[-0.01169735159093392,-0.015292030721448269,0.022226216739906452,7.4591372190305991,-0.0097443757777522372,0.0092781618732806857,0.0059750039205167665,0],"IMU":[-0.00066763730493514116,0.10966418840833077,0.85198423555853842,-0.0276450303085603,-0.035883049121373904,0.015496283287960462,1.0533258568836525,0.0014256490189564681,-9.730399110210854],"FOG":[0.84904826409564516],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-6.8850013886980692,-27.759150588897725,-24.027646368194397,64.23363821417432,64.23363821417432],"omega_rad_s":[-7.1044808650898998,-28.027577989353532,-23.897623683263184,64.340994667008815,64.340866411723852],"thrust_n":[-0.62484240819844183,-9.7774953656748487,-7.161948294662734,53.16808256421978,53.207493821077676],"torque_nm":[0.011715795153720787,0.18332803810640347,0.13428653052492631,-0.9969015480791209,-0.99764050914520641],"angle_rad":[-626.93238907517116,570.90652697310531,-431.94916091425199,1495.767002650822,1495.7670951675047]},"command":[-0.065571441797124472,-0.26437286275140692,-0.2288347273161371,0.61174893537308872,0.61174893537308872],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,-8.6736173798840355e-19,0,0,0,0],"servo_effort":[-0.14448845973026173,-1.5388818558810988,-0.29914064403355922,-0.00020123535194819871,-0.00071240313291271568,0.00026745818118385854]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":529,"step":4232,"t":21.16,"sim_time":21.160000000000075,"vehicle":{"origin_ned":[1.5543330856671227,1.0571895919969219,3.4564569651421611],"origin_quat_xyzw":[-0.022939565420639935,0.049800671136618645,0.41233623909868289,0.90938028097084234],"cg_ned":[1.4996124027058988,0.99480714229172706,3.1635235113403581],"linear_velocity_ned":[-0.01603440012377029,-0.0084776541979966341,-0.0096049225269249881],"angular_velocity_ned":[-0.00074940699331075005,0.00099630035212323279,-0.015620078370778509]},"sensors":{"Odom":[1.5543330856671227,1.0571895919969219,3.4564569651421611,-0.015423619299152607,0.0051107829526817108,-0.011460545317291735,-0.022939565420639945,0.049800671136618666,0.41233623909868311,0.90938028097084234,0.0019643215452200846,0.0012303801969013573,-0.015497376519288156],"Pressure":[26437.415917586779],"DVL":[-0.021284277284022123,-0.0020668705946156238,0.045400318073078136,7.5183246482169572,-0.017296316335480719,0.010625655008438624,-0.023598382358386107,0],"IMU":[-0.0006562799079770249,0.10971309453428833,0.85136185849218537,0.034661424661280894,0.049864568084069756,0.05839174866001668,1.0732614662887945,0.0030323138710858302,-9.75915013591964],"FOG":[0.84654966894345096],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-6.6215141912935351,-27.700032120075129,-23.985836382401221,64.282298532983603,64.282298532983603],"omega_rad_s":[-6.8554600042757396,-27.96796794823052,-23.857129786331811,64.392166857147117,64.392041671226679],"thrust_n":[-0.58129624782181122,-9.7357323491346115,-7.1381577144246968,53.23436907307498,53.273628222158173],"torque_nm":[0.010899304646658961,0.18254498154627397,0.13384045714546308,-0.99814442012015592,-0.99888052916546588],"angle_rad":[-627.21091118830543,569.78677642379125,-432.9041398415946,1498.3418159471214,1498.341903402978]},"command":[-0.063062039917081286,-0.26380982971500122,-0.22843653697524974,0.61221236698079617,0.61221236698079617],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,1.0778494253810979e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,-1.7347234759768071e-18,0,0,0],"servo_effort":[-0.14479528657096874,-1.542169335803673,-0.3000400332773297,-0.0002014705121730469,-0.00071356452864750639,0.00026915710387591916]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":530,"step":4240,"t":21.199999999999999,"sim_time":21.200000000000067,"vehicle":{"origin_ned":[1.5537443122169243,1.0568266936758224,3.4560826640373525],"origin_quat_xyzw":[-0.02292996930998804,0.049831825417821635,0.41205113483189221,0.90950803622987331],"cg_ned":[1.4989732112119634,0.99446951528275995,3.1631532521839554],"linear_velocity_ned":[-0.015937341970231278,-0.0084121253654530631,-0.0089858413682466585],"angular_velocity_ned":[-0.00078487701359697903,0.00094834632098157842,-0.015685270937641868]},"sensors":{"Odom":[1.5537443122169243,1.0568266936758224,3.4560826640373525,-0.015383801987012689,0.0050819287939510146,-0.010833819050617172,-0.022929969309988044,0.049831825417821642,0.41205113483189226,0.90950803622987331,0.0019123766202252955,0.0012254905140285581,-0.015568689916645732],"Pressure":[26434.028424960215],"DVL":[-0.024429018886490465,0.014688808300652065,-0.025988983869382705,7.4081102286461409,0.035456653688231178,0.048425087744985024,0.02195423155094017,0],"IMU":[-0.00064735799070519495,0.10976179368620088,0.85073655782690638,-0.10350501709502127,-0.0015845315690509892,0.092527896063543488,1.0795084658247422,0.019928220400364356,-9.7631322170069623],"FOG":[0.86307018244518496],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-6.3472440342987957,-27.638334893893845,-23.944393149222112,64.328941449369879,64.328941449369879],"omega_rad_s":[-6.5966813440993688,-27.905950238424754,-23.81708654576758,64.441285663875121,64.441163447133789],"thrust_n":[-0.53770504775054639,-9.6923456003789479,-7.1146459012610332,53.297440947088809,53.336574466576785],"torque_nm":[0.010081969645322746,0.18173148000710529,0.13339961064864439,-0.99932701775791521,-1.0000607712483149],"angle_rad":[-627.4792515715327,568.66946501834536,-433.85750943053949,1500.9186293155024,1500.9187118310665]},"command":[-0.060449943183798052,-0.26322223708470327,-0.22804183951640106,0.6126565852320941,0.6126565852320941],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,8.656676720938947e-21,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,1.7347234759768071e-18,0],"servo_effort":[-0.14506861174222804,-1.5454267829627109,-0.30092776777855285,-0.00020171658799366486,-0.00071468774873777283,0.00027082674904468554]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":531,"step":4248,"t":21.240000000000002,"sim_time":21.240000000000059,"vehicle":{"origin_ned":[1.5531589762798494,1.0564666078548297,3.455733028411073],"origin_quat_xyzw":[-0.022921343744392805,0.049862438174790545,0.41176477650937826,0.90963625592123265],"cg_ned":[1.4983378678795454,0.99413445486275354,3.1628076448944653],"linear_velocity_ned":[-0.015841804776046763,-0.0083490298279448594,-0.0083717301877123985],"angular_velocity_ned":[-0.00082058885430426429,0.00090164225704784126,-0.015747442467841332]},"sensors":{"Odom":[1.5531589762798494,1.0564666078548297,3.455733028411073,-0.015346001047480871,0.0050527630535113326,-0.01021236662464999,-0.022921343744392808,0.049862438174790552,0.41176477650937832,0.90963625592123265,0.0018608824983268441,0.0012215672811841708,-0.015636916537810023],"Pressure":[26430.042656263799],"DVL":[-0.035496608370698735,0.0092745964904683269,0.0021921780537020215,7.4033389819432518,-0.018622406480226738,-0.021304303628309398,0.0088846073904818596,0],"IMU":[-0.00064083906585190122,0.10981032185359889,0.85010845198227736,0.041818685827989199,-0.015370451931874743,-0.089540582507316627,1.080812195892028,0.0064792526149675877,-9.7292852708458657],"FOG":[0.84802883841424548],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-6.0611177424214269,-27.573980598361352,-23.903259115245088,64.373550401388442,64.373550401388442],"omega_rad_s":[-6.3273975503400166,-27.84144473706791,-23.777441962307325,64.488340108477459,64.488220756886335],"thrust_n":[-0.49414263675102338,-9.6472898470303559,-7.0913792700580798,53.357276266793818,53.396313239303502],"torque_nm":[0.0092651744390816887,0.1808866846318192,0.13296336131358902,-1.0004489300023842,-1.0011808732369407],"angle_rad":[-627.73700329892483,567.55469088887503,-434.80928653075176,1503.4973603755766,1503.4974380672866]},"command":[-0.057724930880204063,-0.26260933903201289,-0.22765008681185797,0.61308143239417567,0.61308143239417567],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-6.7722931110941484e-22,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,-1.0842021724855044e-19,0,0],"servo_effort":[-0.14511054447865046,-1.5486522967884284,-0.30180211661674905,-0.00020199585295842747,-0.00071572725904104956,0.00027246252589569489]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":532,"step":4256,"t":21.280000000000001,"sim_time":21.280000000000051,"vehicle":{"origin_ned":[1.5525770176744493,1.0561092497823574,3.4554078544270865],"origin_quat_xyzw":[-0.022913695058772401,0.049892527729251318,0.4114772294208513,0.90976490805244814],"cg_ned":[1.497706311343469,0.99380186183307528,3.16248648865652],"linear_velocity_ned":[-0.015747816348894383,-0.0082884460139190201,-0.0077626788058137155],"angular_velocity_ned":[-0.00085702373344395157,0.00085556007607815701,-0.015805608608513551]},"sensors":{"Odom":[1.5525770176744493,1.0561092497823574,3.4554078544270865,-0.015310295578087656,0.0050235616346952306,-0.0095962840012892778,-0.022913695058772415,0.049892527729251339,0.41147722942085152,0.90976490805244814,0.0018089450640248368,0.0012185578567119051,-0.015701164629229537],"Pressure":[26426.708605549069],"DVL":[-0.03527448323807604,0.013858470179584026,0.0045713235885834497,7.4355314742860203,0.0020455331150366881,-0.0081484536485042346,-0.017098383618960943,0],"IMU":[-0.00063671159512235156,0.10985871567073736,0.84947768690303682,0.000317212312519946,0.076190701774885058,-0.13522139083282736,1.0747709246465977,0.0013622148275136354,-9.742660204641691],"FOG":[0.86801421481742602],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-5.7606022636003473,-27.507287407840547,-23.861898232477156,64.416106381051733,64.416106381051733],"omega_rad_s":[-6.0463955931545579,-27.774462907424734,-23.738030508404989,64.533316879094315,64.53320028587008],"thrust_n":[-0.45064106483568261,-9.6005874453598103,-7.068254381531057,53.413850885740807,53.452819477967381],"torque_nm":[0.008449519965669049,0.18001101460049646,0.13252976965370733,-1.0015097041076402,-1.0022403652118885],"angle_rad":[-627.98372048483884,566.44255375899934,-435.75948389825146,1506.0779262548303,1506.0779992348939]},"command":[-0.054862878700955686,-0.2619741657889576,-0.22725617364263959,0.6134867274385879,0.6134867274385879],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,1.7347234759768071e-18,0,0,0],"servo_effort":[-0.14478284533226654,-1.5518755792767451,-0.30266788329686167,-0.00020229673876348472,-0.00071670093358593482,0.00027406529892010106]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":533,"step":4264,"t":21.32,"sim_time":21.320000000000043,"vehicle":{"origin_ned":[1.5519983709478153,1.0557545338239107,3.4551069351305008],"origin_quat_xyzw":[-0.022907031675503009,0.049922109291154773,0.41118856567174711,0.9098939577580184],"cg_ned":[1.4970784778679669,0.99347163506403691,3.1621895792135422],"linear_velocity_ned":[-0.01565545718168794,-0.0082304015642376913,-0.0071587682513581646],"angular_velocity_ned":[-0.00089389340655939931,0.0008102736206443775,-0.015859808343288869]},"sensors":{"Odom":[1.5519983709478153,1.0557545338239107,3.4551069351305008,-0.015276777214727604,0.0049942634290157653,-0.0089856557276459803,-0.02290703167550303,0.049922109291154815,0.41118856567174744,0.9098939577580184,0.0017568860189662297,0.0012163607187984419,-0.015761437991712018],"Pressure":[26425.039161521487],"DVL":[-0.036439485664891941,0.031813564649729655,0.014517282913071092,7.466110253934465,-0.0017372116988728628,0.010788470781415149,-0.023799631833934871,0],"IMU":[-0.00063496965135672798,0.10990700780363211,0.84884442303628993,-0.039108722628976737,0.011092191294630283,-0.093270741415551708,1.06434045231743,0.0072372022166146514,-9.7255248841212296],"FOG":[0.84841569275479156],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-5.4429876370087369,-27.438380403091049,-23.819933819740822,64.456588183863019,64.456588183863019],"omega_rad_s":[-5.7518845148229261,-27.70509462641655,-23.698570903672888,64.576200321482958,64.576086380448231],"thrust_n":[-0.40719322567793964,-9.5523135751190882,-7.0451012120606595,53.467137869839732,53.506062941245609],"torque_nm":[0.0076348729814613671,0.17910587953348292,0.13209564772613741,-1.0025088350594951,-1.0032386801483553],"angle_rad":[-628.21889428506563,565.33315050106285,-436.70810436121815,1508.6602434948909,1508.6603118712467]},"command":[-0.051837977495321305,-0.26131790860086712,-0.22685651256896022,0.61387226841774301,0.61387226841774301],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.14439099580893397,-1.5550875876812744,-0.30352181612020501,-0.00020266026021798913,-0.00071758305035940983,0.00027562785045509114]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":534,"step":4272,"t":21.359999999999999,"sim_time":21.360000000000035,"vehicle":{"origin_ned":[1.5514229702525273,1.0554023698017163,3.454830060897955],"origin_quat_xyzw":[-0.022901354809816869,0.04995119975322531,0.41089885754228483,0.91002337028316649],"cg_ned":[1.4964543006273241,0.99314367233732559,3.1619167094083211],"linear_velocity_ned":[-0.015564800147339346,-0.0081749246720390027,-0.0065600651572885896],"angular_velocity_ned":[-0.00093091836603399444,0.00076600967345885553,-0.015910004795505625]},"sensors":{"Odom":[1.5514229702525273,1.0554023698017163,3.454830060897955,-0.015245522126323264,0.0049647972324466183,-0.0083805537350590768,-0.022901354809816882,0.049951199753225345,0.41089885754228511,0.91002337028316649,0.0017050526759810382,0.0012149164225337913,-0.015817661201184316],"Pressure":[26421.525514511944],"DVL":[-0.026012025330860607,-0.011006477980782881,0.052579616103572535,7.3704005060055353,-0.0069182973592415344,-0.012508366873175185,-0.016508875888346746,0],"IMU":[-0.0006355927326790969,0.10995522802871256,0.84820882185855662,0.015575690147919929,-0.020606510146785981,0.00074146307825151067,1.0708168597377319,-0.0023436563056078328,-9.7763968143992219],"FOG":[0.84671280382270975],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-5.1054796778846656,-27.367201608007139,-23.777215582571252,64.494971627432932,64.494971627432932],"omega_rad_s":[-5.4417528021297983,-27.633379548698631,-23.658821928379862,64.6169722513567,64.616860859056047],"thrust_n":[-0.36381482178272673,-9.5025081325578054,-7.0217749298479628,53.517105344109808,53.556009819893227],"torque_nm":[0.0068215279084261268,0.17817202748545885,0.13165827993464932,-1.003445725202059,-1.004175184122998],"angle_rad":[-628.44193721851411,564.22657560693256,-437.65514044816649,1511.2442279542622,1511.2442918306592]},"command":[-0.048623615979853957,-0.26064001531435371,-0.22644967221496429,0.61423782502317081,0.61423782502317081],"arm":{"servo_position":[3.6462121401337282e-23,3.2526065174565154e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,8.6736173798840355e-19,0,0,0,0],"servo_effort":[-0.14388646797432036,-1.558280009857375,-0.30436097172293142,-0.00020308397672091883,-0.00071835819910671657,0.00027714345686176406]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":535,"step":4280,"t":21.400000000000002,"sim_time":21.400000000000027,"vehicle":{"origin_ned":[1.5508507498797126,1.0550526630296537,3.4545770198855315],"origin_quat_xyzw":[-0.02289665811104398,0.04997981814844199,0.41060817682596057,0.91015311126692033],"cg_ned":[1.4958337098386134,0.99281787053329307,3.1616676696775396],"linear_velocity_ned":[-0.015475920706498046,-0.0081220326053607367,-0.0059666244940170376],"angular_velocity_ned":[-0.00096777888337784654,0.00072304504405821266,-0.015956335645771438]},"sensors":{"Odom":[1.5508507498797126,1.0550526630296537,3.4545770198855315,-0.015216600441135205,0.0049350674169749082,-0.0077810379332475532,-0.022896658111043997,0.049979818148442025,0.41060817682596085,0.91015311126692033,0.0016538753408698319,0.0012141692221228331,-0.015869925229826321],"Pressure":[26415.946082618339],"DVL":[0.021202745368936401,-0.0088808496038440682,-0.013828200573406731,7.4353919281180278,0.014095880375143508,-0.026010212277006881,0.012922678545550492,0],"IMU":[-0.00063854480268670335,0.11000340379716279,0.84757104448922427,0.0085685983753373864,0.077422722235649999,0.011625811779781541,1.0804799133500904,0.017616061347625517,-9.7639258036916736],"FOG":[0.83779390304187429],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-4.7442699462994931,-27.293698217117054,-23.733590806547529,64.531229659396871,64.531229659396871],"omega_rad_s":[-5.1133613422465363,-27.559331500431984,-23.618563108466947,64.655611772794728,64.655502829446675],"thrust_n":[-0.32053785747099978,-9.4511928835161036,-6.99814445546094,53.56371678612949,53.602621813689382],"torque_nm":[0.0060100848275812472,0.17720986656592694,0.13121520853989269,-1.004319689739928,-1.0050491590066759],"angle_rad":[-628.65216586537667,563.12292253108888,-438.6005754560457,1513.8297947024764,1513.8298541786057]},"command":[-0.04518352329809041,-0.25993998302016241,-0.22603419815759551,0.61458313961330358,0.61458313961330358],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.14333229126057984,-1.5614462701545122,-0.30518262534367541,-0.00020360219102849789,-0.00071902236621469392,0.00027860481406678193]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":536,"step":4288,"t":21.440000000000001,"sim_time":21.440000000000019,"vehicle":{"origin_ned":[1.5502816449456736,1.0547053141784257,3.4543475984782357],"origin_quat_xyzw":[-0.022892926898550849,0.050007986159496025,0.41031659287991851,0.91028314761161233],"cg_ned":[1.495216632779296,0.99249412598127018,3.1614422485280653],"linear_velocity_ned":[-0.015388889963949931,-0.008071737031570823,-0.0053784893479976465],"angular_velocity_ned":[-0.001004157717148374,0.00068166762213337873,-0.015998962525649706]},"sensors":{"Odom":[1.5502816449456736,1.0547053141784257,3.4543475984782357,-0.015190073786387663,0.0049049745293310524,-0.0071871562446112723,-0.022892926898550853,0.050007986159496039,0.41031659287991856,0.91028314761161233,0.0016037936833964445,0.0012140733693831458,-0.015918344042015482],"Pressure":[26413.9466306838],"DVL":[-0.021329868576921897,0.0023842805688576467,0.0023400583097235826,7.4264744247136862,0.024801883345178251,-0.015763126996622703,0.021567822635906252,0],"IMU":[-0.00064377270311712271,0.11005156056184819,0.84693124750383897,-0.01170310092568483,0.048145850910961331,-0.043339181892529159,1.0730823587409302,0.015881642963327149,-9.70553196679273],"FOG":[0.84696484518946014],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-4.354044362540864,-27.217752559033599,-23.688986172717264,64.565332216749582,64.565332216749582],"omega_rad_s":[-4.763256098283378,-27.482922116319603,-23.577617760176121,64.692095147959876,64.691988557932916],"thrust_n":[-0.27740887159307054,-9.3983605970071906,-6.9741059368638423,53.606930741022275,53.645855987593038],"torque_nm":[0.0052014163423700736,0.17621926119388484,0.13076448631619703,-1.0051299513941676,-1.0058597997673695],"angle_rad":[-628.8487736357614,562.02228514862338,-439.54438486443087,1516.4168579087268,1516.4169130803809]},"command":[-0.041467089167055847,-0.25921669103841521,-0.2256093921211168,0.61490792587380549,0.61490792587380549],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-6.7722931110941484e-22,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,-1.0842021724855044e-19,0,0],"servo_effort":[-0.14272362235557037,-1.5645783745887236,-0.30598380486030247,-0.00020419362757851252,-0.00071955283349041475,0.00028000512636418826]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":537,"step":4296,"t":21.48,"sim_time":21.480000000000011,"vehicle":{"origin_ned":[1.5497155917179528,1.0543602195997663,3.454141581722173],"origin_quat_xyzw":[-0.022890138299145501,0.050035728346005386,0.41002417273067387,0.91041344741499564],"cg_ned":[1.4946029940445436,0.99217233465124488,3.1612402330149072],"linear_velocity_ned":[-0.015303771951006245,-0.008024044805535752,-0.0047956907527784715],"angular_velocity_ned":[-0.0010397497293785994,0.00064217634560040501,-0.016038034017926896]},"sensors":{"Odom":[1.5497155917179528,1.0543602195997663,3.454141581722173,-0.015165991928879555,0.0048744177684928577,-0.0065989446677075696,-0.022890138299145518,0.05003572834600542,0.41002417273067415,0.91041344741499564,0.0015552462975352132,0.0012146002985068782,-0.015963018517424644],"Pressure":[26414.562665847825],"DVL":[-0.027487215819441829,-0.018530487338257344,0.030595236288285869,7.4779856587569409,-0.05293694442500721,0.0051357683804749534,-0.036478691707946181,0],"IMU":[-0.00065120620180776493,0.11009972233527274,0.84628958318225744,0.029194862147326063,-0.025007927366737761,0.039281741088085631,1.0620446523361453,0.0062897077388196689,-9.7796836156518285],"FOG":[0.84370007427469973],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.9268147461199123,-27.139255449934872,-23.643326864372167,64.597246211470377,64.597246211470377],"omega_rad_s":[-4.3866244712054403,-27.40409444327755,-23.535841375723312,64.726395695361063,64.726291367221847],"thrust_n":[-0.23448150226127407,-9.3439850657809576,-6.9495754730518939,53.646700555650938,53.685664716731061],"torque_nm":[0.0043965281673988893,0.17519971998339295,0.13030454011972303,-1.005875635418455,-1.0066062134387075],"angle_rad":[-629.03078658307948,560.92475915825003,-440.48653785077516,1519.0053307258411,1519.0053816850821]},"command":[-0.037398235677332498,-0.25846909952318925,-0.22517454156544922,0.61521186868067024,0.61521186868067024],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.14205607463182213,-1.5676663434982487,-0.30676108653401452,-0.00020492099415714968,-0.0007199306210052543,0.00028133680964934462]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":538,"step":4304,"t":21.52,"sim_time":21.520000000000003,"vehicle":{"origin_ned":[1.5491525269864408,1.0540172704991708,3.4539587538671208],"origin_quat_xyzw":[-0.02288826022708218,0.050063069944662759,0.4097309799244459,0.91054398063006614],"cg_ned":[1.4939927157248394,0.99185239252628354,3.1610614088818556],"linear_velocity_ned":[-0.015220629846726707,-0.0079789467837843714,-0.0042182681009302961],"angular_velocity_ned":[-0.0010740149931797388,0.00060465501546362501,-0.016073887000328451]},"sensors":{"Odom":[1.5491525269864408,1.0540172704991708,3.4539587538671208,-0.015144486879122324,0.0048432920256782043,-0.0060164301459482844,-0.022888260227082197,0.050063069944662801,0.40973097992444624,0.91054398063006614,0.0015086872044380742,0.001215403974349327,-0.016004237416725891],"Pressure":[26411.521907215749],"DVL":[-0.037455482258672061,0.0024018688801128521,-0.026950816918182997,7.3945496838671128,-0.008362407141588658,-0.0076961591813303381,0.016027727137155341,0],"IMU":[-0.000660758081621479,0.11014790686189073,0.84564619686502551,-0.01489564841844076,-0.0739634057257859,0.013536117565141493,1.0724548829615335,0.029429542608606109,-9.7118077335676389],"FOG":[0.84492447939171955],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.4496207000853354,-27.058079539714573,-23.596543031240696,64.62693573310527,64.62693573310527],"omega_rad_s":[-3.9762589068854215,-27.32277032372204,-23.493112127258769,64.758483748739721,64.758381596342659],"thrust_n":[-0.19180490768892111,-9.28802632532493,-6.9244840382377859,53.68297848801209,53.721991200931576],"torque_nm":[0.0035963420191672717,0.17415049359984242,0.12983407571695849,-1.0065558466502267,-1.0072873350174671],"angle_rad":[-629.19698724355601,559.8304429929434,-441.42699834060551,1521.5951251710812,1521.595172006419]},"command":[-0.032853530477003193,-0.25769599561632928,-0.22472898124991139,0.61549462602957405,0.61549462602957405],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,1.0842021724855044e-19,0,0],"servo_effort":[-0.14142328067530135,-1.5708039149668187,-0.30753338888848236,-0.00020576382156697385,-0.00072017812987663205,0.00028261987510114412]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":539,"step":4312,"t":21.559999999999999,"sim_time":21.559999999999995,"vehicle":{"origin_ned":[1.548592385959668,1.0536763501644884,3.4537988990934547],"origin_quat_xyzw":[-0.022887248436141719,0.050090030689608891,0.4094370695483795,0.91067472171141972],"cg_ned":[1.4933857173463447,0.99153419640224927,3.1609055601496916],"linear_velocity_ned":[-0.015139524675072659,-0.0079364202450697453,-0.003646257228278842],"angular_velocity_ned":[-0.0011063532252947679,0.00056910724417232636,-0.016107036418303456]},"sensors":{"Odom":[1.548592385959668,1.0536763501644884,3.4537988990934547,-0.01512570922431085,0.0048114901682155941,-0.0054396297077997594,-0.022887248436141726,0.050090030689608898,0.40943706954837955,0.91067472171141972,0.0014645708094016695,0.0012160409264465881,-0.016042468622518756],"Pressure":[26409.630592435522],"DVL":[-0.031389218519181306,-0.03156615947424285,0.0020304535824075846,7.383662543821651,0.0035483824831128346,0.0061542752500133606,0.012122985068558845,0],"IMU":[-0.00067232444299402218,0.11019611193341172,0.8450012156746195,0.071567114223866524,-0.10205028543508873,0.16366531222187006,1.0744391480866196,0.0064974759644316309,-9.7290225348739678],"FOG":[0.83949363135385424],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-2.898890863458746,-26.97381365193845,-23.548692820046284,64.654363030989742,64.654363030989742],"omega_rad_s":[-3.5202665272325717,-27.238781229773227,-23.449355284592173,64.788326941917191,64.78822689282056],"thrust_n":[-0.14939611550698578,-9.2303831296410159,-6.8987920663156244,53.715715405275219,53.754770817436189],"torque_nm":[0.0028011771657559846,0.17306968368076908,0.12935235124341798,-1.0071696638489105,-1.0079019528269286],"angle_rad":[-629.34577153906184,558.73944004215923,-442.36572633891632,1524.186152012805,1524.1861948095834]},"command":[-0.027608484413892818,-0.25689346335179475,-0.22427326495282174,0.61575583839037851,0.61575583839037851],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,-8.6736173798840355e-19,0,0,0,0],"servo_effort":[-0.14080371363460131,-1.57393139642489,-0.30828724243136946,-0.000206734982195393,-0.00072026420565396464,0.00028383608123778764]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":540,"step":4320,"t":21.600000000000001,"sim_time":21.599999999999987,"vehicle":{"origin_ned":[1.5480351047377303,1.0533373379164848,3.4536618014901057],"origin_quat_xyzw":[-0.022887050950641245,0.050116630964549914,0.40914249235125955,0.91080564729921676],"cg_ned":[1.4927819166096608,0.99121764356512876,3.1607724703313975],"linear_velocity_ned":[-0.015060490293984043,-0.0078964587862895945,-0.0030796580380424553],"angular_velocity_ned":[-0.0011365715784346143,0.00053578916299624091,-0.01613759481911349]},"sensors":{"Odom":[1.5480351047377303,1.0533373379164848,3.4536618014901057,-0.015109665851607047,0.0047789309724429766,-0.0048685478671207112,-0.022887050950641256,0.050116630964549942,0.40914249235125977,0.91080564729921676,0.0014232270236702311,0.0012165405391849717,-0.016077788575596538],"Pressure":[26409.034093238603],"DVL":[-0.049636943775607831,0.019913759053201845,-0.0061343873293180518,7.4534342825117976,-0.027942336271813511,0.0095593106089334953,-0.0019631204244938893,0],"IMU":[-0.00068578720835131709,0.11024433029964947,0.84435475780657776,0.031053875995823099,-0.034474494954964782,0.10562267043185872,1.0903938230208405,0.016119352477828135,-9.7409243831293288],"FOG":[0.85987012918940831],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-2.2216814578214721,-26.886269198927391,-23.499772950101541,64.679486681093252,64.679486681093252],"omega_rad_s":[-2.9955178489285146,-27.151921274683914,-23.40453099063993,64.81588999770365,64.815791993686688],"thrust_n":[-0.10712724718899784,-9.1709313590130677,-6.8724796881229171,53.744849949983781,53.783942048836629],"torque_nm":[0.0020086358847937092,0.17195496298149504,0.12885899415230467,-1.0077159365621959,-1.0084489134156869],"angle_rad":[-629.4748309873579,557.65186169641754,-443.30267984095116,1526.7783206595057,1526.7783595005089]},"command":[-0.021158871026871164,-0.25605970665645134,-0.22380736142953847,0.61599511124850714,0.61599511124850714],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.14011159643283352,-1.5769894067294872,-0.30900859066860858,-0.0002078275467263685,-0.00072015771984989608,0.00028496447245895777]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":541,"step":4328,"t":21.640000000000001,"sim_time":21.639999999999979,"vehicle":{"origin_ned":[1.5474806218454737,1.0530001108639964,3.4535472452128944],"origin_quat_xyzw":[-0.022887610401177632,0.050142894326150489,0.40884729765094774,0.91093673470896841],"cg_ned":[1.4921812304736544,0.99090263139860679,3.1606619231341515],"linear_velocity_ned":[-0.01498352902004399,-0.0078590673010610276,-0.002518462125063143],"angular_velocity_ned":[-0.0011645031990388909,0.00050494465736230002,-0.016165654415291313]},"sensors":{"Odom":[1.5474806218454737,1.0530001108639964,3.4535472452128944,-0.015096348614889199,0.004745511711700544,-0.0043031802071159591,-0.022887610401177653,0.050142894326150531,0.40884729765094807,0.91093673470896841,0.0013849572165521729,0.0012169440939794475,-0.016110256362412326],"Pressure":[26404.722076560105],"DVL":[-0.012794437946972818,-0.0030108804318116945,-0.0011865627210928733,7.3675184374707614,0.020352755997378433,0.015830731901135854,-0.027007651128710907,0],"IMU":[-0.00070101595771302513,0.11029255622310234,0.84370693898009985,0.011321571469188609,-0.058084331555476307,-0.11400743708673246,1.0726456277943504,-0.00090776534408483836,-9.7622856373825719],"FOG":[0.85036275811426887],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-1.2254090462390097,-26.795368662436189,-23.449721251960657,64.70226245745549,64.70226245745549],"omega_rad_s":[-2.3365161907741023,-27.06202293533374,-23.3585926180325,64.841134612050411,64.841038604124975],"thrust_n":[-0.063956281283011188,-9.1095757623833364,-6.8455232385868978,53.770315092825541,53.809439130354647],"torque_nm":[0.00119918027405646,0.17080454554468757,0.12835356072350435,-1.0081934079904791,-1.0089269836941495],"angle_rad":[-629.58013155914807,556.56782669588642,-444.23781509834481,1529.3715390391305,1529.3715740050363]},"command":[-0.011670562345133426,-0.25519398726129705,-0.2233306785901015,0.61621202340433801,0.61621202340433801],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.1393574445744343,-1.5799671705563054,-0.30969378190154118,-0.00020902161473444097,-0.00071984095667145215,0.00028599695385120245]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":542,"step":4336,"t":21.68,"sim_time":21.679999999999971,"vehicle":{"origin_ned":[1.5469288824127301,1.0526645400786139,3.4534550148154728],"origin_quat_xyzw":[-0.022888867301875185,0.050168844934789236,0.40855153018308688,0.91106796340152596],"cg_ned":[1.4915835811775742,0.9905890527171054,3.1605737026235916],"linear_velocity_ned":[-0.014908384696505067,-0.0078244624008170921,-0.0019626618878785273],"angular_velocity_ned":[-0.0011901528607361242,0.00047643339231812206,-0.016191664801870009]},"sensors":{"Odom":[1.5469288824127301,1.0526645400786139,3.4534550148154728,-0.015085773637927147,0.0047108837123840406,-0.0037435153641332611,-0.022888867301875202,0.050168844934789278,0.40855153018308715,0.91106796340152596,0.0013497033845810591,0.0012171664290282361,-0.016140330489895417],"Pressure":[26403.435827015288],"DVL":[-0.010696702534113494,-0.006143042988081205,0.0076172398809332149,7.4141600431432924,0.0095610705289457202,0.0019447339007962145,-0.021887261964365343,0],"IMU":[-0.0007178764371151403,0.11034078348843449,0.84305786500594038,-0.021344264155928754,0.028900240729896547,-0.044087604882001752,1.0810334173261678,0.012203585935710809,-9.7487733969990664],"FOG":[0.8368211759449371],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[1.3742620351693871,-26.700969195616498,-23.398552780324597,64.722644027081799,64.722644027081799],"omega_rad_s":[-1.0656529751779693,-26.968934882031018,-23.311503323367347,64.864019683689989,64.863925629103761],"thrust_n":[-0.01190651260295526,-9.0462335595733361,-6.8179062524890375,53.792040819061697,53.831190065566446],"torque_nm":[0.00022324711130541116,0.16961687924200006,0.12783574223416944,-1.0086007653574069,-1.0093348137293709],"angle_rad":[-629.64525711193437,555.48745995844729,-445.17108658400008,1531.9657134829554,1531.9657446526255]},"command":[0.013088209858756068,-0.25429494472015712,-0.22284335981261519,0.61640613359125529,0.61640613359125529],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,1.7347234759768071e-18,0,0,0],"servo_effort":[-0.13876001483652364,-1.582894157161379,-0.31034791510687071,-0.0002103958164838135,-0.00071930517118723794,0.00028693673459767073]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":543,"step":4344,"t":21.719999999999999,"sim_time":21.719999999999963,"vehicle":{"origin_ned":[1.5463798278622098,1.05233049822687,3.4533848956077469],"origin_quat_xyzw":[-0.022890755337276747,0.050194506588738551,0.40825522640068979,0.91119931680446486],"cg_ned":[1.4909888848863557,0.9902768065433758,3.1605075931141728],"linear_velocity_ned":[-0.014835781208272007,-0.0077919719113225131,-0.0014122512505747246],"angular_velocity_ned":[-0.0012127851206077582,0.00045079358758644115,-0.016216037296826073]},"sensors":{"Odom":[1.5463798278622098,1.05233049822687,3.4533848956077469,-0.015077975684885536,0.0046757318076648419,-0.0031895363518844094,-0.022890755337276743,0.050194506588738544,0.40825522640068979,0.91119931680446486,0.001318396527238903,0.0012170211418860201,-0.016168321445239692],"Pressure":[26404.206918869713],"DVL":[0.0091696353983037951,-0.0089961960065769887,-0.010751028567599446,7.4325946486975623,0.030723172247557409,-0.0025573584896580832,0.055323301411032907,0],"IMU":[-0.00073622316767253172,0.11038899978242504,0.84240762394153834,-0.15195008202879182,0.015156607829119829,-0.082533653258058504,1.0714428107046043,0.026928384859753837,-9.7186538808455296],"FOG":[0.84481197131707408],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[2.287147393243024,-26.602717092440802,-23.346460190939624,64.740583613694795,64.740583613694795],"omega_rad_s":[0.18249972260245292,-26.872442782456119,-23.263299734063889,64.884501683260027,64.884409546379544],"thrust_n":[0.00086450090277107581,-8.9807818730420035,-6.7896559469576347,53.80995508291268,53.849116999448135],"torque_nm":[-1.6209391926957675e-05,0.1683896601195376,0.12730604900545564,-1.0089366578046128,-1.0096709437396527],"angle_rad":[-629.6590113721013,554.41089384764621,-446.10244898530055,1534.5607486218105,1534.5607760725502]},"command":[0.021782356126124038,-0.25335921040419812,-0.22234723991371069,0.61657698679709327,0.61657698679709327],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,1.0842021724855044e-19,-1.7347234759768071e-18,0],"servo_effort":[-0.13778746576057946,-1.5857751842951906,-0.31097129821728819,-0.00021188927481696605,-0.00070299244055042084,0.00028832723771405878]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":544,"step":4352,"t":21.760000000000002,"sim_time":21.759999999999955,"vehicle":{"origin_ned":[1.5458333730809399,1.0519978809880741,3.4533366737912905],"origin_quat_xyzw":[-0.022893187084494396,0.05021990919986527,0.40795841888904089,0.91133078032217552],"cg_ned":[1.4903970223769603,0.98996582526964039,3.1604633793187702],"linear_velocity_ned":[-0.014766222386597302,-0.0077610857237999939,-0.0008672149459227023],"angular_velocity_ned":[-0.001231899262651896,0.00042845191277822512,-0.016238901550142695]},"sensors":{"Odom":[1.5458333730809399,1.0519978809880741,3.4533366737912905,-0.015072936808317818,0.0046405623841328505,-0.0026412198515506644,-0.022893187084494407,0.050219909199865291,0.40795841888904105,0.91133078032217552,0.0012916989410088398,0.00121642403225616,-0.016194285930835571],"Pressure":[26404.205745080835],"DVL":[-0.060318051176132419,0.027903229618287739,0.02460044322853518,7.4024356085051499,-0.022284483753602046,0.044766388847257622,-0.0059716530730142617,0],"IMU":[-0.00075586740037347539,0.11043718687268046,0.84175629756450554,-0.096023174746370579,-0.020337872467879995,0.03999886161014328,1.0882948197499762,0.0057155444267444639,-9.7429965154817904],"FOG":[0.84134500034021631],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[2.9276020866055679,-26.5004552652359,-23.293429798542014,64.756031844299613,64.756031844299613],"omega_rad_s":[1.256923217722115,-26.772334495093059,-23.21401535843065,64.902534930931751,64.90244468456747],"thrust_n":[0.023165542980439525,-8.9131033249353049,-6.7607970509079385,53.823981423437488,53.863139805301216],"torque_nm":[-0.0004343539308832411,0.16712068734253696,0.12676494470452387,-1.0091996516894528,-1.0099338713493979],"angle_rad":[-629.6267664727535,553.3382694352631,-447.03185855101441,1537.156547295933,1537.156571103812]},"command":[0.027881924634338744,-0.2523852882403419,-0.22184218855754298,0.61672411280285344,0.61672411280285344],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.13678325954540257,-1.5885590898243838,-0.31155152581149681,-0.00021393096187752019,-0.00071750794813239794,0.0002885150355002201]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":545,"step":4360,"t":21.800000000000001,"sim_time":21.799999999999947,"vehicle":{"origin_ned":[1.5452894445910514,1.0516665767575204,3.4533101363988981],"origin_quat_xyzw":[-0.022896080702423389,0.050245080571857136,0.4076611413146034,0.91146233889770278],"cg_ned":[1.489807888723621,0.98965603142313019,3.1604408468564849],"linear_velocity_ned":[-0.014698941010813147,-0.0077324103671532326,-0.00032752666890615911],"angular_velocity_ned":[-0.0012480348584517158,0.00040890220247987645,-0.016260084586463792]},"sensors":{"Odom":[1.5452894445910514,1.0516665767575204,3.4533101363988981,-0.015070580496061829,0.0046046224499358525,-0.0020985387575786912,-0.022896080702423383,0.050245080571857115,0.40766114131460329,0.91146233889770278,0.001268859458249567,0.0012154462285165158,-0.016218132719855775],"Pressure":[26403.563980740051],"DVL":[-0.033364007751454441,-0.0083468891622793528,0.003153607727965837,7.4445824483817145,0.027012673751461984,0.041054334288529719,-0.019052601852127357,0],"IMU":[-0.00077663218963247593,0.11048532747604761,0.84110396937368515,0.034327810506414327,-0.0073580032447566187,-0.044817404384687523,1.0881841136448849,0.013367408442333192,-9.7086689428025661],"FOG":[0.82817567805678682],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[3.4485045626608293,-26.394167666882176,-23.239389846488823,64.76893789341517,64.76893789341517],"omega_rad_s":[2.1655052267751267,-26.668449827426159,-23.163653763538605,64.918071769109048,64.917983392173824],"thrust_n":[0.064981049761985391,-8.8431191183572775,-6.7313361968714638,53.834037602985376,53.873178330689022],"torque_nm":[-0.0012183946830372262,0.16580848346919899,0.12621255369133996,-1.0093882050559759,-1.0101220937004194],"angle_rad":[-629.55538091052574,552.26973519675209,-447.9592722208252,1539.7530104725417,1539.7530307126926]},"command":[0.032842900596769802,-0.25137302539887785,-0.2213275223475126,0.61684702755633491,0.61684702755633491],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.13582540245367949,-1.5912283164295591,-0.31208412823666537,-0.00021636039482455594,-0.000716142564256851,0.00028912907970555401]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":546,"step":4368,"t":21.84,"sim_time":21.839999999999939,"vehicle":{"origin_ned":[1.5447479902398211,1.0513364589943139,3.453305071286541],"origin_quat_xyzw":[-0.022899365919911596,0.05027004459145562,0.40736342945017806,0.91159397650699114],"cg_ned":[1.4892214055334476,0.98934732710250473,3.160439782374791],"linear_velocity_ned":[-0.014633418323409638,-0.0077063246557973336,0.00020683819441138295],"angular_velocity_ned":[-0.0012615056300768986,0.00039185311206026521,-0.016279471290864007]},"sensors":{"Odom":[1.5447479902398211,1.0513364589943139,3.453305071286541,-0.015070831566562998,0.004567400870702374,-0.0015614653479100805,-0.022899365919911603,0.050270044591455641,0.40736342945017823,0.91159397650699114,0.0012494419463476613,0.0012141324134914227,-0.016239793968256772],"Pressure":[26402.617187647436],"DVL":[-0.016059771679346406,-0.0092650434458142125,-0.01804626855413699,7.3466367096044314,-0.0034010314520412643,0.011296599924333451,0.046133628137141933,0],"IMU":[-0.00079836473493925504,0.11053340682715308,0.84045072619244643,0.018879751637151769,-0.081133364499624772,-0.13056748028145451,1.0647534478782479,0.00058841026560991268,-9.7378189239691366],"FOG":[0.84275101498659122],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[3.8940673547768823,-26.283873837540767,-23.184255393714441,64.779250739409193,64.779250739409193],"omega_rad_s":[2.9332328342881633,-26.56068765483618,-23.112188608808758,64.931063044317114,64.930976518612795],"thrust_n":[0.1167031907478733,-8.7707928100567329,-6.7012627212175548,53.840039532073519,53.87915004068519],"torque_nm":[-0.0021881848265226248,0.16445236518856379,0.12564867602282914,-1.0095007412263786,-1.0102340632628475],"angle_rad":[-629.45093027477833,551.20544460704173,-448.88464635986116,1542.3500371768755,1542.3500539236597]},"command":[0.037086355759779831,-0.25032260797657874,-0.2208024323210899,0.61694524513723037,0.61694524513723037],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.13484771262481382,-1.5937812853242943,-0.31256848343451532,-0.00021879293490383007,-0.00071444272145961419,0.00028962292725768623]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":547,"step":4376,"t":21.879999999999999,"sim_time":21.879999999999932,"vehicle":{"origin_ned":[1.5442089704160706,1.0510073939255788,3.4533212671216158],"origin_quat_xyzw":[-0.022902977308574657,0.050294823538841488,0.4070653202636203,0.91172567661236548],"cg_ned":[1.4886375091670725,0.98903960485049558,3.1604599734295094],"linear_velocity_ned":[-0.014569383400318504,-0.0076829748233598859,0.0007359007609246262],"angular_velocity_ned":[-0.0012724101182831943,0.00037721128113911678,-0.016297007728783466]},"sensors":{"Odom":[1.5442089704160706,1.0510073939255788,3.4533212671216158,-0.015073613808771254,0.0045286365256162449,-0.0010299726562717753,-0.022902977308574674,0.050294823538841529,0.40706532026362063,0.91172567661236548,0.0012333062033152236,0.0012124983147332395,-0.016259230621938708],"Pressure":[26400.867578756322],"DVL":[-0.038605020990898617,-0.0087906375139924688,0.012094588861904973,7.4565423553291987,0.0055878268271048097,0.0031053591300348603,-0.013030464464370067,0],"IMU":[-0.00082092226308347197,0.11058141137175502,0.83979665691037642,-0.0067472458216006424,0.093456567947999933,-0.0034016434944436416,1.0835885447923577,-4.2090764390104868e-05,-9.7321016263864166],"FOG":[0.82592735869318756],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[4.2857603185487525,-26.169575286389161,-23.127958573648602,64.78691981559443,64.78691981559443],"omega_rad_s":[3.5856596751030492,-26.448981641639296,-23.059578259904885,64.941458715714319,64.941374024406414],"thrust_n":[0.17244858453540984,-8.6961134372160807,-6.6705574699959014,53.841902564338326,53.880970869291687],"torque_nm":[-0.0032334109600389341,0.16305212694780155,0.12507295256242318,-1.0095356730813438,-1.0102682037992192],"angle_rad":[-629.31846011188986,550.14555434321505,-449.80793589872439,1544.9475244463433,1544.9475377734284]},"command":[0.040816764938559548,-0.24923405034656343,-0.2202662721299867,0.61701828395804226,0.61701828395804226],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,1.0842021724855044e-19,0,0],"servo_effort":[-0.13381222742698229,-1.5962151963534863,-0.31300371804457822,-0.0002212586824838667,-0.0007124029063543439,0.00028999483131436908]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":548,"step":4384,"t":21.920000000000002,"sim_time":21.919999999999924,"vehicle":{"origin_ned":[1.5436723524761253,1.0506792456812142,3.4533585132956852],"origin_quat_xyzw":[-0.022906850198221654,0.050319439387349167,0.40676685128239659,0.91185742247982138],"cg_ned":[1.4880561433943518,0.98873275474734956,3.1605012083166732],"linear_velocity_ned":[-0.014506705021843574,-0.0076623674791186499,0.0012596773556266137],"angular_velocity_ned":[-0.0012807285190930022,0.00036498540838262965,-0.016312675994659385]},"sensors":{"Odom":[1.5436723524761253,1.0506792456812142,3.4533585132956852,-0.015078845257235216,0.0044882176476989397,-0.00050403606858137216,-0.022906850198221678,0.050319439387349216,0.40676685128239698,0.91185742247982138,0.001220470023475191,0.0012105394761570676,-0.016276422367742585],"Pressure":[26403.464508928544],"DVL":[-0.017802031465438045,-0.020442229552193894,-0.0052599022089414582,7.365286624760409,-0.014117116358752171,-0.0097781614852092968,-0.005958991257321692,0],"IMU":[-0.00084416354992845617,0.11062932779531348,0.83914185153053622,0.044185336038655036,-0.00098489164313036591,0.039296507118671178,1.0865868717006435,-0.010107930414115684,-9.7557791338057154],"FOG":[0.85993294443348223],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[4.6362295394296495,-26.051262398227507,-23.070448269979096,64.791895463734548,64.791895463734548],"omega_rad_s":[4.1449818093457047,-26.333284768201981,-23.005776466066415,64.949208419654596,64.949125546782085],"thrust_n":[0.22885625137058993,-8.6190848848210546,-6.6391991161305235,53.839542372468941,53.878556382474095],"torque_nm":[-0.0042910547131985608,0.16160784159039479,0.12448498342744731,-1.0094914194837927,-1.0102229321713894],"angle_rad":[-629.16206635109063,549.09022326718411,-450.72909397630059,1547.5453673079523,1547.5453772883518]},"command":[0.044154567042187134,-0.24810726093550006,-0.21971855495218187,0.61706567108318611,0.61706567108318611],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.13269797598799687,-1.5985258330240524,-0.313389027086799,-0.00022369776226645536,-0.00071001283583029277,0.00029024441360710749]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":549,"step":4392,"t":21.960000000000001,"sim_time":21.959999999999916,"vehicle":{"origin_ned":[1.5431381216792281,1.050351884838318,3.4534165980679963],"origin_quat_xyzw":[-0.022910919033610463,0.05034391369881986,0.40646806161257698,0.91198919677342416],"cg_ned":[1.4874772700938221,0.98842667376896864,3.1605632740881906],"linear_velocity_ned":[-0.014444369886884819,-0.0076440562794414931,0.0017780593336313463],"angular_velocity_ned":[-0.0012863920001367948,0.00035513510626539104,-0.016326274013525866]},"sensors":{"Odom":[1.5431381216792281,1.050351884838318,3.4534165980679963,-0.015085529725385413,0.0044456963664245789,1.6350435778958103e-05,-0.022910919033610474,0.050343913698819881,0.40646806161257715,0.91198919677342416,0.001210927154280398,0.0012081820359259499,-0.016291166320479954],"Pressure":[26401.165127043845],"DVL":[0.027903465026283797,-0.0060316463515033602,-0.015700303722407851,7.5041412945954082,-0.0054865712650034601,0.012134871673022674,0.017697494065155518,0],"IMU":[-0.00086794586833970587,0.11067714149084826,0.83848640353413451,0.0073854431786478398,-0.047114796391878884,0.028536248121552522,1.0792267108596458,0.015974493721788628,-9.6810862293738875],"FOG":[0.82650110735929416],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[4.9534169683617888,-25.929005759992481,-23.011751606693782,64.794129910810838,64.794129910810838],"omega_rad_s":[4.6293059640828318,-26.213577042049749,-22.950750730037587,64.95426211573762,64.954181046461585],"thrust_n":[0.28411966492455015,-8.5397396830754815,-6.6071818507991811,53.832876999270248,53.871822627903867],"torque_nm":[-0.0053272437173353159,0.16012011905766529,0.12388465970248463,-1.0093664437363172,-1.0100966742731974],"angle_rad":[-628.9850497837964,548.03961164668635,-451.64807206285093,1550.1434587793633,1550.1434654854756]},"command":[0.047175399698683701,-0.24694291199992841,-0.21915953911136934,0.61708695153153181,0.61708695153153181],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,8.656676720938947e-21,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,1.7347234759768071e-18,0],"servo_effort":[-0.1317093381529352,-1.6006726584976398,-0.31367396485152577,-0.00022607869920842602,-0.00070716685697567061,0.00029018538581398079]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":550,"step":4400,"t":22,"sim_time":21.999999999999908,"vehicle":{"origin_ned":[1.5426063657771254,1.050025247463414,3.4534952936565699],"origin_quat_xyzw":[-0.022915121599304131,0.050368265241699531,0.40616900486027629,0.91212097583020391],"cg_ned":[1.486900957558335,0.98812132184055201,3.1606459415676946],"linear_velocity_ned":[-0.014378536401921084,-0.0076254972988868339,0.0022903872617671701],"angular_velocity_ned":[-0.0012895896748351498,0.00034742156554530459,-0.016336530562793911]},"sensors":{"Odom":[1.5426063657771254,1.050025247463414,3.4534952936565699,-0.01508916093920913,0.0044001125661390101,0.00053102377220080638,-0.022915121599304155,0.050368265241699579,0.40616900486027674,0.91212097583020391,0.0012042352706681991,0.0012054103122805019,-0.016302232285631119],"Pressure":[26403.123137621296],"DVL":[0.0057719777645537686,-0.0047377882750375636,0.050470834225533133,7.3315011530234528,0.016890909110457392,0.0049620616570783607,-0.025839320947818153,0],"IMU":[-0.00089213311315483753,0.11072483565840879,0.83783043774036414,-0.044750049093439312,-0.0088899155748146923,-0.06648866322780235,1.066013250998435,0.0059181468020177777,-9.7172278809136827],"FOG":[0.8415208539191309],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[5.2395271881414356,-25.804890365665575,-22.953341848161447,64.793602402976376,64.793602402976376],"omega_rad_s":[5.052114144267307,-26.090337199830525,-22.894831966880602,64.956576104904528,64.956496826638997],"thrust_n":[0.33722570536377899,-8.4584801097559037,-6.5747413910736201,53.821839281980189,53.860701403057156],"torque_nm":[-0.0063229819755708568,0.15859650205792322,0.12327640108263037,-1.0091594865371285,-1.0098881513073217],"angle_rad":[-628.79009102608188,546.99387156805153,-452.56482700132977,1552.7416899842472,1552.7416934879266]},"command":[0.049900258934680336,-0.24576086062538643,-0.21860325569677569,0.61708192764739411,0.61708192764739411],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.13154070824626718,-1.6024560860274615,-0.31372799465323148,-0.00022836000338827459,-0.00070354092766440439,0.00028939830271611651]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":551,"step":4408,"t":22.039999999999999,"sim_time":22.0399999999999,"vehicle":{"origin_ned":[1.5420773268437202,1.0496993946372455,3.4535943384919641],"origin_quat_xyzw":[-0.022919398670989546,0.050392509330922937,0.40586975097310529,0.91225272891503184],"cg_ned":[1.4863274327869738,0.98781678151835794,3.160748947479135],"linear_velocity_ned":[-0.014305514882911166,-0.0076035231631333532,0.0027957216943670744],"angular_velocity_ned":[-0.0012901906370172238,0.00034174333978195261,-0.01634302591040775]},"sensors":{"Odom":[1.5420773268437202,1.0496993946372455,3.4535943384919641,-0.015084883248849257,0.0043508856496854058,0.0010395914640360031,-0.022919398670989542,0.05039250933092293,0.40586975097310529,0.91225272891503184,0.0012003603277394032,0.001202062854099439,-0.016309201583056578],"Pressure":[26404.056439010135],"DVL":[-0.030609554147978307,-0.028211995131182634,-0.0030352084152871781,7.3867711651416608,0.012295349895649392,0.022539938655529463,0.013699268946487726,0],"IMU":[-0.00091659547148981537,0.11077238980368777,0.83717411430194366,-0.018564652505885945,0.080167090835775015,0.011555441760676237,1.0858617277400688,0.002852601151065416,-9.7532131884477451],"FOG":[0.84511097320561746],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[5.4958323844056958,-25.682904042960732,-22.89837975859135,64.79037916473699,64.79037916473699],"omega_rad_s":[5.4229732886408399,-25.965176573878107,-22.839212198797568,64.956136591358458,64.956059094479386],"thrust_n":[0.38752840489394358,-8.3764523357358502,-6.5426197735203422,53.806420585398769,53.845179471157202],"torque_nm":[-0.0072661575917614416,0.15705848129504724,0.12267412075350642,-1.0088703859762269,-1.0095971150841976],"angle_rad":[-628.57942476942549,545.95310992521775,-453.47934794304166,1555.3399509142369,1555.3399512868921]},"command":[0.052341260803863768,-0.24459908612343556,-0.21807980722467951,0.61705123014035235,0.61705123014035235],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.1314207747306794,-1.6040222312605725,-0.31361793386997161,-0.00022570864895638838,-0.00069910251709599455,0.00028807652708021878]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":552,"step":4416,"t":22.080000000000002,"sim_time":22.079999999999892,"vehicle":{"origin_ned":[1.5415513571077772,1.0493744998413943,3.4537134342372995],"origin_quat_xyzw":[-0.022923692066760332,0.050416664383629475,0.40557037505368265,0.91238442291244304],"cg_ned":[1.4857570321056319,0.98751324596101198,3.1608719923320958],"linear_velocity_ned":[-0.014223476621331367,-0.0075759028442838241,0.003293226406491712],"angular_velocity_ned":[-0.0012885645485905034,0.00033843595170671712,-0.016345450724207147]},"sensors":{"Odom":[1.5415513571077772,1.0493744998413943,3.4537134342372995,-0.01506958129450558,0.0042981962132004328,0.0015415170367008096,-0.022923692066760353,0.050416664383629524,0.40557037505368304,0.91238442291244304,0.001199269986716174,0.0011986426639558096,-0.016311765818876958],"Pressure":[26406.31995321409],"DVL":[-0.027033034115919168,0.0074000395638294551,-0.015253880196087576,7.3784380867522383,-0.037896578374620953,0.012551949551713147,0.011732477385650412,0],"IMU":[-0.00094120183643717865,0.11081979012982655,0.83651760482811321,0.031126352861893539,0.051235356621404417,-0.10289518658371123,1.0944842923735307,0.023621616691297191,-9.7329411452781436],"FOG":[0.83714220660528471],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[5.7252682487979776,-25.566141007072339,-22.8499357314546,64.78459763098283,64.78459763098283],"omega_rad_s":[5.7492105444212607,-25.840299546938052,-22.785779285945754,64.952976422026964,64.952900698282761],"thrust_n":[0.43464569678239839,-8.2951462373443547,-6.5119360381431477,53.786686250887378,53.825335017660215],"torque_nm":[-0.0081496068146699706,0.1555339919502067,0.12209880071518404,-1.0085003672041386,-1.0092250315811293],"angle_rad":[-628.35495853181237,544.91735421178862,-454.39168877971468,1557.9381320532079,1557.9381293659244]},"command":[0.054526364274266451,-0.24348705721021274,-0.21761843553766286,0.61699616791412215,0.61699616791412215],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,-8.6736173798840355e-19,0,0,0,0],"servo_effort":[-0.13121867250235544,-1.6053112782500225,-0.31345072641322203,-0.00021195704040665223,-0.00069393772544103802,0.00028671336857393924]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":553,"step":4424,"t":22.120000000000001,"sim_time":22.119999999999884,"vehicle":{"origin_ned":[1.541028829352094,1.0490507787760412,3.4538522547086776],"origin_quat_xyzw":[-0.022927950197047978,0.050440760779802314,0.40527095935576363,0.91251602082077177],"cg_ned":[1.4851901083835344,0.98721094343693039,3.1610147510704927],"linear_velocity_ned":[-0.014132818783917043,-0.0075425934965771581,0.0037823864766995097],"angular_velocity_ned":[-0.0012853293519211636,0.00033791280459728506,-0.016343237643768008]},"sensors":{"Odom":[1.541028829352094,1.0490507787760412,3.4538522547086776,-0.015043201313053528,0.0042424706446443413,0.0020362270586238317,-0.022927950197047992,0.050440760779802342,0.4052709593557639,0.91251602082077177,0.0012007944220967224,0.0011958889304246509,-0.01630937202068326],"Pressure":[26406.012517502142],"DVL":[-0.025533499807241535,-0.0061166925229647617,-0.026326576701306156,7.439345171579026,0.0016320470830325855,-0.0075652991345147779,0.0018881634803690212,0],"IMU":[-0.00096582251194592486,0.11086705027484048,0.83586109710234002,-0.04248439895187088,-0.0085584627322662591,-0.0019588227346654368,1.0904907241666884,0.016730739482448909,-9.748327626488658],"FOG":[0.8384530644434175],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[5.9319959011979329,-25.45588517333433,-22.808860896033227,64.776436659314214,64.776436659314214],"omega_rad_s":[6.0371855797953575,-25.717813589884983,-22.736310972916932,64.947176538384724,64.947102567740814],"thrust_n":[0.47845931181092982,-8.2159243166915132,-6.4837027422623406,53.762778083076981,53.801333604640064],"torque_nm":[-0.0089711120964549359,0.15404858093796586,0.12156942641741889,-1.0080520890576934,-1.0087750050870015],"angle_rad":[-628.11833017589379,543.88654364939487,-455.30197911414643,1560.5361263108523,1560.5361206341631]},"command":[0.056495199059027931,-0.24243700165080315,-0.21722724662888787,0.61691844437442112,0.61691844437442112],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.13199786016615073,-1.6068426275698384,-0.31375958267135945,-0.0001982483042669158,-0.00068824956412283692,0.00028725163901770093]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":554,"step":4432,"t":22.16,"sim_time":22.159999999999876,"vehicle":{"origin_ned":[1.5405100986375653,1.0487284523806659,3.454010452058903],"origin_quat_xyzw":[-0.022932131492669629,0.050464840861892811,0.40497159840949176,0.91264747940464286],"cg_ned":[1.4846269941373109,0.98691009798966922,3.1611768794907635],"linear_velocity_ned":[-0.014034098111365493,-0.0075037851837238658,0.0042627443476912835],"angular_velocity_ned":[-0.0012810859943546914,0.0003405579293124161,-0.016335831208500115]},"sensors":{"Odom":[1.5405100986375653,1.0487284523806659,3.454010452058903,-0.015005984474140234,0.00418409985582142,0.0025231752574497342,-0.022932131492669636,0.050464840861892825,0.40497159840949187,0.91264747940464286,0.0012047533092425064,0.0011945083398568368,-0.016301480349668777],"Pressure":[26405.804338409638],"DVL":[-0.0013275444423738285,-0.011823464452479442,-0.001806541817151011,7.3335723416688534,0.0066489068549080016,0.025945055106397837,-0.024975018077580159,0],"IMU":[-0.00099033492405029705,0.11091421409889404,0.8352048060508549,0.01264329066275492,-0.015451901168833382,0.0070184965451115279,1.0807371570800692,0.0038938186244881047,-9.7139435000068648],"FOG":[0.85204103646321849],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[6.1197762772922024,-25.352826530685409,-22.774747260034029,64.7660778887482,64.7660778887482],"omega_rad_s":[6.2925274446554926,-25.599374598594579,-22.691916789408836,64.938853910128628,64.93878164936342],"thrust_n":[0.51904432493330244,-8.1398259794160506,-6.4585349566863259,53.734897377227909,53.773400057675786],"torque_nm":[-0.0097320810924994214,0.15262173711405094,0.12109753043786863,-1.0075293258230236,-1.0082512510814212],"angle_rad":[-627.87094013429476,542.86054394667974,-456.21040437600237,1563.1338306939319,1563.1338220970783]},"command":[0.058283583593259074,-0.24145549076843245,-0.21690235485746695,0.6168197894166495,0.6168197894166495],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-6.7722931110941484e-22,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,-1.0842021724855044e-19,0,0],"servo_effort":[-0.13325290966573169,-1.6084181774174053,-0.31426824411938975,-0.0001884162381123424,-0.00068418722163377031,0.00028856018257554435]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":555,"step":4440,"t":22.199999999999999,"sim_time":22.199999999999868,"vehicle":{"origin_ned":[1.5399955010346353,1.0484077338112245,3.4541876593224017],"origin_quat_xyzw":[-0.022936197509048784,0.050488957402559098,0.40467238790031468,0.91277875440617351],"cg_ned":[1.4840679981800118,0.98661092161388175,3.1613580160860835],"linear_velocity_ned":[-0.013927927491074825,-0.0074598380122004471,0.0047338880930046989],"angular_velocity_ned":[-0.0012760696066530879,0.00034679156259957288,-0.016323394546861561]},"sensors":{"Odom":[1.5399955010346353,1.0484077338112245,3.4541876593224017,-0.014958414737698262,0.0041232618328871365,0.0030018543804500569,-0.022936197509048791,0.050488957402559112,0.40467238790031479,0.91277875440617351,0.0012113151143921278,0.0011949611063756295,-0.016288235362043331],"Pressure":[26409.401037431686],"DVL":[-0.013342104256014849,0.0063304147085028869,-0.019451707873914443,7.4754584839902476,0.024484220102811025,0.010613167760394773,-0.015657961148243041,0],"IMU":[-0.0010146136185119989,0.11096134725559913,0.83454894970183224,-0.065422928796908475,-0.036260040326558343,-0.059494766692285268,1.0849067476206244,0.013732055575165394,-9.7060899479982137],"FOG":[0.82987221161061253],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[6.2908937147256871,-25.257065774530776,-22.747426149791782,64.753697606355743,64.753697606355743],"omega_rad_s":[6.5199646449838253,-25.48619386747264,-22.653263130607371,64.928148325152861,64.928077703788176],"thrust_n":[0.55656203875892463,-8.0675826689532482,-6.4367908878851265,53.703286216497219,53.741791948057575],"torque_nm":[-0.010435538226729837,0.1512671750428734,0.12068982914784616,-1.0069366165593228,-1.0076585990260796],"angle_rad":[-627.61398336997172,541.83916437445225,-457.11718349099584,1565.7311474373519,1565.7311359872326]},"command":[0.059913273473577972,-0.24054348356695976,-0.21664215380754079,0.61670188196529285,0.61670188196529285],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.13456797821236388,-1.6099137517815831,-0.31482647132660629,-0.00019034236199907734,-0.00068608190439173398,0.00028992352506936709]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":556,"step":4448,"t":22.240000000000002,"sim_time":22.23999999999986,"vehicle":{"origin_ned":[1.5394853527373182,1.0480888223542113,3.4543834928164712],"origin_quat_xyzw":[-0.022940109923232168,0.050513172286509048,0.40437341968461338,0.91290980290214585],"cg_ned":[1.4835134041634979,0.98631361060867984,3.1615577840444078],"linear_velocity_ned":[-0.013814946239674164,-0.0074111686093986688,0.0051954574032011709],"angular_velocity_ned":[-0.0012704317708704805,0.00035700360010694357,-0.016306181648004452]},"sensors":{"Odom":[1.5394853527373182,1.0480888223542113,3.4543834928164712,-0.014901066406376987,0.0040600972414266577,0.0034718055433200687,-0.022940109923232185,0.050513172286509089,0.40437341968461366,0.91290980290214585,0.0012206909355584798,0.0011976255720406884,-0.016269868316052327],"Pressure":[26410.656695389534],"DVL":[-0.065621449679438129,-0.0018172454453707658,0.017322013482748748,7.4890845959014385,-0.016995754888952358,-0.015846325969646066,-0.0055235613018883812,0],"IMU":[-0.0010385264670579352,0.11100853234051722,0.8338937383550975,0.035855115693624852,0.067417565690106485,-0.024428014761286865,1.0763597829172795,0.018303089548879374,-9.7455604568500789],"FOG":[0.84060248013894745],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[6.4470193084990068,-25.168485690847405,-22.72676332486494,64.739461972548696,64.739461972548696],"omega_rad_s":[6.7233098644363798,-25.379058416403527,-22.620756273939044,64.915211875965838,64.915142796914012],"thrust_n":[0.5911910483285614,-7.999641785115748,-6.4186794210429792,53.66820713248579,53.706784499791937],"torque_nm":[-0.011084832156160528,0.14999328347092034,0.12035023914455588,-1.0062788837341088,-1.0070022093710989],"angle_rad":[-627.34848703763589,540.82217571883496,-458.02255588628782,1568.3279846715916,1568.3279704316822]},"command":[0.061400183890466732,-0.23969986372235624,-0.21644536499871372,0.61656630450046379,0.61656630450046379],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-6.7722931110941484e-22,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,-1.0842021724855044e-19,0,0],"servo_effort":[-0.13580180853128962,-1.6112237074258171,-0.31531526852719488,-0.000192176089178974,-0.000687371763158797,0.00029113000053534018]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":557,"step":4456,"t":22.280000000000001,"sim_time":22.279999999999852,"vehicle":{"origin_ned":[1.5389799487574189,1.0477719005527188,3.4545975544552441],"origin_quat_xyzw":[-0.022943829166889154,0.050537554203930753,0.40407478160050375,0.91304058354092366],"cg_ned":[1.4829634701545746,0.98601834401965072,3.1617757931196642],"linear_velocity_ned":[-0.01369578976475974,-0.0073582179094142317,0.0056471343909161959],"angular_velocity_ned":[-0.0012642012419527241,0.00037146714826473832,-0.016284338549988297]},"sensors":{"Odom":[1.5389799487574189,1.0477719005527188,3.4545975544552441,-0.014834585262888327,0.0039947359395927544,0.0039326184918584226,-0.022943829166889165,0.050537554203930773,0.40407478160050397,0.91304058354092366,0.0012330753342593482,0.0012027109045648131,-0.016246503818763958],"Pressure":[26412.168766469196],"DVL":[-0.0077972116380041149,0.0071765937215147145,-0.0023617454532037776,7.4379784618312401,-0.005294249003110393,-0.016049884478923353,-0.045083118393314046,0],"IMU":[-0.0010619340893114396,0.11105586356840894,0.83323937407702808,0.014926365135962525,-0.012884598683337566,-0.079560145965444626,1.0831499173634529,0.012402748059119487,-9.7057392499220132],"FOG":[0.84613594702556927],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[6.5894629448533371,-25.086860322204885,-22.712583917839595,64.723525307758464,64.723525307758464],"omega_rad_s":[6.9056209141756337,-25.278428316040166,-22.594614398332755,64.900200976357141,64.900133318900188],"thrust_n":[0.62310368360406632,-7.9362369784547147,-6.4043031910199062,53.629930875686711,53.668655990982423],"torque_nm":[-0.011683194067576244,0.14880444334602591,0.12008068483162325,-1.0055612039191257,-1.0062872998309207],"angle_rad":[-627.07534342847453,539.8093249723031,-458.9267728238346,1570.9242567259498,1570.9242397552964]},"command":[0.06275678995098416,-0.23892247925909413,-0.21631032302704375,0.61641452674055675,0.61641452674055675],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,-1.7347234759768071e-18,0],"servo_effort":[-0.1368895293890271,-1.6123793899097598,-0.31574206851391884,-0.00019391685961062493,-0.00067229010325341166,0.00029274381054072052]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":558,"step":4464,"t":22.32,"sim_time":22.319999999999844,"vehicle":{"origin_ned":[1.5384795619179938,1.047457132705786,3.4548294339060566],"origin_quat_xyzw":[-0.022947313373703017,0.050562176075066648,0.40377656292345676,0.91317105429005074],"cg_ned":[1.48241842934473,0.98572528278831617,3.1620116413257779],"linear_velocity_ned":[-0.013571072944575437,-0.0073014428036170765,0.0060886464842670783],"angular_velocity_ned":[-0.0012573486900298288,0.0003904176210932015,-0.016257731576412974]},"sensors":{"Odom":[1.5384795619179938,1.047457132705786,3.4548294339060566,-0.014759641174225794,0.0039273002352520668,0.0043839314126050358,-0.022947313373703013,0.050562176075066641,0.40377656292345671,0.91317105429005074,0.0012486425856294697,0.001210357999245042,-0.016217987324723477],"Pressure":[26415.307961935705],"DVL":[-0.041870241859406465,-0.0077705378913511553,0.010255009837423204,7.4740516260766432,0.00052056669577107062,0.012886592435693314,-0.015859650395456861,0],"IMU":[-0.0010846893708146698,0.11110344122016066,0.83258606254915657,-0.14171147322449401,-0.020150759931905765,-0.048199967884800646,1.1080125196184145,0.024789079036383839,-9.7343297519423118],"FOG":[0.81638830077735214],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[6.7193170531338211,-25.012109769813147,-22.704424208006504,64.70602997978213,64.70602997978213],"omega_rad_s":[7.0693632217303781,-25.184567829985745,-22.574854174699695,64.883270863244974,64.883204488415046],"thrust_n":[0.65245821942117777,-7.8774773503367514,-6.3936515661168061,53.588726231286621,53.627679676775905],"torque_nm":[-0.012233591614147086,0.14770270031881408,0.1198809668646901,-1.0047886168366242,-1.0055189939395481],"angle_rad":[-626.79533638206192,538.80034561219236,-459.8300898767119,1573.5198841707743,1573.5198645231656]},"command":[0.063993495744131629,-0.2382105692363157,-0.21623261150482384,0.61624790456935363,0.61624790456935363],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.13781724892495828,-1.613373919131933,-0.31610633414441791,-0.00019548154740913664,-0.00068822153264965836,0.0002931065876273229]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":559,"step":4472,"t":22.359999999999999,"sim_time":22.359999999999836,"vehicle":{"origin_ned":[1.5379844434081817,1.0471446656252643,3.4550787104512781],"origin_quat_xyzw":[-0.022950519753676457,0.05058711572541133,0.40347885045246551,0.9133011740949295],"cg_ned":[1.481878490153397,0.98543456999470724,3.162264916995682],"linear_velocity_ned":[-0.013441415977341416,-0.0072412819494625386,0.0065197739906172562],"angular_velocity_ned":[-0.0012499871561702232,0.00041408295582797468,-0.016226678723149028]},"sensors":{"Odom":[1.5379844434081817,1.0471446656252643,3.4550787104512781,-0.01467687042076208,0.0038579188121552637,0.0048254308278606554,-0.022950519753676474,0.050587115725411365,0.40347885045246579,0.9133011740949295,0.0012675160244285026,0.0012208088679482052,-0.016184624302249071],"Pressure":[26416.753929190603],"DVL":[-0.0080613329545936047,0.024297152540246031,-0.0017676388705095826,7.4022251686121265,0.01922996577836978,-0.0047062554699181594,0.018908491542085386,0],"IMU":[-0.0011066399246155325,0.11115137399898761,0.83193400441686249,-0.054420500684874168,0.040374802399203942,-0.014804624598370508,1.1067463212463522,-0.0099216793836357006,-9.7534021645302413],"FOG":[0.84023471649452275],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[6.837525662181136,-24.944016382926232,-22.701967049201858,64.68710581863408,64.68710581863408],"omega_rad_s":[7.2165424773373728,-25.097601361889733,-22.56135129141374,64.864571722015299,64.864506475854171],"thrust_n":[0.67939723120686801,-7.8233835670391096,-6.3866376299589875,53.544850603579704,53.584120514961789],"torque_nm":[-0.012738698085128775,0.14668844188198332,0.11974945556173103,-1.0039659488171195,-1.0047022596555337],"angle_rad":[-626.50916192283171,537.79496357601067,-460.73275958381737,1576.1147936789005,1576.1147714022247]},"command":[0.065119292020772726,-0.23756206078977363,-0.21620920999239865,0.61606767446318167,0.61606767446318167],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.1386899381691149,-1.6141930951676695,-0.31640616704134766,-0.00019690716255768204,-0.00068783326493642317,0.00029387799126897777]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":560,"step":4480,"t":22.400000000000002,"sim_time":22.399999999999828,"vehicle":{"origin_ned":[1.5374948230629799,1.0468346294010129,3.455344954787738],"origin_quat_xyzw":[-0.022953405856992327,0.050612455546047687,0.40318172471992669,0.91343090453248221],"cg_ned":[1.4813438365870983,0.98514633139763863,3.1625352006154266],"linear_velocity_ned":[-0.013307420576175767,-0.0071781637919387112,0.0069403383889601947],"angular_velocity_ned":[-0.0012422332110911026,0.00044261787468966593,-0.016191531204898725]},"sensors":{"Odom":[1.5374948230629799,1.0468346294010129,3.455344954787738,-0.014586908665873376,0.0037867254159228516,0.0052568485100895649,-0.022953405856992334,0.050612455546047701,0.40318172471992686,0.91343090453248221,0.0012897661152237205,0.0012342590497958061,-0.016146759571473143],"Pressure":[26418.757221718501],"DVL":[-0.011503830982653025,0.009154280054186139,0.01287257481453764,7.3664350424931264,-0.030629555777187203,-0.016933560402275255,-0.0013596938692442581,0],"IMU":[-0.0011276311658513615,0.11119977943291645,0.83128338683520542,-0.0072367093690936576,0.05287408025515436,-0.12176636395250444,1.0894370148285404,0.014693859279648894,-9.7736546518927554],"FOG":[0.82898667197369402],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[6.9449346780392576,-24.882226056924111,-22.705026903357719,64.666870508096054,64.666870508096054],"omega_rad_s":[7.3488167596162475,-25.0174947846726,-22.553954547457611,64.844246094500335,64.844181809526091],"thrust_n":[0.70405015233627155,-7.7738791319522802,-6.3831628058028977,53.498547739244678,53.538228751972305],"torque_nm":[-0.013200940356305087,0.14576023372410526,0.11968430260880433,-1.0030977701108377,-1.0038417890994809],"angle_rad":[-626.21744401157764,536.79290353352189,-461.63502884108311,1578.7089177612067,1578.7088928968835]},"command":[0.066142235028945312,-0.23697358149451533,-0.2162383514605497,0.61587495721996244,0.61587495721996244],"arm":{"servo_position":[3.6462121401337282e-23,3.2526065174565154e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,8.6736173798840355e-19,0,0,0,0],"servo_effort":[-0.13951274034055197,-1.6148453205269531,-0.31664438920638288,-0.00019818541247644775,-0.00068693758665692832,0.00029451060202375327]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":561,"step":4488,"t":22.440000000000001,"sim_time":22.43999999999982,"vehicle":{"origin_ned":[1.5370109087379662,1.0465271370569376,3.4556277308561105],"origin_quat_xyzw":[-0.022955929273409562,0.050638279603673272,0.4028852617242295,0.91356020920099912],"cg_ned":[1.4808146292797404,0.9848606757714824,3.1628220661930109],"linear_velocity_ned":[-0.013169653510650369,-0.0071125117546753788,0.0073501865837208294],"angular_velocity_ned":[-0.0012340163596081407,0.00047598421572446817,-0.016152385289536528]},"sensors":{"Odom":[1.5370109087379662,1.0465271370569376,3.4556277308561105,-0.014490448485819226,0.0037138555549892107,0.0056779579140283868,-0.02295592927340958,0.050638279603673314,0.40288526172422984,0.91356020920099912,0.0013154184698574464,0.0012506356889513117,-0.016104486719970765],"Pressure":[26422.630764850495],"DVL":[-0.045225186915659632,-0.003968411295607017,-0.021894428262668329,7.4833356532265665,0.02330219984018253,0.0041862663979250125,0.014746122281847067,0],"IMU":[-0.0011475079114784874,0.11124877833961991,0.83063438705165848,-0.024168925099138764,0.13993104291002653,0.046647188322478286,1.0671715736963887,0.0040061516555133332,-9.7389666205295704],"FOG":[0.82863405192760387],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.0423098441518537,-24.826374647288695,-22.713377859554704,64.645430243628326,64.645430243628326],"omega_rad_s":[7.4675793073817935,-24.944097939586403,-22.552488974444902,64.822427359145323,64.822363857301156],"thrust_n":[0.72653596629948713,-7.7288198111611477,-6.3831179295121609,53.450048248563803,53.490234241474411],"torque_nm":[-0.013622549368115387,0.1449153714592715,0.11968346117835303,-1.0021884046605716,-1.0029418920276454],"angle_rad":[-625.92074650200539,535.79389428874561,-462.53713800760846,1581.3021944240952,1581.3021670065898]},"command":[0.067069617563350989,-0.23644166330751137,-0.21631788437671148,0.61567076422503164,0.61567076422503164],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.14017087644625142,-1.6154093500499289,-0.31683933247626378,-0.00019927247035911926,-0.00068560076354184072,0.00029503000798862788]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":562,"step":4496,"t":22.48,"sim_time":22.479999999999812,"vehicle":{"origin_ned":[1.5365328845488575,1.0462222826541114,3.4559265977246807],"origin_quat_xyzw":[-0.02295804532008917,0.050664667581773272,0.40258953891177246,0.9136890514681214],"cg_ned":[1.4802910070707871,0.98457769510568272,3.16312508206101],"linear_velocity_ned":[-0.013028649667661638,-0.0070447373599291617,0.0077491923505849103],"angular_velocity_ned":[-0.0012251471608307786,0.00051401217841161295,-0.01610919647190202]},"sensors":{"Odom":[1.5365328845488575,1.0462222826541114,3.4559265977246807,-0.014388208824601867,0.0036394441812737858,0.0060885715482327605,-0.022958045320089181,0.050664667581773293,0.40258953891177263,0.9136890514681214,0.0013444663660556904,0.0012696891936411602,-0.016057761506439297],"Pressure":[26422.524792881992],"DVL":[-0.020444508889959252,0.0344896461120359,-0.0015688229746824555,7.5040483211560902,-0.0087649581674446482,-0.027368027237777912,0.018497801014290868,0],"IMU":[-0.0011661143268315323,0.11129848185972835,0.82998718520173997,-0.063142896852940528,0.10885268297782812,0.1731882577414241,1.0887068949699881,0.025082054082816555,-9.7059905206561314],"FOG":[0.83503991275017386],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.1303296506464946,-24.776262523185508,-22.726427467812346,64.622880923347807,64.622880923347807],"omega_rad_s":[7.5740147856304416,-24.877224980611182,-22.556663623392431,64.799239057582781,64.79917615916068],"thrust_n":[0.7469646478829054,-7.6880449647052584,-6.3863303365928425,53.399568835812772,53.440345125712234],"torque_nm":[-0.014005587147804479,0.1441508430882236,0.11974369381111584,-1.0012419156714896,-1.0020064711071044],"angle_rad":[-625.61958238327588,534.7976716849397,-463.43931808811868,1583.8945667856328,1583.8945368422185]},"command":[0.067907901434728524,-0.23596440498271912,-0.21644216636011759,0.6154560087937887,0.6154560087937887],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.14072365406730214,-1.6158673439387983,-0.31698922065359475,-0.00020019042345001918,-0.00068385274550420815,0.00029543901193136989]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":563,"step":4504,"t":22.52,"sim_time":22.519999999999804,"vehicle":{"origin_ned":[1.5360609129297049,1.045920144136584,3.4562411108035667],"origin_quat_xyzw":[-0.022959709977827304,0.05069169792113936,0.40229462915034314,0.91381739687773178],"cg_ned":[1.4797730874418022,0.98429746570900001,3.1634438127687812],"linear_velocity_ned":[-0.012884938271384698,-0.006975219544395935,0.0081372814590452078],"angular_velocity_ned":[-0.0012157366711207135,0.00055665128162319256,-0.016062364474900819]},"sensors":{"Odom":[1.5360609129297049,1.045920144136584,3.4562411108035667,-0.014280796433787796,0.0035636386052998749,0.0064885414445527735,-0.022959709977827304,0.05069169792113936,0.40229462915034314,0.91381739687773178,0.0013768388097379815,0.0012914727417494556,-0.016006993530226523],"Pressure":[26427.060452054917],"DVL":[-0.02806428149065221,-0.020064062647474457,-0.014349646689979807,7.4447423649586222,0.035970617711955172,-0.033809573654144748,0.0275130643970747,0],"IMU":[-0.0011832974918894628,0.11134899957511979,0.82934195111705145,0.0037547545794181163,0.11797521131088143,0.084473027035699588,1.0940370819946776,0.011130160546164031,-9.7640974358378756],"FOG":[0.83655656838540948],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.2096357075440132,-24.731507042590472,-22.743901005613122,64.599307414501126,64.599307414501126],"omega_rad_s":[7.6691480592604755,-24.816638261818017,-22.566149729912254,64.774794390019537,64.774731917583537],"thrust_n":[0.76543975652380336,-7.6513650052597386,-6.392609302405214,53.347303120825821,53.388756077472216],"torque_nm":[-0.014351995434821312,0.1434630938486201,0.11986142442009778,-1.0002619335154843,-1.0010391764526041],"angle_rad":[-625.31442103696918,533.8039799569965,-464.34178705578017,1586.4859826712948,1586.4859502221093]},"command":[0.068663197214704888,-0.23553816231038543,-0.21660858100583927,0.61523149918572506,0.61523149918572506],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.14124866970188307,-1.616192103562792,-0.31708988126135684,-0.00020093512079415087,-0.00068172409791191402,0.00029573614467372878]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":564,"step":4512,"t":22.559999999999999,"sim_time":22.559999999999796,"vehicle":{"origin_ned":[1.5355951356444482,1.0456207850343038,3.456570823088454],"origin_quat_xyzw":[-0.022960881495699019,0.050719448314915948,0.40200059796119397,0.91394521428935416],"cg_ned":[1.4792609673536892,0.98402004919888375,3.1637778205102838],"linear_velocity_ned":[-0.01273901960784939,-0.0069043164830481603,0.0085144065666089615],"angular_velocity_ned":[-0.0012058758983697329,0.00060376953016433462,-0.016012279770583251]},"sensors":{"Odom":[1.5355951356444482,1.0456207850343038,3.456570823088454,-0.014168808031011594,0.0034865913355672427,0.0068777537245392891,-0.022960881495699026,0.050719448314915955,0.40200059796119408,0.91394521428935416,0.0014124174798669305,0.0013159694545779249,-0.015952588474490208],"Pressure":[26429.986288769476],"DVL":[0.0086174098125653374,-0.028999822983933155,-0.0044939931384071971,7.4239757885619273,0.015602678127823493,-0.013742928354158752,0.010744953922425599,0],"IMU":[-0.0011989102844648849,0.1114004417004943,0.82869883817042644,0.1340791715072599,-0.03266680785309814,0.12000316165031436,1.0783126717671918,0.027995396973057664,-9.7250515312540013],"FOG":[0.84889511914970062],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.2808438739070338,-24.691653739002554,-22.765627862920631,64.574784704512325,64.574784704512325],"omega_rad_s":[7.7538876242264081,-24.762021499773059,-22.580665421096484,64.749196030233577,64.749133808556948],"thrust_n":[0.78206182301463256,-7.6185462776614683,-6.4017932546122962,53.293426738462365,53.335642402740376],"torque_nm":[-0.014663659181524361,0.14284774270615255,0.12003362352398059,-0.9992517513461695,-1.000043295051382],"angle_rad":[-625.0056935827987,532.81257469901095,-465.24475084729232,1589.0763941939842,1589.0763592521155]},"command":[0.069341370227686036,-0.23515860703811955,-0.21681550345638695,0.61499794956678411,0.61499794956678411],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,-8.6736173798840355e-19,0,0,0,0],"servo_effort":[-0.14174725884658421,-1.6163993475472391,-0.31714629630088087,-0.0002014964068980073,-0.00067925723711576252,0.0002959311552119707]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":565,"step":4520,"t":22.600000000000001,"sim_time":22.599999999999788,"vehicle":{"origin_ned":[1.5351356739851687,1.0453242550370638,3.4569152864166859],"origin_quat_xyzw":[-0.022961520584063023,0.050747994076727282,0.40170750376203113,0.91407247584145845],"cg_ned":[1.4787547243949557,0.98374549333158523,3.1641266661437273],"linear_velocity_ned":[-0.012591365400281074,-0.0068323655793488388,0.0088805446675478301],"angular_velocity_ned":[-0.0011956279252901443,0.00065515990619115162,-0.015959317082735101]},"sensors":{"Odom":[1.5351356739851687,1.0453242550370638,3.4569152864166859,-0.014052830664117839,0.0034084579868508512,0.0072561261689630579,-0.022961520584063044,0.050747994076727317,0.40170750376203146,0.91407247584145845,0.001451046231814258,0.0013430908503595997,-0.01589494052164123],"Pressure":[26433.276970957173],"DVL":[-0.024077264079548102,0.066723036626788024,-0.055895611294878356,7.4071569084562334,-0.035597899787196192,-0.027951933616983837,0.025551375491972343,0],"IMU":[-0.0012128130287253271,0.11145291623561668,0.8280579836616494,0.013222700207777664,0.0073048319711023326,0.052047535325569341,1.0920442378215061,0.023487316055685901,-9.7316644187606407],"FOG":[0.81692828129273631],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.3445412259455987,-24.65623908036968,-22.791430664096382,64.549378805550006,64.549378805550006],"omega_rad_s":[7.8290526724438552,-24.713001639172635,-22.599958985715073,64.722536414945353,64.722474272340833],"thrust_n":[0.79692987735455312,-7.5893248954413428,-6.4137397982851221,53.238098354739364,53.281160127527521],"torque_nm":[-0.014942435200397874,0.14229984178952518,0.12025762121784606,-0.99821434415136312,-0.99902175239114122],"angle_rad":[-624.6937968945,531.82322549783032,-466.14840484862378,1591.6657573393302,1591.6657199109302]},"command":[0.06994801167567237,-0.23482132457494934,-0.21706124441996555,0.61475598862428571,0.61475598862428571],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.14222037962134249,-1.6165057916935517,-0.31716364946387843,-0.00020189102663179618,-0.00067649130007614491,0.00029603413110917954]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":566,"step":4528,"t":22.640000000000001,"sim_time":22.63999999999978,"vehicle":{"origin_ned":[1.5346826291063345,1.0450305905309509,3.4572740525920671],"origin_quat_xyzw":[-0.022961590425647906,0.05077740664177946,0.40141539829054523,0.91419915683351138],"cg_ned":[1.4782544179704171,0.98347383284230661,3.1644899100875952],"linear_velocity_ned":[-0.012442416921651328,-0.0067596831583779451,0.0092356938343682617],"angular_velocity_ned":[-0.0011850246733099291,0.00071055369649344695,-0.015903819805154623]},"sensors":{"Odom":[1.5346826291063345,1.0450305905309509,3.4572740525920671,-0.013933437826938875,0.0033293939356542723,0.0076236048637631434,-0.022961590425647903,0.050777406641779453,0.40141539829054518,0.91419915683351138,0.0014925414740837729,0.0013726833612514569,-0.015834415516989112],"Pressure":[26434.979134250301],"DVL":[-0.015227887721961304,-0.00083753263998671487,0.00076621309144331642,7.3808680841103129,-0.050212799051892291,0.005056932764784145,-0.022412910625879027,0],"IMU":[-0.0012248746738093715,0.11150652621206947,0.82741950962614985,0.048560636875668556,-0.039142392658128071,-0.055750543320030377,1.099999494401517,0.0074347712171455391,-9.7360408897581596],"FOG":[0.82801161004458501],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.4012838540419743,-24.624796977377422,-22.821122274987601,64.523147547606726,64.523147547606726],"omega_rad_s":[7.8953913889274236,-24.669165659836459,-22.62379629928596,64.69489817698468,64.694835947589567],"thrust_n":[0.81014211446094553,-7.5634170460861307,-6.4283182216305566,53.181460414587605,53.225446920545089],"torque_nm":[-0.01519016464614273,0.14181406961411497,0.12053096665557293,-0.99715238277351748,-0.99797712976022068],"angle_rad":[-624.37909673259946,530.83571781523074,-467.05293480743029,1594.2540315655021,1594.2539916499788]},"command":[0.070488417657542615,-0.23452187597502305,-0.21734402166654859,0.61450616712006412,0.61450616712006412],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.14266453825987985,-1.6165277670678344,-0.3171473479594859,-0.00020211615071281759,-0.00067346540178145743,0.00029605636487090866]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":567,"step":4536,"t":22.68,"sim_time":22.679999999999772,"vehicle":{"origin_ned":[1.5342360827994741,1.0447398148708547,3.4576466743783207],"origin_quat_xyzw":[-0.022961055886948811,0.050807752592477773,0.40112432782787755,0.91432523524930187],"cg_ned":[1.4777600905419583,0.98320509025062974,3.1648671131113857],"linear_velocity_ned":[-0.012292582693761052,-0.0066865673579998971,0.0095798709233904707],"angular_velocity_ned":[-0.0011739861585444082,0.00076972072329632864,-0.015846001428003926]},"sensors":{"Odom":[1.5342360827994741,1.0447398148708547,3.4576466743783207,-0.013811187184555575,0.00324952140096652,0.0079801614419622476,-0.022961055886948821,0.050807752592477801,0.40112432782787777,0.91432523524930187,0.0015368089891827923,0.0014045365754185601,-0.015771238692243131],"Pressure":[26440.384076665348],"DVL":[-0.045690185598861281,0.03958124471792307,0.0226975333786721,7.4121743652829508,0.0048882722774280492,0.05052579821123282,0.00013973507609409388,0],"IMU":[-0.001234971973816215,0.11156136725756338,0.82678352551136469,0.027545109238109485,-0.022410148774611144,0.099886485316936516,1.1087450187215837,0.025117869884006779,-9.7312550441797523],"FOG":[0.82400291032915252],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.4515940470862034,-24.596871340766675,-22.854498468956162,64.496141345689452,64.496141345689452],"omega_rad_s":[7.9535924257388455,-24.630076333796055,-22.651949861034719,64.666354722527657,64.666292249052603],"thrust_n":[0.82179583158637148,-7.540528658979496,-6.4454027281136677,53.123640069543725,53.168623292369986],"torque_nm":[-0.015408671842244466,0.14138491235586556,0.1208513011521313,-0.99606825130394494,-0.9969116867319372],"angle_rad":[-624.06193030746124,529.84985422137652,-467.958517281448,1596.8411794240528,1596.8411370143617]},"command":[0.070967562353201938,-0.23425591753111119,-0.21766189018053489,0.61424896519704242,0.61424896519704242],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-4.3706900078321748e-21],"servo_velocity":[0,0,0,0,-1.7347234759768071e-18,0],"servo_effort":[-0.14303517335474339,-1.6164799863896364,-0.31710216861663049,-0.0002022330071563395,-0.00065436984429263832,0.00029656287555378198]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":568,"step":4544,"t":22.719999999999999,"sim_time":22.719999999999764,"vehicle":{"origin_ned":[1.5337961030323817,1.0444519351730939,3.4580327063340608],"origin_quat_xyzw":[-0.022959873382417735,0.050839098100213573,0.40083434337974916,0.91445068729043311],"cg_ned":[1.4772717694321709,0.98293927609256815,3.165257837168157],"linear_velocity_ned":[-0.012142217912474012,-0.006613319096552701,0.0099131164786734633],"angular_velocity_ned":[-0.0011618701134439777,0.0008331410132000549,-0.015785288717144744]},"sensors":{"Odom":[1.5337961030323817,1.0444519351730939,3.4580327063340608,-0.013686585281650423,0.0031687215723425464,0.00832579128254427,-0.022959873382417739,0.05083909810021358,0.40083434337974927,0.91445068729043311,0.0015845650963590501,0.0014385062961679873,-0.015704752754605634],"Pressure":[26442.936414666488],"DVL":[-0.017921828370800887,0.014085862307819809,0.013288305499404081,7.4051620963292315,0.0065134494867807678,0.0034277109583692213,0.00029682079081570198,0],"IMU":[-0.0012429659909126336,0.1116175275945195,0.82615015176123319,-0.058873759715249573,0.067882278421246639,0.1471410894698178,1.0992135582289424,0.0068558497631418941,-9.7249018344476088],"FOG":[0.82555481242240569],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.4955199876812193,-24.572327180859705,-22.891022377551952,64.468403806933182,64.468403806933182],"omega_rad_s":[8.0041966800878672,-24.59535098444907,-22.684122468975634,64.636970848519098,64.636907984537359],"thrust_n":[0.83196743648070193,-7.5204056138314783,-6.4648264403064495,53.064748702313352,53.110795417564063],"torque_nm":[-0.015599389434013162,0.14100760525934022,0.12121549575574592,-0.99496403816837542,-0.99582741407932618],"angle_rad":[-623.74261004143034,528.86545399998056,-468.86531860355967,1599.427166205026,1599.4271212880733]},"command":[0.07138590464458304,-0.2340221636272353,-0.21800973692906622,0.61398479816126839,0.61398479816126839],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-6.7722931110941484e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,-1.0842021724855044e-19,0,0],"servo_effort":[-0.14316057028669768,-1.6163436351276421,-0.31702590430341315,-0.00020215714379511764,-0.00066679649962681311,0.00029588855046959272]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":569,"step":4552,"t":22.760000000000002,"sim_time":22.759999999999756,"vehicle":{"origin_ned":[1.533362745730996,1.0441669441837476,3.4584317054152631],"origin_quat_xyzw":[-0.022957992077634701,0.050871510665516498,0.40054550100632536,0.91457548711189673],"cg_ned":[1.4767894680033304,0.98267638969412696,3.1656616463468459],"linear_velocity_ned":[-0.01199167116493785,-0.0065401982577610969,0.010235492214161973],"angular_velocity_ned":[-0.0011487005853537953,0.00090069361662321011,-0.015721811798312779]},"sensors":{"Odom":[1.533362745730996,1.0441669441837476,3.4584317054152631,-0.013560081463717547,0.0030871004582960775,0.0086605105732017046,-0.022957992077634711,0.050871510665516519,0.40054550100632552,0.91457548711189673,0.0016357167132424093,0.0014745331640526453,-0.015635098689471497],"Pressure":[26447.045747269116],"DVL":[-0.026444258971013851,-0.0033749828756622618,-0.016114756207757933,7.464427349192059,0.0083389922764452434,-0.020337232289645013,0.040748070282024519,0],"IMU":[-0.0012487028458937209,0.11167509222179009,0.82551952059441791,-0.10792755251866287,-0.0071948891288419123,0.009670814027277385,1.1082734081583769,0.014896236365745427,-9.7128835400365165],"FOG":[0.8243242127014927],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.5329271022212687,-24.551189078497963,-22.930068269785114,64.439972290421835,64.439972290421835],"omega_rad_s":[8.0474979323091755,-24.56475359773416,-22.719875396026225,64.606803333579066,64.606739942978862],"thrust_n":[0.84068932531607587,-7.502886147627895,-6.4863429603899441,53.004882208956737,53.052057081914057],"torque_nm":[-0.015762924849676424,0.14067911526802304,0.12161893050731144,-0.99384154141793879,-0.99472607028588866],"angle_rad":[-623.42143297167013,527.88234803734474,-469.77348952895824,1602.0119596058582,1602.0119121629293]},"command":[0.071742162878297794,-0.23382084836664727,-0.21838160256938202,0.61371402181354129,0.61371402181354129],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,8.656676720938947e-21,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.14326146621363639,-1.6161160485886887,-0.31691908494900856,-0.00020195137897659286,-0.00064735804668701407,0.00029625863051525533]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":570,"step":4560,"t":22.800000000000001,"sim_time":22.799999999999748,"vehicle":{"origin_ned":[1.5329360505257901,1.043884825997168,3.4588432315910129],"origin_quat_xyzw":[-0.022955365915030428,0.05090505371979092,0.40025785126689384,0.91469961144667666],"cg_ned":[1.4763131860736827,0.98241642068210477,3.1660781074719022],"linear_velocity_ned":[-0.011841270666070859,-0.0064674365803634335,0.010547071333040352],"angular_velocity_ned":[-0.0011346423161605384,0.00097202611963127274,-0.015655887534155883]},"sensors":{"Odom":[1.5329360505257901,1.043884825997168,3.4588432315910129,-0.013432108497577663,0.0030048288872045487,0.0089843535962388608,-0.022955365915030435,0.050905053719790934,0.40025785126689395,0.91469961144667666,0.001689927863903306,0.0015125042715058814,-0.01556263271713642],"Pressure":[26452.917776098086],"DVL":[-0.021997357269633113,0.010591991371526626,0.01243384196494055,7.4830150170950374,0.0050769901982793087,0.024915869374202523,0.018564875244666646,0],"IMU":[-0.0012520414901585047,0.11173414266928182,0.8248917513720736,0.014782679012325555,-0.027924452805857179,-0.097499388054675451,1.0959354080715602,0.014433777398415863,-9.7757265414565264],"FOG":[0.82564913236770388],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.564321519762669,-24.53304819723051,-22.971501719286799,64.410878802649606,64.410878802649606],"omega_rad_s":[8.0838405110423093,-24.538003399227382,-22.758843983868452,64.575901637920651,64.575837593984474],"thrust_n":[0.84800974475872004,-7.4877822848409963,-6.5097492684717473,52.944124390897116,52.992488609546683],"torque_nm":[-0.015900182714226004,0.14039591784076869,0.12205779878384525,-0.99270233232932104,-0.99360916142900035],"angle_rad":[-623.09868354993409,526.90037746830842,-470.68316474019065,1604.5955294264356,1604.5954794335833]},"command":[0.072041157331073039,-0.23364807806886201,-0.21877620685035046,0.61343694097761525,0.61343694097761525],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.14333732339479602,-1.6158130236016464,-0.31678669482093341,-0.00020162279887072867,-0.00065947830993690558,0.00029546176899680553]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":571,"step":4568,"t":22.84,"sim_time":22.839999999999741,"vehicle":{"origin_ned":[1.5325160407988287,1.0436055569667915,3.4592668484481925],"origin_quat_xyzw":[-0.022951954366319405,0.050939785112162045,0.39997143882787123,0.91482303983090385],"cg_ned":[1.4758429109159479,0.98215934987637887,3.1665067905258435],"linear_velocity_ned":[-0.011691318508724563,-0.0063952453841705885,0.010847937024340525],"angular_velocity_ned":[-0.0011198340292930002,0.0010467386110011208,-0.015587811427409658]},"sensors":{"Odom":[1.5325160407988287,1.0436055569667915,3.4592668484481925,-0.013303083636864147,0.002922077751031431,0.0092973709322201979,-0.022951954366319416,0.050939785112162066,0.3999714388278714,0.91482303983090385,0.0017468433648543651,0.0015522546364164359,-0.015487691851008475],"Pressure":[26452.797532059227],"DVL":[0.0065336074408145969,-0.018840749101564448,-0.0073647206476023727,7.3426617388258215,-0.0092298069708530769,-0.0079438205100303954,0.021104940037698871,0],"IMU":[-0.0012528563535882914,0.11179475480149403,0.82426694955148139,0.029987422759239872,-0.050026006496369277,0.058078228116869461,1.1280575860263036,0.012296351583061133,-9.7589750616216442],"FOG":[0.83072408914407481],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.5902019333704622,-24.517500502211298,-23.015185780598127,64.381150603087136,64.381150603087136],"omega_rad_s":[8.1136284815015465,-24.514771385068691,-22.800734540440111,64.544308610429994,64.54424379624993],"thrust_n":[0.85399445584637779,-7.4748786259438083,-6.5348829712738983,52.882548363180334,52.932157930846969],"torque_nm":[-0.016012396047119588,0.14015397423644643,0.1225290557113856,-0.99154778180963155,-0.99247796120338083],"angle_rad":[-622.77463102679133,525.91939581139161,-471.5944660232451,1607.177847292668,1607.1777947210946]},"command":[0.072287637460671073,-0.23350000478296476,-0.21919224552950597,0.61315381526749657,0.61315381526749657],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.14338660561469785,-1.6154483950749401,-0.31663305781944767,-0.00020115771978234799,-0.00065565574343228405,0.00029517217600501987]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":572,"step":4576,"t":22.879999999999999,"sim_time":22.879999999999733,"vehicle":{"origin_ned":[1.5321027242270977,1.0433291062633538,3.4597021236976047],"origin_quat_xyzw":[-0.022947722297937078,0.050975756188083747,0.3996863029263712,0.91494575444418502],"cg_ned":[1.4753786183123185,0.98190515008545864,3.1669472690037122],"linear_velocity_ned":[-0.011542090818441606,-0.0063238166541707596,0.011138180678279531],"angular_velocity_ned":[-0.0011043910726846057,0.0011243988676960966,-0.015517851597544699]},"sensors":{"Odom":[1.5321027242270977,1.0433291062633538,3.4597021236976047,-0.013173405592011061,0.0028390152087183988,0.0095996269911555257,-0.022947722297937075,0.05097575618808374,0.39968630292637114,0.91494575444418502,0.0018060975678598828,0.0015935794061153899,-0.015410586845097683],"Pressure":[26459.006847432807],"DVL":[-0.033142208343591203,-0.0037938729475684085,-0.030504765897226761,7.441613039349849,-0.010023214771970013,-0.0081873801238927617,0.053340429769814637,0],"IMU":[-0.0012510377738969827,0.1118569969927769,0.82364520764231886,-0.018824209672435834,-0.02633492464001598,0.017727802075525601,1.0970250629460494,0.026174866543771633,-9.7167384644769985],"FOG":[0.80572168929976118],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.611051723524211,-24.504153732164042,-23.060979020662877,64.350810833588241,64.350810833588241],"omega_rad_s":[8.1373017230161153,-24.494699346162683,-22.845300186601015,64.512061157592669,64.511995467249022],"thrust_n":[0.85872129976588241,-7.4639439278673319,-6.561608422938451,52.820217566821626,52.871121977559362],"torque_nm":[-0.016101024370610294,0.13994894864751248,0.123030157930096,-0.99037907937790559,-0.9913335370792381],"angle_rad":[-622.44952762151024,524.93927045466091,-472.50750453426826,1609.7588864070972,1609.758831223571]},"command":[0.07248620689070677,-0.2333728926872766,-0.21962837162536072,0.61286486508179272,0.61286486508179272],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.14340644592095425,-1.6150341164722402,-0.3164619988387356,-0.00020059814745048338,-0.00065176281993606377,0.00029484233755053713]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":573,"step":4584,"t":22.920000000000002,"sim_time":22.919999999999725,"vehicle":{"origin_ned":[1.5316960934006592,1.0430554364431719,3.4601486296043897],"origin_quat_xyzw":[-0.022942639852131911,0.051013011099437247,0.39940247786829125,0.91506773992303603],"cg_ned":[1.4749202735676328,0.98165378684492688,3.1673991202279961],"linear_velocity_ned":[-0.011393838283238034,-0.0062533243344876782,0.011417900890306551],"angular_velocity_ned":[-0.0010884114305295184,0.0012045494008535833,-0.015446249380072698]},"sensors":{"Odom":[1.5316960934006592,1.0430554364431719,3.4601486296043897,-0.013043452903684144,0.00275580589747663,0.0098911984283663584,-0.022942639852131918,0.051013011099437261,0.39940247786829136,0.91506773992303603,0.0018673155926734538,0.001636243039392932,-0.015331602649625284],"Pressure":[26461.841354196502],"DVL":[-0.030068213493620162,-0.032905087103309742,-0.024469785617453464,7.3952839737663645,0.012639253866749167,0.025884997420717988,0.062032150449830653,0],"IMU":[-0.0012464922606944256,0.11192092873970845,0.82302660625669299,-0.043324918078270568,-0.043220648989387683,-0.074680495487913653,1.1073370613025908,0.024282162386681613,-9.7380130410383181],"FOG":[0.83533633742040247],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.6273402268413619,-24.492630597094838,-23.108735189241532,64.319878910788418,64.319878910788418],"omega_rad_s":[8.1553192668626249,-24.477414430628066,-22.892324134745614,64.479190880544238,64.479124220547092],"thrust_n":[0.86227612293528499,-7.4547398299774787,-6.589807085160623,52.757186732501317,52.80942796458654],"torque_nm":[-0.016167677305036595,0.13977637181207772,0.1235588828467617,-0.98919725123439994,-0.9901767743359976],"angle_rad":[-622.12360748796448,523.95988347886464,-473.422382273697,1612.3386213261629,1612.3385634934903]},"command":[0.072641335493727255,-0.23326314854376037,-0.22008319227849077,0.61257027534084207,0.61257027534084207],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,-4.3368086899420177e-19],"servo_effort":[-0.14339460817151234,-1.6145812854278636,-0.31627728838493541,-0.00019995375603961709,-0.00064780134832572551,0.00036955099773903479]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":574,"step":4592,"t":22.960000000000001,"sim_time":22.959999999999717,"vehicle":{"origin_ned":[1.5312961265182365,1.042784504026812,3.460605943315687],"origin_quat_xyzw":[-0.022936682340360226,0.05105158626363332,0.39911999354998701,0.91518898315694464],"cg_ned":[1.4744678325255354,0.98140521912160816,3.1678619255841167],"linear_velocity_ned":[-0.011246786593507158,-0.0061839252582422122,0.011687201662182676],"angular_velocity_ned":[-0.0010719776311736264,0.0012867144728009939,-0.015373216683236168]},"sensors":{"Odom":[1.5312961265182365,1.042784504026812,3.460605943315687,-0.012913582809290225,0.0026726097933971469,0.010172171946237808,-0.022936682340360243,0.051051586263633361,0.39911999354998734,0.91518898315694464,0.0019301169206276426,0.0016799854606247471,-0.015250995340986088],"Pressure":[26468.64707906804],"DVL":[-0.031971772539327245,0.019634302662573398,0.016198555633079093,7.4377510217319562,0.0021455302272964782,0.0453574820054942,0.035023484120347829,0],"IMU":[-0.0012391426568867541,0.11198659955680336,0.82241121522173077,-0.036777730065211109,0.080396467491937129,-0.052011677127937375,1.1089280354099718,0.01098997177537922,-9.750025488544674],"FOG":[0.82503439139273105],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.6395217621456935,-24.482572154352038,-23.158304252123649,64.288371378577878,64.288371378577878],"omega_rad_s":[8.1681479620881365,-24.462539921626217,-22.941608793817863,64.445724731863578,64.445657022599732],"thrust_n":[0.86474976218458233,-7.4470272405895805,-6.6193712116527754,52.693502949734658,52.747114665750317],"torque_nm":[-0.016214058040960919,0.13963176076105466,0.12411321021848952,-0.98800318030752488,-0.98900839998281853],"angle_rad":[-621.79708621655311,522.98113199113232,-474.33919303124731,1614.9170277625492,1614.9169672401047]},"command":[0.072757350115673275,-0.23316735385097179,-0.2205552785916538,0.61227020360550366,0.61227020360550366],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.1433472367939215,-1.6140993156513608,-0.31608214040740107,-0.00019920712431245653,-0.00064385598684131779,0.00029409353335310283]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":575,"step":4600,"t":23,"sim_time":22.999999999999709,"vehicle":{"origin_ned":[1.5309027880988149,1.0425162600816693,3.4610736471403225],"origin_quat_xyzw":[-0.022929830171184541,0.05109150995655818,0.39883887596255263,0.9153094730852549],"cg_ned":[1.4740212425352093,0.98115939997274204,3.1683352707304535],"linear_velocity_ned":[-0.011101137841510473,-0.0061157601885412482,0.01194619161992173],"angular_velocity_ned":[-0.0010551621477303641,0.001370403647808504,-0.015298939599680756]},"sensors":{"Odom":[1.5309027880988149,1.0425162600816693,3.4610736471403225,-0.0127841308907259,0.0025895826173914882,0.010442643010767798,-0.022929830171184547,0.051091509956558201,0.39883887596255274,0.9153094730852549,0.0019941147807208642,0.001724528434657889,-0.015168995817455316],"Pressure":[26473.821783569394],"DVL":[0.020342426232878835,-0.0012346882385666886,0.0033548917488557106,7.3617429157111287,-0.010890826732638817,0.010752793166492748,0.026702255891833091,0],"IMU":[-0.0012289282561871078,0.11205404814565624,0.82179909466154843,-0.045135239749594019,-0.16955123799207369,-0.070625474500521118,1.0924243157101814,0.019605986756691549,-9.7239696987321391],"FOG":[0.80555178828935181],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.6480376886838437,-24.473638883669505,-23.209533040188834,64.256302052263948,64.256302052263948],"omega_rad_s":[8.1762550863966865,-24.449703270754355,-22.992968374839823,64.411685589155653,64.411616766189852],"thrust_n":[0.86623586338860847,-7.4405710092661179,-6.6501995257302458,52.62920655756627,52.684213519583494],"torque_nm":[-0.016241922438536407,0.13951070642373969,0.12469124110744215,-0.98679762295436768,-0.9878290034921906],"angle_rad":[-621.47016070117991,522.00292808785287,-475.25802297527343,1617.4940824128737,1617.4940191571848]},"command":[0.072838454177941367,-0.23308227508256671,-0.22104317181132224,0.61196478145013278,0.61196478145013278],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.14326160102180432,-1.6135969743766958,-0.31587967808435991,-0.00019840032718690986,-0.0006398909284758414,0.00029368831290565154]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":576,"step":4608,"t":23.039999999999999,"sim_time":23.039999999999701,"vehicle":{"origin_ned":[1.5305160297182434,1.0422506507937823,3.4615513287547532],"origin_quat_xyzw":[-0.022922068775821203,0.051132802006261184,0.39855914768244749,0.91542920049595644],"cg_ned":[1.4735804433869055,0.9809162771730402,3.1688187457495895],"linear_velocity_ned":[-0.01095707099934283,-0.0060489545895066003,0.012194982973505131],"angular_velocity_ned":[-0.0010380283428741061,0.0014551177662356308,-0.01522357674029674]},"sensors":{"Odom":[1.5305160297182434,1.0422506507937823,3.4615513287547532,-0.012655410362774365,0.0025068747852271646,0.010702714480586106,-0.022922068775821206,0.051132802006261191,0.39855914768244749,0.91542920049595644,0.0020589197046247138,0.0017695803198694924,-0.015085807716637752],"Pressure":[26475.161155932488],"DVL":[-0.027387742565781845,0.0050348733875678368,-0.0046440398683178308,7.3956482122324374,0.016073287100397075,-0.0041671920293422813,-0.045623549354836861,0],"IMU":[-0.0012158048356777284,0.11212330174736169,0.8211902960568922,-0.017989701054956411,0.04061518201390469,-0.053254502449174762,1.102918217224272,0.023850799048187002,-9.7761108083928683],"FOG":[0.79404134310320329],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.6533166655515261,-24.465511288640922,-23.262266297928281,64.223682724734644,64.223682724734644],"omega_rad_s":[8.1801039192945311,-24.438541508344631,-23.046224477237924,64.377092830242006,64.377022845411389],"thrust_n":[0.86682936152135703,-7.4351430301094599,-6.6821946027944072,52.564332081243379,52.620749712770142],"torque_nm":[-0.016253050528525444,0.13940893181455236,0.12529114880239514,-0.98558122652331337,-0.98663905711444],"angle_rad":[-621.14300922488451,521.02519856164452,-476.17895102045662,1620.06976280764,1620.0696967730205]},"command":[0.072888730148109773,-0.23300486941562784,-0.22154539331360268,0.61165412118794893,0.61165412118794893],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.14313414600307392,-1.6130821692147559,-0.31567259494979466,-0.00019749811202818813,-0.00063594297957431524,0.000293270709966022]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":577,"step":4616,"t":23.080000000000002,"sim_time":23.079999999999693,"vehicle":{"origin_ned":[1.5301357907744995,1.0419876180299719,3.4620385813632075],"origin_quat_xyzw":[-0.02291338853164052,0.051175473609007552,0.39828082840386941,0.91554815780100784],"cg_ned":[1.4731453682142712,0.98067579380008618,3.1693119452720802],"linear_velocity_ned":[-0.0108147425960063,-0.0059836198312253281,0.012433690379022304],"angular_velocity_ned":[-0.0010206301076016058,0.0015403564213098745,-0.015147253055668294]},"sensors":{"Odom":[1.5301357907744995,1.0419876180299719,3.4620385813632075,-0.012527711779659228,0.0024246300072658274,0.010952495080820517,-0.022913388531640537,0.051175473609007587,0.39828082840386969,0.91554815780100784,0.0021241445381260655,0.001814840897645058,-0.015001600626301521],"Pressure":[26480.959295473447],"DVL":[-0.017920831892177268,-0.0037513814281473074,-0.023044288941302525,7.3728103811982608,0.012280039503995458,0.0037309258330422285,-0.0053866986478862044,0],"IMU":[-0.0011997445801995783,0.11219437571843033,0.82058486340572723,0.012421129010599408,-0.020748147974799326,-0.044731192147648355,1.0900553931468722,0.01999418407855038,-9.7415980226736067],"FOG":[0.81416815552242316],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.6557764710685356,-24.457891129932886,-23.316347198098033,64.19052335982002,64.19052335982002],"omega_rad_s":[8.1801509089788436,-24.428705519896276,-23.101203106774527,64.341962820788396,64.341891643039148],"thrust_n":[0.86662535217427683,-7.4305246847983435,-6.7152610551031184,52.498909004522254,52.556743120986297],"torque_nm":[-0.016249225353267692,0.13932233783996895,0.12591114478318347,-0.98435454383479226,-0.98543893351849321],"angle_rad":[-620.81579169074939,520.04788441620167,-477.10204905079411,1622.6440471825413,1622.6439783217593]},"command":[0.072912156867319389,-0.2329322964755513,-0.22206044950569556,0.61133831771257163,0.61133831771257163],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.14295739850170852,-1.6125613478913017,-0.31546333056768022,-0.00019653851475765215,-0.00063203117754267394,0.00029284636247804002]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":578,"step":4624,"t":23.120000000000001,"sim_time":23.119999999999685,"vehicle":{"origin_ned":[1.5297619996007261,1.0417270996740942,3.4625350037924889],"origin_quat_xyzw":[-0.022903784058267578,0.05121952764597671,0.39800393681819279,0.91566633821537591],"cg_ned":[1.4727159444688049,0.98043788868280657,3.1698144685696108],"linear_velocity_ned":[-0.010674283356779434,-0.0059198586029766452,0.012662431121119646],"angular_velocity_ned":[-0.0010029784309096733,0.0016256818893711571,-0.015069937162494228]},"sensors":{"Odom":[1.5297619996007261,1.0417270996740942,3.4625350037924889,-0.012401298913401724,0.002342969185671573,0.0111920984081702,-0.022903784058267585,0.051219527645976717,0.3980039368181929,0.91566633821537591,0.0021894598260748998,0.0018600203882320726,-0.014916380366737404],"Pressure":[26484.217954574844],"DVL":[-0.029529612142163972,0.002569134083357765,0.0019675637519555051,7.3869544932068667,0.0077672868608763901,-0.021810581200567582,0.0037253732986441647,0],"IMU":[-0.0011807342825907456,0.11226727352772539,0.81998283743087785,0.047137072228204201,-0.02576416191587173,-0.018174408277207309,1.1009562679002061,0.012896220526238414,-9.7483429185898256],"FOG":[0.82544518550836143],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.6557974059761538,-24.450541724910991,-23.371578125583955,64.156832621865618,64.156832621865618],"omega_rad_s":[8.1768384194870922,-24.41987118932877,-23.157724791310368,64.306309414799813,64.306237030692984],"thrust_n":[0.86571710580201489,-7.4265138459317983,-6.749299349344871,52.432962390352941,52.492209444500212],"torque_nm":[-0.016232195733787778,0.13924713461122121,0.12654936280021634,-0.98311804481911769,-0.98422892708437881],"angle_rad":[-620.48865002204843,519.07094011911624,-478.0273819318212,1625.216914369433,1625.2168426344115]},"command":[0.072912356247391938,-0.23286230214200945,-0.22258645833889482,0.61101745354157733,0.61101745354157733],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.14268841601649676,-1.6120361779502859,-0.31525320916414423,-0.00019554705644354238,-0.0006281747050444922,0.00029241919812720738]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":579,"step":4632,"t":23.16,"sim_time":23.159999999999677,"vehicle":{"origin_ned":[1.5293945744555852,1.0414690302938356,3.4630402005409677],"origin_quat_xyzw":[-0.022893254210090808,0.051264959124874242,0.39772849129592747,0.91578373543597202],"cg_ned":[1.4722920947430747,0.98020249689270633,3.1703259196681213],"linear_velocity_ned":[-0.010535808750969475,-0.0058577569688294581,0.012881324936133285],"angular_velocity_ned":[-0.00098513975158702602,0.0017106272387439787,-0.014991692090736902]},"sensors":{"Odom":[1.5293945744555852,1.0414690302938356,3.4630402005409677,-0.012276407229354604,0.0022620219675441111,0.011421642139562607,-0.022893254210090815,0.051264959124874263,0.39772849129592758,0.91578373543597202,0.0022544883979981794,0.0019048491333229648,-0.014830253182805869],"Pressure":[26489.81427849584],"DVL":[0.036811151844650142,-0.030528983683384282,-0.031665713462751759,7.355524068017318,-0.023822450272228114,-0.00096119743426511042,0.0143120024925362,0],"IMU":[-0.0011587748736996886,0.11234198754013398,0.81938425711327645,0.052481148502477877,0.024363066197255537,0.011319126472691093,1.1151801332236162,0.016771444890789643,-9.7268672950478976],"FOG":[0.82251795808380701],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.6537291125927167,-24.443284871555264,-23.427733643056975,64.122618020078235,64.122618020078235],"omega_rad_s":[8.1705840519121988,-24.411758286130965,-23.215588908390782,64.270144366385239,64.270070779949322],"thrust_n":[0.86419340928382127,-7.4229357844962234,-6.7841969804132596,52.366513375914437,52.427161144676539],"torque_nm":[-0.016203626424071648,0.13918004595930419,0.12720369338274862,-0.98187212579839578,-0.98300927146268524],"angle_rad":[-620.1617090417883,518.09433205956111,-478.95500681143858,1627.7883437055336,1627.7882690480524]},"command":[0.072892658215168729,-0.23279318925290726,-0.22312127279101882,0.61069160019122126,0.61069160019122126],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.14237140765846504,-1.611508785370263,-0.31504335194355565,-0.00019447424711975406,-0.00062438001854379747,0.00029199242480232399]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":580,"step":4640,"t":23.199999999999999,"sim_time":23.199999999999669,"vehicle":{"origin_ned":[1.529033423990408,1.0412133420478806,3.4635537818013811],"origin_quat_xyzw":[-0.022881802929256095,0.051311754975684375,0.39745450834266699,0.91590034430286715],"cg_ned":[1.4718737373858231,0.97996955038183897,3.1708459073926987],"linear_velocity_ned":[-0.010399417168114353,-0.0057973874110964886,0.013090491956172354],"angular_velocity_ned":[-0.00096719042253261636,0.0017947158242318552,-0.014912603665579297]},"sensors":{"Odom":[1.529033423990408,1.0412133420478806,3.4635537818013811,-0.012153250670886717,0.0021819160699445062,0.011641246879552751,-0.022881802929256116,0.051311754975684416,0.39745450834266732,0.91590034430286715,0.0023188423613564276,0.0019490574193012928,-0.014743349536970285],"Pressure":[26493.308191923672],"DVL":[0.0074522585299303338,0.010788414825753618,-0.019413557719515237,7.4191645206365422,-0.0010776420486115813,0.011199264401516824,0.00084425487986125082,0],"IMU":[-0.0011338833318381202,0.11241849929772768,0.81878915621743031,-0.056143366125704842,0.052684277369346957,0.13990747667005013,1.090921025530212,0.025279228757119181,-9.7506914952348538],"FOG":[0.82003179678100235],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.6499562497795495,-24.435885688402671,-23.484674565564855,64.087886320813993,64.087886320813993],"omega_rad_s":[8.1617996860426949,-24.404099316125897,-23.274608417575266,64.233477721803524,64.233402954073867],"thrust_n":[0.86214224205884171,-7.4196239291661463,-6.8198487295442041,52.299580149715631,52.361607809105799],"torque_nm":[-0.016165167038603285,0.13911794867186528,0.12787216367895388,-0.98061712780716825,-0.98178014642073386],"angle_rad":[-619.83507701984138,517.11803750469016,-479.88497308060181,1630.3583149582623,1630.3582373306463]},"command":[0.072856726188376658,-0.23272272084193021,-0.22366356729109385,0.61036082210299036,0.61036082210299036],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,1.0778494253810979e-21,-1.3512822486666261e-22,8.656676720938947e-21,-3.3881317890156997e-23],"servo_velocity":[0,0,-1.7347234759768071e-18,0,0,0],"servo_effort":[-0.14200479983456799,-1.6109837548514638,-0.31483561110674685,-0.00019338831989704436,-0.00060492287018036714,0.00029212204977089348]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":581,"step":4648,"t":23.240000000000002,"sim_time":23.239999999999661,"vehicle":{"origin_ned":[1.5286784479536886,1.0409599651865591,3.4640753634737189],"origin_quat_xyzw":[-0.022869439228437208,0.051359894103562079,0.39718200277918836,0.91601616071735337],"cg_ned":[1.4714607871917884,0.97973897845474578,3.171374045383526],"linear_velocity_ned":[-0.010265190075583587,-0.0057388113096673889,0.013290052665607352],"angular_velocity_ned":[-0.0009492069036481283,0.001877478312465858,-0.01483274001047535]},"sensors":{"Odom":[1.5286784479536886,1.0409599651865591,3.4640753634737189,-0.012032022209550224,0.0021027735579539453,0.011851035670118203,-0.022869439228437236,0.051359894103562141,0.3971820027791888,0.91601616071735337,0.0023821375718531624,0.0019923798693627657,-0.014655781719955876],"Pressure":[26497.42534058942],"DVL":[-0.0076963403287500041,0.0040963483498815297,-0.0056392014488674501,7.4294864604547426,-0.014442920703146967,-0.010937545185686568,0.010726051531125385,0],"IMU":[-0.0011060925715456478,0.11249677957978135,0.81819756369075769,0.0277641175584568,-0.15074437192572493,-0.15736991727560451,1.1060855338543789,0.0047061470653199091,-9.750658292497274],"FOG":[0.82184854112825179],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.6448530858342654,-24.428127408847747,-23.542264762521555,64.052643712435184,64.052643712435184],"omega_rad_s":[8.1508914697308779,-24.396638098726637,-23.33461044050269,64.196318171911287,64.196242260477206],"thrust_n":[0.8596504989986461,-7.4164191060578251,-6.8561568570703617,52.232178524325306,52.295556778666281],"torque_nm":[-0.016118446856224617,0.13905785823858427,0.12855294107006932,-0.97935334733109969,-0.98054168959999299],"angle_rad":[-619.50884587807502,516.14204417132828,-480.81732298199086,1632.9268082652293,1632.9267276210192]},"command":[0.072808124626993001,-0.23264883246521664,-0.22421204535734815,0.61002517821366842,0.61002517821366842],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,-4.3368086899420177e-19],"servo_effort":[-0.14158627518742126,-1.6104645141029847,-0.31463125033189432,-0.00019226350080807738,-0.00061699843973128795,0.00034372962133075229]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":582,"step":4656,"t":23.280000000000001,"sim_time":23.279999999999653,"vehicle":{"origin_ned":[1.5283295379404698,1.0407088285245938,3.4646045671382151],"origin_quat_xyzw":[-0.022856177119729114,0.051409347566738484,0.3969109880535584,0.9161311814978147],"cg_ned":[1.4710531560702613,0.97951070819956332,3.1719099520873772],"linear_velocity_ned":[-0.010133192675637451,-0.0056820794978048282,0.013480126981876152],"angular_velocity_ned":[-0.00093126488141211756,0.0019584579579736599,-0.014752154075167227]},"sensors":{"Odom":[1.5283295379404698,1.0407088285245938,3.4646045671382151,-0.011912893672561913,0.0020247095029798639,0.012051132822863721,-0.02285617711972911,0.051409347566738477,0.39691098805355834,0.9161311814978147,0.0024439983212143418,0.0020345584309095989,-0.014567645860161866],"Pressure":[26505.899318081429],"DVL":[-0.0036560880352194472,0.0018362591895838246,-0.0063452506373530473,7.399117446084567,0.0013609959930967848,0.023951644706956949,-0.00092611637846394567,0],"IMU":[-0.001075451117081872,0.11257678865045104,0.81760950436668622,-0.0027498288750263588,-0.010636305725042516,-0.00066734168428708718,1.0922616814401251,-0.0014382734745073053,-9.7558295650699485],"FOG":[0.82010312826671505],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.6387832757087581,-24.41981283902259,-23.600371638250028,64.016896138325521,64.016896138325521],"omega_rad_s":[8.1382582174812086,-24.389132745466458,-23.395432873406165,64.158673374703085,64.15859637316872],"thrust_n":[0.85680342372634821,-7.4131713273413471,-6.8930291504215075,52.164322445479961,52.229013775042539],"torque_nm":[-0.016065064194869035,0.1389969623876503,0.12924429657040329,-0.97808104585274935,-0.97929400828204771],"angle_rad":[-619.18309145402895,515.16634970389123,-481.75209209505334,1635.4938040872239,1635.4937203818256]},"command":[0.072750316911511986,-0.23256964608592942,-0.22476544417380978,0.60968472512690974,0.60968472512690974],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-6.7722931110941484e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,-1.0842021724855044e-19,0,0],"servo_effort":[-0.14111479747259856,-1.609954037856133,-0.31443170564894207,-0.00019109287455026296,-0.00061348226829726737,0.00029075418810025103]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":583,"step":4664,"t":23.32,"sim_time":23.319999999999645,"vehicle":{"origin_ned":[1.527986578135401,1.0404598598631476,3.4651410200176618],"origin_quat_xyzw":[-0.022842035488871069,0.051460078823690247,0.39664147650505727,0.91624540425481682],"cg_ned":[1.4706507536516988,0.97928466488710009,3.172453250745296],"linear_velocity_ned":[-0.010003475649778194,-0.0056272334051171756,0.013660834724918115],"angular_velocity_ned":[-0.00091343955827941797,0.0020372130726750157,-0.014670885152526477]},"sensors":{"Odom":[1.527986578135401,1.0404598598631476,3.4651410200176618,-0.011796017211595143,0.0019478319499187217,0.012241664052988663,-0.022842035488871079,0.051460078823690275,0.39664147650505743,0.91624540425481682,0.0025040590737948295,0.0020753443078799353,-0.014479023249080918],"Pressure":[26508.189817285474],"DVL":[0.00042108648644591413,-0.046332638440515321,-0.015815310221368312,7.3861419684222192,-0.0038751375296658314,-0.0050261231012009482,0.010184594663345979,0],"IMU":[-0.0010420226263602459,0.11265847659114986,0.81702499957190844,-0.050186340708772363,0.011398490883909481,-0.10477423303946755,1.1207678715402576,-0.00052064523095299818,-9.7102985328244991],"FOG":[0.82922106552950259],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.6320975971573448,-24.41076239614522,-23.658867352304831,63.980649430752045,63.980649430752045],"omega_rad_s":[8.1242893552772006,-24.381357238831189,-23.45692253519119,64.120550257547421,64.120472234890556],"thrust_n":[0.85368399849715226,-7.4097407209297677,-6.9303778553038908,52.096024461153718,52.161983431067505],"torque_nm":[-0.016006574971821605,0.13893263851743315,0.12994458478694793,-0.97680045864663234,-0.9780371893325156],"angle_rad":[-618.85787384219918,514.19096106332404,-482.68930972248774,1638.0592831741294,1638.0591963654413]},"command":[0.072686643782450905,-0.23248345139185925,-0.22532254621242698,0.60933951838811473,0.60933951838811473],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-6.7722931110941484e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,-1.0842021724855044e-19,0,0],"servo_effort":[-0.1405890580023961,-1.6094541456774976,-0.31423765009163002,-0.00018991091449383803,-0.00061003930698569223,0.00029036507948395707]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":584,"step":4672,"t":23.359999999999999,"sim_time":23.359999999999637,"vehicle":{"origin_ned":[1.5276494460295289,1.0402129864026026,3.4656843549252643],"origin_quat_xyzw":[-0.022827038000428023,0.051512044027588043,0.3963734795933429,0.91635882727853524],"cg_ned":[1.470253487846225,0.97906077233663724,3.1730035693750889],"linear_velocity_ned":[-0.0098760759442703076,-0.0055743053318176323,0.013832294864890068],"angular_velocity_ned":[-0.00089580849540916909,0.0021133198048264457,-0.014588961152972611]},"sensors":{"Odom":[1.5276494460295289,1.0402129864026026,3.4656843549252643,-0.011681524734457807,0.0018722421583665201,0.012422755438651779,-0.022827038000428044,0.051512044027588091,0.39637347959334324,0.91635882727853524,0.0025619647704051545,0.0021145019724510806,-0.014389982588751326],"Pressure":[26512.766299241161],"DVL":[-0.021219512945321831,-0.0037460358251032856,0.0030349450925179888,7.428615324821048,-0.028776315255685813,-0.0094271897737219588,0.013090906570625133,0],"IMU":[-0.0010058854392676728,0.11274178374561454,0.81644406765820221,-0.024687919354800567,0.0095970916115704092,-0.090701012355852345,1.1025251221633912,0.013533699714032722,-9.6895554632443233],"FOG":[0.82133575091933997],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.6251357614327127,-24.400812968096751,-23.717629371704739,63.943909391211079,63.943909391211079],"omega_rad_s":[8.1093638589149339,-24.373102095637684,-23.518933993006538,64.081955227481998,64.081876267301496],"thrust_n":[0.85037258897970636,-7.4059979188377074,-6.9681190131839257,52.027296037489492,52.094469721286046],"torque_nm":[-0.015944486043369496,0.13886246097820704,0.13065223149719862,-0.97551180070292787,-0.97677130727411343],"angle_rad":[-618.5332377977694,513.21589387481072,-483.62899921737255,1640.6232265404544,1640.6231365894653]},"command":[0.072620340585073453,-0.23238869493425476,-0.22588218449242609,0.6089896132496293,0.6089896132496293],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.14000870068594753,-1.6089664484984203,-0.31405004187168417,-0.00018868908984453049,-0.00060670979883977556,0.00028999176687502103]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":585,"step":4680,"t":23.400000000000002,"sim_time":23.399999999999629,"vehicle":{"origin_ned":[1.52731801316323,1.0399681351133838,3.466234210188234],"origin_quat_xyzw":[-0.022811212947655569,0.051565192384306291,0.39610700810740718,0.9164714494333277],"cg_ned":[1.4698612653786027,0.97883895325748627,3.1735605407356178],"linear_velocity_ned":[-0.0097510179970024414,-0.0055233195859239479,0.013994625667976737],"angular_velocity_ned":[-0.00087844874467025839,0.0021863752355652929,-0.014506400536151792]},"sensors":{"Odom":[1.52731801316323,1.0399681351133838,3.466234210188234,-0.011569529551471371,0.0017980333920916492,0.012594533364966078,-0.02281121294765558,0.051565192384306305,0.39610700810740729,0.9164714494333277,0.0026173752000692059,0.0021518092320225355,-0.014300581438319786],"Pressure":[26519.204855892243],"DVL":[-0.024392235662077821,0.019697862710923556,-0.043166027238301402,7.321340690368225,0.01696821336398819,-0.049045528428574812,0.018532761589088977,0],"IMU":[-0.00096713197670590786,0.11282664123900089,0.81586672449956132,0.047382094707887595,0.03692316863528413,-0.11979638958063753,1.103775709061094,0.0073305758738605939,-9.7628040238320342],"FOG":[0.81872022547476908],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.618221608762159,-24.389818664455131,-23.776540831459286,63.906682084526615,63.906682084526615],"omega_rad_s":[8.0938487316846093,-24.364174888008655,-23.581329112179326,64.04289442151422,64.042814621156694],"thrust_n":[0.84694653881034943,-7.4018243686922558,-7.0061722234094459,51.958147967947184,52.026476388995292],"torque_nm":[-0.015880247602694054,0.1387842069129798,0.13136572918892714,-0.97421527439900979,-0.97549643229366167],"angle_rad":[-618.20921318280796,512.24117175468518,-484.57117828355786,1643.1856154503339,1643.1855223216894]},"command":[0.072554491512020564,-0.23228398728052507,-0.22644324601389795,0.60863506747168206,0.60863506747168206],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-1.1180834903756615e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.13937346571324363,-1.6084911143005427,-0.31386920378603905,-0.00018745137776835842,-0.00060348777277805627,0.0002896357345716084]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":586,"step":4688,"t":23.440000000000001,"sim_time":23.439999999999621,"vehicle":{"origin_ned":[1.5269921458253848,1.0397252330813131,3.4667902295678217],"origin_quat_xyzw":[-0.022794593100993629,0.051619466549619873,0.39584207231934382,0.91658327007447615],"cg_ned":[1.4694739922520799,0.97861912956272812,3.1741238022935088],"linear_velocity_ned":[-0.0096283148236174544,-0.0054742927453736113,0.014147944358750372],"angular_velocity_ned":[-0.00086143793967685906,0.0022559985312469305,-0.014423214202145601]},"sensors":{"Odom":[1.5269921458253848,1.0397252330813131,3.4667902295678217,-0.011460126773276784,0.0017252914127560898,0.012757123992495486,-0.022794593100993635,0.051619466549619887,0.39584207231934393,0.91658327007447615,0.0026699652652961473,0.0021870588593225033,-0.014210868082064823],"Pressure":[26522.657116360384],"DVL":[-0.032157006630086964,0.01228938243366173,-0.031679270836724047,7.3548012322067136,0.012400174782259422,0.017100041642989623,-0.0045955620168318832,0],"IMU":[-0.00092586811374787683,0.11291297156926812,0.81529298387150151,0.041261349879916004,0.061212716927943091,-0.089702510018539558,1.108199791030825,0.017940526932582621,-9.7184505290956089],"FOG":[0.82187067767191113],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.6116655947935241,-24.37764791160636,-23.835492017785818,63.868973872339971,63.868973872339971],"omega_rad_s":[8.0780978494817237,-24.354399824014461,-23.643976995019109,64.003373884399366,64.003293353981306],"thrust_n":[0.84347988484561298,-7.3971120700337485,-7.0444606441889865,51.888590648184696,51.958007279549982],"torque_nm":[-0.015815247840855248,0.13869585131313281,0.13208363707854354,-0.97291107465346305,-0.97421263649156242],"angle_rad":[-617.88581547760282,511.26682563591777,-485.51585926387844,1645.7464314107806,1645.7463350733108]},"command":[0.072492053283747845,-0.23216807534863201,-0.22700468588367445,0.60827594164133303,0.60827594164133303],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-1.1180834903756615e-21],"servo_velocity":[0,0,1.7347234759768071e-18,0,0,0],"servo_effort":[-0.13868403166870474,-1.6080294530063397,-0.3136958426145014,-0.00018621179205303507,-0.00060039003264815807,0.00028929857843741657]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":587,"step":4696,"t":23.48,"sim_time":23.479999999999613,"vehicle":{"origin_ned":[1.5266717057348722,1.0394842078111344,3.4673520621767167],"origin_quat_xyzw":[-0.022777215527723355,0.051674803036189328,0.3955786821133519,0.91669428897612215],"cg_ned":[1.4690915741797341,0.9784012226575407,3.1746929961868933],"linear_velocity_ned":[-0.0095079693502863223,-0.0054272345782905729,0.014292367408050998],"angular_velocity_ned":[-0.0008448542993222596,0.0023218318628073329,-0.014339407495203927]},"sensors":{"Odom":[1.5266717057348722,1.0394842078111344,3.4673520621767167,-0.011353394713092883,0.0016540945222471167,0.012910653322234601,-0.022777215527723372,0.051674803036189362,0.39557868211335218,0.91669428897612215,0.0027194258285128258,0.002220059270336867,-0.014120883446128642],"Pressure":[26527.098955638896],"DVL":[0.020929801599144107,-0.013846197180108832,-0.01252379329281591,7.45490014817325,-0.0080069471598544651,0.009996576564662768,0.03994381812768931,0],"IMU":[-0.00088221249610415553,0.11300068919507,0.81472285777905185,-0.020626410869957788,-0.029732431548641892,-0.19887150945363066,1.1132807841205228,0.0020421731710789258,-9.7261000348640874],"FOG":[0.80642549263546071],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.6057617370732871,-24.364182775857877,-23.894380133035536,63.830791488607964,63.830791488607964],"omega_rad_s":[8.0624507603410471,-24.343617190488828,-23.706754035476425,63.963399730411595,63.963318591776662],"thrust_n":[0.84004310019095274,-7.3917632328754213,-7.0829110657563881,51.818634337152083,51.889066606828059],"torque_nm":[-0.015750808128580367,0.13859556061641415,0.13280458248293228,-0.97159939382160176,-0.97291999887802616],"angle_rad":[-617.56304633111972,510.29289311414851,-486.46304943106082,1648.3056561718765,1648.3055565990844]},"command":[0.072435826067364636,-0.23203983596055119,-0.22756552507652891,0.60791229989150442,0.60791229989150442],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-1.1180834903756615e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.13794072902975524,-1.6075808796235909,-0.31353004654160038,-0.00018493014182954527,-0.00059740544081720995,0.00028898144214550961]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":588,"step":4704,"t":23.52,"sim_time":23.519999999999605,"vehicle":{"origin_ned":[1.526356550700346,1.0392449875053387,3.4679193623917817],"origin_quat_xyzw":[-0.022759121405994585,0.051731132641317748,0.39531684709913284,0.91680450626514387],"cg_ned":[1.4687139169799075,0.97818515370317161,3.1752677691874389],"linear_velocity_ned":[-0.0093899747985835263,-0.0053821483670046556,0.014428010048176136],"angular_velocity_ned":[-0.0008287741990582072,0.0023835426495873169,-0.014254980703206004]},"sensors":{"Odom":[1.526356550700346,1.0392449875053387,3.4679193623917817,-0.011249395385803752,0.0015845126773633114,0.013055246657439852,-0.022759121405994599,0.051731132641317783,0.39531684709913312,0.91680450626514387,0.0027654670042499248,0.002250634342481149,-0.014030661224227864],"Pressure":[26532.825662556483],"DVL":[-0.031355559055266123,-0.0051883755949779049,0.011589465513522709,7.3332758524121004,-0.010708406789188715,0.017787865045061718,-0.019170896377016477,0],"IMU":[-0.00083629583276862297,0.11308970115886635,0.81415635675264686,-0.027879937082823981,-0.042457749638996962,0.080597475022132159,1.1121531685659334,0.011565546387889376,-9.7025435140107668],"FOG":[0.82119263661015085],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.6007887303796826,-24.349318374794105,-23.953109352282283,63.792142076718186,63.792142076718186],"omega_rad_s":[8.0472320084737241,-24.331682605559205,-23.769544001495582,63.922978255781736,63.922896641402922],"thrust_n":[0.83670298052896719,-7.3856898334549026,-7.1214540095256131,51.748289348141512,51.819659151505519],"torque_nm":[-0.015688180884918135,0.13848168437727945,0.13352726267860524,-0.97028042527765346,-0.97161860909072861],"angle_rad":[-617.24089415031585,509.31941782271679,-487.41275128186464,1650.8632717321386,1650.8631689026427]},"command":[0.072388464098854119,-0.23189827023613435,-0.22812485097411697,0.60754421025445893,0.60754421025445893],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-1.1180834903756615e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.13714534273252008,-1.6071457338978794,-0.31337211369523199,-0.00018366453884087927,-0.00059454385812978121,0.00028868503897119742]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":589,"step":4712,"t":23.559999999999999,"sim_time":23.559999999999597,"vehicle":{"origin_ned":[1.5260465352757531,1.0390075012851301,3.4684917897528993],"origin_quat_xyzw":[-0.022740355761836514,0.051788380916635568,0.39505657669606731,0.91691392236733038],"cg_ned":[1.4683409269233789,0.97797084385872679,3.1758477726500183],"linear_velocity_ned":[-0.0092743163745353831,-0.0053390317444257937,0.014554986486404988],"angular_velocity_ned":[-0.00081327242942440779,0.0024408245513130103,-0.014169930936873187]},"sensors":{"Odom":[1.5260465352757531,1.0390075012851301,3.4684917897528993,-0.011148176017325062,0.0015166078912690394,0.013191028561841893,-0.022740355761836518,0.051788380916635582,0.39505657669606742,0.91691392236733038,0.0028078188703956411,0.0022786243355873456,-0.01394022968314473],"Pressure":[26539.561991647388],"DVL":[0.043152876109170485,0.035818224351046049,-0.05411493261883462,7.3539572838855722,0.0070475039189537656,-0.013515738050494639,-0.0060079864094419316,0],"IMU":[-0.00078826001801324014,0.11317990772761125,0.81359349009022863,0.047647282242795068,0.092664833233802507,-0.069128479633057655,1.1169882022358906,0.0079591816977564421,-9.7157788979133599],"FOG":[0.81719912364291625],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.5970044567404553,-24.332961695286198,-24.01159109584588,63.753033441505217,63.753033441505217],"omega_rad_s":[8.0327491561845932,-24.318466278014029,-23.832238112463493,63.882116089838661,63.882034141686859],"thrust_n":[0.83352229260373656,-7.3788131598886801,-7.160023822067286,51.677566287866043,51.749790523730788],"torque_nm":[-0.015628542986320063,0.13835274674791276,0.13425044666376162,-0.96895436789748812,-0.97030857231995238],"angle_rad":[-616.91933474296366,508.34644883512811,-488.36496283349845,1653.4192603491597,1653.4191542470949]},"command":[0.072352423397528148,-0.23174249233605904,-0.22868181996043696,0.60717174706195443,0.60717174706195443],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-1.1180834903756615e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.13629872490537395,-1.606723175397367,-0.31322202106675368,-0.00018237109034449907,-0.00059180751080530221,0.00028840973156346128]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":590,"step":4720,"t":23.600000000000001,"sim_time":23.599999999999589,"vehicle":{"origin_ned":[1.5257415113672639,1.0387716793979755,3.4690690088752802],"origin_quat_xyzw":[-0.022720967235496711,0.051846468619664667,0.39479788021059659,0.91702253795682298],"cg_ned":[1.4679725110480444,0.97775821449908551,3.1764326624752357],"linear_velocity_ned":[-0.0091609717279758536,-0.0052978770490114289,0.014673409868773597],"angular_velocity_ned":[-0.00079842104404586993,0.0024933981480169238,-0.014084251590016732]},"sensors":{"Odom":[1.5257415113672639,1.0387716793979755,3.4690690088752802,-0.011049769713684467,0.0014504340531550804,0.01331812276679414,-0.022720967235496728,0.051846468619664694,0.39479788021059686,0.91702253795682298,0.0028462326422659988,0.0023038855737900926,-0.01384961098182833],"Pressure":[26541.910123055186],"DVL":[-0.011054999532432035,0.033888012607001458,0.012592675601613609,7.4116750236021058,-0.028526854235929846,0.013428361146859871,0.0065897740179781256,0],"IMU":[-0.00073825732400598803,0.11327120302510651,0.8130342660804214,0.046627685819531563,-0.046740828031995772,0.18968849321167716,1.1165928019569418,-0.0090029667251809355,-9.7464643831567592],"FOG":[0.819242672444085],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.5946491752903782,-24.315030688433982,-24.069743689544797,63.713473878879412,63.713473878879412],"omega_rad_s":[8.0192920918667987,-24.303852067658632,-23.894735040203877,63.840820268018199,63.840738136416697],"thrust_n":[0.830559712528806,-7.3710632518713091,-7.1985587316326001,51.606476177796324,51.679467270869445],"torque_nm":[-0.015572994609915115,0.13820743597258703,0.13497297621811125,-0.96762142833368125,-0.96899001132880214],"angle_rad":[-616.59833201491506,507.37404010355033,-489.3196779222078,1655.9736045548229,1655.9734951701948]},"command":[0.072329992145622649,-0.23157172084222841,-0.22923565418614092,0.60679498932266107,0.60679498932266107],"arm":{"servo_position":[3.6462121401337282e-23,3.2526065174565154e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-1.1180834903756615e-21],"servo_velocity":[0,8.6736173798840355e-19,0,0,0,0],"servo_effort":[-0.13540255278291433,-1.6063127730120002,-0.31307982457461342,-0.00018108282822467414,-0.00058919541980045561,0.00028815607113260303]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":591,"step":4728,"t":23.640000000000001,"sim_time":23.639999999999581,"vehicle":{"origin_ned":[1.5254413288186874,1.0385374533837322,3.4696506893619814],"origin_quat_xyzw":[-0.02270100780341517,0.051905312187875384,0.39454076688747297,0.91713035391662456],"cg_ned":[1.4676085774267194,0.97754718741354651,3.1770220990729636],"linear_velocity_ned":[-0.0090499122374435078,-0.0052586718593980609,0.014783392685434249],"angular_velocity_ned":[-0.00078428836917360484,0.0025410110964466217,-0.013997935888650986]},"sensors":{"Odom":[1.5254413288186874,1.0385374533837322,3.4696506893619814,-0.010954196947872908,0.0013860370230173115,0.013436652450777943,-0.02270100780341518,0.051905312187875412,0.39454076688747319,0.91713035391662456,0.0028804818224065212,0.0023262898901255102,-0.013758824608190725],"Pressure":[26548.516069799716],"DVL":[-0.021730095806351161,0.023372882162200934,-0.044768763099933391,7.4234280165086428,-0.016221180057398466,-0.015903619739131302,0.0018902360019549694,0],"IMU":[-0.00068644949808364573,0.11336347567223977,0.81247869217447322,-0.032892293493197951,-0.018371011900882223,0.074569838566168473,1.1089184760622719,0.018915743392063242,-9.7604141804679045],"FOG":[0.80344283134276362],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.5939431535946911,-24.295453493416584,-24.127492114778491,63.673472310035898,63.673472310035898],"omega_rad_s":[8.0071319141811319,-24.287736735355114,-23.956940743094499,63.799098311007207,63.7990161534808],"thrust_n":[0.82786969829033408,-7.3623784396675198,-7.237000807266754,51.535030580566477,51.608696995983969],"torque_nm":[-0.015522556842943765,0.13804459574376599,0.13569376513625167,-0.96628182338562152,-0.96766306867469953],"angle_rad":[-616.27783870312874,506.40224992832003,-490.27688649688469,1658.5262871733755,1658.526174502369]},"command":[0.072323268129473248,-0.23138527136587222,-0.22978563918836659,0.60641402200034189,0.60641402200034189],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,4.3198680309969292e-21,-1.1180834903756615e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.13445882520822749,-1.6059138089543588,-0.31294551204462884,-0.00017976554987677199,-0.00057106659836864788,0.0002884725686704759]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":592,"step":4736,"t":23.68,"sim_time":23.679999999999573,"vehicle":{"origin_ned":[1.5251458359889238,1.0383047562080157,3.4702365057188462],"origin_quat_xyzw":[-0.02268053247337767,0.051964824218621405,0.39428524595061815,0.91723737130380389],"cg_ned":[1.4672490354164618,0.97733768498661744,3.1776157473277595],"linear_velocity_ned":[-0.0089411032737151397,-0.005221399421103121,0.014885046206099026],"angular_velocity_ned":[-0.00077093797686841013,0.0025834404970204606,-0.013910974805444192]},"sensors":{"Odom":[1.5251458359889238,1.0383047562080157,3.4702365057188462,-0.010861465714728567,0.0013234540534156662,0.013546739567633094,-0.022680532473377684,0.051964824218621433,0.39428524595061837,0.91723737130380389,0.0029103643351273602,0.0023457255623950319,-0.01366788503120624],"Pressure":[26554.703937943268],"DVL":[-0.039812125451487372,0.0075831502899591317,-0.031988950873655692,7.3424286198235018,0.023495217178824496,0.034319147093279642,0.0033171937060503839,0],"IMU":[-0.00063300680831179139,0.11345660941858907,0.81192677513858724,-0.074981487052836596,0.015267530675494471,0.024253159523700569,1.1125199465651494,0.016999387918480335,-9.7351280298893261],"FOG":[0.80188475957261618],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.5950846131425784,-24.27416749252593,-24.184768219894632,63.633038186736876,63.633038186736876],"omega_rad_s":[7.9965197035225017,-24.270028843128788,-24.018768548492783,63.756958245730132,63.756876225869206],"thrust_n":[0.82550235230710345,-7.3527046864638486,-7.275296066130414,51.463241636541632,51.537488408652649],"torque_nm":[-0.01547816910575819,0.13786321287119718,0.13641180123994526,-0.96493578068515573,-0.96632790766223731],"angle_rad":[-615.9577971531138,505.43114046932254,-491.23657491362462,1661.0772913412802,1661.0771753865208]},"command":[0.072334139172786457,-0.23118254754786599,-0.2303311259037584,0.6060289351117798,0.6060289351117798],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-1.1180834903756615e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.13346987310062289,-1.6055249793580715,-0.31281877604915187,-0.00017847480358022138,-0.00058434340357929853,0.00028771445962951116]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":593,"step":4744,"t":23.719999999999999,"sim_time":23.719999999999565,"vehicle":{"origin_ned":[1.5248548802962407,1.0380735223685267,3.4708261372573253],"origin_quat_xyzw":[-0.022659598964887669,0.052024913950885744,0.39403132664009183,0.91734359131647203],"cg_ned":[1.4668937958699768,0.97712963036040645,3.1782132765518343],"linear_velocity_ned":[-0.008834505391284846,-0.0051860392021550435,0.014978480749288972],"angular_velocity_ned":[-0.00075842858343139045,0.0026204906069873871,-0.01382335893871095]},"sensors":{"Odom":[1.5248548802962407,1.0380735223685267,3.4708261372573253,-0.010771573266850935,0.0012627146361003051,0.013648505049356928,-0.022659598964887687,0.052024913950885786,0.39403132664009216,0.91734359131647203,0.0029357011199925486,0.0023620957261186542,-0.013576803747592486],"Pressure":[26559.901856932556],"DVL":[-0.021995618298615092,0.0042292264626304539,-0.00027553622105673525,7.3456261491551809,-0.015490669417482299,0.00307046917029928,0.012163423074953191,0],"IMU":[-0.00057810706193133854,0.11355048376750174,0.81137852119959575,-0.0027049073579259739,-0.013029417709197025,0.0029651045636848831,1.1081396068614862,0.017919603299900517,-9.7433360759924135],"FOG":[0.82352076480777414],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.5982490303965005,-24.251119007476291,-24.241510156012481,63.592181741515844,63.592181741515844],"omega_rad_s":[7.987685166421473,-24.250648176072843,-24.08013889076085,63.714408701592312,63.714326987929802],"thrust_n":[0.82350326883354985,-7.3419952331328888,-7.3133943740930265,51.391122234901189,51.465851459122959],"torque_nm":[-0.015440686290629063,0.13766241062124165,0.13712614451424424,-0.96358354190439743,-0.96498471485855541],"angle_rad":[-615.63814015245646,504.46077728530662,-492.19872622374504,1663.6266005296609,1663.6264813004329]},"command":[0.072364276479966669,-0.23096303816644087,-0.23087152529535696,0.60563982610967471,0.60563982610967471],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-1.1180834903756615e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.13243706874461586,-1.6051452185049282,-0.31269934444008901,-0.0001771580880721708,-0.00058210730721837693,0.0002875254144543143]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":594,"step":4752,"t":23.760000000000002,"sim_time":23.759999999999557,"vehicle":{"origin_ned":[1.5245683087309956,1.0378436879726203,3.4714192680199103],"origin_quat_xyzw":[-0.022638267378105242,0.052085487748287487,0.39377901824666639,0.9174490152617919],"cg_ned":[1.4665427713119938,0.97692294757504594,3.1788143604604771],"linear_velocity_ned":[-0.008730074983595364,-0.0051525672615116954,0.015063806247674606],"angular_velocity_ned":[-0.00074681249703904178,0.0026519967177415019,-0.013735078401444806]},"sensors":{"Odom":[1.5245683087309956,1.0378436879726203,3.4714192680199103,-0.010684506427249649,0.001203839651365166,0.013742069198063568,-0.022638267378105266,0.05208548774828755,0.39377901824666683,0.9174490152617919,0.0029563399388075704,0.002375319974000728,-0.013485588729373499],"Pressure":[26564.217239467082],"DVL":[-0.0077001119392292455,0.00037182531525921814,-0.012246710195304739,7.4502088717210624,-0.0047891122583988716,0.0017917782387819416,-0.036605132074408644,0],"IMU":[-0.00052193460307100713,0.11364497459629773,0.81083393618701083,0.021343069904217422,0.10583877114446563,-0.085961426615520517,1.1219339518421274,0.0021392691165495513,-9.7400368162585202],"FOG":[0.81097382413968078],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.6035896693016625,-24.226262721438353,-24.297661369075016,63.550913792431984,63.550913792431984],"omega_rad_s":[7.9808360621796561,-24.229524918323929,-24.14097895137521,63.671458928870379,63.671377693790284],"thrust_n":[0.82191354640229852,-7.3302100957094325,-7.3512492801180356,51.318686012291366,51.393797368200758],"torque_nm":[-0.015410878995043099,0.13744143929455185,0.13783592400221317,-0.96222536273046322,-0.9636337006537643],"angle_rad":[-615.31879179789235,503.49122890526826,-493.16332045116081,1666.1741985690107,1666.17407608143]},"command":[0.072415139707634885,-0.23072631163274623,-0.2314062987530954,0.60524679802316173,0.60524679802316173],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,4.3198680309969292e-21,-1.1180834903756615e-21],"servo_velocity":[0,0,0,0,8.6736173798840355e-19,0],"servo_effort":[-0.1313635558895431,-1.6047733044003558,-0.31258711044115789,-0.00017584685792219849,-0.00057998485277724028,0.00028735816554956129]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":595,"step":4760,"t":23.800000000000001,"sim_time":23.79999999999955,"vehicle":{"origin_ned":[1.5242859683636365,1.037615190788413,3.4720155867032636],"origin_quat_xyzw":[-0.022616599834146187,0.052146449586330572,0.39352833012929556,0.91755364453155008],"cg_ned":[1.4661958761002249,0.97671756169961299,3.179418677144382],"linear_velocity_ned":[-0.0086277646993670187,-0.0051209565422437806,0.015141131662843662],"angular_velocity_ned":[-0.00073613500536588109,0.0026778217493941534,-0.013646123424343527]},"sensors":{"Odom":[1.5242859683636365,1.037615190788413,3.4720155867032636,-0.010600242854766729,0.0011468420703740004,0.013827551179291365,-0.022616599834146215,0.052146449586330648,0.39352833012929611,0.91755364453155008,0.0029721533725152001,0.0023853316285281142,-0.013394245254297107],"Pressure":[26570.681527443307],"DVL":[-0.012376364798553589,-0.0042601937609417478,-0.0072008021762712364,7.4301597590237645,-0.0047659279828418197,-0.0069704777226314444,0.017625617062223313,0],"IMU":[-0.00046467925738563685,0.11373995476350041,0.8102930256411045,0.038168738705490382,-0.023091322502318046,0.14407644886074189,1.1277129713355507,0.0064613938345300988,-9.7566168532204749],"FOG":[0.81477353191346891],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.6112345643661765,-24.199560995418373,-24.353171333063425,63.509245763614445,63.509245763614445],"omega_rad_s":[7.9761567513895937,-24.206599015356428,-24.201222477048301,63.628118793809719,63.62803821247541],"thrust_n":[0.82076961710047669,-7.3173156771820382,-7.3888179682688113,51.245947382292819,51.321338593634081],"torque_nm":[-0.015389430320633939,0.13719966894716323,0.13854033690504025,-0.96086151341799053,-0.96227509863063909],"angle_rad":[-614.99966840681941,502.52256642628623,-494.13033485713606,1668.7200696737602,1668.7199439509036]},"command":[0.072487948232058827,-0.23047200948017499,-0.23193496507679454,0.60484995965347088,0.60484995965347088],"arm":{"servo_position":[3.6462121401337282e-23,3.2526065174565154e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-1.1180834903756615e-21],"servo_velocity":[0,8.6736173798840355e-19,0,0,0,0],"servo_effort":[-0.1302512530283727,-1.6044078007872096,-0.31248158458826353,-0.00017452918376930016,-0.00057799082237714502,0.00028721102063738655]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":596,"step":4768,"t":23.84,"sim_time":23.839999999999542,"vehicle":{"origin_ned":[1.5240077068060123,1.0373879702819515,3.4726147865806531],"origin_quat_xyzw":[-0.022594660119930002,0.052207701525447091,0.39327927172444715,0.91765748058160734],"cg_ned":[1.4658530265477197,0.97651339895135658,3.1800259090398466],"linear_velocity_ned":[-0.0085275244445803394,-0.0050911771537311343,0.015210565372552857],"angular_velocity_ned":[-0.00072643441997791039,0.0026978588473360126,-0.013556485411648831]},"sensors":{"Odom":[1.5240077068060123,1.0373879702819515,3.4726147865806531,-0.010518751430173454,0.0010917269070166973,0.013905069204079537,-0.022594660119930006,0.052207701525447112,0.39327927172444727,0.91765748058160734,0.0029830407470389656,0.0023920796220831108,-0.013302776741193753],"Pressure":[26575.475268896],"DVL":[-0.034496369884644426,-0.0057755679720630712,-0.007026460842190994,7.4831271284439058,0.0024566215865196883,0.033339120529823942,0.0019888124773994632,0],"IMU":[-0.00040653529837403075,0.11383529469539037,0.80975579490223992,0.0055903669304514739,-0.012300637131620509,-0.076851450562901769,1.1232016704791583,-0.0013397021464453505,-9.7633804089404563],"FOG":[0.81784597445019314],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.6212889307105849,-24.170983075976629,-24.407994740307082,63.467189750831011,63.467189750831011],"omega_rad_s":[7.9738078585287493,-24.181819420524118,-24.260809453522189,63.584398814162846,63.584319063494398],"thrust_n":[0.82010329997979992,-7.3032842971489442,-7.4260611094403046,51.172921570283236,51.248488898594971],"torque_nm":[-0.015376936874621249,0.13693658057154273,0.13923864580200576,-0.95949227944281068,-0.96090916684865568],"angle_rad":[-614.68067946279143,501.55486314027524,-495.09974419531841,1671.2641984678351,1671.2640695398291]},"command":[0.07258370410200557,-0.23019983881882503,-0.23245709276482934,0.60444942619839059,0.60444942619839059],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,4.3198680309969292e-21,-5.7598240413290923e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.12910294018753363,-1.6040471064557638,-0.31238231297846086,-0.00017320807265029406,-0.00056049937159117016,0.00028763063700577428]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":597,"step":4776,"t":23.879999999999999,"sim_time":23.879999999999534,"vehicle":{"origin_ned":[1.5237333726245037,1.037161967655208,3.4732165654348979],"origin_quat_xyzw":[-0.02257251339204577,0.052269144151250682,0.39303185254540912,0.91776052491572402],"cg_ned":[1.465514141027848,0.97631038679278703,3.1806357429087861],"linear_velocity_ned":[-0.0084293017554114384,-0.0050631969309312269,0.01527221539465641],"angular_velocity_ned":[-0.00071774994814013254,0.0027120195368595303,-0.013466158371865777]},"sensors":{"Odom":[1.5237333726245037,1.037161967655208,3.4732165654348979,-0.01043999368347143,0.0010384951271325009,0.013974740795571953,-0.022572513392045784,0.052269144151250724,0.3930318525454094,0.91776052491572402,0.0029889143455221591,0.0023955260837279888,-0.013211187761508971],"Pressure":[26580.15486743379],"DVL":[-0.03091723163552236,-0.0062222720508771975,-0.013347270540623591,7.4157249230653619,-0.034951545886745684,0.0052798114379945848,0.0023170892211008759,0],"IMU":[-0.00034770055087216597,0.11393086296054153,0.80922224917101859,-0.021262338820237855,-0.075821873736363496,-0.012317631157920039,1.1215508979448992,0.0002312422422056132,-9.7360894988694344],"FOG":[0.81347255152261111],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.6338329170588946,-24.140505274122585,-24.462090716097368,63.424758481501129,63.424758481501129],"omega_rad_s":[7.9739255068265082,-24.155143532594078,-24.319685776950156,63.540310165995209,63.54023142367749],"thrust_n":[0.81994174936700182,-7.2880938361758236,-7.4629427172143359,51.099624641192861,51.17526332189567],"torque_nm":[-0.015373907800631283,0.13665175942829669,0.13993017594776883,-0.9581179620223661,-0.95953618728554402],"angle_rad":[-614.3617285817752,500.58819418780223,-496.071520955815,1673.806570010908,1673.8064379149755]},"command":[0.072703170638656139,-0.22990957403926271,-0.23297229253426066,0.60404531887143931,0.60404531887143931],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.12792149670286582,-1.6036898601969267,-0.31228900147372812,-0.00017187547874357898,-0.00057434548490103564,0.00028697540477985202]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":598,"step":4784,"t":23.920000000000002,"sim_time":23.919999999999526,"vehicle":{"origin_ned":[1.5234628153823122,1.0369371262005496,3.4738206255015012],"origin_quat_xyzw":[-0.022550226658318389,0.052330676674761337,0.39278608195411668,0.91786277916666492],"cg_ned":[1.4651791400518037,0.97610845402373059,3.1812478698279936],"linear_velocity_ned":[-0.0083330424508463122,-0.0050369815792194652,0.015326189491224091],"angular_velocity_ned":[-0.00071015545146814907,0.0027202012860230076,-0.013375149570133568]},"sensors":{"Odom":[1.5234628153823122,1.0369371262005496,3.4738206255015012,-0.010363923758098959,0.00098715682210721053,0.014036682734929681,-0.022550226658318396,0.052330676674761344,0.39278608195411679,0.91786277916666492,0.0029896541218111042,0.0023956484154034501,-0.013119499941952367],"Pressure":[26585.604673915048],"DVL":[-0.018468257443534378,-0.031817080565940535,0.013233447880375927,7.436723259100031,-0.012958169720923882,-0.010356818180218011,-0.0049347630006896862,0],"IMU":[-0.00028837722967465785,0.11402652683254372,0.80869239297431661,0.092302086215310608,0.071926642348918282,-0.16497180402967118,1.1030300218200204,-0.017769871049743244,-9.757570373249207],"FOG":[0.80279095540622347],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.6489638328934548,-24.108099902202863,-24.515432738709716,63.381965204152536,63.381965204152536],"omega_rad_s":[7.9766303177002449,-24.126534367107201,-24.377804995858508,63.495864653064778,63.495787096606541],"thrust_n":[0.82030937563118811,-7.2717259540169392,-7.4994313203342777,51.02607342564113,51.101678144086051],"torque_nm":[-0.015380800793084777,0.13634486163781764,0.14061433725626774,-0.95673887673077118,-0.95815646520161346],"angle_rad":[-614.04271434115878,499.62263627081927,-497.04563562668676,1676.3471698240635,1676.3470346045351]},"command":[0.072847274598985282,-0.22960095144955106,-0.23348031179723538,0.60363776384907175,0.60363776384907175],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,4.3198680309969292e-21,5.0821976835259523e-22],"servo_velocity":[0,0,0,0,8.6736173798840355e-19,0],"servo_effort":[-0.12670916104865967,-1.6033340304517627,-0.31220108166073102,-0.000170563815780548,-0.00057267147692645825,0.00030659660530702051]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":599,"step":4792,"t":23.960000000000001,"sim_time":23.959999999999518,"vehicle":{"origin_ned":[1.5231958861652304,1.0367133911773383,3.4744266734098477],"origin_quat_xyzw":[-0.022527868141072025,0.052392197528925537,0.39254196925122375,0.91796424503979435],"cg_ned":[1.4648479463310098,0.97590753085799087,3.1818619851798031],"linear_velocity_ned":[-0.0082386909934496419,-0.005012494939303969,0.015372595191379488],"angular_velocity_ned":[-0.0007036678871173344,0.0027223813090205863,-0.013283452655028364]},"sensors":{"Odom":[1.5231958861652304,1.0367133911773383,3.4744266734098477,-0.010290489317511718,0.00093769525703972598,0.0140910110708268,-0.022527868141072042,0.052392197528925571,0.39254196925122403,0.91796424503979435,0.0029852348365478044,0.0023924377695649477,-0.013027710367323397],"Pressure":[26590.733456891048],"DVL":[-0.0065171082608333156,-0.0041149170645864369,-0.0091141885791384963,7.3849720184698509,0.014557364073050921,-0.017215577370419621,0.012980086213017626,0],"IMU":[-0.00022877028069845902,0.11412215288507782,0.80816623046850844,0.023209178071029634,-0.044563910578279783,0.074306217661637947,1.1366921824898615,-0.00614837463128492,-9.7284648522199575],"FOG":[0.81947978615523764],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.6667487468829787,-24.073747502281446,-24.567996609811537,63.338823739961413,63.338823739961413],"omega_rad_s":[7.982030530951719,-24.095959519137875,-24.435128656346066,63.451074697812942,63.450998503618088],"thrust_n":[0.82122859887929422,-7.2541655554844331,-7.5355001370319803,50.95228551351321,51.027750857188607],"torque_nm":[-0.015398036228986767,0.13601560416533312,0.14129062756934965,-0.95535535337837263,-0.95677032857228628],"angle_rad":[-613.72353071382463,498.65826747955077,-498.02205703525664,1678.885983914681,1678.8858456229652]},"command":[0.073016654732218841,-0.22927378573601376,-0.23398092009344321,0.60322689276153729,0.60322689276153729],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.12546831781981307,-1.6029780118708876,-0.31211798193955104,-0.00016922379442395872,-0.00057114840282905012,0.00028681249556378993]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":600,"step":4800,"t":24,"sim_time":23.99999999999951,"vehicle":{"origin_ned":[1.5229324384650105,1.0364907096077973,3.4750344201123742],"origin_quat_xyzw":[-0.022505506253301891,0.05245360553869418,0.39229952407027946,0.91806492410314078],"cg_ned":[1.4645204848290969,0.97570754896784029,3.1824777886950191],"linear_velocity_ned":[-0.0081461903671792117,-0.0049897005688714262,0.015411542551751428],"angular_velocity_ned":[-0.00069831565913413792,0.0027186055992620994,-0.01319103796227369]},"sensors":{"Odom":[1.5229324384650105,1.0364907096077973,3.4750344201123742,-0.010219620316607799,0.00089008272738705927,0.014137841617210984,-0.022505506253301912,0.052453605538694222,0.39229952407027979,0.91806492410314078,0.0029756701132271214,0.0023859410882518142,-0.012935788193493105],"Pressure":[26597.933535237575],"DVL":[0.012280432470582926,-0.014345040143464761,-0.0013770028452298085,7.4501663441646926,-0.0063681589006066843,0.0026392858481366459,0.038937032882497127,0],"IMU":[-0.00016908451551109416,0.11421760834161228,0.80764376649347303,-0.0035220404083656687,-0.027867511742661302,0.052515883347673049,1.1333633699790333,-0.0064725528851044935,-9.7271239162642278],"FOG":[0.82065149686846717],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.6871888861966333,-24.037450439141942,-24.61975120534489,63.295348421632895,63.295348421632895],"omega_rad_s":[7.9902014796751279,-24.063396572965303,-24.491621124253758,63.405953322825326,63.405878665079413],"thrust_n":[0.82271570124616034,-7.2354040559791839,-7.5711238586018164,50.878278688566773,50.953500686865418],"torque_nm":[-0.015425919398365507,0.13566382604960972,0.14195857234878406,-0.95396772541062724,-0.95537813787872639],"angle_rad":[-613.40406808033993,497.69516698758201,-499.00075254164221,1681.4229988008378,1681.4228574953547]},"command":[0.073211322725682218,-0.22892809942039943,-0.23447382100328468,0.60281284211078945,0.60281284211078945],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.12419365422616035,-1.6026088330051729,-0.31203680585558458,-0.00016792085454654302,-0.00056971085417573954,0.00028675246759132247]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":601,"step":4808,"t":24.039999999999999,"sim_time":24.039999999999502,"vehicle":{"origin_ned":[1.5226723286346271,1.0362690303030653,3.4756435808277786],"origin_quat_xyzw":[-0.022483209276277883,0.052514800580828552,0.39205875649796562,0.91816481770642011],"cg_ned":[1.4641966827980253,0.97550844152308169,3.1830949844778402],"linear_velocity_ned":[-0.008055483532447243,-0.0049685597837471262,0.015443139577925123],"angular_velocity_ned":[-0.00069409711398409882,0.0027089221278989288,-0.013097893028603902]},"sensors":{"Odom":[1.5226723286346271,1.0362690303030653,3.4756435808277786,-0.010151250948157858,0.00084428534639348232,0.014177289280522707,-0.02248320927627789,0.05251480058082858,0.39205875649796579,0.91816481770642011,0.0029609974951091585,0.0023761850331583227,-0.012843717149235415],"Pressure":[26601.488882480618],"DVL":[-0.0098915327259341788,-0.012949847772596664,-0.027986031620500805,7.3965748916415723,-0.0082850262627075372,0.0099373196352209175,-0.014413629603294301,0],"IMU":[-0.00010952348159777708,0.11431276204110459,0.80712500692238776,0.04419402057624025,-0.018670539348619251,-0.031576556078848898,1.1256430948434488,-0.01711164319563014,-9.7855437256940245],"FOG":[0.81601544966604778],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.7102614803505514,-23.999230173792988,-24.670665945354397,63.251554021591161,63.251554021591161],"omega_rad_s":[8.0011863865227877,-24.028837845072729,-24.54724832375306,63.360514098283971,63.360441147456982],"thrust_n":[0.82478101801529391,-7.2154421903520038,-7.6062780398575764,50.804071667728451,50.878947624330763],"torque_nm":[-0.015464644087786764,0.1352895410691001,0.14261771324732955,-0.95257634376990841,-0.95398026795620194],"angle_rad":[-613.08421454876418,496.73341451963154,-499.98168811443338,1683.9582015339606,1683.9580572800166]},"command":[0.073431061717624299,-0.22856409689326657,-0.23495872328908951,0.60239575258658251,0.60239575258658251],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,1.0778494253810979e-21,-6.7722931110941484e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,-1.7347234759768071e-18,-1.0842021724855044e-19,0,0],"servo_effort":[-0.1228964241234768,-1.6022363317147028,-0.31195941090388241,-0.00016658305738086941,-0.00056837688071367549,0.00028670713255437338]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":602,"step":4816,"t":24.080000000000002,"sim_time":24.079999999999494,"vehicle":{"origin_ned":[1.5224154159273469,1.0360483035215264,3.476253875040717],"origin_quat_xyzw":[-0.022461044733770055,0.052575683332334693,0.39181967676243051,0.91826392714371063],"cg_ned":[1.4638764697721618,0.97531014328193655,3.1837132809260416],"linear_velocity_ned":[-0.0079665133838592705,-0.0049490324404657289,0.015467493502638933],"angular_velocity_ned":[-0.00069098972203268845,0.0026933915704207205,-0.013004014734371848]},"sensors":{"Odom":[1.5224154159273469,1.0360483035215264,3.476253875040717,-0.010085316089839249,0.00080026274000168053,0.014209468569006636,-0.022461044733770072,0.052575683332334734,0.39181967676243079,0.91826392714371063,0.0029412789762161785,0.0023631900779852461,-0.01275148755238812],"Pressure":[26607.433341825934],"DVL":[-0.0080803261624009335,0.0057901643727246935,0.010980987087583284,7.4350970922758535,0.0080939768540868786,0.0033556526968571937,0.014934221511452118,0],"IMU":[-5.0288548703561147e-05,0.11440748348761909,0.80660995801251822,0.021384280026715746,-0.046999547702563114,-0.12763352054865032,1.124395129044597,-0.0011936070395609311,-9.7671211194530141],"FOG":[0.79269331514962471],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.7359220817378205,-23.959089950434748,-24.720717902023623,63.207455871985225,63.207455871985225],"omega_rad_s":[8.0149994427956948,-23.992280662818857,-24.601979596958582,63.314771163353015,63.314700085731261],"thrust_n":[0.82742957181971044,-7.1942840606860416,-7.6409402951176064,50.729684250505706,50.804112311665527],"torque_nm":[-0.015514304471619573,0.13489282613786333,0.14326763053345512,-0.95118157969698203,-0.95257710584372868],"angle_rad":[-612.76385716511595,495.77308997704546,-500.96482843414577,1686.4915797213566,1686.491432590984]},"command":[0.073675448397503049,-0.2281818090517595,-0.23543540859070117,0.60197577020938309,0.60197577020938309],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.12157945095925195,-1.6018592764285349,-0.31188533873428109,-0.00016524232805836892,-0.0005671390886360638,0.00028667557857988795]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":603,"step":4824,"t":24.120000000000001,"sim_time":24.119999999999486,"vehicle":{"origin_ned":[1.5221615627665421,1.0358284808644542,3.4768650264674226],"origin_quat_xyzw":[-0.022439078995878638,0.052636155602678751,0.39158229518881804,0.91836225366237945],"cg_ned":[1.463559777561511,0.97511259063282218,3.1843323907233385],"linear_velocity_ned":[-0.0078792231828281201,-0.0049310772431337005,0.015484711367409304],"angular_velocity_ned":[-0.00068896078243743468,0.0026721009817848554,-0.012909403170681495]},"sensors":{"Odom":[1.5221615627665421,1.0358284808644542,3.4768650264674226,-0.010021746727983963,0.00075796796840515296,0.014234493238996462,-0.022439078995878645,0.052636155602678772,0.39158229518881815,0.91836225366237945,0.0029166027645992978,0.0023469877460076632,-0.012659089922795217],"Pressure":[26612.175762958301],"DVL":[0.0010260665977664916,0.017232013466448402,-0.045269702325263152,7.2996533214269474,-0.0078427069189951331,0.0058176078775176278,-0.003795442614835381,0],"IMU":[8.4220771592511191e-06,0.11450164315768724,0.8060986263737655,0.038823930077104829,-0.070998954586051211,-0.083854767555539014,1.1261309352776312,-0.0023039622059885774,-9.7348526358189229],"FOG":[0.80642541390343492],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.7641048724467536,-23.91703680742965,-24.769886940704918,63.163069766438767,63.163069766438767],"omega_rad_s":[8.0316278399408656,-23.953725898329527,-24.655787748589447,63.268739192967459,63.26867015030502],"thrust_n":[0.83066146442951105,-7.1719362285671755,-7.6750902969794517,50.655136896429916,50.729016396173471],"torque_nm":[-0.015574902458053331,0.13447380428563455,0.14390794306836471,-0.94978381680806101,-0.95116905742825275],"angle_rad":[-612.44288302781479,494.81427328722646,-501.95013703371353,1689.0231215481076,1689.0229716198903]},"command":[0.073943855928064323,-0.22778130292790141,-0.23590368514957064,0.60155304539465493,0.60155304539465493],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.12024610719083446,-1.6014761820453207,-0.31181418284855333,-0.00016392903399863845,-0.00056600411447110821,0.00028665678642966796]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":604,"step":4832,"t":24.16,"sim_time":24.159999999999478,"vehicle":{"origin_ned":[1.5219106350139562,1.0356095151964606,3.4774767630270067],"origin_quat_xyzw":[-0.022417376911174503,0.052696120705987046,0.39134662219037358,0.9184597984534475],"cg_ned":[1.4632465402325652,0.97491572163311091,3.1849520308459711],"linear_velocity_ned":[-0.0077935568369797287,-0.004914652130110748,0.015494900705045804],"angular_velocity_ned":[-0.0006879690352507256,0.0026451600033107966,-0.012814058853022283]},"sensors":{"Odom":[1.5219106350139562,1.0356095151964606,3.4774767630270067,-0.0099604709466386346,0.00071734885674232815,0.014252476987361833,-0.02241737691117451,0.05269612070598706,0.39134662219037364,0.9184597984534475,0.0028870791143952197,0.0023276191983813955,-0.012566512649890062],"Pressure":[26620.201204096833],"DVL":[0.00051039748198904687,-0.0035854505507232279,0.0084341843873930785,7.4027905146504445,-0.014756790341858434,0.0097669735112946941,-0.0020046921994513398,0],"IMU":[6.6414323075609347e-05,0.11459511290508494,0.8055910190169564,0.0084496586651748272,0.037361191524276242,-0.043620810024247759,1.1165000827134142,-0.015722301410346671,-9.7346243610520471],"FOG":[0.81469805363435299],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.7947233600806252,-23.873081545256621,-24.81815550788944,63.118411920716618,63.118411920716618],"omega_rad_s":[8.051033273453621,-23.913178022573295,-24.708648962373449,63.22243338562258,63.222366534735997],"thrust_n":[0.8344721331118361,-7.1484077322307478,-7.7087097457918281,50.580450705824063,50.653682470423149],"torque_nm":[-0.015646352495846928,0.13403264497932652,0.14453830773359677,-0.94838345073420116,-0.94975654632043405],"angle_rad":[-612.12118033496472,493.85704426144861,-502.93757643717481,1691.5528157984545,1691.5526631573359]},"command":[0.074235460572196432,-0.22736268138339638,-0.23636338578942323,0.60112773257825347,0.60112773257825347],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,4.3198680309969292e-21,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,8.6736173798840355e-19,0],"servo_effort":[-0.11889850374251024,-1.601085227277381,-0.3117451808758811,-0.00016259397785849743,-0.00056495522370567401,0.00028664924772221127]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":605,"step":4840,"t":24.199999999999999,"sim_time":24.19999999999947,"vehicle":{"origin_ned":[1.5216625022223582,1.0353913605672846,3.478088816806574],"origin_quat_xyzw":[-0.022396001454820114,0.052755483829659548,0.39111266825661273,0.91855656264267516],"cg_ned":[1.4629366940791741,0.97471947604205866,3.1855719225640282],"linear_velocity_ned":[-0.0077094590130065421,-0.0048997142167111832,0.015498168791885871],"angular_velocity_ned":[-0.00068796404957395388,0.0026127023053937231,-0.012717984523039533]},"sensors":{"Odom":[1.5216625022223582,1.0353913605672846,3.478088816806574,-0.0099014137165517897,0.00067834756721795798,0.014263532669893384,-0.022396001454820132,0.05275548382965959,0.39111266825661306,0.91855656264267516,0.002852841967242916,0.0023051358360348146,-0.012473743611512732],"Pressure":[26625.554316681173],"DVL":[-0.045641660727911974,0.014271552839211742,-0.029971550481324282,7.3143775299807805,-0.014286714630257377,0.0074783194565496659,0.022064556015686004,0],"IMU":[0.00012349918536098329,0.11468776637295745,0.80508714339478749,-0.079759029467371262,-0.029331816289075486,-0.0027427782413615466,1.1253890718229609,0.0040335779388841614,-9.7490048574036408],"FOG":[0.81459661099439129],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.8276719413023566,-23.827238564857939,-24.865508635971288,63.07349900480785,63.07349900480785],"omega_rad_s":[8.0731538787337271,-23.870645231427474,-24.760542446347312,63.175869422532102,63.175804914865473],"thrust_n":[0.83885267356337501,-7.1237101380949239,-7.7417821780260851,50.50564736000748,50.57813402906514],"torque_nm":[-0.015728487629313281,0.13356956508927983,0.14515841583798911,-0.94698088800014046,-0.94834001304497129],"angle_rad":[-611.79863935616117,492.90148244686048,-503.92710828458564,1694.0806518754316,1694.0804966125086]},"command":[0.074549256583831963,-0.22692608157007563,-0.23681436796163133,0.60069999052197953,0.60069999052197953],"arm":{"servo_position":[1.7198739296202534e-22,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,4.3198680309969292e-21,-3.3881317890156997e-23],"servo_velocity":[2.7105054312137611e-20,-8.6736173798840355e-19,0,0,8.6736173798840355e-19,0],"servo_effort":[-0.11753943987692338,-1.6006848322412588,-0.31167791612797879,-0.00016125082428179334,-0.00056399898682848342,0.00028665196256457863]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":606,"step":4848,"t":24.240000000000002,"sim_time":24.239999999999462,"vehicle":{"origin_ned":[1.5214170378541683,1.0351739721358546,3.4787009240350946],"origin_quat_xyzw":[-0.022375013403802053,0.052814152377911282,0.39088044394898752,0.91865254727890711],"cg_ned":[1.4626301775803023,0.97452379534661437,3.1861917914498163],"linear_velocity_ned":[-0.0076268756714796705,-0.0048862200661708268,0.015494623438998828],"angular_velocity_ned":[-0.00068888666781792465,0.0025748831508194676,-0.012621184166088546]},"sensors":{"Odom":[1.5214170378541683,1.0351739721358546,3.4787009240350946,-0.0098444979624681371,0.00064090151304954668,0.014267773086456857,-0.022375013403802067,0.05281415237791131,0.39088044394898774,0.91865254727890711,0.0028140467696658516,0.0022795979768506628,-0.012380769429961415],"Pressure":[26631.174604775621],"DVL":[0.0021260805920348871,0.018606990035523067,-0.022880830085320963,7.3871315250436087,-0.00081622880292632775,0.017983426958276,-0.0071501129252049753,0],"IMU":[0.00017949359623239744,0.11477947938232042,0.80458700745524925,0.014459983873229894,0.071725092170797825,-0.034476612423005829,1.1303334614732228,-0.0074963908069235275,-9.7391573560406854],"FOG":[0.8119158514664141],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.8628289500290958,-23.779526036840032,-24.911933181028104,63.028348092292759,63.028348092292759],"omega_rad_s":[8.0979059786371721,-23.826139460401798,-24.811450212684399,63.129063471022242,63.129001452200697],"thrust_n":[0.84379010407556676,-7.0978575231358505,-7.7742928453997857,50.430749123763682,50.502395433885233],"torque_nm":[-0.015821064451416875,0.13308482855879719,0.145767990851246,-0.94557654607056929,-0.94691991438534806],"angle_rad":[-611.47515333941146,491.94766697778829,-504.91869344967188,1696.6066198205658,1696.6064620328639]},"command":[0.074884085238372339,-0.22647167654133366,-0.23725650648598193,0.6002699818313596,0.6002699818313596],"arm":{"servo_position":[3.6462121401337282e-23,3.2526065174565154e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,8.6736173798840355e-19,0,0,0,0],"servo_effort":[-0.11617162918351981,-1.6002734291076883,-0.31161179081953289,-0.00015992386744933493,-0.00056313187339658338,0.00028666350232042082]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":607,"step":4856,"t":24.280000000000001,"sim_time":24.279999999999454,"vehicle":{"origin_ned":[1.5211741194890767,1.0349573060837565,3.4793128250707177],"origin_quat_xyzw":[-0.022354471009477388,0.052872036293379859,0.39064995988243179,0.91874775332946113],"cg_ned":[1.4623269313566858,0.97432862278493038,3.1868113673964378],"linear_velocity_ned":[-0.0075457537130578164,-0.0048741257219623788,0.015484372805782645],"angular_velocity_ned":[-0.00069066982458143393,0.0025318779280327289,-0.012523663360850821]},"sensors":{"Odom":[1.5211741194890767,1.0349573060837565,3.4793128250707177,-0.0097896444544366343,0.00060494355295561656,0.014265310838291885,-0.022354471009477392,0.052872036293379866,0.39064995988243184,0.91874775332946113,0.0027708688822531483,0.002251074468702752,-0.012287576001745818],"Pressure":[26635.985210479317],"DVL":[-0.026506710903835818,0.0059832470672977391,0.0016556614727196717,7.3991493863167959,-0.0074234326015202223,0.03304912041969487,-0.00031454478003474729,0],"IMU":[0.00023422127591223585,0.11487013027920739,0.80409061966311113,-0.048244526003421759,0.0099783424851974979,-0.11104311951266278,1.1324867628416324,-0.0042500931061022519,-9.7403621609250699],"FOG":[0.81763240483703647],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.9000559864380078,-23.729964765753131,-24.957418356321114,62.982976512710934,62.982976512710934],"omega_rad_s":[8.1251856051141278,-23.77967615341986,-24.861356856256052,63.082032115743807,63.081972725147203],"thrust_n":[0.84926756571807593,-7.0708663098167532,-7.8062286024714345,50.355778742078385,50.4264917894155],"torque_nm":[-0.015923766857213927,0.13257874330906413,0.14636678629633942,-0.94417085141396984,-0.94549672105154059],"angle_rad":[-611.1506193460657,490.99567643036107,-505.91229214527618,1699.1307103317174,1699.1305501219476]},"command":[0.075238628442266739,-0.2259996644357441,-0.23768969863162964,0.59983787154962798,0.59983787154962798],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.0493186101153311e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.11479758507031426,-1.5998493718338656,-0.31154617953781139,-0.00015859213691983554,-0.000562340226480911,0.00028668272495556072]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":608,"step":4864,"t":24.32,"sim_time":24.319999999999446,"vehicle":{"origin_ned":[1.5209336290038702,1.0347413195328212,3.4799242643857871],"origin_quat_xyzw":[-0.022334429695894047,0.052929048362744251,0.39042122671691598,0.91884218167127685],"cg_ned":[1.4620268981156357,0.97413390336291161,3.1874303846336023],"linear_velocity_ned":[-0.0074660416738690462,-0.0048633867005088375,0.015467525442033917],"angular_velocity_ned":[-0.00069323865066500256,0.0024838815691355172,-0.012425429724711607]},"sensors":{"Odom":[1.5209336290038702,1.0347413195328212,3.4799242643857871,-0.0097367723904131821,0.00057040262719588726,0.014256258327455579,-0.022334429695894067,0.052929048362744292,0.39042122671691631,0.91884218167127685,0.0027235031271706563,0.0022196423969417368,-0.012194148993103379],"Pressure":[26641.114323836591],"DVL":[-0.031826594318852999,-0.047286643562151551,-0.013280741489865163,7.3625164172857263,-0.011536080795777972,0.011870512880072117,0.024053058151580924,0],"IMU":[0.00028751352534426438,0.11495960027366467,0.80359798904017499,-0.027743434301368212,-0.011988038739413518,0.12258657802872956,1.1239146408395471,0.0021578072358536147,-9.7616017275341971],"FOG":[0.793948019874257],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.9392003845516577,-23.678578791782758,-25.001954637738269,62.937401889052452,62.937401889052452],"omega_rad_s":[8.1548701410409734,-23.731274198369412,-24.910249258977402,63.034792324648649,63.03473569500769],"thrust_n":[0.85526453694801163,-7.0427551950654488,-7.837577735147998,50.280759388040693,50.350448881869092],"torque_nm":[-0.016036210067775218,0.13205165990747719,0.14695458253402499,-0.94276423852576308,-0.94407091653504549],"angle_rad":[-610.82493902511874,490.04558868390285,-506.90786402120233,1701.652914778994,1701.6527522552944]},"command":[0.075611432233825313,-0.22551027420745484,-0.23811385369274543,0.59940382751478527,0.59940382751478527],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.0493186101153311e-22],"servo_velocity":[2.7105054312137611e-20,0,0,0,0,0],"servo_effort":[-0.11341978250444464,-1.599411216526734,-0.31148058841568049,-0.00015724535783846953,-0.00056163011255504019,0.00028670823005150952]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":609,"step":4872,"t":24.359999999999999,"sim_time":24.359999999999438,"vehicle":{"origin_ned":[1.5206954527275529,1.0345259704739111,3.4805349905434042],"origin_quat_xyzw":[-0.022314941786426516,0.052985104494288643,0.39019425513819139,0.91893583308735416],"cg_ned":[1.4617300225919583,0.97393958387435964,3.1880485817327537],"linear_velocity_ned":[-0.0073876894529911327,-0.0048539582087319616,0.015444189928550366],"angular_velocity_ned":[-0.00069651027842370207,0.0024311065016848462,-0.01232649202496445]},"sensors":{"Odom":[1.5206954527275529,1.0345259704739111,3.4805349905434042,-0.0096857997964561564,0.00053720389739441712,0.014240727478815374,-0.022314941786426522,0.05298510449428865,0.3901942551381915,0.91893583308735416,0.0026721623416265513,0.0021853855578036247,-0.012100473107103405],"Pressure":[26645.941855419893],"DVL":[-0.021443853528288676,-0.030199512245567599,-0.010149554219185886,7.4363903211757529,0.006971984287038345,0.0015914494266256521,-0.0036027204835454955,0],"IMU":[0.00033920994271418225,0.11504777375019629,0.80310912517742572,0.020563040760076597,0.081449536282758417,0.0010625632521333288,1.127890884856765,-0.0017246562192492374,-9.7346525397026404],"FOG":[0.78691356070460217],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.9800984342159351,-23.625394555076952,-25.045534746601167,62.891642227056288,62.891642227056288],"omega_rad_s":[8.1868203770112782,-23.68095563728874,-24.958116555369259,62.987361440623594,62.987307697643345],"thrust_n":[0.86175712464248855,-7.0135449496326894,-7.8683299583583972,50.205714673871753,50.274293150021265],"torque_nm":[-0.016157946087046664,0.13150396780561294,0.14753118671921997,-0.94135715013509524,-0.94264299656289885],"angle_rad":[-610.4980193140243,489.09748078975139,-507.9053682542156,1704.1732252197071,1704.1730604953673]},"command":[0.07600093746872319,-0.22500375766739952,-0.23852890234858254,0.59896802121005988,0.59896802121005988],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,4.3198680309969292e-21,-3.0493186101153311e-22],"servo_velocity":[-2.7105054312137611e-20,0,0,0,8.6736173798840355e-19,0],"servo_effort":[-0.11204063861111489,-1.5989575163674317,-0.31141448857661913,-0.00015592594697474128,-0.00056099724236315476,0.00028673883321314966]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":610,"step":4880,"t":24.400000000000002,"sim_time":24.39999999999943,"vehicle":{"origin_ned":[1.5204594817116739,1.0343112178231526,3.4811447559715547],"origin_quat_xyzw":[-0.022296056218805108,0.053040123936014413,0.38996905585803632,0.91902870825841543],"cg_ned":[1.4614362516356245,0.97374561306676288,3.1886657013999504],"linear_velocity_ned":[-0.007310636826327075,-0.0048457827555233746,0.015414457518968635],"angular_velocity_ned":[-0.0007003913664968103,0.0023737764461499197,-0.012226860288828146]},"sensors":{"Odom":[1.5204594817116739,1.0343112178231526,3.4811447559715547,-0.009636626585389909,0.00050526989874448392,0.014218814742576701,-0.022296056218805121,0.053040123936014441,0.38996905585803654,0.91902870825841543,0.0026170746553156069,0.002148388400477666,-0.012006532502528776],"Pressure":[26652.492414290573],"DVL":[-0.030239805512579591,-0.0089461660883850581,-0.0037020639667126355,7.4185389026334008,-0.011408182516227199,0.052284230386923099,0.015980177057754889,0],"IMU":[0.00038915911672631685,0.11513453846035343,0.80262403828582007,0.11166740827597463,0.010433378507506528,0.066003177396288026,1.1247226291172352,-0.00031998073050758594,-9.7676789145353151],"FOG":[0.82099366694942555],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[8.0225745463997225,-23.570441574360068,-25.088152106465852,62.845715757055416,62.845715757055416],"omega_rad_s":[8.2208818825934209,-23.628745632625865,-25.004949720933141,62.939757159573574,62.939706421618197],"thrust_n":[0.86871820988490545,-6.9832585197763688,-7.8984763312792792,50.130669000158839,50.198051878856013],"torque_nm":[-0.016288466435341979,0.1309360972458069,0.14809643121148647,-0.93995004375297841,-0.94121347272855027],"angle_rad":[-610.16977307010768,488.1514288464748,-508.90476362951063,1706.6916344131714,1706.6914676063461]},"command":[0.076405471870473543,-0.22448039594628635,-0.23893478196634144,0.59853062625767062,0.59853062625767062],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.0493186101153311e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.11066240540608507,-1.5984832519455463,-0.31134592621430762,-0.00015457672720622307,-0.00056043346418323215,0.00028676967704712022]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":611,"step":4888,"t":24.440000000000001,"sim_time":24.439999999999422,"vehicle":{"origin_ned":[1.5202256133037371,1.0340970228818638,3.481753314533206],"origin_quat_xyzw":[-0.022277818165651754,0.053094029154112682,0.38974563959690461,0.91912080778380822],"cg_ned":[1.461145535761847,0.97355194334201534,3.189281488005633],"linear_velocity_ned":[-0.0072347745548653752,-0.0048387497462129879,0.015378341569674303],"angular_velocity_ned":[-0.00070476476754576737,0.0023121146200293903,-0.012126546721394975]},"sensors":{"Odom":[1.5202256133037371,1.0340970228818638,3.481753314533206,-0.009589077211896951,0.00047452039034194142,0.0141905482828478,-0.022277818165651751,0.053094029154112682,0.38974563959690456,0.91912080778380822,0.0025584843735025698,0.0021087182686598321,-0.011912311604128993],"Pressure":[26655.900843520914],"DVL":[-0.0028878075287678395,0.0023335173183191321,-0.039464154331516364,7.4125359244397799,-0.023156862584930965,0.011233035629811053,0.035916349385251074,0],"IMU":[0.00043721922484838593,0.11521978501581456,0.8021427391863607,-0.0048422725214492526,0.026380021967266097,0.061904622838811374,1.1306013086414175,0.00024568814517466828,-9.7574179388404509],"FOG":[0.79727594216073072],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[8.0664461323682755,-23.513797772861228,-25.129845752079643,62.79966217382902,62.79966217382902],"omega_rad_s":[8.256887399763281,-23.574682697388273,-25.050751410642523,62.892002279795491,62.891954657911349],"thrust_n":[0.87611780904942715,-6.9519277840611968,-7.9280162776850798,50.055656954363343,50.12176201669574],"torque_nm":[-0.016427208919676761,0.13034864595114745,0.14865030520659525,-0.93854356789431281,-0.93978303781304529],"angle_rad":[-609.84011962542809,487.20750770078382,-509.90600878111741,1709.2081359155263,1709.2079671489385]},"command":[0.076823296498745475,-0.22394093117010694,-0.23933186430552042,0.5980920207031335,0.5980920207031335],"arm":{"servo_position":[3.6462121401337282e-23,3.2526065174565154e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.0493186101153311e-22],"servo_velocity":[0,8.6736173798840355e-19,1.7347234759768071e-18,0,0,0],"servo_effort":[-0.10928753669723699,-1.5979801827803377,-0.3112717795513173,-0.00015323162665876704,-0.00055992571872207346,0.0002867931450712807]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":612,"step":4896,"t":24.48,"sim_time":24.479999999999414,"vehicle":{"origin_ned":[1.5199937507783887,1.0338833487730288,3.4823604222825324],"origin_quat_xyzw":[-0.022260268849153851,0.05314674620002733,0.38952401706349032,0.91921213217071651],"cg_ned":[1.4608578285409195,0.97335853021637631,3.1898956883896656],"linear_velocity_ned":[-0.007160054865723766,-0.0048328098638099806,0.015335946206079837],"angular_velocity_ned":[-0.00070952860114635943,0.0022463787730894048,-0.012025564784746878]},"sensors":{"Odom":[1.5199937507783887,1.0338833487730288,3.4823604222825324,-0.009543062281203326,0.00044487307306062909,0.014156034613533543,-0.022260268849153865,0.053146746200027364,0.38952401706349055,0.91921213217071651,0.0024966499314690274,0.0020664778694512234,-0.011817794428527676],"Pressure":[26664.87721437835],"DVL":[0.0063706705493740551,0.0066342191113735911,0.013605333245720618,7.3676184651125407,0.0096387775483414845,-0.031382023574530238,0.020387379307054209,0],"IMU":[0.00048325865742376086,0.11530340743507193,0.80166523932114953,-6.6190742559468167e-05,-0.054753798369183516,-0.076356490400474555,1.1580157959008557,-0.019737502499286436,-9.7415788043115992],"FOG":[0.80375702243816904],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[8.111522170609117,-23.455536392894238,-25.170648916222127,62.753518424634692,62.753518424634692],"omega_rad_s":[8.2946581991007839,-23.518822037791278,-25.095539021793059,62.844126331906182,62.844081929829478],"thrust_n":[0.88392322181299754,-6.9195937689159619,-7.9569578446566753,49.980721615912941,50.045469922222892],"torque_nm":[-0.016573560408993705,0.12974238316717424,0.14919295958731268,-0.93713853029836769,-0.93835256104167941],"angle_rad":[-609.50898526764831,486.26579021053271,-510.90906284944856,1711.7227243788111,1711.7225537794629]},"command":[0.077252592101039214,-0.22338606088470703,-0.23972046586878215,0.5976525564250923,0.5976525564250923],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[-2.7105054312137611e-20,-8.6736173798840355e-19,0,0,0,0],"servo_effort":[-0.1079179105730762,-1.5974573937687635,-0.31119547070929904,-0.00015187692138141239,-0.00055948451489565786,0.00028681768721412504]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":613,"step":4904,"t":24.52,"sim_time":24.519999999999406,"vehicle":{"origin_ned":[1.5197638021215185,1.0336701590425543,3.4829658396056304],"origin_quat_xyzw":[-0.022243445490908453,0.053198205245487309,0.38930419893037821,0.91930268181188746],"cg_ned":[1.4605730850816778,0.97316533083379297,3.1905080540861563],"linear_velocity_ned":[-0.0070864419453525208,-0.0048279245287438767,0.015287392080284663],"angular_velocity_ned":[-0.00071457969289378392,0.0021768425052818498,-0.011923929830013074]},"sensors":{"Odom":[1.5197638021215185,1.0336701590425543,3.4829658396056304,-0.0094985072500060105,0.0004162435096870467,0.014115394200250554,-0.02224344549090846,0.053198205245487323,0.38930419893037838,0.91930268181188746,0.0024318420158480156,0.0020217804021245411,-0.011722965428461992],"Pressure":[26668.427248757103],"DVL":[-0.035953560002944793,0.019431970743229013,-0.019008120424498943,7.3771481189448318,-0.018456879040678539,0.024273855232064663,0.01368187218950128,0],"IMU":[0.00052715652269594889,0.11538530410622766,0.80119155075959625,0.020759900166516458,0.024109693375747518,0.1327454830944384,1.1226887018766856,-0.011466463777242326,-9.7718115386771416],"FOG":[0.78922514727036386],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[8.1576067060598003,-23.395688897268304,-25.210554628269385,62.707301538662541,62.707301538662541],"omega_rad_s":[8.334006007199795,-23.461213556309037,-25.139323943415416,62.796155579989616,62.796114493646641],"thrust_n":[0.89209930478808508,-6.8862939578907163,-7.9853050472873823,49.905899801978059,49.969216141677002],"torque_nm":[-0.016726861964776595,0.12911801171045093,0.14972446963663844,-0.93573562128708865,-0.93692280265644379],"angle_rad":[-609.17630365549405,485.32634713202572,-511.91388554656328,1714.2353955683529,1714.2352232672213]},"command":[0.077691492438664772,-0.2228160847358886,-0.24010052026923223,0.5972123956063099,0.5972123956063099],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.10655612107627313,-1.5969137896834282,-0.31111649475396713,-0.00015053226329980876,-0.00055910080050972132,0.0002868421625346094]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":614,"step":4912,"t":24.560000000000002,"sim_time":24.559999999999398,"vehicle":{"origin_ned":[1.5195356800105204,1.0334574175186879,3.4835693313531682],"origin_quat_xyzw":[-0.022227381143195262,0.053248340754070721,0.38908619581749232,0.91939245698380911],"cg_ned":[1.4602912618801218,0.97297230388463563,3.1911183414757471],"linear_velocity_ned":[-0.007013901993886378,-0.0048240548857774214,0.015232800744986194],"angular_velocity_ned":[-0.00071981008550286258,0.0021037886643617354,-0.011821658045213648]},"sensors":{"Odom":[1.5195356800105204,1.0334574175186879,3.4835693313531682,-0.009455338036786911,0.00038854638791514258,0.014068747997613207,-0.022227381143195283,0.053248340754070769,0.38908619581749265,0.91939245698380911,0.0023643411284094444,0.0019747424759921075,-0.011627808711166407],"Pressure":[26675.118235111313],"DVL":[-0.017114390914890764,0.017566295868922669,0.0094648291827472315,7.4351389510886889,0.03144596129967582,0.012577792281736928,0.011858312147603051,0],"IMU":[0.0005688030852049001,0.1154653779871066,0.80072168619909423,0.045691687487740419,-0.020988604351525018,0.036288547460888318,1.1309920224085204,-0.002060812747589142,-9.7091427188528669],"FOG":[0.81023607113989471],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[8.2044986865291616,-23.334287807907327,-25.24955656732995,62.661028477754101,62.661028477754101],"omega_rad_s":[8.3747342981315462,-23.401902352475528,-25.18211228893583,62.748113329555991,62.748075646661107],"thrust_n":[0.90060862437746736,-6.8520629264209916,-8.0130586384626739,49.831223434669212,49.893036418302891],"torque_nm":[-0.016886411707077512,0.12847617987039359,0.15024484947117511,-0.93433543940004771,-0.93549443284317912],"angle_rad":[-608.84201617170186,484.38924734088494,-512.92043691442279,1716.7461462297986,1716.7459723615141]},"command":[0.078138082728849159,-0.22223131245626024,-0.24047196730790429,0.59677169978813427,0.59677169978813427],"arm":{"servo_position":[1.7198739296202534e-22,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[2.7105054312137611e-20,0,0,0,0,0],"servo_effort":[-0.10520351645359816,-1.5963484660436595,-0.31103443750140358,-0.00014917659570670702,-0.00055877254411360456,0.00028686544931467154]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":615,"step":4920,"t":24.600000000000001,"sim_time":24.59999999999939,"vehicle":{"origin_ned":[1.5193093018468224,1.0332450882790973,3.4841706668567363],"origin_quat_xyzw":[-0.022212104560927644,0.053297091625383979,0.38887001827734791,0.91948145784470547],"cg_ned":[1.4600123167448558,0.97277940961607656,3.191726311819997],"linear_velocity_ned":[-0.0069424029720945553,-0.0048211620489248255,0.015172294612975128],"angular_velocity_ned":[-0.00072510981046492698,0.0020275085298789301,-0.011718767174250551]},"sensors":{"Odom":[1.5193093018468224,1.0332450882790973,3.4841706668567363,-0.0094134805961934315,0.00036169584589268347,0.014016217338226007,-0.022212104560927648,0.053297091625383985,0.38887001827734802,0.91948145784470547,0.0022944351663223288,0.0019254855440551215,-0.011532309042313891],"Pressure":[26680.011282129781],"DVL":[0.0098957207914586558,-0.015515395090879246,-0.0093911507767081223,7.3792482891923967,0.0051951501654275631,-0.013790260458196946,-0.032698631812067024,0],"IMU":[0.00060810010747460992,0.11554353678692279,0.80025565896358686,0.085053676104085429,-0.06855916839286845,0.13514067967090065,1.1279302561895244,-0.0027087843914030494,-9.7197908209215313],"FOG":[0.7918770022084457],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[8.2519954110426781,-23.271367347485704,-25.287649351289591,62.614716114274216,62.614716114274216],"omega_rad_s":[8.4166403740968203,-23.34093079894156,-25.223906829773782,62.70002084837887,62.69998664815212],"thrust_n":[0.90941178978121973,-6.8169335790533188,-8.0402173178353458,49.756721010132985,49.816963202215248],"torque_nm":[-0.017051471058397872,0.12781750460724975,0.15075407470941274,-0.93293851893999336,-0.93406806004153609],"angle_rad":[-608.50607220509153,483.45455797520657,-513.92867715883813,1719.2549739926312,1719.2547986951427]},"command":[0.078590432486120743,-0.22163206997605434,-0.24083475572656754,0.59633062965975447,0.59633062965975447],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[2.7105054312137611e-20,0,0,0,0,0],"servo_effort":[-0.10386214402383118,-1.5957601767285126,-0.31094875639829883,-0.00014781213986830231,-0.00055850139457801196,0.00028688596675868798]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":616,"step":4928,"t":24.640000000000001,"sim_time":24.639999999999382,"vehicle":{"origin_ned":[1.5190845897688414,1.0330331356151983,3.4847696199257645],"origin_quat_xyzw":[-0.022197640092078391,0.053344401296373016,0.38865567677535667,0.91956968443667342],"cg_ned":[1.4597362087299142,0.97258660983999112,3.1923317312707846],"linear_velocity_ned":[-0.0068719144428619709,-0.0048192066808528302,0.015105995693988589],"angular_velocity_ned":[-0.00073036419385841961,0.0019482994530591671,-0.011615275973525444]},"sensors":{"Odom":[1.5190845897688414,1.0330331356151983,3.4847696199257645,-0.0093728614424524979,0.00033560564432923867,0.013957922906912015,-0.022197640092078422,0.053344401296373085,0.38865567677535723,0.91956968443667342,0.0022224195360697621,0.0018741323346540258,-0.011436451283222359],"Pressure":[26686.539766565536],"DVL":[0.020039038350276928,0.0082516196918466667,0.0048027301377855068,7.3417404304020337,-0.01793919430302535,-0.003744627119851518,0.004389224721958844,0],"IMU":[0.00064496112309516741,0.11561969308343809,0.79979348298573338,0.0043848837765312725,0.030432067891345373,-0.10191922595369758,1.1458723522770033,-0.008567031840469426,-9.7338132992218291],"FOG":[0.82513642899010808],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[8.2998936945836075,-23.206962665999384,-25.324828639297852,62.56838134127711,62.56838134127711],"omega_rad_s":[8.4595171540654892,-23.278339768770344,-25.264708452381782,62.651898013313726,62.65186736629169],"thrust_n":[0.91846774344505644,-6.7809378807314573,-8.0667786539637358,49.682418711226937,49.741026667809372],"torque_nm":[-0.017221270189594812,0.12714258526371486,0.15125209976182005,-0.93154535083550516,-0.93264425002142592],"angle_rad":[-608.16842935657178,482.52234451475198,-514.93856655091838,1721.7618773038112,1721.7617007180406]},"command":[0.079046606615081977,-0.22101869205713698,-0.24118884418378908,0.59588934610740107,0.59588934610740107],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.0493186101153311e-22],"servo_velocity":[2.7105054312137611e-20,0,0,0,0,0],"servo_effort":[-0.10253379622723674,-1.5951485333143876,-0.31085920846371701,-0.00014646892991261712,-0.00055827963778295087,0.00028690319488049594]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":617,"step":4936,"t":24.68,"sim_time":24.679999999999374,"vehicle":{"origin_ned":[1.5188614706608476,1.0328215240036782,3.485365968834631],"origin_quat_xyzw":[-0.022184007578158974,0.053390217828032369,0.38844318168164249,0.91965713668360649],"cg_ned":[1.4594628980749458,0.97239386794474048,3.1929343708682056],"linear_velocity_ned":[-0.0068024073222071333,-0.0048181492790754779,0.015034026342307206],"angular_velocity_ned":[-0.0007354571550904198,0.0018664638454925617,-0.011511203935207119]},"sensors":{"Odom":[1.5188614706608476,1.0328215240036782,3.485365968834631,-0.0093334072721393251,0.00031018969516597843,0.013893985398701366,-0.022184007578158995,0.05339021782803241,0.38844318168164282,0.91965713668360649,0.0021485941179335785,0.0018208085199896023,-0.01134022046528845],"Pressure":[26689.830978551909],"DVL":[-0.017288438795988261,-0.019104001708110836,0.0066014978118883721,7.4246973944551451,-0.0040337130173048446,0.0081343726634790885,0.006407734950458893,0],"IMU":[0.00067931168114399097,0.11569376442107139,0.79933517281183397,0.0056201269073045549,-0.0030573052659428903,-0.0077819740450010009,1.1185600434717773,-0.011089007420252997,-9.7429980122058328],"FOG":[0.79788425018158116],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[8.3479899523420862,-23.141110548716576,-25.361090677456609,62.522041234143025,62.522041234143025],"omega_rad_s":[8.5031544903360849,-23.214169599760677,-25.304516961688929,62.603763831080343,62.603736799019103],"thrust_n":[0.92773396673211939,-6.7441074162823487,-8.0927395884442657,49.608341218621796,49.665255559136114],"torque_nm":[-0.017395011876227235,0.12645201405529405,0.15173886728333,-0.93015639784915882,-0.93122354173380206],"angle_rad":[-607.82905358380424,481.59267081873782,-515.95006537086283,1724.2668553846656,1724.26667765416]},"command":[0.07950466621278178,-0.22039152903539597,-0.2415341969281582,0.59544801175374307,0.59544801175374307],"arm":{"servo_position":[-9.9063150159350775e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.0493186101153311e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.10121968823463179,-1.5945123925018483,-0.31076527694671047,-0.00014510999330846056,-0.00055809922676674476,0.00028691593698208204]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":618,"step":4944,"t":24.719999999999999,"sim_time":24.719999999999366,"vehicle":{"origin_ned":[1.518639876143002,1.0326102181007055,3.4859594963102434],"origin_quat_xyzw":[-0.02217122230245016,0.053434493974919457,0.38823254324995976,0.91974381439449082],"cg_ned":[1.4591923461456688,0.97220114890883391,3.193534006539251],"linear_velocity_ned":[-0.0067338542257253603,-0.0048179498919222854,0.014956508555024025],"angular_velocity_ned":[-0.00074027148737670857,0.0017823077951702616,-0.011406571876375305]},"sensors":{"Odom":[1.518639876143002,1.0326102181007055,3.4859594963102434,-0.0092950451548176449,0.0002853628010554017,0.01382452485819357,-0.022171222302450173,0.053434493974919492,0.38823254324995998,0.91974381439449082,0.0020732621519751089,0.0017656419540547467,-0.011243602512626145],"Pressure":[26696.325949822527],"DVL":[-0.042157053995668069,-0.017608850006663221,-0.015150283731224458,7.3536525009094191,0.0010591595949793126,0.039686094976685932,-0.0046381178970846051,0],"IMU":[0.00071108948709263991,0.1157656734145007,0.79888074357262695,-0.071611721580896043,-0.0070648457427470151,-0.014211135872357224,1.1386716152378813,0.0025305838660283596,-9.7458322830768029],"FOG":[0.78228142801531297],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[8.396082353096606,-23.073848836454239,-25.396433038459158,62.475712961629391,62.475712961629391],"omega_rad_s":[8.5473406848431139,-23.14846068267391,-25.343331806802418,62.555636736578514,62.555613372407215],"thrust_n":[0.93716674973108605,-6.7064737209402034,-8.11809690074349,49.534512211417777,49.589677673645305],"torque_nm":[-0.017571876557457865,0.12574638226762883,0.15221431688894047,-0.9287721039640835,-0.92980645638084936],"angle_rad":[-607.48791928986373,480.66559913224387,-516.9631338811115,1726.7699082029972,1726.7697294735756]},"command":[0.07996268907711053,-0.21975094129956418,-0.24187079084246815,0.59500679011075608,0.59500679011075608],"arm":{"servo_position":[1.7198739296202534e-22,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.0493186101153311e-22],"servo_velocity":[5.4210108624275222e-20,0,0,0,0,0],"servo_effort":[-0.099921275348870006,-1.5938509273001813,-0.31066658928900803,-0.00014374527164757049,-0.00055796185455055211,0.00028692306957840761]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":619,"step":4952,"t":24.760000000000002,"sim_time":24.759999999999359,"vehicle":{"origin_ned":[1.5184197425385444,1.0323991827359333,3.4865499895084584],"origin_quat_xyzw":[-0.022159294951603081,0.05347718722922646,0.38802377160864626,0.91982971726287421],"cg_ned":[1.4589245153695578,0.97200841931161919,3.1941304190820654],"linear_velocity_ned":[-0.0066662292842306087,-0.0048185685018029313,0.014873564040950128],"angular_velocity_ned":[-0.00074468892413097571,0.001696138833957798,-0.011301401046163185]},"sensors":{"Odom":[1.5184197425385444,1.0323991827359333,3.4865499895084584,-0.0092577031432687969,0.00026104080673523117,0.013749660810701832,-0.022159294951603094,0.053477187229226494,0.38802377160864648,0.91982971726287421,0.0019967284995192,0.0017087611630329797,-0.011146583545235707],"Pressure":[26700.876674396681],"DVL":[0.0077082351652225621,0.009327803855748041,-0.02765457993567759,7.3600810971131194,0.02152664010451491,-0.0013102350874452816,0.049104724054520203,0],"IMU":[0.00074024450050241722,0.11583534781556602,0.79843021097656741,0.05718610891136882,0.03672562700128558,-0.14047010549927544,1.1326149683172433,-0.010156765408573016,-9.7535133804648897],"FOG":[0.79861944234012905],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[8.4439719193665521,-23.00521683050934,-25.430853910951594,62.429413943284821,62.429413943284821],"omega_rad_s":[8.5918640197192495,-23.081253855190301,-25.381152482645291,62.507534857499884,62.507515205322733],"thrust_n":[0.94672148288642277,-6.6680684952528644,-8.1428474625645304,49.460954811310728,49.514320266404056],"torque_nm":[-0.017751027804120429,0.12502628428599122,0.15267838992308494,-0.92739290271207631,-0.92839350499507611],"angle_rad":[-607.14500934915895,479.74119007560557,-517.97773232283225,1729.2710364564466,1729.2708568758458]},"command":[0.080418780184443359,-0.21909730314770801,-0.24219860867572945,0.59456584707890303,0.59456584707890303],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.0493186101153311e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.098639778952509916,-1.5931637938972871,-0.31056285553690466,-0.00014237991920457,-0.00055786919045127271,0.00028692351330096973]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":620,"step":4960,"t":24.800000000000001,"sim_time":24.799999999999351,"vehicle":{"origin_ned":[1.5182010108245048,1.0321883829143401,3.4871372400039862],"origin_quat_xyzw":[-0.022148231609673014,0.053518259837267705,0.38781687674124671,0.91991484487164332],"cg_ned":[1.4586593691763918,0.9718156473414028,3.1947233941613091],"linear_velocity_ned":[-0.006599507947378948,-0.0048199646949890909,0.014785314260451645],"angular_velocity_ned":[-0.00074859172582629832,0.0016082652567408755,-0.011195714172148456]},"sensors":{"Odom":[1.5182010108245048,1.0321883829143401,3.4871372400039862,-0.0092213097123801536,0.00023714105703042662,0.013669512315431426,-0.022148231609673018,0.053518259837267712,0.38781687674124676,0.91991484487164332,0.001919298181449194,0.0016502960026137867,-0.011049151104356567],"Pressure":[26708.777524943962],"DVL":[0.02418426427002765,0.019160382889906458,-0.0033601768570391648,7.4054785699738552,-0.0093815145544612483,0.0040496263769717669,-0.032921003770153077,0],"IMU":[0.00076673894977558315,0.11590272055429515,0.79798359127485086,0.062803059895353452,0.044253510205535487,0.091938607519687118,1.1437521630673999,-0.032287864777570452,-9.7401817380280384],"FOG":[0.78899738163536659],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[8.4914637562672084,-22.935254436561426,-25.464352247741996,62.38316164071891,62.38316164071891],"omega_rad_s":[8.6365140717776914,-23.01259051229281,-25.417978709884526,62.459476145594415,62.459460240745557],"thrust_n":[0.95635292299513519,-6.6289236489441903,-8.1669883599844884,49.387691785355621,49.439210259378896],"torque_nm":[-0.017931617306158786,0.12429231841770357,0.15313103174970918,-0.926019220975418,-0.92698519236335442],"angle_rad":[-606.80031507910292,478.81950262300546,-518.99382092130236,1731.7702415635729,1731.7700612810961]},"command":[0.080871083393021029,-0.21843099463391832,-0.24251764045468566,0.59412534895922775,0.59412534895922775],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.0493186101153311e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.097376503093088901,-1.5924499811260422,-0.31045363149974314,-0.0001410214418034991,-0.00055781506315335367,0.00028691623211362733]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":621,"step":4968,"t":24.84,"sim_time":24.839999999999343,"vehicle":{"origin_ned":[1.5179836265793172,1.0319777838235691,3.4877210437615829],"origin_quat_xyzw":[-0.022138033765211295,0.053557678801126732,0.38761186846806744,0.91999919669809449],"cg_ned":[1.4583968719467988,0.97162280280513968,3.1953127222831301],"linear_velocity_ned":[-0.0065336672130268348,-0.0048220979889557272,0.014691880001283606],"angular_velocity_ned":[-0.0007518621297074935,0.0015189941855522685,-0.011089534134875446]},"sensors":{"Odom":[1.5179836265793172,1.0319777838235691,3.4877210437615829,-0.00918579462894927,0.00021358272704464582,0.013584197590686893,-0.022138033765211305,0.05355767880112676,0.38761186846806767,0.91999919669809449,0.0018412752312346793,0.0015903759070630726,-0.010951292952134586],"Pressure":[26711.797233042875],"DVL":[0.011849998271404684,-0.0091326111566235688,-0.035405430958856829,7.3694374193083432,-0.0276470741708752,0.040487433830048776,-0.022720844384693937,0],"IMU":[0.00079054731126830947,0.11596772976236278,0.79754090122558452,-0.058393243043886496,0.021263143687094452,0.047253025898568245,1.1431245557819951,-0.0074827382814365226,-9.759831043168651],"FOG":[0.77284151483334562],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[8.53836665874333,-22.864002366694663,-25.49692828602101,62.336973793840166,62.336973793840166],"omega_rad_s":[8.6810826948845818,-22.942512671965996,-25.453810811672131,62.41147850421109,62.411466373344261],"thrust_n":[0.96601540558479204,-6.5890713206729652,-8.1905171354637218,49.314745782340133,49.364374436763605],"torque_nm":[-0.018112788854714852,0.12354508726261811,0.15357219628994481,-0.9246514834188776,-0.92558202068931772],"angle_rad":[-606.45383616406946,477.9005940787485,-520.01135990420983,1734.2675256595437,1734.2673448257124]},"command":[0.081317777702317434,-0.21775240349233013,-0.24282788843829534,0.59368546470323968,0.59368546470323968],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.0493186101153311e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.096132322461711328,-1.5917094295974987,-0.31033872589951483,-0.00013964880259525447,-0.00055779198162403268,0.00028690070754528688]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":622,"step":4976,"t":24.879999999999999,"sim_time":24.879999999999335,"vehicle":{"origin_ned":[1.5177675398962058,1.0317673508527441,3.4883012011228338],"origin_quat_xyzw":[-0.022128698357175132,0.053595415858694928,0.38740875643273653,0.92008277211737366],"cg_ned":[1.4581369889477456,0.97142985713270913,3.1958981987846484],"linear_velocity_ned":[-0.0064686854288424269,-0.0048249276994590988,0.014593382019992837],"angular_velocity_ned":[-0.00075438504873312951,0.0014286303541129301,-0.010982885323577806]},"sensors":{"Odom":[1.5177675398962058,1.0317673508527441,3.4883012011228338,-0.0091510884725980318,0.00019028745011219237,0.013493834628305362,-0.02212869835717516,0.053595415858694991,0.38740875643273703,0.92008277211737366,0.0017629601190593505,0.0015291309621377213,-0.010852998739544008],"Pressure":[26717.404543008139],"DVL":[-0.028413104070075884,-0.0086912024327692565,-0.05733856207371147,7.4109679073934798,-0.01841739890628773,0.0073601653744423661,0.033275930068790822,0],"IMU":[0.00081165620031562206,0.11603031878645027,0.79710215806305151,-0.034513264492315621,-0.090250049190397599,-0.13488218110734468,1.1357531115201707,-0.0082883608674432733,-9.7443556775562925],"FOG":[0.82674933085003921],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[8.5844957516068003,-22.791502062180712,-25.528582519301739,62.290868254430329,62.290868254430329],"omega_rad_s":[8.7253652804126958,-22.871063023340874,-25.488649591463695,62.363559862130941,62.363551523346679],"thrust_n":[0.97566313692982365,-6.5485438812462107,-8.2134317131448356,49.242139424820977,49.289839558109428],"torque_nm":[-0.018293683817434195,0.12278519777336645,0.15400184462146566,-0.92329011421539331,-0.92418449171455153],"angle_rad":[-606.1055805374242,476.984520050931,-521.03030952278311,1736.7628915962371,1736.7627103624463]},"command":[0.081757102396255235,-0.21706192440172106,-0.24312935732668323,0.59324636432790789,0.59324636432790789],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,1.0778494253810979e-21,-1.3512822486666261e-22,-4.3537493488871065e-21,-3.0493186101153311e-22],"servo_velocity":[0,0,-1.7347234759768071e-18,0,-8.6736173798840355e-19,0],"servo_effort":[-0.094908229568912122,-1.5909411877572908,-0.31021769532510751,-0.00013827526039096201,-0.00055780454301794383,0.00028687549086587829]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":623,"step":4984,"t":24.920000000000002,"sim_time":24.919999999999327,"vehicle":{"origin_ned":[1.5175527053019695,1.03155704961552,3.4888775167923982],"origin_quat_xyzw":[-0.022120217835585026,0.053631447449235238,0.38720755007537527,0.92016557041221225],"cg_ned":[1.4578796862831793,0.97123678338192243,3.1964796238213506],"linear_velocity_ned":[-0.0064045422990246011,-0.0048284131852346316,0.014489940497151164],"angular_velocity_ned":[-0.00075604708919902895,0.0013374750709010969,-0.010875792333991781]},"sensors":{"Odom":[1.5175527053019695,1.03155704961552,3.4888775167923982,-0.0091171231827183348,0.00016717926286937077,0.013398540708399506,-0.022120217835585026,0.053631447449235231,0.38720755007537527,0.92016557041221225,0.0016846495487214737,0.0014666904660470617,-0.010754258720771124],"Pressure":[26723.179690794557],"DVL":[0.010733496852634739,-0.03004597053424047,-0.028181346417767213,7.3967969182488558,0.0099702570177445105,0.017161028378703751,-0.020233434013278432,0],"IMU":[0.00083006422200091129,0.11609043618585237,0.79666737943468791,-0.049738233708224056,-0.082592503396292233,-0.066043527013362829,1.1490091491514125,0.0008122053233910239,-9.7529756363347655],"FOG":[0.80537896493269978],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[8.6296715559450323,-22.717794987851246,-25.559316981768031,62.244862941247455,62.244862941247455],"omega_rad_s":[8.7691616542973936,-22.798284729383152,-25.522496674523456,62.315738179581075,62.315733642576525],"thrust_n":[0.98525042346073055,-6.5073738017767671,-8.2357306223509745,49.169895345804463,49.215632359256723],"torque_nm":[-0.018473445439888696,0.12201325878331439,0.15441994916908081,-0.92193553773383363,-0.92279310673606374],"angle_rad":[-605.75556421693955,476.07133442889528,-522.05063007890385,1739.2563429432998,1739.2561614614776]},"command":[0.082187348151857451,-0.21635995226524996,-0.24342206649302886,0.59280821848807097,0.59280821848807097],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.0493186101153311e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.093704711554547265,-1.5901452313372118,-0.31009035530745327,-0.00013690236535968863,-0.00055784165390365974,0.0002868401969135747]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":624,"step":4992,"t":24.960000000000001,"sim_time":24.959999999999319,"vehicle":{"origin_ned":[1.5173390816525985,1.0313468459883972,3.4894497998087144],"origin_quat_xyzw":[-0.022112580259975707,0.053665754660419618,0.38700825862497862,0.92024759077491491],"cg_ned":[1.4576249308422196,0.97104355624024163,3.1970568023382513],"linear_velocity_ned":[-0.0063412187188425168,-0.004832513597896485,0.014381674942033039],"angular_velocity_ned":[-0.00075673881588712508,0.001245824801658269,-0.010768280361135373]},"sensors":{"Odom":[1.5173390816525985,1.0313468459883972,3.4894497998087144,-0.0090838315689495443,0.00014418537040806597,0.013298432312428814,-0.022112580259975725,0.053665754660419653,0.3870082586249789,0.92024759077491491,0.001606633928011255,0.0014031835446760364,-0.010655064446976588],"Pressure":[26728.76338089459],"DVL":[0.0074504495564235163,0.024635702949929741,0.0021458048516819969,7.3815888104427438,0.0026044852503483641,0.016175421055393453,0.014010139674513689,0],"IMU":[0.00084578173997935501,0.11614803572466112,0.79623658337444059,-0.02376024003156043,0.00068097650731617065,-0.087137774946868668,1.1324496057599172,-0.009241406409319794,-9.7655742702525554],"FOG":[0.78814370250495813],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[8.6737219799678105,-22.64292350617642,-25.589134101872425,62.198976029083447,62.198976029083447],"omega_rad_s":[8.8122769935118264,-22.724221514507256,-25.555354366066648,62.268031511419593,62.268030777662318],"thrust_n":[0.99473192162445234,-6.4655936860717507,-8.2574129103612499,49.098036288590528,49.141779665806112],"torque_nm":[-0.018651223530458481,0.12122988161384533,0.1548264920692734,-0.92058818041107249,-0.92140836873386467],"angle_rad":[-605.40381110871749,475.16108936280926,-523.07228195459913,1741.7478839907392,1741.7477024130167]},"command":[0.082606875999693435,-0.21564689053501351,-0.24370603906545166,0.5923712002769852,0.5923712002769852],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.0493186101153311e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.092522575757230552,-1.5893211328755632,-0.30995639632063338,-0.0001355441471961987,-0.00055790890491625562,0.0002867935787874884]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":625,"step":5000,"t":25,"sim_time":24.999999999999311,"vehicle":{"origin_ned":[1.5171266320169441,1.0311367061375223,3.4900178635340384],"origin_quat_xyzw":[-0.022105769389627002,0.053698323152222102,0.38681089108672223,0.92032883231322693],"cg_ned":[1.4573726902453179,0.9708501520250874,3.1976295440559537],"linear_velocity_ned":[-0.006278697073504833,-0.0048371883125216848,0.014268704636491557],"angular_velocity_ned":[-0.00075635329679154346,0.0011539697874393261,-0.010660375169623197]},"sensors":{"Odom":[1.5171266320169441,1.0311367061375223,3.4900178635340384,-0.0090511484810390005,0.00012123603513191654,0.013193625610776919,-0.022105769389627022,0.053698323152222151,0.38681089108672262,0.92032883231322693,0.0015291973990462812,0.0013387371277337292,-0.010555408734605516],"Pressure":[26733.323747818034],"DVL":[-0.0058086354906263715,0.014050261019422423,-0.017439742237809856,7.325575589952412,0.038074109808560998,0.017487096768208525,0.00052531754964288749,0],"IMU":[0.00085883064188805604,0.11620307631417051,0.7958097882631644,-0.07724335526472749,0.035160468411781519,-0.05447635724990376,1.1447828628355194,-0.011438755732593011,-9.7528284264304848],"FOG":[0.78789860826207037],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[8.7164814694575163,-22.56693036443421,-25.618036653262187,62.153225727856089,62.153225727856089],"omega_rad_s":[8.8545225479055176,-22.648917620874549,-25.587225651221363,62.220458011697076,62.220461074627778],"thrust_n":[1.0040628590791165,-6.4232362230946141,-8.2784781418796438,49.026585127750522,49.06830835595629],"torque_nm":[-0.018826178607733435,0.12043567918302403,0.15522146516024338,-0.91924847114532227,-0.9200307816741804],"angle_rad":[-605.05035277384434,474.25383524192051,-524.09522564073609,1744.2375197531373,1744.2373382315234]},"command":[0.083014109232928721,-0.21492314632794485,-0.24398130145963987,0.59193548312243893,0.59193548312243893],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-6.7722931110941484e-22,4.3198680309969292e-21,-3.0493186101153311e-22],"servo_velocity":[0,0,0,-1.0842021724855044e-19,0,0],"servo_effort":[-0.09136262896280363,-1.5884690682777591,-0.30981577385041709,-0.00013417267949337815,-0.00054251419911253149,0.00028727821770297899]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":626,"step":5008,"t":25.039999999999999,"sim_time":25.039999999999303,"vehicle":{"origin_ned":[1.5169153235459747,1.0309265965622121,3.4905815256472801],"origin_quat_xyzw":[-0.022099764824223534,0.053729143074086563,0.38661545621237914,0.92040929406266436],"cg_ned":[1.4571229327894997,0.97065654867642626,3.1981976634614764],"linear_velocity_ned":[-0.0062169608474550372,-0.0048423967792713572,0.014151148484694552],"angular_velocity_ned":[-0.00075478904379470198,0.001062193619394304,-0.010552103019534853]},"sensors":{"Odom":[1.5169153235459747,1.0309265965622121,3.4905815256472801,-0.009019009875460832,9.8265076514552298e-05,0.013084236272366337,-0.022099764824223544,0.053729143074086577,0.3866154562123793,0.92040929406266436,0.0014526154909365405,0.0012734777351194263,-0.010455285869560784],"Pressure":[26739.066785803498],"DVL":[0.020394521926826906,-0.0085704998096363498,-0.019199013790066641,7.3121697675242974,-0.011420926260533327,-0.028071930461059082,-0.0043923875469506178,0],"IMU":[0.00086924400412246954,0.11625552198135143,0.79538701274659729,-0.023135891248152338,-0.02618323218553539,-0.056354219802094548,1.1295650489900271,-0.003858917083844126,-9.7295226321834889],"FOG":[0.77618929043732743],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[8.7577927358985441,-22.489857409944957,-25.646028765683305,62.107630236233796,62.107630236233796],"omega_rad_s":[8.8957163600678193,-22.572417411157929,-25.618114263452124,62.173035899175446,62.17304274443017],"thrust_n":[1.0131992664606222,-6.3803339404031281,-8.2989264484193637,48.955564794828781,48.995245335335248],"torque_nm":[-0.018997486246136664,0.11963126138255865,0.15560487090786304,-0.91791683990303985,-0.91866085003753595],"angle_rad":[-604.69522817091558,473.34962068205391,-525.11942176368018,1746.7252559728324,1746.7250746588961]},"command":[0.083407549865700426,-0.21418911818995195,-0.24424789300650768,0.59150124034508378,0.59150124034508378],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.0493186101153311e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.090224683323844021,-1.5875882934510219,-0.30966804044388746,-0.00013278320046868997,-0.00055811126361391945,0.00028666481131000448]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":627,"step":5016,"t":25.080000000000002,"sim_time":25.079999999999295,"vehicle":{"origin_ned":[1.5167051273422913,1.0307164841415135,3.4911406081251117],"origin_quat_xyzw":[-0.022094542153747211,0.05375820896181057,0.38642196248959887,0.92048897499205373],"cg_ned":[1.4568756274087886,0.97046272574980652,3.198760979784494],"linear_velocity_ned":[-0.0061559946974639934,-0.004848098766148108,0.014029124926456121],"angular_velocity_ned":[-0.00075194929260137978,0.00097077113419291898,-0.010443490917835085]},"sensors":{"Odom":[1.5167051273422913,1.0307164841415135,3.4911406081251117,-0.0089873536273887677,7.5210003285420852e-05,0.012970379458646307,-0.022094542153747204,0.05375820896181055,0.38642196248959876,0.92048897499205373,0.0013771541610519107,0.001207529468436245,-0.010354691974370136],"Pressure":[26743.800185877844],"DVL":[-0.0043859267885566012,-0.0058225375215496065,0.0051517140946632633,7.4597593221808713,0.0014927760790093456,0.0063790869466711451,0.01419699968352627,0],"IMU":[0.00087706572618923245,0.11630534180622798,0.79496827569128248,0.054723029403263575,-0.034400381528895921,-0.25218152964294732,1.1415218399766136,-0.024284617627784146,-9.7765161809614884],"FOG":[0.80651364303880935],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[8.7975059194429992,-22.411747164177569,-25.673114954286753,62.062207903517375,62.062207903517375],"omega_rad_s":[8.9356837459663172,-22.494765474317973,-25.648024660536194,62.125783471839085,62.125794077483398],"thrust_n":[1.0220981660814032,-6.336919251603689,-8.3187585154360235,48.884998331122048,48.922617535927699],"torque_nm":[-0.019164340614026311,0.11881723596756916,0.15597672216442543,-0.91659371870853856,-0.91729907879864436],"angle_rad":[-604.33848337171094,472.44849251917014,-526.14483111594745,1749.2110991226532,1749.2109181672183]},"command":[0.083785770661361905,-0.21344521108740541,-0.24450585670749289,0.59106864670016546,0.59106864670016546],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,1.7347234759768071e-18,0,0,0],"servo_effort":[-0.089109292996800468,-1.5866791230065944,-0.30951319022016588,-0.00013140659600586471,-0.00055824335351002208,0.00028658110270638832]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":628,"step":5024,"t":25.120000000000001,"sim_time":25.119999999999287,"vehicle":{"origin_ned":[1.5164960183005864,1.0305063361920166,3.4916949372357551],"origin_quat_xyzw":[-0.02209007314052067,0.053785519617174773,0.38623041811786502,0.92056787401508633],"cg_ned":[1.4566307436208306,0.9702686644081685,3.1993193169853726],"linear_velocity_ned":[-0.0060957845297177522,-0.0048542541360471758,0.013902752054701217],"angular_velocity_ned":[-0.00074774346127108691,0.0008799681101873966,-0.010334566208942625]},"sensors":{"Odom":[1.5164960183005864,1.0305063361920166,3.4916949372357551,-0.008956119192781534,5.2012597955035898e-05,0.012852169916433887,-0.022090073140520691,0.053785519617174815,0.3862304181178654,0.92056787401508633,0.0013030685247027109,0.0011410148178040442,-0.010253624748903187],"Pressure":[26750.22176532467],"DVL":[-0.023042959149439962,-0.022180890330038609,-0.050985725244990815,7.4081279271702103,0.038535056979257035,0.0057764281648593251,0.0033439110426398948,0],"IMU":[0.00088235009050688655,0.11635250985150784,0.79455359610650333,-0.020882336168278972,0.064928795040065421,-0.0096503356270096173,1.1347467264259361,0.0051754386420479002,-9.7284462676733572],"FOG":[0.8025804766289758],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[8.8354807513773945,-22.3326413152637,-25.699300643404698,62.01697703708308,62.01697703708308],"omega_rad_s":[8.9742580253095863,-22.416006289067344,-25.676962055006936,62.078719078982409,62.078733415765846],"thrust_n":[1.030717827435401,-6.2930242484283694,-8.3379756032403751,48.814908830139181,48.850451876601319],"torque_nm":[-0.019325959264413772,0.11799420465803193,0.15633704256075703,-0.91527954056510974,-0.91594597268627476],"angle_rad":[-603.98017125604451,471.55049580783333,-527.1714146854448,1751.6950564085955,1751.694875961444]},"command":[0.084147435727403755,-0.21269182205013049,-0.24475524422290187,0.59063787654364841,0.59063787654364841],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-6.7722931110941484e-22,-1.6940658945088655e-23,-3.0493186101153311e-22],"servo_velocity":[0,0,0,-1.0842021724855044e-19,0,-5.4210108624275222e-20],"servo_effort":[-0.088016836959259548,-1.5857417554215845,-0.30935098322423465,-0.00013003890253743855,-0.00055839342608651776,0.00028648337213676468]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":629,"step":5032,"t":25.16,"sim_time":25.159999999999279,"vehicle":{"origin_ned":[1.5162879749679206,1.0302961205112042,3.4922443435265174],"origin_quat_xyzw":[-0.022086325878061232,0.053811077988699128,0.38604083099693776,0.92064598999729308],"cg_ned":[1.4563882514884725,0.97007434741007847,3.1998725037353721],"linear_velocity_ned":[-0.0060363171395457363,-0.0048608231856535396,0.013772147473857139],"angular_velocity_ned":[-0.00074208625901166073,0.00079004118096210512,-0.010225356398227624]},"sensors":{"Odom":[1.5162879749679206,1.0302961205112042,3.4922443435265174,-0.0089252477922840429,2.8618250342891412e-05,0.01272972187954367,-0.022086325878061235,0.053811077988699135,0.38604083099693781,0.92064598999729308,0.0012306033993191167,0.0010740539418746474,-0.010152083232407639],"Pressure":[26753.676126793984],"DVL":[-0.033487306470997354,0.032921582558442249,-0.0059444877599132201,7.4199280964513283,-0.0020034010799111677,-0.0011640048107281369,-0.012294568548595572,0],"IMU":[0.00088516136781018051,0.11639700507543384,0.79414299309510716,0.01675867375521805,-0.1370218812486364,-0.081706613079365831,1.1458841743396582,-0.01240940084446001,-9.7505050097659236],"FOG":[0.79999437764461223],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[8.8715836101336283,-22.252581566421913,-25.724591642568061,61.971955980325362,61.971955980325362],"omega_rad_s":[9.0112806477684462,-22.336184210679754,-25.704932349502798,62.031861109122865,62.031879140747456],"thrust_n":[1.0390178896172897,-6.2486806847103189,-8.3565795069274245,48.745319433512577,48.778775237416568],"torque_nm":[-0.019481585430324185,0.1171627628383185,0.15668586575488924,-0.91397473937836093,-0.91460203570156073],"angle_rad":[-603.62035118330471,470.65567382643383,-528.19913368490097,1754.1771357714983,1754.1769559810814]},"command":[0.084491272477463131,-0.21192934825163728,-0.24499611088160059,0.59020910457452724,0.59020910457452724],"arm":{"servo_position":[3.6462121401337282e-23,3.2526065174565154e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.0493186101153311e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.086946979690550555,-1.5847760658982344,-0.30918140868275712,-0.00012867771194822461,-0.00055856529215088922,0.00028637151990401388]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":630,"step":5040,"t":25.199999999999999,"sim_time":25.199999999999271,"vehicle":{"origin_ned":[1.5160809793700474,1.0300858054478008,3.4927886618181763],"origin_quat_xyzw":[-0.022083265015719167,0.053834891025623673,0.3858532087033007,0.92072332176820171],"cg_ned":[1.4561481215757459,0.96987975909611557,3.2004203734035062],"linear_velocity_ned":[-0.0059775804425025317,-0.0048677664839442214,0.013637428383292599],"angular_velocity_ned":[-0.00073489979267164719,0.00070123496074203358,-0.010115889293773732]},"sensors":{"Odom":[1.5160809793700474,1.0300858054478008,3.4927886618181763,-0.0088946826218787509,4.9772298269454268e-06,0.012603149178328844,-0.022083265015719191,0.053834891025623735,0.38585320870330109,0.92072332176820171,0.0011599898250247999,0.0010067641327095682,-0.010050068356297397],"Pressure":[26760.682334679037],"DVL":[0.032993810438494475,0.04076188227913477,0.0089465103433061088,7.3652775129579693,0.0041226628543667458,0.024453073282970045,-0.0027373504157598544,0],"IMU":[0.00088557327846440666,0.11643881124530288,0.79373648576940603,0.12192850691731957,-0.14453449685968195,0.031084202766431847,1.1512538400964447,-0.0063258141799519239,-9.776115828419373],"FOG":[0.78616292181511771],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[8.905691156770132,-22.171608643523733,-25.748994884850788,61.927162997299213,61.927162997299213],"omega_rad_s":[9.0466016503427635,-22.255343275381573,-25.73194219189897,61.985227963249017,61.985249646645393],"thrust_n":[1.0469595645586256,-6.2039198524954795,-8.3745725947976428,48.676253288876801,48.707614410510971],"torque_nm":[-0.019630491835474231,0.11632349723429024,0.15702323615245584,-0.91267974916644012,-0.91326777019708083],"angle_rad":[-603.25908866251336,469.76406808527963,-529.2279495795384,1756.6573458881587,1756.6571669013233]},"command":[0.084816106254953644,-0.21115817755736888,-0.24522852271286466,0.58978250473618299,0.58978250473618299],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-6.7722931110941484e-22,-1.6940658945088655e-23,-3.0493186101153311e-22],"servo_velocity":[0,0,0,-1.0842021724855044e-19,0,0],"servo_effort":[-0.08589968636209,-1.5837822627241511,-0.30900420986154709,-0.00012730679308720286,-0.00055874431370775066,0.00028624482609627294]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":631,"step":5048,"t":25.240000000000002,"sim_time":25.239999999999263,"vehicle":{"origin_ned":[1.5158750168392481,1.0298753599624813,3.4933277312007096],"origin_quat_xyzw":[-0.022080851974518,0.053856969525018436,0.38566755847302508,0.92079986813156978],"cg_ned":[1.4559103249075174,0.96968488537106334,3.2009627640428615],"linear_velocity_ned":[-0.0059195634055663757,-0.0048750452210437976,0.01349871189076499],"angular_velocity_ned":[-0.00072611367589483448,0.00061378320555432781,-0.01000619368641084]},"sensors":{"Odom":[1.5158750168392481,1.0298753599624813,3.4933277312007096,-0.0088643688225988702,-1.8955910462972291e-05,0.01247256548862552,-0.02208085197451801,0.053856969525018457,0.38566755847302525,0.92079986813156978,0.0010914458972316216,0.00093926067978745628,-0.0099475835363434743],"Pressure":[26765.423067344451],"DVL":[-0.027661038846976346,-0.006446614734827009,-0.020685723064633493,7.4002311608831386,-0.0079710486108088615,-0.0018794787600289571,0.030115114349694772,0],"IMU":[0.00088366846573603502,0.11647791683049782,0.79333409318075798,-0.0053766666622113981,-0.044248420199141533,-0.024156960740268553,1.1433336965729735,0.0021961752335967356,-9.7171936250950974],"FOG":[0.80842051198616549],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[8.937688725901209,-22.089762848975543,-25.772517585859514,61.882616314426485,61.882616314426485],"omega_rad_s":[9.0800801133332278,-22.17352708796782,-25.757998881354084,61.938838035816339,61.938863321437331],"thrust_n":[1.0545058430234029,-6.158772508824268,-8.3919577464119559,48.607733512271444,48.636996072560187],"torque_nm":[-0.019771984556688806,0.11547698454045503,0.15734920774522415,-0.91139500335508961,-0.91194367636050355],"angle_rad":[-602.89645499484072,468.87571834277679,-530.25782411546083,1759.1356961713618,1759.1355181330846]},"command":[0.08512084500858294,-0.21037869379976706,-0.24545254843675729,0.5893582506135856,0.5893582506135856],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,-8.6736173798840355e-19,0],"servo_effort":[-0.084875236921435726,-1.582760585072545,-0.30881938661827824,-0.00012592747782871311,-0.00054349718642877963,0.00028664396106154019]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":632,"step":5056,"t":25.280000000000001,"sim_time":25.279999999999255,"vehicle":{"origin_ned":[1.5156700758402566,1.0296647536911416,3.4938613950281847],"origin_quat_xyzw":[-0.022079045176013525,0.053877327972603729,0.38548388718626042,0.92087562787513189],"cg_ned":[1.4556748329336522,0.96948971368255388,3.2014995183757056],"linear_velocity_ned":[-0.0058622556675136852,-0.0048826210284480202,0.013356114474434719],"angular_velocity_ned":[-0.0007156644200418357,0.0005279069531003471,-0.0098962973006633658]},"sensors":{"Odom":[1.5156700758402566,1.0296647536911416,3.4938613950281847,-0.0088342535477601864,-4.3222066725314022e-05,0.012338083936816766,-0.022079045176013536,0.05387732797260375,0.38548388718626059,0.92087562787513189,0.001025175642638672,0.0008716551069911921,-0.0098446327434068958],"Pressure":[26770.503217320831],"DVL":[0.0030953689540407763,-0.00094063974487044576,-0.0089746231469523992,7.2839825596295684,-0.014504255870490194,0.021038034303477393,0.0041236607466694037,0],"IMU":[0.00087953794047105911,0.11651431489302554,0.79293583425053571,-0.10467316865397183,0.13480260881316539,0.16224127354951454,1.1276766705069923,-0.020706001594714959,-9.734891339642628],"FOG":[0.77671002090312413],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[8.9674705008357698,-22.007083483163889,-25.795167763851893,61.838334061777054,61.838334061777054],"omega_rad_s":[9.1115842325970213,-22.090778577114879,-25.783110452545881,61.89270967461497,61.892738506730531],"thrust_n":[1.0616216133094927,-6.113268739595112,-8.4087384091754149,48.53978315049671,48.566946711929795],"torque_nm":[-0.01990540524955299,0.11462378886740836,0.15766384517203905,-0.91012093407181316,-0.91063025084868365],"angle_rad":[-602.53252691089926,467.99066262888783,-531.28871934813742,1761.6121967685492,1761.6120198216852]},"command":[0.085404480960340673,-0.20959127126822752,-0.24566826441763706,0.58893651487406717,0.58893651487406717],"arm":{"servo_position":[3.6462121401337282e-23,3.2526065174565154e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,8.6736173798840355e-19,0,0,0,0],"servo_effort":[-0.083872694276732274,-1.5817114756293833,-0.30862686166890052,-0.00012456995238922306,-0.00055913925862948887,0.00028594529452902331]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":633,"step":5064,"t":25.32,"sim_time":25.319999999999247,"vehicle":{"origin_ned":[1.5154661477935691,1.0294539570124341,3.4943895009150898],"origin_quat_xyzw":[-0.022077800281205515,0.053895984376118214,0.38530220134651388,0.92095059978285632],"cg_ned":[1.4554416174962119,0.96929423300045492,3.2020304837793065],"linear_velocity_ned":[-0.0058056478336219559,-0.0048904560339005608,0.013209752242518113],"angular_velocity_ned":[-0.00070349694066643392,0.00044381514478258557,-0.0097862294798466663]},"sensors":{"Odom":[1.5154661477935691,1.0294539570124341,3.4943895009150898,-0.0088042857855817475,-6.7857486761877073e-05,0.012199817258640076,-0.022077800281205522,0.053895984376118235,0.38530220134651405,0.92095059978285632,0.00096136872979952939,0.00080405665321670581,-0.0097412232457873074],"Pressure":[26774.765408160056],"DVL":[0.034109090330953495,-0.010128376310379168,0.0064777992568061469,7.3934635179672661,-0.031272341481520458,0.0032676095673238293,0.016477930971828807,0],"IMU":[0.00087328050090266607,0.11654800297110463,0.79254172768776188,0.042729009810928344,-0.1447103079892641,0.071663257002467284,1.145870021319731,-0.010896775640179322,-9.7130971753885937],"FOG":[0.78783381024621257],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[8.9949393846933212,-21.92360897457603,-25.816954022564818,61.794334210480599,61.794334210480599],"omega_rad_s":[9.1409914088142532,-22.007140022621869,-25.807285527156928,61.846861160738662,61.846893477744025],"thrust_n":[1.0682737832801141,-6.0674379639459319,-8.424918504470579,48.472425132632544,48.497492610381222],"torque_nm":[-0.020030133436502139,0.11376446182398622,0.15796722195882343,-0.9088579712368603,-0.90932798644464807],"angle_rad":[-602.16738620356841,467.10893726993453,-532.32059766696557,1764.0868585597384,1764.0866828447802]},"command":[0.085666089378031635,-0.20879627594834313,-0.24587575259585542,0.58851746867124377,0.58851746867124377],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.082892320475849046,-1.5806351737551647,-0.30842658549805246,-0.00012321439758187702,-0.00055935465375629657,0.00028577149427554246]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":634,"step":5072,"t":25.359999999999999,"sim_time":25.359999999999239,"vehicle":{"origin_ned":[1.5152632268887882,1.0292429411174588,3.4949119007267986],"origin_quat_xyzw":[-0.022077070443437891,0.053912960084511935,0.38512250706120377,0.92102478264727183],"cg_ned":[1.4552106507975548,0.96909843379358529,3.2025555122643738],"linear_velocity_ned":[-0.00574973123928411,-0.0048985131763332121,0.013059740987230643],"angular_velocity_ned":[-0.00068956397282205167,0.00036170272479352233,-0.0096760188715557405]},"sensors":{"Odom":[1.5152632268887882,1.0292429411174588,3.4949119007267986,-0.0087744169479679144,-9.2893712102265277e-05,0.012057877940241714,-0.022077070443437895,0.053912960084511942,0.38512250706120382,0.92102478264727183,0.00090019926978789446,0.00073657049626222563,-0.0096373634213486742],"Pressure":[26778.355670681529],"DVL":[-0.022140974875008448,0.029805854259620422,-0.017186477326416399,7.3054331136207189,0.031265578946224525,0.016841552434539959,-0.039914681836664516,0],"IMU":[0.00086500211589777502,0.11657898294640319,0.79215179190661766,0.025350308364968908,-0.039313714445101275,0.15398062210556129,1.141954991215137,-0.017548995789273856,-9.7548319399569756],"FOG":[0.80204580821339566],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[9.0200075799758199,-21.839376641192445,-25.83788577737192,61.750634723881085,61.750634723881085],"omega_rad_s":[9.1681884194647321,-21.92265277855789,-25.83053349779637,61.801310711717008,61.801346446443276],"thrust_n":[1.0744314181277932,-6.0213087828484655,-8.4405025447121318,48.405682297342821,48.428659827970229],"torque_nm":[-0.020145589089896117,0.11289953967840875,0.15825942271335247,-0.90760654307517785,-0.90803737177444188],"angle_rad":[-601.80111935636637,466.23057692240627,-533.35342182456566,1766.5596931547304,1766.5595188095804]},"command":[0.085904834095007807,-0.20799406324945185,-0.24607510264163732,0.58810128308458176,0.58810128308458176],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,1.0778494253810979e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,-1.7347234759768071e-18,0,0,0],"servo_effort":[-0.081933502677663944,-1.5795321848368411,-0.30821854577378138,-0.0001218666003760912,-0.00055957153081790561,0.00028558153883942596]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":635,"step":5080,"t":25.400000000000002,"sim_time":25.399999999999231,"vehicle":{"origin_ned":[1.5150613098872587,1.0290316780822386,3.4954284505894071],"origin_quat_xyzw":[-0.022076806584843529,0.05392827960051684,0.38494481002782377,0.92109817527937077],"cg_ned":[1.4549819053671866,0.96890230799699573,3.2030744604731742],"linear_velocity_ned":[-0.0056944979978415695,-0.0049067560131670074,0.012906196439955447],"angular_velocity_ned":[-0.0006738279732687643,0.00028175028464693199,-0.0095656944244137971]},"sensors":{"Odom":[1.5150613098872587,1.0290316780822386,3.4954284505894071,-0.0087446004659490779,-0.0001183570545574758,0.011912378433545945,-0.022076806584843536,0.053928279600516854,0.38494481002782388,0.92109817527937077,0.00084182436255687983,0.00066929882805799915,-0.0095330639357493717],"Pressure":[26786.923710043662],"DVL":[-0.015575805837131083,0.007551417561863288,-0.037296253195686684,7.2921801717490133,0.019058182125490573,0.021898669076330961,-0.023980992731622304,0],"IMU":[0.00085481526038097642,0.11660726091623379,0.79176604495314817,-0.16723904212941104,0.053940999890056511,0.19540219212571955,1.1317171706274702,-0.01177537361032528,-9.761745873012595],"FOG":[0.78841280431534466],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[9.042596635048973,-21.754422538904102,-25.857972769327024,61.70725327329675,61.70725327329675],"omega_rad_s":[9.1930715378747134,-21.837357188723036,-25.852864325080965,61.756076420400134,61.756115500431783],"thrust_n":[1.0800658634935572,-5.9749089298420381,-8.455495500935621,48.339577276034746,48.360474113622637],"torque_nm":[-0.020251234940504195,0.11202954243453822,0.15854054064254286,-0.90636707392565141,-0.9067588896304245],"angle_rad":[-601.43381716632723,465.35561461121932,-534.38715496207044,1769.0307128893553,1769.0305400491095]},"command":[0.086119967952847362,-0.20718497656099144,-0.24626640732692404,0.58768812641235002,0.58768812641235002],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.080995475157316199,-1.5784030501478772,-0.3080026994129888,-0.00012050713235068494,-0.00055979920096459266,0.00028537456904266371]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":636,"step":5088,"t":25.440000000000001,"sim_time":25.439999999999223,"vehicle":{"origin_ned":[1.5148603959378564,1.0288201409390714,3.4959390108874571],"origin_quat_xyzw":[-0.022076957656390464,0.053941970390300249,0.38476911551360382,0.92117077652188295],"cg_ned":[1.4547553540386884,0.96870584898815149,3.2035871896638568],"linear_velocity_ned":[-0.0056399408236129248,-0.0049151489043912679,0.012749233761519223],"angular_velocity_ned":[-0.00065625926023001296,0.00020412545049844558,-0.0094552850437786187]},"sensors":{"Odom":[1.5148603959378564,1.0288201409390714,3.4959390108874571,-0.0087147918413291899,-0.00014426951785930609,0.011763430671673375,-0.022076957656390471,0.053941970390300263,0.38476911551360393,0.92117077652188295,0.00078638634236894399,0.00060234047675385247,-0.0094283371357775526],"Pressure":[26791.130163960544],"DVL":[-0.033761320646479319,0.011148172414324161,0.00050969971707759236,7.4329535995581884,-0.013400447401454638,0.024290989353795592,-0.011799477022447411,0],"IMU":[0.000842838278311638,0.11663284704668921,0.79138450441870833,0.017821685492443042,-0.0051894146003324589,0.08988901087873255,1.1658288278528095,-0.01247138241111467,-9.7910230178326145],"FOG":[0.7771290102945716],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[9.0626369033963314,-21.668781286504462,-25.877225614688435,61.664207334551286,61.664207334551286],"omega_rad_s":[9.2155466868156992,-21.751292419397902,-25.874288637963598,61.711176216470761,61.711218564469114],"thrust_n":[1.0851508724230785,-5.9282651847889385,-8.4699028702060701,48.274132454882043,48.292960850539217],"torque_nm":[-0.020346578857932722,0.11115497221479262,0.15881067881636385,-0.90513998352903824,-0.90549301594761045],"angle_rad":[-601.06557435782167,464.4840817740066,-535.42176063418833,1771.4999308194137,1771.4997596161595]},"command":[0.086310827651393626,-0.20636934558575679,-0.24644976775893748,0.58727816509096464,0.58727816509096464],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,-8.6736173798840355e-19,0,0,0,0],"servo_effort":[-0.080077837620767534,-1.5772481394292284,-0.30777911569937616,-0.00011914789838432511,-0.00056002876149784261,0.00028515095659114632]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":637,"step":5096,"t":25.48,"sim_time":25.479999999999215,"vehicle":{"origin_ned":[1.5146604883772121,1.0286083057788749,3.4964434431524412],"origin_quat_xyzw":[-0.022077470726079053,0.053954062218614242,0.38459542835492366,0.92124258528627601],"cg_ned":[1.4545309721296025,0.96850905379280672,3.2040935624995486],"linear_velocity_ned":[-0.0055859138291194472,-0.0049235154669080372,0.012588766312171288],"angular_velocity_ned":[-0.00063679185727829072,0.00012893435615844427,-0.0093448199339590584]},"sensors":{"Odom":[1.5146604883772121,1.0286083057788749,3.4964434431524412,-0.0086847477082329858,-0.00017064743803468419,0.011610972630117898,-0.022077470726079077,0.053954062218614304,0.38459542835492405,0.92124258528627601,0.000734009380723053,0.00053572536281064657,-0.0093231977400709733],"Pressure":[26793.476421698546],"DVL":[-0.013425401510562304,-0.01314415838737513,-0.020363341246645357,7.3741094481534839,0.013514086422867643,-0.0047833065092458644,0.026441240044118634,0],"IMU":[0.00082919469825006346,0.11665575441493387,0.79100718736822184,-0.0025265613827339974,-0.047890958154565247,-0.090139403126344636,1.1562875994259618,-0.00026208975668928769,-9.7725263455104994],"FOG":[0.78594944555921009],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[9.0800678858291217,-21.582512497743597,-25.895676847724264,61.621524734616138,61.621524734616138],"omega_rad_s":[9.2355292423239366,-21.6645013081001,-25.894821664818796,61.666629826594111,61.666675360855386],"thrust_n":[1.0896626445075563,-5.8814077598430634,-8.4837353244071085,48.209377583374085,48.226151084483298],"torque_nm":[-0.020431174584516685,0.11027639549705744,0.15907003733263328,-0.90392582968826418,-0.90424033283406191],"angle_rad":[-600.69648920405291,463.61600824628687,-536.45720288566019,1773.967360739382,1773.9671913020118]},"command":[0.086476837007896393,-0.20554773807374854,-0.24662549378785015,0.58687166413920133,0.58687166413920133],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.079179682502719895,-1.5760326144170709,-0.30753392811894398,-0.00011781222050405665,-0.00056023437513215706,0.00028487460601038706]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":638,"step":5104,"t":25.52,"sim_time":25.519999999999207,"vehicle":{"origin_ned":[1.5144616010199838,1.0283961584720356,3.4969415999612692],"origin_quat_xyzw":[-0.02207829061050148,0.053964585484575375,0.38442375294620201,0.9213136006637227],"cg_ned":[1.4543087445447256,0.96831193038500407,3.2045934326602414],"linear_velocity_ned":[-0.00553218730640822,-0.0049315902359403667,0.012424580747380017],"angular_velocity_ned":[-0.00061534206909109998,5.6248928689997795e-05,-0.0092343305812671844]},"sensors":{"Odom":[1.5144616010199838,1.0283961584720356,3.4969415999612692,-0.0086540995376883662,-0.00019750051669236202,0.011454832569517688,-0.02207829061050149,0.053964585484575396,0.38442375294620218,0.9213136006637227,0.00068480610215461424,0.00046944686281924226,-0.0092176640931170561],"Pressure":[26799.620570904041],"DVL":[0.013962095780128862,0.026641172057701112,0.0065646207673285654,7.273750415211877,0.00332331627933936,0.017759596913569958,0.011238004358246843,0],"IMU":[0.00081401261925378087,0.1166759956505113,0.7906341101950678,0.024873641747939681,0.0088782183610712322,-0.051773907770544671,1.1425388793351059,-0.019730786877804291,-9.7776641117386642],"FOG":[0.79484588877062679],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[9.0948421908621491,-21.495958479941688,-25.913596947251307,61.579347512932408,61.579347512932408],"omega_rad_s":[9.2529451352069181,-21.577105403777225,-25.914546005218391,61.622489041282925,61.622537677864642],"thrust_n":[1.0935801774185459,-5.8344114430970713,-8.4970504046604241,48.145397866471555,48.160129565816],"torque_nm":[-0.020504628326597739,0.10939521455807011,0.15931969508738297,-0.90272620999634168,-0.90300242935905017],"angle_rad":[-600.3266631269604,462.75142059313112,-537.49344770796347,1776.4330178686741,1776.4328503227541]},"command":[0.086617544674877617,-0.20472341409468275,-0.24679616140239341,0.58646997631364195,0.58646997631364195],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.078300662833382662,-1.5747678447503985,-0.30727144882779373,-0.00011647796928304017,-0.00056042449897218021,0.0002845563829296088]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":639,"step":5112,"t":25.560000000000002,"sim_time":25.559999999999199,"vehicle":{"origin_ned":[1.5142637522256415,1.0281836889560536,3.4974333335573964],"origin_quat_xyzw":[-0.02207936068905687,0.053973572538505134,0.38425409316894732,0.92138382185813472],"cg_ned":[1.4540886593127467,0.96811449124045834,3.2050866537234257],"linear_velocity_ned":[-0.005478760554359881,-0.0049393389199897334,0.012256782552711206],"angular_velocity_ned":[-0.00059191138854878514,-1.3795136811060377e-05,-0.0091238493330473448]},"sensors":{"Odom":[1.5142637522256415,1.0281836889560536,3.4974333335573964,-0.0086228075252199072,-0.00022483346745553649,0.011295112240266886,-0.022079360689056891,0.053973572538505182,0.38425409316894771,0.92138382185813472,0.00063887473809036096,0.00040360385082572605,-0.0091117571878573771],"Pressure":[26804.932180341319],"DVL":[-0.0095325207020611202,0.015525632877422689,-0.029845563405733334,7.3487381369992724,-0.03987354162118887,0.03611093827154075,0.015654841180219172,0],"IMU":[0.00079742421499684186,0.11669358599988858,0.79026528851224465,0.036886047335294471,0.07620466079118024,0.041038212438545191,1.127572995528312,-0.012666440661094888,-9.7679735915281007],"FOG":[0.78312463786899311],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[9.1069234914736903,-21.409239210389131,-25.931070424356324,61.537730452931086,61.537730452931086],"omega_rad_s":[9.2677315801934537,-21.489254115756907,-25.933568643199102,61.578817550722405,61.578869203987445],"thrust_n":[1.0968855049824058,-5.7873616046808287,-8.5099177940610229,48.082288060536662,48.094993795068675],"torque_nm":[-0.020566603218420108,0.10851303008776557,0.15956095863864417,-0.90154290113506275,-0.90178113365753776],"angle_rad":[-599.95620025284472,461.89033950241952,-538.53046527090669,1778.8969199190453,1778.8967543867491]},"command":[0.086732604680701805,-0.20389751628942029,-0.24696257547006023,0.58607362336124846,0.58607362336124846],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.0493186101153311e-22],"servo_velocity":[0,0,0,0,-8.6736173798840355e-19,0],"servo_effort":[-0.07744011723216121,-1.5734731363595094,-0.30699914114193322,-0.00011514455904937984,-0.00054525770506075463,0.00028475345133315954]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":640,"step":5120,"t":25.600000000000001,"sim_time":25.599999999999191,"vehicle":{"origin_ned":[1.5140669615348443,1.0279708880888456,3.4979185011098894],"origin_quat_xyzw":[-0.022080623521755629,0.053981058311393902,0.3840864523507555,0.92145324815157226],"cg_ned":[1.4538707040208765,0.96791674971534247,3.2055730845616814],"linear_velocity_ned":[-0.005425653782780435,-0.0049467491944091948,0.012085525170529469],"angular_velocity_ned":[-0.00056652044067812338,-8.1066874902583459e-05,-0.0090134077869354449]},"sensors":{"Odom":[1.5140669615348443,1.0279708880888456,3.4979185011098894,-0.0085908645904036966,-0.00025264656554366326,0.011131956960942475,-0.022080623521755643,0.053981058311393937,0.38408645235075578,0.92145324815157226,0.00059629662123348334,0.00033830554138521173,-0.0090054992577688203],"Pressure":[26808.266968815275],"DVL":[-0.017983720915678791,0.031460843185535319,-0.00032132729021532372,7.2689314414857389,0.0024600745077570326,-0.022548295383045765,0.006813008978864791,0],"IMU":[0.00077956506897192764,0.1167085449677987,0.78990073706307939,0.039633469829211371,-0.0032726703623149837,0.062372468809615542,1.1534539731978446,-0.023280508790097857,-9.7585540749519737],"FOG":[0.7900400981887169],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[9.1162843362323436,-21.322386401239321,-25.948110627408756,61.496690886561957,61.496690886561957],"omega_rad_s":[9.2798365528297744,-21.401061171697631,-25.951968223778657,61.535665261843803,61.53571984367435],"thrust_n":[1.0995636301044931,-5.7403224203402878,-8.5223880510614123,48.020119250406005,48.030818095681951],"torque_nm":[-0.020616818064459246,0.10763104538138041,0.15979477595740152,-0.90037723594511265,-0.90057783929403656],"angle_rad":[-599.58520697219865,461.03278050846041,-539.56822936898288,1781.3590868382701,1781.3589234382914]},"command":[0.086821755583165183,-0.20307034667846971,-0.24712486311817863,0.58568277034820915,0.58568277034820915],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.0493186101153311e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.076596910623052433,-1.5721547603616153,-0.30671868136231911,-0.00011382416223537409,-0.0005607764001072631,0.00028385551068630803]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":641,"step":5128,"t":25.640000000000001,"sim_time":25.639999999999183,"vehicle":{"origin_ned":[1.513871249064221,1.0277577472940513,3.498396965815644],"origin_quat_xyzw":[-0.022082021208509432,0.053987080246218476,0.38392083325474646,0.92152187890403148],"cg_ned":[1.4536548653281298,0.96771871951269606,3.2060525904566601],"linear_velocity_ned":[-0.0053728912159617843,-0.0049538139735957358,0.011910971160957129],"angular_velocity_ned":[-0.00053920110875660876,-0.00014545001927002415,-0.0089030377406716862]},"sensors":{"Odom":[1.513871249064221,1.0277577472940513,3.498396965815644,-0.0085582720302998169,-0.00028093559717792268,0.010965520448220405,-0.022082021208509436,0.053987080246218483,0.38392083325474652,0.92152187890403148,0.00055713475721247494,0.00027365885178907208,-0.0088989148917583052],"Pressure":[26814.62873903073],"DVL":[0.010939403795816965,-0.015374468405085783,-0.0034073929011402592,7.5002970441724335,-0.015461869271444977,-0.019949450835387055,-0.0082797059735731145,0],"IMU":[0.00076057344960574517,0.11672089646741941,0.78954046965736524,-0.047024213713534845,0.0071793856655996465,-0.2274950088347733,1.1463590989168027,0.0030284322202071227,-9.7756927812448957],"FOG":[0.77423004390896633],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[9.1229059091508962,-21.235414062275872,-25.964717629523797,61.456235060012723,61.456235060012723],"omega_rad_s":[9.2892181925670609,-21.312608973317115,-25.969798727382774,61.493068222186771,61.493125641355356],"thrust_n":[1.1016024348534201,-5.6933400681594994,-8.5344955053651823,47.958940305203541,47.9676545437935],"torque_nm":[-0.020655045653501625,0.10675012627799062,0.16002179072559719,-0.89923013072256641,-0.89939352269612827],"angle_rad":[-599.21379152431177,460.17875533064745,-540.60671636263373,1783.8195402468291,1783.8193790942689]},"command":[0.086884818182389495,-0.20224203868834165,-0.24728302504308378,0.58529747676202593,0.58529747676202593],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.0493186101153311e-22],"servo_velocity":[0,0,0,0,-8.6736173798840355e-19,0],"servo_effort":[-0.075770637399823135,-1.5708142746605993,-0.30643049359634861,-0.00011248536719774848,-0.00054562374524985322,0.00028401348574652125]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":642,"step":5136,"t":25.68,"sim_time":25.679999999999175,"vehicle":{"origin_ned":[1.5136766352732047,1.0275442585514403,3.498868597045822],"origin_quat_xyzw":[-0.022083495671832595,0.053991678081028976,0.38375723806606243,0.92158971356499741],"cg_ned":[1.4534411289125866,0.9675204145693006,3.206525043228905],"linear_velocity_ned":[-0.0053204975542184407,-0.0049605283182373458,0.011733284576167801],"angular_velocity_ned":[-0.00050999380513977628,-0.00020684404288875396,-0.0087927700622647594]},"sensors":{"Odom":[1.5136766352732047,1.0275442585514403,3.498868597045822,-0.0085250347722574046,-0.00030969247800981004,0.010795957928701907,-0.022083495671832609,0.053991678081029004,0.38375723806606266,0.92158971356499741,0.00052143487378493772,0.00020976570491570203,-0.0087920297729626191],"Pressure":[26819.283080312685],"DVL":[-0.027157804890147103,0.019803829735687211,0.031776826453630648,7.3957732406434911,-0.0044897972269314357,0.0062358293892638972,-0.0080187511640100358,0],"IMU":[0.00074058961206843591,0.11673066863651574,0.78918449909432797,0.0077053578932820329,0.017913715261986839,-0.0094151731362627552,1.1404568700190576,-0.0030036308740824949,-9.7512243095831579],"FOG":[0.78802039674385749],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[9.1267761524009892,-21.148331845120492,-25.980890560607662,61.416367661274599,61.416367661274599],"omega_rad_s":[9.2958440800339979,-21.223956704903411,-25.987096697931108,61.451052228654085,61.451112390510744],"thrust_n":[1.1029925508239178,-5.6464475210076426,-8.5462630775695931,47.898783991524759,47.905538944675129],"torque_nm":[-0.020681110327948456,0.10587089101889331,0.16024243270442989,-0.8981021998410893,-0.89822885521265861],"angle_rad":[-598.84206360444807,459.32827294040283,-541.6459043582696,1786.2783029648251,1786.278144171059]},"command":[0.086921677641914177,-0.20141268423924277,-0.2474370529581682,0.58491778725023424,0.58491778725023424],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,1.0778494253810979e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.0493186101153311e-22],"servo_velocity":[0,0,-1.7347234759768071e-18,0,0,0],"servo_effort":[-0.074959778037806638,-1.5694527713483453,-0.3061345713000525,-0.00011116564779578518,-0.00056109916203097145,0.00028307854972052824]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":643,"step":5144,"t":25.719999999999999,"sim_time":25.719999999999168,"vehicle":{"origin_ned":[1.513483140766154,1.0273304144459612,3.4993332703948505],"origin_quat_xyzw":[-0.022084988967128634,0.053994893632369222,0.38359566838583259,0.92165675168121952],"cg_ned":[1.4532294794607932,0.96732184898500595,3.2069903212720194],"linear_velocity_ned":[-0.0052684975239958793,-0.0049668886770752475,0.01155262964083776],"angular_velocity_ned":[-0.00047894897963577992,-0.00026516401509195787,-0.0086826354464735554]},"sensors":{"Odom":[1.513483140766154,1.0273304144459612,3.4993332703948505,-0.0084911600137878001,-0.00033890484394594113,0.010623424874012397,-0.022084988967128648,0.053994893632369256,0.38359566838583281,0.92165675168121952,0.00048922456338772852,0.00014672417445437568,-0.0086848715430662346],"Pressure":[26821.166810553023],"DVL":[-0.0082903015845544742,0.015003376130093471,0.00112669454186793,7.3988156086782615,-0.038650987077840433,0.020605164975649251,0.0039563109518237268,0],"IMU":[0.00071975505047470589,0.11673789367458076,0.78883283709938545,0.00037083304887089848,-0.0044847156187962133,-0.0076934746392289515,1.1411355135229317,-0.016036137583313674,-9.721404364052745],"FOG":[0.79331874749573505],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[9.127891687062732,-21.061146332473438,-25.996627974000823,61.377092157996721,61.377092157996721],"omega_rad_s":[9.2996908904882041,-21.13514672631695,-26.00388656751641,61.409635703497507,61.40969850987554],"thrust_n":[1.1037273094696969,-5.5996682267170712,-8.557705764287876,47.839671538388878,47.844495437495745],"torque_nm":[-0.020694887052556815,0.10499377925094511,0.16045698308039769,-0.89699384134479154,-0.89708428945304541],"angle_rad":[-598.470133997728,458.48134033847884,-542.68577263615578,1788.7353986700455,1788.7352423425839]},"command":[0.086932301781549828,-0.20058234602355657,-0.24758693308572213,0.58454373483806399,0.58454373483806399],"arm":{"servo_position":[3.6462121401337282e-23,3.2526065174565154e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,8.6736173798840355e-19,0,0,0,0],"servo_effort":[-0.07416382047816629,-1.5680712589470118,-0.30583130940981124,-0.00010985581674635531,-0.00056124397801237552,0.00028266226247935925]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":644,"step":5152,"t":25.760000000000002,"sim_time":25.75999999999916,"vehicle":{"origin_ned":[1.5132907861171505,1.027116208223829,3.4997908676705176],"origin_quat_xyzw":[-0.02208644356328477,0.053996770559739234,0.38343612522755111,0.92172299290531223],"cg_ned":[1.4530199006833586,0.96712303697909219,3.2074483095229849],"linear_velocity_ned":[-0.0052169152646586534,-0.0049728926180100897,0.01136916952217909],"angular_velocity_ned":[-0.00044612529250044619,-0.00032034214462232029,-0.0085726632698747054]},"sensors":{"Odom":[1.5132907861171505,1.027116208223829,3.4997908676705176,-0.008456657169871382,-0.00036855627402339217,0.010448075977344699,-0.022086443563284788,0.053996770559739268,0.38343612522755138,0.92172299290531223,0.00046051334858615946,8.4626075712096395e-05,-0.008577468641036954],"Pressure":[26827.835710592859],"DVL":[-0.022047755190531329,0.029152447356260228,-0.0068833180823806382,7.4078409506719396,0.0082186589888132624,0.00151381428371429,0.017291870403909577,0],"IMU":[0.00069821179110304105,0.11674260762119458,0.78848549426710957,0.024664135175734295,0.010589695505236783,-0.030901576138910012,1.1393423276465862,0.00097031863620370903,-9.7352445497578408],"FOG":[0.78924721663341701],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[9.1262565146527965,-20.973861507759914,-26.011928427234583,61.33841136940854,61.33841136940854],"omega_rad_s":[9.3007440921324989,-21.0462090497026,-26.020184574844588,61.368831812409915,61.368897161689709],"thrust_n":[1.1038026929229199,-5.5530186898620864,-8.5688332095248363,47.781616049498346,47.78453984056862],"torque_nm":[-0.02069630049230475,0.10411910043491414,0.16066562267859066,-0.89590530092809384,-0.89596012201066166],"angle_rad":[-598.09811422078462,457.63796312233495,-543.72630125934108,1791.1908516527162,1791.1906978950647]},"command":[0.08691672871097901,-0.19975106197866585,-0.24773265168794842,0.58417534637531943,0.58417534637531943],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,5.4210108624275222e-20],"servo_effort":[-0.073381245285952967,-1.5666713569564248,-0.30552101287602162,-0.00010855661890150318,-0.00056138289222295895,0.0002822278703440738]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":645,"step":5160,"t":25.800000000000001,"sim_time":25.799999999999152,"vehicle":{"origin_ned":[1.5130995917001566,1.0269016338454073,3.5002412768783731],"origin_quat_xyzw":[-0.022087802630415914,0.053997354129450954,0.38327860901783178,0.92178843700240365],"cg_ned":[1.4528123753382505,0.96692399283894626,3.2078988994271218],"linear_velocity_ned":[-0.005165774268180429,-0.00497853886523678,0.011183066323900709],"angular_velocity_ned":[-0.00041158933257386305,-0.00037232594962169536,-0.0084628825933542647]},"sensors":{"Odom":[1.5130995917001566,1.0269016338454073,3.5002412768783731,-0.0084215375227447431,-0.00039862689844904852,0.010270065098995912,-0.022087802630415931,0.053997354129450996,0.38327860901783206,0.92178843700240365,0.00043529429563651258,2.3558030303800112e-05,-0.0084698511247685727],"Pressure":[26830.118056079231],"DVL":[-0.00066127634924706066,0.0060516021995127341,-0.033840314563192704,7.4147534122834164,0.011174208123283284,0.025425983013731494,-0.0052683384057130708,0],"IMU":[0.00067610167282399533,0.11674485013796854,0.78814248001306542,0.028782953416136431,-0.026788295336247974,-0.020096751343978009,1.1360574548734867,0.01154673505671585,-9.737397447130018],"FOG":[0.77717902565537211],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[9.1218825287533072,-20.886478880182626,-26.026790113106106,61.300327387777649,61.300327387777649],"omega_rad_s":[9.2989977811941529,-20.957164501989848,-26.036001261818985,61.328649936963679,61.328717724251369],"thrust_n":[1.1032173078002439,-5.5065102829805639,-8.5796513370872436,47.724624815101279,47.725681992892198],"torque_nm":[-0.020685324521254572,0.10324706780588558,0.16086846257038584,-0.89483671528314912,-0.89485653736672877],"angle_rad":[-597.72611617398638,456.79814590456692,-544.76747080505879,1793.6446866404879,1793.6445355520125]},"command":[0.086875071702412446,-0.19891884647792976,-0.24787419155339149,0.58381264178835857,0.58381264178835857],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.072611030986892255,-1.5652538687250943,-0.30520381241477162,-0.00010726271932258398,-0.000561511574190144,0.00028177556889412745]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":646,"step":5168,"t":25.84,"sim_time":25.839999999999144,"vehicle":{"origin_ned":[1.5129095775493893,1.026686686050639,3.5006843921574582],"origin_quat_xyzw":[-0.022089010301288094,0.0539966909915396,0.38312311959819351,0.92185308385621934],"cg_ned":[1.452606885271186,0.96672473089239397,3.2083419888547251],"linear_velocity_ned":[-0.0051150968077429788,-0.0049838266284114516,0.010994479586710645],"angular_velocity_ned":[-0.00037541660399981815,-0.00042107859460586495,-0.0083533209940187918]},"sensors":{"Odom":[1.5129095775493893,1.026686686050639,3.5006843921574582,-0.0083858130286157788,-0.00042909297248060896,0.010089543860770942,-0.022089010301288119,0.053996690991539656,0.38312311959819395,0.92185308385621934,0.00041354295852000309,-3.6398093993521882e-05,-0.0083620496194845243],"Pressure":[26835.131641366708],"DVL":[0.042546388892100793,0.0050005587563579351,0.0042437379229126465,7.4129283017151995,0.005022649755211289,0.011490847512015902,0.0040188037206424897,0],"IMU":[0.00065356568697260895,0.11674466429363906,0.78780380253153337,0.049920869898920757,0.029910332243284991,0.17360161241183575,1.153525262285265,-0.014354792640684073,-9.7231854535769955],"FOG":[0.79065746247118129],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[9.1147880446589848,-20.798998057239778,-26.041211465822116,61.262842038387717,61.262842038387717],"omega_rad_s":[9.294454102489464,-20.868026917951362,-26.051343377598702,61.28909675690484,61.289166874281037],"thrust_n":[1.1019722525505258,-5.4601505180850012,-8.5901636079088668,47.668701053974331,47.667927503888819],"torque_nm":[-0.020661979735322359,0.10237782221409379,0.1610655676482913,-0.89378814476201873,-0.89377364069791554],"angle_rad":[-597.35425180965524,455.96189262983154,-545.80926218198147,1796.0969286720911,1796.0967803478939]},"command":[0.08680750518722842,-0.19808569578323598,-0.24801153776973442,0.58345563846083537,0.58345563846083537],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,4.3198680309969292e-21,-3.0493186101153311e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.071851972306891429,-1.5638197012808726,-0.30487989882342803,-0.00010598858743825252,-0.00054639552283033445,0.00028183945070799511]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":647,"step":5176,"t":25.879999999999999,"sim_time":25.879999999999136,"vehicle":{"origin_ned":[1.5127207632194366,1.0264713604247571,3.5011201137095398],"origin_quat_xyzw":[-0.022090011939673696,0.053994828948228213,0.38296965622137097,0.9219169334777626],"cg_ned":[1.4524034114612945,0.96652526547876993,3.2087774820103157],"linear_velocity_ned":[-0.0050649040180630774,-0.0049887560099566054,0.010803566606845316],"angular_velocity_ned":[-0.00033768865393054643,-0.00046657897270589689,-0.0082440056192687669]},"sensors":{"Odom":[1.5127207632194366,1.0264713604247571,3.5011201137095398,-0.0083494973202625829,-0.00045992778269792042,0.0099066620315517353,-0.02209001193967371,0.053994828948228255,0.3829696562213713,0.9219169334777626,0.00039521946442094055,-9.5167300414106452e-05,-0.0082540961331434987],"Pressure":[26840.087403406455],"DVL":[0.0057188574935868961,0.012947476209241441,-0.0029018722387796963,7.3504435430108215,-0.023554677068167384,-0.025109252941780725,0.009808501292659982,0],"IMU":[0.00063074329749215744,0.11674209633819378,0.78746946874003854,0.091360865583915402,-0.066145789718668774,-0.013518005405658725,1.1461733417568798,0.0051713666385014827,-9.7385943908632342],"FOG":[0.7778644001558036],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[9.1049990271151895,-20.711416480892311,-26.055191592154266,61.225956880910296,61.225956880910296],"omega_rad_s":[9.2871232774251329,-20.778804814927504,-26.066215279640158,61.250177058915661,61.250249395723806],"thrust_n":[1.1000711192406083,-5.4139440016015854,-8.6003719403130923,47.613845200300105,47.611278997819596],"torque_nm":[-0.020626333485761407,0.10151145003002975,0.16125697388087049,-0.89275959750562695,-0.89271148120911759],"angle_rad":[-596.98263280893957,455.12920681268008,-546.85165651119974,1798.5476030087818,1798.5474575395854]},"command":[0.086714276448716085,-0.1972515855323077,-0.24814468183004063,0.58310435124676474,0.58310435124676474],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.0493186101153311e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.071102874050550033,-1.5623701703342046,-0.30454954644988191,-0.00010470247777101836,-0.00056174068118312285,0.00028081818550703801]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":648,"step":5184,"t":25.920000000000002,"sim_time":25.919999999999128,"vehicle":{"origin_ned":[1.5125331676576514,1.0262556534633795,3.5015483477153895],"origin_quat_xyzw":[-0.02209075439275902,0.053991816729845113,0.38281821755596168,0.92197998601045883],"cg_ned":[1.4522019340721444,0.96632561092532998,3.2092052893290894],"linear_velocity_ned":[-0.0050152157042815506,-0.0049933274083159267,0.010610481942869432],"angular_velocity_ned":[-0.00029849581127952768,-0.00050882069933148063,-0.0081349629186970203]},"sensors":{"Odom":[1.5125331676576514,1.0262556534633795,3.5015483477153895,-0.0083126042925795451,-0.00049110099264623318,0.0097215669726751913,-0.022090754392759034,0.053991816729845148,0.3828182175559619,0.92197998601045883,0.00038026728127132307,-0.00015267883248255948,-0.0081460239326251356],"Pressure":[26843.094898804342],"DVL":[0.017636359782550789,-0.016440083980435553,0.0077105568710242826,7.3324849537210284,0.02167220683711657,0.03382862924990656,-0.017749485576665332,0],"IMU":[0.00060777179786703438,0.11673719547787448,0.78713948424428404,0.0064460214867538652,0.054874940602942048,-0.076409130218870955,1.1496243787361167,-0.0048141798726834429,-9.776436093972432],"FOG":[0.7921464165012756],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[9.0925480324521963,-20.623730140017702,-26.068729600658415,61.189673338270744,61.189673338270744],"omega_rad_s":[9.2770231294801082,-20.689502442828548,-26.080619726780025,61.211894285481335,61.211968728656423],"thrust_n":[1.0975198691168797,-5.3678930477523839,-8.6102772338306863,47.560055755554068,47.555737020955043],"torque_nm":[-0.020578497545941495,0.10064799464535722,0.16144269813432541,-0.89175104541663863,-0.89167006914290692],"angle_rad":[-596.61137027127063,454.30009172762431,-547.8946350497373,1800.9967350713916,1800.9965925434362]},"command":[0.086595695547163773,-0.19641647752397812,-0.24827361524436586,0.58275879369781658,0.58275879369781658],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.0493186101153311e-22],"servo_velocity":[0,0,0,0,-8.6736173798840355e-19,0],"servo_effort":[-0.070362707683138459,-1.5609060441374669,-0.30421286374636813,-0.00010342125619263278,-0.00054663039535843348,0.0002808464286730921]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":649,"step":5192,"t":25.960000000000001,"sim_time":25.95999999999912,"vehicle":{"origin_ned":[1.5123468090820735,1.026039562634347,3.5019690062475441],"origin_quat_xyzw":[-0.022091186238180471,0.053987703773031241,0.38266880168155298,0.92204224173923266],"cg_ned":[1.4520024325047836,0.96612578152362116,3.2096253273698725],"linear_velocity_ned":[-0.0049660503504764045,-0.0049975421616792245,0.010415377571371856],"angular_velocity_ned":[-0.0002579348790577177,-0.00054781274001262296,-0.0080262181697987618]},"sensors":{"Odom":[1.5123468090820735,1.026039562634347,3.5019690062475441,-0.0082751491969173651,-0.00052257940449856671,0.0095344038469327985,-0.022091186238180485,0.053987703773031269,0.38266880168155321,0.92204224173923266,0.00036861434559357564,-0.00020886827222704339,-0.0080378669321059283],"Pressure":[26846.814864007392],"DVL":[0.041668755530398206,0.026142657089739854,-0.028676823437731928,7.334820327546371,-0.034304807085994662,-0.013594294709007257,0.022607640477669312,0],"IMU":[0.00058478567894481627,0.11673001364970943,0.78681385328322229,-0.0002281034863207518,-0.025383686391557806,-0.078115427549199729,1.1479915215328522,-0.022996782616337749,-9.7351250710421677],"FOG":[0.7786138078140904],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[9.0774742741558523,-20.535932754093217,-26.081825526908577,61.153992720911305,61.153992720911305],"omega_rad_s":[9.2641790599164313,-20.600120516253057,-26.094558715896405,61.174250940557393,61.174327374961905],"thrust_n":[1.0943268054792363,-5.3219981062220363,-8.6198799184015176,47.507329944010792,47.501300652373835],"torque_nm":[-0.020518627602735682,0.099787464491663175,0.1616227484700285,-0.89076243645020248,-0.89064938723200937],"angle_rad":[-596.24057440840397,453.47455056080332,-548.9381791466252,1803.4443503962668,1803.4442108912228]},"command":[0.086452135944341452,-0.19558031194374492,-0.24839833835151026,0.58241897829439337,0.58241897829439337],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.0493186101153311e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.069629936579579388,-1.5594283776696023,-0.30387008851283598,-0.00010216611265634774,-0.0005619181139656053,0.00027979205161873853]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":650,"step":5200,"t":26,"sim_time":25.999999999999112,"vehicle":{"origin_ned":[1.5121617046650098,1.0258230866338731,3.5023820071774514],"origin_quat_xyzw":[-0.022091258492590585,0.05398253980686548,0.3825214059876394,0.92210370113965656],"cg_ned":[1.4518048854567127,0.96592579150062485,3.2100375187019639],"linear_velocity_ned":[-0.0049174248103946369,-0.0050014020839136558,0.010218402308430286],"angular_velocity_ned":[-0.0002161450377296037,-0.00058361433140870418,-0.0079178046943039759]},"sensors":{"Odom":[1.5121617046650098,1.0258230866338731,3.5023820071774514,-0.0082371478023456242,-0.00055431301282131667,0.0093453150850378915,-0.022091258492590603,0.053982539806865522,0.38252140598763967,0.92210370113965656,0.00036012440649369458,-0.00026367680992893416,-0.0079296746776936679],"Pressure":[26851.654526074541],"DVL":[-0.033401432228704231,-0.030522516503916814,0.022492712043473077,7.3016190222041439,-0.02638610772081805,0.001703595211927798,0.014865128559425069,0],"IMU":[0.00056191497992722037,0.116720605294426,0.78649257840607767,-0.050398134133074264,0.04787301436557298,-0.016482217531642595,1.1345887113796902,-0.023247069679413999,-9.7372222125392867],"FOG":[0.78663158644930964],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[9.0598368844176491,-20.448012785400664,-26.094482519442426,61.118916229079005,61.118916229079005],"omega_rad_s":[9.2486262640183412,-20.510656070020346,-26.108034300096246,61.137248852212117,61.137327160984562],"thrust_n":[1.0905030529834046,-5.2762577010711462,-8.6291805372874659,47.455664127307095,47.447967938064068],"torque_nm":[-0.020446932243438836,0.098929831895083975,0.16179713507413998,-0.88979370238700817,-0.88964939883870131],"angle_rad":[-595.8703542163737,452.65258654823788,-549.98227022546462,1805.8904746038656,1805.8903381987582]},"command":[0.086284160803977605,-0.19474297890857775,-0.24851888113754692,0.58208491646741911,0.58208491646741911],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.0493186101153311e-22],"servo_velocity":[0,0,0,5.4210108624275222e-20,0,0],"servo_effort":[-0.068903324438652297,-1.5579383770542969,-0.30352148587427152,-0.0001009239178723868,-0.00056199511331139773,0.00027925366759213915]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":651,"step":5208,"t":26.039999999999999,"sim_time":26.039999999999104,"vehicle":{"origin_ned":[1.5119778703362474,1.0256062255182801,3.502787274063365],"origin_quat_xyzw":[-0.02209092501466841,0.053976374536399939,0.38237602712477459,0.92216436490691622],"cg_ned":[1.4516092709825907,0.96572565500498164,3.2104417917683641],"linear_velocity_ned":[-0.004869354571555475,-0.0050049092135048883,0.010019701522432811],"angular_velocity_ned":[-0.00017324225103263759,-0.00061627146962310651,-0.0078097488611070737]},"sensors":{"Odom":[1.5119778703362474,1.0256062255182801,3.502787274063365,-0.0081986168396845915,-0.0005862600614402689,0.0091544401608769452,-0.022090925014668413,0.053976374536399946,0.3823760271247747,0.92216436490691622,0.00035468595565156568,-0.00031705286735236892,-0.0078214868169386269],"Pressure":[26856.261219571777],"DVL":[-4.8231694405674597e-05,-0.0050601647105691979,-0.019420391187299532,7.3635911540074197,0.0055192248950667174,-0.018459981170908361,0.0032056769448633063,0],"IMU":[0.00053928428870534762,0.11670902707364131,0.78617566029965558,0.032312175822382425,-0.0036037003475642591,0.094635376571342703,1.1459166437484658,-0.0051218017261361959,-9.7728070157788505],"FOG":[0.78327575674840455],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[9.0397202282760638,-20.35995106575708,-26.10670841996934,61.08444517792443,61.08444517792443],"omega_rad_s":[9.2304175313687633,-20.421100442466614,-26.121050744046091,61.100889421102899,61.100969486029257],"thrust_n":[1.0860643788841711,-5.2306674763092804,-8.6381811264173187,47.405054227130577,47.395736262076049],"torque_nm":[-0.02036370710407821,0.098075015180799002,0.16196589612032475,-0.88884476675869839,-0.88867005491392581],"angle_rad":[-595.50081686606882,451.83420317923748,-551.02688984570909,1808.335133377446,1808.3350001445945]},"command":[0.086092573602629174,-0.19390429586435315,-0.24863531828542229,0.58175662074213741,0.58175662074213741],"arm":{"servo_position":[3.6462121401337282e-23,3.2526065174565154e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.0493186101153311e-22],"servo_velocity":[0,8.6736173798840355e-19,0,0,0,0],"servo_effort":[-0.068182222035419307,-1.5564372227502377,-0.30316735180335175,-9.9677549136203552e-05,-0.00056205773417418957,0.00027869926497085232]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":652,"step":5216,"t":26.080000000000002,"sim_time":26.079999999999096,"vehicle":{"origin_ned":[1.511795320978889,1.0253889804537137,3.5031847360490014],"origin_quat_xyzw":[-0.022090142019784174,0.053969257718666161,0.38223266115650573,0.92222423389979169],"cg_ned":[1.4514155665513286,0.96552538608804261,3.2108380807643773],"linear_velocity_ned":[-0.0048218535860639969,-0.0050080663153052457,0.0098194178159017528],"angular_velocity_ned":[-0.00012933649549973179,-0.00064583177471795475,-0.007702073369138091]},"sensors":{"Odom":[1.511795320978889,1.0253889804537137,3.5031847360490014,-0.0081595737904802731,-0.00061838114829104631,0.0089619161621488468,-0.022090142019784185,0.053969257718666175,0.38223266115650589,0.92222423389979169,0.00035219008137058003,-0.00036895038296550962,-0.007713339001715374],"Pressure":[26860.995333052972],"DVL":[-0.031123275857223874,-0.0045965569059554373,0.015467215769250921,7.4245764251157347,0.013284759605745671,-0.020098060337057546,0.003122002825379909,0],"IMU":[0.00051701372001725912,0.11669533763105623,0.78586309816820865,0.026361055921417888,0.023263587071958546,-0.048644849721966629,1.1278405057193213,-0.020305714347367772,-9.7644723287966766],"FOG":[0.76573464227293231],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[9.0171811521596208,-20.271735620088457,-26.118504494447397,61.050580881428019,61.050580881428019],"omega_rad_s":[9.2096094655458529,-20.331443214101007,-26.133611780791245,61.065173779565079,61.065255481454642],"thrust_n":[1.0810278831723776,-5.1852222845179341,-8.646883387541008,47.355495934742699,47.344602609257642],"torque_nm":[-0.02026927280948208,0.097222917834711264,0.16212906351639392,-0.88791554877642553,-0.88771129892358092],"angle_rad":[-595.13206731026025,451.01940433525937,-552.0720197286571,1810.7783524499741,1810.7782224569446]},"command":[0.085877915734853524,-0.19306414876274719,-0.24874766185187996,0.5814341036326478,0.5814341036326478],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.3881317890156997e-23],"servo_velocity":[0,0,0,5.4210108624275222e-20,0,0],"servo_effort":[-0.067465211850934528,-1.5549258333603535,-0.3028077835623616,-9.8448979403388187e-05,-0.00056211093749278511,0.00027812849641493611]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":653,"step":5224,"t":26.120000000000001,"sim_time":26.119999999999088,"vehicle":{"origin_ned":[1.5116140703755361,1.025171353720933,3.5035743277595905],"origin_quat_xyzw":[-0.022088868195648367,0.053961238995742594,0.38209130358484089,0.92228330913701151],"cg_ned":[1.4512237491105129,0.96532499867894217,3.2112263255141293],"linear_velocity_ned":[-0.0047749342067858226,-0.0050108766744992985,0.0096176904224445289],"angular_velocity_ned":[-8.4542059822907022e-05,-0.00067235420446048056,-0.0075948002663211566]},"sensors":{"Odom":[1.5116140703755361,1.025171353720933,3.5035743277595905,-0.0081200364904382132,-0.00065063524500737354,0.0087678771970260486,-0.022088868195648387,0.05396123899574265,0.38209130358484122,0.92228330913701151,0.00035251677257937589,-0.00041932838847940935,-0.0076052675330399912],"Pressure":[26863.293581171078],"DVL":[-0.0031271259981401102,0.011658483980724946,-0.013820294521390483,7.3805709906278372,0.051273442071471317,0.013448920857517118,0.029829718948798673,0],"IMU":[0.00049521857478769722,0.11667959736600327,0.78555488976220156,-0.027117627023302948,-0.0030826407779446455,-0.12239441332772018,1.128567412848007,0.0046191866731320136,-9.7237434664254678],"FOG":[0.79564708212922619],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[8.9922809494437015,-20.183353398092382,-26.129871832130632,61.017324632645014,61.017324632645014],"omega_rad_s":[9.1862612476481722,-20.241672782142277,-26.145720424897014,61.030102863828283,61.030186082878373],"thrust_n":[1.0754116538066945,-5.1399164869862881,-8.6552885846958123,47.306984831903669,47.294563694130268],"torque_nm":[-0.020163968508875522,0.096373434130992919,0.16228666096304648,-0.88700596559819389,-0.88677306926494259],"angle_rad":[-594.76420818028612,450.20819434169852,-553.11764172781295,1813.2201575949421,1813.220030904519]},"command":[0.085640770947082875,-0.19222241331516554,-0.24885592221076794,0.58111737745376202,0.58111737745376202],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.0493186101153311e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.066751376196178464,-1.5534050926545271,-0.30244295515329722,-9.7218876557381235e-05,-0.00056215097066329429,0.00027754167074001715]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":654,"step":5232,"t":26.16,"sim_time":26.15999999999908,"vehicle":{"origin_ned":[1.5114341311351551,1.0249533487402911,3.50395598919286],"origin_quat_xyzw":[-0.022087064861297391,0.053952367714330332,0.38195194935301297,0.92234159180276798],"cg_ned":[1.4510337951464645,0.96512450656143323,3.2116064713427228],"linear_velocity_ned":[-0.0047286073061802887,-0.0050133442428316223,0.0094146555537230007],"angular_velocity_ned":[-3.8976036711660107e-05,-0.00069590852818391617,-0.0074879505202544413]},"sensors":{"Odom":[1.5114341311351551,1.0249533487402911,3.50395598919286,-0.0080800235575725979,-0.00068298010016354914,0.008572454753236966,-0.022087064861297395,0.053952367714330346,0.38195194935301308,0.92234159180276798,0.00035553630426366997,-0.00046815171402876801,-0.0074973087647380579],"Pressure":[26868.551168014015],"DVL":[0.0075672092387352695,0.0043815896008127225,0.02720293799354705,7.3634662148618677,0.003219156044486339,0.014970883919593978,-0.040394160811866045,0],"IMU":[0.00047400890603885364,0.11666186821509819,0.78525103135277008,0.086149452231960869,-0.0096114421542708786,0.079984972599785806,1.1577279045956057,-0.0063127996451819088,-9.7220620079439861],"FOG":[0.78150815332377288],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[8.965086054461203,-20.094789459929711,-26.140812170978311,60.984677794372459,60.984677794372459],"omega_rad_s":[9.1604354495290057,-20.15177616306206,-26.157379411239287,60.995677512445731,60.995762128588559],"thrust_n":[1.0692349117747615,-5.0947438654009893,-8.6633978326396051,47.259516543355083,47.245616103103529],"torque_nm":[-0.020048154595776784,0.095526447476268567,0.16243870936199264,-0.88611593518790788,-0.88585530193319129],"angle_rad":[-594.39733966459539,449.40057801918971,-554.16373781044786,1815.6605746209536,1815.6604512911231]},"command":[0.085381771947249552,-0.19137894723742582,-0.24896011591407916,0.58080645518449958,0.58080645518449958],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.0493186101153311e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.066039757035214086,-1.5518761041327278,-0.30207308667768051,-9.5997813564056031e-05,-0.00056217541771422003,0.00027693910654176903]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":655,"step":5240,"t":26.199999999999999,"sim_time":26.199999999999072,"vehicle":{"origin_ned":[1.5112555146377091,1.0247349700803379,3.5043296656098741],"origin_quat_xyzw":[-0.022084696089039138,0.053942692764247298,0.38181459285639474,0.92239908324862407],"cg_ned":[1.4508456807441577,0.96492392334941646,3.2119784689488684],"linear_velocity_ned":[-0.0046828822570404464,-0.0050154733632650867,0.0092104460118644909],"angular_velocity_ned":[7.2417770777769973e-06,-0.00071657377496136166,-0.0073815441568563216]},"sensors":{"Odom":[1.5112555146377091,1.0247349700803379,3.5043296656098741,-0.0080395538253147415,-0.00071537241023233143,0.0083757772865344741,-0.022084696089039148,0.053942692764247326,0.38181459285639496,0.92239908324862407,0.00036111042078010855,-0.00051538997042406337,-0.0073894991034783699],"Pressure":[26870.934826101598],"DVL":[-0.0041044488390770371,0.015593044546014428,0.020804055502414015,7.3372938679574036,0.014372255940528003,-0.0060749243697278479,-0.0051762646926701598,0],"IMU":[0.00045348916948769396,0.11664221344029714,0.78495151772918403,0.04715748656336221,0.053481831100830636,0.038964619022117356,1.1309331193829686,-4.8907833067228859e-05,-9.7661099495822459],"FOG":[0.78283263548625448],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[8.935666021798303,-20.006027417283121,-26.151327324451469,60.952641754348846,60.952641754348846],"omega_rad_s":[9.1321981057883761,-20.061738938817733,-26.168591295374316,60.961898504827616,60.961984398065326],"thrust_n":[1.0625179788820578,-5.0496976117375665,-8.671212163513303,47.213086792945333,47.197756373984213],"torque_nm":[-0.019922212104038585,0.09468183022007938,0.16258522806587442,-0.88524537736772502,-0.88495793201220418],"angle_rad":[-594.03155936961764,448.5965607403254,-555.21029004863328,1818.0996293686524,1818.099509452597]},"command":[0.085101581159983841,-0.19053359445031545,-0.24906026023287112,0.58050135004141756,0.58050135004141756],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,-3.0493186101153311e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.065329244211191656,-1.5503397742814442,-0.30169844488007141,-9.4806228714400663e-05,-0.0005621892633517775,0.00027632118921162369]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":656,"step":5248,"t":26.240000000000002,"sim_time":26.239999999999064,"vehicle":{"origin_ned":[1.5110782309848327,1.0245162234718268,3.504695307422574],"origin_quat_xyzw":[-0.022081728819806672,0.053932262426310232,0.38167922794513409,0.92245578499845415],"cg_ned":[1.450659381645758,0.96472326247015605,3.2123422742752985],"linear_velocity_ned":[-0.0046377670393887918,-0.0050172690534249853,0.0090051916863611251],"angular_velocity_ned":[5.3989339767417679e-05,-0.0007344379611223808,-0.0072756011272830335]},"sensors":{"Odom":[1.5110782309848327,1.0245162234718268,3.504695307422574,-0.007998646708011127,-0.00074776816657954465,0.008177970689617238,-0.022081728819806693,0.053932262426310287,0.38167922794513442,0.92245578499845415,0.00036909295651227028,-0.00056101768844232119,-0.0072818758073436114],"Pressure":[26875.494890916842],"DVL":[-0.028149283938734455,0.017423050798167517,-0.035360432590730628,7.3266274359758938,-0.031121327116857965,0.0087861451605346329,0.011225085124424793,0],"IMU":[0.00043375789284650913,0.11662069742916308,0.78465634217995772,-0.014985293597411582,-0.0043704145250334555,0.084533083215115004,1.1357791521219469,0.018213867100453963,-9.7686308070939827],"FOG":[0.79417331821202364],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[8.9040944643241549,-19.917049525947522,-26.161419631222905,60.921218020206283,60.921218020206283],"omega_rad_s":[9.1016189177049203,-19.971545300178338,-26.179358658825279,60.928766627956058,60.928853678675587],"thrust_n":[1.0552822727754874,-5.0047703636529857,-8.6787326632821937,47.167691499218293,47.150981091254664],"torque_nm":[-0.019786542614540388,0.093839444318493476,0.16272623743654116,-0.88439421561034326,-0.88408089546102497],"angle_rad":[-593.6669621767852,447.79614848557543,-556.25728061658026,1820.5373477099704,1820.5372312560808]},"command":[0.08480089966023005,-0.18968618596140496,-0.24915637744021815,0.58020207638291699,0.58020207638291699],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,2.3716922523121912e-22],"servo_velocity":[0,0,0,5.4210108624275222e-20,-8.6736173798840355e-19,0],"servo_effort":[-0.064618900710496655,-1.5487969816303488,-0.30131912751706408,-9.3596535507351085e-05,-0.00054713604749328821,0.00028833877158492834]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":657,"step":5256,"t":26.280000000000001,"sim_time":26.279999999999056,"vehicle":{"origin_ned":[1.5109022889522794,1.0242971158086056,3.5050528700882353],"origin_quat_xyzw":[-0.022078132967866947,0.053921124229499726,0.38154584793711666,0.92251169874881611],"cg_ned":[1.4504748733045603,0.96452253713697345,3.2126978483869078],"linear_velocity_ned":[-0.0045932682566837647,-0.0050187369072639508,0.0087990191302050082],"angular_velocity_ned":[0.00010114287711760373,-0.00074959712067513423,-0.0071701398328270936]},"sensors":{"Odom":[1.5109022889522794,1.0242971158086056,3.5050528700882353,-0.0079573219900425391,-0.00078012275209745946,0.0079791578620079604,-0.022078132967866964,0.053921124229499767,0.38154584793711693,0.92251169874881611,0.00037933071078285905,-0.00060501400039031264,-0.0071744753967379745],"Pressure":[26879.840057404701],"DVL":[-0.043664513620874097,-0.011137240466329051,0.00658476494634605,7.3853071451482917,0.020110439060422803,0.0013850916122990881,0.02236209767917377,0],"IMU":[0.00041490737361098552,0.11659738550406672,0.78436549649844201,-0.015030817511533304,-0.078940360842944618,-0.01922048200827885,1.1455011936381414,-0.012932325568593802,-9.7761029638228401],"FOG":[0.80078335982620064],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[8.8704485364477748,-19.827836625616818,-26.171091414194688,60.890408078647432,60.890408078647432],"omega_rad_s":[9.0687712098660089,-19.881177924860996,-26.189684176252708,60.896282669719888,60.896370758989306],"thrust_n":[1.0475502422201197,-4.959954161720411,-8.6859605115311993,47.123326765925192,47.105286886562411],"torque_nm":[-0.019641567041627245,0.092999140532257718,0.16286175959120999,-0.8835623768610974,-0.88322412912304538],"angle_rad":[-593.30364009735001,446.99934790314893,-557.30469179439308,1822.9737555482516,1822.9736426001482]},"command":[0.084480462251883562,-0.18883653929158875,-0.24924848965899704,0.57990864836807077,0.57990864836807077],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,2.3716922523121907e-22],"servo_velocity":[0,0,0,0,0,-1.0842021724855044e-19],"servo_effort":[-0.063908063762047898,-1.547248699173446,-0.30093541924769496,-9.2407964486976678e-05,-0.00056216139638317936,0.00028789835676322527]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":658,"step":5264,"t":26.32,"sim_time":26.319999999999048,"vehicle":{"origin_ned":[1.5107276959599969,1.0240776551388289,3.5054023139952779],"origin_quat_xyzw":[-0.022073881489550647,0.053909324820691974,0.38141444562333826,0.92256682637259602],"cg_ned":[1.4502921309407353,0.96432176032987404,3.2130451573399283],"linear_velocity_ned":[-0.0045493911717592976,-0.005019882992056939,0.0085920518200280765],"angular_velocity_ned":[0.00014857795341669523,-0.00076215440322346072,-0.0070651785427325638]},"sensors":{"Odom":[1.5107276959599969,1.0240776551388289,3.5054023139952779,-0.0079155998392160462,-0.00081239136640575825,0.0077794589800706856,-0.022073881489550664,0.053909324820692016,0.38141444562333859,0.92256682637259602,0.00039166500406403266,-0.000647362763547009,-0.0070673348979829282],"Pressure":[26884.023556159067],"DVL":[-0.04363350019129604,-0.00043670280620494457,-0.029888212801664607,7.3958824617314534,0.0080309122836688951,0.017391973980835879,-0.0071827038015536476,0],"IMU":[0.00039702345260679887,0.11657234372706606,0.78407897097647572,0.046398648459788326,0.0041207854312097173,-0.069013835455492306,1.1442921088473064,0.001084298492087985,-9.7798626432909348],"FOG":[0.78981199508850908],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[8.8348075843048566,-19.73836802068325,-26.180345361106401,60.860213544745378,60.860213544745378],"omega_rad_s":[9.0337316568510388,-19.790618058516351,-26.199570622093027,60.864447466203707,60.864536476054376],"thrust_n":[1.0393452480803924,-4.9152405062842366,-8.6928969902954911,47.079988954204076,47.060670506525092],"torque_nm":[-0.019487723401507361,0.092160759492829453,0.16299181856804049,-0.8827497928913266,-0.88238757199734563],"angle_rad":[-592.94168213153841,446.20616636619218,-558.35250597083245,1825.4088788194072,1825.4087694159743]},"command":[0.084141024612427201,-0.18798445733984048,-0.24933662248672764,0.57962108137852741,0.57962108137852741],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,2.3716922523121907e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.063195670670125187,-1.5456956419102779,-0.30054735360219836,-9.1231028932606929e-05,-0.00056213634964236646,0.00028743317123497176]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":659,"step":5272,"t":26.359999999999999,"sim_time":26.35999999999904,"vehicle":{"origin_ned":[1.510554458042318,1.0238578506561424,3.5057436043572441],"origin_quat_xyzw":[-0.022068950456546915,0.053896909844888818,0.38128501328039593,0.92262116991899046],"cg_ned":[1.4501111295933418,0.96412094477051213,3.213384172061247],"linear_velocity_ned":[-0.0045061397259436734,-0.0050207139734330004,0.0083844101649581393],"angular_velocity_ned":[0.00019616962844242809,-0.00077221882668008981,-0.0069607344778680365]},"sensors":{"Odom":[1.510554458042318,1.0238578506561424,3.5057436043572441,-0.0078735006710592571,-0.00084452930752965105,0.007578991455029797,-0.022068950456546915,0.053896909844888825,0.38128501328039599,0.92262116991899046,0.00040593256187461825,-0.00068805179019094877,-0.0069604908160278605],"Pressure":[26887.656484411469],"DVL":[-0.033728805634816117,0.052895684130871985,0.0077323679909973003,7.3753590362885646,-0.0053689221935710853,-0.042681065384246465,0.012802293694380393,0],"IMU":[0.00038018528827898332,0.11654563872773797,0.78379675441425711,-0.058293543562155596,-0.029327178823200066,0.023668063628292109,1.146152797094484,-0.0043804779837488513,-9.7577138702921467],"FOG":[0.78575481211770026],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[8.7972542529035351,-19.648621756560452,-26.189184120714291,60.830636044702914,60.830636044702914],"omega_rad_s":[8.996580183158029,-19.699845478819299,-26.209020898046919,60.833261897469171,60.833351711158919],"thrust_n":[1.0306914830639715,-4.8706203566957527,-8.6995434969898948,47.03767466292804,47.017128816342563],"torque_nm":[-0.019325465307449469,0.09132413168804536,0.16311644056856056,-0.88195639992990083,-0.88157116530642321],"angle_rad":[-592.58117413838931,445.41661203199072,-559.40070564897246,1827.8427434937855,1827.8426376692157]},"command":[0.083783373837176531,-0.18712973101486144,-0.24942080114965992,0.57933939090193254,0.57933939090193254],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,2.3716922523121907e-22],"servo_velocity":[0,0,1.7347234759768071e-18,0,0,0],"servo_effort":[-0.062480976075804273,-1.54413848123789,-0.30015514544666361,-9.0049292433165402e-05,-0.00056209651769500719,0.00028695205608800147]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":660,"step":5280,"t":26.400000000000002,"sim_time":26.399999999999032,"vehicle":{"origin_ned":[1.5103825798371868,1.0236377126808447,3.5060767110998792],"origin_quat_xyzw":[-0.022063319092042392,0.053883923846539797,0.38115754268179219,0.92267473161364977],"cg_ned":[1.4499318441713485,0.96392010290284302,3.2137148682217802],"linear_velocity_ned":[-0.0044635166409742466,-0.0050212370537605043,0.0081762113149664722],"angular_velocity_ned":[0.00024379315752006369,-0.00077990473559694446,-0.0068568240528025046]},"sensors":{"Odom":[1.5103825798371868,1.0236377126808447,3.5060767110998792,-0.0078310451829733414,-0.00087649212699015904,0.0073778697446436319,-0.022063319092042403,0.053883923846539818,0.38115754268179236,0.92267473161364977,0.00042196641962651731,-0.00072707296008414234,-0.0068539792706699375],"Pressure":[26889.912531542253],"DVL":[-0.018155750026223268,-0.016847120842080884,0.002313365475182543,7.3152381834015952,-0.018312592813481292,0.0086331784031744539,0.0084056310047325427,0],"IMU":[0.00036446521626649084,0.11651733754168281,0.78351883413305268,-0.004666772834538745,-0.089031031860579576,-0.095029400499602817,1.1426032316337322,-0.017332504213271961,-9.7360555990210393],"FOG":[0.77356863579670654],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[8.7578727017348417,-19.558574743231112,-26.197610594962494,60.801677281242554,60.801677281242554],"omega_rad_s":[8.9573994948121367,-19.608838612899014,-26.218038034645168,60.802726899538733,60.802817401792034],"thrust_n":[1.021613807784296,-4.8260842073471233,-8.7059015465129743,46.996380751632891,46.974658822831707],"torque_nm":[-0.019155258895955551,0.090489078887758576,0.16323565399711829,-0.88118213909311671,-0.88077485292809454],"angle_rad":[-592.22219871561185,444.63069389763558,-560.44927345079066,1830.2753755781653,1830.2752733620127]},"command":[0.083408311445093739,-0.18627214041172488,-0.2495010532853571,0.57906359315469103,0.57906359315469103],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,7.792703114739713e-22],"servo_velocity":[0,0,0,0,0,1.0842021724855044e-19],"servo_effort":[-0.061763159906894356,-1.5425781695769882,-0.29975891086428169,-8.8897180630246559e-05,-0.00056204380217379313,0.00028644904348527114]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":661,"step":5288,"t":26.440000000000001,"sim_time":26.439999999999024,"vehicle":{"origin_ned":[1.5102120645752439,1.023417252638404,3.5064016087470833],"origin_quat_xyzw":[-0.022056969805717915,0.053870410173772219,0.38103202510379569,0.92272751386094443],"cg_ned":[1.4497542495021745,0.96371924687166166,3.214037226109113],"linear_velocity_ned":[-0.0044215234333703831,-0.0050214599161088821,0.0079675693657697156],"angular_velocity_ned":[0.00029132376779955529,-0.00078533103426859058,-0.0067534635834811396]},"sensors":{"Odom":[1.5102120645752439,1.023417252638404,3.5064016087470833,-0.0077882541336172645,-0.00090823574489708116,0.00717620552456592,-0.022056969805717933,0.053870410173772261,0.38103202510379597,0.92272751386094443,0.00043959638931176804,-0.00076442152012087144,-0.0067478366532212671],"Pressure":[26893.192760319682],"DVL":[0.0051240384591107798,-0.047194511734085266,-0.042287128498367237,7.3002209978778465,0.0036304340157601056,-0.0044927362548918964,-0.0040353351513224825,0],"IMU":[0.00034992861282208507,0.11648750745365886,0.78324519597659437,-0.042534615483678845,0.071207637499870233,-0.026464224981764484,1.137939082516626,-0.006631783017576982,-9.7421067788654749],"FOG":[0.77666520248213966],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[8.7167489576207871,-19.468202458230422,-26.205627856352535,60.773339076864673,60.773339076864673],"omega_rad_s":[8.9162748027432457,-19.517574536260714,-26.226625183236504,60.772843491667551,60.772934568899316],"thrust_n":[1.012137631576427,-4.7816221017825935,-8.7119727665456921,46.956104372248042,46.93325772106791],"torque_nm":[-0.018977580592058008,0.089655414408423631,0.16334948937273175,-0.8804269569796509,-0.87999858227002359],"angle_rad":[-591.86483509467075,443.84842185354313,-561.49819212184605,1832.7068011186468,1832.7067025358926]},"command":[0.08301665673924559,-0.18541145198314687,-0.24957740815573842,0.57879370549394926,0.57879370549394926],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-4.3537493488871065e-21,2.3716922523121907e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.061041608592026363,-1.5410152235050476,-0.29935881905067607,-8.7727712036441197e-05,-0.00056197169243064557,0.00028593158052645152]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":662,"step":5296,"t":26.48,"sim_time":26.479999999999016,"vehicle":{"origin_ned":[1.5100429140763258,1.0231964830368259,3.5067182763103508],"origin_quat_xyzw":[-0.022049888216739023,0.053856410899011949,0.38090845134220991,0.92277951924107271],"cg_ned":[1.4495783203771959,0.96351838850175264,3.2143512305054602],"linear_velocity_ned":[-0.0043801605293998583,-0.0050213908385972244,0.0077585954019947822],"angular_velocity_ned":[0.00033863786175184634,-0.00078862022968052749,-0.0066506679012665855]},"sensors":{"Odom":[1.5100429140763258,1.0231964830368259,3.5067182763103508,-0.0077451485552749643,-0.00093971677090031553,0.0069741077203089186,-0.022049888216739033,0.053856410899011976,0.38090845134221013,0.92277951924107271,0.00045865041966693413,-0.00080009625462588877,-0.0066420980704054592],"Pressure":[26897.157101018609],"DVL":[0.012559545715713435,-0.012968838574745371,-0.036396011952049626,7.4377803767248007,0.03126427870257259,-0.0017974231297444463,0.028990914466300376,0],"IMU":[0.00033663379468939478,0.11645621586201392,0.78297582433890922,-0.017914378869615867,0.063355813686916729,0.0058264418447066474,1.1281687316040194,-0.008401126749112392,-9.749544719746881],"FOG":[0.80244931160530841],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[8.6739710186564327,-19.377479527298405,-26.213239002954179,60.745623337420604,60.745623337420604],"omega_rad_s":[8.8732936441861199,-19.426029029799771,-26.234785656830564,60.743612779289244,60.743704319803122],"thrust_n":[1.0022888175736511,-4.7372236792641225,-8.7177589191484426,46.916842970044627,46.8929228985306],"torque_nm":[-0.018792915329505961,0.088822943986202302,0.16345797973403334,-0.87969080568833669,-0.87924230434744888],"angle_rad":[-591.50915904495707,443.06980673749786,-562.54744453807177,1835.1370462040206,1835.1369512751446]},"command":[0.08260924779672793,-0.18454742406950861,-0.24964989526623027,0.57852974607067242,0.57852974607067242],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,1.0778494253810979e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,2.3716922523121907e-22],"servo_velocity":[0,0,-1.7347234759768071e-18,0,0,-1.0842021724855044e-19],"servo_effort":[-0.06031546460029822,-1.5394504707747074,-0.29895497121322012,-8.6566031474628294e-05,-0.00056188784413836897,0.00028539585061959161]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":663,"step":5304,"t":26.52,"sim_time":26.519999999999008,"vehicle":{"origin_ned":[1.5098751287557153,1.02297541743236,3.5070266971783148],"origin_quat_xyzw":[-0.022042063157228065,0.053841966750322108,0.38078681172593742,0.92283075050836127],"cg_ned":[1.4494040315964503,0.96331753927401043,3.2146568705661704],"linear_velocity_ned":[-0.0043394272163878589,-0.0050210386172448327,0.0075493973152371708],"angular_velocity_ned":[0.00038561275071390306,-0.00078989786464075127,-0.0065484518184291875]},"sensors":{"Odom":[1.5098751287557153,1.02297541743236,3.5070266971783148,-0.0077017494634036088,-0.00097089266185005035,0.0067716823066554434,-0.022042063157228071,0.053841966750322129,0.38078681172593759,0.92283075050836127,0.00047895497960403154,-0.00083409889450763346,-0.0065367987738693149],"Pressure":[26900.547913332273],"DVL":[-0.029675349179577266,0.019379362203543068,-0.0089174056599450272,7.3291337857565555,0.028338636726415661,-0.004566319497290321,-0.0013929693996324489,0],"IMU":[0.00032463196320301938,0.11642353014821445,0.78271070218802474,-0.021999212175011332,-0.030740787800775542,0.037464357991571412,1.1142710516847032,-0.003507581728572452,-9.703558285732246],"FOG":[0.78072585391795091],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[8.6296277189119355,-19.286379632246831,-26.220446989028442,60.718532017083334,60.718532017083334],"omega_rad_s":[8.8285454573506499,-19.33417673644589,-26.242522778321618,60.715035948429872,60.715127842598122],"thrust_n":[0.99209353289283297,-4.6928782655545005,-8.723261802685867,46.878594271395691,46.853651936053865],"torque_nm":[-0.018601753741740619,0.087991467479146893,0.16356115880036004,-0.87897364258866928,-0.87850597380101003],"angle_rad":[-591.15524278988653,442.29486038205874,-563.59701370799382,1837.5661369691086,1837.5660457101683]},"command":[0.082186930656304141,-0.18367980602139838,-0.24971854275265185,0.57827173349603178,0.57827173349603178],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,2.3716922523121907e-22],"servo_velocity":[0,0,0,0,0,-1.0842021724855044e-19],"servo_effort":[-0.059584309635140179,-1.5378843000195981,-0.29854747154507205,-8.5407858992083197e-05,-0.00056178760501673496,0.00028483847812780789]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":664,"step":5312,"t":26.560000000000002,"sim_time":26.559999999999,"vehicle":{"origin_ned":[1.509708707633068,1.0227540703962155,3.5073268590062354],"origin_quat_xyzw":[-0.022033486669217627,0.053827117048938104,0.38066709611904881,0.92288121059413064],"cg_ned":[1.4492313580100473,0.96311671030596879,3.214954139698742],"linear_velocity_ned":[-0.0042993218502404961,-0.0050204125564805233,0.0073400801413912014],"angular_velocity_ned":[0.00043212732206521264,-0.0007892916595967595,-0.0064468294088850736]},"sensors":{"Odom":[1.509708707633068,1.0227540703962155,3.5073268590062354,-0.0076580779896054264,-0.0010017218141143496,0.0065690326186408901,-0.022033486669217638,0.053827117048938132,0.38066709611904898,0.92288121059413064,0.00050033604831214193,-0.00086643397694148062,-0.0064319733189753285],"Pressure":[26903.994731765713],"DVL":[0.0017803870603521395,0.045904549805155022,0.0043177715668482677,7.3930375803369142,0.020665809723233026,0.0047703477116170026,0.031706915242353743,0],"IMU":[0.00031396716392441626,0.11638951755307143,0.78244981106593803,0.0078003594965652739,0.0025253368687742292,-0.020332066854129721,1.1605240333962938,-0.0070263486170153711,-9.747585603743028],"FOG":[0.79850565538098106],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[8.5838090790482315,-19.194874721147105,-26.227255311045592,60.69206716372274,60.69206716372274],"omega_rad_s":[8.7821213234356694,-19.241990997271756,-26.24984004687423,60.687114282318333,60.687206422743586],"thrust_n":[0.98157814058260662,-4.6485748077033948,-8.7284833602488447,46.841356301628082,46.815442629170235],"torque_nm":[-0.018404590135923882,0.087160777644438636,0.16365906300466584,-0.87827543065552682,-0.87778954929694208],"angle_rad":[-590.80315493721957,441.52359566334809,-564.64688277692949,1839.9940995984739,1839.9940120211911]},"command":[0.081750562657602208,-0.18280833067759147,-0.24978338391471994,0.57801968727354991,0.57801968727354991],"arm":{"servo_position":[-9.9063150159350775e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,2.3716922523121907e-22],"servo_velocity":[-1.3552527156068805e-20,0,0,0,0,0],"servo_effort":[-0.058847464821994891,-1.5363173773912724,-0.29813641414856845,-8.4264111127195707e-05,-0.00056166557546905591,0.00028426748113768665]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":665,"step":5320,"t":26.600000000000001,"sim_time":26.599999999998992,"vehicle":{"origin_ned":[1.5095436483441214,1.0225324574802015,3.5076187536026229],"origin_quat_xyzw":[-0.02202415399447687,0.053811899658472648,0.38054929394207865,0.92293090260114241],"cg_ned":[1.4490602745564505,0.96291591233056617,3.2152430354403592],"linear_velocity_ned":[-0.0042598417723527446,-0.0050195225882910185,0.0071307458904195783],"angular_velocity_ned":[0.00047806173055083278,-0.00078693150569802365,-0.0063458138235030067]},"sensors":{"Odom":[1.5095436483441214,1.0225324574802015,3.5076187536026229,-0.0076141553162768728,-0.0010321636194203822,0.0063662591678240732,-0.02202415399447687,0.053811899658472655,0.38054929394207865,0.92293090260114241,0.00052261888385656766,-0.00089710861978001624,-0.0063276554048077071],"Pressure":[26906.723418751186],"DVL":[-0.0013847159744271942,0.036758763661477192,-0.0015340200397302092,7.3484717566775224,-0.027650958251782504,0.0036891861292389122,-0.0091861046692543521,0],"IMU":[0.00030467627103168628,0.11635424506934448,0.7821931311321868,0.047226392707378446,-0.07838268290542473,-0.11343152574149948,1.1199938498115296,-0.00076717528706124211,-9.7136824518865854],"FOG":[0.77353706647137344],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[8.5366063378960195,-19.102936296130469,-26.233667138640197,60.666230975408816,60.666230975408816],"omega_rad_s":[8.7341137863839435,-19.149444046750489,-26.256741007622082,60.659849166730339,60.659941448386874],"thrust_n":[0.97076911041276026,-4.6043019865942236,-8.7334255902173741,46.8051273926135,46.778293005629877],"torque_nm":[-0.018201920820239258,0.086330662248641721,0.16375172981657576,-0.87759613861150332,-0.87709299385556028],"angle_rad":[-590.45296041806705,440.75602654960397,-565.69703503147798,1842.420960330199,1842.4208764420532]},"command":[0.081301012741866852,-0.181932726629814,-0.24984444893943045,0.57777362833722679,0.57777362833722679],"arm":{"servo_position":[3.6462121401337282e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,2.3716922523121907e-22],"servo_velocity":[1.3552527156068805e-20,0,0,5.4210108624275222e-20,0,0],"servo_effort":[-0.058104176668728802,-1.5347501843670099,-0.29772190508583934,-8.311665349815691e-05,-0.00056153071539477681,0.00028367302648496073]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":666,"step":5328,"t":26.640000000000001,"sim_time":26.639999999998984,"vehicle":{"origin_ned":[1.5093799471598623,1.0223105951727882,3.5079023768209483],"origin_quat_xyzw":[-0.022014063552035255,0.053796350941939401,0.38043339418016675,0.92297982980334758],"cg_ned":[1.4488907562998723,0.96271515567172405,3.2155235593409608],"linear_velocity_ned":[-0.0042209834582455944,-0.0050183790878800252,0.0069214934190172678],"angular_velocity_ned":[0.0005232985759519792,-0.00078294844274463577,-0.0062454181946378562]},"sensors":{"Odom":[1.5093799471598623,1.0223105951727882,3.5079023768209483,-0.0075700026660449424,-0.0010621787519396451,0.0061634595228606598,-0.022014063552035262,0.053796350941939415,0.38043339418016686,0.92297982980334758,0.00054562967583435262,-0.00092613262382562221,-0.0062238785905123495],"Pressure":[26910.592149330114],"DVL":[-0.046606011393215921,0.012577414615467204,0.02000877205380952,7.2878914922592513,0.01790665877810918,-0.0074601359733209374,0.0043978711332942613,0],"IMU":[0.00029678899898750836,0.11631777933967023,0.78194064118070317,0.01047990685961879,-0.0063359997817144208,-0.054940548802855801,1.1555097394780671,-0.0072653015229814438,-9.7625690088735215],"FOG":[0.780783288280261],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[8.4881110989170203,-19.01053460118813,-26.239685718114536,60.641025666707563,60.641025666707563],"omega_rad_s":[8.6846165727462221,-19.056507015973732,-26.263229229475641,60.633242079971012,60.633334400327328],"thrust_n":[0.95969291112593591,-4.5600482317972659,-8.7380905332794452,46.76990616671079,46.742201308946534],"torque_nm":[-0.017994242083611302,0.085500904346198739,0.16383919749898959,-0.87693574062582735,-0.87641627454274751],"angle_rad":[-590.1047204337309,439.99216814453524,-566.74745390042506,1844.8467454599354,1844.8466652642608]},"command":[0.080839153323019247,-0.18105271048750599,-0.24990176874394798,0.57753357777816727,0.57753357777816727],"arm":{"servo_position":[-3.1300514379006746e-23,3.2526065174565154e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,2.3716922523121907e-22],"servo_velocity":[0,8.6736173798840355e-19,0,0,0,0],"servo_effort":[-0.057354116969214552,-1.5331831809894754,-0.29730397065776454,-8.1964087184346023e-05,-0.00056137510568842841,0.00028306171517531879]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":667,"step":5336,"t":26.68,"sim_time":26.679999999998977,"vehicle":{"origin_ned":[1.5092175990109415,1.0220885008571623,3.5081777284418889],"origin_quat_xyzw":[-0.022003216899896767,0.05378050572725572,0.38031938538926469,0.92302799564634463],"cg_ned":[1.4487227784645664,0.96251445022892601,3.2157957168371678],"linear_velocity_ned":[-0.004182742565217017,-0.0050169928789807723,0.0067124186264480128],"angular_velocity_ned":[0.0005677226237624114,-0.00077747390214954971,-0.0061456551156804911]},"sensors":{"Odom":[1.5092175990109415,1.0220885008571623,3.5081777284418889,-0.0075256411382149989,-0.001091729182918196,0.0059607284618788583,-0.022003216899896788,0.053780505727255769,0.38031938538926507,0.92302799564634463,0.00056919582013392625,-0.00095351773422885304,-0.0061206757384947522],"Pressure":[26911.123634942032],"DVL":[-0.037305681835312271,0.0033431710171196415,0.019948887709454136,7.3544456734319974,-0.020567646404965622,-0.017571914108980759,0.026043589671030123,0],"IMU":[0.00029032794991686587,0.11628018655838016,0.78169231865471323,0.027958129661635991,0.0093249050560259839,-0.0077107660671646141,1.1412141011765504,0.00015833251396504518,-9.7338143903550929],"FOG":[0.79790454236291208],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[8.4384154880101114,-18.917638625388832,-26.245314594608878,60.616453655636619,60.616453655636619],"omega_rad_s":[8.633724336584212,-18.963149851337604,-26.269308388792169,60.607294628489129,60.607386887618674],"thrust_n":[0.94837591146513089,-4.5158016987482759,-8.7424803267308633,46.735691584317003,46.707166060985621],"torque_nm":[-0.017782048339971209,0.084671281851530181,0.16392150612620374,-0.87629421720594369,-0.8757593636434805],"angle_rad":[-589.75849241474089,439.23203673368749,-567.79812295758552,1847.271481345357,1847.2714048414439]},"command":[0.080365861790572493,-0.18016798690846508,-0.24995537709151311,0.57729955862511062,0.57729955862511062],"arm":{"servo_position":[-3.1300514379006746e-23,3.2526065174565154e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,2.3716922523121907e-22],"servo_velocity":[-1.3552527156068805e-20,8.6736173798840355e-19,0,0,0,0],"servo_effort":[-0.056596749061254115,-1.5316168343612435,-0.29688272131538301,-8.0825591878946814e-05,-0.00056120405492652431,0.00028243337166182611]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":668,"step":5344,"t":26.719999999999999,"sim_time":26.719999999998969,"vehicle":{"origin_ned":[1.5090565975126307,1.0218661927618007,3.5084448120621095],"origin_quat_xyzw":[-0.021991618689124508,0.053764397278120525,0.38020725571783331,0.92307540374135555],"cg_ned":[1.4485563164666648,0.96231380545571876,3.2160595171331021],"linear_velocity_ned":[-0.0041451139484314599,-0.0050153753575946525,0.0065036143788746361],"angular_velocity_ned":[0.00061122161844847549,-0.00077063987605688106,-0.0060465362590501493]},"sensors":{"Odom":[1.5090565975126307,1.0218661927618007,3.5084448120621095,-0.0074810920031535989,-0.0011207783489967148,0.0057581579200409773,-0.021991618689124519,0.053764397278120553,0.38020725571783348,0.92307540374135555,0.00059314633119510662,-0.00097927832860695771,-0.0060180785806058122],"Pressure":[26915.182748685362],"DVL":[-0.011467547125454437,-0.0083099287435719239,-0.022615233752586294,7.4253225493321828,0.0047425277994686717,-0.0066919852560756374,0.02463739632329515,0],"IMU":[0.00028530868131054207,0.1162415323777221,0.78144813969653992,-0.058555705922341307,-0.035736451770533112,-0.014183319782637271,1.1488869000994137,-0.0032812005187542606,-9.7080707457749362],"FOG":[0.77168328762962968],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[8.3876118410531841,-18.824216847611158,-26.250556848439341,60.59251747416014,60.59251747416014],"omega_rad_s":[8.5815324382071196,-18.869341474784861,-26.274982153883489,60.582008547192608,60.582100647868664],"thrust_n":[0.93684429154824178,-4.4715503627357096,-8.7465971239630544,46.702482949106859,46.673186054464281],"torque_nm":[-0.017565830466529535,0.08384156930129455,0.16399869607430731,-0.87567155529575369,-0.8751222385212053],"angle_rad":[-589.4143299885277,438.4756498288196,-568.84902592441824,1849.6951944112889,1849.6951215944921]},"command":[0.079882017533839847,-0.17927825569153483,-0.25000530331846993,0.57707159499200134,0.57707159499200134],"arm":{"servo_position":[-9.9063150159350775e-23,-1.0842021724855024e-21,1.0778494253810979e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,2.3716922523121907e-22],"servo_velocity":[-1.3552527156068805e-20,0,-1.7347234759768071e-18,0,0,0],"servo_effort":[-0.055831580229406361,-1.5300516031026192,-0.29645816164696226,-7.9681130336645609e-05,-0.00056101037071090395,0.00028178578034074016]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":669,"step":5352,"t":26.760000000000002,"sim_time":26.759999999998961,"vehicle":{"origin_ned":[1.5088969349893646,1.0216436899062382,3.5087036349858804],"origin_quat_xyzw":[-0.021979276615612001,0.053748057267683357,0.38009699291063465,0.92312205786650825],"cg_ned":[1.4483913459417828,0.96211323033596829,3.2163149730843377],"linear_velocity_ned":[-0.0041080918516653211,-0.0050135385413791573,0.0062951707257079175],"angular_velocity_ned":[0.00065368619299554338,-0.00076257796217190537,-0.0059480734854952359]},"sensors":{"Odom":[1.5088969349893646,1.0216436899062382,3.5087036349858804,-0.0074363766715228518,-0.0011492913159813431,0.0055558371464370891,-0.021979276615612012,0.053748057267683377,0.38009699291063487,0.92312205786650825,0.00061731257722490358,-0.0010034306703533382,-0.0059161187486348613],"Pressure":[26917.6447229978],"DVL":[-0.020001189816238704,0.0096140016144276134,0.0033914145793423091,7.2896459256304507,0.015902873540832151,-0.023576967787211033,0.031165123622061929,0],"IMU":[0.00028173977795129028,0.11620188181777678,0.78120807915897028,0.013350610414287525,-0.03422013068605792,0.11455479643781302,1.1337315154982484,-0.010372729323203995,-9.7547835205414355],"FOG":[0.77794315456956309],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[8.335792847940132,-18.730236070478234,-26.255415766435412,60.569219761814537,60.569219761814537],"omega_rad_s":[8.528136766248311,-18.775049680327012,-26.280254165581642,60.557385702587361,60.55747755037013],"thrust_n":[0.92512396768856087,-4.4272819808575976,-8.7504430820492871,46.670279900912213,46.640260362570636],"torque_nm":[-0.01734607439416052,0.083011537141079964,0.1640708077884242,-0.87506774814210408,-0.87450488179819952],"angle_rad":[-589.07228295594757,437.72302620969242,-569.9001466680503,1852.1179111549861,1852.1178420168335]},"command":[0.079388503313715539,-0.17838320067122126,-0.2500515787279563,0.5768497120172813,0.5768497120172813],"arm":{"servo_position":[-3.1300514379006746e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,2.3716922523121907e-22],"servo_velocity":[0,0,1.7347234759768071e-18,0,0,0],"servo_effort":[-0.05505841203676811,-1.5284879338583741,-0.29603043110717614,-7.8543864132714423e-05,-0.00056079685679139089,0.00028111815936991355]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":670,"step":5360,"t":26.800000000000001,"sim_time":26.799999999998953,"vehicle":{"origin_ned":[1.5087386025108183,1.0214210120424687,3.5089542081084057],"origin_quat_xyzw":[-0.021966201346805044,0.053731515763287101,0.37998858432363253,0.92316796196352735],"cg_ned":[1.4482278427736304,0.96191273336589223,3.2165621010736976],"linear_velocity_ned":[-0.0040716697476223477,-0.0050114947431676793,0.0060871744372813456],"angular_velocity_ned":[0.00069501066348578154,-0.00075341910738482582,-0.0058502776066288245]},"sensors":{"Odom":[1.5087386025108183,1.0214210120424687,3.5089542081084057,-0.0073915164104551342,-0.0011772347628365575,0.0053538523028837399,-0.021966201346805055,0.053731515763287122,0.37998858432363275,0.92316796196352735,0.00064152887775192251,-0.0010259932801470297,-0.0058148264579828786],"Pressure":[26919.881039552372],"DVL":[0.00095563919238459034,0.014601617150274169,-0.022683142594270254,7.2529068900309204,-0.038803375960181595,-0.035425349171334573,-0.015650725651200341,0],"IMU":[0.00027962298032700939,0.11616129917806246,0.78097211064404359,0.0091409208306832967,-0.058138164202038066,-0.12527845807654645,1.1380335813641627,0.024169845287090513,-9.7525893397946852],"FOG":[0.77951844665469716],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[8.2830502984817045,-18.635662145313582,-26.259894423022686,60.546563343916638,60.546563343916638],"omega_rad_s":[8.4736333267440784,-18.680241079723388,-26.2851280306717,60.533428101884738,60.533519605198023],"thrust_n":[0.91324047089661398,-4.3829840889801357,-8.7540203573353317,46.639082442585654,46.60838835769389],"torque_nm":[-0.017123258829311514,0.082180951668377578,0.16413788170003751,-0.87448279579848132,-0.87390728170676046],"angle_rad":[-588.73239727866667,436.97418597189989,-570.9514692008114,1854.5396581514203,1854.539592679726]},"command":[0.078886193318873379,-0.17748249662203411,-0.25009423260021607,0.57663393660872986,0.57663393660872986],"arm":{"servo_position":[-3.1300514379006746e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,7.792703114739713e-22],"servo_velocity":[0,0,0,0,0,1.0842021724855044e-19],"servo_effort":[-0.054276612727879238,-1.5269262658086755,-0.2955995118789157,-7.7390464751901869e-05,-0.00056055784925025871,0.00028043079969081137]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":671,"step":5368,"t":26.84,"sim_time":26.839999999998945,"vehicle":{"origin_ned":[1.5085815899318724,1.0211981795951339,3.5091965458043561],"origin_quat_xyzw":[-0.021952406439831193,0.053714801221468628,0.37988201693624252,0.92321312013515644],"cg_ned":[1.4480657831187904,0.9617123225376315,3.2168009208933239],"linear_velocity_ned":[-0.0040358405684904142,-0.0050092567957407338,0.0058797094713719618],"angular_velocity_ned":[0.00073509373955719123,-0.0007432922223199244,-0.0057531595416648283]},"sensors":{"Odom":[1.5085815899318724,1.0211981795951339,3.5091965458043561,-0.0073465325706304424,-0.0012045775003974909,0.0051522868644595914,-0.021952406439831207,0.053714801221468662,0.37988201693624274,0.92321312013515644,0.0006656341093820746,-0.0010469864460103844,-0.0057142314846219027],"Pressure":[26923.101904756561],"DVL":[-0.033024290845503811,0.013002666007337273,-0.026218452766607805,7.2471604888780297,-0.0082565772386197032,0.0090215271348636685,-0.022357102401032784,0],"IMU":[0.00027895333657695508,0.11611984796190863,0.78074020653777487,0.020366633444886959,-0.07436724834930325,-0.065826749187395714,1.1415342073291821,-0.0035690015893602217,-9.7413968184987372],"FOG":[0.79795179656655502],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[8.2294755011009872,-18.540459974904568,-26.263995776323153,60.524551181261501,60.524551181261501],"omega_rad_s":[8.4181180531585795,-18.584881246670903,-26.28960725457318,60.510137913698834,60.510228983896212],"thrust_n":[0.90121887791116784,-4.3386440834324329,-8.7573310585026309,46.608890955232553,46.577569741262124],"torque_nm":[-0.016897853960834399,0.081349576564358109,0.16419995734692436,-0.87391670541061039,-0.87332943264866481],"angle_rad":[-588.39471507845121,436.22915056975535,-572.00297767678887,1856.9604620596265,1856.9604002386072]},"command":[0.078375957153342737,-0.1765758092848054,-0.25013329310783955,0.57642429696439523,0.57642429696439523],"arm":{"servo_position":[-9.9063150159350775e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,4.3198680309969292e-21,2.3716922523121907e-22],"servo_velocity":[-1.3552527156068805e-20,0,0,0,8.6736173798840355e-19,0],"servo_effort":[-0.053486072069972662,-1.5253667937359652,-0.29516539341908671,-7.6253292543871279e-05,-0.00056029816193696772,0.00027972663440288824]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":672,"step":5376,"t":26.879999999999999,"sim_time":26.879999999998937,"vehicle":{"origin_ned":[1.5084258859360236,1.0209752135934795,3.5094306658118883],"origin_quat_xyzw":[-0.021937908248512453,0.053697940487645049,0.37977727736726175,0.92325753664109078],"cg_ned":[1.4479051434302992,0.96151200531931647,3.2170314556222634],"linear_velocity_ned":[-0.0040005966496309388,-0.0050068379338372611,0.0056728566378952553],"angular_velocity_ned":[0.00077383805460400621,-0.00073232465553008282,-0.0056567293497870813]},"sensors":{"Odom":[1.5084258859360236,1.0209752135934795,3.5094306658118883,-0.0073014464249065766,-0.0012312901408395834,0.004951221300516161,-0.021937908248512456,0.053697940487645056,0.3797772773672618,0.92325753664109078,0.00068947093181977051,-0.0010664322219580775,-0.005614362281037651],"Pressure":[26924.672281197072],"DVL":[0.010742350298840212,-0.015170345627171976,-0.02720457866861235,7.3439439019923238,-0.011852431392293215,0.0075330169954592463,0.0068074504391801649,0],"IMU":[0.00027971937916884416,0.11607759080135639,0.78051233805428832,-0.010119336253579555,-0.071955493978290735,-0.18832892594211023,1.1497403338734178,0.001163719299061213,-9.7317883656859703],"FOG":[0.80470518612590736],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[8.1751581676862006,-18.444593548920619,-26.267722412794949,60.503186451037344,60.503186451037344],"omega_rad_s":[8.3616862582376239,-18.488934674928792,-26.293695202910445,60.487517476218279,60.487608027639979],"thrust_n":[0.88908366947181072,-4.2942492208393084,-8.7603772193931757,46.579706218691186,46.547804563018836],"torque_nm":[-0.016670318802596451,0.080517172890737065,0.16425707286362212,-0.87336949160045985,-0.87277133555660324],"angle_rad":[-588.059274653128,435.48794285985576,-573.0546563876245,1859.3803496291412,1859.3802914395351]},"command":[0.077858649216059048,-0.17566279570400589,-0.25016878488376143,0.57622082334321278,0.57622082334321278],"arm":{"servo_position":[-3.1300514379006746e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,2.3716922523121907e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.052686424249233345,-1.523810195968275,-0.29472823606118259,-7.5093708263138087e-05,-0.00056001312814807195,0.00027900178488572669]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":673,"step":5384,"t":26.920000000000002,"sim_time":26.919999999998929,"vehicle":{"origin_ned":[1.5082714780784303,1.0207521356053573,3.5096565891161533],"origin_quat_xyzw":[-0.021922725826130182,0.053680958797539903,0.37967435188376991,0.92330121589683201],"cg_ned":[1.4477459004782993,0.96131178863991529,3.2172537315035514],"linear_velocity_ned":[-0.0039659298800950246,-0.005004251931263113,0.0054666937809319423],"angular_velocity_ned":[0.00081115136069430057,-0.00072064103663145769,-0.0055609971927776114]},"sensors":{"Odom":[1.5082714780784303,1.0207521356053573,3.5096565891161533,-0.0072562793959654991,-0.0012573456483231079,0.0047507332318109628,-0.021922725826130186,0.05368095879753991,0.37967435188376997,0.92330121589683201,0.0007128875524496952,-0.0010843544401245471,-0.0055152467394903038],"Pressure":[26926.358984915943],"DVL":[0.042590078808015713,0.042997949741662135,0.0059757024339406831,7.3479279344651616,0.0042349216735009885,-0.014317437139417036,-0.0091720529032709459,0],"IMU":[0.00028190330992505021,0.11603458938237489,0.78028847526519607,0.17154900420426916,-0.003385569960974812,0.36075058323530418,1.1198339710206007,-0.006254492868488953,-9.7198920097956503],"FOG":[0.76879866463962043],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[8.1201872325118689,-18.348025604552831,-26.27107693298651,60.482472558260056,60.482472558260056],"omega_rad_s":[8.3044325435942774,-18.392364803421614,-26.297395089170362,60.465569324310671,60.465659274333788],"thrust_n":[0.8768586931219714,-4.2497866452616329,-8.7631607909807521,46.551529449755726,46.51909325908985],"torque_nm":[-0.016441100496036965,0.079683499598655602,0.16430926483088912,-0.87284117718291998,-0.8722329986079348],"angle_rad":[-587.72611050355886,434.75058714248092,-574.10648975583138,1861.7993477074531,1861.7992931266397]},"command":[0.07733511650011303,-0.17474310099574125,-0.25020073269510962,0.57602354817390533,0.57602354817390533],"arm":{"servo_position":[-3.1300514379006746e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,4.3198680309969292e-21,2.3716922523121907e-22],"servo_velocity":[1.3552527156068805e-20,-8.6736173798840355e-19,0,5.4210108624275222e-20,8.6736173798840355e-19,0],"servo_effort":[-0.051877655541213361,-1.5222566173017604,-0.29428795423280929,-7.3926621337014198e-05,-0.0005597013786621945,0.00027825449308743576]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":674,"step":5392,"t":26.960000000000001,"sim_time":26.959999999998921,"vehicle":{"origin_ned":[1.5081183528407807,1.0205289676608582,3.5098743398394845],"origin_quat_xyzw":[-0.021906880813488301,0.053663879800400091,0.37957322641809793,0.92334416246833284],"cg_ned":[1.4475880313682365,0.96111167886613935,3.2174677778304686],"linear_velocity_ned":[-0.0039318316553811523,-0.0050015130211412294,0.005261295822458518],"angular_velocity_ned":[0.00084694539985768753,-0.00070836312617511294,-0.0054659722471329846]},"sensors":{"Odom":[1.5081183528407807,1.0205289676608582,3.5098743398394845,-0.0072110527002488545,-0.0012827190109730912,0.0045508974383450546,-0.021906880813488315,0.053663879800400133,0.37957322641809815,0.92334416246833284,0.00073573690953238242,-0.0011007778019611037,-0.0054169111923636085],"Pressure":[26930.089107249663],"DVL":[-0.016064091651035534,0.0031292888624619747,0.0056297423868892091,7.3545670599651407,-0.027015043757930166,0.0036517614206966415,-0.010873253637085424,0],"IMU":[0.0002854812301011028,0.11599090439957288,0.78006858714974658,-0.078132432395052298,0.035832835204720782,0.038773507115609014,1.1334762032063284,0.0020133989068808382,-9.7872303055605094],"FOG":[0.7727944137722268],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[8.0646486939053297,-18.250717993807662,-26.274061500132539,60.462413047249193,60.462413047249193],"omega_rad_s":[8.2464501008874525,-18.295133976909568,-26.300709919858413,60.444296184383461,60.444385453457031],"thrust_n":[0.8645670009045342,-4.2052433894401924,-8.7656836002335776,46.524362278768599,46.491436655884193],"torque_nm":[-0.016210631266960016,0.078848313552003613,0.16435656750437957,-0.8723317927269113,-0.87171443729782871],"angle_rad":[-587.39525337744101,434.01710920593683,-575.15846232802778,1864.2174832478602,1864.2174322499843]},"command":[0.076806178037193612,-0.17381636184578725,-0.25022915714411942,0.57583250521189711,0.57583250521189711],"arm":{"servo_position":[-3.1300514379006746e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,7.792703114739713e-22],"servo_velocity":[-1.3552527156068805e-20,0,0,0,0,1.0842021724855044e-19],"servo_effort":[-0.051059132233421824,-1.5207062973985632,-0.29384457284472631,-7.2773722498526531e-05,-0.00055936192602615525,0.00027748997479328121]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":675,"step":5400,"t":27,"sim_time":26.999999999998913,"vehicle":{"origin_ned":[1.5079664958829273,1.0203057319739766,3.5100839451206021],"origin_quat_xyzw":[-0.021890396828993967,0.05364672576909045,0.37947388702983109,0.92338638088472813],"cg_ned":[1.4474315135864093,0.96091168176214881,3.2176736268193968],"linear_velocity_ned":[-0.0038982915076893362,-0.0049986371746954588,0.0050567344625908773],"angular_velocity_ned":[0.00088118189498356944,-0.00069556741796492441,-0.0053716155046377315]},"sensors":{"Odom":[1.5079664958829273,1.0203057319739766,3.5100839451206021,-0.0071657878814093637,-0.0013074033699071847,0.0043517856671675828,-0.021890396828993967,0.053646725769090457,0.37947388702983109,0.92338638088472813,0.00075793330446774932,-0.0011157300558005889,-0.0053193262959896999],"Pressure":[26932.048967685187],"DVL":[0.012289359905048231,-0.0045883420566032746,-0.032378818308287059,7.3089479093794667,0.019856724033151942,0.024736588615118259,-0.020346173228947745,0],"IMU":[0.00029042449519861894,0.11594659547816706,0.77985264267340393,0.015954883552294262,0.023972271695962614,-0.16695595994624624,1.1387698154829355,-0.0056145950837958288,-9.7417791338028099],"FOG":[0.76678099915804421],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[8.0086140504039687,-18.152644714344191,-26.276669005184175,60.443011772847974,60.443011772847974],"omega_rad_s":[8.187828204158917,-18.197206003915053,-26.303640763733057,60.423701003925949,60.423789515599367],"thrust_n":[0.85223033255134895,-4.1606076697825767,-8.7679460596037178,46.498206827284569,46.464835993954601],"torque_nm":[-0.015979318735337797,0.078011393808423313,0.16439898861756971,-0.8718413780115859,-0.87121567488664886],"angle_rad":[-587.06673035887411,433.28753633522496,-576.21055874352453,1866.6347833176144,1866.6347358737071]},"command":[0.076272514765752086,-0.17288233061280184,-0.25025399052556357,0.57564773116998069,0.57564773116998069],"arm":{"servo_position":[-9.9063150159350775e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,2.3716922523121907e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.050216317077224772,-1.5191600693965335,-0.29339817878711544,-7.159219094352205e-05,-0.00055899536189150337,0.00027670240696034333]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":676,"step":5408,"t":27.039999999999999,"sim_time":27.039999999998905,"vehicle":{"origin_ned":[1.5078158922883793,1.020082450618077,3.5102854350065744],"origin_quat_xyzw":[-0.021873298800514716,0.053629517777133311,0.37937632037156632,0.92342787545314331],"cg_ned":[1.4472763250444642,0.96071180244212673,3.2178713134865902],"linear_velocity_ned":[-0.0038652991892792143,-0.0049956402950339695,0.0048530783183396804],"angular_velocity_ned":[0.00091381075563792857,-0.00068234922314315105,-0.0052779095577041328]},"sensors":{"Odom":[1.5078158922883793,1.020082450618077,3.5102854350065744,-0.0071205076831368144,-0.001331387148911112,0.0041534668720244064,-0.021873298800514741,0.053629517777133373,0.37937632037156671,0.92342787545314331,0.00077937208333709522,-0.0011292440834250854,-0.0052224866504867688],"Pressure":[26934.246391935994],"DVL":[-0.038303052897455052,0.012654893401478618,0.01354585104175408,7.3385841465584365,-0.014208419106352167,-0.026279553809365586,0.017665333375187855,0],"IMU":[0.0002967011529340198,0.1159017209913533,0.77964061187642031,0.0095882188686422197,0.025457470876275957,0.043341740823341787,1.1366660676621019,-0.0056090436990022113,-9.7572999349077687],"FOG":[0.7768961588379093],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.9521122274055118,-18.053814882798022,-26.278866043048485,60.424272786168821,60.424272786168821],"omega_rad_s":[8.1286383717966864,-18.098558472511808,-26.306177959173574,60.403786962994026,60.403874643990207],"thrust_n":[0.83986624781184716,-4.1158744085090673,-8.7699414402001032,46.473065751887695,46.439292901335406],"torque_nm":[-0.015747492146472138,0.077172645159545028,0.16443640200375195,-0.87136998284789424,-0.87073674190003914],"angle_rad":[-586.74056536244404,432.56189694923353,-577.26276344118753,1869.051275107222,1869.0512311853286]},"command":[0.075734402165766782,-0.17194109412188593,-0.25027491469569985,0.57546926463017922,0.57546926463017922],"arm":{"servo_position":[-3.1300514379006746e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,2.3716922523121907e-22],"servo_velocity":[1.3552527156068805e-20,0,0,0,0,0],"servo_effort":[-0.049361751497557012,-1.5176188143074281,-0.29294884428473156,-7.041153079239463e-05,-0.00055859468369471069,0.00027589527816403425]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":677,"step":5416,"t":27.080000000000002,"sim_time":27.079999999998897,"vehicle":{"origin_ned":[1.507666526233062,1.019859145808647,3.5104788423352526],"origin_quat_xyzw":[-0.021855613724083997,0.053612275322662432,0.37928051288417436,0.92346865059393768],"cg_ned":[1.44712244404287,0.96051204540443946,3.2180608755196389],"linear_velocity_ned":[-0.0038328451531200003,-0.0049925376125209515,0.0046503927978935149],"angular_velocity_ned":[0.00094476105318028159,-0.00066882581255307664,-0.0051848676731249448]},"sensors":{"Odom":[1.507666526233062,1.019859145808647,3.5104788423352526,-0.0070752347267911807,-0.0013546515477827049,0.0039560068922213313,-0.021855613724084007,0.05361227532266246,0.37928051288417453,0.92346865059393768,0.0007999221163781788,-0.0011413538069298713,-0.0051264208077464171],"Pressure":[26935.705534007404],"DVL":[-0.030644760248655156,-0.027668562433142779,-0.0026179811499398983,7.2026990985489094,-0.0018875344833769892,0.020673312577810975,-0.0026051811050776751,0],"IMU":[0.00030427414558487716,0.11585633794012992,0.7794324640240412,-0.0074011276974237381,-0.032706548491751766,-0.082809957564875955,1.1408978408630408,-0.0031188395104597587,-9.7469808523094503],"FOG":[0.79234951762582095],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.8952169082920305,-17.954189376092302,-26.280650987039188,60.40620044692524,60.40620044692524],"omega_rad_s":[8.068950669276024,-17.999166349183572,-26.308312233044191,60.3845574911875,60.384644271500335],"thrust_n":[0.82749159173679998,-4.0710375163963102,-8.7716634127607289,46.448942229522466,46.414809481160518],"torque_nm":[-0.015515467345065001,0.076331953432430821,0.16446868898926367,-0.87091766680354632,-0.87027767777175979],"angle_rad":[-586.41677951717907,431.84022038067724,-578.31506045282117,1871.4669859399523,1871.4669455052599]},"command":[0.075192541983733624,-0.17099227977230763,-0.25029191416227797,0.57529714711357371,0.57529714711357371],"arm":{"servo_position":[-3.1300514379006746e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,2.3716922523121907e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.048498123861357836,-1.5160827571311393,-0.2924966212267045,-6.9223670516520126e-05,-0.00055816303156450576,0.0002750634435286824]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":678,"step":5424,"t":27.120000000000001,"sim_time":27.119999999998889,"vehicle":{"origin_ned":[1.5075183809742403,1.0196358399225658,3.5106642026118648],"origin_quat_xyzw":[-0.021837370725771427,0.053595016304674989,0.37918645063708251,0.92350871090658271],"cg_ned":[1.446969849270503,0.9603124145381452,3.2182423531539324],"linear_velocity_ned":[-0.0038009195283881477,-0.0049893443850387896,0.0044487402507101077],"angular_velocity_ned":[0.00097396586636493035,-0.00065511007583309185,-0.005092502673548484]},"sensors":{"Odom":[1.5075183809742403,1.0196358399225658,3.5106642026118648,-0.0070299909096304229,-0.001377179699277944,0.0037594685566983855,-0.021837370725771431,0.053595016304675003,0.37918645063708256,0.92350871090658271,0.00081945814000719997,-0.0011520929268801425,-0.005031156173784428],"Pressure":[26938.876391026311],"DVL":[-0.0066073869116044558,-0.018415414403093792,0.025153162793636236,7.275018496829035,-0.031715839150704757,-0.018286908203415136,0.02494351227502448,0],"IMU":[0.00031310115880842408,0.11581050195462823,0.77922816725274935,-0.038872300103174252,0.10482228041826375,-0.19022101518671139,1.1290006733600488,-0.0085588977364543482,-9.7973310214947222],"FOG":[0.78002498122942998],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.8380040223205345,-17.85372335181421,-26.282025732028586,60.388799435164053,60.388799435164053],"omega_rad_s":[8.008838108726227,-17.898997575048494,-26.310037986158079,60.366016301376625,60.366102114316448],"thrust_n":[0.81512340560129715,-4.0260880194051785,-8.7731081257757495,46.42583997982571,46.391388390711747],"torque_nm":[-0.015283563855024324,0.07548915036384711,0.16449577735829532,-0.87048449962173213,-0.86983853232584529],"angle_rad":[-586.09539107761202,431.12253712987194,-579.36743352634244,1873.8819432826674,1873.8819062976363]},"command":[0.074647657355433661,-0.17003546049346865,-0.25030500697170083,0.57513142319203858,0.57513142319203858],"arm":{"servo_position":[-3.1300514379006746e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,2.3716922523121907e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.047624972632580947,-1.5145519198983926,-0.29204136196672492,-6.8013508644393139e-05,-0.00055769963946603193,0.0002742133590235207]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":679,"step":5432,"t":27.16,"sim_time":27.159999999998881,"vehicle":{"origin_ned":[1.5073714388956492,1.0194125554191311,3.5108415538894366],"origin_quat_xyzw":[-0.021818600928564216,0.053577757024812322,0.37909411932461673,0.92354806117451371],"cg_ned":[1.4468185198180818,0.96011291311614477,3.21841578904451],"linear_velocity_ned":[-0.003769512158630074,-0.0049860761387016403,0.004248179601346041],"angular_velocity_ned":[0.0010013669486704044,-0.00064131441786408235,-0.0050008294883561247]},"sensors":{"Odom":[1.5073714388956492,1.0194125554191311,3.5108415538894366,-0.0069847993756938535,-0.0013989571933529686,0.0035639116022594241,-0.021818600928564229,0.05357775702481235,0.37909411932461695,0.92354806117451371,0.00083786163000503411,-0.0011615009677723494,-0.0049367214739026175],"Pressure":[26941.094552647515],"DVL":[-0.017913676959288138,0.027050051594643895,-0.021439263421364374,7.2712826394838173,-0.028343011259952516,-0.030094721974486691,0.018725488263812037,0],"IMU":[0.00032313487204530618,0.11576426719443339,0.77902768857541838,0.071938543243693642,-0.073855146784044076,-0.011825311366973835,1.1517587554563855,-0.0025321607359364284,-9.7555362236568151],"FOG":[0.77863902998527013],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.7805469687261164,-17.752370435156838,-26.282992162835374,60.372074754591722,60.372074754591722],"omega_rad_s":[7.9483749191097939,-17.798014967449816,-26.311352114636612,60.348167409687548,60.34825219191039],"thrust_n":[0.80277854553330863,-3.9810150119901491,-8.7742734227804409,46.403763368430774,46.369032795222239],"torque_nm":[-0.01505209772874954,0.074644031474815298,0.16451762667713327,-0.87007056315807718,-0.86941936491041705],"angle_rad":[-585.776415345754,430.40887909860749,-580.41986624485435,1876.2961747576217,1876.2961411821207]},"command":[0.074100447321201107,-0.16907019462054132,-0.25031421107462259,0.57497214051992118,0.57497214051992118],"arm":{"servo_position":[-3.1300514379006746e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,2.3716922523121907e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.046743395264512232,-1.5130280813260353,-0.29158338572507708,-6.6783660407263408e-05,-0.00055719634947805699,0.00027333732824568992]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":680,"step":5440,"t":27.199999999999999,"sim_time":27.199999999998873,"vehicle":{"origin_ned":[1.5072256815359655,1.0191893147351805,3.5110109366504978],"origin_quat_xyzw":[-0.021799337284262237,0.053560512150272507,0.37900350425240248,0.92358670637713625],"cg_ned":[1.4466684351870667,0.95991354379135041,3.2185812281308768],"linear_velocity_ned":[-0.0037386127152021281,-0.0049827483799144145,0.0040487668517987111],"angular_velocity_ned":[0.0010269109643626904,-0.00062754597614142244,-0.0049098623767206738]},"sensors":{"Odom":[1.5072256815359655,1.0191893147351805,3.5110109366504978,-0.0069396826361556472,-0.0014199717512528793,0.0033693928819272362,-0.021799337284262248,0.053560512150272535,0.3790035042524027,0.92358670637713625,0.00085502116072199309,-0.0011696172218252031,-0.0048431439177836029],"Pressure":[26940.849335249048],"DVL":[0.00116625250832163,-0.022110922479581525,0.010325527248806398,7.3627857561054091,0.0016176935890930843,0.023620687730563143,0.012894462852355191,0],"IMU":[0.00033432324292944899,0.11571768615055782,0.77883099386449706,0.009461607250958997,0.019760040768241116,0.027171580095980894,1.1411647233420736,-0.0075267845409297176,-9.7140603743796436],"FOG":[0.77662173675182677],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.7229154704704399,-17.650079268763015,-26.283551939391661,60.356031823782345,60.356031823782345],"omega_rad_s":[7.8876349076663228,-17.696176282060357,-26.312253177619748,60.331015172835485,60.331098864452414],"thrust_n":[0.79047333805151798,-3.9358057590706883,-8.7751582791101406,46.382717419266832,46.3477464684794],"torque_nm":[-0.014821375088465963,0.073796357982575403,0.16453421773331517,-0.86967595161125311,-0.86902024628398888],"angle_rad":[-585.45986466112458,429.69927979244073,-581.47234210733666,1878.7097081553843,1878.7096779468261]},"command":[0.073551575909242287,-0.16809599303583825,-0.25031954227992059,0.57481935070268897,0.57481935070268897],"arm":{"servo_position":[-3.1300514379006746e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,2.3716922523121907e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.045852820977477504,-1.5115102284601656,-0.29112238259706186,-6.5552462436091209e-05,-0.00055665774074880616,0.00027243530588584049]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":681,"step":5448,"t":27.240000000000002,"sim_time":27.239999999998865,"vehicle":{"origin_ned":[1.5070810897174762,1.0189661402854564,3.5111723936750994],"origin_quat_xyzw":[-0.021779614503138589,0.053543294905695794,0.37891459037203268,0.92362465166642826],"cg_ned":[1.4465195753019873,0.95971430858860562,3.2187387175304263],"linear_velocity_ned":[-0.0037082103564234159,-0.004979376852908543,0.0038505550161306167],"angular_velocity_ned":[0.00105054337715426,-0.00061390099757786755,-0.0048196145125707305]},"sensors":{"Odom":[1.5070810897174762,1.0189661402854564,3.5111723936750994,-0.0068946600115909491,-0.0014402134897239626,0.0031759658863109927,-0.021779614503138593,0.053543294905695808,0.37891459037203279,0.92362465166642826,0.00087083195925579976,-0.001176472445926727,-0.004750448837173819],"Pressure":[26945.283957136777],"DVL":[-0.017011971426397092,0.0048932704141995314,0.029188489756110918,7.3603172951772082,-0.011900328654476947,-0.015492826258428809,0.0031260241322889886,0],"IMU":[0.00034660979140452492,0.11567080994642048,0.77863804795157399,-0.11118640895585849,0.057255003461832321,-0.069402796711255391,1.1336761714995003,-0.022528302645946199,-9.728082937776767],"FOG":[0.77864064299105662],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.6651761347360763,-17.546801599923988,-26.283707277153564,60.340676354670464,60.340676354670464],"omega_rad_s":[7.8266905607532706,-17.593436342100027,-26.312740929669392,60.31456428155154,60.314646826069136],"thrust_n":[0.77822339713911848,-3.8904467145101536,-8.7757624751179648,46.362707659427876,46.327533955572839],"torque_nm":[-0.014591688696358473,0.072945875897065374,0.16454554640846183,-0.86930076861427286,-0.86864126166699085],"angle_rad":[-585.14574843848095,428.99377448014343,-582.52484458246988,1881.1225714483337,1881.122544561812]},"command":[0.073001677473676918,-0.16711239618975227,-0.25032102168717679,0.57467310813971872,0.57467310813971872],"arm":{"servo_position":[-3.1300514379006746e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-4.0617876798803873e-22,-1.6940658945088655e-23,7.792703114739713e-22],"servo_velocity":[0,0,0,-5.4210108624275222e-20,0,1.0842021724855044e-19],"servo_effort":[-0.044953156989525539,-1.5099972671260626,-0.29065797516301145,-6.4300359444756028e-05,-0.00055607595797485608,0.00027150882560721628]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":682,"step":5456,"t":27.280000000000001,"sim_time":27.279999999998857,"vehicle":{"origin_ned":[1.506937643651636,1.0187430544413623,3.5113259699049122],"origin_quat_xyzw":[-0.021759468962613465,0.053526117200560892,0.37882736229298314,0.92366190235715451],"cg_ned":[1.4463719205274921,0.95951520890332009,3.2188883064164546],"linear_velocity_ned":[-0.0036782939810146606,-0.0049759773791242497,0.0036535943056533928],"angular_velocity_ned":[0.0010722126969111882,-0.00060046941583415884,-0.0047300985087228896]},"sensors":{"Odom":[1.506937643651636,1.0187430544413623,3.5113259699049122,-0.0068497495956494217,-0.0014596746094753987,0.0029836812324318847,-0.021759468962613479,0.053526117200560927,0.37882736229298336,0.92366190235715451,0.0008851957690024254,-0.0011820950954910018,-0.0046586602285151263],"Pressure":[26946.976077189309],"DVL":[-0.0029404292559594087,0.025740403472564878,-0.015024690629477014,7.3874852001931908,0.021570763956663044,0.012743641348893681,-0.014097698383621545,0],"IMU":[0.00035993387037199192,0.11562368850362512,0.77844881467354765,-0.043969939366792728,0.017752147276550445,-0.12424092918478327,1.1192076448148285,0.0034336508307668974,-9.7184830448057458],"FOG":[0.77896140567123617],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.6073921046364941,-17.442489287449188,-26.283461441175021,60.326014560417512,60.326014560417512],"omega_rad_s":[7.765612219204149,-17.489748346317672,-26.312816314719484,60.298819824480134,60.298901168633002],"thrust_n":[0.76604346774270626,-3.8449241507966869,-8.776086601904959,46.343740299656496,46.308400567471814],"torque_nm":[-0.014363315020175743,0.07209232782743788,0.16455162378571803,-0.86894513061855938,-0.86828251064009665],"angle_rad":[-584.83407324104894,428.29240027575884,-583.57735715663944,1883.5347928055385,1883.5347691939603]},"command":[0.072451353377490424,-0.16611894559475418,-0.25031868039214306,0.57453347200397631,0.57453347200397631],"arm":{"servo_position":[-3.1300514379006746e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,4.3198680309969292e-21,2.3716922523121907e-22],"servo_velocity":[0,0,1.7347234759768071e-18,0,8.6736173798840355e-19,0],"servo_effort":[-0.044044275971656159,-1.5084888863620849,-0.29018999471090562,-6.3030036105017886e-05,-0.00055545046911171798,0.00027055484131825904]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":683,"step":5464,"t":27.32,"sim_time":27.319999999998849,"vehicle":{"origin_ned":[1.5067953230277447,1.0185200794916678,3.5114717123188566],"origin_quat_xyzw":[-0.021738938599140605,0.053508989724409574,0.37874180430767707,0.92369846391396637],"cg_ned":[1.4462254516834867,0.95931624549711414,3.2190300459015995],"linear_velocity_ned":[-0.003648852000793546,-0.0049725657972838934,0.0034579318451192537],"angular_velocity_ned":[0.0010918706809938689,-0.00058733462626763878,-0.0046413261005722245]},"sensors":{"Odom":[1.5067953230277447,1.0185200794916678,3.5114717123188566,-0.0068049680150067317,-0.0014783495677997587,0.0027925864030392145,-0.021738938599140605,0.053508989724409581,0.37874180430767712,0.92369846391396637,0.00089802111043531382,-0.0011865112985496079,-0.0045678004053052272],"Pressure":[26947.530816280836],"DVL":[0.014811324915423404,-0.031080927618088099,-0.029415331705683896,7.3324673701617744,0.019351649106098108,0.028169842429192717,0.011738920602038927,0],"IMU":[0.00037423094441495404,0.11557637063559859,0.77826325694591769,0.043618025515846634,-0.13461868671110599,-0.055474156481638393,1.1347573105619435,-0.0048631146011626023,-9.7656701553550374],"FOG":[0.78581480214743105],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.549622672638951,-17.337094711890568,-26.28281760070935,60.312053024963319,60.312053024963319],"omega_rad_s":[7.7044675465372698,-17.385064493302821,-26.312481104770406,60.28378728286728,60.28386737643838],"thrust_n":[0.75394733499017663,-3.7992244682786596,-8.7761318190919138,46.325822233068799,46.290352370450542],"torque_nm":[-0.014136512531065812,0.071235458780224886,0.16455247160797337,-0.86860916687004008,-0.86794410694594781],"angle_rad":[-584.52484287768436,427.5951961899392,-584.6298633736767,1885.9464006084936,1885.9463802227049]},"command":[0.071901168310847155,-0.16511518773229114,-0.2503125485781843,0.57440050499965067,0.57440050499965067],"arm":{"servo_position":[-3.1300514379006746e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,4.3198680309969292e-21,2.3716922523121907e-22],"servo_velocity":[0,0,0,0,8.6736173798840355e-19,0],"servo_effort":[-0.04312606378614716,-1.5069847249655821,-0.28971820183962288,-6.1749089118045389e-05,-0.00055477579817717071,0.00026956952221392303]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":684,"step":5472,"t":27.359999999999999,"sim_time":27.359999999998841,"vehicle":{"origin_ned":[1.5066541071061768,1.0182972376052042,3.5116096698027608],"origin_quat_xyzw":[-0.021718062795938325,0.053491922044582071,0.37865790041593023,0.92373434193872395],"cg_ned":[1.4460801500624731,0.9591174184973138,3.2191639889154513],"linear_velocity_ned":[-0.0036198724116349537,-0.0049691579512656523,0.0032636117541040783],"angular_velocity_ned":[0.0011094728023949858,-0.00057457288248410421,-0.0045533079220049753]},"sensors":{"Odom":[1.5066541071061768,1.0182972376052042,3.5116096698027608,-0.0067603304509476344,-0.0014962352171737307,0.002602725816006274,-0.021718062795938336,0.053491922044582099,0.37865790041593039,0.92373434193872395,0.00090922400528187035,-0.0011897447475086934,-0.0044778896897007432],"Pressure":[26948.348348620588],"DVL":[0.024899098954569217,0.0076995305240961931,-0.0085732880700772601,7.3678472777628752,-0.01641937018607869,-0.005593640719783524,0.0072555156282100089,0],"IMU":[0.00038943287797005077,0.11552890414297133,0.7780813368352345,0.026967939128258487,-0.0067050344712567727,0.074222847331283273,1.1144282006240465,0.0062665341201883105,-9.7608791711075895],"FOG":[0.75968151463779376],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.4919232165308003,-17.230570706217204,-26.281779134090336,60.298798802666028,60.298798802666028],"omega_rad_s":[7.6433210413333921,-17.27933647242914,-26.31173770616374,60.269472562865353,60.269551358499932],"thrust_n":[0.74194774892262472,-3.753334435302377,-8.7758997245780517,46.308961083865007,46.273396237080753],"torque_nm":[-0.013911520292299216,0.070375020661919585,0.1645481198358385,-0.86829302032246913,-0.8676261794452641],"angle_rad":[-584.21805852168143,426.90220315826042,-585.68234686343533,1888.3574234675698,1888.3574062564728]},"command":[0.071351649681245716,-0.1641006733925448,-0.25030265841990795,0.574274274311105,0.574274274311105],"arm":{"servo_position":[-3.1300514379006746e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,7.792703114739713e-22],"servo_velocity":[0,0,0,0,0,1.0842021724855044e-19],"servo_effort":[-0.042198553817892795,-1.5054843563084599,-0.28924234750823241,-6.0447403606135213e-05,-0.00055405112830818717,0.00026855456971626077]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":685,"step":5480,"t":27.400000000000002,"sim_time":27.399999999998833,"vehicle":{"origin_ned":[1.5065139748249357,1.0180745507963873,3.511739893019509],"origin_quat_xyzw":[-0.021696882265071684,0.053474922724129528,0.37857563434516339,0.92376954215853047],"cg_ned":[1.4459359974475781,0.95891872739839723,3.219290190085498],"linear_velocity_ned":[-0.0035913427450271801,-0.0049657696458607513,0.00307067519903604],"angular_velocity_ned":[0.0011249771118506315,-0.00056225241381772559,-0.0044660538563517033]},"sensors":{"Odom":[1.5065139748249357,1.0180745507963873,3.511739893019509,-0.0067158501527243321,-0.0015133307768147629,0.0024141408102301191,-0.021696882265071698,0.053474922724129556,0.37857563434516361,0.92376954215853047,0.00091872782523136787,-0.001191815264776241,-0.004388946785352673],"Pressure":[26950.086499349487],"DVL":[-0.0093934700161141006,-0.032206657523202245,-0.0004838992246804486,7.4426641333482344,0.0073311311088900726,0.013383743048125571,0.0063645530502962856,0],"IMU":[0.00040546824878121869,0.11548133594230592,0.77790301562455022,0.10875706458257142,-0.021270961331940792,-0.052556406107125878,1.1184675644437754,-0.01071743302875432,-9.7454341924258543],"FOG":[0.789101537628078],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.4343439419648067,-17.122870674862728,-26.280349916598698,60.286259412706016,60.286259412706016],"omega_rad_s":[7.5822333662358528,-17.172515859251909,-26.310589054513407,60.255882015530297,60.255959468536247],"thrust_n":[0.73005631921033132,-3.7072413785237859,-8.7753922844573342,46.293165220089691,46.257539896526431],"torque_nm":[-0.013688555985193713,0.069510775847320988,0.16453860533357503,-0.86799684787668174,-0.86732887305987072],"angle_rad":[-583.91371885231388,426.21346405186955,-586.73479136377216,1890.7678902394644,1890.7678761501279]},"command":[0.070803275637760066,-0.16307495880821646,-0.25028904682474951,0.57415485154958112,0.57415485154958112],"arm":{"servo_position":[-3.1300514379006746e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-1.3512822486666261e-22,-1.6940658945088655e-23,7.792703114739713e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.04126132502009483,-1.5039868888259695,-0.28876201286617842,-5.9118083032105868e-05,-0.00055327015749390433,0.00026750532337330461]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":686,"step":5488,"t":27.440000000000001,"sim_time":27.439999999998825,"vehicle":{"origin_ned":[1.5063749049150306,1.0178520408928695,3.511862434280244],"origin_quat_xyzw":[-0.021675438920922139,0.053457999452819968,0.37849498959237349,0.92380407040430201],"cg_ned":[1.4457929761325792,0.95872017106518193,3.2194087056206553],"linear_velocity_ned":[-0.0035632499858070485,-0.0049624165488682329,0.002879160408468038],"angular_velocity_ned":[0.001138346143564141,-0.00055043242827079286,-0.0043795714137377364]},"sensors":{"Odom":[1.5063749049150306,1.0178520408928695,3.511862434280244,-0.0066715385013816179,-0.0015296382800283231,0.0022268697051018409,-0.021675438920922156,0.053457999452820003,0.37849498959237377,0.92380407040430201,0.00092646514582918143,-0.0011927394220546551,-0.0043009869301508736],"Pressure":[26952.003172612443],"DVL":[-0.013710554017478626,-0.0024963581141459641,-0.0014980212914892971,7.4058296685798775,-0.0031659996724977884,-0.028125955165364189,0.011736200608236221,0],"IMU":[0.00042226268997784961,0.11543371221278237,0.77772825392797296,-0.049774515521718923,-0.0096742145668152757,0.048438645268709342,1.1330063178533423,-0.027602159344843551,-9.7584619510532349],"FOG":[0.78291891678828929],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.376929660205974,-17.013950038146,-26.278533723930156,60.274442837279629,60.274442837279629],"omega_rad_s":[7.521260814524851,-17.064554686125057,-26.309038509849064,60.243022453926514,60.24309852205122],"thrust_n":[0.71828344408739098,-3.6609334486759764,-8.7746117585957411,46.27844378264836,46.24279195498287],"torque_nm":[-0.013467814576638582,0.068642502162674562,0.16452397047367015,-0.86772082092465663,-0.86705234915592899],"angle_rad":[-583.61182022001321,425.52902367064422,-587.78718074058418,1893.17783004544,1893.1778190232005]},"command":[0.070256472954342605,-0.1620376194109143,-0.25027174975171579,0.57404231273599648,0.57404231273599648],"arm":{"servo_position":[-3.1300514379006746e-23,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,2.3716922523121907e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.040314135071543647,-1.5024920456057624,-0.28827700886083107,-5.7771336454300868e-05,-0.00055243583651289692,0.00026642141408741613]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":687,"step":5496,"t":27.48,"sim_time":27.479999999998817,"vehicle":{"origin_ned":[1.5062368760260365,1.0176297295004697,3.5119773474143292],"origin_quat_xyzw":[-0.021653775734828889,0.053441159180334437,0.37841594947209045,0.92383793258721736],"cg_ned":[1.4456510689472619,0.95852174774257237,3.2195195931927345],"linear_velocity_ned":[-0.0035355804489550684,-0.0049591140592088355,0.002689102712119668],"angular_velocity_ned":[0.0011495464289834529,-0.00053916314742380109,-0.0042938659801856289]},"sensors":{"Odom":[1.5062368760260365,1.0176297295004697,3.5119773474143292,-0.0066274047407380394,-0.0015451624749292007,0.0020409478427991243,-0.021653775734828906,0.053441159180334478,0.37841594947209073,0.92383793258721736,0.00093237740471663333,-0.0011925302160198463,-0.0042140221886907024],"Pressure":[26953.857468099937],"DVL":[-0.048536114880020881,0.051785078972327744,0.019312834408587023,7.3800679236136819,-0.0049252701542799203,0.057787675579625407,0.025931372757652178,0],"IMU":[0.0004397392694334999,0.11538607853287404,0.77755701181999048,-0.021956764879842702,0.10264963859082393,0.024358626137265565,1.128129665384453,-0.0028739389949842616,-9.7466681154820201],"FOG":[0.77494292257521824],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.3197183726939876,-16.903766674897891,-26.276334180679996,60.263357572869083,60.263357572869083],"omega_rad_s":[7.4604544253445866,-16.955406144821303,-26.307089620121005,60.230901174059355,60.230975817260223],"thrust_n":[0.70663817773400761,-3.6143999308842392,-8.7735605446389577,46.264806715848877,46.22916192979207],"torque_nm":[-0.013249465832512648,0.067769998704079501,0.1645042602119805,-0.86746512592216674,-0.86679678618360134],"angle_rad":[-583.3123568418315,424.84892870817248,-588.83949899854872,1895.5872722902359,1895.5872642787897]},"command":[0.069711603549466553,-0.16098825404664657,-0.25025080172076186,0.57393673878922935,0.57393673878922935],"arm":{"servo_position":[-3.1300514379006746e-23,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,2.3716922523121907e-22],"servo_velocity":[0,-8.6736173798840355e-19,0,0,0,0],"servo_effort":[-0.039356625570051852,-1.5009990836952458,-0.28778688008547149,-5.6392373961654894e-05,-0.00055153101024766281,0.00026529682125000522]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":688,"step":5504,"t":27.52,"sim_time":27.519999999998809,"vehicle":{"origin_ned":[1.5060998675032042,1.0174076377069277,3.5120846875436946],"origin_quat_xyzw":[-0.021631935475002952,0.053424408643533802,0.37833849812362563,0.92387113428564971],"cg_ned":[1.4455102595644851,0.9583234552274299,3.2196229117134525],"linear_velocity_ned":[-0.0035083033542664178,-0.0049558693317421397,0.0025005285745835957],"angular_velocity_ned":[0.0011586818752736283,-0.00052836598689988184,-0.0042088019485123414]},"sensors":{"Odom":[1.5060998675032042,1.0174076377069277,3.5120846875436946,-0.0065834404975196447,-0.0015599572705108792,0.0018564040246703028,-0.021631935475002979,0.053424408643533872,0.37833849812362608,0.92387113428564971,0.00093657683397238502,-0.001191205152865849,-0.004127902889343899],"Pressure":[26954.938106079255],"DVL":[0.014985297007486405,-0.01334867048342016,-0.0065862035039438195,7.3824463815511567,-0.032104963914507734,-0.020142959522665649,-0.028548985182916903,0],"IMU":[0.00045782136282022717,0.11533847990101731,0.777389251182803,0.05237264455530357,0.00046946348359748957,-0.032792411138710349,1.1186824100176247,-0.0032717633104576691,-9.7588648945800482],"FOG":[0.77136956323994643],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.2627311946872695,-16.792295017510234,-26.273751851426002,60.25301298707577,60.25301298707577],"omega_rad_s":[7.3998574870736045,-16.845027713050172,-26.304745467234074,60.219526036334763,60.219599216569804],"thrust_n":[0.69512783533515621,-3.5676329272207217,-8.7722405488125936,46.25226506076222,46.21666035463403],"torque_nm":[-0.01303364691253418,0.066893117385388529,0.16447951029023611,-0.86722996988929169,-0.86656238164938815],"angle_rad":[-583.01532105034357,424.17322765942725,-589.89173027905417,1897.9962466825389,1897.9962416240269]},"command":[0.069168868520831137,-0.15992661921438317,-0.25022620810881907,0.57383821892453113,0.57383821892453113],"arm":{"servo_position":[-3.1300514379006746e-23,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,2.3716922523121907e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.038331853517564886,-1.4995086881908288,-0.28729096544020022,-5.4998978945308779e-05,-0.00055056447899514489,0.00026412901233368712]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":689,"step":5512,"t":27.560000000000002,"sim_time":27.559999999998801,"vehicle":{"origin_ned":[1.505963862155463,1.0171857837136895,3.5121845108276921],"origin_quat_xyzw":[-0.021609954375875175,0.05340775640050708,0.37826262573440228,0.92390367863790435],"cg_ned":[1.4453705332557663,0.95812529097292376,3.2197187209970042],"linear_velocity_ned":[-0.0034813784311951992,-0.0049526923818775624,0.0023134590769429884],"angular_velocity_ned":[0.0011660723591289115,-0.00051780919954918213,-0.0041240502534236343]},"sensors":{"Odom":[1.505963862155463,1.0171857837136895,3.5121845108276921,-0.0065396445929189057,-0.0015741451610340731,0.001673264347676056,-0.021609954375875186,0.053407756400507107,0.3782626257344025,0.92390367863790435,0.00093941307105966927,-0.001188823864993517,-0.0040422571054510997],"Pressure":[26956.051359044901],"DVL":[-0.023410352031896689,-0.016771461678245572,0.010071825188825694,7.3249542293449572,-0.0017262709752233134,-0.002225742651746767,0.018963413260093487,0],"IMU":[0.0004764466328167048,0.11529095969996472,0.77722494779628182,-0.087186048501809027,-0.030273099244893815,-0.12026395377136399,1.1263056431713372,-0.0023759451671795176,-9.7488709185340916],"FOG":[0.78075765877418668],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.2056187475890177,-16.679858624824963,-26.27058422054818,60.243420342207131,60.243420342207131],"omega_rad_s":[7.3394160801835362,-16.733467761202391,-26.301959646234696,60.208905917424012,60.208977598837777],"thrust_n":[0.68374137826048054,-3.5206642669975876,-8.7706199124322364,46.240832087719951,46.20529887115088],"torque_nm":[-0.01282015084238401,0.066012455006204784,0.16444912335810444,-0.86701560164474922,-0.86634935383407907],"angle_rad":[-582.7207052799539,423.50196899698221,-590.94385793936613,1900.404783268189,1900.4047811032776]},"command":[0.068624940453228742,-0.15885579642690439,-0.25019604019569697,0.57374686040197265,0.57374686040197265],"arm":{"servo_position":[-3.1300514379006746e-23,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,2.3716922523121907e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.037249475603955487,-1.4980309894158905,-0.28679130065370267,-5.3566479602272124e-05,-0.00054952606161482224,0.00026291766459899746]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":690,"step":5520,"t":27.600000000000001,"sim_time":27.599999999998793,"vehicle":{"origin_ned":[1.505828843869528,1.0169641842029267,3.5122768745526995],"origin_quat_xyzw":[-0.021587866432371053,0.053391210418052712,0.37818832442368611,0.92393556806879018],"cg_ned":[1.4452318763727849,0.95792725206845686,3.2198070817439963],"linear_velocity_ned":[-0.0034547874480120033,-0.0049495930132798013,0.0021279174494073148],"angular_velocity_ned":[0.0011717273815563278,-0.00050758467604288329,-0.0040396385713522259]},"sensors":{"Odom":[1.505828843869528,1.0169641842029267,3.5122768745526995,-0.0064960355082697638,-0.0015877320517175097,0.0014915560298222751,-0.021587866432371056,0.053391210418052719,0.37818832442368616,0.92393556806879018,0.00094083162691591766,-0.0011854590231651766,-0.0039571188763278349],"Pressure":[26957.355105293816],"DVL":[0.015958341342280837,0.015788131973332106,0.0070505664790949775,7.3375357184103969,-0.02164653197510169,0.0081589407241240038,-0.0062602752073634606,0],"IMU":[0.00049555668586947663,0.11524355849137428,0.7770640817973965,-0.013860765528589133,0.020152903221823341,0.096382220535565138,1.1328979412478448,-0.012343799388981308,-9.7442364317420402],"FOG":[0.76558356278329265],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.1482778431390868,-16.56652102086068,-26.266770263416316,60.234590197198479,60.234590197198479],"omega_rad_s":[7.2790223177645599,-16.620816423501775,-26.298659405784257,60.199050325246745,60.199120474952444],"thrust_n":[0.67245800855248472,-3.4735420841704632,-8.7686501747335459,46.230522314353983,46.19508980517454],"torque_nm":[-0.012608587660359088,0.065128914078196196,0.16441219077625396,-0.86682229339413741,-0.86615793384702267],"angle_rad":[-582.42850588310898,422.83519779037465,-591.99586257839235,1902.8129124641059,1902.8129131320914]},"command":[0.068078836601324633,-0.15777639067486363,-0.2501597167944411,0.57366276378284264,0.57366276378284264],"arm":{"servo_position":[-3.1300514379006746e-23,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,-3.0493186101153316e-22],"servo_velocity":[0,0,1.7347234759768071e-18,0,0,0],"servo_effort":[-0.036159781604526632,-1.4965677707566909,-0.28628845353745047,-5.2102705467637172e-05,-0.00054843486500189031,0.00024535485628670808]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":691,"step":5528,"t":27.640000000000001,"sim_time":27.639999999998786,"vehicle":{"origin_ned":[1.505694796153866,1.0167428551793576,3.5123618371761864],"origin_quat_xyzw":[-0.021565706081908796,0.05337477690761093,0.37811558571725257,0.92396680532849795],"cg_ned":[1.4450942758766709,0.95772933513375946,3.2198880555731542],"linear_velocity_ned":[-0.00342851613961059,-0.0049465832727846907,0.00194392549649021],"angular_velocity_ned":[0.00117566407186189,-0.00049778628740255017,-0.0039555987667618782]},"sensors":{"Odom":[1.505694796153866,1.0167428551793576,3.5123618371761864,-0.0064526379140179323,-0.0016007241679934091,0.0013113047276921449,-0.021565706081908803,0.053374776907610937,0.37811558571725262,0.92396680532849795,0.00094078255541185727,-0.0011811900810981375,-0.0038725259169112218],"Pressure":[26956.701341385662],"DVL":[0.0040584689595215429,0.033582318672088565,0.011664889613436107,7.3634297062457374,-0.016230810253359582,-0.028983872206191644,0.011244755717893292,0],"IMU":[0.00051509088157291867,0.11519631389636338,0.77690663185235997,0.020328129823969084,0.0014647903037830563,-0.13676250578594723,1.1397149941564921,0.006345982754699578,-9.7658165967853545],"FOG":[0.7934230038906942],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.0907183516182526,-16.452222572324217,-26.262312544616471,60.226532499014901,60.226532499014901],"omega_rad_s":[7.2186060842046329,-16.507115719289448,-26.294796510470075,60.189968937044654,60.190037525714715],"thrust_n":[0.66126453604390312,-3.4262933465371845,-8.7662993599848082,46.22135064435961,46.18604574309402],"torque_nm":[-0.012398710050823181,0.064243000247572193,0.16436811299971521,-0.86665032458174285,-0.86598835768301285],"angle_rad":[-582.1387226292635,422.17295663331402,-593.0477224688459,1905.2206650718838,1905.2206685108254]},"command":[0.067530650967792885,-0.1566878340221354,-0.25011726232968068,0.5735860238001419,0.5735860238001419],"arm":{"servo_position":[-3.1300514379006746e-23,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,-3.0493186101153316e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.035063394757919204,-1.4951239367598803,-0.28578334588255927,-5.0610123271272481e-05,-0.00054724779239442259,0.00024416093447636526]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":692,"step":5536,"t":27.68,"sim_time":27.679999999998778,"vehicle":{"origin_ned":[1.5055617018733809,1.0165218116670593,3.5124394582668588],"origin_quat_xyzw":[-0.02154350783822568,0.053358459708706694,0.37804440057804817,0.92399739352398758],"cg_ned":[1.4449577193272878,0.95753153634977273,3.2199617048414733],"linear_velocity_ned":[-0.0034025490351156499,-0.0049436733030145379,0.0017614995368491237],"angular_velocity_ned":[0.0011779351766784611,-0.00048853478654887518,-0.0038719601806643466]},"sensors":{"Odom":[1.5055617018733809,1.0165218116670593,3.5124394582668588,-0.0064094868741781672,-0.0016131288907914752,0.0011325331535891531,-0.021543507838225687,0.053358459708706708,0.37804440057804833,0.92399739352398758,0.00093922216974008177,-0.0011761406478575844,-0.0037885126436506766],"Pressure":[26960.227421057083],"DVL":[0.021445832204259652,-0.029699886559921864,-0.01267756688011251,7.3984288529654307,0.010522798816114174,-0.0069831046262580944,0.010121842215197517,0],"IMU":[0.0005349865484483592,0.11514925917481056,0.77675257520200081,0.014589521055400116,-0.045751338208032753,0.18363765685859473,1.1279535418440878,-0.0032083111459875907,-9.7250315245523584],"FOG":[0.7982425257277157],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[7.0329484588198721,-16.336890808774214,-26.257206158621479,60.219257674552871,60.219257674552871],"omega_rad_s":[7.1581224572467494,-16.39237078267411,-26.290337672803879,60.181671637496052,60.181738640250238],"thrust_n":[0.65015280139173359,-3.3789293572188832,-8.7635455933893347,46.213333033682346,46.178179029733641],"torque_nm":[-0.012190365026095006,0.06335492544785408,0.16431647987605003,-0.86649999438154413,-0.86584085680750578],"angle_rad":[-581.85135749108326,421.51528730031146,-594.09941432198173,1907.6280722845443,1907.6280784314242]},"command":[0.066980461512570214,-0.15558943627404015,-0.25006863008210933,0.57351673975764639,0.57351673975764639],"arm":{"servo_position":[-3.1300514379006746e-23,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,2.3716922523121907e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.033960472149703338,-1.4937060213376634,-0.28527728093810872,-4.9103108538944143e-05,-0.00054596902803566005,0.00025899458225095136]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":693,"step":5544,"t":27.719999999999999,"sim_time":27.71999999999877,"vehicle":{"origin_ned":[1.5054295435013096,1.0163010678800311,3.5125097983679812],"origin_quat_xyzw":[-0.021521306309142015,0.053342260703176367,0.37797475935321007,0.92402733611604004],"cg_ned":[1.4448221949098092,0.95733385153274808,3.2200280925739637],"linear_velocity_ned":[-0.0033768703177587752,-0.0049408714804828439,0.0015806567159405815],"angular_velocity_ned":[0.0011785542131597022,-0.00047990144170547864,-0.0037887577006717418]},"sensors":{"Odom":[1.5054295435013096,1.0163010678800311,3.5125097983679812,-0.0063665971794003608,-0.0016249549820621951,0.00095526186787645885,-0.021521306309142028,0.053342260703176402,0.37797475935321029,0.92402733611604004,0.00093611413843170148,-0.0011703715577718464,-0.0037051182272761409],"Pressure":[26958.736248687946],"DVL":[0.0079891625202077651,0.017809733370595757,0.0096380749584956404,7.4055589859660476,0.0075229944973513032,-0.003166180887888663,-0.0012645938561434312,0],"IMU":[0.00055517926305120771,0.11510242400731518,0.77660188758223581,-0.049054093771023731,0.02575736749966499,-0.155442934866444,1.1383466386254264,-0.0091850404887251023,-9.7264534491047385],"FOG":[0.78763473555890207],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[6.9749720268135214,-16.220454537067262,-26.251451748726328,60.212776555383812,60.212776555383812],"omega_rad_s":[7.0975422710740066,-16.276560247102811,-26.285259498080542,60.174168609349003,60.174234006351845],"thrust_n":[0.63911777745661924,-3.331450489651568,-8.7603736401308048,46.206485260969551,46.171503370570484],"torque_nm":[-0.011983458327311612,0.062464696680966908,0.16425700575245256,-0.86637159864317925,-0.86571568819819678],"angle_rad":[-581.56641385925377,420.86223200118872,-595.15091373704661,1910.0351656972571,1910.0351744881766]},"command":[0.066428305017271636,-0.15448051940064059,-0.250013826178346,0.57345501481317918,0.57345501481317918],"arm":{"servo_position":[-3.1300514379006746e-23,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,2.3716922523121907e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.032852666522845443,-1.4923025332945294,-0.28476758900154869,-4.7560617198180244e-05,-0.00054462327218087348,0.00025758460689664984]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":694,"step":5552,"t":27.760000000000002,"sim_time":27.759999999998762,"vehicle":{"origin_ned":[1.5052983035380041,1.0160806375410372,3.512572918853218],"origin_quat_xyzw":[-0.021499136350693955,0.053326180580477077,0.37790665174181964,0.92405663688442796],"cg_ned":[1.4446876914708739,0.95713627620191843,3.2200872824496702],"linear_velocity_ned":[-0.003351462836733576,-0.0049381844457730964,0.0014014125496412499],"angular_velocity_ned":[0.0011775306168242525,-0.00047194201445794113,-0.003706024624969495]},"sensors":{"Odom":[1.5052983035380041,1.0160806375410372,3.512572918853218,-0.0063239770608013411,-0.0016362130506093091,0.00077950937040777266,-0.021499136350693965,0.053326180580477098,0.37790665174181981,0.92405663688442796,0.00093142987796936833,-0.001163929732083707,-0.0036223793424553057],"Pressure":[26959.518041892406],"DVL":[-0.016021970243156644,0.036428974090218454,0.0029150076689696105,7.2786277923382539,-0.016271182511146242,0.0049060375026762186,0.067842486453535189,0],"IMU":[0.00057560314569317611,0.11505583603170604,0.77645454320828577,-0.078277591471671987,-0.010900205827999748,-0.1428251265973573,1.1232979729740458,-0.0083039060119523452,-9.7465849377047231],"FOG":[0.76823999558743339],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[6.9167877737592196,-16.102854001799813,-26.245060108857956,60.207100215346536,60.207100215346536],"omega_rad_s":[7.0368454197796861,-16.15964888897205,-26.279549544296081,60.167470324396945,60.167534100327764],"thrust_n":[0.6281562471199571,-3.2838517884804341,-8.7567756299917168,46.200823334262225,46.166033348441594],"torque_nm":[-0.011777929633499197,0.061572221034008147,0.16418954306234468,-0.86626543751741669,-0.86561312528328005],"angle_rad":[-581.28389606988287,420.21383413777971,-596.20219563291096,1912.4419773191162,1912.4419886894862]},"command":[0.065874169273897332,-0.15336051430285536,-0.24995295341769483,0.57340095443187178,0.57340095443187178],"arm":{"servo_position":[-3.1300514379006746e-23,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,7.792703114739713e-22],"servo_velocity":[0,0,0,0,0,1.0842021724855044e-19],"servo_effort":[-0.031740117783597387,-1.4909133627788909,-0.2842540538628836,-4.5999624667304812e-05,-0.00054319467194316213,0.00025611730757010116]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":695,"step":5560,"t":27.800000000000001,"sim_time":27.799999999998754,"vehicle":{"origin_ned":[1.5051679642245976,1.0158605335000612,3.5126288818836859],"origin_quat_xyzw":[-0.0214770325601467,0.053310217939164815,0.37784006610240184,0.92408530027450475],"cg_ned":[1.4445541985341339,0.95693880574765711,3.2201393385856218],"linear_velocity_ned":[-0.003326310429769096,-0.0049356115182709265,0.0012237726295260152],"angular_velocity_ned":[0.0011749637690799558,-0.00046480480641873222,-0.0036238869668689744]},"sensors":{"Odom":[1.5051679642245976,1.0158605335000612,3.5126288818836859,-0.0062816679641989406,-0.0016469153950277615,0.00060529133648203797,-0.02147703256014671,0.053310217939164843,0.37784006610240201,0.92408530027450475,0.00092515080159789615,-0.0011569912007040222,-0.0035404247585790597],"Pressure":[26959.929613105945],"DVL":[-0.028389299692474175,-0.0019626967997217817,0.030397956742760416,7.4288986998319499,0.0065003423785908246,-0.0030194415156999405,0.00489958231374003,0],"IMU":[0.00059619103209676365,0.11500951879366339,0.77631051323716693,0.023965863744600309,-0.03758079690137734,-0.031464732665452681,1.1196217327329185,-0.0082911322128547196,-9.7230567599843187],"FOG":[0.76882036508244156],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[6.8583883281888083,-15.984004195698445,-26.238049793053328,60.202240076226033,60.202240076226033],"omega_rad_s":[6.9760158675109754,-16.041588269573943,-26.273204721544964,60.161587555472678,60.161649699546885],"thrust_n":[0.61726585324560002,-3.2361233941560181,-8.7527503611820823,46.196365319175733,46.161782502777505],"torque_nm":[-0.011573734748355002,0.060677313640425348,0.1641140692721641,-0.86618184973454504,-0.86553342192707838],"angle_rad":[-581.00380916091751,419.57013877987657,-597.25323463879533,1914.8485395848286,1914.8485534695455]},"command":[0.065317984077988653,-0.15222861138760424,-0.24988618850526981,0.57335466739262886,0.57335466739262886],"arm":{"servo_position":[-3.1300514379006746e-23,3.2526065174565154e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,7.792703114739713e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.030664164374534141,-1.4895786725944022,-0.28374509138581561,-4.4417215124230941e-05,-0.00054168195351724847,0.00025459450747686519]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":696,"step":5568,"t":27.84,"sim_time":27.839999999998746,"vehicle":{"origin_ned":[1.5050385074399659,1.0156407672882821,3.512677750351378],"origin_quat_xyzw":[-0.021455028177780135,0.053294367327318987,0.37777498804982396,0.9241133321086904],"cg_ned":[1.4444217068680638,0.95674143616901175,3.2201843251033124],"linear_velocity_ned":[-0.0033013479945277276,-0.0049331118711182917,0.0010477338056428937],"angular_velocity_ned":[0.0011709747488684232,-0.00045862486933615697,-0.0035424704977802955]},"sensors":{"Odom":[1.5050385074399659,1.0156407672882821,3.512677750351378,-0.0062396493917614773,-0.0016570871636173894,0.00043262232602091634,-0.021455028177780146,0.053294367327319007,0.37777498804982412,0.9241133321086904,0.00091728295476441873,-0.0011497377492438953,-0.0034593801395289146],"Pressure":[26961.027396308742],"DVL":[0.04288198534201941,0.00063738384491528969,0.016516417599267998,7.3591813296956161,-0.027809760529289771,-0.02840152493410256,-0.0027381837425300925,0],"IMU":[0.00061687484685292904,0.11496348728232721,0.7761697626466173,-0.029532683035232373,0.0068770935561506506,-0.046671428318394381,1.1292261098630076,0.011232023340287466,-9.7602778883915615],"FOG":[0.77989429359205542],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[6.7997539748728508,-15.863660076965996,-26.230476243597181,60.198208226438325,60.198208226438325],"omega_rad_s":[6.9150371321358852,-15.922273057801265,-26.266239444348169,60.156531486396503,60.156591994878461],"thrust_n":[0.60644425881708275,-3.1882334985337017,-8.7483090701275383,46.193130672785308,46.158764359995395],"torque_nm":[-0.011370829852820303,0.05977937809750692,0.16403079506489135,-0.8661212001147246,-0.86547683174991374],"angle_rad":[-580.72615880372382,418.93119414749958,-598.30400564425338,1917.2548853691399,1917.2549017028196]},"command":[0.064759561665455725,-0.15108247692348567,-0.24981405946283028,0.57331626882322217,0.57331626882322217],"arm":{"servo_position":[-3.1300514379006746e-23,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,7.792703114739713e-22],"servo_velocity":[0,0,0,0,0,1.0842021724855044e-19],"servo_effort":[-0.029602309548531359,-1.4882733321356107,-0.28323214667750446,-4.2810866931776439e-05,-0.00054007433244159908,0.00025300494465566021]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":697,"step":5576,"t":27.879999999999999,"sim_time":27.879999999998738,"vehicle":{"origin_ned":[1.504909921976282,1.0154213551434565,3.5127195870680787],"origin_quat_xyzw":[-0.021433155412473964,0.053278621583593401,0.37771140320790997,0.9241407383174538],"cg_ned":[1.4442902148472694,0.95654416911286821,3.2202223057064749],"linear_velocity_ned":[-0.0032763171722207528,-0.0049304859570051367,0.00087328391151477271],"angular_velocity_ned":[0.0011656347224148298,-0.00045342819635598,-0.0034616861640982509]},"sensors":{"Odom":[1.504909921976282,1.0154213551434565,3.5127195870680787,-0.0061976183664173724,-0.0016667692767393476,0.00026153083306415775,-0.021433155412473967,0.053278621583593408,0.37771140320791002,0.9241407383174538,0.00090784831685920885,-0.0011422382340996878,-0.0033791531164177415],"Pressure":[26964.538321097516],"DVL":[-0.020072188986882691,-0.072801270354047307,-0.0096635458020091648,7.2833793539806608,-0.0038785223290466204,-0.024828166472207709,-0.012359031257645607,0],"IMU":[0.00063758713220507469,0.11491775251762784,0.77603225639056672,-0.012065701212702349,-0.045475617773669014,-0.016803194236663786,1.1316700669848803,-0.014884203698751536,-9.753062452477387],"FOG":[0.78309423870507822],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[6.7407807986135557,-15.742001588075246,-26.222480862760165,60.195014348181765,60.195014348181765],"omega_rad_s":[6.8538701978692407,-15.801647360192488,-26.258701945069163,60.152313121746204,60.152371997939042],"thrust_n":[0.59568526021193646,-3.1401734803036181,-8.7434877055529086,46.191136517807514,46.156993856317932],"torque_nm":[-0.011169098628973809,0.058878252755692834,0.16394039447911707,-0.86608380970889087,-0.86544363480596131],"angle_rad":[-580.45095176160396,418.2970521091371,-599.3544847912342,1919.6610479940127,1919.6610667112855]},"command":[0.064197912367748147,-0.14992382464833567,-0.24973791297866824,0.57328585093506446,0.57328585093506446],"arm":{"servo_position":[2.5808035111652679e-24,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,2.3716922523121907e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.0284974021529634,-1.4869906745781902,-0.28270848561064926,-4.1198020302545805e-05,-0.00053835048454443869,0.00025132330241708239]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":698,"step":5584,"t":27.920000000000002,"sim_time":27.91999999999873,"vehicle":{"origin_ned":[1.5047822050205379,1.0152023206670107,3.5127544550079479],"origin_quat_xyzw":[-0.021411445368194636,0.053262972638747574,0.37764929905387484,0.92416752414107572],"cg_ned":[1.4441597296706841,0.95634701420048707,3.220253344045263],"linear_velocity_ned":[-0.00325095281417041,-0.0049274439790389975,0.0007004155304512165],"angular_velocity_ned":[0.0011590126165416303,-0.000449229950203391,-0.0033814859234990568]},"sensors":{"Odom":[1.5047822050205379,1.0152023206670107,3.5127544550079479,-0.0061552020384746334,-0.0016759479592736864,9.2057319520126601e-05,-0.021411445368194639,0.053262972638747588,0.3776492990538749,0.92416752414107572,0.00089687955882178827,-0.0011345522101249726,-0.0032996913770461725],"Pressure":[26964.727314895124],"DVL":[-0.0050615578576081724,0.033382798711206356,0.0076958394731374358,7.3219979638473864,0.032083110735641317,-0.0055190219851850505,-0.001569394554393808,0],"IMU":[0.00065826202803496514,0.11487232298095829,0.77589796348097384,-0.041262522863652333,-0.073784001598195093,0.01317241687242653,1.1387674350948123,-0.012834324840613483,-9.7585758783438319],"FOG":[0.7969357087435468],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[6.6814085102216803,-15.619345239385172,-26.214128089224676,60.192661951781055,60.192661951781055],"omega_rad_s":[6.7924603466147762,-15.679789446644785,-26.250659307403026,60.148941370330263,60.148998623421313],"thrust_n":[0.5849803391768672,-3.0919890993947798,-8.7383353131386166,46.190396274672366,46.156482611496322],"torque_nm":[-0.01096838135956626,0.057974795613652125,0.16384378712134909,-0.86606993015010714,-0.86543404896555587],"angle_rad":[-580.1781968322166,417.66776346570452,-600.40465076549253,1922.0670611774804,1922.0670822132436]},"command":[0.063632462002111242,-0.14875566894652545,-0.24965836275452072,0.57326344715981958,0.57326344715981958],"arm":{"servo_position":[2.5808035111652679e-24,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,7.792703114739713e-22],"servo_velocity":[0,-8.6736173798840355e-19,1.7347234759768071e-18,0,0,1.0842021724855044e-19],"servo_effort":[-0.02737457752578655,-1.4857241725507722,-0.28216312038197577,-3.9577116421724682e-05,-0.00053647510141799967,0.00024952038787306487]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":699,"step":5592,"t":27.960000000000001,"sim_time":27.959999999998722,"vehicle":{"origin_ned":[1.5046553738419355,1.0149837103700947,3.5127824157219028],"origin_quat_xyzw":[-0.021389927863564702,0.053247411135882307,0.37758866103297345,0.9241936957438327],"cg_ned":[1.444030278819121,0.95615000516366522,3.2202775020599703],"linear_velocity_ned":[-0.0032247018519433843,-0.0049233157932290078,0.00052908698763206186],"angular_velocity_ned":[0.0011511844623354065,-0.00044607415731319472,-0.0033020781587090489]},"sensors":{"Odom":[1.5046553738419355,1.0149837103700947,3.5127824157219028,-0.0061115626359266413,-0.001684556534840417,-7.573652830655407e-05,-0.021389927863564709,0.053247411135882321,0.37758866103297356,0.9241936957438327,0.00088442372756879673,-0.0011267649524585085,-0.0032211990622116136],"Pressure":[26964.371457118894],"DVL":[0.0046083760100279671,0.0058214069519725541,-0.019511120832745015,7.3947986027758033,-0.0095492586758115141,-0.015640560106894453,0.0015186490936303792,0],"IMU":[0.00067883483324821599,0.11482720377836775,0.77576684853355671,-0.02626103518242854,-0.046880244682524899,0.032204344392055308,1.1223210967307835,-0.020358991676114692,-9.7808294738720907],"FOG":[0.78290118439192513],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[6.6218841830018871,-15.496505107994984,-26.206027764523657,60.191149418258405,60.191149418258405],"omega_rad_s":[6.7308264911330005,-15.556970276405632,-26.242303442255796,60.146422043633017,60.14647768814266],"thrust_n":[0.5743341475506607,-3.0438043073207681,-8.7329911088654715,46.190918522977668,46.157236605619929],"torque_nm":[-0.010768765266574887,0.057071330762264401,0.16374358329122757,-0.86607972230583152,-0.86544818635537391],"angle_rad":[-579.90790361948177,417.04337208595297,-601.45448709695336,1924.47295892681,1924.4729822164488]},"command":[0.063065563647637018,-0.14758576293328557,-0.24958121680498721,0.57324904207865146,0.57324904207865146],"arm":{"servo_position":[2.5808035111652679e-24,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,2.3716922523121907e-22],"servo_velocity":[-6.7762635780344027e-21,0,0,0,0,-1.0842021724855044e-19],"servo_effort":[-0.026289422007203852,-1.4844769274013216,-0.28159600467748452,-3.7940780028843735e-05,-0.00053443598663069998,0.00024757626810351319]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":700,"step":5600,"t":28,"sim_time":27.999999999998714,"vehicle":{"origin_ned":[1.504529459807326,1.0147655874659793,3.5128035311477803],"origin_quat_xyzw":[-0.021368631684547411,0.05323192778978602,0.37752947210177579,0.92421926031557444],"cg_ned":[1.4439019033452678,0.95595319324523198,3.2202948420209778],"linear_velocity_ned":[-0.0031972507094844668,-0.0049176580444877513,0.00035931699070829203],"angular_velocity_ned":[0.0011421799992046993,-0.00044390281250185283,-0.0032235313656748597]},"sensors":{"Odom":[1.504529459807326,1.0147655874659793,3.5128035311477803,-0.0060661652684292711,-0.0016925215161860034,-0.00024177229330430924,-0.021368631684547418,0.05323192778978604,0.3775294721017759,0.92421926031557444,0.00087054999738604157,-0.001118856372701771,-0.0031437370186349453],"Pressure":[26964.721969798979],"DVL":[-0.022117955877084199,0.0090403054061529153,-0.012168800487326863,7.4173799122378554,-0.00056665113521316699,0.011500127054277496,0.032134814098387872,0],"IMU":[0.00069924251732023958,0.11478239935497184,0.77563887087385408,-0.028993496378564403,0.075219861904403884,-0.036926540746871461,1.1411834418463178,-0.0011825606643099049,-9.7652662611055536],"FOG":[0.77591460452735461],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[6.56234939722472,-15.373848681136945,-26.198557505390866,60.190466986250229,60.190466986250229],"omega_rad_s":[6.6690459165700382,-15.433554370771098,-26.233935356266954,60.144756155537017,60.144810210141252],"thrust_n":[0.56376112217643426,-2.9957738063043902,-8.7276623423886548,46.192702628274901,46.159255569409964],"torque_nm":[-0.010570521040808144,0.056170758868207327,0.16364366891978727,-0.86611317428015455,-0.86548604192643697],"angle_rad":[-579.64007936053554,416.42390802623498,-602.50398815808023,1926.8787753749568,1926.8788008545382]},"command":[0.062498565687854474,-0.14641760648701851,-0.24951007147991303,0.57324254272619268,0.57324254272619268],"arm":{"servo_position":[-3.1300514379006746e-23,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,2.3716922523121907e-22],"servo_velocity":[0,0,0,2.7105054312137611e-20,0,-1.0842021724855044e-19],"servo_effort":[-0.025173084427073847,-1.4832347177002805,-0.28099808778033092,-3.6319211150300961e-05,-0.00053220734175803152,0.00024546201324387795]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":701,"step":5608,"t":28.039999999999999,"sim_time":28.039999999998706,"vehicle":{"origin_ned":[1.5044045123020047,1.014548039538691,3.5128178635193077],"origin_quat_xyzw":[-0.021347584390139739,0.053216514419576991,0.37747171437164601,0.92424422534472306],"cg_ned":[1.4437746613578226,0.95575665457362624,3.2203054265878279],"linear_velocity_ned":[-0.0031682313167564744,-0.0049099218180599898,0.00019113878870296225],"angular_velocity_ned":[0.0011320157599366985,-0.0004426243246463535,-0.0031458811921396121]},"sensors":{"Odom":[1.5044045123020047,1.014548039538691,3.5128178635193077,-0.0060183546641859936,-0.001699733232891584,-0.00040594601412740207,-0.021347584390139743,0.053216514419577005,0.37747171437164612,0.92424422534472306,0.00085533775721002305,-0.0011107731015270697,-0.003067331883997282],"Pressure":[26963.596750499863],"DVL":[0.031704702685409245,0.015798592234084086,0.03986540515703741,7.318310429272171,0.014535610464780874,-0.01531706843636866,0.033868598526467605,0],"IMU":[0.00071942507484974868,0.11473791526344179,0.77551398821400164,-0.11744566383888376,0.073760170437969161,-0.10158732150730994,1.1343278024476355,-0.0139013609539686,-9.7588533697668449],"FOG":[0.77261261425884653],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[6.5033368788688311,-15.252350976757722,-26.192331309662393,60.190597281702331,60.190597281702331],"omega_rad_s":[6.6073137889869482,-15.31005781996901,-26.225934816358592,60.143939060579669,60.14399154619835],"thrust_n":[0.55329519304782349,-2.9481078673691048,-8.7226106254995326,46.195738214547681,46.162530449174049],"torque_nm":[-0.010374284869646689,0.055277022513170723,0.16354894922811625,-0.86617009152276914,-0.8655474459220136],"angle_rad":[-579.3747259012016,415.80938398028445,-603.55316180336524,1929.2845445703911,1929.2845721767858]},"command":[0.061936541703512676,-0.14526048549293069,-0.24945077437773708,0.5732437836352603,0.5732437836352603],"arm":{"servo_position":[2.5808035111652679e-24,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,2.3716922523121907e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.024036681838724695,-1.4819987406206749,-0.28038044768835441,-3.469063861650318e-05,-0.00052979742947356309,0.00024318846803529908]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":702,"step":5616,"t":28.080000000000002,"sim_time":28.079999999998698,"vehicle":{"origin_ned":[1.5042805925976834,1.0143311701624167,3.5128254773376586],"origin_quat_xyzw":[-0.021326812763186841,0.053201164950571027,0.37741536958289312,0.92426859835649189],"cg_ned":[1.4436486214970008,0.95556048126381476,3.2203093209666869],"linear_velocity_ned":[-0.0031373085069888464,-0.0048996039784866647,2.4608614737154107e-05],"angular_velocity_ned":[0.0011206926650128303,-0.00044212522653400838,-0.003069154825120512]},"sensors":{"Odom":[1.5042805925976834,1.0143311701624167,3.5128254773376586,-0.0059675254082415998,-0.0017060918386381896,-0.00056813873129836967,-0.021326812763186855,0.053201164950571062,0.37741536958289335,0.92426859835649189,0.00083886954504752611,-0.0011024351751873277,-0.0029920014500018676],"Pressure":[26964.804767981008],"DVL":[0.0081804599887132842,-0.023873529658837767,0.0052415988934093188,7.3610780884714115,-0.00043754773545441042,-0.041860132461510852,-0.00024762123182783086,0],"IMU":[0.00073932550995473956,0.11469376036504904,0.7753921577298809,0.024574852602613974,0.029176241856276618,-0.012525527964173395,1.1271145088587715,-0.0047658920519466855,-9.7756537567048181],"FOG":[0.76873339982579458],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[6.4450937925908338,-15.132483743499336,-26.187618787552672,60.191514941344536,60.191514941344536],"omega_rad_s":[6.5458737113357177,-15.187036376597677,-26.218681694774009,60.143959311182812,60.144010248633514],"thrust_n":[0.54297701431310696,-2.9010242005935249,-8.7180951217613458,46.200003497830537,46.167041988368631],"torque_nm":[-0.010180819018370755,0.054394203761128586,0.16346428353302528,-0.86625006558432271,-0.86563203728191185],"angle_rad":[-579.11183575771361,415.19979043749959,-604.60203149990036,1931.6903002199806,1931.6903298909008]},"command":[0.061381845643722226,-0.14411889279523177,-0.24940589321478734,0.57325252325090037,0.57325252325090037],"arm":{"servo_position":[2.5808035111652679e-24,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,7.792703114739713e-22],"servo_velocity":[0,0,0,0,0,1.0842021724855044e-19],"servo_effort":[-0.022862655914906882,-1.4807651402715842,-0.27972689919099314,-3.3094598544633296e-05,-0.00052716655608181593,0.00024070796119839944]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":703,"step":5624,"t":28.120000000000001,"sim_time":28.11999999999869,"vehicle":{"origin_ned":[1.5041577769331713,1.0141151034715654,3.5128264397407132],"origin_quat_xyzw":[-0.021306342757534548,0.053185875629025478,0.37736041911208446,0.92429238689898552],"cg_ned":[1.4435238658875535,0.95536478596851182,3.2203065933100485],"linear_velocity_ned":[-0.0031042882161122728,-0.0048863820189974129,-0.00014015820294913743],"angular_velocity_ned":[0.0011081738553851252,-0.00044226266452093412,-0.0029933514428811042]},"sensors":{"Odom":[1.5041577769331713,1.0141151034715654,3.5128264397407132,-0.0059132903145971841,-0.0017115231893959325,-0.00072820126867507746,-0.021306342757534576,0.053185875629025547,0.3773604191120849,0.92429238689898552,0.00082121829292550012,-0.0010937151410887389,-0.0029177364727309505],"Pressure":[26966.254260732909],"DVL":[-0.0092915088232186915,0.02273273984229976,-0.019835746570632664,7.3614423882430247,0.0032342709142995645,0.027140499587040793,0.021755223194552104,0],"IMU":[0.00075889009821725098,0.11464994718966345,0.77527333610004534,-0.00037174589588749606,-0.0081839040828097422,-0.090543511264506493,1.1220364340178088,-0.022470430126563246,-9.7857349240109297],"FOG":[0.78680044429000529],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[6.3881443700722897,-15.015198278035699,-26.184976087095492,60.193184835153239,60.193184835153239],"omega_rad_s":[6.4850516970240992,-15.065160570577174,-26.212605013393421,60.144798076671108,60.14484748499369],"thrust_n":[0.53285928551939621,-2.8547768829436144,-8.7144066839148131,46.205464198244819,46.172759339382893],"torque_nm":[-0.0099911116034886813,0.053527066555192772,0.16339512532340275,-0.86635245371709035,-0.86573923761342919],"angle_rad":[-578.85138996293767,414.59509330595176,-605.65063685711505,1934.0960754101116,1934.0961070840685]},"command":[0.060839470191164667,-0.14300188836224476,-0.24938072463900468,0.57326842700145941,0.57326842700145941],"arm":{"servo_position":[2.5808035111652679e-24,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,-3.3881317890157044e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.021661102183800181,-1.4795374949564937,-0.27905797414916705,-3.1466118404659449e-05,-0.00052436749028206286,0.00022617537947264277]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":704,"step":5632,"t":28.16,"sim_time":28.159999999998682,"vehicle":{"origin_ned":[1.5040361452669297,1.013899971910982,3.5128208231562059],"origin_quat_xyzw":[-0.021286201300358871,0.053170647041473167,0.37730684545397436,0.92431559778084571],"cg_ned":[1.4434004783559922,0.95516968803769342,3.2202973178004042],"linear_velocity_ned":[-0.003069172367803177,-0.0048701093925829298,-0.00030299839486553877],"angular_velocity_ned":[0.0010942753293184272,-0.00044282375992469745,-0.002918366988896181]},"sensors":{"Odom":[1.5040361452669297,1.013899971910982,3.5128208231562059,-0.0058554830916418147,-0.001715916358423898,-0.00088597473670867571,-0.021286201300358885,0.053170647041473201,0.37730684545397464,0.92431559778084571,0.0008023893617466857,-0.0010843324392174633,-0.0028444317066866312],"Pressure":[26966.273868132237],"DVL":[-0.020545866745960442,0.0142823625398,0.016539100741869889,7.3162426276322172,-0.00051012942567741856,0.011994836685573069,0.04440746542861098,0],"IMU":[0.00077806675749142039,0.11460649704605591,0.77515748273963936,0.017001878359729154,-0.03762807003480468,0.044398717143425047,1.1342270340373335,0.026218560725271511,-9.7493644405298756],"FOG":[0.7791837543340947],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[6.3328401428073722,-14.900882713033809,-26.184526988927651,60.195563535393852,60.195563535393852],"omega_rad_s":[6.4251871167832642,-14.945046915533004,-26.208064861845354,60.146428159080571,60.146476052462305],"thrust_n":[0.52299483099314992,-2.8095889027666998,-8.7117853406825212,46.212070749029351,46.17964087192432],"torque_nm":[-0.0098061530811215606,0.052679791926875628,0.16334597513779728,-0.86647632654430051,-0.86586826634858116],"angle_rad":[-578.59335619506737,413.99523253998495,-606.6990333805478,1936.5019022804033,1936.5019358965749]},"command":[0.06031276326483212,-0.14191316869556009,-0.24937644751359667,0.57329108128946527,0.57329108128946527],"arm":{"servo_position":[2.5808035111652679e-24,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,-3.3881317890157044e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.020387587640051233,-1.4782923808912511,-0.27836791933907018,-2.9824661509053248e-05,-0.00052135597401005895,0.00022412577203734886]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":705,"step":5640,"t":28.199999999999999,"sim_time":28.199999999998674,"vehicle":{"origin_ned":[1.5039157776842136,1.0136859113006831,3.512808706269114],"origin_quat_xyzw":[-0.02126641668090655,0.05315548460778928,0.37725463256740677,0.92433823689388506],"cg_ned":[1.4432785406930781,0.95497530822521648,3.2202815757191208],"linear_velocity_ned":[-0.003032061930412706,-0.0048508663294486712,-0.0004637232315094546],"angular_velocity_ned":[0.0010788845813972639,-0.00044362212234647796,-0.0028441386502164978]},"sensors":{"Odom":[1.5039157776842136,1.0136859113006831,3.512808706269114,-0.0057941890030082143,-0.0017192660474998542,-0.0010412977093947648,-0.021266416680906553,0.053155484607789294,0.37725463256740682,0.92433823689388506,0.00078242507243613869,-0.0010740754723470428,-0.0027720191331938979],"Pressure":[26965.79459166016],"DVL":[0.023235772404865417,0.0086401803454161357,-0.027401484411084458,7.3772547179050658,0.023931651272196354,-0.018884429221382032,-0.0047595195888743454,0],"IMU":[0.00079680474103708534,0.1145634412313197,0.77504456055907212,0.032095814522966955,-0.0015559955023730959,0.11328865727233595,1.1190411959332094,-0.012103947463752329,-9.7779337742624044],"FOG":[0.78723756532993483],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[6.2795571208001082,-14.789893701175409,-26.186342829347403,60.198602921065508,60.198602921065508],"omega_rad_s":[6.3666552847025999,-14.827249123254271,-26.205336093597946,60.148815054894669,60.148861439241436],"thrust_n":[0.51344006169972134,-2.7656510655165101,-8.7104121573098681,46.219762860634688,46.187633029470334],"torque_nm":[-0.0096270011568697755,0.051855957478434564,0.16332022794956,-0.86662055363690049,-0.86601811930256889],"angle_rad":[-578.33768745721648,413.40012471433602,-607.74728905149755,1938.9078117134238,1938.9078472113742]},"command":[0.059805305912381986,-0.14085613048738485,-0.24939374123188002,0.57332002781967151,0.57332002781967151],"arm":{"servo_position":[2.5808035111652679e-24,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,-3.0493186101153316e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.019108921597703214,-1.4770619152789366,-0.27767559076533288,-2.8604666866994533e-05,-0.00051844618576681143,0.00022205345340725558]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":706,"step":5648,"t":28.240000000000002,"sim_time":28.239999999998666,"vehicle":{"origin_ned":[1.5037967512454005,1.0134730539094281,3.5127901746233143],"origin_quat_xyzw":[-0.021247017945431143,0.053140397763512488,0.3772037657537286,0.92436030932486946],"cg_ned":[1.4431581297952503,0.95478176228870182,3.2202594558812763],"linear_velocity_ned":[-0.0029930871033217394,-0.0048287925061834529,-0.00062214706859182014],"angular_velocity_ned":[0.0010618934140113031,-0.00044448944334993961,-0.0027705856706417408]},"sensors":{"Odom":[1.5037967512454005,1.0134730539094281,3.5127901746233143,-0.0057295597371357096,-0.0017215847162588666,-0.0011940181448653563,-0.021247017945431147,0.053140397763512509,0.37720376575372871,0.92436030932486946,0.00076135612523297528,-0.0010627485332829311,-0.0027004140149078392],"Pressure":[26966.500083322215],"DVL":[0.010038306700207824,0.0067936737048291205,0.014123279761144634,7.2857465191737463,-0.0095511159581885535,-0.019999307509726699,-0.035691306876562842,0],"IMU":[0.00081505512170154161,0.11452081905714517,0.77493453568084225,-0.014342412612093278,0.0016782781885437438,0.01718396934012224,1.1298004040017875,-0.026584574039287344,-9.7587382187001026],"FOG":[0.77497949252232334],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[6.2283777800590903,-14.682339460453113,-26.190359526977957,60.202255062444912,60.202255062444912],"omega_rad_s":[6.3097471207456799,-14.712185871473771,-26.20458919545187,60.151918949067095,60.151963820860352],"thrust_n":[0.50423560613708007,-2.7230970324769674,-8.7103976557283076,46.228472726668492,46.196673914206592],"torque_nm":[-0.0094544176150702496,0.051058069358943144,0.16331995604490576,-0.86678386362503423,-0.86618763589137371],"angle_rad":[-578.08432362064298,412.80966736048276,-608.795480454467,1941.3138330839347,1941.3138704032556]},"command":[0.059317883619610386,-0.13983180438526774,-0.24943199549502817,0.57335481011852296,0.57335481011852296],"arm":{"servo_position":[2.5808035111652679e-24,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,-3.0493186101153316e-22],"servo_velocity":[0,0,1.7347234759768071e-18,0,0,0],"servo_effort":[-0.017872611758229753,-1.47589613855196,-0.27703214742918636,-3.1611195089438791e-05,-0.00051831522626059965,0.00022005148857443506]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":707,"step":5656,"t":28.280000000000001,"sim_time":28.279999999998658,"vehicle":{"origin_ned":[1.503679139195935,1.0132615269616736,3.512765320382143],"origin_quat_xyzw":[-0.021228034428302615,0.053125399289151103,0.37715423185661856,0.92438181932431085],"cg_ned":[1.443039317151718,0.95458915988176773,3.2202310542612262],"linear_velocity_ned":[-0.0029523827781898103,-0.0048040435038103277,-0.00077809755326423689],"angular_velocity_ned":[0.0010432568331619114,-0.00044529328061594035,-0.0026975759745584242]},"sensors":{"Odom":[1.503679139195935,1.0132615269616736,3.512765320382143,-0.0056617807193272297,-0.0017228945282161151,-0.0013439953152047492,-0.021228034428302629,0.053125399289151137,0.37715423185661884,0.92438181932431085,0.00073922724547409457,-0.0010502256907894371,-0.0026294783022816899],"Pressure":[26965.08849421472],"DVL":[0.0056121488505995621,-0.028889195561633531,0.0073231396228953458,7.352186067991239,-0.0013939881823023456,0.0038682997643297301,-0.018293694660429374,0],"IMU":[0.00083277117568570302,0.11447867625165298,0.77482737785498812,0.0174907461919615,0.0022948031860051117,-0.069310873740999271,1.1196229545861371,-0.0067972499764131673,-9.7592647436231523],"FOG":[0.77715227524844432],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[6.1793374984384855,-14.578272343646285,-26.196499071054504,60.206473916688978,60.206473916688978],"omega_rad_s":[6.2546782298325558,-14.600164957170245,-26.205913101669477,60.155697025455275,60.155740371625292],"thrust_n":[0.49540858469494753,-2.6820151431228858,-8.7117980394552124,46.23812909501244,46.206696391621833],"torque_nm":[-0.0092889109630302676,0.050287783933554098,0.16334621323978527,-0.86696492053148333,-0.86637555734290939],"angle_rad":[-577.83319461239557,412.22374379841665,-609.84368906338807,1943.7199941005501,1943.7200331804754]},"command":[0.058850833318461762,-0.13884068898710747,-0.24949046734337624,0.57339498968275215,0.57339498968275215],"arm":{"servo_position":[2.5808035111652679e-24,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,-3.0493186101153316e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.01674102233793703,-1.4748139094924977,-0.27644696645008693,-3.4546167988689044e-05,-0.00051800245808575221,0.00021825173532524726]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":708,"step":5664,"t":28.32,"sim_time":28.31999999999865,"vehicle":{"origin_ned":[1.5035630101560162,1.0130514542443398,3.5127342418401839],"origin_quat_xyzw":[-0.021209496705386736,0.053110504142034158,0.37710602369547958,0.92440276854403003],"cg_ned":[1.4429221693337457,0.95439760543232688,3.2201964733809256],"linear_velocity_ned":[-0.002910067316397166,-0.0047767362725547498,-0.00093141534182357563],"angular_velocity_ned":[0.0010228446216828213,-0.00044595850231248001,-0.0026247045285618426]},"sensors":{"Odom":[1.5035630101560162,1.0130514542443398,3.5127342418401839,-0.0055909915076535087,-0.0017231490708657974,-0.0014910978835618875,-0.021209496705386736,0.053110504142034165,0.37710602369547963,0.92440276854403003,0.0007159516354449595,-0.0010363620955637597,-0.0025588143408081976],"Pressure":[26964.970073584711],"DVL":[-0.060255262657319647,0.013365466102535572,0.020426979098969494,7.3452756810836517,-0.020864664358703888,0.016391604410721804,-0.014383768148954439,0],"IMU":[0.0008499062690316599,0.11443706351097378,0.77472306989413453,0.10125410424333718,-0.064229752197080561,-0.14832183598319501,1.1232582081064788,-0.014000343739611135,-9.7462392003978273],"FOG":[0.77547890770255146],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[6.1326367885028104,-14.478032221108553,-26.204536538339568,60.211215599773112,60.211215599773112],"omega_rad_s":[6.2016384319207827,-14.491474124597147,-26.209306011824275,60.160105194225594,60.160146993130404],"thrust_n":[0.4869811180297326,-2.642484310129706,-8.7146089826354931,46.248659023963953,46.217631634958607],"torque_nm":[-0.0091308959630574879,0.04954658081493199,0.16339891842441551,-0.86716235669932418,-0.86658059315547398],"angle_rad":[-577.58422266043556,411.64222597849107,-610.89199795264585,1946.1263207268992,1946.1263615059445]},"command":[0.058406064652407719,-0.13788602115341478,-0.24956701465085301,0.57344014856926773,0.57344014856926773],"arm":{"servo_position":[2.5808035111652679e-24,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,-3.0493186101153316e-22],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.015909862577520115,-1.4739434275420225,-0.27607590123800396,-3.7425779223116934e-05,-0.00051750662721333372,0.00021723931815651184]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":709,"step":5672,"t":28.359999999999999,"sim_time":28.359999999998642,"vehicle":{"origin_ned":[1.5034484282493807,1.0128429554907334,3.5126970430860984],"origin_quat_xyzw":[-0.021191436574416998,0.053095729951067948,0.37705913753693282,0.92442315704269318],"cg_ned":[1.4428067475932758,0.95420719769272322,3.2201558220490059],"linear_velocity_ned":[-0.0028662816579725549,-0.0047470275192922663,-0.0010819467140420693],"angular_velocity_ned":[0.0010005931815770337,-0.00044635655673502296,-0.0025519153401075772]},"sensors":{"Odom":[1.5034484282493807,1.0128429554907334,3.5126970430860984,-0.005517377314054538,-0.0017223689189636746,-0.0016352046748283693,-0.021191436574417022,0.053095729951068003,0.37705913753693321,0.92442315704269318,0.00069156678101741417,-0.0010210215945971508,-0.0024883615261040094],"Pressure":[26965.666249736034],"DVL":[-0.025967168509195223,0.014577424457048302,0.018220043888682244,7.43039684615505,0.0016512327600086976,0.031559606610297344,-0.0097074723103487744,0],"IMU":[0.00086641395458363763,0.11439603740431287,0.77462160222834164,0.030594954794617591,0.059716241094245268,-0.10579220432363858,1.1300980091268142,-0.023235273095959838,-9.7371483273998773],"FOG":[0.78407714272744333],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[6.0884439017189269,-14.381814777112956,-26.214321248874608,60.216437635997558,60.216437635997558],"omega_rad_s":[6.1508320136977455,-14.386407310599443,-26.214701050599814,60.165099027601443,60.165139249239189],"thrust_n":[0.47897682199365671,-2.604582676398068,-8.7187835364115731,46.259989247101807,46.229410624935788],"torque_nm":[-0.008980815412381063,0.048835925182463769,0.16347719130771701,-0.86737479838315878,-0.8668014492175462],"angle_rad":[-577.337321795815,411.06497374257583,-611.94048839312416,1948.5328371533344,1948.5328795689607]},"command":[0.057985180016370735,-0.13696966454393292,-0.24966020237023437,0.57348988224759578,0.57348988224759578],"arm":{"servo_position":[2.5808035111652679e-24,3.2526065174565154e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,-3.0493186101153316e-22],"servo_velocity":[0,8.6736173798840355e-19,0,0,0,0],"servo_effort":[-0.015142159911169236,-1.4730736595984915,-0.27571552805921151,-3.8258551237785227e-05,-0.00051681691365074427,0.00021627900403922625]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":710,"step":5680,"t":28.400000000000002,"sim_time":28.399999999998634,"vehicle":{"origin_ned":[1.5033354538479,1.0126361477255723,3.5126538335939528],"origin_quat_xyzw":[-0.021173887203445239,0.053081097456884711,0.37701357289163878,0.9244429833412926],"cg_ned":[1.4426931083812566,0.95401803092734694,3.2201092150303037],"linear_velocity_ned":[-0.0028211267566405074,-0.0047149926144613935,-0.0012295441158714404],"angular_velocity_ned":[0.00097634946020411771,-0.00044636760996412671,-0.0024789339323379542]},"sensors":{"Odom":[1.5033354538479,1.0126361477255723,3.5126538335939528,-0.0054410206477071279,-0.001720505622900456,-0.0017761937118059667,-0.021173887203445246,0.053081097456884725,0.37701357289163889,0.9244429833412926,0.00066601563267027614,-0.0010040114938266555,-0.0024178502538133445],"Pressure":[26964.889856491598],"DVL":[0.010385578130852998,-0.010877611874291595,0.0010654099083988817,7.357046963088222,0.018812432837366836,-0.0022026462831583739,-0.038866167857898357,0],"IMU":[0.00088224800423456851,0.11435566130309903,0.7745229724883459,0.0028378296141225961,0.040426030592921193,-0.047695225072585598,1.1211695849050447,-0.012183204722185488,-9.7265904440990401],"FOG":[0.76302462757351364],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[6.0469431063778565,-14.28982533330573,-26.225729726026294,60.222098938396968,60.222098938396968],"omega_rad_s":[6.1024397024354791,-14.285207964743526,-26.222014391366052,60.170634440719432,60.170673046709986],"thrust_n":[0.47141502686510711,-2.5683686806538653,-8.7242640449744684,46.272046394774414,46.241965619102054],"torque_nm":[-0.0088390317537207583,0.048156912762259974,0.16357995084327129,-0.86760086990202034,-0.86703685535816366],"angle_rad":[-577.09239869456542,410.49183669558471,-612.98923863133143,1950.9395658007397,1950.9396097890212]},"command":[0.057589934346455776,-0.13609357460291172,-0.24976885453358377,0.57354379941330447,0.57354379941330447],"arm":{"servo_position":[-1.4359855433920739e-23,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,-3.0493186101153316e-22],"servo_velocity":[-6.7762635780344027e-21,0,1.7347234759768071e-18,0,0,0],"servo_effort":[-0.014586679740016808,-1.4721763580537313,-0.27536890379643775,-3.6439366962732778e-05,-0.00051591867760263489,0.00021540253403593186]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":711,"step":5688,"t":28.440000000000001,"sim_time":28.439999999998626,"vehicle":{"origin_ned":[1.5032241437358933,1.0124311446300427,3.5126047282991424],"origin_quat_xyzw":[-0.021156882254183891,0.053066629585313822,0.37696933172881703,0.92446224481785444],"cg_ned":[1.4425813037355244,0.95383019504626121,3.2200567729212493],"linear_velocity_ned":[-0.0027747302224234152,-0.0046807819710978768,-0.0013740668154131517],"angular_velocity_ned":[0.00095013799514221157,-0.00044591022519234393,-0.0024057643855256786]},"sensors":{"Odom":[1.5032241437358933,1.0124311446300427,3.5126047282991424,-0.005362119918707592,-0.0017175985537592701,-0.0019139502720090743,-0.021156882254183905,0.05306662958531385,0.37696933172881725,0.92446224481785444,0.00063937233808189443,-0.00098529096544376963,-0.002347276111606446],"Pressure":[26963.882688065529],"DVL":[0.00689372692646671,-0.013207336140431125,0.03191855454787073,7.4095775908649113,-0.013161820805140372,0.0080898341486587283,-0.0095136946718965155,0],"IMU":[0.0008973632347504479,0.11431600300023205,0.7744271837959471,0.024348826731834597,0.022282740920856005,0.12813310465249592,1.1190954028460747,-0.012893089229456551,-9.7598830932781517],"FOG":[0.7808277332595599],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[6.0083243684875791,-14.202296437601074,-26.238644051960659,60.228154441084357,60.228154441084357],"omega_rad_s":[6.0566659685894981,-14.188139457969299,-26.231144282467174,60.176666549020659,60.176703492993127],"thrust_n":[0.46431818184260204,-2.5339060436184799,-8.7309813037602186,46.284757745002494,46.255225774372498],"torque_nm":[-0.00870596590954879,0.047510738317846496,0.16370589944550415,-0.86783920771879663,-0.86728548326948451],"angle_rad":[-576.8493519914648,409.92265395200326,-614.03832307653863,1953.3465273111321,1953.346572806422]},"command":[0.057222136842738851,-0.13525996607239119,-0.24989184811391105,0.57360147086747004,0.57360147086747004],"arm":{"servo_position":[1.9521462456251275e-23,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,-1.694065894508451e-22],"servo_velocity":[3.3881317890172014e-21,0,0,0,0,0],"servo_effort":[-0.014026598107020567,-1.4712651753474784,-0.2750098628543714,-3.4623855494116672e-05,-0.00051482963295199232,0.00021448850203568777]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":712,"step":5696,"t":28.48,"sim_time":28.479999999998618,"vehicle":{"origin_ned":[1.5031145498307106,1.0122280518332403,3.512549847213287],"origin_quat_xyzw":[-0.021140453413929842,0.053052349841044684,0.37692641504725877,0.9244809392547898],"cg_ned":[1.4424713799651159,0.95364377296574276,3.2199986213579765],"linear_velocity_ned":[-0.0027272409488300446,-0.0046445780376229932,-0.0015153995866680873],"angular_velocity_ned":[0.00092207778149571275,-0.00044494182083509236,-0.0023324821828055483]},"sensors":{"Odom":[1.5031145498307106,1.0122280518332403,3.512549847213287,-0.0052809361352411039,-0.0017137130692501579,-0.0020483844601677627,-0.021140453413929852,0.053052349841044712,0.37692641504725893,0.9244809392547898,0.00061175927643158262,-0.00096491304129560254,-0.002276700947116028],"Pressure":[26964.901362156204],"DVL":[0.017410506748584027,0.0026233015970540999,0.00070484069557278143,7.3659565296000684,-0.022282488256344123,0.017531309606375566,0.0071043618927377119,0],"IMU":[0.00091171844892634613,0.11427712986761403,0.774334237398564,-0.040946068747295158,-0.069042013905442207,-0.048632117240244577,1.1291744885680737,-0.0019115743834448749,-9.7520173519723752],"FOG":[0.76784462591658276],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[5.9725010520386848,-14.119092978782652,-26.252983041816975,60.234566370628777,60.234566370628777],"omega_rad_s":[6.0136310469805023,-14.09535068640473,-26.241993324975855,60.183151437764437,60.183186668127298],"thrust_n":[0.45769537074671396,-2.501215898666914,-8.7388690420748656,46.298054167624301,46.269120785898551],"torque_nm":[-0.0085817882015008853,0.046897798100004634,0.16385379453890372,-0.86808851564295564,-0.867546014735598],"angle_rad":[-576.60807398261636,409.35725657600506,-615.08781216650243,1955.7537405447249,1955.7537874793929]},"command":[0.056880962400368426,-0.1344675521788824,-0.25002840992206643,0.57366253686313118,0.57366253686313118],"arm":{"servo_position":[1.9521462456251275e-23,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,-1.694065894508451e-22],"servo_velocity":[3.3881317890172014e-21,0,0,0,0,0],"servo_effort":[-0.013468252778318555,-1.4703585839122364,-0.27464284455218091,-3.2966439922637214e-05,-0.00051356527924947511,0.00021354351049239536]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":713,"step":5704,"t":28.52,"sim_time":28.51999999999861,"vehicle":{"origin_ned":[1.5030067191273173,1.0120269659456733,3.5124893148331782],"origin_quat_xyzw":[-0.021124629308289802,0.053038282019635265,0.37688482192320827,0.92449906526772885],"cg_ned":[1.4423633774085611,0.95345884040202655,3.2199348903123672],"linear_velocity_ned":[-0.0026788089406572118,-0.0046065585849268615,-0.0016534375338860229],"angular_velocity_ned":[0.00089228888805420773,-0.00044335470506990271,-0.0022592375486295258]},"sensors":{"Odom":[1.5030067191273173,1.0120269659456733,3.5124893148331782,-0.0051977128859387505,-0.0017089304134731385,-0.0021794185960299283,-0.02112462930828982,0.053038282019635306,0.37688482192320855,0.92449906526772885,0.00058335335504138669,-0.00094288498388182243,-0.0022062556347174096],"Pressure":[26964.636348985772],"DVL":[-0.003584570027726614,0.00503553897465598,0.012239104591190694,7.2843421378519855,-0.022439728545221995,0.019955380968019562,0.018293962144573711,0],"IMU":[0.00092527812176662692,0.11423910750227462,0.77424413067375841,0.049579933915761341,0.04057921611678323,0.086896500278213856,1.1167201793725023,-0.017972232673579329,-9.7482175343397408],"FOG":[0.78441846340660726],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[5.9393267733330806,-14.040010302979727,-26.268666495466828,60.241301289639225,60.241301289639225],"omega_rad_s":[5.9733709901837457,-14.006876943833543,-26.25446611497437,60.190047804541052,60.190081267547704],"thrust_n":[0.45154294344830703,-2.470278991139145,-8.7478626357263032,46.311870603709352,46.283584993692394],"torque_nm":[-0.0084664301896557569,0.046317731083858969,0.1640224244198682,-0.86834757381955052,-0.86781721863173245],"angle_rad":[-576.36845408456304,408.79547230564435,-616.13777246778807,1958.1612226640625,1958.1612709683598]},"command":[0.056565016888886481,-0.13371438383790216,-0.25017777614730313,0.57372667894894502,0.57372667894894502],"arm":{"servo_position":[1.9521462456251275e-23,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,-1.694065894508451e-22],"servo_velocity":[3.3881317890172014e-21,0,0,0,0,0],"servo_effort":[-0.012941287347685324,-1.4694349028186453,-0.27426336122900985,-3.1321494057040783e-05,-0.00051212720073345495,0.00021256221132905188]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":714,"step":5712,"t":28.560000000000002,"sim_time":28.559999999998603,"vehicle":{"origin_ned":[1.5029006947159171,1.0118279753214767,3.5124232595229108],"origin_quat_xyzw":[-0.021109436003112544,0.053024452109352346,0.37684454904676334,0.92451662237294308],"cg_ned":[1.4422573304873694,0.95327546598607527,3.2198657138044857],"linear_velocity_ned":[-0.002629578846949756,-0.0045669015078863805,-0.0017880827641911007],"angular_velocity_ned":[0.0008607974032561835,-0.00044099473320676895,-0.0021861238075653031]},"sensors":{"Odom":[1.5029006947159171,1.0118279753214767,3.5124232595229108,-0.0051126594416205321,-0.00170332087045469,-0.0023069864374293371,-0.021109436003112547,0.053024452109352353,0.37684454904676346,0.92451662237294308,0.00055429050347239358,-0.0009191150450885082,-0.0021360185855522859],"Pressure":[26964.005365715901],"DVL":[-0.006696348679418907,-0.01492595944735175,0.021819015833120299,7.3520511233492298,0.0049589148916968848,-0.039362997745776653,-0.0020495363237611084,0],"IMU":[0.00093801285877974448,0.11420200363642163,0.77415685624535757,-0.034435902075839339,-0.032547612183970794,0.033384010466067773,1.1209874746486317,-0.0032895228235171299,-9.7438190241386025],"FOG":[0.77750175917643649],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[5.9086070980816752,-13.964820531554382,-26.285662945527804,60.248328500888896,60.248328500888896],"omega_rad_s":[5.9358450723113254,-13.9226623350095,-26.268484530289566,60.197317084532685,60.197348724742156],"thrust_n":[0.44584609911450046,-2.44104505714665,-8.7579089709193134,46.326145003382699,46.298558843130309],"torque_nm":[-0.0083596143583968864,0.045769594821499685,0.16421079320473708,-0.86861521881342552,-0.8680979783086934],"angle_rad":[-576.1303820716056,408.23712964916194,-617.18826711037366,1960.5689892418445,1960.5690388438366]},"command":[0.056272448553158813,-0.13299829077670841,-0.25033964710026479,0.57379360477037045,0.57379360477037045],"arm":{"servo_position":[-1.4359855433920739e-23,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,-3.3881317890157044e-23],"servo_velocity":[-3.3881317890172014e-21,0,1.7347234759768071e-18,0,0,0],"servo_effort":[-0.012405442403374446,-1.4684786332524549,-0.27386817756869997,-2.9692247002212716e-05,-0.00051051718426921332,0.00021154064409741649]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":715,"step":5720,"t":28.600000000000001,"sim_time":28.599999999998595,"vehicle":{"origin_ned":[1.5027965152053446,1.0116311615808986,3.5123518129748232],"origin_quat_xyzw":[-0.021094899658973147,0.05301088802962306,0.37680559319980972,0.92453360993098999],"cg_ned":[1.4421532681254672,0.9530937111280976,3.2197912294894331],"linear_velocity_ned":[-0.0025796841796624967,-0.0045257869209921874,-0.0019192513552537351],"angular_velocity_ned":[0.00082755671754204533,-0.00043781803282439628,-0.0021131000032722862]},"sensors":{"Odom":[1.5027965152053446,1.0116311615808986,3.5123518129748232,-0.0050259853979615979,-0.0016969151307588562,-0.0024310333870598867,-0.021094899658973161,0.053010888029623095,0.37680559319981,0.92453360993098999,0.00052456309804214593,-0.00089353935506140915,-0.0020659495036358931],"Pressure":[26963.50853240291],"DVL":[0.014951573033846642,0.006689161952911615,0.018683036666008977,7.3860565585322115,0.022534151793672796,-0.0050942794367896307,0.023083657325588373,0],"IMU":[0.00094989456736058653,0.11416588965880622,0.77407240710289305,-0.051405573555120911,0.076099991481571289,0.038240971653816909,1.1198141980490954,0.010907532495815093,-9.7500217170133752],"FOG":[0.76253001236210471],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[5.8803064580140374,-13.893466340481275,-26.303868849780965,60.255620112278294,60.255620112278294],"omega_rad_s":[5.9009945042036813,-13.842632435129749,-26.2839675654307,60.204923521479358,60.204953280857083],"thrust_n":[0.44058802228995775,-2.4134595113299442,-8.7689527773540092,46.340820013679007,46.313987271938053],"torque_nm":[-0.0082610254179367095,0.045252365837436463,0.16441786457538768,-0.86889037525648138,-0.86838726134883881],"angle_rad":[-575.89375001776386,407.68206000103675,-618.23935613067158,1962.9770543720158,1962.9771051974935]},"command":[0.056002918647752739,-0.13231872705220263,-0.25051303666458064,0.57386304868836469,0.57386304868836469],"arm":{"servo_position":[2.5808035111652679e-24,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,-3.3881317890157044e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.011845970589224375,-1.4675065268218088,-0.27346097360416233,-2.8084698857676506e-05,-0.00050874173818947119,0.00021048357883175311]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":716,"step":5728,"t":28.640000000000001,"sim_time":28.639999999998587,"vehicle":{"origin_ned":[1.5026942152956979,1.011436598113415,3.5122751098098606],"origin_quat_xyzw":[-0.021081043536832898,0.052997619109364187,0.37676794969793181,0.92455002787980789],"cg_ned":[1.4420512137677919,0.95291363044251143,3.2197115779883196],"linear_velocity_ned":[-0.0025292628206025729,-0.0044833790387117361,-0.0020468754815941336],"angular_velocity_ned":[0.00079273643443317015,-0.0004336712582369448,-0.0020403168202697921]},"sensors":{"Odom":[1.5026942152956979,1.011436598113415,3.5122751098098606,-0.0049379124928917665,-0.0016898133753416966,-0.0025515162495391651,-0.021081043536832902,0.052997619109364194,0.37676794969793193,0.92455002787980789,0.00049441497497764158,-0.00086616705292054343,-0.0019961720894570356],"Pressure":[26963.696254709303],"DVL":[-0.016631536451876691,0.004575221528465916,0.0012106104013861246,7.3513189117475761,0.024062788522688498,-0.0017340403630662104,-0.02458915822234943,0],"IMU":[0.0009609014366111099,0.11413083738539846,0.77399077343941391,0.051029789997379796,0.0073469614971441643,-0.04977207016619048,1.1331078975959279,-0.021448071025134186,-9.7756452931485907],"FOG":[0.79085993406757815],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[5.8542119997178288,-13.825755440344942,-26.32321582540213,60.263151253271616,60.263151253271616],"omega_rad_s":[5.8687367208008716,-13.766691321362497,-26.300828791622443,60.212834281764835,60.212862100415002],"thrust_n":[0.43574919088560132,-2.3874621245929153,-8.780935824487651,46.355844216910775,46.329818722028257],"torque_nm":[-0.0081702973291050262,0.044764914836117164,0.16464254670914347,-0.86917207906707705,-0.86868410103802995],"angle_rad":[-575.65845250735026,407.13009796303112,-619.29109608995316,1965.3854307846509,1965.3854827570376]},"command":[0.055754399997312659,-0.13167386133661849,-0.25069729357525838,0.57393477384068203,0.57393477384068203],"arm":{"servo_position":[2.5808035111652679e-24,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,4.3198680309969292e-21,-3.3881317890157044e-23],"servo_velocity":[0,0,1.7347234759768071e-18,0,8.6736173798840355e-19,0],"servo_effort":[-0.011300937411834674,-1.466523897212392,-0.2730429870140344,-2.6505807337867049e-05,-0.0005068042913593915,0.0002093927814610467]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":717,"step":5736,"t":28.68,"sim_time":28.679999999998579,"vehicle":{"origin_ned":[1.5025938251897375,1.0112443505234359,3.5121932871443158],"origin_quat_xyzw":[-0.021067888898057691,0.05298467495797337,0.37673161282230577,0.92456587660224687],"cg_ned":[1.4419511856530498,0.95273527190448881,3.2196269023349835],"linear_velocity_ned":[-0.0024784400839918826,-0.0044398435206383854,-0.0021709012079118052],"angular_velocity_ned":[0.00075639189811837755,-0.00042856780915036491,-0.0019677913418193189]},"sensors":{"Odom":[1.5025938251897375,1.0112443505234359,3.5121932871443158,-0.0048486646710169737,-0.001682056467788056,-0.0026684026061561885,-0.021067888898057701,0.052984674957973391,0.37673161282230594,0.92456587660224687,0.00046387778419172394,-0.0008370464982802565,-0.0019266998719489972],"Pressure":[26963.690815739854],"DVL":[-0.0055931002271799365,0.020447145514513043,-0.018073203235952105,7.3339455611365549,-0.0086402080875530602,0.012182057865398515,0.000973692974857143,0],"IMU":[0.00097101545851101343,0.11409691764660015,0.77391194340968439,-0.01117441012625584,-0.023902068772879908,-0.02309074683269802,1.1192813466690792,-0.0065189106394696805,-9.7343458516093957],"FOG":[0.75634898947953866],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[5.8301938591384896,-13.761514094453103,-26.3436193007133,60.270899868556292,60.270899868556292],"omega_rad_s":[5.838947028950372,-13.694702773243055,-26.318986757276541,60.221019490589129,60.221045308068014],"thrust_n":[0.43130458358294005,-2.3629809569774096,-8.7938030759402128,46.371171497469597,46.346005915353821],"torque_nm":[-0.0080869609421801263,0.04430589294332643,0.164883807673879,-0.86945946557755505,-0.86898761091288423],"angle_rad":[-575.42438874531626,406.58108307889631,-620.34354029279768,1967.7941299639449,1967.7941830042503]},"command":[0.055525655801318949,-0.13106203899479146,-0.25089161238774571,0.57400857017672657,0.57400857017672657],"arm":{"servo_position":[2.5808035111652679e-24,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,-3.3881317890157044e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.010742091854784332,-1.4655443058276647,-0.27261732756895191,-2.498124714529934e-05,-0.00050471499387409573,0.0002082725020429058]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":718,"step":5744,"t":28.719999999999999,"sim_time":28.719999999998571,"vehicle":{"origin_ned":[1.5024953702992563,1.0110544767729286,3.5121064841807828],"origin_quat_xyzw":[-0.021055455162427149,0.052972084566529069,0.376696576170992,0.92458115683028674],"cg_ned":[1.4418531970798547,0.95255867706790764,3.2195373474364652],"linear_velocity_ned":[-0.0024273378329571905,-0.0043953372346206554,-0.0022912867162262554],"angular_velocity_ned":[0.00071863836397121066,-0.00042248889403949364,-0.0018955811081719067]},"sensors":{"Odom":[1.5024953702992563,1.0110544767729286,3.5121064841807828,-0.0047584615893734817,-0.0016737040443782802,-0.0027816700882419294,-0.021055455162427166,0.052972084566529111,0.37669657617099234,0.92458115683028674,0.00043305272425494097,-0.00080624492275530209,-0.0018575791137830015],"Pressure":[26961.161021564556],"DVL":[-0.058642843419514971,0.050604701933020101,-0.011723330901534544,7.4235672062195341,-0.0046474348233906506,0.020296834167546428,0.0043616015916170328,0],"IMU":[0.00098022149482229412,0.11406419873998652,0.77383590379956002,0.017197361414824086,-0.11973710748086211,-0.0078863609483754045,1.1121147933234414,-0.0021563439049892916,-9.762326075811206],"FOG":[0.77884579820257094],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[5.8081317988960279,-13.700561713782861,-26.364982099730458,60.278846610201505,60.278846610201505],"omega_rad_s":[5.8115067185015326,-13.626516225918438,-26.338351603627864,60.229452213527459,60.229475970518344],"thrust_n":[0.4272309456683957,-2.339941386224873,-8.8074940363770686,46.386760894050447,46.362505923269239],"torque_nm":[-0.0080105802312824201,0.043873900991716376,0.16514051318207007,-0.86975176676344601,-0.86929698606129824],"angle_rad":[-575.19146268275415,406.03486062652439,-621.39673856749425,1970.2031622662828,1970.2032162931191]},"command":[0.055315540941866935,-0.13048154013126534,-0.25109506761648054,0.57408425343049052,0.57408425343049052],"arm":{"servo_position":[2.5808035111652679e-24,3.2526065174565154e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,-3.3881317890157044e-23],"servo_velocity":[0,8.6736173798840355e-19,1.7347234759768071e-18,0,0,0],"servo_effort":[-0.010180723456389923,-1.4645698265565452,-0.27218472605456651,-2.3496761903338221e-05,-0.00050248471515289674,0.0002068547045268488]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":719,"step":5752,"t":28.760000000000002,"sim_time":28.759999999998563,"vehicle":{"origin_ned":[1.5023988717141781,1.0108670271487545,3.5120148417820847],"origin_quat_xyzw":[-0.021043759268591269,0.052959876498662885,0.37666283232688047,0.92459586978343367],"cg_ned":[1.4417572565940808,0.95238388137615415,3.2194430596372854],"linear_velocity_ned":[-0.0023760723701729209,-0.0043500097738673584,-0.0024080005791123462],"angular_velocity_ned":[0.00067959944225089869,-0.00041540725196027997,-0.0018237501994662238]},"sensors":{"Odom":[1.5023988717141781,1.0108670271487545,3.5120148417820847,-0.0046675126315162269,-0.0016648185768894017,-0.0028913055597546153,-0.021043759268591276,0.052959876498662899,0.37666283232688058,0.92459586978343367,0.00040205357667878023,-0.00077382932088587025,-0.0017888612245110377],"Pressure":[26960.222242258427],"DVL":[-0.022871000317582404,0.0030110518983515406,0.017611733804337688,7.2427012773785924,0.0013298947551986815,-0.023471660911999054,0.0039375562400002818,0],"IMU":[0.00098850857233444517,0.11403274630217859,0.77376263937860368,-0.0012964573173457603,-0.039444759641026193,-0.0066421712678065778,1.1385460927597348,-0.010116420843198259,-9.7368013214905567],"FOG":[0.76058874959261213],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[5.7878632039093816,-13.642699419620691,-26.387219332586412,60.286974626640387,60.286974626640387],"omega_rad_s":[5.7862812842231799,-13.561961797312929,-26.358832700293274,60.238108375989604,60.238130015558085],"thrust_n":[0.42350348159358453,-2.3182643803270322,-8.8219477607112786,46.402576067757927,46.37928044770571],"torque_nm":[-0.0079406902798797117,0.043467457131131856,0.16541152051333652,-0.87004830127046118,-0.8696115083944822],"angle_rad":[-574.95958336893227,405.49128235616786,-622.45073712083411,1972.6125370361522,1972.6125919658093]},"command":[0.055122506703898871,-0.12993047066305419,-0.25130685078653725,0.57416166311086081,0.57416166311086081],"arm":{"servo_position":[2.5808035111652679e-24,3.2526065174565154e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,-3.3881317890157044e-23],"servo_velocity":[0,8.6736173798840355e-19,0,0,0,0],"servo_effort":[-0.0096186441538007091,-1.463602801791176,-0.27174600713849056,-2.2079088784476905e-05,-0.00050011628240073473,0.00020456081250170408]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":720,"step":5760,"t":28.800000000000001,"sim_time":28.799999999998555,"vehicle":{"origin_ned":[1.5023043464662653,1.0106820444797784,3.5119185020679167],"origin_quat_xyzw":[-0.021032815556810431,0.052948078884261132,0.37663037284231976,0.92461001717744462],"cg_ned":[1.4416633682284228,0.9522109144465648,3.2193441863082901],"linear_velocity_ned":[-0.002324753792547742,-0.0043040036846212727,-0.0025210215949638122],"angular_velocity_ned":[0.00063940308069723012,-0.00040729740213679775,-0.0017523611408079836]},"sensors":{"Odom":[1.5023043464662653,1.0106820444797784,3.5119185020679167,-0.0045760179867385667,-0.0016554623618994316,-0.0029973046926685884,-0.021032815556810434,0.052948078884261146,0.37663037284231982,0.92461001717744462,0.00037099581251998255,-0.0007398709652474435,-0.001720595856987575],"Pressure":[26958.642784404274],"DVL":[0.018593792590499585,0.02084278442593682,-0.0098416213278682309,7.3395095382735231,-0.010764326171524834,0.043433297526121573,0.0067045220778069216,0],"IMU":[0.00099587009574078839,0.11400262320952782,0.77369213287638339,-0.0044438019409812814,0.0021413350949567537,0.24317620982723825,1.1246877987319603,-0.0016245612296595102,-9.7880287706471822],"FOG":[0.78554061406902331],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[5.769214076446608,-13.58772632170586,-26.4102498662103,60.295269397299911,60.295269397299911],"omega_rad_s":[5.7631204997254786,-13.500855245743677,-26.38034063924373,60.246966644727202,60.246986113169193],"thrust_n":[0.42009583815991736,-2.2978682126033738,-8.837104143725341,46.418585168219124,46.396295563572991],"torque_nm":[-0.0078767969654984522,0.043085028986313258,0.16569570269485015,-0.8703484719041088,-0.86993054181699381],"angle_rad":[-574.72866559759063,404.95020715420185,-623.50557856044122,1975.0222627178405,1975.0223184644015]},"command":[0.054944895966158168,-0.12940691734957963,-0.25152618920200287,0.57424066092666581,0.57424066092666581],"arm":{"servo_position":[2.5808035111652679e-24,-1.0842021724855024e-21,9.7514668052651336e-21,-6.7365589086318584e-23,-1.6940658945088655e-23,-3.3881317890157044e-23],"servo_velocity":[0,0,0,-1.3552527156068805e-20,0,0],"servo_effort":[-0.0090561411367544257,-1.4626466218590226,-0.27130232737883836,-2.0723377572677264e-05,-0.00049762182643048769,0.00020209218168081104]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":721,"step":5768,"t":28.84,"sim_time":28.839999999998547,"vehicle":{"origin_ned":[1.5022118077307529,1.0104995643916845,3.5118176080354129],"origin_quat_xyzw":[-0.021022635734944797,0.052936719318057178,0.37659918829286149,0.92462360120848897],"cg_ned":[1.4415715317573474,0.95203980036067637,3.2192408754497115],"linear_velocity_ned":[-0.0022734856778600528,-0.0042574540656732376,-0.0026303381791537351],"angular_velocity_ned":[0.00059818067199184923,-0.0003981390944477099,-0.0016814729104488758]},"sensors":{"Odom":[1.5022118077307529,1.0104995643916845,3.5118176080354129,-0.0044841687788218388,-0.0016456963860095545,-0.0030996712154468145,-0.021022635734944808,0.052936719318057206,0.37659918829286165,0.92462360120848897,0.00033999333688168197,-0.00070444725012693389,-0.0016528292731284554],"Pressure":[26958.472313938422],"DVL":[-0.033228713276680699,-0.0042109842026004929,0.0048253094788542686,7.3455134459844311,-0.031904709299768672,-0.0082419797242594822,0.027601917050473046,0],"IMU":[0.0010023038417886544,0.11397388936512531,0.77362436509305665,0.013924350625632093,0.095838093955987053,-0.0095548341907502349,1.1053468851811579,-0.026113101726493119,-9.7343776196567688],"FOG":[0.77837674966278358],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[5.752005824425769,-13.535442606886924,-26.433994489353132,60.303718653894606,60.303718653894606],"omega_rad_s":[5.7418615129660893,-13.443002860453458,-26.402787608192721,60.256008321231697,60.256025568708658],"thrust_n":[0.41698052410554426,-2.2786700807766969,-8.8529041501046652,46.434760684371668,46.413521506472009],"torque_nm":[-0.0078183848269789535,0.042725064014563073,0.1659919528144625,-0.87065176283196888,-0.87025352824635016],"angle_rad":[-574.49863046861481,404.41150150375989,-624.56130195362584,1977.4323469626918,1977.4324034381766]},"command":[0.054781007851673988,-0.12890897720844691,-0.25175232847002982,0.57432113003709151,0.57432113003709151],"arm":{"servo_position":[2.5808035111652679e-24,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,-3.3881317890157044e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.0084931031791762781,-1.4617052866297588,-0.27085506362583572,-1.9440487715644462e-05,-0.00049501330252714492,0.00019945618865256932]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":722,"step":5776,"t":28.879999999999999,"sim_time":28.879999999998539,"vehicle":{"origin_ned":[1.5021212650130038,1.010319615584532,3.5117123032097544],"origin_quat_xyzw":[-0.021013228864499703,0.052925824724521425,0.37656926834798554,0.92463662453191853],"cg_ned":[1.4414817429615852,0.9518705579718616,3.2191332753202229],"linear_velocity_ned":[-0.0022223649853348659,-0.0042104882924406872,-0.0027359477979673565],"angular_velocity_ned":[0.00055606630856715926,-0.00038791838949413021,-0.0016111406628729699]},"sensors":{"Odom":[1.5021212650130038,1.010319615584532,3.5117123032097544,-0.0043921469512211691,-0.0016355797904518093,-0.0031984163121219623,-0.021013228864499717,0.05292582472452146,0.37656926834798582,0.92463662453191853,0.00030915717937831527,-0.00066764194492057978,-0.0015856042141138157],"Pressure":[26957.771251158854],"DVL":[0.0049882445785439308,0.008805358726661482,0.038557044122594218,7.3679676369701195,-0.0045324076578607602,0.0095394874293064352,0.019405417258577518,0],"IMU":[0.0010078118925322824,0.11394660143830997,0.77355931504208619,0.045060803235293843,-0.050435912444778415,0.1422697105569565,1.1185091556994697,-0.025962394839842425,-9.7267613190838826],"FOG":[0.78172447452111815],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[5.7360580047597995,-13.485651253745585,-26.45837556667782,60.312312146996668,60.312312146996668],"omega_rad_s":[5.7223321861838867,-13.388205434771171,-26.426087450542312,60.265217195559899,60.26523217661768],"thrust_n":[0.41412935063556477,-2.2605873614181724,-8.8692898398644591,46.451079212895927,46.43093242378422],"torque_nm":[-0.0077649253244168395,0.042386013026590737,0.16629918449745862,-0.87095773524179854,-0.87057998294595407],"angle_rad":[-574.26940581596079,403.87503977052859,-625.61794289272996,1979.8427967312405,1979.8428538457733]},"command":[0.05462912385485523,-0.12843477384519605,-0.25198452920645542,0.57440297282853969,0.57440297282853969],"arm":{"servo_position":[2.5808035111652679e-24,-1.0842021724855024e-21,9.7514668052651336e-21,-6.7365589086318584e-23,-1.6940658945088655e-23,-3.3881317890157044e-23],"servo_velocity":[0,0,0,-1.3552527156068805e-20,0,0],"servo_effort":[-0.0079295480862399265,-1.4607830540475826,-0.27040575092013175,-1.8229969688034152e-05,-0.00049230406160336059,0.00019666764716369558]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":723,"step":5784,"t":28.920000000000002,"sim_time":28.919999999998531,"vehicle":{"origin_ned":[1.5020327243310536,1.0101422201159662,3.5116027313159881],"origin_quat_xyzw":[-0.021004601362137044,0.052915421221469035,0.37654060184887594,0.9246490902379445],"cg_ned":[1.4413939938933809,0.95170320120965846,3.2190215340879496],"linear_velocity_ned":[-0.0021714820026131824,-0.0041632260489188585,-0.0028378563559360737],"angular_velocity_ned":[0.00051319724933842129,-0.00037662719397698843,-0.0015414149514797399]},"sensors":{"Odom":[1.5020327243310536,1.0101422201159662,3.5116027313159881,-0.0043001253260580279,-0.0016251700506907279,-0.0032935580168517728,-0.021004601362137051,0.052915421221469049,0.37654060184887606,0.9246490902379445,0.0002785960613394758,-0.00062954518875283087,-0.0015189590522924194],"Pressure":[26957.992703124721],"DVL":[-0.024804852268091447,0.0070875293269560651,-0.024722159346514897,7.366648896049556,-0.028886570392374886,0.0609279231245261,-0.015775997056345831,0],"IMU":[0.0010124005396611321,0.11392081261335051,0.77349696010679325,0.06497374890776994,-0.02357657641995687,0.056665224702540901,1.1139271811783336,-0.027550584437026852,-9.7695542289510069],"FOG":[0.76533352834753987],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[5.7211898753076031,-13.43815877540287,-26.483317018060507,60.32104155776733,60.32104155776733],"omega_rad_s":[5.7043540405283375,-13.336261252372159,-26.450155715963902,60.27457940810384,60.274592082108093],"thrust_n":[0.41151380330233878,-2.2435384965017211,-8.8862043842279501,46.467521231266197,46.448506151809376],"torque_nm":[-0.0077158838119188522,0.042066346809407275,0.1666163322042741,-0.87126602308624113,-0.87090949034642595],"angle_rad":[-574.04092650933126,403.3407043525072,-626.6755335628917,1982.253618389575,1982.2536760515677]},"command":[0.054487522621977175,-0.12798246452764639,-0.25222206683867149,0.57448611007397454,0.57448611007397454],"arm":{"servo_position":[1.1051132983708271e-23,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,-3.3881317890157044e-23],"servo_velocity":[1.6940658945086007e-21,0,0,0,0,0],"servo_effort":[-0.0073657394328727633,-1.4598843019715653,-0.26995601827352994,-1.7101654481465525e-05,-0.00048950887228203842,0.00019373824041826233]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":724,"step":5792,"t":28.960000000000001,"sim_time":28.959999999998523,"vehicle":{"origin_ned":[1.5019461884010996,1.0099673937002027,3.5114890359761333],"origin_quat_xyzw":[-0.020996757010171847,0.05290553399101975,0.37651317689637909,0.92466100182260136],"cg_ned":[1.441308273143721,0.95153773939222686,3.218905799508446],"linear_velocity_ned":[-0.0021209203358056755,-0.0041157792080777468,-0.0029360775007844443],"angular_velocity_ned":[0.00046971201571787904,-0.00036426386714430176,-0.0014723415782537527]},"sensors":{"Odom":[1.5019461884010996,1.0099673937002027,3.5114890359761333,-0.0042082673307328143,-0.0016145223549996869,-0.0033851205626038226,-0.020996757010171844,0.05290553399101975,0.37651317689637903,0.92466100182260136,0.0002484146055407371,-0.00059025259588366466,-0.0014529278448973514],"Pressure":[26955.924270652733],"DVL":[-0.008258422417807023,-0.016174295778514512,0.038000674316731854,7.4445465185432216,0.0044311927170173895,0.014210301908030593,0.018202500877445797,0],"IMU":[0.0010160801789051291,0.11389657235842467,0.77343727621888081,-0.044591374055566194,-0.00634161177036437,0.0047657759546885399,1.1171231099755856,-0.01394720312672771,-9.7674019587457774],"FOG":[0.79020187091650529],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[5.7072214697160284,-13.392777221959451,-26.508744199007769,60.329900318098346,60.329900318098346],"omega_rad_s":[5.6877444211816908,-13.286968718506914,-26.474909611296077,60.284083298986005,60.284093630493039],"thrust_n":[0.40910529574084059,-2.2274437428785245,-8.9035920199190457,46.48407083989337,46.466223981339105],"torque_nm":[-0.0076707242951407611,0.041764570178972338,0.16694235037348215,-0.87157632824800069,-0.87124169965010823],"angle_rad":[-573.81313465919948,402.80838571969338,-627.73410280890698,1984.6648177999373,1984.6648759162922]},"command":[0.054354490187771699,-0.12755025925675667,-0.25246423046674066,0.57457047921998428,0.57457047921998428],"arm":{"servo_position":[2.5808035111652679e-24,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,-3.3881317890157044e-23],"servo_velocity":[0,-8.6736173798840355e-19,0,0,0,0],"servo_effort":[-0.0068029071215659738,-1.4590134675507338,-0.26950760181077826,-1.6033433540251724e-05,-0.00048663477487743571,0.00019068522979392785]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":725,"step":5800,"t":29,"sim_time":28.999999999998515,"vehicle":{"origin_ned":[1.5018616568181635,1.0097951460166938,3.5113713604337331],"origin_quat_xyzw":[-0.02098969698203906,0.052896187148027525,0.37648698093386002,0.92467236316065493],"cg_ned":[1.4412245661089369,0.95137417754134757,3.2187862186306324],"linear_velocity_ned":[-0.0020707569613864774,-0.0040682517103312532,-0.0030306319483061222],"angular_velocity_ned":[0.00042575045578938472,-0.00035083292354153419,-0.0014039618325637966]},"sensors":{"Odom":[1.5018616568181635,1.0097951460166938,3.5113713604337331,-0.0041167269834082474,-0.0016036895678918927,-0.0034731337183998129,-0.020989696982039077,0.052896187148027574,0.37648698093386035,0.92467236316065493,0.00021871361605278723,-0.0005498650900675145,-0.0013875405417571127],"Pressure":[26954.846560211987],"DVL":[-0.0052567111105340132,0.041400796586984007,-0.0040429807859796952,7.3431135130317999,0.019556405575679347,0.017670639770323501,0.031096070003212035,0],"IMU":[0.0010188651739691911,0.11387392620109599,0.77338023802436684,-0.0091271056322773884,0.058010115559305381,-0.11083187691343349,1.1203835614764395,-0.0089514087112528406,-9.7493398797220099],"FOG":[0.77703977404888214],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[5.6939751241049255,-13.349324299889881,-26.534584161697325,60.338883416131011,60.338883416131011],"omega_rad_s":[5.6723186864599722,-13.240128323169808,-26.50026805812729,60.293719243186224,60.293727202262623],"thrust_n":[0.40687542658783155,-2.2122256863427419,-8.9213980784505154,46.500715491586213,46.484070389922458],"torque_nm":[-0.0076289142485218417,0.041479231618926415,0.16727621397094714,-0.8718884154672415,-0.87157631981104611],"angle_rad":[-573.58597973193844,402.27798236250885,-628.79367620271034,1987.0764004050116,1987.076458881337]},"command":[0.054228334515285005,-0.12713642190371316,-0.25271032534949833,0.57465603253458108,0.57465603253458108],"arm":{"servo_position":[2.5808035111652679e-24,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,-3.3881317890157044e-23],"servo_velocity":[1.6940658945086007e-21,0,0,0,0,0],"servo_effort":[-0.0062399998234173989,-1.4581750648017253,-0.26906231206812503,-1.504876705416824e-05,-0.00048370697621050017,0.00018752907562540164]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":726,"step":5808,"t":29.039999999999999,"sim_time":29.039999999998507,"vehicle":{"origin_ned":[1.5017791262341906,1.0096254810313965,3.511249847300506],"origin_quat_xyzw":[-0.02098341988716234,0.052887403618318694,0.37646200083485659,0.92468317847561621],"cg_ned":[1.4411428552542582,0.95121251669668594,3.2186629375275344],"linear_velocity_ned":[-0.0020210622871383549,-0.0040207396871886738,-0.0031215468710881523],"angular_velocity_ned":[0.00038145254586024698,-0.00033634534976396762,-0.001336311968958055]},"sensors":{"Odom":[1.5017791262341906,1.0096254810313965,3.511249847300506,-0.0040256489140898322,-0.0015927219088223807,-0.003557632232132216,-0.020983419887162354,0.052887403618318743,0.37646200083485692,0.92468317847561621,0.00018958894763459997,-0.00050848829552338048,-0.0013228225888917218],"Pressure":[26954.922021735754],"DVL":[-0.012371660922414178,0.019964072043826938,-0.017057974724015861,7.347174056047554,-0.013201991340452046,-0.00012477590878340412,0.0010670930197214034,0],"IMU":[0.0010207736923527647,0.11385291553652488,0.77332581905909925,0.035367956987806648,-0.026104433413178606,-0.12928383234630922,1.1289911327245314,-0.019002319583312131,-9.759139080834041],"FOG":[0.76980483021043],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[5.6812772406654739,-13.307624680597806,-26.560765717546097,60.347987264629026,60.347987264629026],"omega_rad_s":[5.6578921099485129,-13.19554429575386,-26.526151773425628,60.303479486384575,60.303485048877171],"thrust_n":[0.40479619641362052,-2.197809650239015,-8.9395690292199355,46.517445715820124,46.502032788747584],"torque_nm":[-0.0075899286827553871,0.041208930941981532,0.16761691929787381,-0.87220210717162738,-0.87191311478901723],"angle_rad":[-573.35941858658612,401.74940067059191,-629.85427611399371,1989.488371305539,1989.4884300463743]},"command":[0.054107402292052131,-0.12673928267236007,-0.25295967350043902,0.5747427358536098,0.5747427358536098],"arm":{"servo_position":[2.5808035111652679e-24,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,-3.3881317890157044e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.0056773782158028368,-1.4573733944627851,-0.26862200191127455,-1.4131452625160772e-05,-0.0004807305630979287,0.00018428449300260654]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":727,"step":5816,"t":29.080000000000002,"sim_time":29.079999999998499,"vehicle":{"origin_ned":[1.5016985905373113,1.0094583973166005,3.5111246383272752],"origin_quat_xyzw":[-0.020977921815591515,0.052879205025024453,0.37643822298493707,0.92469345231171773],"cg_ned":[1.441063120373447,0.95105275422754676,3.2185361010525244],"linear_velocity_ned":[-0.0019719003047785743,-0.0039733315463558799,-0.0032088552766941602],"angular_velocity_ned":[0.0003369583122971114,-0.00032081782883568405,-0.0012694239563969382]},"sensors":{"Odom":[1.5016985905373113,1.0094583973166005,3.5111246383272752,-0.003935168425766182,-0.0015816671043246868,-0.0036386552676182455,-0.020977921815591528,0.052879205025024488,0.37643822298493734,0.92469345231171773,0.00016113207384028344,-0.00046623193007368018,-0.0012587956175484235],"Pressure":[26952.258532607051],"DVL":[0.010188700584312385,-2.2255653188222799e-05,0.049569109982817924,7.2892722203559579,0.0072646143628453683,0.015750801436859058,0.010207413719401528,0],"IMU":[0.0010218275469613307,0.1138335774504132,0.77327399191245727,-0.030560667434870719,0.051887911193306401,-0.013078483180686858,1.1191169088773478,-0.017332612183993588,-9.7242714010240228],"FOG":[0.8007243334926909],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[5.6689583056724313,-13.267510261498913,-26.587219609407985,60.357209526916954,60.357209526916954],"omega_rad_s":[5.6442814275743434,-13.153025942373276,-26.552483334262249,60.313357978776345,60.313361126540116],"thrust_n":[0.40284017807280809,-2.1841239986361476,-8.9580525171517369,46.534254842669569,46.520101261173281],"torque_nm":[-0.0075532533388651514,0.040952324974427773,0.16796348469659506,-0.87251727830005454,-0.87225189864699915],"angle_rad":[-573.13341544058676,401.22255475120534,-630.91592178304415,1991.9007353313764,1991.9007942404303]},"command":[0.053990079101642205,-0.12635724058570394,-0.25321161532769509,0.57483056692301859,0.57483056692301859],"arm":{"servo_position":[2.5808035111652679e-24,-1.0842021724855024e-21,9.7514668052651336e-21,-6.7365589086318584e-23,4.3198680309969292e-21,-3.3881317890157044e-23],"servo_velocity":[0,0,0,-1.3552527156068805e-20,0,0],"servo_effort":[-0.0051156313568466744,-1.4566122549982494,-0.26818808997502397,-1.3268884330770358e-05,-0.00046439210634488585,0.00018144127443022663]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":728,"step":5824,"t":29.120000000000001,"sim_time":29.119999999998491,"vehicle":{"origin_ned":[1.501620041027415,1.009293888373499,3.5109958741978677],"origin_quat_xyzw":[-0.020973196392380104,0.052871611581624872,0.37641563336273653,0.92470318950568031],"cg_ned":[1.4409853388431773,0.95089488414061263,3.2184058526201436],"linear_velocity_ned":[-0.0019233286991589583,-0.0039261079809325642,-0.0032925953537845062],"angular_velocity_ned":[0.00029240747722531673,-0.00030427267287166118,-0.0012033252342188434]},"sensors":{"Odom":[1.501620041027415,1.009293888373499,3.5109958741978677,-0.0038454115688806552,-0.0015705702300217166,-0.0037162457842192529,-0.020973196392380124,0.052871611581624921,0.37641563336273687,0.92470318950568031,0.00013342985408792963,-0.00042320951113781558,-0.0011954772248864212],"Pressure":[26952.036424877304],"DVL":[-0.0076733581044497274,0.00075347055075470357,-0.017135282122465192,7.3304806798746158,0.024307524485716613,0.028287952289637434,-0.0090040995690638028,0],"IMU":[0.0010220520245178809,0.11381594456165274,0.77322472838903267,0.01017441915723279,-0.010734153370589474,0.12414967250771472,1.1210081348708925,-0.042701692632886368,-9.758285458732928],"FOG":[0.76443737559201541],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[5.656854028793501,-13.228820732780173,-26.61387851932184,60.366548977763131,60.366548977763131],"omega_rad_s":[5.6313060641373465,-13.112388640815857,-26.579187283844067,60.323350213084808,60.323350934170975],"thrust_n":[0.40098064672344269,-2.1711003321070059,-8.9767974287079593,46.551138734295684,46.538268305120617],"torque_nm":[-0.0075183871260645508,0.04070813122700636,0.16831495178827421,-0.87283385126804425,-0.87259253072101151],"angle_rad":[-572.90794178401768,400.69736620362573,-631.97862939796119,1994.3134971059842,1994.3135560863777]},"command":[0.053874800274223818,-0.12598876888362071,-0.25346550970782705,0.5749195140739346,0.5749195140739346],"arm":{"servo_position":[2.5808035111652679e-24,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,4.3198680309969292e-21,-3.3881317890157044e-23],"servo_velocity":[0,0,0,0,8.6736173798840355e-19,0],"servo_effort":[-0.0045555847956865415,-1.4558959988364868,-0.26776274822853696,-1.247029976499933e-05,-0.00047470835686838636,0.00017762166462527339]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":729,"step":5832,"t":29.16,"sim_time":29.159999999998483,"vehicle":{"origin_ned":[1.5015434665921972,1.0091319429543877,3.5108636943484193],"origin_quat_xyzw":[-0.020969234831606492,0.05286464199765574,0.37639421761624542,0.92471239515975512],"cg_ned":[1.4409094858704068,0.95073889738519723,3.2182723340142476],"linear_velocity_ned":[-0.0018753990467151873,-0.0038791421267002279,-0.0033728098024362494],"angular_velocity_ned":[0.00024793879623244246,-0.00028673720288293215,-0.0011380390713546108]},"sensors":{"Odom":[1.5015434665921972,1.0091319429543877,3.5108636943484193,-0.0037564952002521875,-0.0015594736958528608,-0.0037904499503970445,-0.020969234831606492,0.05286464199765574,0.37639421761624542,0.92471239515975512,0.00010656453368475073,-0.00037953745153613487,-0.0011328813358714995],"Pressure":[26950.746517129901],"DVL":[-0.0081817026662224894,0.023416251425747471,0.013558500799700522,7.346013805587277,-0.013406276003704448,0.0056900625204657921,-0.0081338662727102502,0],"IMU":[0.0010214757235937817,0.11380004488810642,0.77317799966117917,0.06333417450379164,-0.063298273323391246,-0.14467111628434304,1.1053995981374332,-0.0035288142715196374,-9.7728001354177927],"FOG":[0.75907936619794569],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[5.6448053423161646,-13.191403806399324,-26.640677259481581,60.376005313575277,60.376005313575277],"omega_rad_s":[5.6187891081817005,-13.073454677564262,-26.606190225722898,60.333453052184765,60.333451340992411],"thrust_n":[0.39919168061092192,-2.1586736371019311,-8.9957539520537519,46.568095493765853,46.556528565854649],"torque_nm":[-0.0074848440114547877,0.040475130695661214,0.16867038660100786,-0.87315179050810987,-0.87293491060977479],"angle_rad":[-572.68297624878767,400.17376385630604,-633.04241217528568,1996.7266611042164,1996.7267200587353]},"command":[0.053760050879201569,-0.12563241720380308,-0.25372073580458648,0.57500957441500267,0.57500957441500267],"arm":{"servo_position":[2.5808035111652679e-24,-1.0842021724855024e-21,9.7514668052651336e-21,-3.3484271196146569e-23,4.3198680309969292e-21,-3.3881317890157091e-23],"servo_velocity":[0,0,0,-6.7762635780344027e-21,8.6736173798840355e-19,-1.0842021724855044e-19],"servo_effort":[-0.0039980625539546384,-1.4552284265071147,-0.26734789268579523,-1.1721760744398181e-05,-0.00047167292829132371,0.00017471028283013742]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":730,"step":5840,"t":29.199999999999999,"sim_time":29.199999999998475,"vehicle":{"origin_ned":[1.5014688538864467,1.0089725453824685,3.5107282368059116],"origin_quat_xyzw":[-0.020966025994477614,0.052858313402778828,0.3763739611312546,0.92472107461687125],"cg_ned":[1.4408355347331092,0.9505847821506147,3.2181356852184737],"linear_velocity_ned":[-0.0018281570092087091,-0.0038324998077016162,-0.003449545351240185],"angular_velocity_ned":[0.00020368981004565808,-0.00026824305364889168,-0.0010735850633299469]},"sensors":{"Odom":[1.5014688538864467,1.0089725453824685,3.5107282368059116,-0.0036685271488719334,-0.0015484174118502864,-0.003861316737472508,-0.020966025994477628,0.052858313402778863,0.37637396113125482,0.92472107461687125,8.0614105501749194e-05,-0.00033533439081249474,-0.0010710186623420952],"Pressure":[26948.026505544451],"DVL":[0.0047062614899713966,0.018997178454623079,0.0096393913692631485,7.2670730903211815,-0.022376013924068489,0.028204923600918422,-0.00014433248006420955,0],"IMU":[0.001020130397950304,0.11378590174946007,0.77313377640582648,0.0067257180466801748,-0.035098393779589739,-0.087085058036188587,1.110675768768528,-0.019632184972110018,-9.7554613879985315],"FOG":[0.77641796272897357],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[5.6326583373661006,-13.155115516056105,-26.667553068991126,60.385579023141638,60.385579023141638],"omega_rad_s":[5.6065580127114858,-13.036053897360446,-26.633420977453454,60.343664562188181,60.343660419572501],"thrust_n":[0.39744822965829207,-2.1467823813779079,-9.0148736794862145,46.585125187170867,46.574878581368232],"torque_nm":[-0.0074521543060929772,0.040252169650835778,0.16902888149036654,-0.87347109725945393,-0.87327897340065441],"angle_rad":[-572.45850444449729,399.65168347522132,-634.10728044568157,1999.1402317032653,1999.1402905346163]},"command":[0.053644365117772388,-0.12528681443862957,-0.25397669589515359,0.57510075260134896,0.57510075260134896],"arm":{"servo_position":[-1.6543612251062339e-24,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,5.0821976835259514e-22],"servo_velocity":[0,0,0,0,0,1.0842021724855044e-19],"servo_effort":[-0.0034441641150733536,-1.454612885825441,-0.26694526164553073,-1.1014764552547306e-05,-0.00046868486921771785,0.0001708662947508048]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":731,"step":5848,"t":29.240000000000002,"sim_time":29.239999999998467,"vehicle":{"origin_ned":[1.5013961875030346,1.0088156758718092,3.5105896380473656],"origin_quat_xyzw":[-0.020963556458420664,0.052852641278362762,0.37635484909308276,0.92472923343789559],"cg_ned":[1.4407634570103969,0.9504325241567132,3.2179960442691757],"linear_velocity_ned":[-0.0017816425901276479,-0.0037862396190897849,-0.0035228521231968298],"angular_velocity_ned":[0.00015979602113790688,-0.00024882582830458133,-0.0010099794346010316]},"sensors":{"Odom":[1.5013961875030346,1.0088156758718092,3.5105896380473656,-0.0035816062844544832,-0.0015374385854862486,-0.0039288973627911242,-0.020963556458420681,0.052852641278362804,0.37635484909308303,0.92472923343789559,5.5651997665975562e-05,-0.00029072037496536644,-0.0010098970433939146],"Pressure":[26947.629621706739],"DVL":[-0.022616255937703552,-0.035236194372403655,0.010289801075547535,7.3335904394606226,-0.0036546485745658341,-0.0028432530095990438,0.030968860111924238,0],"IMU":[0.001018050784228206,0.11377353369223564,0.77309202892643281,0.04335396027290786,-0.029530293700623048,0.12266495818934574,1.1219269155399467,-0.0037396241208814494,-9.7424307626705922],"FOG":[0.78203620744344438],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[5.620265454741987,-13.119820049925076,-26.694445690948164,60.395271252346156,60.395271252346156],"omega_rad_s":[5.5944452279118471,-13.000024097261225,-26.660810721472597,60.35398385769593,60.353977291036713],"thrust_n":[0.39572618182285368,-2.1353685343432462,-9.0341097101296075,46.602229582206775,46.593316542015074],"torque_nm":[-0.007419865909178508,0.040038160018935863,0.16938955706493014,-0.87379180466637718,-0.8736246851627828],"angle_rad":[-572.23451877113325,399.13106745211263,-635.1732417459898,2001.5542132272756,2001.5542718383465]},"command":[0.053526337664209403,-0.12495066714214359,-0.25423281610426823,0.57519305954615385,0.57519305954615385],"arm":{"servo_position":[-1.6543612251062339e-24,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,-3.3881317890157091e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.0028950035694183455,-1.4540522614507134,-0.26655640102198452,-1.0345650030390451e-05,-0.00046570679801803309,0.00016750373315961814]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":732,"step":5856,"t":29.280000000000001,"sim_time":29.279999999998459,"vehicle":{"origin_ned":[1.5013254501482527,1.0086613108396629,3.5104480328786689],"origin_quat_xyzw":[-0.020961810583893906,0.05284763940861617,0.37633686654105014,0.92473687738082855],"cg_ned":[1.4406932228050877,0.95028210693445458,3.2178535471308716],"linear_velocity_ned":[-0.0017358903335706333,-0.0037404132765547519,-0.0035927831631382607],"angular_velocity_ned":[0.0001163907223575016,-0.00022852438586582431,-0.00094723548768870295]},"sensors":{"Odom":[1.5013254501482527,1.0086613108396629,3.5104480328786689,-0.0034958227690459567,-0.0015265719744215268,-0.0039932448998457682,-0.020961810583893913,0.052847639408616191,0.37633686654105025,0.92473687738082855,3.1747496010937773e-05,-0.00024581622885774048,-0.00094952184938015155],"Pressure":[26947.083177307755],"DVL":[-0.028972772337546231,-0.0063724172195998956,0.012083009080384916,7.2924073241761826,-0.035277109221899243,-0.014526501662619427,-0.0096552456911864395,0],"IMU":[0.0010152744477571691,0.11376295444928988,0.77305272726114205,-0.011058975542808306,-0.011447079169510812,-0.081488855573144434,1.1023885201852526,-0.012454849827233355,-9.740957676421953],"FOG":[0.78112048372986709],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[5.6074843979823159,-13.085389930489043,-26.72129759024391,60.405083657831376,60.405083657831376],"omega_rad_s":[5.5822885803160522,-12.965211343954033,-26.68829318005038,60.36441094425556,60.364401967481982],"thrust_n":[0.39400239989201091,-2.1243775712903368,-9.0534167702613502,46.619411885059897,46.611842049204284],"torque_nm":[-0.0073875449979752044,0.039832079461693821,0.16975156444240039,-0.87411397284487313,-0.87397203842258031],"angle_rad":[-572.01101820818633,398.61186447888377,-636.24030091788916,2003.9686099856681,2003.968668279789]},"command":[0.053404613314117291,-0.12462276124275279,-0.25448854847851343,0.57528651102696549,0.57528651102696549],"arm":{"servo_position":[-1.6543612251062339e-24,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,-1.1180834903756616e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[-0.0023519592747772919,-1.453549024805487,-0.2661827754451932,-9.7061699947976235e-06,-0.00046276917226742382,0.00016417807479270047]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":733,"step":5864,"t":29.32,"sim_time":29.319999999998451,"vehicle":{"origin_ned":[1.501256622812182,1.0085094232118161,3.5103035543339907],"origin_quat_xyzw":[-0.020960770585258567,0.052843319841701555,0.37631999841230623,0.92474401238371995],"cg_ned":[1.4406248009556888,0.95013351209620112,3.217708327594043],"linear_velocity_ned":[-0.0016909295956880281,-0.0036950658817754439,-0.003659393786612715],"angular_velocity_ned":[7.3604463493119572e-05,-0.0002073804875288859,-0.00088536397291449768]},"sensors":{"Odom":[1.501256622812182,1.0085094232118161,3.5103035543339907,-0.0034112583228469262,-0.0015158498728332316,-0.0040544137097778959,-0.020960770585258571,0.052843319841701569,0.37631999841230634,0.92474401238371995,8.9656509064712256e-06,-0.00020074293241150967,-0.00088989636496584427],"Pressure":[26945.022298609209],"DVL":[0.016834510173208358,0.025153776901900494,0.001635281351111397,7.4436690059695092,-0.038931328498855916,0.033639892088719911,-0.0089353304500053507,0],"IMU":[0.001011841626992058,0.11375417292084312,0.7730158412683823,0.03138508958659722,-0.021971580374369856,-0.0086471975916667162,1.1253781214325034,-0.022361297310334115,-9.7492509580346844],"FOG":[0.7641142509612644],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[5.5941783752800696,-13.051705414591229,-26.748054245678684,60.415018270496468,60.415018270496468],"omega_rad_s":[5.5699314471227952,-12.931470043468568,-26.715804808176994,60.374946569562326,60.374935203138193],"thrust_n":[0.39225473593081667,-2.1137584052278733,-9.0727513480284792,46.636676489253134,46.63045588167077],"torque_nm":[-0.0073547762987028129,0.039632970098022628,0.17011408777553405,-0.87443768417349621,-0.87432104778132691],"angle_rad":[-571.78800809562597,398.09402921436248,-637.30846021367313,2006.3834263054239,2006.3834841866292]},"command":[0.053277889288381619,-0.12430195632944027,-0.25474337376836842,0.57538112638568062,0.57538112638568062],"arm":{"servo_position":[-1.6543612251062339e-24,-1.0842021724855024e-21,1.0778494253810979e-21,-3.3484271196146569e-23,-4.3537493488871065e-21,-1.1180834903756616e-21],"servo_velocity":[0,0,-1.7347234759768071e-18,-6.7762635780344027e-21,0,0],"servo_effort":[-0.0018162096517311962,-1.4531051213457833,-0.26582563331605397,-9.0874831436745984e-06,-0.00045988012850641658,0.00016090653536261011]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":734,"step":5872,"t":29.359999999999999,"sim_time":29.359999999998443,"vehicle":{"origin_ned":[1.5011896849310067,1.0083599827309258,3.5101563335890269],"origin_quat_xyzw":[-0.020960416619458109,0.052839692863865792,0.37630422958831455,0.92475064454540168],"cg_ned":[1.440558159237523,0.94998671959606173,3.2175605171898765],"linear_velocity_ned":[-0.0016467848158771199,-0.0036502360872454351,-0.0037227413061325476],"angular_velocity_ned":[3.1563838236887666e-05,-0.00018543839129053145,-0.0008243731490586286]},"sensors":{"Odom":[1.5011896849310067,1.0083599827309258,3.5101563335890269,-0.0033279862229467073,-0.0015053018686412422,-0.0041124592653740801,-0.02096041661945813,0.052839692863865848,0.37630422958831489,0.92475064454540168,-1.2633298637089774e-05,-0.00015562048492550324,-0.0008310219167835481],"Pressure":[26943.62367230314],"DVL":[-0.010478616095617904,-0.002527135277335587,0.033890795328943762,7.299638340135818,-0.00064791797593172771,-0.0022143928689432536,-0.011390778763969803,0],"IMU":[0.0010077950549493059,0.1137471931930427,0.7729813407178191,0.056305952234211143,-0.0070214316871269377,0.082442352975843097,1.1017278021973369,0.0033675809748436782,-9.7257301355692309],"FOG":[0.76926271750330466],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[5.5802171963011551,-13.018655289479501,-26.774663881931232,60.425077402431178,60.425077402431178],"omega_rad_s":[5.5572231055019179,-12.89866309706581,-26.743284891567381,60.385592078101126,60.385578348968231],"thrust_n":[0.39046207655783138,-2.1034633572745354,-9.0920717644207745,46.654028731092446,46.649159783511877],"torque_nm":[-0.0073211639354593388,0.039439937948897552,0.17047634558288954,-0.87476303870798333,-0.87467174594084762],"angle_rad":[-571.56549990558688,397.57752194832733,-638.37771940827747,2008.798666557328,2008.7987239306162]},"command":[0.053144925679058617,-0.1239871932331381,-0.25499679887553556,0.57547692764220171,0.57547692764220171],"arm":{"servo_position":[4.6322114302951701e-25,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,-1.1180834903756616e-21],"servo_velocity":[0,0,0,6.7762635780344027e-21,0,0],"servo_effort":[-0.0012891918379686208,-1.4527219492962655,-0.26548606869918739,-8.4903534976338867e-06,-0.00045705171296004027,0.0001577030075863779]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":735,"step":5880,"t":29.400000000000002,"sim_time":29.399999999998435,"vehicle":{"origin_ned":[1.5011246145504711,1.0082129562627888,3.5100064998916904],"origin_quat_xyzw":[-0.020960726883273863,0.052836766992718193,0.37628954492712291,0.92475678011076001],"cg_ned":[1.4404932645550763,0.94984170798072121,3.2174102451259361],"linear_velocity_ned":[-0.0016034757517656951,-0.0036059564395406266,-0.0037828843710730011],"angular_velocity_ned":[-9.6090333205806381e-06,-0.00016274432520569756,-0.00076426921186873353]},"sensors":{"Odom":[1.5011246145504711,1.0082129562627888,3.5100064998916904,-0.0032460715633152205,-0.001494954955121613,-0.0041674375820730126,-0.02096072688327388,0.052836766992718234,0.37628954492712324,0.92475678011076001,-3.2993880450642529e-05,-0.00011056716850408876,-0.00077289830005005625],"Pressure":[26943.967605079244],"DVL":[-0.043479134604637995,-0.0017507685818134492,-0.0021860057046826252,7.2474469419543297,0.031409706695014375,0.014924947645882472,0.01091714945505754,0],"IMU":[0.0010031797773975902,0.11374201459848657,0.77294919535140072,-0.017559894764897083,-0.061112409413220693,-0.1569839744821114,1.1142684437872212,-0.0017232391515201347,-9.7473264804394635],"FOG":[0.78362622985566954],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[5.5654769186317692,-12.98613614468608,-26.801078181610638,60.435263515526771,60.435263515526771],"omega_rad_s":[5.5440190681867652,-12.866661922291001,-26.770675767322686,60.396349282567037,60.396333224039722],"thrust_n":[0.38860439103086014,-2.0934480895539229,-9.1113383305737266,46.671474665462789,46.667956265653466],"torque_nm":[-0.0072863323318286266,0.039252151679136066,0.17083759369825735,-0.87509014997742751,-0.87502417998100246],"angle_rad":[-571.34351099744845,397.06230826028724,-639.44807591699953,2011.2143351769898,2011.2143919485816]},"command":[0.053004542082207326,-0.12367748709224838,-0.25524836363438702,0.57557393824311209,0.57557393824311209],"arm":{"servo_position":[4.6322114302951701e-25,-1.0842021724855024e-21,9.7514668052651336e-21,-3.3484271196146569e-23,-1.6940658945088655e-23,-1.1180834903756616e-21],"servo_velocity":[2.1175823681357508e-22,0,0,-6.7762635780344027e-21,0,0],"servo_effort":[-0.00077204767479421735,-1.4524005259433439,-0.26516498642663361,-7.9039837745916075e-06,-0.00045429262328473526,0.00015458006233489571]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":736,"step":5888,"t":29.440000000000001,"sim_time":29.439999999998427,"vehicle":{"origin_ned":[1.5010613885059163,1.0080683080559911,3.5098541805091106],"origin_quat_xyzw":[-0.020961677643195405,0.052834548999676059,0.37627592926307196,0.92476242546915532],"cg_ned":[1.4404300831164929,0.94969845462760549,3.2172576382384603],"linear_velocity_ned":[-0.0015610181546769348,-0.0035622534351151419,-0.0038398827202032748],"angular_velocity_ned":[-4.9788400810806736e-05,-0.00013933826171826571,-0.00070506282641351618]},"sensors":{"Odom":[1.5010613885059163,1.0080683080559911,3.5098541805091106,-0.0031655717365857575,-0.0014848370231019751,-0.0042194050490554514,-0.020961677643195422,0.052834548999676101,0.3762759292630723,0.92476242546915532,-5.2053179247197974e-05,-6.5699324454643703e-05,-0.00071552895854790132],"Pressure":[26942.353363355905],"DVL":[0.018082920882999336,0.019801824743110884,0.0044514222648930381,7.383869099281462,0.0023154045344895837,-0.0084196727620551963,0.021216562401150624,0],"IMU":[0.00099804311447462195,0.11373863177997612,0.77291937488227858,-0.070563849932225226,-0.0073987074238619117,0.090392681493958155,1.1121775127944857,-0.022199005508046661,-9.7283436909357253],"FOG":[0.77459237650500035],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[5.5498399079922107,-12.95405222102006,-26.82725176585615,60.445579109156711,60.445579109156711],"omega_rad_s":[5.5301812704759055,-12.835346386152727,-26.797922898396529,60.40722032771744,60.407201979341792],"thrust_n":[0.38666276495131252,-2.0836715118266596,-9.1305134160753685,46.689020849007008,46.686848392128866],"torque_nm":[-0.0072499268428371094,0.039068840846749865,0.17119712655141317,-0.87541914091888151,-0.87537840735241623],"angle_rad":[-571.12206436379392,396.54835867985599,-640.51952491993711,2013.6304366803954,2013.6304927579847]},"command":[0.052855618171354389,-0.12337192591447677,-0.25549763586529667,0.57567218199196868,0.57567218199196868],"arm":{"servo_position":[-6.6174449004420709e-26,-1.0842021724855024e-21,1.0778494253810979e-21,3.9704669402544482e-25,-1.6940658945088655e-23,-1.1180834903756616e-21],"servo_velocity":[0,0,-1.7347234759768071e-18,0,0,0],"servo_effort":[-0.00027097272099710677,-1.4521412884248515,-0.26486308307680734,-7.3328786421122894e-06,-0.00045161105415920168,0.00015154841865270118]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":737,"step":5896,"t":29.48,"sim_time":29.479999999998419,"vehicle":{"origin_ned":[1.5009999828101945,1.0079259998021528,3.5096995006834035],"origin_quat_xyzw":[-0.020963242817795279,0.052833044159250227,0.37626336717049153,0.92476758724608887],"cg_ned":[1.440368580567513,0.94955693600388003,3.2171028209609287],"linear_velocity_ned":[-0.0015194245134242772,-0.0035191473628243659,-0.0038937966418297093],"angular_velocity_ned":[-8.8837191159158059e-05,-0.00011524243066866413,-0.00064677750094024292]},"sensors":{"Odom":[1.5009999828101945,1.0079259998021528,3.5096995006834035,-0.0030865360615787117,-0.0014749808937557195,-0.0042684180897923953,-0.020963242817795293,0.052833044159250261,0.37626336717049175,0.92476758724608887,-6.972644795793476e-05,-2.1128507721731989e-05,-0.00065892777198916033],"Pressure":[26940.209746449556],"DVL":[-0.0054115123528564275,0.0024619089704162331,0.033552886802460602,7.4175109908734447,-0.04070406625036143,-0.008317777824099511,0.010709532569827783,0],"IMU":[0.00099243559804931239,0.11373703483752044,0.77289184854103565,-0.012056423265564577,-0.0033219474212454378,-0.15516418647737285,1.1313653860617725,-0.012139832376263182,-9.7356822583059479],"FOG":[0.77155959836358279],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[5.5331524610068392,-12.922298727006837,-26.853150970932806,60.456026658608636,60.456026658608636],"omega_rad_s":[5.515568177793126,-12.804600770147037,-26.824976934164951,60.41820758044652,60.41818698780807],"thrust_n":[0.38461802808404594,-2.0740943954968749,-9.1495628914552807,46.706674123738068,46.705839644955397],"torque_nm":[-0.0072115880265758618,0.038889269915566405,0.17155430421478648,-0.87575013982008909,-0.87573449334291364],"angle_rad":[-570.90118855030312,396.0356484217964,-641.59205952373384,2016.04697567468,2016.0470309676789]},"command":[0.05269669010482704,-0.1230695116857794,-0.25574429496126483,0.57577168246293942,0.57577168246293942],"arm":{"servo_position":[1.3234889800830593e-25,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,-1.1180834903756616e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.0002120332452326522,-1.4519437383115281,-0.26458080380270227,-6.7654847413566384e-06,-0.00044901023958953112,0.00014861868252178634]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":738,"step":5904,"t":29.52,"sim_time":29.519999999998412,"vehicle":{"origin_ned":[1.500940372632068,1.0077859910954192,3.5095425836000089],"origin_quat_xyzw":[-0.020965394494941701,0.052832256129941052,0.37625184317029237,0.92477227221454328],"cg_ned":[1.4403087221724722,0.94941712784658439,3.2169459153059199],"linear_velocity_ned":[-0.0014787022111118157,-0.0034766547457417201,-0.003944686782549606],"angular_velocity_ned":[-0.00012665411964441915,-9.050906690626873e-05,-0.00058941225080812892]},"sensors":{"Odom":[1.500940372632068,1.0077859910954192,3.5095425836000089,-0.0030090065583972089,-0.0014654045796868736,-0.0043145329356859188,-0.020965394494941711,0.05283225612994108,0.37625184317029259,0.92477227221454328,-8.5977977966047385e-05,2.3037254638161536e-05,-0.00060308957114300823],"Pressure":[26938.185025512645],"DVL":[-0.0016655519219181676,-0.0078026184684099878,-0.02127207424977947,7.3022274928569848,-0.016537172105576984,8.1974517460492625e-06,0.0049361191842177696,0],"IMU":[0.00098640994442715686,0.1137372094971497,0.77286658546806308,0.042216614976083124,-0.020075252791084675,0.039219242323392509,1.1077795681842268,0.0024374801081961713,-9.7481119695762555],"FOG":[0.77496721924266521],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[5.515294976572652,-12.890789281570537,-26.878740294363936,60.466608545924494,60.466608545924494],"omega_rad_s":[5.5000385662002591,-12.774315110711081,-26.851793184803007,60.429313526434861,60.429290740907263],"thrust_n":[0.38245129575511122,-2.0646798137059585,-9.1684556964306623,46.724441462114221,46.72493374720154],"torque_nm":[-0.0071709617954083356,0.038712746506986723,0.17190854430807495,-0.87608327741464165,-0.87609250776002878],"angle_rad":[-570.68091782404804,395.52415722449825,-642.66567098000439,2018.4639568645837,2018.4640112843585]},"command":[0.05252661882450145,-0.12276942172924321,-0.25598800280346606,0.57587246234213807,0.57587246234213807],"arm":{"servo_position":[1.3234889800830593e-25,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,-1.1180834903756616e-21],"servo_velocity":[0,-8.6736173798840355e-19,0,0,0,0],"servo_effort":[0.00068266727683080684,-1.4518075415590601,-0.26431848809061725,-6.2030765306317317e-06,-0.00044649714121498032,0.00014579660474842125]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":739,"step":5912,"t":29.560000000000002,"sim_time":29.559999999998404,"vehicle":{"origin_ned":[1.5008825322821149,1.0076482398472815,3.5093835503741877],"origin_quat_xyzw":[-0.020968103376842129,0.052832186837715761,0.3762413419129228,0.92477648721747119],"cg_ned":[1.44025047298261,0.9492790053396003,3.216787040860992],"linear_velocity_ned":[-0.0014388550573996156,-0.0034347873528457755,-0.0039926137532824008],"angular_velocity_ned":[-0.00016314497903924296,-6.5193336176892135e-05,-0.00053296327520733361]},"sensors":{"Odom":[1.5008825322821149,1.0076482398472815,3.5093835503741877,-0.0029330186071201423,-0.0014561228688211463,-0.0043578052617740202,-0.02096810337684215,0.05283218683771581,0.37624134191292313,0.92477648721747119,-0.00010077943807739888,6.669277805747933e-05,-0.00054800719539354237],"Pressure":[26936.196738375536],"DVL":[0.01201252667650906,-0.017425059918508463,0.017059302194164801,7.4390259834284214,0.010968710130375306,0.014239070964849717,0.00902290227399212,0],"IMU":[0.00098002016028164891,0.11373913722995094,0.77284355506126068,-0.022185634399189465,-0.0075333554489293852,0.1434278840771101,1.1102790639302385,-0.004501681778611941,-9.7697365201065303],"FOG":[0.76809304624563746],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[5.4961750942345073,-12.859453089026639,-26.903983256685393,60.477326915418928,60.477326915418928],"omega_rad_s":[5.4834649208218158,-12.744390334380427,-26.878329028504254,60.440540663153762,60.440515741634471],"thrust_n":[0.38014587405250971,-2.0553947471640739,-9.1871621213813981,46.742329804782152,46.744134473344388],"torque_nm":[-0.0071277351384845594,0.038538651509326394,0.17225928977590121,-0.87641868383966548,-0.87645252137520746],"angle_rad":[-570.46129178638409,395.01386897544751,-643.74034879988324,2020.881385054849,2020.8814385149471]},"command":[0.052344524706995306,-0.1224709818002537,-0.25622841196843232,0.57597454205160881,0.57597454205160881],"arm":{"servo_position":[1.3234889800830593e-25,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,-1.1180834903756616e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.0011404140962836115,-1.4517320997182854,-0.264076336460216,-5.6457721482701997e-06,-0.00044407516993066117,0.00014308687030863392]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":740,"step":5920,"t":29.600000000000001,"sim_time":29.599999999998396,"vehicle":{"origin_ned":[1.5008264353185807,1.0075127025479178,3.5092225200415332],"origin_quat_xyzw":[-0.020971338919462543,0.052832836485876153,0.37623184819911931,0.92478023915601504],"cg_ned":[1.4401937979700319,0.94914254329396508,3.2166263147892358],"linear_velocity_ned":[-0.0013998836215106682,-0.0033935526355881726,-0.0040376381299210345],"angular_velocity_ned":[-0.00019822213892802562,-3.935226928282519e-05,-0.00047742572385761834]},"sensors":{"Odom":[1.5008264353185807,1.0075127025479178,3.5092225200415332,-0.0028586013636235029,-0.0014471478721284591,-0.0043982902720233856,-0.020971338919462557,0.052832836485876188,0.37623184819911953,0.92478023915601504,-0.0001141085800673213,0.00010973613125627292,-0.00049367312334358071],"Pressure":[26934.082064689133],"DVL":[-0.014381408904665521,0.03296138471516024,-0.008065268321356435,7.3979596742764899,-0.019312443483243513,0.0061118561438628614,0.030187330694145691,0],"IMU":[0.00097332129316006065,0.11374279537498985,0.77282272700985566,-0.0012895592794274385,-0.0234252342606272,-0.02559801515139196,1.1176393945223841,-0.013272578287947225,-9.7405892913299716],"FOG":[0.77759532544667043],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[5.4757081815411821,-12.828225924100408,-26.928846299083204,60.488183685393246,60.488183685393246],"omega_rad_s":[5.4657319313316037,-12.714737241327736,-26.904544160559546,60.451891411208294,60.451864415850615],"thrust_n":[0.37768705640203881,-2.0462096969456489,-9.2056539917717028,46.760345920324355,46.763445519641785],"torque_nm":[-0.0070816323075382293,0.038366431817730924,0.17260601234571946,-0.87675648600608169,-0.87681460349328355],"angle_rad":[-570.24235485689655,394.50477129661385,-644.8160808415372,2023.2992651485031,2023.2993175648662]},"command":[0.052149601728963636,-0.12217358022952771,-0.25646520284841146,0.57607793986088807,0.57607793986088807],"arm":{"servo_position":[1.3234889800830593e-25,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,-1.1180834903756616e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.0015845681414163064,-1.4517164271834038,-0.26385438249529414,-5.0936451588638715e-06,-0.00044174800143034879,0.00014049435998670056]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":741,"step":5928,"t":29.640000000000001,"sim_time":29.639999999998388,"vehicle":{"origin_ned":[1.5007720546476497,1.0073793345177693,3.5090596095580127],"origin_quat_xyzw":[-0.020975069477787243,0.052834203571020269,0.37622334699845905,0.92478353497815635],"cg_ned":[1.4401386621538601,0.94900771631410319,3.2164638518406519],"linear_velocity_ned":[-0.001361785417029883,-0.0033529540497700995,-0.0040798200050976468],"angular_velocity_ned":[-0.00023180527090834862,-1.3044891250720936e-05,-0.00042279315095595865]},"sensors":{"Odom":[1.5007720546476497,1.0073793345177693,3.5090596095580127,-0.0027857780397675955,-0.0014384888969174211,-0.0044360423168997021,-0.020975069477787253,0.05283420357102029,0.37622334699845922,0.92478353497815635,-0.00012594990759676978,0.00015206904969195567,-0.00044007899996029669],"Pressure":[26933.900516535406],"DVL":[-0.024101517089787094,-0.00079905795075694685,-0.018648880590410671,7.3070279644880225,-0.028545418911042359,-0.0042174703850753233,0.0078931736086026681,0],"IMU":[0.00096636917541215487,0.11374815727793448,0.77280407132345386,0.080456737570694201,0.1010743484472357,-0.066981548722349252,1.1134326812847888,-0.023489337994099791,-9.778992955168297],"FOG":[0.77534249522861354],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[5.4538173995075701,-12.797050195692769,-26.953298658104877,60.499180486043286,60.499180486043286],"omega_rad_s":[5.4467351687741585,-12.68527552697517,-26.930400837870589,60.463368049365194,60.463339047302256],"thrust_n":[0.37506194650239139,-2.0370983239712883,-9.2239048412966547,46.778496289920916,46.782870400924821],"torque_nm":[-0.0070324114969198392,0.038195593574461652,0.1729482157743123,-0.87709680543601731,-0.87717882001734016],"angle_rad":[-570.0241558175012,393.99685517369608,-645.89285340912113,2025.71760214237,2025.717653433539]},"command":[0.051941118090548286,-0.12187666853040732,-0.25669808245814169,0.57618267129565037,0.57618267129565037],"arm":{"servo_position":[-1.9852334701274449e-24,3.2526065174565154e-21,9.7514668052651336e-21,3.9704669402544482e-25,4.3198680309969292e-21,-1.1180834903756616e-21],"servo_velocity":[0,8.6736173798840355e-19,0,0,8.6736173798840355e-19,0],"servo_effort":[0.0020148295441372701,-1.4517592585005916,-0.26365253388109733,-4.5389851230388555e-06,-0.00043951679118240256,0.00013802085803601394]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":742,"step":5936,"t":29.68,"sim_time":29.67999999999838,"vehicle":{"origin_ned":[1.5007193626178981,1.0072480901482386,3.5088949338119484],"origin_quat_xyzw":[-0.020979262449250032,0.052836284907407778,0.37621582346122256,0.92478638166966043],"cg_ned":[1.4400850307148945,0.94887449895303677,3.2162997643766538],"linear_velocity_ned":[-0.0013245552114046293,-0.0033129912089849686,-0.0041192187847652103],"angular_velocity_ned":[-0.00026382099494239952,1.3668495084152648e-05,-0.00036905826388193341]},"sensors":{"Odom":[1.5007193626178981,1.0072480901482386,3.5088949338119484,-0.0027145661723791729,-0.0014301526207137001,-0.0044711147437897685,-0.020979262449250042,0.052836284907407806,0.37621582346122273,0.92478638166966043,-0.00013629384419903907,0.00019359720018470832,-0.00038721629534912413],"Pressure":[26932.477217883861],"DVL":[0.0058048129637242639,-0.051954726069982207,0.016925680526806958,7.3518504976318493,0.0053166288094713774,0.010344832493781297,-0.022564543677834146,0],"IMU":[0.00095922017701899212,0.11375519244388455,0.77278755834745871,-0.0058494994778156189,-0.031077309115699687,-0.071347667761489666,1.1344277878812736,-0.00018166813470886674,-9.7684311851600896],"FOG":[0.76648487583997527],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[5.4304333972975201,-12.765874285970677,-26.977312430248308,60.510318563143564,60.510318563143564],"omega_rad_s":[5.4263802302305368,-12.655933062563626,-26.955864002800823,60.474972632823032,60.474941695881022],"thrust_n":[0.37225934816051182,-2.0280371774965138,-9.241890006445816,46.796786971651258,46.802412323794222],"torque_nm":[-0.0069798627780095967,0.038025697078059632,0.17328543762085907,-0.87743975571846122,-0.87754523107114168],"angle_rad":[-569.80674739636629,393.4901146160654,-646.97065135781315,2028.136401119516,2028.1364512068242]},"command":[0.051718413307595433,-0.12157975510448263,-0.2569267850499839,0.57628874822041487,0.57628874822041487],"arm":{"servo_position":[-1.9852334701274449e-24,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,-3.3881317890157185e-23],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.0024308172705271463,-1.4518590462196972,-0.2634705369252156,-3.992475339499524e-06,-0.00043738341221977986,0.00013566584178636263]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":743,"step":5944,"t":29.719999999999999,"sim_time":29.719999999998372,"vehicle":{"origin_ned":[1.5006683311057134,1.0071189231247661,3.5087286056400346],"origin_quat_xyzw":[-0.020983884415703865,0.052839075651846978,0.37620926292721707,0.9247887862462687],"cg_ned":[1.4400328691003033,0.94874286585098799,3.2161341623985811],"linear_velocity_ned":[-0.0012881852643361292,-0.0032736606318100724,-0.0041558931370255939],"angular_velocity_ned":[-0.00029420289931147167,4.0726012778052775e-05,-0.00031621312889858622]},"sensors":{"Odom":[1.5006683311057134,1.0071189231247661,3.5087286056400346,-0.0026449783751498093,-0.0014221434094646031,-0.004503559915623059,-0.020983884415703865,0.052839075651846971,0.37620926292721707,0.9247887862462687,-0.00014513693102297849,0.00023422998192030504,-0.00033507653422875316],"Pressure":[26929.506373089171],"DVL":[0.010585305379470559,0.020881737832903539,-0.023815856021716306,7.2901095514332548,-0.0016899306270123813,-0.0029011564886468662,-0.0058308692632905081,0],"IMU":[0.00095193096110023697,0.11376386669006151,0.77277315877204966,-0.033697377318573328,-0.050380329971918901,-0.02905963977829136,1.1193444005688977,-0.019770232337252981,-9.7646056562896373],"FOG":[0.77854140992734344],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[5.4054943055106284,-12.734652408658889,-27.000862370861423,60.521598767105644,60.521598767105644],"omega_rad_s":[5.4045820734813548,-12.626645260722499,-26.980901365710963,60.486706928644665,60.486674133049085],"thrust_n":[0.36926968033259572,-2.0190054556249861,-9.2595866893271559,46.815223502509923,46.822074084278022],"torque_nm":[-0.0069238065062361704,0.037856352292968486,0.17361725042488418,-0.8777854406720611,-0.87791388908021295],"angle_rad":[-569.59018588259357,392.98454634474496,-648.0494582037278,2030.5556672387609,2030.5557160465144]},"command":[0.051480898147720271,-0.12128240389198941,-0.25715107019868022,0.57639617873433946,0.57639617873433946],"arm":{"servo_position":[-1.9852334701274449e-24,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.002832017425673297,-1.4520141542875484,-0.263308096749786,-3.4448721758638984e-06,-0.0004353290897003997,0.00013388934898456723]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":744,"step":5952,"t":29.760000000000002,"sim_time":29.759999999998364,"vehicle":{"origin_ned":[1.5006189315958811,1.0069917866406985,3.5085607358447501],"origin_quat_xyzw":[-0.020988901297127414,0.05284256933897772,0.37620365093229874,0.92479075574597081],"cg_ned":[1.4399821431202497,0.94861279185628455,3.2159671535799643],"linear_velocity_ned":[-0.0012526655182033496,-0.0032349557782572324,-0.0041899009063441151],"angular_velocity_ned":[-0.00032289313203523267,6.8064803596174173e-05,-0.00026424831385941114]},"sensors":{"Odom":[1.5006189315958811,1.0069917866406985,3.5085607358447501,-0.0025770220459582962,-0.0014144629234661512,-0.0045334292225142061,-0.020988901297127417,0.052842569338977734,0.37620365093229879,0.92479075574597081,-0.00015248264631177884,0.0002738820621644307,-0.00028365052825610198],"Pressure":[26928.642315494155],"DVL":[-0.020258965262553604,0.030967746909444954,0.001440052974513347,7.3091270060344913,-0.00027673305580566855,0.0026392994737098967,0.025414269536660067,0],"IMU":[0.00094455822514404356,0.11377414232665273,0.77276084363600983,0.064372314593211813,0.014691862330848146,0.059400052551487059,1.1202870927247213,-0.014930342705316284,-9.7541254926990728],"FOG":[0.78690820025422126],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[5.3789447635624308,-12.70334363433019,-27.023926048067306,60.533021549331941,60.533021549331941],"omega_rad_s":[5.3812642100332662,-12.597354313835517,-27.00548344582208,60.498572373423777,60.498537799496233],"thrust_n":[0.3660848727273851,-2.0099847314892183,-9.2769739930357957,46.833810814156699,46.841858022194238],"torque_nm":[-0.0068640913636384719,0.03768721371542285,0.17394326236942118,-0.87813395276543815,-0.87828483791614176],"angle_rad":[-569.37453077118107,392.48014950876757,-649.12925623525473,2032.9754057221649,2032.9754531778115]},"command":[0.051228045367261242,-0.12098422508885896,-0.25737072426730767,0.57650496713649468,0.57650496713649468],"arm":{"servo_position":[-1.9852334701274452e-24,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[8.4703294725430034e-22,0,0,0,0,0],"servo_effort":[0.003218883929199644,-1.4522224092685443,-0.26316472594918794,-2.9021679756724966e-06,-0.00043339096506358246,0.0001317706185343905]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":745,"step":5960,"t":29.800000000000001,"sim_time":29.799999999998356,"vehicle":{"origin_ned":[1.5005711352495055,1.006866633598591,3.5083914332216826],"origin_quat_xyzw":[-0.020994278493927761,0.052846757913715028,0.37619897321785872,0.92479229722049328],"cg_ned":[1.4399328190310972,0.94848425214028853,3.2157988433075313],"linear_velocity_ned":[-0.0012179839452786628,-0.0031968674347014089,-0.0042212987103421367],"angular_velocity_ned":[-0.00034983993872362521,9.5620798361882825e-05,-0.00021315447469551449]},"sensors":{"Odom":[1.5005711352495055,1.006866633598591,3.5083914332216826,-0.0025107004910684002,-0.0014071107500159752,-0.0045607726462045372,-0.020994278493927779,0.052846757913715077,0.376198973217859,0.92479229722049328,-0.00015833963438560594,0.00031247149127659014,-0.0002329297688365551],"Pressure":[26926.346101769894],"DVL":[0.0090285769785813843,0.036261930202295387,0.018858708387140603,7.2483833624900473,0.014008392923718192,0.033293420052795043,-0.036108104351028139,0],"IMU":[0.00093715846161145013,0.11378597832377814,0.77275058433771238,-0.022018052155512786,0.010127186545255186,0.066041616152568511,1.120028483883875,0.0057396647805549369,-9.7258038616062965],"FOG":[0.77805596804629384],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[5.350737135006514,-12.671912710088961,-27.046483210798982,60.544586923078768,60.544586923078768],"omega_rad_s":[5.35635865627148,-12.568009051118294,-27.029583457566211,60.510570038953269,60.51053377079792],"thrust_n":[0.36269836448603537,-2.0009588796586386,-9.2940328540777788,46.852553190362364,46.861765935341161],"torque_nm":[-0.0068005943341131634,0.037517978993599481,0.17426311601395836,-0.87848537231929447,-0.87865811128764681],"angle_rad":[-569.15984442106151,391.9769254159915,-650.21002662335013,2035.3956218411138,2035.3956678754002]},"command":[0.050959401285776328,-0.1206848829532282,-0.25758555438856173,0.57661511355313111,0.57661511355313111],"arm":{"servo_position":[-1.9852334701274452e-24,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[-8.4703294725430034e-22,-8.6736173798840355e-19,0,0,0,0],"servo_effort":[0.0035909001273921478,-1.452481869683881,-0.26303992902000961,-2.3648978035258577e-06,-0.00043154675352545795,0.00012976889677091978]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":746,"step":5968,"t":29.84,"sim_time":29.839999999998348,"vehicle":{"origin_ned":[1.5005249129745175,1.0067434167965437,3.5082208045869292],"origin_quat_xyzw":[-0.020999981033084109,0.052851631775764615,0.3761952157262658,0.92479341773172086],"cg_ned":[1.4398848636140917,0.9483572222940635,3.2156293347244249],"linear_velocity_ned":[-0.0011841266517804011,-0.0031593841511861863,-0.0042501422342354784],"angular_velocity_ned":[-0.00037499998718835156,0.00012332950855062569,-0.00016292151221991856]},"sensors":{"Odom":[1.5005249129745175,1.0067434167965437,3.5082208045869292,-0.0024460126091194255,-0.0014000842457739492,-0.0045856392064017593,-0.020999981033084127,0.052851631775764664,0.37619521572626613,0.92479341773172086,-0.0001627229070403964,0.00034992189280910318,-0.00018290571798564647],"Pressure":[26926.019140735003],"DVL":[-0.0058081585739850191,0.02926365485245639,-0.018290562325352273,7.3729730562905713,0.016530068557109416,-0.0017355561936240184,0.0072335935859162061,0],"IMU":[0.00092978771878502277,0.1137993305037807,0.77274235261631719,0.01123367574628192,-0.047681141106854653,-0.14260453039025159,1.107632128202978,-0.0068297599024635183,-9.7560647602097639],"FOG":[0.76397660997197891],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[5.3208297369498485,-12.6403284850725,-27.068516442258225,60.556294439838133,60.556294439838133],"omega_rad_s":[5.3298052047470836,-12.53856412668924,-27.053177366384435,60.522700580905031,60.522662706093143],"thrust_n":[0.35910500634130321,-1.9919137913609219,-9.3107460864437002,46.871454169808935,46.881799036327031],"torque_nm":[-0.0067332188688994342,0.037348383588017293,0.17457648912081941,-0.87883976568391731,-0.87903373193113188],"angle_rad":[-568.94619173247668,391.47487728791657,-651.29174953013649,2037.8163209003565,2037.8163654474731]},"command":[0.050674568923331886,-0.12038408081021428,-0.25779539468817358,0.57672661371274414,0.57672661371274414],"arm":{"servo_position":[2.2499312661440565e-24,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,-4.3368086899420177e-19],"servo_effort":[0.0039482798859016887,-1.4527901890853809,-0.26293310971892397,-1.8364051529707675e-06,-0.00042979755017161713,0.00012787868470496186]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":747,"step":5976,"t":29.879999999999999,"sim_time":29.87999999999834,"vehicle":{"origin_ned":[1.5004802354865945,1.0066220891056459,3.5080489548067777],"origin_quat_xyzw":[-0.02100597370981739,0.052857179827662776,0.37619236460381605,0.92479412434495822],"cg_ned":[1.4398382442422812,0.94823167841705502,3.2154587287759697],"linear_velocity_ned":[-0.0011510781321422945,-0.0031224922928403736,-0.0042764857915767243],"angular_velocity_ned":[-0.00039833700129245602,0.00015112615669606836,-0.00011353900196615932]},"sensors":{"Odom":[1.5004802354865945,1.0066220891056459,3.5080489548067777,-0.0023829534138366639,-0.0013933787425467201,-0.0046080765067762174,-0.021005973709817393,0.05285717982766279,0.37619236460381617,0.92479412434495822,-0.00016565273352452063,0.00038616160276439275,-0.00013357011353649386],"Pressure":[26921.165613333262],"DVL":[-0.033880957201779624,-0.017204346939837224,0.002693484633840771,7.439405145798176,0.0038244203507355979,0.0013556424622839505,-0.013883120033660927,0],"IMU":[0.00092250137350311586,0.11381415173668878,0.77273612054991681,0.059808305351613647,0.084771932906248654,-0.079476906679029041,1.1075630224677795,0.014105078224023652,-9.7227068724118002],"FOG":[0.77897920923421882],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[5.2891874308393518,-12.608564360991954,-27.090010551110218,60.568143221754482,60.568143221754482],"omega_rad_s":[5.3015511671228257,-12.508979762105728,-27.07624379609771,60.534964235634227,60.53492484487699],"thrust_n":[0.35530102661963031,-1.9828372711368363,-9.3270983267206997,46.890516541556188,46.901957927688322],"torque_nm":[-0.006661894249118068,0.037178198833815686,0.17488309362601315,-0.87919718515417855,-0.87941171114415595],"angle_rad":[-568.73363984176945,390.97401003190544,-652.37440421723397,2040.2375082214051,2040.2375512191177]},"command":[0.050373213627041447,-0.12008156534278051,-0.25800010048676397,0.57683945925480462,0.57683945925480462],"arm":{"servo_position":[2.2499312661440565e-24,-1.0842021724855024e-21,1.0778494253810979e-21,3.9704669402544482e-25,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,-1.7347234759768071e-18,0,0,0],"servo_effort":[0.0042911577076277137,-1.4531450775672632,-0.26284364644165953,-1.3116609573551779e-06,-0.00042814005846111228,0.00012609769701329656]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":748,"step":5984,"t":29.920000000000002,"sim_time":29.919999999998332,"vehicle":{"origin_ned":[1.5004370733663674,1.0065026036289473,3.5078759868352001],"origin_quat_xyzw":[-0.021012221225388435,0.052863389525294138,0.37619040620095767,0.92479442412323765],"cg_ned":[1.4397929289412192,0.94810759718917326,3.2152871242634036],"linear_velocity_ned":[-0.0011188214909735276,-0.0030861766795130295,-0.0043003824630284881],"angular_velocity_ned":[-0.00041982208528946064,0.00017894578167186359,-6.4995890503711783e-05]},"sensors":{"Odom":[1.5004370733663674,1.0065026036289473,3.5078759868352001,-0.0023215145267380171,-0.0013869877766296689,-0.0046281309569880984,-0.021012221225388438,0.052863389525294145,0.37619040620095778,0.92479442412323765,-0.00016715483365616063,0.00042112397168489577,-8.4914686097496789e-05],"Pressure":[26922.805119294288],"DVL":[0.017773073411439078,0.0085133846854196435,-0.021055677348426796,7.3611842875215281,0.016936027685521628,-0.00027657658416465269,0.0031330911601457328,0],"IMU":[0.00091535391260561373,0.11383039213737495,0.77273186054828424,0.053499672406541368,-0.061811258009337733,0.067790471429505894,1.1092398999625965,-0.012431554253277395,-9.7587129097982412],"FOG":[0.76698765891151832],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[5.255780578634802,-12.576597717841702,-27.110952604887316,60.580131864471902,60.580131864471902],"omega_rad_s":[5.2715509082327827,-12.47922133819535,-27.098763954616647,60.547360775118236,60.547319961937383],"thrust_n":[0.35128396518900051,-1.9737188855216592,-9.3430759868788957,46.909742273244063,46.922242538602333],"torque_nm":[-0.0065865743472937601,0.037007229103531117,0.17518267475397933,-0.87955766762332632,-0.87979204759879381],"angle_rad":[-568.52225783055508,390.47433002777797,-653.45796915052995,2042.6591891246799,2042.6592305144452]},"command":[0.050055053129855254,-0.11977712112230193,-0.25819954861797445,0.5769536368044943,0.5769536368044943],"arm":{"servo_position":[2.2499312661440565e-24,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.0046199072374064187,-1.4535439789535656,-0.26277083505601151,-7.9880475444105447e-07,-0.00042657192025606178,0.00012442348911233551]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":749,"step":5992,"t":29.960000000000001,"sim_time":29.959999999998324,"vehicle":{"origin_ned":[1.5003953971127177,1.0063849138507257,3.5077020017444669],"origin_quat_xyzw":[-0.021018688317368112,0.052870246935552652,0.37618932707116182,0.92479432412193008],"cg_ned":[1.4397488864400381,0.94798495593587995,3.2151146178913863],"linear_velocity_ned":[-0.0010873386184382427,-0.0030504204633336855,-0.0043218841505411679],"angular_velocity_ned":[-0.00043943339980597016,0.0002067238931496575,-1.7281127592754067e-05]},"sensors":{"Odom":[1.5003953971127177,1.0063849138507257,3.5077020017444669,-0.0022616841358909269,-0.001380903131898926,-0.0046458478440286428,-0.021018688317368108,0.052870246935552645,0.37618932707116176,0.92479432412193008,-0.0001672596224474106,0.00045474760666427299,-3.6931709501825078e-05],"Pressure":[26918.930427309835],"DVL":[-0.029434828376439064,0.02324531496176041,-0.0030547303107627726,7.3581891157405384,-0.018266953458771541,-0.010741940299954565,-0.0035967492082135573,0],"IMU":[0.00090839873361184958,0.11384799927031401,0.7727295453439279,-0.001475016869750879,0.0035491972980618144,-0.077390036610873306,1.1300349859418308,-0.0065539614977103127,-9.754410630589005],"FOG":[0.77526546387523476],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[5.2205848674638649,-12.544409899727624,-27.131331731905611,60.592258536040184,60.592258536040184],"omega_rad_s":[5.239765383036409,-12.449259089845212,-27.120721485552004,60.559889507476647,60.559847367871932],"thrust_n":[0.34705260700323065,-1.9645498478744454,-9.3586671619307218,46.929132511334508,46.94265213152466],"torque_nm":[-0.0065072363813105764,0.036835309647645857,0.17547500928620102,-0.87992123458752214,-0.88017472746608727],"angle_rad":[-568.3121164545995,389.97584492857936,-654.54242209981635,2045.0813689108941,2045.0814086379676]},"command":[0.049719855880608239,-0.11947057047359642,-0.25839363554195821,0.57706912891466844,0.57706912891466844],"arm":{"servo_position":[2.2499312661440565e-24,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,4.3368086899420177e-19],"servo_effort":[0.004934749965481277,-1.4539843344462917,-0.26271395179357121,-2.9118961738123221e-07,-0.00042509382436844577,0.00012285109557636344]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":750,"step":6000,"t":30,"sim_time":29.999999999998316,"vehicle":{"origin_ned":[1.5003551771936581,1.0062689737747232,3.5075270987589722],"origin_quat_xyzw":[-0.021025339887893266,0.052877736801864805,0.37618911396799076,0.92479383138367077],"cg_ned":[1.4397060862151985,0.94786373268181756,3.2149413043198312],"linear_velocity_ned":[-0.0010566104036425913,-0.0030152057398344142,-0.0043410413687154951],"angular_velocity_ned":[-0.00045715625390762974,0.00023439672135845092,2.9616828561222375e-05]},"sensors":{"Odom":[1.5003551771936581,1.0062689737747232,3.5075270987589722,-0.0022034475194430947,-0.0013751151169175064,-0.0046612712030713616,-0.021025339887893273,0.052877736801864812,0.37618911396799087,0.92479383138367077,-0.00016600215928865556,0.00048697661512957431,1.0386502439206504e-05],"Pressure":[26916.032807139214],"DVL":[-0.017520563229898822,0.010770268763419907,0.025718318313579465,7.28134473990161,-0.026531917067677106,0.010661196558809519,0.026634040099721319,0],"IMU":[0.0009016879548682064,0.11386691836743827,0.77272914798005177,-0.0086706132830917815,-0.072704542519157964,0.033833997645488778,1.1272896141835058,-0.030884517213264288,-9.7575671952597993],"FOG":[0.7852255856658108],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[5.1835810502334239,-12.511985868512761,-27.151139201244678,60.604520959688621,60.604520959688621],"omega_rad_s":[5.2061617795922812,-12.419067774693353,-27.142102436062075,60.572549278530822,60.572505910641489],"thrust_n":[0.34260692679116617,-1.9553228948310231,-9.3738616097091736,46.948687575635248,46.963185305394695],"torque_nm":[-0.0064238798773343661,0.036662304278081682,0.17575990518204704,-0.88028789204316094,-0.88055972447615072],"angle_rad":[-568.10328788807283,389.47856347424863,-655.62774023581414,2047.5040528425827,2047.5040908561095]},"command":[0.049367438573651654,-0.11916177017631201,-0.25858227810709217,0.57718591390179641,0.57718591390179641],"arm":{"servo_position":[2.2499312661440565e-24,-1.0842021724855024e-21,9.7514668052651336e-21,-8.0732827785175587e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.0052362587889959551,-1.4544636331974001,-0.26267225885407541,2.0063100888033656e-07,-0.00042369723929775593,0.00012137531874227197]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":751,"step":6008,"t":30.039999999999999,"sim_time":30.039999999998308,"vehicle":{"origin_ned":[1.5003163840920113,1.0061547380483502,3.5073513752898262],"origin_quat_xyzw":[-0.021032141127833814,0.052885842610344534,0.37618975384424069,0.92479295293248331],"cg_ned":[1.4396644985279805,0.94774390619230542,3.2147672762163637],"linear_velocity_ned":[-0.001026616855072462,-0.0029805135123981952,-0.0043579033411958318],"angular_velocity_ned":[-0.00047298268067424748,0.00026190152673861994,7.570959041475115e-05]},"sensors":{"Odom":[1.5003163840920113,1.0061547380483502,3.5073513752898262,-0.002146787115669286,-0.0013696126417939774,-0.0046744439168953673,-0.021032141127833817,0.052885842610344541,0.3761897538442408,0.92479295293248331,-0.00016342158407086068,0.00051776053023753479,5.7047236519433207e-05],"Pressure":[26914.681294427803],"DVL":[0.011340559803510716,0.022933686996786082,0.032465371894361127,7.3223510854256366,-0.0034176552995134604,0.017082540723324078,-0.0019532353868275164,0],"IMU":[0.00089527223401460589,0.11388709254410946,0.77273064180338258,-0.055599331160046436,-0.038411243270847086,-0.055262754135558263,1.119411557795829,0.0041625216893649373,-9.7287536714433589],"FOG":[0.75715301107444233],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[5.144754475378023,-12.479314096964787,-27.170368060239824,60.616916422991942,60.616916422991942],"omega_rad_s":[5.1707130441145139,-12.388626430119091,-27.162895085946055,60.585338467668286,60.585293971432385],"thrust_n":[0.33794801668742852,-1.9460321934604574,-9.388650640610134,46.968406955538427,46.983839989230511],"torque_nm":[-0.0063365253128892856,0.036488103627383577,0.17603719951144006,-0.88065763041634559,-0.88094699979807212],"angle_rad":[-567.89584548583935,388.9824953161833,-656.71390022227513,2049.9272461254395,2049.9272823785313]},"command":[0.048997661670266889,-0.11885061044728368,-0.25876541009752213,0.57730396593325661,0.57730396593325661],"arm":{"servo_position":[2.2499312661440565e-24,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.0055248106925995947,-1.4549788277797209,-0.26264458673553098,6.8808042551390766e-07,-0.00042238345669615038,0.00011999308860876812]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":752,"step":6016,"t":30.080000000000002,"sim_time":30.0799999999983,"vehicle":{"origin_ned":[1.5002789883528869,1.0060421620691549,3.5071749269691659],"origin_quat_xyzw":[-0.021039057622359643,0.052894546664495799,0.37619123384813602,0.92479169576901876],"cg_ned":[1.4396240944546255,0.94762545600574499,3.2145926243086858],"linear_velocity_ned":[-0.00099733730453071385,-0.0029463242211058395,-0.0043725180548176024],"angular_velocity_ned":[-0.00048691107559765718,0.00028917676279049828,0.0001210091343154359]},"sensors":{"Odom":[1.5002789883528869,1.0060421620691549,3.5071749269691659,-0.0020916830666385003,-0.0013643835379208873,-0.0046854078213480997,-0.021039057622359657,0.052894546664495834,0.3761912338481363,0.92479169576901876,-0.00015956078084016612,0.00054705417571450886,0.00010305771352221401],"Pressure":[26913.439317525619],"DVL":[0.018363926311036428,0.0064702535504531505,0.014278296208202455,7.3893831458187993,-0.010001062831440524,0.011007604014064351,0.0025554527894627284,0],"IMU":[0.00088920062716934904,0.11390846301694899,0.77273400045294738,-0.037201298768683867,-0.026643581129999795,-0.0065635254467157006,1.12174304195569,-0.0071619695989254151,-9.7319909919729906],"FOG":[0.76938128873880274],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[5.1040933044769963,-12.446386174130666,-27.189013207910403,60.629441768563971,60.629441768563971],"omega_rad_s":[5.133397209574146,-12.357918081543756,-27.183089872712074,60.598254989103353,60.598209465916767],"thrust_n":[0.33307798645466152,-1.9366732327788363,-9.4030270678582752,46.988289313785032,47.004613444481258],"torque_nm":[-0.0062452122460249044,0.03631262311460319,0.17630675752234271,-0.88103042463346937,-0.88133650208402359],"angle_rad":[-567.68986356598646,388.48765085257219,-657.80087830375237,2052.350953889716,2052.3509883395163]},"command":[0.048610412423590439,-0.11853701118219682,-0.25894298293248003,0.5774232549387045,0.5774232549387045],"arm":{"servo_position":[2.2499312661440565e-24,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.0058013427842945131,-1.4555218865602715,-0.26263053637696732,1.1788800914535895e-06,-0.00042114592537327231,0.00011870035019473576]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":753,"step":6024,"t":30.120000000000001,"sim_time":30.119999999998292,"vehicle":{"origin_ned":[1.5002429606102508,1.0059312020838989,3.5069978476832024],"origin_quat_xyzw":[-0.021046055462320846,0.052903830131890831,0.37619354132341243,0.92479006686566578],"cg_ned":[1.4395848459124989,0.94750836246123926,3.2144174374316679],"linear_velocity_ned":[-0.00096875049102779242,-0.0029126175240323689,-0.0043849322578200078],"angular_velocity_ned":[-0.00049894538230571279,0.00031616103780963728,0.0001655274354682162]},"sensors":{"Odom":[1.5002429606102508,1.0059312020838989,3.5069978476832024,-0.0020381135180382905,-0.0013594143309796341,-0.004694203627046996,-0.021046055462320874,0.0529038301318909,0.37619354132341287,0.92479006686566578,-0.00015446647759838396,0.00057481635410247859,0.00014842471020833268],"Pressure":[26910.1653092706],"DVL":[-0.01281120557110128,-0.0060856991995614906,0.0024401823643210321,7.3343306808171338,0.02239527310827363,-0.012476506410012234,-0.024575730616253462,0],"IMU":[0.00088352041646815895,0.11393096927408645,0.77273919785427403,-0.078519193814575408,-0.073551885090997332,0.076907130108289798,1.1137254502402958,-0.012940341130178971,-9.7421050860392349],"FOG":[0.75848321803028085],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[5.0615906273466624,-12.413196566261854,-27.207070870581887,60.642093462514325,60.642093462514325],"omega_rad_s":[5.0941971539369071,-12.32692946545076,-27.202679172006338,60.611296311568715,60.61124986396409],"thrust_n":[0.32799991989730543,-1.9272427235362051,-9.4169850648745363,47.008332535372567,47.02550227302055],"torque_nm":[-0.0061499984980744769,0.03613580106630384,0.17656846996639758,-0.88140623503823567,-0.88172816761913531],"angle_rad":[-567.48541721570314,387.99404107500555,-658.88865038706319,2054.7751811720418,2054.775213779777]},"command":[0.048205625022349166,-0.11822091967868432,-0.25911496067220846,0.57754374726204116,0.57754374726204116],"arm":{"servo_position":[2.2499312661440565e-24,-1.0842021724855024e-21,9.7514668052651336e-21,3.9704669402544482e-25,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.0060676811598957669,-1.4560865620465766,-0.26262946582218366,1.6823908202315993e-06,-0.00041998402624510124,0.00011749489018728217]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":754,"step":6032,"t":30.16,"sim_time":30.159999999998284,"vehicle":{"origin_ned":[1.5002082716323248,1.0058218152768386,3.5068202296050797],"origin_quat_xyzw":[-0.0210531013353388,0.052913673132479015,0.37619666380037475,0.92478807316339284],"cg_ned":[1.4395467256769865,0.94739260671831405,3.2142418025795214],"linear_velocity_ned":[-0.00094083481845033646,-0.0028793728386672071,-0.0043951914574118798],"angular_velocity_ned":[-0.00050909552432216207,0.00034279630948948225,0.00020927653412199942]},"sensors":{"Odom":[1.5002082716323248,1.0058218152768386,3.5068202296050797,-0.001986054398044227,-0.0013546910048122184,-0.0047008711116643146,-0.02105310133533881,0.052913673132479036,0.37619666380037492,0.92478807316339284,-0.00014818734560488215,0.00060101243624770078,0.0001931548407282751],"Pressure":[26908.588414776856],"DVL":[0.0072412195730595201,0.020871447036447867,0.0096874324467694575,7.3770281865493335,-0.0018020414976457231,-0.011781970743093,0.0041527236665037564,0],"IMU":[0.00087827700585937029,0.11395454930739193,0.77274620819939777,-0.083073209150156965,0.011997270371137791,0.078195203908577204,1.1097078447336912,-0.010279385081910543,-9.7467263225760625],"FOG":[0.75103143734918321],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[5.0172418920595332,-12.379742274137563,-27.224539180833993,60.654867551980296,60.654867551980296],"omega_rad_s":[5.053100141360849,-12.295650669362383,-27.221657262383349,60.624459459627026,60.624412190953784],"thrust_n":[0.32271780124609473,-1.9177384686512013,-9.4305201386415742,47.028533696741775,47.04650245990404],"torque_nm":[-0.0060509587733642775,0.035957596287210035,0.17682225259952955,-0.88178500681390837,-0.88212192112320087],"angle_rad":[-567.28258210427305,387.50167742887044,-659.97719211725439,2057.1999328976367,2057.1999636286523]},"command":[0.0477832561148527,-0.1179023073727387,-0.25928132553175232,0.5776654052569552,0.5776654052569552],"arm":{"servo_position":[2.2499312661440565e-24,-1.0842021724855024e-21,9.7514668052651336e-21,-1.7205356741103061e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[1.6940658945086007e-21,0,0,0,0,0],"servo_effort":[0.006324872543205514,-1.456680591918849,-0.26264059062659389,2.1848854013330833e-06,-0.00041889479564287738,0.00011636874465334609]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":755,"step":6040,"t":30.199999999999999,"sim_time":30.199999999998276,"vehicle":{"origin_ned":[1.5001748923701488,1.0057139598548925,3.5066421632226068],"origin_quat_xyzw":[-0.021060162625436599,0.05292405484545628,0.37620058900007808,0.92478572156197325],"cg_ned":[1.4395097073947432,0.9472781707633785,3.2140658049563093],"linear_velocity_ned":[-0.00091356836352955413,-0.0028465693751540486,-0.0044033397664434747],"angular_velocity_ned":[-0.00051737923271122214,0.00036902784414407605,0.00025226903906062426]},"sensors":{"Odom":[1.5001748923701488,1.0057139598548925,3.5066421632226068,-0.0019354790860554745,-0.0013501985854489631,-0.0047054490334292104,-0.021060162625436609,0.052924054845456314,0.37620058900007824,0.92478572156197325,-0.00014077538520632725,0.0006256156087933052,0.00023725490346300721],"Pressure":[26907.573409109278],"DVL":[-0.0012501887365812332,0.01395071190833827,-0.035642015222797321,7.3972242284616199,0.020078153231635028,-0.014780923969044697,-0.0038211900417177498,0],"IMU":[0.00087351381673534561,0.11397913988561974,0.7727550059561602,0.029639430520204534,0.038120983017540848,0.070243786408933376,1.1165041163987577,-0.00061437399752201517,-9.7653655444287022],"FOG":[0.77374992911719831],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[4.9710441895191559,-12.346023881512856,-27.241417484952596,60.667759751774412,60.667759751774412],"omega_rad_s":[5.0100968972566564,-12.264075191927502,-27.240020176686297,60.637741041627848,60.637693055710628],"thrust_n":[0.31723638142535515,-1.9081593695461569,-9.4436290280965416,47.048889093476198,47.067609431698529],"torque_nm":[-0.0059481821517254098,0.035777988178990444,0.17706804427681019,-0.88216667050267883,-0.88251767684434745],"angle_rad":[-567.08143433043426,387.01057167883721,-661.06647895093886,2059.6252138631621,2059.6252426869514]},"command":[0.047343277995420534,-0.11758117982393197,-0.25944207128526281,0.57778818811213728,0.57778818811213728],"arm":{"servo_position":[-6.220398206398947e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.4558378780933203e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[-3.3881317890172014e-21,0,1.7347234759768071e-18,2.1175823681357508e-22,0,0],"servo_effort":[0.0065735985259191883,-1.4573009612564487,-0.26266300296735473,2.6960701151553459e-06,-0.00041787317972407994,0.00011531971257778181]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":756,"step":6048,"t":30.240000000000002,"sim_time":30.239999999998268,"vehicle":{"origin_ned":[1.5001427940053429,1.0056075951440682,3.5064637373666034],"origin_quat_xyzw":[-0.021067207530743731,0.052934953629741974,0.37620530483463116,0.92478301891057435],"cg_ned":[1.4394737655924774,0.94716503741493552,3.2138895280303514],"linear_velocity_ned":[-0.00088692911475073588,-0.0028141864245199719,-0.004409420076750303],"angular_velocity_ned":[-0.00052382107273332994,0.00039480419834075073,0.00029451784797570446]},"sensors":{"Odom":[1.5001427940053429,1.0056075951440682,3.5064637373666034,-0.0018863589678223104,-0.0013459214040417384,-0.0047079753110248262,-0.021067207530743745,0.052934953629742008,0.37620530483463138,0.92478301891057435,-0.00013228521447387876,0.00064860618190734826,0.00028073168126592236],"Pressure":[26906.386295824861],"DVL":[-0.029257789172864875,-0.0053936761440828507,0.02952132861810974,7.3797146041338753,-0.016165303300217676,0.016998062063103715,0.0074849426165048026,0],"IMU":[0.00086927215979437926,0.11400467686649203,0.77276556586864253,-0.041600751845051742,0.033597074112103033,0.17173146588599097,1.1162686535572934,-0.010712514530789374,-9.7567853389600003],"FOG":[0.76767588951690435],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[4.9229983789910037,-12.31204600049662,-27.257706961778343,60.680765390256553,60.680765390256553],"omega_rad_s":[4.9651816773118336,-12.232200214195791,-27.257765724752339,60.65113725411755,60.651088654876922],"thrust_n":[0.31156117325173527,-1.8985054961344254,-9.4563097225391655,47.069394249470108,47.088818064545954],"torque_nm":[-0.0058417719984700358,0.035596978052520482,0.17730580729760939,-0.88255114217756458,-0.88291533871023675],"angle_rad":[-566.88205028343657,386.52073576584814,-662.15648622661467,2062.0510287201928,2062.0510556104041]},"command":[0.046885698847533366,-0.11725758095711067,-0.25959720915979373,0.57791205133577672,0.57791205133577672],"arm":{"servo_position":[2.2499312661440565e-24,-1.0842021724855024e-21,9.7514668052651336e-21,-5.2939559203394617e-25,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,-1.0587911840678754e-22,0,0],"servo_effort":[0.0068144484291338958,-1.4579452781138056,-0.26269595734375534,3.2072310922319846e-06,-0.00041691657632890163,0.00011434232744323996]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":757,"step":6056,"t":30.280000000000001,"sim_time":30.27999999999826,"vehicle":{"origin_ned":[1.5001119479915563,1.0055026816580457,3.5062850392339961],"origin_quat_xyzw":[-0.02107420515899688,0.052946347132094042,0.37621079941371749,0.92477997199700201],"cg_ned":[1.4394388756817413,0.94705319031522817,3.2137130535800877],"linear_velocity_ned":[-0.00086089481479168211,-0.0027822034702311483,-0.0044134741600560306],"angular_velocity_ned":[-0.00052845225277694673,0.00042007689930544979,0.00033603698375782358]},"sensors":{"Odom":[1.5001119479915563,1.0055026816580457,3.5062850392339961,-0.0018386634947220926,-0.0013418431907943008,-0.0047084871014015008,-0.021074205158996887,0.052946347132094063,0.37621079941371766,0.92477997199700201,-0.00012277425006439966,0.00066997122836744366,0.00032359276247949359],"Pressure":[26904.329238867718],"DVL":[-0.021229363748282382,0.0044000757611302333,0.022127936517752772,7.2906972759810076,-0.017768673535727687,-0.032935086999208052,-0.026667603855328102,0],"IMU":[0.00086559113960154482,0.1140310954691213,0.7727778629719374,0.0097025209228297164,-0.058463685436574299,0.13047692910368788,1.1385196675501892,-0.015832492821810103,-9.7399576041619991],"FOG":[0.77567916632326261],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[4.8731065411268268,-12.277816502149358,-27.273409961204749,60.693879512403903,60.693879512403903],"omega_rad_s":[4.9183516938453486,-12.20002651394311,-27.274893354689993,60.664643914333809,60.664594805403233],"thrust_n":[0.30569836297154529,-1.8887780468498068,-9.4685613672166369,47.090043979177331,47.110122727171181],"torque_nm":[-0.0057318443057164745,0.035414588378433878,0.17753552563531197,-0.88293832460957511,-0.88331480113445993],"angle_rad":[-566.68450651334911,386.03218166183728,-663.24718923299667,2064.4773819594475,2064.4774068938805]},"command":[0.046410538486922157,-0.11693158573475579,-0.25974676153528331,0.57803694773718006,0.57803694773718006],"arm":{"servo_position":[1.072026073868706e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-2.6469779601696972e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[3.3881317890172014e-21,0,0,-4.2351647362715017e-22,0,0],"servo_effort":[0.0070484236417253342,-1.4586109565735708,-0.2627386304428988,3.7173148562815665e-06,-0.00041601931060542799,0.00011343281915921806]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":758,"step":6064,"t":30.32,"sim_time":30.319999999998252,"vehicle":{"origin_ned":[1.5000823260871903,1.0053991811660534,3.5061061544114485],"origin_quat_xyzw":[-0.021081125623661517,0.052958212386656434,0.37621706105102071,0.92477658753743408],"cg_ned":[1.4394050139597945,0.94694261392274859,3.2135364617391886],"linear_velocity_ned":[-0.00083544350564807403,-0.0027506001737143482,-0.0044155425330336846],"angular_velocity_ned":[-0.00053130971303988863,0.00044480049065469978,0.000376840347515306]},"sensors":{"Odom":[1.5000823260871903,1.0053991811660534,3.5061061544114485,-0.001792360755848836,-0.0013379469889565872,-0.0047070206789650328,-0.021081125623661538,0.052958212386656489,0.3762170610510211,0.92477658753743408,-0.00011230188530592047,0.00068970397968943814,0.00036584538008554215],"Pressure":[26902.078668433762],"DVL":[0.038339444277265967,0.014262619472589335,0.0069252227404751048,7.358548174961923,0.013312993423317326,-0.045348204337441009,0.012528133002822146,0],"IMU":[0.0008625075514836169,0.11405833053104619,0.77279187260587978,-0.012541058008098693,-0.085121542543311959,0.055866548649488174,1.1180596104611062,-0.024119898906415322,-9.7297276644752753],"FOG":[0.75527450534226748],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[4.8213733027660259,-12.243347138486907,-27.288529869190135,60.707096903137874,60.707096903137874],"omega_rad_s":[4.8696069338234373,-12.167558671958908,-27.291403968030213,60.678256491333414,60.678206975683139],"thrust_n":[0.29965477294027087,-1.8789793959591479,-9.4803841382707876,47.110832440442529,47.131517318332001],"torque_nm":[-0.0056185269926300801,0.035230863674234031,0.1777572025925773,-0.88332810825829755,-0.88371594971872525],"angle_rad":[-566.48887961823152,385.54492122021162,-664.3385632701096,2066.9042778963112,2066.9043008568988]},"command":[0.045917840978724055,-0.1166033060808277,-0.25989076065895367,0.57816282764893212,0.57816282764893212],"arm":{"servo_position":[2.2499312661440565e-24,-1.0842021724855024e-21,1.0778494253810979e-21,1.5881867761018046e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,-1.7347234759768071e-18,8.4703294725430034e-22,0,0],"servo_effort":[0.0072760683434578205,-1.4592958257171267,-0.26279033731740115,4.2300923924352918e-06,-0.00041518181078364105,0.00011259048472188831]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":759,"step":6072,"t":30.359999999999999,"sim_time":30.359999999998244,"vehicle":{"origin_ned":[1.5000539003843267,1.0052970567525901,3.5059271669020067],"origin_quat_xyzw":[-0.021087940134592479,0.0529705259195246,0.37622407826761739,0.92477287216719883],"cg_ned":[1.4393721576024245,0.94683329349881273,3.2133598310451577],"linear_velocity_ned":[-0.00081055317545307372,-0.0027193567456286778,-0.00441566471963919],"angular_velocity_ned":[-0.00053243713492595157,0.0004689326483626686,0.00041694312106043703]},"sensors":{"Odom":[1.5000539003843267,1.0052970567525901,3.5059271669020067,-0.0017474172144911137,-0.0013342153614682264,-0.004703611735966659,-0.0210879401345925,0.052970525919524655,0.37622407826761772,0.92477287216719883,-0.00010093028714689964,0.00070780461561998265,0.00040749773102643664],"Pressure":[26900.894159650634],"DVL":[0.0085311777302814855,0.023447848453147978,0.0044001147197568506,7.3483352742649881,-0.0022830769710248957,0.019947890967105066,0.019657911134964061,0],"IMU":[0.00086005579204224416,0.11408631677050364,0.77280757042308745,-0.046129303296469928,-0.030404750406801826,-0.052046405796322935,1.1175150731037944,-0.019498259238972734,-9.7688602808694363],"FOG":[0.76302524273773964],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[4.7678057718991012,-12.208652392017253,-27.303071242016649,60.72041199878511,60.72041199878511],"omega_rad_s":[4.8189501117733213,-12.134804699204553,-27.307299859467381,60.691970104279299,60.69192028385001],"thrust_n":[0.2934378386950694,-1.8691129633481509,-9.4917791997280947,47.131753126949185,47.152995277344615],"torque_nm":[-0.0055019594755325515,0.035045868062777825,0.17797085999490181,-0.88372037113029733,-0.88411866145021167],"angle_rad":[-566.29524613405863,385.05896603346275,-665.43058370621043,2069.3317206569127,2069.3317416296832]},"command":[0.04540767401808668,-0.11627287992397384,-0.26002924992396809,0.57828963808366773,0.57828963808366773],"arm":{"servo_position":[2.2499312661440565e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018046e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,4.3368086899420177e-19],"servo_effort":[0.0074984152404062188,-1.4599973485804347,-0.26285026198260514,4.7410505443413894e-06,-0.00041439764016246232,0.00011180704348688175]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":760,"step":6080,"t":30.400000000000002,"sim_time":30.399999999998236,"vehicle":{"origin_ned":[1.5000266433373108,1.0051962728719539,3.5057481591397153],"origin_quat_xyzw":[-0.021094621096643805,0.052983263851252051,0.37623183980609559,0.92476883242709795],"cg_ned":[1.4393402846604419,0.94672521508391561,3.2131832384761001],"linear_velocity_ned":[-0.00078620207153430155,-0.0026884539258068517,-0.0044138792782159762],"angular_velocity_ned":[-0.0005318843295704632,0.00049243382918104318,0.0004563611368044313]},"sensors":{"Odom":[1.5000266433373108,1.0051962728719539,3.5057481591397153,-0.001703798115173864,-0.0013306302672693013,-0.0046982953993168729,-0.021094621096643815,0.052983263851252078,0.37623183980609576,0.92476883242709795,-8.8724133090986189e-05,0.00072427958567883256,0.00044855837226175039],"Pressure":[26896.988170705579],"DVL":[0.0066522597152501844,-0.030825011565219877,-0.029332479411569492,7.4433310774243564,0.010956788891157358,-0.0072010075025364332,-0.012061052182018549,0],"IMU":[0.00085826775466250449,0.11411498905091685,0.7728249324193659,-0.045755340320500625,0.014030214773387367,-0.14163316946632842,1.1226585358660075,-0.0086948727550400697,-9.7212127463831379],"FOG":[0.77318119653803086],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[4.7124129408349091,-12.173750782022019,-27.317039343214784,60.733819069962109,60.733819069962109],"omega_rad_s":[4.7663864133649909,-12.101776325885238,-27.322584515266588,60.705779572327252,60.705729547666053],"thrust_n":[0.2870555598879303,-1.8591832881815569,-9.502748564728833,47.152798954980533,47.174549657537845],"torque_nm":[-0.0053822917478986935,0.034859686653404193,0.17817653558866564,-0.88411498040588499,-0.8845228060788346],"angle_rad":[-566.10368243178743,384.57432728863188,-666.52322602889831,2071.7597141652118,2071.7597331402417]},"command":[0.044880123246046753,-0.11594048363830495,-0.26016227945918841,0.57841732447582961,0.57841732447582961],"arm":{"servo_position":[2.2499312661440565e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018046e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,4.3368086899420177e-19],"servo_effort":[0.0077163127389493994,-1.4607133355626547,-0.26291772852563383,5.2483965983090486e-06,-0.00041366478711155888,0.0001110825640408987]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":761,"step":6088,"t":30.440000000000001,"sim_time":30.439999999998228,"vehicle":{"origin_ned":[1.5000005277800867,1.0050967954057259,3.5055692120084583],"origin_quat_xyzw":[-0.021101142213760464,0.052996401992407544,0.37624033463743933,0.92476447475291856],"cg_ned":[1.4393093740492349,0.94661836547633627,3.2130067594910026],"linear_velocity_ned":[-0.0007623687145374376,-0.0026578730330379932,-0.0044102237140492299],"angular_velocity_ned":[-0.00052970815987872586,0.0005152668265055565,0.00049511106296355539]},"sensors":{"Odom":[1.5000005277800867,1.0050967954057259,3.5055692120084583,-0.0016614674377002649,-0.0013271727874753336,-0.0046911061649096766,-0.021101142213760474,0.052996401992407571,0.3762403346374395,0.92476447475291856,-7.5751595806554579e-05,0.00073914193569387331,0.0004890362935811508],"Pressure":[26896.628422057744],"DVL":[-0.019501484173574526,0.0047804044110961764,0.029140686205913414,7.3531582667912616,-0.0031174371363501294,-0.038405374894076826,0.012907116235920349,0],"IMU":[0.00085717270867610349,0.11414428263667856,0.77284393494730141,0.025367688538906658,0.068036577149607258,0.068843292834270486,1.127482859411546,-0.013080176438475201,-9.7438404106500087],"FOG":[0.76204017820355363],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[4.6552072287814079,-12.138663994578156,-27.330440373468878,60.747312173141786,60.747312173141786],"omega_rad_s":[4.7119237266729863,-12.068488866906398,-27.337262530498766,60.719679440976684,60.719629310884663],"thrust_n":[0.28051650955823942,-1.8491959710458763,-9.5132950391480531,47.173962299146524,47.196173166737481],"torque_nm":[-0.005259684554216988,0.034672424457110176,0.178374281984026,-0.88451179310899719,-0.88492824687632776],"angle_rad":[-565.91426461466017,384.09101562173674,-667.61646589066527,2074.1882621316431,2074.1882791029921]},"command":[0.04433530694077531,-0.11560632375788721,-0.26028990831875121,0.57854583022039796,0.57854583022039796],"arm":{"servo_position":[2.2499312661440565e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018043e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,1.6940658945086007e-21,0,0],"servo_effort":[0.0079307398286608422,-1.4614415182141061,-0.2629920284116059,5.7533283269854281e-06,-0.00041297848988223188,0.0001104098363672547]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":762,"step":6096,"t":30.48,"sim_time":30.479999999998221,"vehicle":{"origin_ned":[1.4999755269397319,1.0049985917136999,3.5053904048597544],"origin_quat_xyzw":[-0.021107478595177375,0.053009915937810778,0.37624955196923404,0.92475980546440872],"cg_ned":[1.4392794055358722,0.94651273220319188,3.2128304680689115],"linear_velocity_ned":[-0.00073903194751592783,-0.0026275962302443178,-0.0044047346269251554],"angular_velocity_ned":[-0.0005259717606121893,0.00053739674063435798,0.00053321025585415069]},"sensors":{"Odom":[1.4999755269397319,1.0049985917136999,3.5053904048597544,-0.0016203882665490731,-0.0013238234507690605,-0.0046820780407319457,-0.021107478595177372,0.053009915937810771,0.37624955196923399,0.92475980546440872,-6.2083791730321625e-05,0.00075241074272950378,0.00052894083202527419],"Pressure":[26895.740931921173],"DVL":[0.023174468183520425,0.01186531942595194,-0.0091801077739715551,7.3059643308158346,-0.021531658465121485,0.014720522568054744,0.02095110561382774,0],"IMU":[0.00085679717379346092,0.11417413344811911,0.77286455473239635,-0.012862653769030971,0.00055633515848676422,0.0018635581495028549,1.1243190332244415,-0.0083552906812232389,-9.7575350483486947],"FOG":[0.76951736206980581],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[4.5962048167133238,-12.103416986611411,-27.34328132687881,60.760885163369331,60.760885163369331],"omega_rad_s":[4.6555731029783818,-12.034961189072357,-27.351339527356998,60.733663999125305,60.733613860312111],"thrust_n":[0.27382986659631753,-1.8391576471821744,-9.5234221640515191,47.195235026696707,47.217858190465805],"torque_nm":[-0.0051343099986809549,0.034484205884665775,0.17856416557596602,-0.88491065675056324,-0.88533484107123395],"angle_rad":[-565.7270683982515,383.60904097484189,-668.71027915147317,2076.6173680425227,2076.617383008158]},"command":[0.043773379206793563,-0.11527063796772773,-0.26041220311313151,0.57867509679399365,0.57867509679399365],"arm":{"servo_position":[2.2499312661440565e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018043e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.0081425994576416229,-1.462179833742093,-0.26307249295840512,6.2532028811243515e-06,-0.00041233868743406773,0.00010978787859924902]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":763,"step":6104,"t":30.52,"sim_time":30.519999999998213,"vehicle":{"origin_ned":[1.4999516144400662,1.004901630680797,3.5052118155280527],"origin_quat_xyzw":[-0.021113606864714841,0.053023781147505632,0.37625948125361791,0.92475483075501785],"cg_ned":[1.4392503597241793,0.94640830348874161,3.2126544367437582],"linear_velocity_ned":[-0.00071617105087242209,-0.0025976064184567746,-0.0043974478657014824],"angular_velocity_ned":[-0.00052074518094889354,0.00055879004081770163,0.00057067685112843715]},"sensors":{"Odom":[1.4999516144400662,1.004901630680797,3.5052118155280527,-0.0015805228459945533,-0.0013205617434634749,-0.0046712446899222155,-0.021113606864714869,0.053023781147505701,0.37625948125361841,0.92475483075501785,-4.77958985481487e-05,0.0007641108930192713,0.00056828163516312979],"Pressure":[26894.927945605046],"DVL":[0.0081305000368221692,-0.0080188582657093159,-0.014827165750838603,7.3731471494777203,0.0076763646928589262,0.0017955889901098718,0.010297839043892714,0],"IMU":[0.00085716477870118447,0.1142044782942528,0.77288676888720631,-0.0048259025970246042,0.11082154324037487,0.041020225936204698,1.1183131099248533,0.0089723431235666559,-9.7510392488808666],"FOG":[0.75024173725735366],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[4.5354261106486424,-12.068037634679348,-27.355569843650514,60.774531710342416,60.774531710342416],"omega_rad_s":[4.5973489741144906,-12.001215547777615,-27.364822046800054,60.747727302072775,60.747677248829774],"thrust_n":[0.26700541404216416,-1.8290759207138358,-9.53313414144211,47.216608540881133,47.239596824801779],"torque_nm":[-0.0050063515132905793,0.034295173513384417,0.17874626515203956,-0.88531141014152126,-0.88574244046503348],"angle_rad":[-565.5421689812207,383.12841245782221,-669.80464191739281,2079.0470351503609,2079.0470481120642]},"command":[0.043194534387129925,-0.11493369175885093,-0.26052923660619537,0.578805063908023,0.578805063908023],"arm":{"servo_position":[2.2499312661440565e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018057e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,-4.3368086899420177e-19],"servo_effort":[0.0083528905373148818,-1.4629262195231085,-0.26315847563338701,6.7457206616753512e-06,-0.00041174010865976197,0.00010921249685084126]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":764,"step":6112,"t":30.560000000000002,"sim_time":30.559999999998205,"vehicle":{"origin_ned":[1.4999287639722876,1.004805883401455,3.5050335203216103],"origin_quat_xyzw":[-0.021119506547060435,0.053037972912944847,0.37627011222157719,0.92474955664831548],"cg_ned":[1.4392222180612813,0.94630506818190285,3.2124787366768719],"linear_velocity_ned":[-0.00069376420721764759,-0.0025678898366021273,-0.0043883956418923125],"angular_velocity_ned":[-0.00051425041132049411,0.00057934014579785265,0.00060754359752686338]},"sensors":{"Odom":[1.4999287639722876,1.004805883401455,3.5050335203216103,-0.0015418192092424778,-0.0013173222893177864,-0.0046586390265276802,-0.021119506547060438,0.053037972912944861,0.3762701122215773,0.92474955664831548,-3.3123499920744424e-05,0.00077432106336365462,0.00060706460739911173],"Pressure":[26890.053011847423],"DVL":[0.00110278771206631,0.031031599548597404,0.00045197936293131036,7.3771809300667934,-0.019274993600371906,0.019390368304419193,-0.037318595036726479,0],"IMU":[0.00085829365976981158,0.11423525585673032,0.77291055485914917,-0.033191819445892751,0.016802238959994574,-0.088900358427651663,1.1185032482260207,-0.012127390521096675,-9.7670675402764768],"FOG":[0.79164820978324124],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[4.4729303224728945,-12.032558814888661,-27.367315882458463,60.788245399670778,60.788245399670778],"omega_rad_s":[4.5372761594014497,-11.967277859827631,-27.377717785881671,60.761863214545585,60.761813338261938],"thrust_n":[0.26005429066490643,-1.8189594073209556,-9.5424359636907834,47.23807329311169,47.261381535119341],"torque_nm":[-0.0048760179499669955,0.034105488887267915,0.17892067431920222,-0.88571387424584425,-0.88615090378348771],"angle_rad":[-565.35964081096267,382.64913821057786,-670.89953057970411,2081.4772664654738,2081.4772774287344]},"command":[0.042599336404503758,-0.11459579823703488,-0.26064110364246157,0.57893567047305505,0.57893567047305505],"arm":{"servo_position":[2.2499312661440565e-24,3.2526065174565154e-21,9.7514668052651336e-21,1.5881867761018057e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,8.6736173798840355e-19,0,0,0,0],"servo_effort":[0.0085838562108807356,-1.4636631473511046,-0.26324599222788264,7.2330250770193897e-06,-0.00041117494807894916,0.00010867784901925696]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":765,"step":6120,"t":30.600000000000001,"sim_time":30.599999999998197,"vehicle":{"origin_ned":[1.4999069480440277,1.0047113254709124,3.5048555939809831],"origin_quat_xyzw":[-0.021125164699436146,0.053052465881399023,0.37628143493050425,0.92474398890015241],"cg_ned":[1.4391949628994041,0.94620301560572229,3.2123034378314599],"linear_velocity_ned":[-0.0006717891036830269,-0.0025384345593666533,-0.0043776080101221486],"angular_velocity_ned":[-0.00050682003491892263,0.00059887078969271751,0.00064384768121618092]},"sensors":{"Odom":[1.4999069480440277,1.0047113254709124,3.5048555939809831,-0.0015042183275959028,-0.0013140035213560486,-0.0046442933078079864,-0.02112516469943616,0.053052465881399051,0.37628143493050448,0.92474398890015241,-1.8429678160661683e-05,0.00078314726847603707,0.0006452854484577089],"Pressure":[26888.966155632545],"DVL":[0.018966478520972486,0.0014434373835729495,0.04367518153397619,7.3765870884017417,0.011513075874409444,0.037116576421761471,-0.0086408920105175112,0],"IMU":[0.00086018748736576742,0.11426640930477704,0.77293589007986796,0.1227118226245091,-0.05513427260951205,0.27124126885947292,1.1278863246729658,-0.014630587459485693,-9.7435426154281615],"FOG":[0.78109579872607271],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[4.409217213294685,-11.997039407722337,-27.37855038892765,60.802019445882515,60.802019445882515],"omega_rad_s":[4.4755031021524125,-11.933183942848666,-27.390040801713788,60.776065365850641,60.77601575338317],"thrust_n":[0.25300176600601448,-1.8088196052971774,-9.5513370737421717,47.259618706071024,47.28320508380979],"torque_nm":[-0.0047437831126127712,0.033915367599322066,0.17908757013266574,-0.88611785073883187,-0.88656009532143354],"angle_rad":[-565.17955491489192,382.17122512679163,-671.99492196435176,2083.9080647475303,2083.9080737213981]},"command":[0.041992544888520805,-0.11425751816878416,-0.26074809894216811,0.57906685186554774,0.57906685186554774],"arm":{"servo_position":[2.2499312661440565e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018057e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,-4.3368086899420177e-19],"servo_effort":[0.0088272001971020329,-1.4643986488960692,-0.26333646623727375,7.7123434851686018e-06,-0.00041066375495473438,0.00010818247960613533]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":766,"step":6128,"t":30.640000000000001,"sim_time":30.639999999998189,"vehicle":{"origin_ned":[1.4998861388320459,1.0046179349703075,3.5046781097735487],"origin_quat_xyzw":[-0.021130572053158179,0.053067234151737759,0.37629343955804068,0.92473813316515174],"cg_ned":[1.4391685774012295,0.94610213566087153,3.2121286088403052],"linear_velocity_ned":[-0.00065022656767333559,-0.002509225163974808,-0.004365119745105445],"angular_velocity_ned":[-0.00049852492959475119,0.00061733139341532423,0.0006795973636161528]},"sensors":{"Odom":[1.4998861388320459,1.0046179349703075,3.5046781097735487,-0.0014676882734661551,-0.0013105820539605882,-0.0046282398761282881,-0.021130572053158193,0.053067234151737787,0.3762934395580409,0.92473813316515174,-3.8009033492872573e-06,0.00079060279004461854,0.00068294253994386509],"Pressure":[26888.890783597009],"DVL":[-0.0192579922235349,-0.016397566135265843,0.00088534514778056605,7.3072008376900115,-0.010969705673948041,-0.0024423127006706303,-0.013123146772879367,0],"IMU":[0.00086284269162009426,0.11429788356055988,0.77296275186788599,-0.029357045423126633,-0.034231834755833718,-0.0034200509469728252,1.1194207275642765,-0.0060527261681682723,-9.7511211691142048],"FOG":[0.76340543525989013],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[4.3444860969782235,-11.961501888600932,-27.38929079620722,60.815847092391593,60.815847092391593],"omega_rad_s":[4.4122374376409637,-11.898969570758428,-27.40180850461817,60.790327200655952,60.790277934081537],"thrust_n":[0.24587909710493835,-1.7986679241891281,-9.5598493967968743,47.281235234744678,47.305058489567131],"torque_nm":[-0.004610233070717595,0.033725023578546155,0.17924717618994138,-0.88652316065146286,-0.88696984667938372],"angle_rad":[-565.00197445447441,381.69467861937176,-673.09079356340135,2086.3394324968735,2086.3394394937623]},"command":[0.041376058066459269,-0.11391906560572317,-0.26085038853530684,0.57919854373706281,0.57919854373706281],"arm":{"servo_position":[2.2499312661440565e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018057e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,4.3368086899420177e-19],"servo_effort":[0.0090694369211958958,-1.4651423762163198,-0.26343181009140548,8.1807681925468863e-06,-0.00041020691681549281,0.00010772361483684998]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":767,"step":6136,"t":30.68,"sim_time":30.679999999998181,"vehicle":{"origin_ned":[1.499866308683216,1.0045256914311673,3.504501139537668],"origin_quat_xyzw":[-0.021135721059241195,0.053082251464466962,0.3763061163405188,0.92473199505558623],"cg_ned":[1.4391430454884797,0.9460024188274454,3.2119543169571614],"linear_velocity_ned":[-0.00062905777169639703,-0.0024802478642900615,-0.0043509650922482646],"angular_velocity_ned":[-0.00048943907052604544,0.00063467459307883106,0.00071480122159202678]},"sensors":{"Odom":[1.499866308683216,1.0045256914311673,3.504501139537668,-0.0014321972104914908,-0.0013070353853753968,-0.0046105109425497561,-0.021135721059241212,0.053082251464467003,0.37630611634051908,0.92473199505558623,1.0676343548365256e-05,0.00079670538058187795,0.00072003456964714926],"Pressure":[26886.437938195224],"DVL":[0.0094285546653035922,0.0074680302516694098,-0.01354425945146915,7.3418369201387765,0.012302153784613341,-0.018585896490558841,0.027879696903349838,0],"IMU":[0.00086625223508550681,0.11432962417662404,0.77299111748454297,-0.020121482640466898,0.040417093883556195,-0.079215146413037951,1.101593825714972,-0.0067070933166237705,-9.7451939545479824],"FOG":[0.77774819217426283],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[4.2788236699268261,-11.925960359882822,-27.399549255757972,60.829721565748535,60.829721565748535],"omega_rad_s":[4.3476493685136761,-11.864663866178869,-27.413036954268659,60.804642043784902,60.804593201179308],"thrust_n":[0.2387122611203637,-1.7885136367008634,-9.5679839458807709,47.302913174805376,47.326932531858503],"torque_nm":[-0.0044758548960068213,0.033534630688141186,0.17939969898526445,-0.88692962202760106,-0.88737998497234716],"angle_rad":[-564.8269551776641,381.21950282947535,-674.18712353306546,2088.7713719488102,2088.7713769843244]},"command":[0.040750701618350725,-0.11358057485602688,-0.26094808815007592,0.57933068157855749,0.57933068157855749],"arm":{"servo_position":[2.2499312661440565e-24,3.2526065174565154e-21,9.7514668052651336e-21,1.5881867761018057e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,8.6736173798840355e-19,0,0,0,4.3368086899420177e-19],"servo_effort":[0.0093109203354002548,-1.465892905512618,-0.26353156117343274,8.6432742899760896e-06,-0.00040978071092036668,0.00010730394569037499]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":768,"step":6144,"t":30.719999999999999,"sim_time":30.719999999998173,"vehicle":{"origin_ned":[1.4998474301356328,1.0044345758099502,3.5043247536935063],"origin_quat_xyzw":[-0.021140605918015226,0.05309749128095733,0.37631945557842822,0.92472558013404338],"cg_ned":[1.4391183518272415,0.94590385610533556,3.2117806280818475],"linear_velocity_ned":[-0.00060826429483618744,-0.0024514902183762981,-0.0043351775974005509],"angular_velocity_ned":[-0.00047963906061942291,0.00065085615641699806,0.000749468339335733]},"sensors":{"Odom":[1.4998474301356328,1.0044345758099502,3.5043247536935063,-0.0013977133685023819,-0.0013033417114120328,-0.004591138380027537,-0.02114060591801524,0.053097491280957365,0.37631945557842844,0.92472558013404338,2.4915825331249376e-05,0.00080147687652129811,0.0007565607540271829],"Pressure":[26885.70853714451],"DVL":[-0.027380214592536079,0.012019303914570926,-0.0028046728986768632,7.2787857706761407,-0.014296502482665348,-0.0067969919442493025,0.0012437523593656641,0],"IMU":[0.00087040561806977525,0.11436157750561773,0.77302096414954824,-0.017441260853152167,-0.0028035781278607829,0.012620318509739671,1.124026899876045,-0.0037635282497806288,-9.7215870382346754],"FOG":[0.77160505212734765],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[4.2123194901777552,-11.890430009741396,-27.409338108696303,60.8436360233381,60.8436360233381],"omega_rad_s":[4.2818845732610153,-11.830291794699242,-27.42374135479745,60.819003122238165,60.818954778151323],"thrust_n":[0.23152359475487649,-1.7783646546173024,-9.5757511571467049,47.324642592903729,47.34881788687651],"torque_nm":[-0.0043410674016539346,0.033344337274074418,0.17954533419650073,-0.88733704861694507,-0.88779033537893481],"angle_rad":[-564.65454661034084,380.74570083335612,-675.28389065148906,2091.2038850694157,2091.2038881622025]},"command":[0.040117328477883379,-0.11324219056896567,-0.26104131532091718,0.5794632002222676,0.5794632002222676],"arm":{"servo_position":[2.2499312661440565e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018057e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.0095519562804864781,-1.4666488888073808,-0.26363528063684438,9.091237900074755e-06,-0.00040938037747988002,0.00010691464220757672]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":769,"step":6152,"t":30.760000000000002,"sim_time":30.759999999998165,"vehicle":{"origin_ned":[1.4998294759352466,1.0043445704681713,3.5041490212511643],"origin_quat_xyzw":[-0.021145222599340489,0.053112926857518811,0.37633344764276783,0.9247188939062293],"cg_ned":[1.4390944818095919,0.9458064389663936,3.2116076067812567],"linear_velocity_ned":[-0.00058782821325666524,-0.0024229409589238173,-0.0043177904334553308],"angular_velocity_ned":[-0.00046920353825130303,0.0006658348811312137,0.00078360804961847804]},"sensors":{"Odom":[1.4998294759352466,1.0043445704681713,3.5041490212511643,-0.0013642050976556681,-0.0012994798673717023,-0.0045701540172785734,-0.021145222599340499,0.053112926857518838,0.37633344764276805,0.9247188939062293,3.8831929290718061e-05,0.00080494271229446148,0.00079252062172351795],"Pressure":[26880.834597418023],"DVL":[0.040003448354345029,0.017342450977701068,0.0041908273045962799,7.3371997754006228,-0.0008169690027915713,0.019403026171194094,-0.013069459083984009,0],"IMU":[0.00087528889769437326,0.11439369085338931,0.77305226905885838,-0.0080857578175487117,-0.0166370111692749,-0.043353019046696799,1.118285130727231,0.0056197219319826502,-9.75119860742344],"FOG":[0.79182620239183721],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[4.1450676507225879,-11.854927450792776,-27.418669847392799,60.857583565449083,60.857583565449083],"omega_rad_s":[4.2150734705584068,-11.795875968700733,-27.433936368397706,60.8334035714675,60.833355797187366],"thrust_n":[0.22433294117903552,-1.7682280887472099,-9.5831611080284382,47.346413348907717,47.370705135707531],"torque_nm":[-0.0042062426471069165,0.03315427666401019,0.17968427077553328,-0.88774525029201978,-0.88820072129451622],"angle_rad":[-564.48479281880816,380.27327476588653,-676.38107429190461,2093.6369735516764,2093.6369747232916]},"command":[0.039476834768786551,-0.1129040709599312,-0.26113018902278856,0.57959603395665793,0.57959603395665793],"arm":{"servo_position":[2.2499312661440565e-24,3.2526065174565154e-21,9.7514668052651336e-21,1.5881867761018057e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,8.6736173798840355e-19,0,0,0,4.3368086899420177e-19],"servo_effort":[0.0097927853838621591,-1.4674091601686217,-0.26374260484322964,9.5300823960941474e-06,-0.0004090068564740133,0.00010656100604154308]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":770,"step":6160,"t":30.800000000000001,"sim_time":30.799999999998157,"vehicle":{"origin_ned":[1.4998124190512272,1.0042556591414753,3.5039740098156682],"origin_quat_xyzw":[-0.021149568844299482,0.053128531313820906,0.37634808297920586,0.92471194181540306],"cg_ned":[1.4390714215326217,0.9457101593071906,3.2114353163051934],"linear_velocity_ned":[-0.00056773213347892056,-0.0023945898787545977,-0.004298836336830745],"angular_velocity_ned":[-0.0004582121049443284,0.00067957276816498543,0.00081722984026218008]},"sensors":{"Odom":[1.4998124190512272,1.0042556591414753,3.5039740098156682,-0.0013316410062041303,-0.0012954294919530428,-0.0045475895377884426,-0.021149568844299485,0.053128531313820913,0.37634808297920591,0.92471194181540306,5.2340561194872803e-05,0.00080713129607729993,0.00082791402253510986],"Pressure":[26880.715410888341],"DVL":[0.0018106311531047971,0.0017486080158344232,0.0056757807351407227,7.3120843652700689,0.0094902146705154108,-0.017949641330031782,-0.0060776271139094673,0],"IMU":[0.00088088473688115545,0.11442591260764241,0.77308500939896896,-0.05163081018398577,-0.064612013199903187,-0.066231215166991694,1.1172997373032907,-0.0064652388390313616,-9.7379501295490059],"FOG":[0.7588409552797587],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[4.0771657919532327,-11.81947021299905,-27.427556983049357,60.871557296967445,60.871557296967445],"omega_rad_s":[4.1473374312617688,-11.761437731372732,-27.443636314836688,60.847836468090712,60.847789331776156],"thrust_n":[0.21715839507763415,-1.7581105838016577,-9.5902236548360378,47.368215154635571,47.392584803947777],"torque_nm":[-0.0040717199077056404,0.032964573446281085,0.17981669352817573,-0.88815403414941707,-0.88861096507402093],"angle_rad":[-564.31773287074861,379.80222588859391,-677.47865440604062,2096.0706388126141,2096.070638087393]},"command":[0.038830150399554599,-0.11256638298094333,-0.26121482840999388,0.57972911711397568,0.57972911711397568],"arm":{"servo_position":[2.2499312661440565e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018057e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,-4.3368086899420177e-19],"servo_effort":[0.010033569860229229,-1.468172588548522,-0.26385316164906636,9.9536174161677112e-06,-0.00040865622355951934,0.00010623507890263197]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":771,"step":6168,"t":30.84,"sim_time":30.839999999998149,"vehicle":{"origin_ned":[1.4997962326921204,1.0041678269148282,3.5037997855967249],"origin_quat_xyzw":[-0.021153644161492336,0.053144277700332775,0.37636335210945399,0.92470472923811409],"cg_ned":[1.4390491577772933,0.94561500941136423,3.2112638186064837],"linear_velocity_ned":[-0.00054795919350372041,-0.0023664277914021569,-0.0042783474787446924],"angular_velocity_ned":[-0.00044674534365824619,0.0006920350587078935,0.00085034345259378714]},"sensors":{"Odom":[1.4997962326921204,1.0041678269148282,3.5037997855967249,-0.0012999899356301923,-0.0012911709949913006,-0.0045234763505548458,-0.021153644161492346,0.053144277700332802,0.37636335210945415,0.92470472923811409,6.535914723615401e-05,0.00080807404955188743,0.0008627412266975894],"Pressure":[26877.207315274474],"DVL":[-0.0035006446108360465,0.015300097705433235,-0.029855836641868586,7.4557698722067043,0.0024034268422457499,0.00084520447534596008,-0.0041777839665053411,0],"IMU":[0.00088717246232957521,0.11445819236072907,0.77311916235558586,0.026485152139048968,0.0061702806513962514,-0.025732509444400285,1.1158720077596684,-0.009271475576092765,-9.7463770550663735],"FOG":[0.76787564214772097],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[4.0087167622258857,-11.784076713044675,-27.436012369757997,60.885550279045034,60.885550279045034],"omega_rad_s":[4.0787932346064046,-11.726997861399735,-27.452855353140937,60.862294838197407,60.862248404928522],"thrust_n":[0.21001681068358422,-1.7480185346184169,-9.596948558527167,47.390037582838829,47.414447370977271],"torque_nm":[-0.0039378152003172037,0.032775347524095326,0.17994278547238443,-0.88856320467822814,-0.88902088820582381],"angle_rad":[-564.15340109369981,379.33255462361899,-678.57661151423929,2098.5048819911681,2098.5048793961046]},"command":[0.038178254878341769,-0.11222930202899691,-0.26129535590245712,0.57986238360995268,0.57986238360995268],"arm":{"servo_position":[2.2499312661440565e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018057e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,4.3368086899420177e-19],"servo_effort":[0.010274516166518581,-1.4689381753419151,-0.26396658483863217,1.0366243815165679e-05,-0.00040832885095611689,0.00010593848036765231]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":772,"step":6176,"t":30.879999999999999,"sim_time":30.879999999998141,"vehicle":{"origin_ned":[1.499780890321148,1.0040810601852723,3.5036264134139357],"origin_quat_xyzw":[-0.021157449804661218,0.053160139060012428,0.37637924563414166,0.92469726148007902],"cg_ned":[1.4390276779855005,0.94552098191088874,3.2110931743544833],"linear_velocity_ned":[-0.00052849313323911711,-0.0023384463116363215,-0.004256355927427115],"angular_velocity_ned":[-0.0004348835547074789,0.00070319025300649457,0.00088295836169858231]},"sensors":{"Odom":[1.499780890321148,1.0040810601852723,3.5036264134139357,-0.0012692210659236696,-0.0012866856655062134,-0.0044978459937042225,-0.021157449804661232,0.053160139060012469,0.37637924563414193,0.92469726148007902,7.7807605828218506e-05,0.00080780453858605983,0.00089700251420318734],"Pressure":[26877.21007899884],"DVL":[0.010374002741534273,-0.0049623318084382299,0.013156969974514286,7.4307300486260699,-0.0048495397364520815,0.0077708879620261885,-0.0075002479249086677,0],"IMU":[0.0008941281530850145,0.11449048100769499,0.77315470512673856,0.12933789660143685,0.077846574417952535,-0.029039147092352058,1.1117998427588121,-0.014838403344942894,-9.7388333452066842],"FOG":[0.77684152326752121],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[3.9398271088916479,-11.748766260030449,-27.444048752407497,60.899555559198994,60.899555559198994],"omega_rad_s":[4.0095559028439851,-11.692577078044348,-27.461607515292428,60.876771661997402,60.876725993779139],"thrust_n":[0.20292410444780126,-1.7379582394913415,-9.6033455085999826,47.411870094971036,47.436283272681599],"torque_nm":[-0.0038048269583962737,0.032586716990462658,0.18006272828624972,-0.88897256428070703,-0.88943031136277995],"angle_rad":[-563.9918271894918,378.86426056389161,-679.67492670017532,2100.9397039461801,2100.9396995107995]},"command":[0.03752216294182522,-0.11189301200028999,-0.2613718928800714,0.57999576723046664,0.57999576723046664],"arm":{"servo_position":[2.2499312661440565e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018057e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.010515605614141671,-1.4697049829102027,-0.26408259651134591,1.0761631038176268e-05,-0.00040802114959022877,0.00010566778195321892]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":773,"step":6184,"t":30.920000000000002,"sim_time":30.919999999998133,"vehicle":{"origin_ned":[1.4997663656714473,1.0039953466263556,3.5034539566969651],"origin_quat_xyzw":[-0.021160988744193674,0.053176088489771643,0.37639575423266508,0.92468954377343271],"cg_ned":[1.4390069702355106,0.94542806975274452,3.2109234429431237],"linear_velocity_ned":[-0.0005093183254989656,-0.0023106379519482645,-0.0042328933838406031],"angular_velocity_ned":[-0.00042270672939199137,0.00071301042478587372,0.00091508412553032911]},"sensors":{"Odom":[1.4997663656714473,1.0039953466263556,3.5034539566969651,-0.0012393039716119456,-0.001281955760864901,-0.0044707298921745171,-0.021160988744193688,0.053176088489771671,0.3763957542326653,0.92468954377343271,8.9608545141798727e-05,0.00080635868040097208,0.00093069854888883725],"Pressure":[26872.696120176828],"DVL":[0.012709765779819112,-0.027768067500532987,-0.011293034922602552,7.2969127997791601,-0.026921262294554518,-0.011412603922471003,0.0010732874729354215,0],"IMU":[0.00090172473998887531,0.11452273083931069,0.77319161492989452,0.11777501487596743,-0.032645785048995193,-0.0068872153532613138,1.1194571519735677,0.0013747608488888265,-9.7480837251470156],"FOG":[0.75927665610715478],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[3.8706083324876248,-11.713558847144748,-27.451679051479928,60.913566265747967,60.913566265747967],"omega_rad_s":[3.9397408329086407,-11.658196250661121,-27.469906803304333,60.891259917667142,60.891215073408169],"thrust_n":[0.19589546160307436,-1.7279359627000968,-9.609424187886134,47.43370210396381,47.458082968624964],"torque_nm":[-0.0036730399050576446,0.032398799300626828,0.18017670352286502,-0.88938191444932124,-0.88983905566171817],"angle_rad":[-563.83303625488475,378.39734247095896,-680.77358160812753,2103.3751052556067,2103.3750990118474]},"command":[0.036862936499882142,-0.11155770330614045,-0.26144456239504693,0.58012920253093303,0.58012920253093303],"arm":{"servo_position":[2.2499312661440565e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018057e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.010756900264394697,-1.4704721930405515,-0.26420089055960649,1.114304578234305e-05,-0.00040773140517292184,0.00010542215046486181]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":774,"step":6192,"t":30.960000000000001,"sim_time":30.959999999998125,"vehicle":{"origin_ned":[1.4997526327639819,1.0039106751409477,3.5032824774944964],"origin_quat_xyzw":[-0.021164265620954022,0.053192099200558625,0.37641286866375551,0.92468158127416267],"cg_ned":[1.4389870232169077,0.94533626616389788,3.2107546825064324],"linear_velocity_ned":[-0.0004904197528359267,-0.0022829960950498389,-0.0042079912248141537],"angular_velocity_ned":[-0.00041029342545845758,0.00072147133297850491,0.00094673008913646417]},"sensors":{"Odom":[1.4997526327639819,1.0039106751409477,3.5032824774944964,-0.0012102087924862307,-0.0012769647883011225,-0.0044421593606589586,-0.021164265620954033,0.053192099200558639,0.37641286866375562,0.92468158127416267,0.00010068817448824442,0.00080377403810059954,0.0009638301863680313],"Pressure":[26871.247893387575],"DVL":[0.011966458505838572,0.027924829622572075,-0.0051633517213351106,7.3516597670333805,0.001642081542747064,0.035055376678218869,0.0050459581106812781,0],"IMU":[0.00090993213708554215,0.1145548956192044,0.77322986901212387,-0.0093334958703568064,0.01852649698328233,-0.19226523871087398,1.1152877776499031,-0.0076678550757823113,-9.7516745976900143],"FOG":[0.77009887046218861],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[3.801175584660577,-11.678474989723483,-27.458916154336446,60.927575498632727,60.927575498632727],"omega_rad_s":[3.8694649865108159,-11.623876566659753,-27.477767181801674,60.905752578156473,60.905708613635966],"thrust_n":[0.18894543117695708,-1.7179579839506589,-9.6151942666452488,47.455522976363135,47.479836924978514],"torque_nm":[-0.0035427268345679451,0.03221171219907485,0.18028489249959845,-0.88979105580680884,-0.89024694234334723],"angle_rad":[-563.67704873682976,377.93179826434289,-681.87255844161723,2105.8110862164276,2105.8110781985133]},"command":[0.03620167223486264,-0.11122357133069984,-0.26151348718415662,0.58026262379650217,0.58026262379650217],"arm":{"servo_position":[2.2499312661440565e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018057e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.010998179107414826,-1.4712390291791062,-0.26432120148040295,1.150676093464578e-05,-0.00040745969373054267,0.00010520152508605623]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":775,"step":6200,"t":31,"sim_time":30.999999999998117,"vehicle":{"origin_ned":[1.4997396659280862,1.0038270358107775,3.5031120364750539],"origin_quat_xyzw":[-0.021167286687623021,0.053208144577674081,0.37643057976341182,0.92467337906088043],"cg_ned":[1.438967826204957,0.94524556462007803,3.2105869499251707],"linear_velocity_ned":[-0.00047178307680062058,-0.0022555148347270532,-0.0041816807258295762],"angular_velocity_ned":[-0.00039772057302627612,0.000728552694401495,0.00097790529429461976]},"sensors":{"Odom":[1.4997396659280862,1.0038270358107775,3.5031120364750539,-0.0011819061285162765,-0.0012716974487065264,-0.0044121658206044811,-0.021167286687623042,0.053208144577674144,0.37643057976341221,0.92467337906088043,0.0001109766423005406,0.00080008988018899594,0.00099639842222894507],"Pressure":[26872.370099250384],"DVL":[0.022011311191968905,0.011488749705453181,0.0084462318219963792,7.3425310721930108,0.011700536685046222,0.0060458688178220213,0.010853820060884218,0],"IMU":[0.0009187173961597144,0.11458693065200701,0.77326944465572856,0.049157701366069367,-0.1122426985553345,0.012397356919271255,1.136967995908388,-0.019792083945386379,-9.7564071066704745],"FOG":[0.78728682853700849],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[3.7316471080154261,-11.643535615469521,-27.465772985928215,60.941576431265425,60.941576431265425],"omega_rad_s":[3.7988473973751966,-11.589639553904444,-27.485202584319492,60.920242628735757,60.920199596569461],"thrust_n":[0.18208794579252829,-1.7080306043064033,-9.6206654065949717,47.477322066019731,47.501535647985357],"torque_nm":[-0.0034141489836099054,0.032025573830745065,0.18038747637365574,-0.89019978873786987,-0.89065379339972572],"angle_rad":[-563.52388035781223,377.46762500836076,-682.9718399619037,2108.2476468447185,2108.247637089034]},"command":[0.035539496266813582,-0.110890815385424,-0.26157879034217346,0.58039596601205168,0.58039596601205168],"arm":{"servo_position":[2.2499312661440565e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018057e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,-4.3368086899420177e-19],"servo_effort":[0.011239488891061704,-1.4720046645877973,-0.26444321468990001,1.1876090819024501e-05,-0.00040720212875888269,0.00010500116112610346]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":776,"step":6208,"t":31.039999999999999,"sim_time":31.039999999998109,"vehicle":{"origin_ned":[1.4997274398204932,1.0037444198413157,3.5029426929315202],"origin_quat_xyzw":[-0.021170059742911244,0.053224198238602236,0.37644887844440861,0.92466494213324979],"cg_ned":[1.4389493690333552,0.94515595881418801,3.2104203008363448],"linear_velocity_ned":[-0.00045339462672987782,-0.0022281890743346402,-0.0041539928718277597],"angular_velocity_ned":[-0.00038506276373698704,0.00073423830511713621,0.0010086185071223786]},"sensors":{"Odom":[1.4997274398204932,1.0037444198413157,3.5029426929315202,-0.0011543672443534642,-0.0012661398879803974,-0.004380780598093631,-0.021170059742911262,0.053224198238602277,0.37644887844440894,0.92466494213324979,0.0001204086230528106,0.00079534677084798185,0.0010284044881388075],"Pressure":[26868.602980980791],"DVL":[0.010925409790678428,0.010882085099571876,0.03003451696692554,7.4685533030762521,-0.019096318312237834,-0.0053373366295537683,-0.0018063458765887441,0],"IMU":[0.00092804487287699437,0.11461879284150436,0.77331031918775173,0.050683704845194591,-0.017963600333207614,-0.068293538806136839,1.0968285849646373,-0.0012586249505442439,-9.7362241655736277],"FOG":[0.76720904075105445],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[3.6621445497181675,-11.608762028780117,-27.472262338321769,60.955562274439657,60.955562274439657],"omega_rad_s":[3.7280096582179669,-11.555507101973411,-27.492226898806582,60.934723085036062,60.934681034645116],"thrust_n":[0.17533633698898196,-1.6981601513168414,-9.6258472481797561,47.499088742715792,47.52316970136129],"torque_nm":[-0.0032875563185434122,0.031840502837190775,0.18048463590337047,-0.8906079139259212,-0.89105943190052428],"angle_rad":[-563.37354202089705,377.0048188978372,-684.07140948675783,2110.6847868766868,2110.6847754216478]},"command":[0.034877567140173024,-0.11055963836933444,-0.26164059369830256,0.58052916451847292,0.58052916451847292],"arm":{"servo_position":[2.2499312661440565e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018087e-24,-1.6940658945088655e-23,-1.1180834903756616e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.011480712320065202,-1.4727683707060553,-0.26456655116910688,1.2359164668552494e-05,-0.00040697542790457349,0.00010436373319756296]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":777,"step":6216,"t":31.080000000000002,"sim_time":31.079999999998101,"vehicle":{"origin_ned":[1.4997159294515077,1.0036628195016601,3.5027745047820256],"origin_quat_xyzw":[-0.021172594046531174,0.053240234095187973,0.37646775569656887,0.92465627541028395],"cg_ned":[1.4389316420674936,0.94506744262922848,3.2102547896385634],"linear_velocity_ned":[-0.0004352414097025392,-0.0022010143524063665,-0.0041249585617305117],"angular_velocity_ned":[-0.00037239165174730935,0.00073851652976613096,0.0010388783435106986]},"sensors":{"Odom":[1.4997159294515077,1.0036628195016601,3.5027745047820256,-0.0011275639520902086,-0.0012602797822938014,-0.004348035110206391,-0.021172594046531181,0.053240234095187987,0.37646775569656898,0.92465627541028395,0.00012892406874398066,0.00078958650160667568,0.0010598500651617946],"Pressure":[26868.228401603861],"DVL":[-0.0067640963345714121,0.0022512760375978493,0.029562006535885227,7.4206863598099666,-0.033851562927015112,0.02775549264434465,0.0074623487459309877,0],"IMU":[0.00093787643216408114,0.11465044074231778,0.77335246999330221,-0.040157529131799867,-0.0098633349302651475,-0.1047119351421078,1.1122383994308547,-0.011745332298725377,-9.7617596540398193],"FOG":[0.76368648309220688],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[3.5927913838539149,-11.57417607686005,-27.478396915969881,60.96952632771854,60.96952632771854],"omega_rad_s":[3.6570757581122866,-11.521501479414731,-27.4988539388156,60.94918700433923,60.949145981925263],"thrust_n":[0.16870328871108606,-1.6883529840651252,-9.6307493900488819,47.52081241568866,47.544729727397176],"torque_nm":[-0.0031631866633328636,0.0316566184512211,0.1805765510634165,-0.89101523279416239,-0.89146368238869733],"angle_rad":[-563.22603971016497,376.54337524377337,-685.17125088785463,2113.1225057700181,2113.1224926559466]},"command":[0.034217060798608714,-0.1102302483510481,-0.26169901824733222,0.58066215550208133,0.58066215550208133],"arm":{"servo_position":[2.2499312661440565e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018087e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.011721377965934593,-1.4735295491438491,-0.26469110122870715,1.2876600755580251e-05,-0.00040672843547553093,0.00010466422269233347]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":778,"step":6224,"t":31.120000000000001,"sim_time":31.119999999998093,"vehicle":{"origin_ned":[1.49970511020543,1.0035822280809241,3.5026075285709775],"origin_quat_xyzw":[-0.021174900266202192,0.053256226420276741,0.37648720258816276,0.92464738372718502],"cg_ned":[1.4389146361769349,0.94498001010903365,3.2100904695002579],"linear_velocity_ned":[-0.0004173111104571956,-0.0021739870270680505,-0.0040946084033511845],"angular_velocity_ned":[-0.00035978130352928373,0.00074137892462238181,0.0010686935814126733]},"sensors":{"Odom":[1.49970511020543,1.0035822280809241,3.5026075285709775,-0.0011014679361446493,-0.0012541050443365055,-0.0043139608129315072,-0.021174900266202199,0.053256226420276769,0.37648720258816293,0.92464738372718502,0.00013646341509257638,0.00078285484253048183,0.0010907370439587917],"Pressure":[26865.19753799717],"DVL":[-0.019933077582606873,0.0447128693795176,0.0039043777232333232,7.3960194170196409,-0.018506647276220173,-0.016029719814208615,-0.01400926825236196,0],"IMU":[0.00094817159756294871,0.11468183464405585,0.77339587452891367,-0.0054450148463733921,-0.05346838813021125,-0.1639036437551793,1.1124006407261118,0.011804245282542421,-9.7338047795456841],"FOG":[0.76483892906654338],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[3.523712938338674,-11.539800090959599,-27.484189232519764,60.983461953558468,60.983461953558468],"omega_rad_s":[3.5861719024420773,-11.487645398451226,-27.505097397963713,60.963627499566961,60.963587548087006],"thrust_n":[0.16220079361587994,-1.6786155094472297,-9.6353813524621259,47.542482524211835,47.566206499724281],"torque_nm":[-0.0030412648802977489,0.031474040802135561,0.18066340035866485,-0.89142154732897205,-0.89186637186983042],"angle_rad":[-563.08137439912036,376.08328845622754,-686.27134858673355,2115.5608027059502,2115.5607879749423]},"command":[0.033559170841320707,-0.10990285800913903,-0.26175418316685489,0.5807948757481759,0.5807948757481759],"arm":{"servo_position":[2.2499312661440565e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018087e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,-8.6736173798840355e-19,0,0,0,4.3368086899420177e-19],"servo_effort":[0.011961937185806444,-1.4742866428037076,-0.2648164739705236,1.3382745973004656e-05,-0.00040650867109915203,0.00010452002208172455]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":779,"step":6232,"t":31.16,"sim_time":31.159999999998085,"vehicle":{"origin_ned":[1.4996949576825593,1.0035026400558655,3.5024418195869611],"origin_quat_xyzw":[-0.021176990867455902,0.053272149704707346,0.37650721027957923,0.9246382718291124],"cg_ned":[1.4388983427449267,0.94489365544230441,3.2099273924796652],"linear_velocity_ned":[-0.00039958963416308202,-0.0021471026702433119,-0.0040629656786730596],"angular_velocity_ned":[-0.00034731732361142605,0.00074277826539231341,0.0010980759657135235]},"sensors":{"Odom":[1.4996949576825593,1.0035026400558655,3.5024418195869611,-0.0010760558011262094,-0.0012475936567120165,-0.0042785806817142074,-0.021176990867455909,0.053272149704707367,0.37650721027957934,0.9246382718291124,0.00014293164577295839,0.00077517788399472794,0.0011210662309157277],"Pressure":[26862.134289942747],"DVL":[-0.00040125038494160108,0.034585836855426134,0.018585403505336478,7.3140524619504514,-0.0011258277593499001,0.023745702220600656,-0.019394494357293467,0],"IMU":[0.00095888671888223677,0.11471293660103575,0.77344051030464644,0.039549546783058304,-0.022515917774996626,0.2263768214644753,1.1156419540679363,-0.0081467007734790826,-9.7611408769767163],"FOG":[0.7792792866364604],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[3.4550810643907361,-11.505660778931921,-27.48965389192329,60.997362379631973,60.997362379631973],"omega_rad_s":[3.5154359603849379,-11.453962889282547,-27.510971323628983,60.978037709942939,60.977998869009362],"thrust_n":[0.15584096968561675,-1.6689544487130534,-9.6397529449700823,47.564088531913164,47.587590462559099],"torque_nm":[-0.0029220181816053139,0.031292895913369756,0.18074536771818908,-0.89182665997337174,-0.89226732117298324],"angle_rad":[-562.93954181196023,375.62455201190022,-687.37168755768619,2117.9996765912424,2117.9996602870383]},"command":[0.032905533946578441,-0.10957772170411352,-0.26180622754212657,0.58092726075839973,0.58092726075839973],"arm":{"servo_position":[2.2499312661440565e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018087e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,4.3368086899420177e-19],"servo_effort":[0.012205806246593879,-1.4749446967520923,-0.26492121385882983,1.3876455537163391e-05,-0.00040630210709438294,0.00010439861146968929]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":780,"step":6240,"t":31.199999999999999,"sim_time":31.199999999998077,"vehicle":{"origin_ned":[1.4996854462684142,1.0034240513374442,3.5022774326685582],"origin_quat_xyzw":[-0.021178881390431451,0.053287976178356192,0.37652776968170781,0.92462894462394141],"cg_ned":[1.4388827538380018,0.94480837309252819,3.209765610021476],"linear_velocity_ned":[-0.00038205900263827406,-0.0021203540591624502,-0.004030043882255533],"angular_velocity_ned":[-0.00033515741234118945,0.00074245222386788853,0.0011270029121947709]},"sensors":{"Odom":[1.4996854462684142,1.0034240513374442,3.5022774326685582,-0.001051331684854872,-0.0012406681256447948,-0.0042419021635683772,-0.021178881390431458,0.053287976178356199,0.37652776968170792,0.92462894462394141,0.00014803714353855466,0.00076647813792356256,0.0011507813120168766],"Pressure":[26861.481110309374],"DVL":[-0.033791719730804387,-0.01096937879183069,0.040626793585045937,7.349283377622891,-0.010388754798558495,-0.012496531011313585,-0.0044367985324830946,0],"IMU":[0.00096997066842547069,0.11474370679877691,0.77348635381011077,-0.057161607724234009,0.067296600686509098,0.028348014231621105,1.1188819092654989,-0.001615953710359868,-9.7283873503734775],"FOG":[0.74692413140529923],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[3.3872182782559985,-11.471724782312229,-27.494797623906567,61.011212778858969,61.011212778858969],"omega_rad_s":[3.4450535495245593,-11.42046654464041,-27.516488218315033,60.992408831579361,60.992371138811478],"thrust_n":[0.14963909398296221,-1.6593731148044082,-9.6438732135764855,47.585617920952792,47.608866890277483],"torque_nm":[-0.0028057330121805417,0.031113245902582652,0.1808226227545591,-0.89223033601786483,-0.89266625419270285],"angle_rad":[-562.80053124911672,375.16715859714634,-688.47225330868503,2120.4391260226962,2120.439108190566]},"command":[0.032259221697676178,-0.10925452173630694,-0.26185521546577684,0.58105916932246637,0.58105916932246637],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018087e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[3.3881317890172014e-21,0,0,6.7762635780344027e-21,0,4.3368086899420177e-19],"servo_effort":[0.012457966154408501,-1.4754905562431453,-0.26500210658139411,1.436292360692485e-05,-0.00040620365666669997,0.00010433276257226918]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":781,"step":6248,"t":31.240000000000002,"sim_time":31.239999999998069,"vehicle":{"origin_ned":[1.4996765485002015,1.0033464601831756,3.5021144217969868],"origin_quat_xyzw":[-0.021180592497544184,0.053303675632122939,0.37654887090234862,0.92461940737133819],"cg_ned":[1.4388678620775437,0.94472415768451512,3.2096051726500181],"linear_velocity_ned":[-0.00036470827640888172,-0.002093738698323877,-0.0039958718041173949],"angular_velocity_ned":[-0.00032344806705365879,0.0007402902863144138,0.0011554549040140194]},"sensors":{"Odom":[1.4996765485002015,1.0033464601831756,3.5021144217969868,-0.001027275965423535,-0.0012332825117406722,-0.0042039539813473834,-0.021180592497544195,0.053303675632122967,0.37654887090234884,0.92461940737133819,0.00015160126124264,0.00075677896186093839,0.0011798419622036651],"Pressure":[26859.771174161171],"DVL":[0.013287436586432524,-0.014257864016753354,-0.00082085584853512335,7.4218252891862271,-0.020034425647261527,-0.018989810153344892,0.026584652728790754,0],"IMU":[0.00098136082642832022,0.11477410477277515,0.77353337911380915,0.046138358745422249,-0.025122808495975125,0.073591359826530756,1.1144677726302963,-0.024189138952744885,-9.7643034042289418],"FOG":[0.7852731297344393],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[3.3208401965376964,-11.437896481961204,-27.49966116842895,61.025002461907008,61.025002461907008],"omega_rad_s":[3.375375274908254,-11.387132879298152,-27.521667769196078,61.006730638312355,61.00669413046483],"thrust_n":[0.14362325699989603,-1.6498642415127596,-9.6477561176651943,47.607055229016268,47.630020687591234],"torque_nm":[-0.002692936068748051,0.030934954528364249,0.1808954272062224,-0.89263228554405505,-0.89306288789233579],"angle_rad":[-562.66432089975604,374.71110124721497,-689.57303198306738,2122.8791492016289,2122.8791298883293]},"command":[0.031627049490835203,-0.10893234744724956,-0.26190153493741858,0.58119049963720959,0.58119049963720959],"arm":{"servo_position":[-1.4690727678941952e-23,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018087e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,-8.6736173798840355e-19,0,0,0,0],"servo_effort":[0.012710338935800159,-1.4760189102747818,-0.2650806379169709,1.4844821880250293e-05,-0.00040616244201102414,0.00010440105167897168]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":782,"step":6256,"t":31.280000000000001,"sim_time":31.279999999998061,"vehicle":{"origin_ned":[1.499668237322886,1.0032698655169741,3.5019528396235726],"origin_quat_xyzw":[-0.021182145768334049,0.053319218244465019,0.37657050392500829,0.9246096653399819],"cg_ned":[1.4388536604770841,0.94464100393605288,3.2094461296765902],"linear_velocity_ned":[-0.00034752815934833932,-0.002067254659524541,-0.0039604807598745389],"angular_velocity_ned":[-0.00031220091241593924,0.00073634137808569248,0.0011834351669394443]},"sensors":{"Odom":[1.499668237322886,1.0032698655169741,3.5019528396235726,-0.0010038642872125132,-0.0012254490272999182,-0.0041647686058127889,-0.021182145768334062,0.053319218244465047,0.37657050392500852,0.9246096653399819,0.00015364927257728903,0.00074612362235056346,0.0012082542242220454],"Pressure":[26857.21968235854],"DVL":[-0.025669339663666853,-0.0016933345005109225,-0.011714117980312763,7.3086284951788629,0.031213927655214337,-0.03725363292856098,0.028205424457474756,0],"IMU":[0.00099299313888632709,0.11480409147582958,0.77358155995965638,-0.023060644820439,0.007189908884723312,0.085488835699823518,1.1205174183454654,-0.002849307533871308,-9.7608236512803828],"FOG":[0.77849108514289056],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[3.2561109720220203,-11.404180281206806,-27.504259019939408,61.038724577575309,61.038724577575309],"omega_rad_s":[3.3067372865727616,-11.353940384996042,-27.526530727909659,61.020993830996112,61.020958543439519],"thrust_n":[0.13781791072903848,-1.6404212632559565,-9.6514161703410011,47.628386164132756,47.651038787149417],"torque_nm":[-0.0025840858261694721,0.030757898686049188,0.18096405319389378,-0.89303224057748931,-0.8934569772590516],"angle_rad":[-562.53087469440879,374.25637398515045,-690.67401056959602,2125.3197439406508,2125.31972319438]},"command":[0.031010580685924004,-0.10861124077339815,-0.26194532399942294,0.58132118645309816,0.58132118645309816],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018087e-24,4.3198680309969292e-21,1.0503208545953473e-21],"servo_velocity":[3.3881317890172014e-21,0,0,0,0,-4.3368086899420177e-19],"servo_effort":[0.012961087134694219,-1.4765421732346582,-0.26515903399084567,1.5316565427704038e-05,-0.00039302255254845006,0.00010448218862494278]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":783,"step":6264,"t":31.32,"sim_time":31.319999999998053,"vehicle":{"origin_ned":[1.4996604866693568,1.0031942664615969,3.5017927373763884],"origin_quat_xyzw":[-0.021183562601129195,0.053334575276885607,0.37659265882226767,0.92459972370574128],"cg_ned":[1.4388401424176358,0.94455890661699626,3.2092885291464666],"linear_velocity_ned":[-0.00033050954510077099,-0.0020409010711564036,-0.003923902491945081],"angular_velocity_ned":[-0.00030142717640843506,0.00073066248098771242,0.0012109484352529492]},"sensors":{"Odom":[1.4996604866693568,1.0031942664615969,3.5017927373763884,-0.0009810714471975698,-0.0012171821220158217,-0.0041243793102817457,-0.021183562601129215,0.053334575276885655,0.376592658822268,0.92459972370574128,0.00015421215526983028,0.00073456087436382037,0.0012360263143085355],"Pressure":[26855.918870793237],"DVL":[-0.0011725920414320918,0.0028535216730118398,-0.0087607209764518391,7.3440901015918083,0.0013997396335223744,0.0033787610472645257,0.022119463190333876,0],"IMU":[0.0010048047166389431,0.11483362973867192,0.77363087038941525,-0.031917600645839657,0.024799948902448406,-0.062217929685674717,1.1210052643613748,-0.0051368665114882193,-9.7266649088380657],"FOG":[0.77134876621549531],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[3.1931092662414802,-11.370599818421628,-27.508601495203578,61.052373157960695,61.052373157960695],"omega_rad_s":[3.2393943997369128,-11.320882082665666,-27.531094720951458,61.03519012298473,61.035156089075834],"thrust_n":[0.1322385422357446,-1.6310418785903782,-9.6548656776598243,47.649597928567339,47.671909834091402],"torque_nm":[-0.0024794726669202117,0.03058203522356959,0.18102873145612172,-0.89342996116063778,-0.89384830938921389],"angle_rad":[-562.40014503866848,373.80297135555696,-691.7751768131551,2127.760907703901,2127.7608855742292]},"command":[0.030410564440395048,-0.10829142684211074,-0.26198668090670074,0.581451172932959,0.581451172932959],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018087e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[3.3881317890172014e-21,0,0,0,-8.6736173798840355e-19,0],"servo_effort":[0.013210618564361027,-1.4770595278537864,-0.2652370781903457,1.5775058745326031e-05,-0.00039302452363538804,0.00010457399563499589]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":784,"step":6272,"t":31.359999999999999,"sim_time":31.359999999998045,"vehicle":{"origin_ned":[1.4996532715214497,1.0031196622856977,3.501634164844599],"origin_quat_xyzw":[-0.021184864127262944,0.053349719176929634,0.37661532578967943,0.92458958753383425],"cg_ned":[1.4388273016368918,0.94447786051709048,3.2091324178341729],"linear_velocity_ned":[-0.0003136437476626223,-0.0020146775958010768,-0.0038861687603145185],"angular_velocity_ned":[-0.00029113536119391124,0.00072331589441050614,0.0012380021781834482]},"sensors":{"Odom":[1.4996532715214497,1.0031196622856977,3.501634164844599,-0.00095887231951664333,-0.0012084977732018461,-0.0040828195604561525,-0.021184864127262948,0.053349719176929641,0.37661532578967949,0.92458958753383425,0.00015332620563092357,0.00072214137454095113,0.0012631698162457303],"Pressure":[26853.79586122547],"DVL":[0.058155552979022661,0.0077799320263356921,-0.0013414061025762724,7.4151649728622022,-0.0076438984961993061,0.0050752918254518935,-0.0094356962945418496,0],"IMU":[0.0010167340776809617,0.11486268439642119,0.77368128483330789,0.0147803223379342,0.031425510614387323,-0.081561565047410939,1.150635012692127,-0.023899191548133761,-9.7365046796741375],"FOG":[0.77621143098942802],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[3.131899602867962,-11.337181964180749,-27.512698508458506,61.065942455331388,61.065942455331388],"omega_rad_s":[3.1735416312159805,-11.287962179870357,-27.535375130227425,61.049312015149191,61.049279265747735],"thrust_n":[0.12689419052608134,-1.6217270283701559,-9.6581153660098327,47.670678916452545,47.692623733340852],"torque_nm":[-0.0023792660723640246,0.030407381781940426,0.18108966311268437,-0.89382522968348521,-0.89423669500014114],"angle_rad":[-562.27207555228335,373.35088791959606,-692.87651911087528,2130.2026376425492,2130.2026141803249]},"command":[0.029827615265409162,-0.10797316156362619,-0.2620257000805572,0.58158040433648939,0.58158040433648939],"arm":{"servo_position":[-1.4690727678941952e-23,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018087e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[-3.3881317890172014e-21,0,0,0,0,0],"servo_effort":[0.013456860969539889,-1.4775695161341533,-0.26531461879636459,1.6217938080625146e-05,-0.00040617547197437494,0.00010467580612557414]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":785,"step":6280,"t":31.400000000000002,"sim_time":31.399999999998037,"vehicle":{"origin_ned":[1.4996465677880066,1.0030460522055507,3.501477170637934],"origin_quat_xyzw":[-0.021186070929166349,0.05336462317489523,0.37663849519865988,0.9245792617869355],"cg_ned":[1.4388151322676077,0.9443978604860096,3.2089778414219978],"linear_velocity_ned":[-0.00029691923550979215,-0.0019885813821826303,-0.0038473016064619085],"angular_velocity_ned":[-0.00028129153476358365,0.0007143296218149333,0.0012646029008127274]},"sensors":{"Odom":[1.4996465677880066,1.0030460522055507,3.501477170637934,-0.00093725538124236267,-0.001199414099581233,-0.0040401100017994664,-0.021186070929166367,0.053364623174895279,0.37663849519866022,0.9245792617869355,0.00015103418079891266,0.00070886159194175069,0.0012896961473835974],"Pressure":[26852.293133075942],"DVL":[0.019809315507023591,0.010505787004961778,0.0098063940877991113,7.4227021610396138,0.024794106326297288,0.027773637633486871,0.028581638715390479,0],"IMU":[0.001028721371504266,0.11489122132744801,0.77373277821470987,-0.019849715897837145,0.020136002127955365,-0.037579387085828302,1.1358024491268659,0.00049493013922044179,-9.7402087240434021],"FOG":[0.7819997274011985],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[3.0725398081360606,-11.30395366140816,-27.516555658115873,61.079425504444792,61.079425504444792],"omega_rad_s":[3.1093306578582007,-11.255193253189006,-27.539384781466538,61.063352343314641,61.063320906719966],"thrust_n":[0.12178932505125289,-1.6124800709337468,-9.6611742464638475,47.691618392627802,47.713169913449498],"torque_nm":[-0.0022835498447109923,0.030234001330007754,0.18114701712119713,-0.89421784486177158,-0.8946219358771782],"angle_rad":[-562.14660307654458,372.90011786424043,-693.97802642073134,2132.6449306183986,2132.6449058756461]},"command":[0.029262283887010101,-0.10765670153722058,-0.26206243483919878,0.58170881432804566,0.58170881432804566],"arm":{"servo_position":[1.9190590211230062e-23,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018087e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[6.7762635780344027e-21,0,0,0,0,0],"servo_effort":[0.01370322689280319,-1.4780391391576151,-0.26539512258501163,1.6648534373355021e-05,-0.00040619555440376463,0.00010475433945764105]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":786,"step":6288,"t":31.440000000000001,"sim_time":31.43999999999803,"vehicle":{"origin_ned":[1.4996403521738795,1.0029734351163011,3.5013218025164403],"origin_quat_xyzw":[-0.021187202681461553,0.053379260773117818,0.37666215757656862,0.92456875137093741],"cg_ned":[1.4388036289003208,0.9443189014765776,3.20882484472703],"linear_velocity_ned":[-0.0002803260972624879,-0.0019626112165939719,-0.0038073260886853596],"angular_velocity_ned":[-0.00027187137539884637,0.00070375051155889545,0.0012907565895282922]},"sensors":{"Odom":[1.4996403521738795,1.0029734351163011,3.5013218025164403,-0.00091620498017599245,-0.0011899511625048263,-0.0039962755570477106,-0.021187202681461556,0.053379260773117831,0.37666215757656868,0.92456875137093741,0.00014738514761159568,0.00069473818818188639,0.0013156169156850462],"Pressure":[26851.918867274049],"DVL":[0.0027718050892192453,-0.015191347976828752,0.012345232972466176,7.3603283273657922,0.028058001195004324,-0.0082505182170694077,-0.044586934973195866,0],"IMU":[0.0010407086557194844,0.11491920623474856,0.77378532589416771,-0.028144117826036423,-0.022794088618278086,0.12581924334690051,1.1323621502798928,-0.016724346337698162,-9.7528657738747615],"FOG":[0.77942348000275496],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[3.0150643329325799,-11.270919630658675,-27.520171975937544,61.092810776237009,61.092810776237009],"omega_rad_s":[3.0468769498269554,-11.222586478359769,-27.543132322626466,61.077302621394061,61.077272524173402],"thrust_n":[0.11692481986626083,-1.6033039177362058,-9.6640483974559412,47.712403524514144,47.733535763023035],"torque_nm":[-0.0021923403724923908,0.030061948457553857,0.18120090745229889,-0.89460756608464032,-0.89500379555668208],"angle_rad":[-562.02365922331603,372.45065489341295,-695.07968811789021,2135.0877831778726,2135.0877572077084]},"command":[0.028714898408881712,-0.10734209172055881,-0.26209687596130993,0.58183629310701912,0.58183629310701912],"arm":{"servo_position":[-1.4690727678941952e-23,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018087e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[-3.3881317890172014e-21,0,0,0,-8.6736173798840355e-19,0],"servo_effort":[0.013948316653208653,-1.4784931429745478,-0.26547549952408322,1.7068329056199924e-05,-0.00039306829919948946,0.00010480078986880792]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":787,"step":6296,"t":31.48,"sim_time":31.479999999998022,"vehicle":{"origin_ned":[1.4996346025062546,1.0029018098398923,3.5011681068614982],"origin_quat_xyzw":[-0.021188278444830112,0.053393606760885462,0.37668630360788513,0.92455806106909066],"cg_ned":[1.4387927864257959,0.94424097840691323,3.2086734713502802],"linear_velocity_ned":[-0.00026385794303308006,-0.0019367689196715906,-0.0037662748890693971],"angular_velocity_ned":[-0.00026287781374703862,0.00069166116172754899,0.0013164700258237916]},"sensors":{"Odom":[1.4996346025062546,1.0029018098398923,3.5011681068614982,-0.00089569578557442838,-0.0011801302980275464,-0.0039513515041759949,-0.021188278444830119,0.05339360676088549,0.3766863036078853,0.92455806106909066,0.00014243353616545334,0.00067983243778711256,0.0013409451073041947],"Pressure":[26851.860572782931],"DVL":[-0.0058689695642603059,2.4755992316676748e-05,0.011175186452769078,7.4048314284567898,-0.0012706710896271357,-0.00028780924750501972,-0.0036548657357084137,0],"IMU":[0.0010526401218533749,0.11494660675100228,0.77383890373573949,0.027457466811203885,-0.062310416140776308,0.037333286734778273,1.1289824359900962,-0.0088148769706515116,-9.7698226403523876],"FOG":[0.78073688750769588],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[2.9594960476777246,-11.23811101757995,-27.523554887633839,61.106092512899316,61.106092512899316],"omega_rad_s":[2.9862666875296568,-11.190158038328091,-27.546625503633845,61.091154779672031,61.09112604634511],"thrust_n":[0.1122988235146082,-1.594202834501399,-9.6667431703608102,47.733021699177328,47.753710438737833],"torque_nm":[-0.0021056029408989033,0.029891303146901232,0.18125143444426522,-0.89499415685957484,-0.89538207072633458],"angle_rad":[-561.90317166961995,372.00249217176815,-696.18149389338589,2137.5311915318216,2137.5311643883801]},"command":[0.028185676644549757,-0.10702962873885666,-0.26212909416794133,0.58196278583713634,0.58196278583713634],"arm":{"servo_position":[-1.4690727678941952e-23,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018087e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[-6.7762635780344027e-21,0,1.7347234759768071e-18,0,0,0],"servo_effort":[0.0141926366435575,-1.4789382891255327,-0.26555487090572111,1.7475598939085798e-05,-0.00040624729015057586,0.00010485282080661622]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":788,"step":6304,"t":31.52,"sim_time":31.519999999998014,"vehicle":{"origin_ned":[1.4996292978317947,1.0028311751495271,3.5010161285324353],"origin_quat_xyzw":[-0.021189316671422719,0.053407637508602973,0.37671092413828722,0.92454719552309783],"cg_ned":[1.4387825999742738,0.94416408611640035,3.2085237635800627],"linear_velocity_ned":[-0.00024750914004556909,-0.0019110565546870441,-0.0037241808839347124],"angular_velocity_ned":[-0.00025431093306459672,0.00067814851182347146,0.0013417501213900697]},"sensors":{"Odom":[1.4996292978317947,1.0028311751495271,3.5010161285324353,-0.00087570279732114651,-0.0011699739773508989,-0.0039053734529899352,-0.021189316671422726,0.053407637508602994,0.37671092413828738,0.92454719552309783,0.00013623880516803002,0.00066420672554510477,0.0013656944228933059],"Pressure":[26847.21896003481],"DVL":[0.025640016078472889,0.031843236066717531,0.0095313750669917333,7.2859086444393899,-0.028189027562687975,0.047917840226753848,0.02220657023076068,0],"IMU":[0.001064462309927028,0.11497339298838628,0.77389348814187775,0.014355061012263862,0.054227377495878609,0.056163547008661552,1.1107391501732782,-0.0078389014228040736,-9.7230390104466444],"FOG":[0.76780010058246573],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[2.905842379913719,-11.205563703555374,-27.526712706099868,61.119266008854453,61.119266008854453],"omega_rad_s":[2.9275611907271237,-11.157930985811026,-27.549872441559224,61.104901817051726,61.104874469447964],"thrust_n":[0.10790735982069544,-1.585182985935891,-9.6692641670437478,47.753461937569107,47.773684834473066],"torque_nm":[-0.0020232629966380395,0.029722180986297961,0.1812987031320703,-0.89537741132942084,-0.89575659064637003],"angle_rad":[-561.78506522077282,371.55562205509381,-697.28343375730822,2139.9751515934067,2139.9751233317438]},"command":[0.027674689332511611,-0.10671965431957499,-0.26215916862952254,0.58208824770337575,0.58208824770337575],"arm":{"servo_position":[-1.4690727678941952e-23,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018087e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.014435978056638802,-1.4793740611897763,-0.26563312179657278,1.7866853095075574e-05,-0.0004062791347159914,0.00010491153694784171]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":789,"step":6312,"t":31.560000000000002,"sim_time":31.559999999998006,"vehicle":{"origin_ned":[1.4996244184312197,1.0027615297275558,3.5008659108589151],"origin_quat_xyzw":[-0.021190335121288137,0.05342133102116825,0.37673601018307518,0.92453615922835164],"cg_ned":[1.4387730648830686,0.94408821935667064,3.2083757623877287],"linear_velocity_ned":[-0.00023127485654266515,-0.0018854764369481062,-0.003681077026107476],"angular_velocity_ned":[-0.00024616791507368825,0.00066330338150647394,0.0013666040496690213]},"sensors":{"Odom":[1.4996244184312197,1.0027615297275558,3.5008659108589151,-0.00085620150815700379,-0.0011595056894497565,-0.0038583772135246529,-0.021190335121288147,0.053421331021168271,0.37673601018307534,0.92453615922835164,0.00012886514556065853,0.0006479241775174296,0.0013898793765465449],"Pressure":[26847.472843482115],"DVL":[-0.0074185183258872953,0.029435426999048532,0.0089842607173753631,7.3391098058444957,0.0029792909903122826,-0.032025372170021507,0.008770301357039257,0],"IMU":[0.0010761243059461334,0.11499953757435476,0.77394905608446496,0.072271221043585535,-0.10263057331036661,-0.098672530946972342,1.1307080995938539,-0.021184330777240593,-9.7644678994641723],"FOG":[0.78149224962015162],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[2.8540965174919557,-11.173315215939672,-27.529653309718455,61.132326794765362,61.132326794765362],"omega_rad_s":[2.8708000586791038,-11.125933591035514,-27.552881364255828,61.118537541675138,61.11851159850076],"thrust_n":[0.10374477739555968,-1.5762519418958241,-9.6716170629403351,47.773714510377793,47.793451119406051],"torque_nm":[-0.0019452145761667439,0.029554723910546716,0.18134281993013129,-0.89575714706958376,-0.8961272084888634],"angle_rad":[-561.66926273069294,371.11003585461134,-698.38549804756349,2142.4196590147458,2142.4196296907226]},"command":[0.027181871595161482,-0.10641252586609212,-0.26218717437827099,0.58221263614062246,0.58221263614062246],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018087e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[3.3881317890172014e-21,0,1.7347234759768071e-18,0,0,0],"servo_effort":[0.014678188038717569,-1.4798001205775371,-0.26571014567293577,1.824736835027014e-05,-0.00040631303631344373,0.00010497481097560969]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":790,"step":6320,"t":31.600000000000001,"sim_time":31.599999999997998,"vehicle":{"origin_ned":[1.4996199458282964,1.0026928721238959,3.50071749563365],"origin_quat_xyzw":[-0.02119135078485777,0.053434666984851456,0.37676155293596658,0.92452495652924904],"cg_ned":[1.4387641766635049,0.94401337278117115,3.2082295074230811],"linear_velocity_ned":[-0.00021515113585111756,-0.0018600311011260694,-0.0036369964412451671],"angular_velocity_ned":[-0.00023844323772461676,0.00064722003181594376,0.0013910391056615235]},"sensors":{"Odom":[1.4996199458282964,1.0026928721238959,3.50071749563365,-0.00083716797610713326,-0.001148749747402384,-0.0038103988859155579,-0.021191350784857781,0.053434666984851484,0.3767615529359668,0.92452495652924904,0.00012038105187081382,0.000631048483934435,0.0014135151056690442],"Pressure":[26843.535931681883],"DVL":[-0.026053770486143019,0.013625066958480935,-0.010124629811613465,7.3158790274022154,0.034677566629226421,-0.0059806097024461781,0.0014058806627285252,0],"IMU":[0.0010875779232621865,0.11502501567988031,0.77400558513557283,-0.012972962653620706,-0.02690029218172655,0.17674812870659584,1.1407724271347965,0.0084491681130330742,-9.6977181674038935],"FOG":[0.75489155964724186],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[2.8042362914238392,-11.141404721729911,-27.532384044537544,61.145270644435762,61.145270644435762],"omega_rad_s":[2.8160029946375529,-11.094198206278222,-27.55566039361711,61.132056390357668,61.132031866913771],"thrust_n":[0.099804061483766388,-1.5674183364520706,-9.6738074545320831,47.793770661723336,47.813002456863728],"torque_nm":[-0.0018713261528206199,0.029389093808476326,0.18138388977247655,-0.89613319990731266,-0.89649379606619517],"angle_rad":[-561.55568592696,370.66572365524758,-699.48767742918926,2144.8647092149713,2144.8646788851202]},"command":[0.026707012299274659,-0.10610861639742773,-0.26221318137654803,0.58233591089938819,0.58233591089938819],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018087e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.014919028263292024,-1.4802161007070187,-0.26578581974602844,1.8612614264097497e-05,-0.00040634638221169299,0.0001050444599634774]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":791,"step":6328,"t":31.640000000000001,"sim_time":31.63999999999799,"vehicle":{"origin_ned":[1.4996158627922465,1.0026252007140011,3.5005709231078477],"origin_quat_xyzw":[-0.021192379801970699,0.053447626805080556,0.37678754377472856,0.92451359161639191],"cg_ned":[1.4387559309650999,0.94393954093850729,3.208085037010882],"linear_velocity_ned":[-0.00019913489629732584,-0.0018347232709948489,-0.0035919722292941806],"angular_velocity_ned":[-0.00023112825519389833,0.00062999588002003921,0.0014150626543205718]},"sensors":{"Odom":[1.4996158627922465,1.0026252007140011,3.5005709231078477,-0.00081857897640152466,-0.001137731300936356,-0.0037614746353122983,-0.021192379801970716,0.053447626805080597,0.37678754377472884,0.92451359161639191,0.00011085942890379604,0.00061364340036621,0.0014366173321570717],"Pressure":[26843.306664803724],"DVL":[0.0087825337620873137,0.0081791081731817754,-0.0016156684212234843,7.3495123086987615,0.014157193689084507,0.012403162396095789,0.0097290086102997751,0],"IMU":[0.0010987778830813726,0.11504980502815335,0.77406305349087856,0.019138327616582202,-0.014930351428064807,0.079671783148551514,1.1465135684968464,-0.032824869256870372,-9.7473213450248952],"FOG":[0.77006870601076949],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[2.7562239133275854,-11.10987249572951,-27.53491175449026,61.158093582307536,61.158093582307536],"omega_rad_s":[2.7631710045522069,-11.062760347541831,-27.558217409769096,61.14545331376042,61.1454302217712],"thrust_n":[0.096077071499125283,-1.5586915946124804,-9.675840764263727,47.813622433971432,47.832332813316917],"torque_nm":[-0.001801445090608599,0.029225467398984004,0.1814220143299449,-0.89650542063696448,-0.89685624024969224],"angle_rad":[-561.44425617716695,370.22267417373047,-700.58996288693288,2147.310297402686,2147.3102661240719]},"command":[0.026249751555500814,-0.1058083094831382,-0.26223725480466914,0.58245803411721464,0.58245803411721464],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018087e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,4.3368086899420177e-19],"servo_effort":[0.015158381591184752,-1.480621785635059,-0.26586012302845907,1.8964805853886503e-05,-0.00040638374844167828,0.00010511973681544226]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":792,"step":6336,"t":31.68,"sim_time":31.679999999997982,"vehicle":{"origin_ned":[1.4996121532984754,1.0025585136179491,3.5004262320791564],"origin_quat_xyzw":[-0.021193437335051232,0.053460193504029446,0.37681397426921964,0.92450206853195993],"cg_ned":[1.4387483235639527,0.94386671828279922,3.2079423882149167],"linear_velocity_ned":[-0.00018322263341382224,-0.0018095546871527515,-0.0035460338005281959],"angular_velocity_ned":[-0.00022420003211152535,0.00061171906258172565,0.0014386820894915491]},"sensors":{"Odom":[1.4996121532984754,1.0025585136179491,3.5004262320791564,-0.0008004157022167541,-0.0011264761962456601,-0.0037116360088427312,-0.021193437335051239,0.053460193504029467,0.37681397426921981,0.92450206853195993,0.00010037689122776558,0.00059575604744099993,0.0014592022588364409],"Pressure":[26842.074444098042],"DVL":[-0.0043988369525334607,0.035082749600853003,-0.027252269036643201,7.3367168042032809,0.02847820954802718,-0.0055907431034362721,0.012431585280422795,0],"IMU":[0.0011096819738470702,0.11507388560846968,0.77412143998999949,-0.012739857372551372,-0.12161974139328997,-0.24160230696094517,1.1356639916862732,-0.011729267470617291,-9.696301284872213],"FOG":[0.77311861656617253],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[2.7100045431985236,-11.078758354536847,-27.537242191420329,61.17079143411425,61.17079143411425],"omega_rad_s":[2.7122867254780254,-11.031657738976037,-27.560559835718216,61.158723603550044,61.158701951143534],"thrust_n":[0.092554694296545073,-1.5500816637802233,-9.6777221150166746,47.833262491495653,47.851436369566947],"torque_nm":[-0.0017354005180602206,0.029064031195879188,0.18145728965656269,-0.89687367171554355,-0.89721443192938044],"angle_rad":[-561.33489522806201,369.78087465165498,-701.69234571152731,2149.7564185932197,2149.7563864232957]},"command":[0.025809567078081175,-0.10551198432892235,-0.26225944944209839,0.58257896603918335,0.58257896603918335],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.01539610262252086,-1.4810230745817574,-0.26593412158511104,1.9306043637210847e-05,-0.00040641861145410656,0.00010519859686496426]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":793,"step":6344,"t":31.720000000000002,"sim_time":31.719999999997974,"vehicle":{"origin_ned":[1.4996088024507495,1.0024928085849358,3.500283460069789],"origin_quat_xyzw":[-0.021194537387326073,0.053472351487219315,0.37684083618964764,0.92449039118384113],"cg_ned":[1.4387413503711732,0.94379489920854598,3.2078015969681624],"linear_velocity_ned":[-0.00016741165465430859,-0.0017845273039621241,-0.0034992103518752152],"angular_velocity_ned":[-0.00021763223616045466,0.00059248001730089622,0.0014619045215280384]},"sensors":{"Odom":[1.4996088024507495,1.0024928085849358,3.500283460069789,-0.00078266030418497985,-0.0011150110896383382,-0.0036609143868003751,-0.021194537387326077,0.053472351487219322,0.37684083618964775,0.92449039118384113,8.9014102570205447e-05,0.00057743280583581215,0.0014812862773513418],"Pressure":[26841.024342707064],"DVL":[0.050063068370958495,-0.012763631530850441,-0.012570969589183807,7.3985075582234536,0.00012953964176210032,-0.014271104771637495,-0.0075321341556023004,0],"IMU":[0.0011202512131219297,0.11509723910550769,0.77418072413058303,-0.01147735572745414,-0.031083141073627016,-0.084339418215059955,1.1193411748919526,-0.001677670866469293,-9.7454222604251655],"FOG":[0.77536938666103306],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[2.6655060971206948,-11.048095628036783,-27.539377662606448,61.183357912401,61.183357912401],"omega_rad_s":[2.6633145884691927,-11.000927666231275,-27.562693715145006,61.17186215833609,61.17184195038385],"thrust_n":[0.089226970146147083,-1.5415982592430191,-9.6794556672232517,47.852682921244188,47.870306548082517],"torque_nm":[-0.0016730056902402582,0.028904967360806607,0.18148979376043597,-0.8972378047733286,-0.89756824777654742],"angle_rad":[-561.2275259354891,369.34031082634766,-702.79481746083718,2152.2030676060594,2152.2030346025285]},"command":[0.025385772353530428,-0.10521995836225508,-0.26227978726291856,0.58269864678477146,0.58269864678477146],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.0156319655849219,-1.4814158569080318,-0.2660070565473957,1.9632956484914707e-05,-0.00040645498819305071,0.00010528381980473021]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":794,"step":6352,"t":31.760000000000002,"sim_time":31.759999999997966,"vehicle":{"origin_ned":[1.4996057965635412,1.002428083035044,3.5001426431159661],"origin_quat_xyzw":[-0.021195692860736474,0.053484086873989922,0.37686812150284721,0.92447856332655098],"cg_ned":[1.4387350073487366,0.9437240779877698,3.2076626979180203],"linear_velocity_ned":[-0.00015170149579421798,-0.001759644662431405,-0.003451535361678788],"angular_velocity_ned":[-0.00021140868705727325,0.0005723842891373729,0.0014847373080141531]},"sensors":{"Odom":[1.4996057965635412,1.002428083035044,3.5001426431159661,-0.00076529173836986045,-0.0011033631853337074,-0.0036093466134962003,-0.021195692860736498,0.053484086873989978,0.3768681215028476,0.92447856332655098,7.6854985404439775e-05,0.00055873794403914873,0.0015028863903612541],"Pressure":[26838.747556960767],"DVL":[0.011140793917233742,0.0017844984553262401,-0.015883896445117927,7.3567000108620899,-0.03414558576147074,-0.018269382652740192,0.012615715284396397,0],"IMU":[0.0011304499913713394,0.11511984955584477,0.77424088608490971,0.073132609986306232,-0.051792772262330422,0.12041222242427579,1.1187213705735415,-0.0088196395039199706,-9.7660772836269505],"FOG":[0.76572498982902837],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[2.6226370737113749,-11.017925169404132,-27.541322765338514,61.19578925108047,61.19578925108047],"omega_rad_s":[2.6162001987625882,-10.97060850114728,-27.56462448788302,61.18486409044425,61.184845328575861],"thrust_n":[0.086083151990853216,-1.533251276691056,-9.6810451134820905,47.871876021222093,47.88893755958302],"torque_nm":[-0.0016140590998284981,0.028748461437957298,0.18151959587778924,-0.89759767539791413,-0.89791757924218174],"angle_rad":[-561.1220730063967,368.90096692759573,-703.89736991719178,2154.6502390585397,2154.6502052792284]},"command":[0.024977495940108334,-0.10493262066099172,-0.26229831205084297,0.58281704048648064,0.58281704048648064],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,4.3368086899420177e-19],"servo_effort":[0.015865988699989855,-1.4817978322624714,-0.26607844847810447,1.9950387404188929e-05,-0.00040648930173409935,0.00010537065894718976]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":795,"step":6360,"t":31.800000000000001,"sim_time":31.799999999997958,"vehicle":{"origin_ned":[1.4996031231795393,1.0023643340540995,3.5000038156959694],"origin_quat_xyzw":[-0.021196915537987832,0.053495387614322168,0.3768958223768929,0.9244665885528337],"cg_ned":[1.4387292904600466,0.94365424874822734,3.2075257243717927],"linear_velocity_ned":[-0.00013609243659016992,-0.0017349104478087951,-0.003403042410229339],"angular_velocity_ned":[-0.00020551065386143193,0.00055153870739320539,0.0015071879743456453]},"sensors":{"Odom":[1.4996031231795393,1.0023643340540995,3.5000038156959694,-0.00074828982423391166,-0.0010915600728999509,-0.0035569696617474885,-0.021196915537987845,0.053495387614322203,0.37689582237689312,0.9244665885528337,6.3986155328008899e-05,0.00053973485301474201,0.0015240200868043526],"Pressure":[26836.19241567421],"DVL":[-0.026561289948448939,0.0073182883682785639,0.01881878357936681,7.2807657236971801,0.026990020510474423,0.0016380037402878487,0.025318878930846975,0],"IMU":[0.0011402461953424338,0.11514170355070884,0.77430190672247368,0.0062519355381531125,-0.096000251515578491,-0.047592079002963424,1.1163817976168171,-0.01700084536727707,-9.7123743551387332],"FOG":[0.79586129201368094],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[2.5812887280309358,-10.988290209881411,-27.543082040051338,61.20808237651336,61.20808237651336],"omega_rad_s":[2.5708704743190647,-10.940740828243776,-27.566357432542613,61.197725114831869,61.197707797292352],"thrust_n":[0.083111805831684579,-1.5250511213181468,-9.68249402709443,47.89083503440289,47.907324571979117],"torque_nm":[-0.0015583463593440861,0.028594708524715257,0.18154676300802056,-0.89795315689505439,-0.89826233572460856],"angle_rad":[-561.01846375007631,368.46282559832417,-704.99999507733889,2157.0979273866178,2157.0978928893414]},"command":[0.024583702171723197,-0.10465038295125154,-0.26231506704810797,0.5829341178715558,0.5829341178715558],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-4.3537493488871065e-21,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,4.3368086899420177e-19],"servo_effort":[0.016098073927219934,-1.4821689578039465,-0.2661482529364198,2.0254624754209297e-05,-0.00040652162673328546,0.00010546154943754343]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":796,"step":6368,"t":31.84,"sim_time":31.83999999999795,"vehicle":{"origin_ned":[1.4996007710512667,1.0023015583592918,3.4998670107278662],"origin_quat_xyzw":[-0.021198216024483182,0.053506243488284977,0.37692393118852496,0.92445447029182548],"cg_ned":[1.4387241956394659,0.94358540547005021,3.2073907082908386],"linear_velocity_ned":[-0.00012058556237880445,-0.0017103283554512408,-0.0033537651544483563],"angular_velocity_ned":[-0.00019991648250276473,0.0005300511809701381,0.0015292642569945866]},"sensors":{"Odom":[1.4996007710512667,1.0023015583592918,3.4998670107278662,-0.0007316353213711825,-0.0010796296201308884,-0.0035038205813774648,-0.021198216024483196,0.053506243488285012,0.37692393118852519,0.92445447029182548,5.0497038478935168e-05,0.00052048563839408456,0.0015447053995748452],"Pressure":[26836.771349096223],"DVL":[0.00050759929498953049,0.0069850252018561158,0.031005217621685847,7.3368161864476482,-0.0020769249908147219,-0.0078057833405759183,-0.0054506994134364021,0],"IMU":[0.0011496113170801573,0.11516279019060101,0.77436376763183712,-0.038629596656728243,0.11369725334745467,-0.16894191950420367,1.1106387477276904,-0.011686309003720955,-9.7582096195734565],"FOG":[0.76914743323655654],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[2.5413349391949569,-10.959234662428802,-27.544659284012283,61.220234498445485,61.220234498445485],"omega_rad_s":[2.5272337821715198,-10.911366947289606,-27.567897474191167,61.210441444745719,61.210425566340014],"thrust_n":[0.080300897847459127,-1.5170085667607192,-9.683805729634555,47.909554000736776,47.925463514169266],"torque_nm":[-0.0015056418346398586,0.028443910626763488,0.18157135743064795,-0.89830413751381466,-0.89860244089067387],"angle_rad":[-560.91662882282128,368.02586781794258,-706.10268514155189,2159.5461268664244,2159.5460917088503]},"command":[0.024203189897094829,-0.10437366345170287,-0.26233008841916461,0.58304985236614748,0.58304985236614748],"arm":{"servo_position":[2.2499312661440551e-24,3.2526065174565154e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,8.6736173798840355e-19,0,0,0,-4.3368086899420177e-19],"servo_effort":[0.016328185962330911,-1.4825293304830627,-0.26621648733545067,2.054892343147123e-05,-0.00040655331347966392,0.00010555615754355958]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":797,"step":6376,"t":31.879999999999999,"sim_time":31.879999999997942,"vehicle":{"origin_ned":[1.4995987301193023,1.0022397522653075,3.4997322595734315],"origin_quat_xyzw":[-0.021199603700027429,0.053516646098188909,0.37695244053788479,0.92444221180444552],"cg_ned":[1.4387197187653535,0.9435175419783729,3.2072576802903767],"linear_velocity_ned":[-0.00010518247177622167,-0.001685902426717736,-0.0033037372601913309],"angular_velocity_ned":[-0.00019460261252369942,0.00050802958012544238,0.0015509749746775642]},"sensors":{"Odom":[1.4995987301193023,1.0022397522653075,3.4997322595734315,-0.00071530999035355645,-0.0010675999018383777,-0.0034499364293281935,-0.021199603700027436,0.05351664609818893,0.3769524405378849,0.92444221180444552,3.6478272606777726e-05,0.00050105103180017477,0.0015649615977138733],"Pressure":[26834.131530172344],"DVL":[-0.016723718885232296,-0.01841205392070884,-0.004513533316033303,7.4552002666152077,0.047027019353610859,0.0095913291523150139,0.032499574817268763,0],"IMU":[0.0011585205401322093,0.11518310103372428,0.77442645115680653,-0.0076356135212866071,0.0056402698967662193,0.044267240359155254,1.1252837662428037,-0.0079568187835902214,-9.7417879574980386],"FOG":[0.77626674594687195],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[2.5026319035671154,-10.930803311119716,-27.546057353980913,61.232243032345067,61.232243032345067],"omega_rad_s":[2.4851799933527072,-10.88253056097159,-27.569249002702424,61.22300970472358,61.222995256825854],"thrust_n":[0.077637863996076861,-1.5091346676314903,-9.6849831606638617,47.928027620316108,47.943350936397081],"torque_nm":[-0.0014557099499264412,0.028296275018090448,0.18159343426244745,-0.89865051788092709,-0.89893783005744532],"angle_rad":[-560.81650296825069,367.59007284171304,-707.20543249550349,2161.9948316321916,2161.9947958717012]},"command":[0.023834589557782053,-0.10410288867733063,-0.26234340337124679,0.58316421935566731,0.58316421935566731],"arm":{"servo_position":[2.2499312661440551e-24,3.2526065174565154e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.016556560124833513,-1.4828791357851216,-0.26628315266063479,2.0832614873328546e-05,-0.00040658036727976864,0.00010565296610747188]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":798,"step":6384,"t":31.920000000000002,"sim_time":31.919999999997934,"vehicle":{"origin_ned":[1.4995969914868197,1.0021789116511506,3.4995995920424936],"origin_quat_xyzw":[-0.021201086675762308,0.053526588852069457,0.37698134326230925,0.92442981617955899],"cg_ned":[1.4387158556352064,0.94345065193578459,3.2071266696386598],"linear_velocity_ned":[-8.9885584582823728e-05,-0.0016616366683003684,-0.0032529923861474176],"angular_velocity_ned":[-0.00018954270518992155,0.00048558224251116379,0.0015723289544150422]},"sensors":{"Odom":[1.4995969914868197,1.0021789116511506,3.4995995920424936,-0.00069929662503726714,-0.00105549908816404,-0.0033953542363902361,-0.021201086675762315,0.05352658885206947,0.37698134326230931,0.92442981617955899,2.2022801040222557e-05,0.00048149014099824411,0.0015848082321153624],"Pressure":[26832.855747710542],"DVL":[-0.0019004645583972019,-0.025875222438551171,0.010813308835006249,7.4059833413344789,-0.0053474653768992358,0.033138836889185036,-0.01125955592368469,0],"IMU":[0.0011669528093058575,0.11520263003224306,0.7744899404293033,-0.064879814107852221,0.058956224076342462,0.13171851113641594,1.1276650797084222,-0.010211057082393303,-9.7688402622682116],"FOG":[0.78032150078479179],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[2.4650179212222243,-10.903041914427982,-27.547278007352052,61.244105618895368,61.244105618895368],"omega_rad_s":[2.4445804677083363,-10.854276699287025,-27.570415657562172,61.235426872220394,61.235413842831569],"thrust_n":[0.075109666458554158,-1.5014407386144228,-9.6860287290525164,47.94625116666348,47.960983914600519],"torque_nm":[-0.0014083062460978908,0.02815201384902043,0.18161303866973472,-0.89899220937494029,-0.89926844839875986],"angle_rad":[-560.71802575690515,367.15541814563585,-708.30822968356085,2164.4440356912951,2164.4439993848518]},"command":[0.023476361154497374,-0.10383849442312364,-0.26235502864144811,0.58327719637043207,0.58327719637043207],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.016783072142486734,-1.4832184697521349,-0.26634822708928479,2.1105096555305247e-05,-0.00040660377599752298,0.00010575170787390768]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":799,"step":6392,"t":31.960000000000001,"sim_time":31.959999999997926,"vehicle":{"origin_ned":[1.4995955473886879,1.0021190319331152,3.499469036398593],"origin_quat_xyzw":[-0.021202671747715708,0.053536066943362666,0.37701063244460326,0.92441728633270082],"cg_ned":[1.4387126019360885,0.94338472884420776,3.206997704256632],"linear_velocity_ned":[-7.46978483347379e-05,-0.0016375351744939604,-0.0032015642443076857],"angular_velocity_ned":[-0.00018470822831242231,0.00046281674946521391,0.0015933359375252764]},"sensors":{"Odom":[1.4995955473886879,1.0021190319331152,3.499469036398593,-0.00068357906277567151,-0.0010433552871399164,-0.0033401110286014972,-0.021202671747715715,0.053536066943362687,0.37701063244460337,0.92441728633270082,7.2245030316278104e-06,0.00046185998414153472,0.0016042658896224587],"Pressure":[26831.44273381848],"DVL":[0.027778482908932367,-0.010244986102276527,0.030644443874636738,7.3198411744357212,-0.014787172501713068,-0.039203530948369245,-0.0038445927089254994,0],"IMU":[0.0011748909031276309,0.11522137345888693,0.77455421939017532,0.011587658618405999,-0.080216073070551522,-0.07262368856042066,1.1428236286577571,-0.02221767103278496,-9.7293130009965587],"FOG":[0.77631054369153729],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[2.4283151714617879,-10.875996315482883,-27.548322252118012,61.255820104859787,61.255820104859787],"omega_rad_s":[2.4052884265254377,-10.826651307483349,-27.571400313548178,61.247690233442931,61.247678607283724],"thrust_n":[0.072702865751234733,-1.4939382434218018,-9.6869443030865892,47.964220423716299,47.978359975936471],"torque_nm":[-0.0013631787328356514,0.028011342064158791,0.18163020568287361,-0.89932913294468075,-0.89959424954880884],"angle_rad":[-560.62114232023032,366.72187938314102,-709.4110693784155,2166.8937329373366,2166.8936961413465]},"command":[0.023126811156778934,-0.10358091729031317,-0.26236497382969537,0.58338876290342656,0.58338876290342656],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,1.7347234759768071e-18,0,0,4.3368086899420177e-19],"servo_effort":[0.017008078734834831,-1.4835476532188594,-0.26641176279770468,2.1367511686771974e-05,-0.00040662208397166999,0.00010585308884035959]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":800,"step":6400,"t":32,"sim_time":31.999999999997918,"vehicle":{"origin_ned":[1.4995943911586465,1.0020601080364182,3.4993406193655288],"origin_quat_xyzw":[-0.021204364368110105,0.053545077317823361,0.37704030143860673,0.92440462499808873],"cg_ned":[1.4387099532258325,0.94331976603669088,3.2068708107175636],"linear_velocity_ned":[-5.9622740262091127e-05,-0.0016136022413833367,-0.0031494865013211135],"angular_velocity_ned":[-0.00018006871329234183,0.00043983979581826478,0.0016140069377472558]},"sensors":{"Odom":[1.4995943911586465,1.0020601080364182,3.4993406193655288,-0.00066814225151800872,-0.0010311965130173921,-0.0032842437426006763,-0.021204364368110126,0.053545077317823417,0.37704030143860712,0.92440462499808873,-7.8221206614548884e-06,0.0004422155762139839,0.001623356516964336],"Pressure":[26832.432101241895],"DVL":[-0.026006067234010718,-0.013721281994114737,-0.017176812706097756,7.3441586682756199,-0.051085838617853811,0.023096644878765806,0.019235710088831692,0],"IMU":[0.0011823214657111663,0.11523932982326777,0.77461927284479504,0.026692025482420997,0.028124973895253362,0.1484199372356925,1.1253490925319722,-0.015937165545157034,-9.7571447531683368],"FOG":[0.76556272647570078],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[2.3923286305161908,-10.849713874347939,-27.549189647559547,61.267384553549022,61.267384553549022],"omega_rad_s":[2.3671391328852485,-10.799701371082589,-27.572204878723156,61.259797357289841,61.259787115923757],"thrust_n":[0.070403673685622004,-1.4866388334452891,-9.6877310656631241,47.981931644482621,47.995477056357679],"torque_nm":[-0.0013200688816054128,0.027874478127099169,0.18164495748118356,-0.89966121833404922,-0.89991519480670656],"angle_rad":[-560.52580407035509,366.2894303465855,-710.51394434627309,2169.3439171618829,2169.3438799320706]},"command":[0.022784082195392293,-0.10333060832712324,-0.26237323473866236,0.58349890050999065,0.58349890050999065],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,4.3368086899420177e-19],"servo_effort":[0.017231817517025926,-1.4838670034402095,-0.26647379744432331,2.1621462966551362e-05,-0.00040663777555327595,0.00010595601592902461]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":801,"step":6408,"t":32.039999999999999,"sim_time":32.039999999997939,"vehicle":{"origin_ned":[1.4995935138854573,1.0020021355599524,3.4992143662823669],"origin_quat_xyzw":[-0.021206172790168114,0.053553613986271731,0.37707034409844964,0.92439183481145026],"cg_ned":[1.4387079050965592,0.94325575658171401,3.206746013925112],"linear_velocity_ned":[-4.4654121095543772e-05,-0.0015898471556898934,-0.0030968105674641427],"angular_velocity_ned":[-0.00017582340508098072,0.00041610833200302858,0.0016344056348434183]},"sensors":{"Odom":[1.4995935138854573,1.0020021355599524,3.4992143662823669,-0.00065305694179087744,-0.0010188756652501031,-0.0032277910800743064,-0.021206172790168128,0.053553613986271766,0.37707034409844986,0.92439183481145026,-2.3643156873389445e-05,0.00042230822258381334,0.0016420836029921535],"Pressure":[26829.643349903847],"DVL":[0.0046357170814510709,0.0076301721230656906,-0.019219062818942992,7.3534031777769462,-0.014628121246363762,-0.01246200628188969,-0.045099997322858486,0],"IMU":[0.0011892237551689206,0.11525649431305143,0.77468508617350562,0.058844448266698192,0.04105672980437141,0.11658640015935151,1.1235248424394335,-0.015045032826026638,-9.7811714067651074],"FOG":[0.78925849512424573],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[2.3573071965568588,-10.824200700364003,-27.549866049070292,61.278797423319617,61.278797423319617],"omega_rad_s":[2.3300358294612424,-10.773467083485571,-27.572827839846866,61.271746106256344,61.271737229685819],"thrust_n":[0.068203011575719868,-1.4795522972916872,-9.688388140398084,47.999385217609287,48.012329616217812],"torque_nm":[-0.0012788064670447477,0.027741605574219137,0.18165727763246411,-0.89998847283017425,-0.900231180304084],"angle_rad":[-560.43196831635566,365.85804302496831,-711.61684737495386,2171.7945820656391,2171.7945444569405]},"command":[0.02245054472911294,-0.1030876257177524,-0.26237967665781231,0.58360759450780586,0.58360759450780586],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.01752462654650077,-1.484260611207163,-0.26655245522833415,2.1864621691735509e-05,-0.00040667449607440734,0.00010608038616345801]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":802,"step":6416,"t":32.079999999999998,"sim_time":32.079999999997959,"vehicle":{"origin_ned":[1.4995928998736319,1.0019451125292151,3.4990903013223189],"origin_quat_xyzw":[-0.021208113940396189,0.053561661765268186,0.37710075474737947,0.92437891855071574],"cg_ned":[1.4387064533617122,0.94319269320411236,3.2066233367163735],"linear_velocity_ned":[-2.979093072785893e-05,-0.001566275862507203,-0.0030435811204704379],"angular_velocity_ned":[-0.00017212947131468395,0.00039125568927881357,0.0016545519103137046]},"sensors":{"Odom":[1.4995928998736319,1.0019451125292151,3.4990903013223189,-0.000638366949065018,-0.0010062882054686665,-0.0031707901390350831,-0.021208113940396199,0.053561661765268213,0.3771007547473797,0.92437891855071574,-4.0607268916915794e-05,0.00040198590475505711,0.0016604246370432504],"Pressure":[26828.473212624809],"DVL":[-0.033565751366089497,0.0277867877809643,0.060375702261323327,7.4288783738754178,-0.032919877962863234,0.00082109061403645158,0.013557332859846538,0],"IMU":[0.001195553947164095,0.11527285162898973,0.77475164418134657,0.020446628737169199,-0.018965846374776815,-0.049100005953211644,1.1108523932369607,-0.011546575274624949,-9.75602382081874],"FOG":[0.77752418305296611],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[2.3252711163633819,-10.799285080287856,-27.550301247878433,61.29005782635025,61.29005782635025],"omega_rad_s":[2.2945100217766354,-10.747927111809764,-27.573252084970512,61.283534788031773,61.283527260668762],"thrust_n":[0.066128756811853484,-1.472671449167763,-9.6889037717984898,48.016582261356788,48.028912738723221],"torque_nm":[-0.001239914190222253,0.02761258967189556,0.18166694572122172,-0.90031091740043989,-0.90054211385106064],"angle_rad":[-560.33958247887915,365.42768913107182,-712.71977083359036,2174.2457212741633,2174.2456833408019]},"command":[0.022145439203460779,-0.10285033409797958,-0.26238382140836602,0.58371483644143096,0.58371483644143096],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,4.3198680309969292e-21,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,8.6736173798840355e-19,0],"servo_effort":[0.017823434925780045,-1.4846581957082767,-0.2666329534418716,2.2099791899277614e-05,-0.00040671449231930378,0.00010621350030837201]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":803,"step":6424,"t":32.119999999999997,"sim_time":32.11999999999798,"vehicle":{"origin_ned":[1.4995925332064259,1.0018890372150286,3.4989684472236631],"origin_quat_xyzw":[-0.021210205411134976,0.053569205606574744,0.37713152735309824,0.92436587911574131],"cg_ned":[1.4387055936559363,0.94313056851861565,3.2065028005575211],"linear_velocity_ned":[-1.5039519834463933e-05,-0.0015428898740189744,-0.0029898281495551529],"angular_velocity_ned":[-0.00016896886314022647,0.00036542431087541237,0.0016744139233291866]},"sensors":{"Odom":[1.4995925332064259,1.0018890372150286,3.4989684472236631,-0.00062404749226934342,-0.00099346639636488528,-0.0031132759742817095,-0.021210205411134983,0.053569205606574764,0.37713152735309829,0.92436587911574131,-5.8599038698087079e-05,0.00038133791215898461,0.0016783607895033167],"Pressure":[26826.144100360627],"DVL":[0.002890168799761336,0.016766325034423404,0.0061011598976852561,7.3161419821539901,0.018729593885937781,0.0082866075770342291,-0.019567793089306625,0],"IMU":[0.0012012670329919783,0.11528838723422578,0.77481893085316389,0.10112262667147039,0.04775608826242915,-0.073821550536307054,1.1296715827656008,-0.009532786702257769,-9.7522824665899712],"FOG":[0.77294687070602308],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[2.2963865266437353,-10.77494650621572,-27.550510809743013,61.3011638743627,61.3011638743627],"omega_rad_s":[2.2611283303937819,-10.723047077418867,-27.573466495802414,61.295161762246302,61.295155572207612],"thrust_n":[0.064209086146101935,-1.4659855004406539,-9.6892700914722045,48.033519909297503,48.045225901715355],"torque_nm":[-0.0012039203652394114,0.027487228133262258,0.18167381421510384,-0.90062849829932823,-0.90084798565716306],"angle_rad":[-560.24856987544774,364.99834171253349,-713.82270648509984,2176.6973283474949,2176.697290143165]},"command":[0.021870347872797478,-0.10261853815443543,-0.26238581723564774,0.58382060832726379,0.58382060832726379],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,1.3552527156068805e-20,0,0],"servo_effort":[0.018110778429156957,-1.4850403580781455,-0.26671106631316721,2.2328955859642296e-05,-0.0004067539290506302,0.00010635186681447092]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":804,"step":6432,"t":32.160000000000004,"sim_time":32.159999999998,"vehicle":{"origin_ned":[1.4995923995024332,1.001833907507786,3.4988488252171588],"origin_quat_xyzw":[-0.021212463296828306,0.053576232980784171,0.37716265538186833,0.92435271949930853],"cg_ned":[1.4387053213924066,0.94306937507858979,3.2063844257104521],"linear_velocity_ned":[-4.0494300143212461e-07,-0.0015196907996019762,-0.0029355818354011853],"angular_velocity_ned":[-0.00016631923457122749,0.00033875924343029139,0.001693960275219851]},"sensors":{"Odom":[1.4995923995024332,1.001833907507786,3.4988488252171588,-0.00061007324625876971,-0.00098044489849765108,-0.0030552836698365593,-0.021212463296828313,0.053576232980784191,0.37716265538186849,0.92435271949930853,-7.7498222132632881e-05,0.00036045236847986379,0.001695874241341107],"Pressure":[26826.050466768531],"DVL":[0.015649159746209694,-0.020819865617104236,0.0041578580729948137,7.4322234564540537,0.020934334231923816,-0.027521548223139524,-0.0031884244313634055,0],"IMU":[0.0012063226424913465,0.11530309013828256,0.77488692944289761,0.035664384742065756,-0.04226562830306204,0.12311350717509284,1.1145999024558602,-0.0063586352496026359,-9.76091051718854],"FOG":[0.78164046580762558],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[2.270509140877532,-10.751190041561411,-27.550518709447356,61.312113753577329,61.312113753577329],"omega_rad_s":[2.2302287869570758,-10.698805124626643,-27.573471649279597,61.306625359303126,61.306620495561091],"thrust_n":[0.062457640282379677,-1.4594872016753762,-9.6894874526965289,48.050195079400432,48.061268715644317],"torque_nm":[-0.0011710807552946191,0.027365385031413312,0.18167788973805993,-0.90094115773875816,-0.90114878841833101],"angle_rad":[-560.15883654239383,364.56997489692702,-714.92564592522479,2179.1493967791139,2179.1493583570609]},"command":[0.021623896579786018,-0.10239228611010869,-0.2623858924709272,0.58392489289121263,0.58392489289121263],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.018385761434005523,-1.4854072920698123,-0.2667867686333607,2.2547964526578635e-05,-0.00040678890395856403,0.00010649477935539301]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":805,"step":6440,"t":32.200000000000003,"sim_time":32.19999999999802,"vehicle":{"origin_ned":[1.4995924859798364,1.0017797208632711,3.4987314550266042],"origin_quat_xyzw":[-0.021214902104394293,0.053582733904331568,0.37719413181175288,0.92433944278215041],"cg_ned":[1.4387056317934033,0.94300910536336824,3.2062682312321251],"linear_velocity_ned":[1.410820745276152e-05,-0.0014966805924301423,-0.0028808722885163766],"angular_velocity_ned":[-0.00016415471201402729,0.00031140863467825082,0.0017131600778065696]},"sensors":{"Odom":[1.4995924859798364,1.0017797208632711,3.4987314550266042,-0.00059641886874686658,-0.00096726029753165812,-0.0029968482123464146,-0.02121490210439431,0.05358273390433161,0.37719413181175321,0.92433944278215041,-9.7179957411576125e-05,0.00033941712403292765,0.0017129482278252005],"Pressure":[26825.265815579594],"DVL":[0.023206433320618565,0.043429264084259629,-0.021108583746457479,7.4024208622866663,-0.011055509972290925,0.00016970453368085039,-0.016672650456287158,0],"IMU":[0.0012106852336512557,0.11531695287863451,0.77495562251330496,-0.02829456537545582,0.0098223392564792227,-0.0090374716618911687,1.1393419485048395,-0.0071777275357626383,-9.7345858589968319],"FOG":[0.77593120806197802],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[2.2474479774082461,-10.728022298098971,-27.550349159032788,61.322905883014656,61.322905883014656],"omega_rad_s":[2.2019783326530837,-10.67518850956464,-27.573276146191962,61.31792397146495,61.317920421937274],"thrust_n":[0.06087788790705715,-1.453171872268944,-9.6895618545450954,48.066604788431427,48.077040880474421],"torque_nm":[-0.0011414603982573214,0.027246972605042705,0.18167928477272061,-0.90124883978308934,-0.90144451650889523],"angle_rad":[-560.07027901525851,364.14256347067681,-716.02858096338389,2181.6019199969878,2181.601881409998]},"command":[0.021404266451507104,-0.10217164093427591,-0.26238427770507416,0.58402767507633002,0.58402767507633002],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,-4.3368086899420177e-19],"servo_effort":[0.01864762952815963,-1.4857591907152614,-0.26686000337808941,2.2758818874323009e-05,-0.00040682043096015505,0.00010664097821880415]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":806,"step":6448,"t":32.240000000000002,"sim_time":32.239999999998041,"vehicle":{"origin_ned":[1.4995927815017662,1.0017264742509313,3.4986163548694464],"origin_quat_xyzw":[-0.021217534654705997,0.053588700963044529,0.37722594915606278,0.92432605212423669],"cg_ned":[1.4387065199028719,0.94294975177258622,3.2061542349728152],"linear_velocity_ned":[2.8495518315907708e-05,-0.0014738613072582617,-0.0028257296813198997],"angular_velocity_ned":[-0.00016244507572896975,0.00028352361113803183,0.0017319836554236393]},"sensors":{"Odom":[1.4995927815017662,1.0017264742509313,3.4986163548694464,-0.00058305921750533268,-0.00095395081886294171,-0.0029380045928530784,-0.021217534654706008,0.053588700963044557,0.377225949156063,0.92432605212423669,-0.00011751434977647704,0.00031831909493513366,0.0017295677942053219],"Pressure":[26821.782400001819],"DVL":[-0.041595728418467981,0.005198590732459896,0.029640227059226622,7.3558969435420716,-0.0068315001375303984,0.023790739047432129,0.021784204185921072,0],"IMU":[0.0012143242974106147,0.11532997148903822,0.77502499199828356,0.079806418551150282,0.019701917962322981,0.028402314253589966,1.1247321117041784,-0.0027191954415839645,-9.7458027399776679],"FOG":[0.78228064302385758],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[2.2269686227372691,-10.705451908130286,-27.550026125543663,61.333538938633367,61.333538938633367],"omega_rad_s":[2.1764129739285938,-10.652191267229915,-27.572893980372754,61.32905611293868,61.329053863239636],"thrust_n":[0.059466117114198157,-1.4470367375530093,-9.6895030893018514,48.082746258033438,48.092542273162572],"torque_nm":[-0.0011149896958912154,0.027131938829118924,0.18167818292440974,-0.90155149233812715,-0.90173516762179828],"angle_rad":[-559.98279022105703,363.7160825711768,-717.13150388169186,2184.0548913673902,2184.0548526677171]},"command":[0.021209224978450184,-0.10195668483933605,-0.26238120119565395,0.58412894227269874,0.58412894227269874],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,4.3368086899420177e-19],"servo_effort":[0.018895767948865595,-1.4860962249665188,-0.26693073371940057,2.2960679638123554e-05,-0.00040684789733171517,0.00010678976329464773]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":807,"step":6456,"t":32.280000000000001,"sim_time":32.279999999998061,"vehicle":{"origin_ned":[1.4995932765857154,1.0016741640855893,3.4985035415703045],"origin_quat_xyzw":[-0.021220371944511009,0.053594129218616927,0.37725809949466904,0.92431255076056662],"cg_ned":[1.4387079806183309,0.94289130665073506,3.206042453666333],"linear_velocity_ned":[4.275449117571521e-05,-0.0014512332075047648,-0.0027701784710026018],"angular_velocity_ned":[-0.00016114576262615997,0.00025524645900216656,0.0017504027472457085]},"sensors":{"Odom":[1.4995932765857154,1.0016741640855893,3.4985035415703045,-0.00056997210607483584,-0.00094055583330431968,-0.0028787809938647371,-0.021220371944511023,0.053594129218616962,0.37725809949466926,0.92431255076056662,-0.00013836761627459291,0.00029722882247027306,0.0017457198856260583],"Pressure":[26819.785384136216],"DVL":[0.001106295042947349,-0.014160306749652565,0.010840468445745204,7.3529288635613401,-0.0088481574149533674,-0.0065328191665641397,0.028945816301523389,0],"IMU":[0.0012172145477913259,0.11534214522067694,0.77509501927533309,0.078356439867346653,0.012113447320171219,0.086563700858888343,1.1358843235358735,-0.02532594755878969,-9.7356254739348813],"FOG":[0.78680834172296199],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[2.2087960273846905,-10.683488729053558,-27.54957279771553,61.344011434938899,61.344011434938899],"omega_rad_s":[2.1534659593192722,-10.629812586973424,-27.572342576040953,61.340020389165232,61.340019421865073],"thrust_n":[0.058213466159125399,-1.441080478574468,-9.6893233904712321,48.098616897069832,48.107772558226621],"torque_nm":[-0.0010915024904836011,0.027020258973271274,0.18167481357133564,-0.90184906682005939,-0.90202073546674921],"angle_rad":[-559.89626404936314,363.2905074523465,-718.23440760465269,2186.5083041999114,2186.5082654391672]},"command":[0.021036152641758957,-0.10174751170527198,-0.26237688378776697,0.58422868033275144,0.58422868033275144],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,1.3552527156068805e-20,0,-4.3368086899420177e-19],"servo_effort":[0.019129826827360176,-1.4864254180118566,-0.26700015859153148,2.3152025489004788e-05,-0.00040686959148018631,0.0001069423800222958]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":808,"step":6464,"t":32.32,"sim_time":32.319999999998082,"vehicle":{"origin_ned":[1.499593963354023,1.0016227861201883,3.4983930309329341],"origin_quat_xyzw":[-0.021223422916502761,0.053599015846122672,0.37729057451986292,0.92429894200875606],"cg_ned":[1.4387100087903033,0.94283376238116579,3.2059329032305195],"linear_velocity_ned":[5.6883721691307e-05,-0.0014287955545562155,-0.0027142393604722473],"angular_velocity_ned":[-0.00016020136295302748,0.00022671511225979697,0.0017683908530933159]},"sensors":{"Odom":[1.499593963354023,1.0016227861201883,3.4983930309329341,-0.00055713751598425541,-0.00092711600656582294,-0.002819201152420894,-0.021223422916502786,0.053599015846122734,0.37729057451986336,0.92429894200875606,-0.00015960149068694921,0.00027620612508072928,0.001761393757443656],"Pressure":[26820.94952143366],"DVL":[-0.0090887429171522469,-0.0055164263562046028,0.0052739968347071623,7.472405975649421,0.02661270382363851,0.01955508163184614,0.0088719481208275799,0],"IMU":[0.0012193360795924092,0.1153534756948229,0.77516568525380247,0.05646459042638332,0.074624761148952043,-0.0034372366720398129,1.1449684158276838,-0.00019156028457216999,-9.750930255845935],"FOG":[0.78601597895904796],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[2.1926213761568141,-10.662137678609897,-27.549008621855847,61.354317580022411,61.354317580022411],"omega_rad_s":[2.1329890256443083,-10.608053930778071,-27.571640640439036,61.350814326460579,61.35081462103674],"thrust_n":[0.057107360660199107,-1.4353024391323921,-9.6890359247256139,48.114212471847125,48.122729288301876],"torque_nm":[-0.0010707630123787334,0.026911920733732352,0.18166942358860527,-0.90214148384713355,-0.90230117415566036],"angle_rad":[-559.81059896386273,362.86581334088771,-719.33728578846626,2188.9621517275632,2188.9621129565921]},"command":[0.02088210834435061,-0.10154416836771329,-0.26237151068434139,0.5843268340954515,0.5843268340954515],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,1.0778494253810979e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,-1.7347234759768071e-18,0,-8.6736173798840355e-19,0],"servo_effort":[0.019349173659291154,-1.486744205693598,-0.26706779987343432,2.3334517621921614e-05,-0.00039365575708234319,0.00010709636133873914]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":809,"step":6472,"t":32.359999999999999,"sim_time":32.359999999998102,"vehicle":{"origin_ned":[1.4995948356265578,1.0015723354376964,3.4982848374021493],"origin_quat_xyzw":[-0.021226694474219893,0.053603360520760139,0.37732336556353069,0.92428522923521272],"cg_ned":[1.4387125991112799,0.94277711128098296,3.2058255984910207],"linear_velocity_ned":[7.0877896136237488e-05,-0.0014065512257830253,-0.0026579430626199343],"angular_velocity_ned":[-0.00015956966360478275,0.00019809135914973817,0.0017859229945973597]},"sensors":{"Odom":[1.4995948356265578,1.0015723354376964,3.4982848374021493,-0.00054453167083496961,-0.0009136738850725768,-0.0027593006809561861,-0.021226694474219893,0.053603360520760146,0.37732336556353074,0.92428522923521272,-0.00018107064986613982,0.00025533707102704136,0.0017765809879261689],"Pressure":[26820.38246306948],"DVL":[0.013483661187877853,0.012538170280661613,0.0092614230583394908,7.3768890365856743,0.049467687156340756,-0.029177620298973441,0.049566431893746252,0],"IMU":[0.0012206746394725157,0.11536396763042726,0.77523697046729001,0.06027374889823775,-0.055790274853456147,-0.042181759420203954,1.1276901069037868,-0.0095300898021789919,-9.722936129438235],"FOG":[0.79928114829753316],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[2.1780927412249955,-10.641411970940766,-27.548354434065484,61.364455602158557,61.364455602158557],"omega_rad_s":[2.1147650255971602,-10.586919802653535,-27.570807695701504,61.361435248662715,61.361436781291296],"thrust_n":[0.056132333198460185,-1.4297027847220602,-9.6886543509215262,48.129528372679843,48.13741042584217],"torque_nm":[-0.0010524812474711285,0.026806927213538632,0.18166226907977862,-0.90242865698774721,-0.90257644548454075],"angle_rad":[-559.72570095055426,362.44197534460636,-720.44013285429207,2191.416427073309,2191.4163883420606]},"command":[0.020743740392619007,-0.10134678067562634,-0.26236528032443318,0.58442338668722438,0.58442338668722438],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.019554303788239424,-1.4870483664419674,-0.26713284256953546,2.3507775374462573e-05,-0.00040689726010544991,0.00010725223034157754]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":810,"step":6480,"t":32.399999999999999,"sim_time":32.399999999998123,"vehicle":{"origin_ned":[1.499595888966005,1.0015228064255624,3.4981789738979883],"origin_quat_xyzw":[-0.021230191431703758,0.0536071655982528,0.37735646364237402,0.92427141582741612],"cg_ned":[1.4387157460562201,0.94272134555804032,3.2057205530406869],"linear_velocity_ned":[8.4731512366660423e-05,-0.0013845029195610856,-0.0026013204718336198],"angular_velocity_ned":[-0.00015920334803916163,0.00016953886729711794,0.0018029772670400844]},"sensors":{"Odom":[1.499595888966005,1.0015228064255624,3.4981789738979883,-0.00053213144749428764,-0.00090027296785869057,-0.0026991152551504999,-0.021230191431703758,0.0536071655982528,0.37735646364237402,0.92427141582741612,-0.00020262517917640083,0.00023470547395723702,0.0017912767894082812],"Pressure":[26818.27769429719],"DVL":[-0.02258017210892194,0.0063415510651184089,0.01143030641195926,7.3387023256219157,-0.0011270532774932645,0.0093004365992715964,0.022535606277079928,0],"IMU":[0.0012212218634643436,0.11537362913949117,0.77530885519265724,-0.004114112168149461,0.026185392406550913,0.10972592887824918,1.1342141394930134,-0.024186396179809951,-9.7519390622144542],"FOG":[0.78708069390958513],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[2.1648229912859045,-10.621329751998159,-27.547630551277713,61.374425313187501,61.374425313187501],"omega_rad_s":[2.0985172357030057,-10.566419077120122,-27.569863950339009,61.371881327456421,61.371884070641848],"thrust_n":[0.055270568238189807,-1.4242828821251658,-9.6881927967421877,48.144561346392756,48.151815288097097],"torque_nm":[-0.0010363231544660591,0.026705304039846861,0.18165361493891602,-0.90271052524486417,-0.90284653665182057],"angle_rad":[-559.64148606579795,362.01896829066669,-721.54294402201424,2193.8711232729188,2193.8710846303102]},"command":[0.02061736182177052,-0.10115552144760152,-0.2623583862026449,0.58451833631607142,0.58451833631607142],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,1.3552527156068805e-20,0,-4.3368086899420177e-19],"servo_effort":[0.01974623004358721,-1.4873381670924057,-0.26719530166996819,2.3666839909951207e-05,-0.00040689957661740303,0.00010740843638009109]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":811,"step":6488,"t":32.439999999999998,"sim_time":32.439999999998143,"vehicle":{"origin_ned":[1.4995971206814558,1.0014741927242812,3.4980754518184507],"origin_quat_xyzw":[-0.021233916425730189,0.05361043611939189,0.37738985953656962,0.92425750516362148],"cg_ned":[1.4387194438716184,0.94266645729798737,3.2056177792374685],"linear_velocity_ned":[9.8438658678759452e-05,-0.0013626538083661387,-0.0025444024168017406],"angular_velocity_ned":[-0.00015905118630630749,0.00014122340931934711,0.0018195361892590514]},"sensors":{"Odom":[1.4995971206814558,1.0014741927242812,3.4980754518184507,-0.00051991471835705874,-0.00088695769956197688,-0.002638680488342145,-0.021233916425730203,0.053610436119391924,0.37738985953656989,0.92425750516362148,-0.00022411141584922792,0.0002143938866977667,0.0018054812682111257],"Pressure":[26816.277749147532],"DVL":[0.0081488420021687009,-0.006470445721885161,-0.0095206890113910831,7.1933586339417301,0.0095506610406150914,-0.01187912329437342,0.013306788450893588,0],"IMU":[0.001220975454259564,0.11538247166781532,0.77538131962927426,0.0059409048005693438,-0.013108383823344122,-0.093738991201703856,1.1468255376089673,-0.0011308996310413315,-9.7477598064517714],"FOG":[0.78321271479006727],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[2.1523929020134664,-10.601914175436905,-27.546854960481856,61.384226833425593,61.384226833425593],"omega_rad_s":[2.0839178630472959,-10.546565148400743,-27.568829364721079,61.382151411826605,61.38215533420729],"thrust_n":[0.054502341332828587,-1.4190453301859258,-9.687665194156093,48.159309220033123,48.165944235249192],"torque_nm":[-0.001021918899990536,0.026607099940986114,0.18164372239042675,-0.90298704787562123,-0.90311145441092255],"angle_rad":[-559.55788261606961,361.59676654907378,-722.64571531659817,2196.3262333048265,2196.326194798587]},"command":[0.020498980019175873,-0.10097061119463718,-0.26235099962363673,0.5846116841278628,0.5846116841278628],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,4.3368086899420177e-19],"servo_effort":[0.019923097116974379,-1.487614269574536,-0.2672551675065975,2.3814939292757221e-05,-0.00040689207924047568,0.00010756320665261523]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":812,"step":6496,"t":32.480000000000004,"sim_time":32.479999999998164,"vehicle":{"origin_ned":[1.4995985297589298,1.0014264871262246,3.4979742810578545],"origin_quat_xyzw":[-0.02123786976723244,0.053613179656365494,0.37742354388715932,0.92424350058550131],"cg_ned":[1.438723686565371,0.94261243846800746,3.2055172881891498],"linear_velocity_ned":[0.00011199333060263261,-0.0013410068592774021,-0.0024872205897630856],"angular_velocity_ned":[-0.00015904639128178546,0.00011330023945788079,0.0018355872863045357]},"sensors":{"Odom":[1.4995985297589298,1.0014264871262246,3.4979742810578545,-0.00050786470389599045,-0.00087377300305095033,-0.0025780319081497977,-0.021237869767232465,0.053613179656365549,0.37742354388715971,0.92424350058550131,-0.0002453725342861901,0.00019446643473293215,0.0018191999641776761],"Pressure":[26815.087883956559],"DVL":[0.014275369705099164,-0.00065288801922879077,0.010679483263794309,7.4272379469108758,0.01968632092643556,0.008492325868933016,-0.023582627253093107,0],"IMU":[0.001219939353271753,0.1153905095961745,0.7754543441102163,-0.11741792981646726,-0.014149693395640187,0.048545838248695405,1.1373597359448342,-0.008719324706054259,-9.7662816460066981],"FOG":[0.75848670239895755],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[2.1403570019785572,-10.583192131477402,-27.546041897840794,61.393860520034046,61.393860520034046],"omega_rad_s":[2.0705950816421685,-10.527375983378251,-27.567722615932087,61.392244893037059,61.392249959405895],"thrust_n":[0.053806344237315271,-1.4139939740455907,-9.6870845719300647,48.173770900216816,48.179798225839811],"torque_nm":[-0.0010088689544496612,0.02651238701335483,0.18163283572368871,-0.90325820437906534,-0.9033712167344965],"angle_rad":[-559.4748330420756,361.1753438473462,-723.74844353573519,2198.7817501140726,2198.7817117905902]},"command":[0.020384352399795781,-0.10079230601407049,-0.26234325616991233,0.58470343352413379,0.58470343352413379],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,-6.6174449004242214e-23,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,-1.3552527156068805e-20,0,0],"servo_effort":[0.020085311283936817,-1.4878810422453699,-0.26731330480647453,2.3953329184864777e-05,-0.00040687605297939309,0.00010771805791291996]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":813,"step":6504,"t":32.520000000000003,"sim_time":32.519999999998184,"vehicle":{"origin_ned":[1.4996001167851729,1.0013796815240674,3.497875470113931],"origin_quat_xyzw":[-0.021242049326857172,0.053615406190605813,0.3774575073052735,0.92422940536335507],"cg_ned":[1.43872846788176,0.94255928094320918,3.2054190898338897],"linear_velocity_ned":[0.00012538794241722572,-0.0013195626264490016,-0.0024297989220339769],"angular_velocity_ned":[-0.00015912522991300143,8.5932309091769151e-05,0.0018511240038387995]},"sensors":{"Odom":[1.4996001167851729,1.0013796815240674,3.497875470113931,-0.00049596267067857059,-0.00086076141406084608,-0.0025171976488717082,-0.02124204932685719,0.053615406190605855,0.37745750730527378,0.92422940536335507,-0.00026624919067099259,0.00017499485204512208,0.0018324446644724763],"Pressure":[26813.842725802861],"DVL":[0.00092876434416441995,-0.0082528313307065389,0.00061571269201517284,7.2566814974219866,-0.022469573664355327,0.0024775764695651589,-0.0099281369998113021,0],"IMU":[0.001218123874666835,0.11539775992572145,0.77552790933883686,-0.08590756133037987,0.035339062937349487,-0.0075401378381125088,1.1104277967298684,-0.0064804865657835664,-9.7614956306793541],"FOG":[0.77434850365149199],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[2.1282444183703646,-10.565191898443457,-27.545200259332688,61.403326967891559,61.403326967891559],"omega_rad_s":[2.0581387947309935,-10.508872795302526,-27.566559642841213,61.402161612273076,61.402167783863867],"thrust_n":[0.053159931781233079,-1.4091335329026828,-9.686462006475784,48.187945814553252,48.193378812175169],"torque_nm":[-0.00099674872089812049,0.026421253741925301,0.18162116262142095,-0.90352398402287371,-0.90362585272828455],"angle_rad":[-559.39229554242479,360.75467312337639,-724.8511261632309,2201.2376666318478,2201.237628536021]},"command":[0.020268994460670139,-0.10062087522327101,-0.26233524056507324,0.58479359017039578,0.58479359017039578],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,-8.6736173798840355e-19,0,0,0,0],"servo_effort":[0.0202350235861272,-1.4881370342392721,-0.26736914899038983,2.4079916306424621e-05,-0.00040685048452655369,0.00010786970641237734]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":814,"step":6512,"t":32.560000000000002,"sim_time":32.559999999998205,"vehicle":{"origin_ned":[1.4996018838519054,1.0013337673688538,3.4977790270893472],"origin_quat_xyzw":[-0.021246450600487393,0.053617128387421303,0.37749174044555855,0.92421522264878908],"cg_ned":[1.438733781078966,0.9425069768597909,3.2053231939889577],"linear_velocity_ned":[0.00013860714588948093,-0.0012983105758281402,-0.0023721279791136577],"angular_velocity_ned":[-0.00015923032314733062,5.9291013268846957e-05,0.0018661428144570453]},"sensors":{"Odom":[1.4996018838519054,1.0013337673688538,3.4977790270893472,-0.00048418837787723469,-0.00084795223584702086,-0.0024561729812382178,-0.021246450600487403,0.053617128387421331,0.37749174044555872,0.92421522264878908,-0.00028658100926106078,0.00015606131930133787,0.0018452303145576573],"Pressure":[26814.697218863937],"DVL":[0.020693147727916979,0.012759112031760779,-0.039711042770634593,7.3628673599200321,0.010276491154022814,-0.013278851127300418,0.00048923846734020345,0],"IMU":[0.0012155458028125889,0.11540424283557553,0.77560199656680884,-0.075275269897290581,-0.093811089709861878,0.078142004046813068,1.1309308294453613,-0.020241347863278723,-9.7236139310015091],"FOG":[0.76416547304212568],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[2.115674870732319,-10.54795647679178,-27.544339901509545,61.412616959891658,61.412616959891658],"omega_rad_s":[2.046130724868684,-10.491083553825744,-27.565354427638574,61.4118995232717,61.41190675772517],"thrust_n":[0.052540644450247351,-1.4044705239202393,-9.6858071573574094,48.201829384820954,48.206683922811862],"torque_nm":[-0.00098513708344213783,0.026333822323504483,0.1816088842004514,-0.90378430096539297,-0.90387532355272249],"angle_rad":[-559.31024506431891,360.33472631790937,-725.95376127240172,2203.6939757530859,2203.693937928183]},"command":[0.020149284483164942,-0.1004567283503979,-0.26232704668104329,0.58488206628468242,0.58488206628468242],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,4.3368086899420177e-19],"servo_effort":[0.020375195090553116,-1.4883855223337457,-0.26742304491122992,2.4196163702158308e-05,-0.00040681368504020811,0.00010801810037912275]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":815,"step":6520,"t":32.600000000000001,"sim_time":32.599999999998225,"vehicle":{"origin_ned":[1.4996038344569251,1.0012887355256899,3.4976849594454786],"origin_quat_xyzw":[-0.021251066709443791,0.053618361472990636,0.37752623415132802,0.92420095542267156],"cg_ned":[1.4387396189115333,0.94245551848221598,3.2052296100849711],"linear_velocity_ned":[0.00015164136262314247,-0.001277253855340272,-0.0023142348841006404],"angular_velocity_ned":[-0.00015929610994571539,3.3533186813266441e-05,0.0018806522109757774]},"sensors":{"Odom":[1.4996038344569251,1.0012887355256899,3.4976849594454786,-0.0004725276374993918,-0.00083538634611029594,-0.0023949892793636162,-0.021251066709443808,0.053618361472990685,0.3775262341513283,0.92420095542267156,-0.00030621330480563907,0.00013773187110102344,0.0018575833245248496],"Pressure":[26811.197369028763],"DVL":[0.017049484744729879,-0.0091947074035028126,0.0038223030531675736,7.3874498157610047,0.0039608480653074134,0.017812732794610774,0.0056477672849611785,0],"IMU":[0.0012122283169913978,0.11540998145336097,0.77567658789826077,-0.0064332755291198248,-0.01581246688603934,-0.14979138316522927,1.1282098094705078,-0.018848296496588458,-9.7393627466969441],"FOG":[0.79153311188432418],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[2.1022574093838196,-10.531532843430874,-27.54346510277723,61.421722354935781,61.421722354935781],"omega_rad_s":[2.0341636296091803,-10.474042708726392,-27.564118511432977,61.421453703744064,61.421461955110594],"thrust_n":[0.051927119348848284,-1.4000131949303121,-9.6851279286891572,48.215413478037156,48.219707522328292],"torque_nm":[-0.00097363348779090544,0.026250247404943354,0.18159614866292176,-0.90403900271319682,-0.90411951604365559],"angle_rad":[-559.22867290659485,359.91547410336767,-727.05634744669806,2206.1506702112733,2206.150632698786]},"command":[0.020021499136988759,-0.10030031279457975,-0.26231871526454503,0.5849687843327217,0.5849687843327217],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.020505044666961594,-1.4886231637685585,-0.26747477784088225,2.4296652220741871e-05,-0.00040676653268832767,0.00010816239137123918]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":816,"step":6528,"t":32.640000000000001,"sim_time":32.639999999998246,"vehicle":{"origin_ned":[1.4996059734905904,1.001244575900915,3.4975932731148114],"origin_quat_xyzw":[-0.021255888406877883,0.053619122924942038,0.37756097966519214,0.92418660642700001],"cg_ned":[1.4387459738073733,0.94240489787293225,3.2051383462297629],"linear_velocity_ned":[0.000164482950136453,-0.0012563980605082186,-0.0022561542874812929],"angular_velocity_ned":[-0.00015925413535930894,8.8034558717085636e-06,0.0018946703380159535]},"sensors":{"Odom":[1.4996059734905904,1.001244575900915,3.4975932731148114,-0.00046096895395272884,-0.00082310502807876878,-0.0023336848772850531,-0.021255888406877886,0.053619122924942045,0.3775609796651922,0.92418660642700001,-0.00032499892902140614,0.00012006177515770342,0.0018695389636225121],"Pressure":[26812.795375687871],"DVL":[0.0041857452387588541,0.031573834046336985,0.038589860856421201,7.3281944052221535,-0.017399586851395626,0.0017389501945618494,-0.011823410572085712,0],"IMU":[0.0012082007705440923,0.11541500128464845,0.77575166671886531,0.02427281000643727,0.084500728759450999,0.0061215365382012192,1.1348443208301295,0.00091574371789146514,-9.7679853306419027],"FOG":[0.77961882949472705],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[2.0874935359342004,-10.515977374327587,-27.542571631951596,61.430645210510747,61.430645210510747],"omega_rad_s":[2.0217966718611122,-10.457791872058072,-27.56285876455031,61.430821185751441,61.430830404806343],"thrust_n":[0.051296768362418532,-1.3957717061403296,-9.6844289267023544,48.228693534132013,48.232446783122711],"torque_nm":[-0.00096181440679534759,0.026170719490131181,0.18158304237566913,-0.90428800376497531,-0.90435837718355072],"angle_rad":[-559.14758740202024,359.49688561386017,-728.15888362735086,2208.6077425841418,2208.6077054236489]},"command":[0.019880890818420954,-0.10015216546978654,-0.26231020601858662,0.58505376390962616,0.58505376390962616],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,1.7347234759768071e-18,0,0,4.3368086899420177e-19],"servo_effort":[0.020626558543622629,-1.4888513225542559,-0.26752455539084041,2.4387146268187024e-05,-0.0004067084892460737,0.00010830183104321691]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":817,"step":6536,"t":32.68,"sim_time":32.679999999998266,"vehicle":{"origin_ned":[1.4996083070769406,1.0012012774417187,3.4975039724632055],"origin_quat_xyzw":[-0.021260904218595965,0.053619432214684418,0.37759596874359225,0.92417217812990371],"cg_ned":[1.4387528378921377,0.94235510685946799,3.2050494091387138],"linear_velocity_ned":[0.00017712424966564769,-0.0012357491299588152,-0.00219792105371761],"angular_velocity_ned":[-0.00015904240177606289,-1.4772549324707494e-05,0.0019082173355633376]},"sensors":{"Odom":[1.4996083070769406,1.0012012774417187,3.4975039724632055,-0.00044950378315276852,-0.00081114439391451621,-0.0022722978816707333,-0.021260904218595979,0.053619432214684445,0.37759596874359247,0.92417217812990371,-0.00034280874452716101,0.0001030972262393418,0.0018811324355659177],"Pressure":[26811.577596476265],"DVL":[0.0088809236487456394,0.0036912267261210736,-0.025137167099180312,7.2648878820123066,0.0095556987249357326,-0.033128316260781845,0.012436304594591982,0],"IMU":[0.001203498247328564,0.11541932984040783,0.77582721790881592,0.034578550393548561,0.077267760372941238,-0.024505429610442615,1.1442933055566957,-0.012072840268873212,-9.7345175389477916],"FOG":[0.78143491835214629],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[2.070885328694124,-10.501353344167111,-27.541649746110078,61.43938793490959,61.43938793490959],"omega_rad_s":[2.00856226737233,-10.442380111558823,-27.561576908164433,61.440000819377964,61.440010954040297],"thrust_n":[0.050626202741754285,-1.3917581877065008,-9.6837111377790972,48.241667974225926,48.244901584303754],"torque_nm":[-0.00094924130140789276,0.026095466019496902,0.18156958383335811,-0.90453127451673621,-0.90459190470569539],"angle_rad":[-559.06701515597831,359.07892814805393,-729.26136891363512,2211.0651853736304,2211.0651486026777]},"command":[0.019722717416134516,-0.10001288899206771,-0.26230142615342933,0.58513702795151989,0.58513702795151989],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.020739235577618729,-1.4890715685323184,-0.26757266639682353,2.4465684507388183e-05,-0.00040664002976379429,0.00010843471702559465]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":818,"step":6544,"t":32.719999999999999,"sim_time":32.719999999998286,"vehicle":{"origin_ned":[1.4996108420506553,1.0011588285195667,3.4974170603185084],"origin_quat_xyzw":[-0.021266101422745362,0.053619310197385028,0.37763119307634163,0.92415767297576057],"cg_ned":[1.4387602029606794,0.94230613707639688,3.2049628041288378],"linear_velocity_ned":[0.0001895566138800751,-0.0012153109366033151,-0.0021395702667148823],"angular_velocity_ned":[-0.00015865492413684565,-3.7138399368362229e-05,0.0019212628300350389]},"sensors":{"Odom":[1.4996108420506553,1.0011588285195667,3.4974170603185084,-0.00043812592110933484,-0.0007995167944669561,-0.0022108659914024708,-0.021266101422745372,0.053619310197385042,0.37763119307634174,0.92415767297576057,-0.0003595956442913323,8.6874146435386896e-05,0.0018923385962936405],"Pressure":[26810.349949752839],"DVL":[-0.0015373338100300527,0.025978406056437607,0.021128515835821777,7.3110414385257814,-0.023940633241560844,0.00059723830775702271,-0.00079913133607212848,0],"IMU":[0.001198159202076931,0.11542299624775991,0.77590322644014031,-0.011101943280826865,0.047609235396505252,-0.023129501674565296,1.1361627462097996,-0.0017224622416004733,-9.7502381021395266],"FOG":[0.76467682616744981],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[2.0520703036319254,-10.487678665420827,-27.540703726301011,61.447953108268159,61.447953108268159],"omega_rad_s":[1.9940044111450832,-10.427852570392167,-27.560273471793078,61.448992753711103,61.449003749523726],"thrust_n":[0.049893282655560173,-1.3879836429933972,-9.6829748965147342,48.254337397111122,48.257073674094194],"torque_nm":[-0.0009354990497917533,0.026024693306126202,0.18155577930965128,-0.90476882619583365,-0.9048201313892662],"angle_rad":[-558.98700142407677,358.66156705571734,-730.36380241813151,2213.5229910664216,2213.5229547204144]},"command":[0.019543526701256433,-0.099882653956388831,-0.26229241644096202,0.58521860103112533,0.58521860103112533],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,-6.6174449004242214e-23,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,-4.3368086899420177e-19],"servo_effort":[0.020831725355363453,-1.4892856250209512,-0.26761940311012505,2.4531016002732881e-05,-0.00040655929529529795,0.00010856223173339111]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":819,"step":6552,"t":32.759999999999998,"sim_time":32.759999999998307,"vehicle":{"origin_ned":[1.4996135857383857,1.0011172170139637,3.4973325380035365],"origin_quat_xyzw":[-0.021271466304643206,0.053618778787558677,0.37766664433337876,0.92414309337923761],"cg_ned":[1.4387680604969244,0.94225797997610827,3.2048785351165368],"linear_velocity_ned":[0.00020177324239536884,-0.0011950888741413281,-0.0020811366946158626],"angular_velocity_ned":[-0.00015804047561724109,-5.8207925809476425e-05,0.0019338340865528009]},"sensors":{"Odom":[1.4996135857383857,1.0011172170139637,3.4973325380035365,-0.00042683205722791407,-0.00078824760819594657,-0.0021494260429083122,-0.021271466304643223,0.053618778787558719,0.37766664433337904,0.92414309337923761,-0.00037526638356410102,7.1418063050134462e-05,0.0019031956889691509],"Pressure":[26810.414147273361],"DVL":[-0.01576629854167819,-0.012280371295395281,0.014874488839791089,7.2772085140371034,-0.015230730404520143,-0.00047008903551194021,0.0035664251489775172,0],"IMU":[0.001192224745213178,0.11542603084067599,0.77597967742616969,0.024643315098309394,0.050093944630582941,0.039209758491859259,1.1145772282980779,-0.021105350595274873,-9.7715704048703422],"FOG":[0.76189123909925272],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[2.0307697271398819,-10.4749477900831,-27.539743905902572,61.456343507071963,61.456343507071963],"omega_rad_s":[1.977725854069025,-10.414234642153856,-27.558953724569673,61.457798079885315,61.45780988054549],"thrust_n":[0.049079593235744873,-1.3844538746301152,-9.6822237445614405,48.266704014283128,48.268966098783224],"torque_nm":[-0.00092024237317021634,0.025958510149314665,0.18154169521052704,-0.90500070026780877,-0.90504311435218565],"angle_rad":[-558.90760822957975,358.24476639247433,-731.4661834066444,2215.9811521773831,2215.9811162895048]},"command":[0.019340664067998874,-0.099761407524600956,-0.26228327529431023,0.58529850959116159,0.58529850959116159],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,-6.6174449004242214e-23,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,-1.3552527156068805e-20,0,0],"servo_effort":[0.020922371970319448,-1.4894955423666274,-0.26766515791964213,2.4584910229239319e-05,-0.00040646851125365714,0.00010868206381240122]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":820,"step":6560,"t":32.799999999999997,"sim_time":32.799999999998327,"vehicle":{"origin_ned":[1.4996165461292494,1.0010764300007993,3.4972504054832272],"origin_quat_xyzw":[-0.021276983434598593,0.053617860994283839,0.3777023150734562,0.92412844136866235],"cg_ned":[1.4387764017532712,0.94221062680980006,3.2047966047245335],"linear_velocity_ned":[0.00021376882443891487,-0.0011750872000763721,-0.0020226500577058019],"angular_velocity_ned":[-0.00015713878162752532,-7.7903715136145305e-05,0.0019459780323138583]},"sensors":{"Odom":[1.4996165461292494,1.0010764300007993,3.4972504054832272,-0.00041562139711664889,-0.00077736086316881046,-0.0020880090034660413,-0.021276983434598586,0.053617860994283818,0.37770231507345603,0.92412844136866235,-0.00038972965338485946,5.6741917861626755e-05,0.0019137615420426371],"Pressure":[26808.059075389927],"DVL":[0.0046771238895443644,0.035211926184165715,0.0098173587363751622,7.3195825615185228,-0.0088151392806518555,0.0090216105236254583,-0.016322789484146002,0],"IMU":[0.001185740126979507,0.11542846467606355,0.77605655816219987,-0.0047239907324240519,-0.039975970255536696,0.18722152929654434,1.1343532890603523,0.0010198298716411446,-9.7381465638860103],"FOG":[0.77580401606584137],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[2.0065353865518185,-10.463237135544246,-27.538745698153637,61.464561230815782,61.464561230815782],"omega_rad_s":[1.9593126641617866,-10.401565619241554,-27.557614518173899,61.466418401580377,61.4664309495273],"thrust_n":[0.048166745298139316,-1.3811784497012876,-9.6814552325196388,48.278770889292097,48.280582374799948],"torque_nm":[-0.00090312647434011219,0.025897095931899143,0.18152728560974327,-0.90522695417422683,-0.9052609195274991],"angle_rad":[-558.82891379443186,357.82848891697489,-732.56851117795622,2218.4396612784581,2218.4396258796105]},"command":[0.019109860824303031,-0.099649877481373772,-0.26227376855384416,0.58537677362681695,0.58537677362681695],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.02101296427945374,-1.4897044174830703,-0.26771044263203769,2.4629208369177663e-05,-0.00040636831671621082,0.00010879541991560376]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":821,"step":6568,"t":32.840000000000003,"sim_time":32.839999999998348,"vehicle":{"origin_ned":[1.499619731514221,1.0010364540934085,3.4971706618114093],"origin_quat_xyzw":[-0.021282635940081146,0.053616580642467007,0.37773819878481235,0.92411371857929758],"cg_ned":[1.4387852176070774,0.9421640688766082,3.2047170147016781],"linear_velocity_ned":[0.0002255299567664953,-0.0011552997924515677,-0.0019641257236105371],"angular_velocity_ned":[-0.00015590233340629907,-9.6166418706329035e-05,0.0019577386941029289]},"sensors":{"Odom":[1.499619731514221,1.0010364540934085,3.4971706618114093,-0.00040449451833638752,-0.00076686136508934664,-0.002026631215471501,-0.02128263594008116,0.053616580642467042,0.37773819878481257,0.92411371857929758,-0.00040291542787014079,4.2854672413112956e-05,0.0019240886016690501],"Pressure":[26807.245953401332],"DVL":[-0.040816688661406399,0.025765894521625581,-0.0037539304267561499,7.3095976736830783,-0.013366716788197563,0.0010936555147981863,0.025010934551452729,0],"IMU":[0.001178754023922616,0.11543032922227303,0.77613385816440883,-0.012206703119427151,-0.038252906660294954,-0.066418347902468797,1.1228173272946258,-0.010698631505464578,-9.7428162671823362],"FOG":[0.78027806446724612],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[1.9790169019473427,-10.452619381441352,-27.53768378334475,61.472604801767673,61.472604801767673],"omega_rad_s":[1.9383548707284102,-10.389897074996114,-27.556245035881801,61.474854725363947,61.47486796236079],"thrust_n":[0.0471376339982741,-1.3781702058648555,-9.6806615405646657,48.290539852881452,48.291924631213256],"torque_nm":[-0.00088383063746763938,0.025840691359966046,0.18151240388558745,-0.90544762224152742,-0.90547358683524859],"angle_rad":[-558.75101295660454,357.41269551814304,-733.67078472197488,2220.8985109963978,2220.8984761151646]},"command":[0.018847780018546121,-0.09954875601372716,-0.2622636550794738,0.58545337906445405,0.58545337906445405],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,4.3368086899420177e-19],"servo_effort":[0.021107233661533775,-1.4899150239353016,-0.26775565148812064,2.4660895526932277e-05,-0.00040625717419236364,0.00010890048255600547]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":822,"step":6576,"t":32.880000000000003,"sim_time":32.879999999998368,"vehicle":{"origin_ned":[1.4996231501681643,1.0009972756152519,3.4970933051534536],"origin_quat_xyzw":[-0.021288405869325979,0.053614962055326447,0.37777428982949546,0.924098926286125],"cg_ned":[1.4387944984918475,0.94211829757297949,3.2046397659183197],"linear_velocity_ned":[0.00023704934182503415,-0.0011357295141779676,-0.0019055943488667324],"angular_velocity_ned":[-0.00015429241383141661,-0.00011296261642387715,0.0019691600023445132]},"sensors":{"Odom":[1.4996231501681643,1.0009972756152519,3.4970933051534536,-0.00039345588154668571,-0.00075675747566590569,-0.0019653237848524237,-0.021288405869325983,0.053614962055326447,0.37777428982949546,0.924098926286125,-0.00041477794333442578,2.9752921814470529e-05,0.0019342264184617744],"Pressure":[26808.671111670155],"DVL":[0.022849656192409241,0.031557557291082276,0.0020938749351441651,7.3616578138867848,-0.015389966088576137,-0.0073706328316512715,0.0018330297855486278,0],"IMU":[0.0011713176135813705,0.11543165604530375,0.77621156898791266,-0.050668833526340724,0.050843940905477246,-0.085466986119961105,1.1237338608030347,-0.0040753608207852393,-9.7317192058886892],"FOG":[0.77449361321448484],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[1.9479660162557577,-10.443157856533,-27.536533273540766,61.48047139446345,61.48047139446345],"omega_rad_s":[1.9144912696914738,-10.379285963471425,-27.554829534205371,61.483106629654266,61.483120497299531],"thrust_n":[0.045978829006729949,-1.3754434183060122,-9.6798314052328109,48.302010930448397,48.302992858853337],"torque_nm":[-0.00086210304387618678,0.025789564093237731,0.18149683884811518,-0.9056627049459075,-0.90568111610350011],"angle_rad":[-558.67401579579985,356.99734488465691,-734.77300247970879,2223.3576939615791,2223.3576596242074]},"command":[0.018552057297673882,-0.099458646252695238,-0.2622526978432454,0.58552829899489001,0.58552829899489001],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,4.3368086899420177e-19],"servo_effort":[0.021201905171541961,-1.4901261808389759,-0.26780083889193185,2.4682412334524623e-05,-0.00040613787985931495,0.00010899778811866872]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":823,"step":6584,"t":32.920000000000002,"sim_time":32.919999999998389,"vehicle":{"origin_ned":[1.4996268090811702,1.0009588817378674,3.4970183323106765],"origin_quat_xyzw":[-0.021294277702740044,0.053613028496631375,0.37781057993030037,0.92408406684958477],"cg_ned":[1.4388042344149397,0.94207330431907754,3.2045648578668882],"linear_velocity_ned":[0.00024831007353988085,-0.0011163689295113656,-0.001847090666243607],"angular_velocity_ned":[-0.00015257010561338139,-0.00012854431605707772,0.0019798896520633134]},"sensors":{"Odom":[1.4996268090811702,1.0009588817378674,3.4970183323106765,-0.00038250747551426688,-0.00074695595537299891,-0.0019041220481890587,-0.021294277702740061,0.053613028496631424,0.37781057993030071,0.92408406684958477,-0.00042563693934095849,1.7439110210212637e-05,0.0019437832662023795],"Pressure":[26805.284626828754],"DVL":[0.015063949102678668,0.0050104105088317388,0.00015863071831531336,7.3100474714220507,-0.0446886371483005,0.015724849910558461,0.0068081888451960561,0],"IMU":[0.0011634764152360548,0.11543247658645961,0.77628967614450062,-0.024968081328230047,0.018525313803831201,0.012431203178431932,1.123085481622434,0.0035086455679667963,-9.7769490878523833],"FOG":[0.78608320394403386],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[1.9133631059856089,-10.434746952902955,-27.535329690099726,61.488164253236917,61.488164253236917],"omega_rad_s":[1.8874249402444674,-10.369760070210875,-27.553359946142212,61.491174697356115,61.491189137604458],"thrust_n":[0.04468141766033449,-1.3730042305289274,-9.6789601177296838,48.313185900191712,48.313788854929236],"torque_nm":[-0.00083777658113127172,0.025743829322417394,0.18148050220743159,-0.90587223562859476,-0.90588354102992319],"angle_rad":[-558.59804593318199,356.58239378396576,-735.87516231925702,2225.8172028075551,2225.8171690379636]},"command":[0.018222505771291513,-0.099378542408599571,-0.26224123514380693,0.58560156431654209,0.58560156431654209],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.021162000850404226,-1.4903343020801156,-0.26784520113416077,2.4678424204495685e-05,-0.00040600821989865117,0.0001090843421865121]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":824,"step":6592,"t":32.960000000000001,"sim_time":32.959999999998409,"vehicle":{"origin_ned":[1.4996307127356459,1.0009212622735359,3.4969457386987939],"origin_quat_xyzw":[-0.021300242263509239,0.053610801228739555,0.37784705316779477,0.92406914572641252],"cg_ned":[1.4388144146265087,0.94202908094096216,3.2044922887389604],"linear_velocity_ned":[0.00025929672971603045,-0.0010972109496188722,-0.0017886454746440653],"angular_velocity_ned":[-0.00015089807758208754,-0.00014300820215706628,0.0019896619985857482]},"sensors":{"Odom":[1.4996307127356459,1.0009212622735359,3.4969457386987939,-0.00037163825546265199,-0.00073740984437453715,-0.0018430595111727961,-0.02130024226350926,0.05361080122873961,0.37784705316779515,0.92406914572641252,-0.00043564427970971796,5.9577583538675912e-06,0.0019524740743451629],"Pressure":[26806.414255252537],"DVL":[-0.0038516899956856313,-0.024179629791866115,-0.0054131028536025527,7.3565503933631975,-0.038019056764247029,-6.3397269948860997e-06,-0.030878250137194602,0],"IMU":[0.0011552616714755179,0.11543282338804427,0.77636814780345742,-0.081089243544521197,-0.029510594591585664,-0.19440695616435957,1.1375356036590829,0.00085893975018561282,-9.7568465821382784],"FOG":[0.75022017430380816],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[1.8763368323848737,-10.426673082570387,-27.534350512719296,61.495686429691752,61.495686429691752],"omega_rad_s":[1.8572923689853571,-10.361124648089698,-27.551912775366791,61.49906043480653,61.499075389877781],"thrust_n":[0.043258415876913911,-1.3707999223669374,-9.6781024971020795,48.324067368076264,48.324316455774067],"torque_nm":[-0.00081109529769213598,0.025702498544380073,0.181464421820664,-0.90607626315142997,-0.9060809335457638],"angle_rad":[-558.52322918404593,356.16780277852075,-736.9772636345715,2228.2770302134468,2228.2769970332392]},"command":[0.017869874594141653,-0.099301648405432263,-0.26223190964494569,0.58567320409230239,0.58567320409230239],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,-4.3368086899420177e-19],"servo_effort":[0.021080817255405327,-1.4905320000576605,-0.26788707966282405,2.4656144566581903e-05,-0.00040586472303672091,0.00010915927299944483]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":825,"step":6600,"t":33,"sim_time":32.99999999999843,"vehicle":{"origin_ned":[1.4996348661880163,1.0008844068694951,3.4968755183854463],"origin_quat_xyzw":[-0.021306289711893068,0.053608302730011971,0.37788369290431062,0.92405416861465473],"cg_ned":[1.4388250280665964,0.94198561926638502,3.2044220555272549],"linear_velocity_ned":[0.0002700052453873975,-0.0010782587010368368,-0.0017302884026513291],"angular_velocity_ned":[-0.00014920188961694674,-0.00015622628467334626,0.001998533014540831]},"sensors":{"Odom":[1.4996348661880163,1.0008844068694951,3.4968755183854463,-0.00036083790221968159,-0.00072815570843732277,-0.0017821681860790417,-0.021306289711893082,0.053608302730011999,0.37788369290431084,0.92405416861465473,-0.0004446644377102598,-4.6520020903688111e-06,0.0019603708737915226],"Pressure":[26805.858934847434],"DVL":[-0.0051311650780289904,0.017076954748869298,0.011266760769155233,7.3369570694722848,0.020823636470682458,0.036984138478670978,0.02009894516646701,0],"IMU":[0.0011467067003533024,0.11543273074000684,0.77644695074051773,-0.001842980055977555,0.029279726364158744,-0.099333579647670048,1.1519076188520503,-0.021756478127024467,-9.7684099348530484],"FOG":[0.77683043047673639],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[1.8364423650319006,-10.418922736500031,-27.5336159844598,61.503040647261535,61.503040647261535],"omega_rad_s":[1.8241572508746713,-10.353186962292567,-27.550567719323126,61.506765860206521,61.506781272021321],"thrust_n":[0.041719823488672245,-1.3687790228088099,-9.6773143360110705,48.334658687798012,48.334580280453011],"torque_nm":[-0.0007822466904126047,0.025664606677665191,0.18144964380020759,-0.90627485039621269,-0.90627338025849402],"angle_rad":[-558.44968601999426,355.75354092086229,-738.07930923683034,2230.7371689310899,2230.7371363595535]},"command":[0.0174899272860181,-0.099227835585714574,-0.26222491413771237,0.58574324425963364,0.58574324425963364],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,4.3368086899420177e-19],"servo_effort":[0.020992341314747774,-1.4907213675404412,-0.26792683743137158,2.4619149621307147e-05,-0.00040570839525357728,0.0001092210714424588]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":826,"step":6608,"t":33.039999999999999,"sim_time":33.03999999999845,"vehicle":{"origin_ned":[1.4996392755388714,1.0008483043595731,3.496807664154197],"origin_quat_xyzw":[-0.02131240812167463,0.053605556993794691,0.37792048375475418,0.9240391406634314],"cg_ned":[1.4388360635495707,0.94194291098368588,3.2043541540466363],"linear_velocity_ned":[0.00028043314391351757,-0.0010595159423093079,-0.0016720487158463477],"angular_velocity_ned":[-0.00014741439245238467,-0.00016809843318850627,0.0020065670142519836]},"sensors":{"Odom":[1.4996392755388714,1.0008483043595731,3.496807664154197,-0.00035009990363875289,-0.00071922373450823392,-0.0017214788849538411,-0.021312408121674637,0.053605556993794712,0.37792048375475429,0.9240391406634314,-0.00045258739830185261,-1.4365834140365423e-05,0.0019675511527618463],"Pressure":[26804.75492426374],"DVL":[-0.0083377605274723467,0.017388930583893857,0.025144029459768218,7.3952454602667359,-0.015387345509651875,0.00017846872198487904,-0.012561005939710568,0],"IMU":[0.0011378500183511105,0.11543223415166294,0.7765260547715247,0.086091317013702151,0.01506261660904785,-0.0027950992667842298,1.1302667011238754,-0.015954569376016067,-9.7509053813482787],"FOG":[0.78088849529703042],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[1.7930235219982076,-10.411587983230191,-27.533102193293718,61.510229507504526,61.510229507504526],"omega_rad_s":[1.7878412780107564,-10.345847241794104,-27.549371042429172,61.514293281206356,61.514309091215807],"thrust_n":[0.040065176201075935,-1.3669148514138278,-9.6766278633708378,48.344963855519538,48.344585136731709],"torque_nm":[-0.00075122205377017382,0.025629653464009278,0.18143677243820328,-0.90646807229099136,-0.90646097131371961],"angle_rad":[-558.37754011509298,355.33958276823199,-739.18130433684985,2233.1976118000366,2233.1975798541262]},"command":[0.017076414495221025,-0.099157980792668493,-0.2622200208885116,0.58581170959528117,0.58581170959528117],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,1.0778494253810979e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,-1.7347234759768071e-18,0,0,0],"servo_effort":[0.02089912965768026,-1.490904479164556,-0.26796486828748345,2.456767593210686e-05,-0.00040554017312442552,0.00010926800141157604]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":827,"step":6616,"t":33.079999999999998,"sim_time":33.079999999998471,"vehicle":{"origin_ned":[1.4996439476686645,1.0008129428515677,3.4967421675732155],"origin_quat_xyzw":[-0.021318583845809282,0.053602589096298087,0.3779574116682779,0.92402406645606283],"cg_ned":[1.4388475098255793,0.94190094761571863,3.2042885789576196],"linear_velocity_ned":[0.00029057940536623842,-0.0010409870240122047,-0.001613954948545944],"angular_velocity_ned":[-0.00014547780784723895,-0.00017855033850387971,0.0020138316554956953]},"sensors":{"Odom":[1.4996439476686645,1.0008129428515677,3.4967421675732155,-0.00033942079081252636,-0.00071063801279099589,-0.0016610210096408681,-0.021318583845809293,0.053602589096298107,0.37795741166827806,0.92402406645606283,-0.00045932814177655648,-2.3171281947800108e-05,0.0019740928809195923],"Pressure":[26803.409360310332],"DVL":[-0.022605369665518609,0.015089126876319005,0.015037410424621044,7.4014163258499632,-0.021607303623845324,-0.010155633024811615,-0.036980570008920521,0],"IMU":[0.0011287343410940364,0.11543136982665911,0.77660543285848826,0.0094091915587096644,0.018240297832146112,-0.15001181531010882,1.1354451771062744,-0.0034206378195852042,-9.7412074871378458],"FOG":[0.77577532171543984],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[1.7454095958060922,-10.404761943738727,-27.532780857487662,61.517255444535373,61.517255444535373],"omega_rad_s":[1.747998554332638,-10.339069491451925,-27.548344657029862,61.5216451506097,61.521661299950267],"thrust_n":[0.038288001348859665,-1.3651976744420815,-9.6760582038885445,48.354987240521048,48.354335831216304],"torque_nm":[-0.00071790002529111897,0.025597456395789024,0.18142609132291024,-0.90665601075976965,-0.90664379683530583],"angle_rad":[-558.30692624021253,354.9259053523914,-740.28325542075936,2235.6583517558115,2235.6583204501298]},"command":[0.016622948531486593,-0.099092970892749779,-0.26221696054750154,0.58587862328128926,0.58587862328128926],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,4.3368086899420177e-19],"servo_effort":[0.02080257438656568,-1.491082917032674,-0.26800147226402632,2.4504129593747274e-05,-0.00040535871047829748,0.00010930055479157954]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":828,"step":6624,"t":33.119999999999997,"sim_time":33.119999999998491,"vehicle":{"origin_ned":[1.4996488899883036,1.0007783098294045,3.4966790190642372],"origin_quat_xyzw":[-0.021324801876225388,0.053599424810511352,0.37799446392749492,0.92400895002434247],"cg_ned":[1.4388593556222389,0.94185972051028788,3.2042253237970728],"linear_velocity_ned":[0.00030044379550580734,-0.0010226763240733874,-0.0015560348203918324],"angular_velocity_ned":[-0.00014334364443963727,-0.00018753140535605222,0.0020203941940303487]},"sensors":{"Odom":[1.4996488899883036,1.0007783098294045,3.4966790190642372,-0.00032879979753678906,-0.00070241642711822878,-0.0016008225540066433,-0.021324801876225388,0.053599424810511352,0.37799446392749497,0.92400895002434247,-0.00046482468917396667,-3.1066323122753899e-05,0.0019800709632661036],"Pressure":[26802.183535832301],"DVL":[0.0036275499372394205,-0.01899874140743301,-0.0060463026946465121,7.3163415976799966,0.0049155573711356215,0.017189811561416257,-0.0046587900471379839,0],"IMU":[0.0011194056196130993,0.11543017421921151,0.77668506104122703,-0.088452482915607436,-0.050343728337922368,-0.099746546725236362,1.1206983683210252,-0.011938445787239875,-9.7723789431716135],"FOG":[0.77110177585589612],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[1.6929004187689529,-10.398533442199273,-27.532621893693229,61.524120694205536,61.524120694205536],"omega_rad_s":[1.7041607741760474,-10.332859870383121,-27.547493196977928,61.528823949956262,61.528840379775424],"thrust_n":[0.036378843784786175,-1.3636289314421794,-9.6756083628912162,48.364733378610246,48.363837011764893],"torque_nm":[-0.00068210332096474066,0.025568042464540867,0.18141765680421032,-0.90683875084894228,-0.90682194397059179],"angle_rad":[-558.23799587875999,354.51248613726216,-741.38516944178923,2238.1193818329416,2238.1193511797369]},"command":[0.016122861131132885,-0.099033651830469263,-0.26221544660660218,0.58594400661148127,0.58594400661148127],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,-8.6736173798840355e-19,0,0,0,-4.3368086899420177e-19],"servo_effort":[0.020703327232977211,-1.4912579982742691,-0.2680369100868733,2.4427094082588442e-05,-0.00040516531359156962,0.00010931804006144049]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":829,"step":6632,"t":33.160000000000004,"sim_time":33.159999999998512,"vehicle":{"origin_ned":[1.499654110210231,1.0007443922620878,3.4966182079710659],"origin_quat_xyzw":[-0.021331046185281647,0.053596090267246668,0.37803162909244131,0.92399379488307243],"cg_ned":[1.4388715896714896,0.9418192208428452,3.2041643810147629],"linear_velocity_ned":[0.00031002666901294869,-0.0010045880657316545,-0.0014983150800836264],"angular_velocity_ned":[-0.00014097294534659569,-0.00019501214100132772,0.0020263188049295224]},"sensors":{"Odom":[1.499654110210231,1.0007443922620878,3.4966182079710659,-0.00031823827950444312,-0.00069457109506219515,-0.0015409100548084338,-0.021331046185281654,0.053596090267246682,0.37803162909244142,0.92399379488307243,-0.00046903615407479848,-3.805732813093672e-05,0.0019855547667125377],"Pressure":[26803.278750121583],"DVL":[-0.014638053869501691,-0.00091892194188783862,-0.019592164852479794,7.388772912119034,-0.044486818648846967,0.038814254931857833,-0.012695492621265703,0],"IMU":[0.0011099121396604594,0.1154286836641171,0.77676491825489347,-0.013826162019799101,-0.027812075771592511,-0.072257558464994848,1.1284484508282937,-0.011216479380427425,-9.7429587754081108],"FOG":[0.79608555794075553],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[1.6347410286963129,-10.392983803335936,-27.532595098467315,61.530827262356361,61.530827262356361],"omega_rad_s":[1.6557605009676863,-10.327250767817963,-27.546809425087883,61.53583210342579,61.535848755285215],"thrust_n":[0.034327318430584328,-1.3622169977633938,-9.6752730343917701,48.374206806165148,48.373093062596787],"torque_nm":[-0.00064363722057345627,0.02554156870806364,0.18141136939484565,-0.90701637761559661,-0.9069954949236898],"angle_rad":[-558.17092153948192,354.09930170835031,-742.48705325594449,2240.5806951640993,2240.5806651732751]},"command":[0.015568962178060123,-0.098980798127008912,-0.26221519141397442,0.5860078786891082,0.5860078786891082],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,4.3198680309969292e-21,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,4.3368086899420177e-19],"servo_effort":[0.020601481016056446,-1.491430761810133,-0.26807140389825929,2.4341822371893181e-05,-0.00039167841393543932,0.00010932140345695062]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":830,"step":6640,"t":33.200000000000003,"sim_time":33.199999999998532,"vehicle":{"origin_ned":[1.4996596161484872,1.0007111767118302,3.496559722625963],"origin_quat_xyzw":[-0.02133730004191511,0.053592611664934814,0.37806889690951984,0.92397860407666998],"cg_ned":[1.4388842007296949,0.94177943962516319,3.2041057420139047],"linear_velocity_ned":[0.00031932882294481474,-0.00098672622461796274,-0.0014408214254782929],"angular_velocity_ned":[-0.0001383359182646553,-0.00020098150258311716,0.0020316652196052218]},"sensors":{"Odom":[1.4996596161484872,1.0007111767118302,3.496559722625963,-0.00030773927122893451,-0.00068710893342698043,-0.0014813086010819882,-0.021337300041915103,0.0535926116649348,0.37806889690951978,0.92397860407666998,-0.00047194047903142072,-4.4157422113077128e-05,0.0019906070083118245],"Pressure":[26801.874247037911],"DVL":[-0.012996440698068479,-0.019622594994155432,-0.03481859078881254,7.3926797320608157,0.030178029238286466,-0.029445664374983277,0.0079325716147480088,0],"IMU":[0.0011003037008308603,0.11542693407821271,0.77684498607808139,0.13590585903877886,0.062499824078784759,-0.18615065778734938,1.132623939997264,-0.020324288449759201,-9.7297197292930893],"FOG":[0.75717847699693086],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[1.5700813250442027,-10.38818493481635,-27.532671407552542,61.537376914633036,61.537376914633036],"omega_rad_s":[1.6021344227648795,-10.322289245877851,-27.546278378152234,61.542671913453503,61.542688729745251],"thrust_n":[0.032123422514333047,-1.3609741207888892,-9.6750415169024997,48.383411934540007,48.382108029825822],"torque_nm":[-0.00060231417214374463,0.025518264764791677,0.18140702844192194,-0.9071889737726252,-0.90716452555923432],"angle_rad":[-558.10590059882873,353.68632699680307,-743.58891324465901,2243.0422849762826,2243.0422556554208]},"command":[0.014953155476611454,-0.098935094617298575,-0.26221591816716705,0.58607025632983845,0.58607025632983845],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,4.3198680309969292e-21,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,8.6736173798840355e-19,4.3368086899420177e-19],"servo_effort":[0.020497705270200901,-1.4916019755131367,-0.26810511301320322,2.4243534103904758e-05,-0.00040474520393299221,0.00010930947367199489]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":831,"step":6648,"t":33.240000000000002,"sim_time":33.239999999998552,"vehicle":{"origin_ned":[1.4996654155457505,1.0006786494390378,3.4965035504131987],"origin_quat_xyzw":[-0.02134354630094755,0.053589015022903384,0.37810625820445048,0.92396338023040914],"cg_ned":[1.4388971775934256,0.94174036771766101,3.2040493971940687],"linear_velocity_ned":[0.0003283514054645743,-0.0009690944322195453,-0.0013835784945877153],"angular_velocity_ned":[-0.00013541143678240576,-0.00020544452959745613,0.0020364880023433841]},"sensors":{"Odom":[1.4996654155457505,1.0006786494390378,3.4965035504131987,-0.00029730708082753696,-0.00068003217480680782,-0.0014220418941480464,-0.021343546300947563,0.053589015022903419,0.37810625820445071,0.92396338023040914,-0.00047353235236827858,-4.93851403404679e-05,0.0019952832668109211],"Pressure":[26800.273662022191],"DVL":[0.0015112134463045315,-0.0078571221471817939,0.013192667154144234,7.3661187432739217,0.034039757037130719,-0.0085039956664338719,0.00061932717667650418,0],"IMU":[0.001090630876718829,0.11542496072230546,0.77692524845249911,0.019244221531132553,-0.029650158467404215,0.099512969236554213,1.1085469478584216,-0.0024514064731720672,-9.7436773997123769],"FOG":[0.76894894860750695],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[1.4979167668814746,-10.384198781372898,-27.532823563800182,61.54377116627699,61.54377116627699],"omega_rad_s":[1.5425070039807223,-10.318028936478916,-27.545880432919294,61.549345514290543,61.549362438628691],"thrust_n":[0.029758326120174077,-1.3599142811520544,-9.6748998684059533,48.392352957640135,48.39088557178065],"torque_nm":[-0.00055796861475326397,0.025498392771601024,0.18140437253261166,-0.90735661795575262,-0.9073291044708871],"angle_rad":[-558.04315945854353,353.27353488477041,-744.69075507800017,2245.5041445848506,2245.504115939254]},"command":[0.014265873970299757,-0.098897131251170459,-0.26221736727428746,0.58613115396454274,0.58613115396454274],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.020390167210966707,-1.4917721910894399,-0.26813817791462746,2.4138219493289902e-05,-0.00040451894120540374,0.00010928341395713564]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":832,"step":6656,"t":33.280000000000001,"sim_time":33.279999999998573,"vehicle":{"origin_ned":[1.4996715159252643,1.000646796502229,3.4964496778320724],"origin_quat_xyzw":[-0.021349767667581957,0.053585325973156669,0.37814370477021031,0.92394812560205497],"cg_ned":[1.4389105091131145,0.94170199584229608,3.2039953359980835],"linear_velocity_ned":[0.00033709594537130162,-0.00095169605546352053,-0.001326609583422739],"angular_velocity_ned":[-0.00013218712552252795,-0.00020842025248122968,0.0020408364746840164]},"sensors":{"Odom":[1.4996715159252643,1.000646796502229,3.4964496778320724,-0.0002869468892261254,-0.00067333886143535631,-0.0013631320508081155,-0.021349767667581961,0.053585325973156683,0.37814370477021042,0.92394812560205497,-0.00047382180492305716,-5.3762871313470076e-05,0.0019996320674180341],"Pressure":[26801.72821691255],"DVL":[-0.013151197790877629,0.0053525017376194898,0.0083584393602404872,7.3083819550699261,-0.012504094126737983,0.01202069614351226,-0.0055091202409769955,0],"IMU":[0.0010809443499272201,0.11542279801584078,0.77700569139743081,-0.078758667477085154,0.096684076350799411,0.01607293704945854,1.126656542811332,0.0020916312456504653,-9.7047189514639101],"FOG":[0.78699476652730316],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[1.4169959121659905,-10.381077312505438,-27.533026432186823,61.550011288111136,61.550011288111136],"omega_rad_s":[1.475950984261817,-10.314524496937146,-27.545593525749506,61.555854843563168,61.555871821131973],"thrust_n":[0.027224788269514903,-1.3590517367802235,-9.6748324636035203,48.401033781921683,48.399428933516027],"torque_nm":[-0.00051046478005340465,0.025482220064629187,0.18140310869256601,-0.90751938341103178,-0.90748929250342569],"angle_rad":[-557.98295886863082,352.86089607472167,-745.79258358086315,2247.9662673861399,2247.9662394188922]},"command":[0.013495199163485624,-0.098867402976242261,-0.26221929935416022,0.58619058369629651,0.58619058369629651],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,1.0778494253810979e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,-1.7347234759768071e-18,0,0,0],"servo_effort":[0.020278268002606251,-1.4919416356163122,-0.26817067221724,2.4024332578964083e-05,-0.00040428321520413031,0.00010924192238391948]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":833,"step":6664,"t":33.32,"sim_time":33.319999999998593,"vehicle":{"origin_ned":[1.4996779244660301,1.0006156038509737,3.496398090558571],"origin_quat_xyzw":[-0.021355946938566295,0.053581569589527207,0.37818122925011721,0.92393284213385873],"cg_ned":[1.4389241842039266,0.94166431459351918,3.2039435469620217],"linear_velocity_ned":[0.00034556412305588414,-0.00093453407509394148,-0.0012699369193262644],"angular_velocity_ned":[-0.00012865774316137742,-0.00020993944757459381,0.0020447542964950574]},"sensors":{"Odom":[1.4996779244660301,1.0006156038509737,3.496398090558571,-0.00027666465399393836,-0.00066702343077030917,-0.0013045999092606614,-0.021355946938566309,0.053581569589527242,0.37818122925011749,0.92393284213385873,-0.00047283145416212756,-5.7316384562716318e-05,0.0020036947790454244],"Pressure":[26799.644625418623],"DVL":[0.012493908559045983,0.054881633105430927,-0.029676801120865747,7.4630086592391072,0.0055414485918823036,0.0096215811375329439,-0.0068623493736100294,0],"IMU":[0.00107129431835367,0.11542047940331468,0.77708630271909029,0.048113424563742242,-0.058585873605989491,-0.064405283742384259,1.1420523252731078,-0.01749094450155431,-9.7445084076422699],"FOG":[0.78930576228382554],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[1.3256682256180332,-10.37886252491805,-27.533257412077546,61.556098253419222,61.556098253419222],"omega_rad_s":[1.4013143945660071,-10.311827921356146,-27.545394773337733,61.562201600908608,61.562218578750297],"thrust_n":[0.024517275350354039,-1.3584000603471442,-9.6748231312202364,48.409457955179491,48.407740899385963],"torque_nm":[-0.00045969891281913834,0.025470001131508956,0.18140293371037944,-0.90767733665961547,-0.90764514186348699],"angle_rad":[-557.92560155455681,352.44837913553874,-746.8944026734074,2250.4286468485852,2250.4286195606169]},"command":[0.012625411672552697,-0.098846309761124282,-0.26222149916264331,0.5862485547944688,0.5862485547944688],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,4.3368086899420177e-19],"servo_effort":[0.020161286352228063,-1.4921106216234366,-0.26820269734043567,2.3901726262287563e-05,-0.00040403834867444122,0.00010918783077875662]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":834,"step":6672,"t":33.359999999999999,"sim_time":33.359999999998614,"vehicle":{"origin_ned":[1.4996846478974675,1.0005850574100665,3.4963487735017686],"origin_quat_xyzw":[-0.021362067206281539,0.053577770239053683,0.37821882503039395,0.92391753150024902],"cg_ned":[1.438938191856582,0.94162731445489711,3.2038940177611206],"linear_velocity_ned":[0.00035375798012106852,-0.00091761116174771801,-0.0012135814708792837],"angular_velocity_ned":[-0.00012482516569047437,-0.00021004322470171135,0.0020482802081326938]},"sensors":{"Odom":[1.4996846478974675,1.0005850574100665,3.4963487735017686,-0.00026646673452526459,-0.00066107714675351281,-0.0012464648802094759,-0.021362067206281546,0.053577770239053704,0.37821882503039411,0.92391753150024902,-0.00047059559506370543,-6.0073829918379054e-05,0.0020075064657745028],"Pressure":[26801.159761004463],"DVL":[0.013375333207721852,-0.024340678461840647,0.032100001451245516,7.3088658142001455,-0.010722106739217356,0.01486081453415043,-0.017116753845210629,0],"IMU":[0.0010617299885431327,0.11541803723388021,0.77716707174588007,-0.027369502772940889,0.051718379608490878,0.044670568210406332,1.1280762371390745,0.0046754232833747782,-9.7314229482064203],"FOG":[0.7706466108472958],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[1.2216120125963437,-10.377587440457175,-27.53349620028056,61.562032798075052,61.562032798075052],"omega_rad_s":[1.3170894953817311,-10.309986185621446,-27.545261553834653,61.568387246525148,61.568404173780955],"thrust_n":[0.021631750333059245,-1.3579715318176515,-9.6748559111981791,48.417628651805416,48.415823800117742],"torque_nm":[-0.00040559531874486088,0.025461966221580968,0.18140354833496586,-0.90783053722135165,-0.90779669625220782],"angle_rad":[-557.87144400245768,352.03595066706743,-747.99621536434734,2252.8912765032069,2252.8912498933773]},"command":[0.011634400119965178,-0.098834166099592141,-0.26222377333600533,0.58630507426738143,0.58630507426738143],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,4.3368086899420177e-19],"servo_effort":[0.020038557200540964,-1.4922791309616781,-0.26823429252339354,2.3773053224957201e-05,-0.00040378566339228895,0.00010912017549168412]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":835,"step":6680,"t":33.399999999999999,"sim_time":33.399999999998634,"vehicle":{"origin_ned":[1.4996916924402917,1.0005551431924096,3.4963017108564083],"origin_quat_xyzw":[-0.021368112095777585,0.053573951530691812,0.37825648592558014,0.92390219523393313],"cg_ned":[1.4389525211280436,0.94159098582651124,3.2038467352693139],"linear_velocity_ned":[0.00036167843863306503,-0.00090092854101692923,-0.0011575623140512169],"angular_velocity_ned":[-0.00012070770024529267,-0.00020877651289275063,0.0020514188258322478]},"sensors":{"Odom":[1.4996916924402917,1.0005551431924096,3.4963017108564083,-0.00025635688144617328,-0.00065548811905440216,-0.0011887449119561404,-0.021368112095777589,0.053573951530691818,0.3782564859255802,0.92390219523393313,-0.0004671588950367548,-6.2054588540718262e-05,0.0020110666262066518],"Pressure":[26798.074985524356],"DVL":[-0.005078246075401519,0.00066079173044070541,-0.024560928713252723,7.3290541069021629,-0.034012334253027465,-0.0023041867993672479,0.014639618469237344,0],"IMU":[0.0010522990561559859,0.1154155028467683,0.77724798861946243,0.010337186393849767,-0.0062380041238415951,0.05837067336711519,1.1372393116111668,0.0024100217729802094,-9.7556929685938183],"FOG":[0.77470707254072368],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[1.1012981966643838,-10.377271392868394,-27.533727315364992,61.567815397213536,61.567815397213536],"omega_rad_s":[1.2211666307102873,-10.309039001122693,-27.545172688129096,61.574412986415311,61.574429814475153],"thrust_n":[0.018564945980284454,-1.3577765264555623,-9.6749159447093387,48.425548515213045,48.423679633829302],"torque_nm":[-0.00034809273713033359,0.025458309871041789,0.18140467396330015,-0.90797903466024477,-0.90794399313429952],"angle_rad":[-557.82091589571235,351.62357554366514,-749.0980237844401,2255.3541499336525,2255.3541239988376]},"command":[0.010488554253946512,-0.098831156122556135,-0.26222597443204754,0.58636014664012892,0.58636014664012892],"arm":{"servo_position":[2.2499312661440551e-24,3.2526065174565154e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,8.6736173798840355e-19,0,0,0,4.3368086899420177e-19],"servo_effort":[0.019895386305116617,-1.4924436670930257,-0.26826474955463581,2.3636015563170475e-05,-0.0004035237191528237,0.0001090381858276543]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":836,"step":6688,"t":33.439999999999998,"sim_time":33.439999999998655,"vehicle":{"origin_ned":[1.4996990638540453,1.0005258474946113,3.4962568861457703],"origin_quat_xyzw":[-0.021374066068358382,0.053570136495684748,0.37829420531139041,0.92388683506334401],"cg_ned":[1.4389671610721388,0.94155531910506818,3.2038016856497555],"linear_velocity_ned":[0.00036932550997650026,-0.00088448620714340332,-0.0011018966544820053],"angular_velocity_ned":[-0.00011633520232874606,-0.00020618412762790484,0.0020541483636383239]},"sensors":{"Odom":[1.4996990638540453,1.0005258474946113,3.4962568861457703,-0.00024633641164344534,-0.00065024277433338971,-0.0011314564834350206,-0.021374066068358392,0.053570136495684775,0.37829420531139057,0.92388683506334401,-0.00046257108385237643,-6.3269879594165875e-05,0.0020143475837958889],"Pressure":[26798.694108915301],"DVL":[0.013029929338246525,0.030609346215791946,0.039845194325889038,7.3245354789695361,0.0015926016308519199,0.0076686557420262745,-0.021035635371395352,0],"IMU":[0.0010430471704747563,0.11541290713743073,0.77732904240034395,0.037978000974636904,-0.032339440466383582,0.035084370021634476,1.1315500573997559,-0.0042935431580941145,-9.7638691162310192],"FOG":[0.78810685347395737],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[0.9587851192596426,-10.377857359057794,-27.533970655563596,61.573446160505625,61.573446160505625],"omega_rad_s":[1.110323213718599,-10.309000324023863,-27.545117482976266,61.580279739927967,61.580296422244729],"thrust_n":[0.015312427329145055,-1.3578186462915325,-9.6749958462990566,48.433219537343902,48.431310085681254],"torque_nm":[-0.00028710801242146973,0.025459099617966236,0.18140617211810731,-0.90812286632519812,-0.90808706410652351],"angle_rad":[-557.77455483286849,351.2112175765111,-750.19982942579793,2257.8172607653928,2257.8172355005713]},"command":[0.0091312868500918343,-0.098836736752931365,-0.26222829195774855,0.58641377295719643,0.58641377295719643],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.019736404257467623,-1.4926049995903434,-0.26829425320105299,2.3493007706230602e-05,-0.00040325429686667607,0.00010894344474818296]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":837,"step":6696,"t":33.480000000000004,"sim_time":33.479999999998675,"vehicle":{"origin_ned":[1.4997067673048432,1.0004971568213139,3.4962142822855999],"origin_quat_xyzw":[-0.021379914350037988,0.053566347312522113,0.37833197679650232,0.92387145265520021],"cg_ned":[1.4389821008086148,0.94152030463819125,3.2037588543710047],"linear_velocity_ned":[0.00037670161808233841,-0.00086828590931102036,-0.0010466016982965836],"angular_velocity_ned":[-0.00011172160279898955,-0.00020232521618079142,0.0020565025462367385]},"sensors":{"Odom":[1.4997067673048432,1.0004971568213139,3.4962142822855999,-0.00023641255166630392,-0.00064532614702602123,-0.001074614940530106,-0.021379914350038005,0.053566347312522168,0.37833197679650271,0.92387145265520021,-0.00045688699670960438,-6.3752236267173031e-05,0.0020173769744203447],"Pressure":[26797.437600924673],"DVL":[-0.0020076441870097751,0.018401012300182634,-0.0070684960687225368,7.3817151639312968,-0.0200288639533742,-0.020663684596796919,-0.017929756544132366,0],"IMU":[0.0010340179413913077,0.11541027999293683,0.77741022250889336,-0.0098910406628711055,0.14598426016903215,-0.064380245766168714,1.1338965821960365,-0.017162557265034441,-9.727589895371457],"FOG":[0.77638688881298656],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[0.78224573019168619,-10.379342062744675,-27.53421970386065,61.578925029799962,61.578925029799962],"omega_rad_s":[0.97892570340838481,-10.309871520272321,-27.545089785055417,61.585988153109213,61.586004645212356],"thrust_n":[0.011861637178648632,-1.3580983128730124,-9.6750912778887557,48.440643551941122,48.438716054904191],"torque_nm":[-0.00022240569709966191,0.025464343366368984,0.18140796146041419,-0.90826206659889619,-0.90822592602945362],"angle_rad":[-557.73307717626665,350.79884040925589,-751.30163350528926,2260.2806026542903,2260.2805780526246]},"command":[0.0074499593351589162,-0.098850876788044523,-0.2622306638462919,0.58646595266476154,0.58646595266476154],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,4.3368086899420177e-19],"servo_effort":[0.019571844967405716,-1.4927654462185989,-0.26832335297225102,2.3343944573898946e-05,-0.00040297781528062377,0.00010883683157928715]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":838,"step":6704,"t":33.520000000000003,"sim_time":33.519999999998696,"vehicle":{"origin_ned":[1.4997148072334239,1.0004690579004771,3.4961738816486037],"origin_quat_xyzw":[-0.021385642978442664,0.053562605113853162,0.37836979454349379,0.92385604949306366],"cg_ned":[1.4389973295393392,0.94148593272337289,3.2037182262441863],"linear_velocity_ned":[0.00038380827284932492,-0.00085232827463660704,-0.00099169341467951542],"angular_velocity_ned":[-0.00010688500696831316,-0.0001972646937303758,0.0020585123401725249]},"sensors":{"Odom":[1.4997148072334239,1.0004690579004771,3.4961738816486037,-0.00022659289988357343,-0.00064071999386242529,-0.0010182343272979889,-0.021385642978442677,0.053562605113853197,0.37836979454349406,0.92385604949306366,-0.00045016813308959818,-6.3535366680000281e-05,0.0020201788851191334],"Pressure":[26799.121456475346],"DVL":[0.020349412052583539,0.011482483101608357,-0.018432632320175474,7.2505499436490917,0.00084306495643193759,0.035661821197732133,-0.016744401570967484,0],"IMU":[0.0010252527446925244,0.11540764996969273,0.77749151940115624,0.028440111691571655,0.056191565640601009,0.062861809142965061,1.1321163539666477,0.00053120553201356849,-9.7541808799421048],"FOG":[0.7904150074269557],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[0.53967043720750885,-10.381738924755975,-27.534458767472724,61.584251617710031,61.584251617710031],"omega_rad_s":[0.81438791685393064,-10.311658293118581,-27.545079994330258,61.591538594442767,61.591554854166858],"thrust_n":[0.0081602285196768071,-1.358617154877743,-9.6751954783388943,48.447821961627717,48.445897925903559],"torque_nm":[-0.00015300428474394011,0.025474071653957681,0.18140991521885427,-0.9083966617805197,-0.90836058611069204],"angle_rad":[-557.69756207771536,350.38640752325125,-752.4034369107801,2262.7441692758307,2262.7441453287556]},"command":[0.0051397184495953225,-0.098873704045294997,-0.26223294064259739,0.58651668207342889,0.58651668207342889],"arm":{"servo_position":[2.2499312661440551e-24,3.2526065174565154e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,-4.3368086899420177e-19],"servo_effort":[0.019402071580365124,-1.49292492436341,-0.2683521078362584,2.318848436271595e-05,-0.00040269642771030155,0.00010871954412033405]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":839,"step":6712,"t":33.560000000000002,"sim_time":33.559999999998716,"vehicle":{"origin_ned":[1.4997231871304273,1.0004415378814762,3.4961356661117664],"origin_quat_xyzw":[-0.021391238810755112,0.053558929946373485,0.37840765319034586,0.9238406269114362],"cg_ned":[1.4390128363392189,0.94145219381902312,3.2036797854646046],"linear_velocity_ned":[0.00039063342019215807,-0.00083660025964636252,-0.00093718670878316986],"angular_velocity_ned":[-0.00010183559998618751,-0.00019106313311045156,0.0020602023766316314]},"sensors":{"Odom":[1.4997231871304273,1.0004415378814762,3.4961356661117664,-0.00021688599960288933,-0.00063638987585374316,-0.00096232753963945694,-0.021391238810755123,0.053558929946373519,0.37840765319034608,0.9238406269114362,-0.00044246663803119805,-6.2655432982139538e-05,0.0020227721112088589],"Pressure":[26797.083632080063],"DVL":[0.020829632843707906,0.01047606311721754,0.015713226929745097,7.4307414904701776,0.016090189773408779,-0.061452173635718345,0.022927580593176167,0],"IMU":[0.0010167906665311487,0.11540504422568024,0.77757292439426107,-0.01735116725735969,-0.016042261151187651,0.065063432038831484,1.1286892048275623,-0.01999663065736584,-9.7494761520021243],"FOG":[0.77833612292828114],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-0.20502391972632347,-10.385054843576532,-27.534673429410855,61.589425367494776,61.589425367494776],"omega_rad_s":[0.51627164413528848,-10.314367268604693,-27.545076588896247,61.596931170846297,61.596947158498686],"thrust_n":[0.0032103130579293742,-1.3593771021821845,-9.675300350752444,48.454755760276505,48.452855609327344],"torque_nm":[-6.0193369836175768e-05,0.02548832066591596,0.18141188157660831,-0.90852667050518465,-0.90849104267488756],"angle_rad":[-557.67093298150678,349.9738821425936,-753.50524009918718,2265.2079543141967,2265.207931011515]},"command":[-0.0019526087592983187,-0.098905284224538398,-0.26223498504200815,0.58656595588090266,0.58656595588090266],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.019234589786573272,-1.4930839630940975,-0.26838068781816998,2.302995411988975e-05,-0.00040241043115839584,0.00010859246278642689]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":840,"step":6720,"t":33.600000000000001,"sim_time":33.599999999998737,"vehicle":{"origin_ned":[1.4997319090773507,1.0004145847818176,3.4960996171040524],"origin_quat_xyzw":[-0.021396689348831849,0.053555340802315853,0.37844554774723232,0.92382518614008058],"cg_ned":[1.4390286096297729,0.94141907909104894,3.2036435156534497],"linear_velocity_ned":[0.00039718088635192265,-0.00082110458111052853,-0.00088309538870732997],"angular_velocity_ned":[-9.6603043515975149e-05,-0.00018379766822149317,0.0020615987037481344]},"sensors":{"Odom":[1.4997319090773507,1.0004145847818176,3.4960996171040524,-0.00020729970426393572,-0.00063231613451940815,-0.00090690641983249437,-0.021396689348831863,0.05355534080231588,0.37844554774723255,0.92382518614008058,-0.00043386015615123202,-6.1146723348261023e-05,0.0020251739158117753],"Pressure":[26795.507061657747],"DVL":[-0.016622294706763598,0.017209177119357939,-0.016023091787594194,7.4697024097746354,0.022497320385413137,-0.022151009945333106,0.0089340286158766918,0],"IMU":[0.0010086688393926239,0.11540248844662085,0.77765442946086849,-0.011424423829201091,-0.038668097193994451,-0.051931993443148111,1.1275020855279021,-0.01916658885300361,-9.7451594577686045],"FOG":[0.78304230370330896],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-0.6212351328480743,-10.389286519773687,-27.534851678165328,61.594445483910789,61.594445483910789],"omega_rad_s":[0.11253650692168519,-10.318002479128296,-27.545067455467226,61.602165732868116,61.602181411375057],"thrust_n":[0.00012023688364274653,-1.3603794634307564,-9.6753973956045503,48.461445513419079,48.459588582119252],"torque_nm":[-2.2544415683014975e-06,0.025507114939326687,0.18141370116758535,-0.90865210337660762,-0.90861728591473612],"angle_rad":[-557.65955719283238,349.56122727758247,-754.60704304975854,2267.671951451955,2267.6719287819406]},"command":[-0.0059165250747435644,-0.098945585902606548,-0.26223668264919359,0.58661376651343611,0.58661376651343611],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.019046189843020166,-1.4932399592725374,-0.2684086135438366,2.2865459605557018e-05,-0.00040212048435857382,0.00010845648051502868]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":841,"step":6728,"t":33.640000000000001,"sim_time":33.639999999998757,"vehicle":{"origin_ned":[1.4997409764615675,1.0003881849028329,3.4960657156339203],"origin_quat_xyzw":[-0.021401984868593911,0.053551854981553411,0.37848347385796982,0.92380972818439322],"cg_ned":[1.4390446407521902,0.94138657677569781,3.203609399919789],"linear_velocity_ned":[0.0004035562152725485,-0.00080594765958876794,-0.00082943157567825197],"angular_velocity_ned":[-9.1312664177858622e-05,-0.00017562215831920953,0.0020627517085657393]},"sensors":{"Odom":[1.4997409764615675,1.0003881849028329,3.4960657156339203,-0.00019783861066752033,-0.00062858661607736825,-0.0008519816266955246,-0.021401984868593921,0.053551854981553432,0.37848347385796999,0.92380972818439322,-0.0004245503292440367,-5.9031046965855905e-05,0.0020274116774241313],"Pressure":[26797.400629622829],"DVL":[0.0086730871918319474,0.016693756845992228,0.0062188081938021741,7.3055528947289456,-0.013118681791115347,-8.4367600111688282e-06,-0.026844885255893979,0],"IMU":[0.0010009180284589593,0.11540000728096891,0.77773602755003979,0.0076831505575216527,0.014596576975813274,0.039334355838815935,1.1322592799094287,-0.0011911803070850397,-9.7030269778350604],"FOG":[0.7731315821816388],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-0.86202440866823904,-10.394447759080494,-27.534978569904673,61.599310949145178,61.599310949145178],"omega_rad_s":[-0.24914323283243137,-10.32256920308523,-27.545039666991407,61.607241885227381,61.607257220051522],"thrust_n":[-0.00088312872818117037,-1.361625948057557,-9.6754774856165415,48.467891166195713,48.466096126174421],"torque_nm":[1.6558663653396946e-05,0.025530486526079192,0.18141520285531018,-0.90877295936616997,-0.9087393023657705],"angle_rad":[-557.6634295738512,349.14840577455726,-755.70884524282701,2270.1361543601024,2270.1361323096057]},"command":[-0.0082097562730308483,-0.098994740562671366,-0.26223789114194929,0.58666010427757309,0.58666010427757309],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,-4.3368086899420177e-19],"servo_effort":[0.018835233863457038,-1.4933924163287073,-0.26843583434274554,2.2700651535878034e-05,-0.00040182768028679906,0.00010831200088638987]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":842,"step":6736,"t":33.68,"sim_time":33.679999999998778,"vehicle":{"origin_ned":[1.4997503930154206,1.0003623237441996,3.49603394234612],"origin_quat_xyzw":[-0.021407117725275187,0.053548488292485708,0.3785214276663369,0.92379425388433956],"cg_ned":[1.4390609227257585,0.94135467344464663,3.2035774209052348],"linear_velocity_ned":[0.00040973567234997826,-0.00079110420358484835,-0.00077620676156714408],"angular_velocity_ned":[-8.5971021826317643e-05,-0.00016659602865314632,0.0020636772883976372]},"sensors":{"Odom":[1.4997503930154206,1.0003623237441996,3.49603394234612,-0.00018851194036324348,-0.00062515164317489041,-0.00079756258497876555,-0.021407117725275201,0.053548488292485742,0.37852142766633712,0.92379425388433956,-0.00041458495387734984,-5.6346239007737781e-05,0.0020294959032659526],"Pressure":[26796.161929533322],"DVL":[0.0092503308004596805,-0.0035222186338340722,-0.0003140031282818646,7.2912107939576272,0.021013990610254191,0.022192647282935414,-0.013487025458255546,0],"IMU":[0.00099356405975210621,0.11539762418603483,0.77781771237718134,-0.020405932248046901,-0.006539514218177233,-0.051647656206489791,1.127199408607978,-0.016418409056183976,-9.7242055960847722],"FOG":[0.79405674220713762],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-1.0560506801177048,-10.400546157494087,-27.535040131382392,61.604020457409106,61.604020457409106],"omega_rad_s":[-0.56190525993642615,-10.328075275904187,-27.544979394069323,61.612158974034834,61.61217393306211],"thrust_n":[-0.004233063873878686,-1.3631189960641725,-9.6755309208365361,48.474092425829866,48.472376863851579],"torque_nm":[7.9369947635225355e-05,0.025558481176203234,0.18141620476568504,-0.90888923298431012,-0.90885706619721707],"angle_rad":[-557.68064544508275,348.73538018395965,-756.81064561601352,2272.6005566880094,2272.6005352425532]},"command":[-0.010057625524930522,-0.099052820547562745,-0.26223847744173706,0.58670495673722955,0.58670495673722955],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,-8.6736173798840355e-19,0,0,0,4.3368086899420177e-19],"servo_effort":[0.01863520636427806,-1.4935444447507102,-0.26846308051924095,2.2532238781259939e-05,-0.00040153315728124378,0.00010816069296831952]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":843,"step":6744,"t":33.719999999999999,"sim_time":33.719999999998798,"vehicle":{"origin_ned":[1.4997601598220391,1.0003369888647429,3.4960042775766476],"origin_quat_xyzw":[-0.021412080214833724,0.053545255682073661,0.37855940543767058,0.92377876408233817],"cg_ned":[1.4390774463860574,0.94132335793806299,3.2035475608028432],"linear_velocity_ned":[0.00041566493923101994,-0.00077651778154256505,-0.00072343174411456409],"angular_velocity_ned":[-8.0561212367332802e-05,-0.00015675961521997571,0.0020643807654365876]},"sensors":{"Odom":[1.4997601598220391,1.0003369888647429,3.4960042775766476,-0.00017932978529754248,-0.00062192758406943158,-0.00074365792660735714,-0.021412080214833727,0.053545255682073675,0.37855940543767064,0.92377876408233817,-0.0004039807059735167,-5.3132995713310732e-05,0.0020314300639141464],"Pressure":[26796.867958098701],"DVL":[0.0066472249940950565,0.017741016332683102,-0.0036119103658259809,7.3776072200575351,0.012779382348308988,0.013652338017163777,-0.019162469459560967,0],"IMU":[0.00098663222964732035,0.11539536097265055,0.77789947784962732,0.11312679504365092,-0.05091667470029191,-0.1270871373326812,1.1324784147576412,-0.021344386537020296,-9.7447467523254385],"FOG":[0.77584085354402454],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-1.2242214482253602,-10.407560890319177,-27.535027967416536,61.608572555848504,61.608572555848504],"omega_rad_s":[-0.83149774648006713,-10.33452040359326,-27.544874053343506,61.616916099857498,61.61693065357354],"thrust_n":[-0.0091224888609890732,-1.3648589633269892,-9.6755489128798651,48.4800486748045,48.478428921018832],"torque_nm":[0.00017104666614354514,0.025591105562381047,0.18141654211649746,-0.90900091265258443,-0.90897054226910301],"angle_rad":[-557.7093691808243,348.32211291498669,-757.91244257866856,2275.0651520531173,2275.0651311969959]},"command":[-0.011659251887860572,-0.099119627526849302,-0.26223836159444319,0.58674831005570005,0.58674831005570005],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,-4.3368086899420177e-19],"servo_effort":[0.018440378214436365,-1.4936950978686021,-0.26849023256777715,2.2359096671682439e-05,-0.00040123830234824344,0.00010800410847092546]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":844,"step":6752,"t":33.759999999999998,"sim_time":33.759999999998819,"vehicle":{"origin_ned":[1.499770275784079,1.0003121694331341,3.4959767013873249],"origin_quat_xyzw":[-0.021416865056158123,0.053542171090093099,0.3785974035776819,0.92376325961274475],"cg_ned":[1.4390942010445771,0.94129262068148678,3.2035198013993518],"linear_velocity_ned":[0.00042131683869294623,-0.00076216020544744368,-0.00067111629644131131],"angular_velocity_ned":[-7.5095083520219263e-05,-0.00014617675739987901,0.0020648731681644607]},"sensors":{"Odom":[1.499770275784079,1.0003121694331341,3.4959767013873249,-0.00017030178826350897,-0.00061885866798270074,-0.0006902754437309043,-0.021416865056158134,0.053542171090093127,0.37859740357768212,0.92376325961274475,-0.00039279165898476549,-4.9428573011550218e-05,0.0020332190352690548],"Pressure":[26794.6622886283],"DVL":[-0.027521745097121065,0.013771892814523236,0.019477754582699094,7.3300483036930899,-0.0033175909819809393,0.0046881246128698912,-0.00030693309377685316,0],"IMU":[0.00098014629909239418,0.1153932379014715,0.77798131805153248,-0.039049029917616308,0.0013738363696408828,0.14932662708004249,1.1305263882422774,-0.011910035222984221,-9.7630961144938126],"FOG":[0.7901332451645634],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-1.375015099829249,-10.415471657042234,-27.53493371768036,61.612965567656083,61.612965567656083],"omega_rad_s":[-1.0653367441935229,-10.34189714725451,-27.544712339562885,61.62151213499061,61.621526256565019],"thrust_n":[-0.014864134947215118,-1.3668443826791052,-9.6755235575784777,48.485758861237237,48.484250098587545],"torque_nm":[0.00027870253026028347,0.025628332175233227,0.18141606670459642,-0.90910797864819826,-0.90907968934851668],"angle_rad":[-557.7480430968227,347.90856656160844,-759.01423406805191,2277.5299340317142,2277.529913748102]},"command":[-0.013095381903135705,-0.099194968162306996,-0.2622374639779082,0.58679014826339126,0.58679014826339126],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,-4.3368086899420177e-19],"servo_effort":[0.018246067244683164,-1.4938435791244185,-0.26851720556445069,2.2185480395579797e-05,-0.00040094435438627854,0.00010784345101490903]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":845,"step":6760,"t":33.799999999999997,"sim_time":33.799999999998839,"vehicle":{"origin_ned":[1.4997807382570845,1.0002878556190919,3.4959511935905709],"origin_quat_xyzw":[-0.021421465957095143,0.053539247288997595,0.37863541866992206,0.92374774128255888],"cg_ned":[1.4391111753418386,0.94126245279855747,3.2034941241106836],"linear_velocity_ned":[0.00042668157699446462,-0.00074802107704518,-0.00061926922798993128],"angular_velocity_ned":[-6.9603443398457359e-05,-0.00013492541489971738,0.002065168140386397]},"sensors":{"Odom":[1.4997807382570845,1.0002878556190919,3.4959511935905709,-0.00016143682015076386,-0.00061590691764995791,-0.00063742211748200493,-0.02142146595709515,0.053539247288997609,0.37863541866992217,0.92374774128255888,-0.00038109545691268349,-4.5266964560376751e-05,0.0020348675901949486],"Pressure":[26796.374633411699],"DVL":[-0.013956970809395047,-0.016693394177426043,-0.0074043507952317672,7.3617308930901553,0.033844311692521993,-0.02186448221618667,0.013837694999986511,0],"IMU":[0.00097412732337519303,0.11539127381652396,0.77806322726052912,0.043805530115895316,-0.031422208187032542,-0.050569395807252199,1.1200110666229883,-0.0052920159732345344,-9.7808123136073775],"FOG":[0.77558455895092693],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-1.5130042507251908,-10.424258735994009,-27.534748872641298,61.6171977460478,61.6171977460478],"omega_rad_s":[-1.2702452789016094,-10.350193644012462,-27.544483688273115,61.625945760336514,61.625959425595575],"thrust_n":[-0.021041107885153804,-1.3690726749922801,-9.675447464818026,48.491221565022258,48.489837929042473],"torque_nm":[0.0003945207728466339,0.025670112656105255,0.18141463996533802,-0.90921040434416733,-0.90918446116954632],"angle_rad":[-557.79539516021282,347.49470412081757,-760.11601758664324,2279.994896150507,2279.994876421566]},"command":[-0.014409564292620865,-0.099278654628514373,-0.26223570354896475,0.58683045472426476,0.58683045472426476],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,-8.6736173798840355e-19,0],"servo_effort":[0.018049444798688256,-1.4939891521283166,-0.26854391275110995,2.2006496480102163e-05,-0.00038734624360139708,0.00010767975281515186]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":846,"step":6768,"t":33.840000000000003,"sim_time":33.839999999998859,"vehicle":{"origin_ned":[1.4997915434454427,1.0002640382273422,3.4959277337907135],"origin_quat_xyzw":[-0.021425877960622182,0.053536495796992815,0.37867344750097387,0.9237322098579881],"cg_ned":[1.4391283577720888,0.94123284557208475,3.2034705100316225],"linear_velocity_ned":[0.00043175932340199175,-0.00073410059905716803,-0.00056789800394006871],"angular_velocity_ned":[-6.4128089774847028e-05,-0.00012309144755839993,0.0020652817088691812]},"sensors":{"Odom":[1.4997915434454427,1.0002640382273422,3.4959277337907135,-0.0001527436173193617,-0.00061304477775132957,-0.00058510372431127763,-0.021425877960622189,0.053536495796992843,0.37867344750097404,0.9237322098579881,-0.00036898331002690457,-4.0680057665591307e-05,0.0020363813255821501],"Pressure":[26795.87259216528],"DVL":[-0.028670891655423962,-0.030092882266495258,0.011955403451967861,7.274098796564993,-0.0278816969929696,0.04942912552876208,-0.0026079822403697003,0],"IMU":[0.00096859294505503716,0.11538948624768698,0.77814519996392217,0.045421034302095431,0.088055216715842335,-0.06816030020658953,1.1192579625138568,-0.021965711574457265,-9.7426202903162569],"FOG":[0.78383190991318763],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-1.6410168407894756,-10.433903373044091,-27.534464934765225,61.621267063765963,61.621267063765963],"omega_rad_s":[-1.4519282449109849,-10.359395304383172,-27.544178087477945,61.630215452139936,61.630228639476954],"thrust_n":[-0.027412709258295243,-1.3715405920619457,-9.6753136239261561,48.496434980302588,48.495189626503482],"torque_nm":[0.00051398829859303588,0.025716386101161483,0.18141213044861543,-0.9093081558806736,-0.90928480549694024],"angle_rad":[-557.85040116515006,347.08048913009526,-761.21779022787155,2282.4600318789235,2282.4600126859068]},"command":[-0.015628731817042624,-0.099370508314705619,-0.26223299937871641,0.58686921013110438,0.58686921013110438],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.017849473902785858,-1.4941312878876334,-0.26857031007308668,2.1828208851706974e-05,-0.00040036254541640196,0.00010751376785404506]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":847,"step":6776,"t":33.880000000000003,"sim_time":33.87999999999888,"vehicle":{"origin_ned":[1.4998026866772887,1.000240708541303,3.4959063014076208],"origin_quat_xyzw":[-0.021430097707370071,0.05353392695147615,0.37871148669106885,0.92371666620541537],"cg_ned":[1.4391457369407237,0.94120379016640099,3.2034489399877586],"linear_velocity_ned":[0.00043655423858988967,-0.00072040309829030265,-0.00051700866468028695],"angular_velocity_ned":[-5.8729746941136993e-05,-0.00011075831179756251,0.0020651876589027622]},"sensors":{"Odom":[1.4998026866772887,1.000240708541303,3.4959063014076208,-0.00014422664951047764,-0.00061025055109005326,-0.00053332538258830638,-0.021430097707370088,0.053533926951476192,0.37871148669106919,0.92371666620541537,-0.00035655328651508869,-3.5684761811182956e-05,0.0020377225044009447],"Pressure":[26794.934594125523],"DVL":[0.0091298785950521457,0.029433758439676567,0.0090712112197432592,7.3377542976291661,0.048530425742412779,-0.030288868165025688,-0.001554262428585203,0],"IMU":[0.00096355691560150278,0.11538789174743683,0.77822723003948502,-0.039309613273040646,-0.073072124826364243,0.07045255632018721,1.1378541069031038,0.0028216217222319512,-9.7135268103460852],"FOG":[0.76671156990255662],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-1.7609425372173322,-10.444370127607421,-27.534081076189882,61.62517132925894,61.62517132925894],"omega_rad_s":[-1.6149633125575509,-10.369482716937634,-27.543787246332105,61.634319471892773,61.634332162079708],"thrust_n":[-0.033846041701731035,-1.3742436079496461,-9.675116332376108,48.50139675677552,48.500302255338774],"torque_nm":[0.00063461328190745714,0.025767067649055862,0.18140843123205205,-0.90940118918954105,-0.90938066728760203],"angle_rad":[-557.91223913771239,346.66588579054365,-762.31954870921243,2284.9253346204077,2284.925315943759]},"command":[-0.016770881306831735,-0.099470191691499246,-0.26222934358276079,0.58690639361198993,0.58690639361198993],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,-8.6736173798840355e-19,0,0,0,0],"servo_effort":[0.017629283882643128,-1.4942661233213517,-0.26859561583151775,2.1647339676314384e-05,-0.00040007504873289024,0.00010734579132045615]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":848,"step":6784,"t":33.920000000000002,"sim_time":33.9199999999989,"vehicle":{"origin_ned":[1.499814162575557,1.0002178582156842,3.4958868757116695],"origin_quat_xyzw":[-0.021434123535753215,0.053531549964688653,0.37874953244540732,0.92370111138777855],"cg_ned":[1.4391633017027774,0.94117527747894514,3.2034293945856884],"linear_velocity_ned":[0.00044107440006537103,-0.00070693729444553765,-0.00046660638448565452],"angular_velocity_ned":[-5.3460274656531615e-05,-9.8013913053585983e-05,0.0020648891099797118]},"sensors":{"Odom":[1.499814162575557,1.0002178582156842,3.4958868757116695,-0.00013589358004545377,-0.00060750686220088432,-0.00048209091169435972,-0.021434123535753226,0.053531549964688681,0.37874953244540749,0.92370111138777855,-0.00034390366809106305,-3.0307324378065779e-05,0.0020388829043850921],"Pressure":[26795.903243264089],"DVL":[0.0077709965118486247,-0.0045675248150259928,-0.012841720942585452,7.2933209339994605,-0.016649117615640689,-0.0043979883419842363,0.01572563035353873,0],"IMU":[0.0009590289204826041,0.11538650607116202,0.77830931021131822,-0.0017770501998964849,-0.008164079676605724,0.012279403857727009,1.1368502039087944,-0.033200012350146732,-9.7428294387702348],"FOG":[0.76406666243396248],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-1.8741179444057376,-10.455587586713699,-27.533612897228327,61.628908136641435,61.628908136641435],"omega_rad_s":[-1.7629497997385355,-10.380418633829654,-27.543310825522884,61.638255879555899,61.63826805542449],"thrust_n":[-0.040271512275529525,-1.3771725247593178,-9.6748554300704832,48.50610426421143,48.505172454606367],"torque_nm":[0.00075509085516617868,0.02582198483923721,0.18140353931382158,-0.90948945495396449,-0.90947198352386949],"angle_rad":[-557.98024745013117,346.25085950077187,-763.42128960528169,2287.3907977043673,2287.3907795238069]},"command":[-0.017848742327673691,-0.099577024635368563,-0.26222488473550787,0.58694198225372796,0.58694198225372796],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,-4.3368086899420177e-19],"servo_effort":[0.017405152273775933,-1.4943970438186167,-0.26862060459828002,2.1463617910243705e-05,-0.00039979197385149883,0.00010717767449063291]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":849,"step":6792,"t":33.960000000000001,"sim_time":33.959999999998921,"vehicle":{"origin_ned":[1.4998259650749712,1.0001954791029366,3.4958694358919415],"origin_quat_xyzw":[-0.021437955360232065,0.05352937276907134,0.37878758118481559,0.92368554641776168],"cg_ned":[1.4391810413004431,0.94114729800198038,3.2034118542492913],"linear_velocity_ned":[0.00044533028860399933,-0.00069371403736498893,-0.00041669536486737597],"angular_velocity_ned":[-4.8366049018566242e-05,-8.4946337055741088e-05,0.0020644061529187072]},"sensors":{"Odom":[1.4998259650749712,1.0001954791029366,3.4958694358919415,-0.00012775315545537926,-0.00060479920248138024,-0.00043140294276028786,-0.021437955360232082,0.053529372769071382,0.37878758118481592,0.92368554641776168,-0.00033113094356609446,-2.4577930447039364e-05,0.0020398715995457763],"Pressure":[26797.125894511286],"DVL":[-0.0033103948783177813,-0.016326224567188075,0.024751710141213829,7.4162900964024816,0.0081146135264358651,-0.026762417205342538,-0.039210180727095423,0],"IMU":[0.00095501476605254281,0.11538534379816889,0.77839143341707484,0.058413794407303495,0.026309362659120566,-0.15027564649748854,1.1466439797989798,-0.01900169341925095,-9.7120515988447345],"FOG":[0.79109855594518008],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-1.9815292155967372,-10.467538073758774,-27.533050566122913,61.632474645933563,61.632474645933563],"omega_rad_s":[-1.8986910480603112,-10.392168746482835,-27.542746616841722,61.642022465284661,61.642034111695985],"thrust_n":[-0.046655458969362934,-1.3803189705861019,-9.6745293730500297,48.510554504986843,48.509796305651392],"torque_nm":[0.00087478985567555488,0.025880980698489413,0.18139742574468806,-0.90957289696850319,-0.90955868073096391],"angle_rad":[-558.05388985124932,345.83537711949873,-764.52300945077479,2289.8564143766721,2289.8563966712804]},"command":[-0.018871706815207022,-0.099690838797702616,-0.26221952920117059,0.58697594900889105,0.58697594900889105],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,-6.6174449004242214e-23,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,1.7347234759768071e-18,-1.3552527156068805e-20,0,0],"servo_effort":[0.017177713089486249,-1.4945240388016274,-0.2686453318129679,2.1278121478724807e-05,-0.00039951438281931516,0.00010701075126727848]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":850,"step":6800,"t":34,"sim_time":33.999999999998941,"vehicle":{"origin_ned":[1.499838087472487,1.0001735631304562,3.4958539610864494],"origin_quat_xyzw":[-0.021441594552545223,0.053527401981215569,0.37882562961612742,0.92366997223365988],"cg_ned":[1.4391989454132779,0.94111984176577668,3.2033962992368701],"linear_velocity_ned":[0.00044933305721781165,-0.00068074527206097083,-0.00036727941416443173],"angular_velocity_ned":[-4.3485389820412069e-05,-7.1643121510507173e-05,0.0020637587175536291]},"sensors":{"Odom":[1.499838087472487,1.0001735631304562,3.4958539610864494,-0.00011981603832425056,-0.00060211611459600801,-0.00038126348969751611,-0.021441594552545244,0.053527401981215618,0.37882562961612776,0.92366997223365988,-0.00031832551010818068,-1.8532008137496602e-05,0.002040698212513297],"Pressure":[26794.37578435355],"DVL":[0.027500783397435707,-0.028539213396470489,-0.0028534185243453843,7.3016759705213028,0.00087022156388556456,0.0064051661544777018,-0.020227699117576381,0],"IMU":[0.0009515165812992028,0.11538441817532506,0.77847359296839158,-0.041024746368931303,-0.091819030354267556,-0.051744568639624441,1.12815568067772,-0.0036382424358305451,-9.7661424303744635],"FOG":[0.77365762087086865],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-2.0839360842551491,-10.480203431152413,-27.532382780219752,61.63586798291594,61.63586798291594],"omega_rad_s":[-2.0243641788247095,-10.404703836884222,-27.542089415680607,61.645616781592366,61.645627885478468],"thrust_n":[-0.052983905066321391,-1.3836759377038967,-9.6741345110966819,48.514744162562494,48.514169426251051],"torque_nm":[0.00099344821999352607,0.025943923831948067,0.18139002208306279,-0.90965145304804684,-0.90964067674220717],"angle_rad":[-558.13272754259208,345.41940675350878,-765.62470462246904,2292.3221777890476,2292.3221605373451]},"command":[-0.019847010326239516,-0.099811461249070602,-0.26221316933542621,0.58700826650396132,0.58700826650396132],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.016947446142178049,-1.494648044070725,-0.26867005461549498,2.1091875262178244e-05,-0.00039924363349216397,0.00010684590729724966]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":851,"step":6808,"t":34.039999999999999,"sim_time":34.039999999998962,"vehicle":{"origin_ned":[1.4998505224762599,1.0001521022736575,3.4958404304472852],"origin_quat_xyzw":[-0.021445043905007677,0.053525642952926819,0.37886367475306315,0.92365438968858538],"cg_ned":[1.4392170041733796,0.94109289831848764,3.2033827097121113],"linear_velocity_ned":[0.00045309430291378625,-0.00066804316539402411,-0.00031835986683753355],"angular_velocity_ned":[-3.8862480926310652e-05,-5.8186508231119111e-05,0.0020629682968264285]},"sensors":{"Odom":[1.4998505224762599,1.0001521022736575,3.4958404304472852,-0.00011209064918718759,-0.00059944634016579961,-0.00033167249247010444,-0.021445043905007687,0.05352564295292684,0.37886367475306332,0.92365438968858538,-0.00030557840641306871,-1.2197074203721115e-05,0.0020413738571828854],"Pressure":[26795.515025371187],"DVL":[-0.0057339048392844342,-0.0020056969249839214,0.0025403016418152503,7.32493748578006,-0.005380144392644547,-0.0065695246579163544,-0.00080202661445337832,0],"IMU":[0.00094853292749893538,0.1153837411845606,0.77855578260420244,-0.0080426698897938902,0.15405272224990904,0.10254018840078312,1.1214105453462093,-0.013046717025996392,-9.7119352677898849],"FOG":[0.76188690258827141],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-2.1819294562313671,-10.493566761022892,-27.531597032506244,61.639084723118316,61.639084723118316],"omega_rad_s":[-2.1416614052530005,-10.417997978819743,-27.541331504835711,61.649036099459451,61.649046649855379],"thrust_n":[-0.059253116530167835,-1.3872373031004184,-9.6736654162018461,48.518669335368216,48.518287033811504],"torque_nm":[0.0011109959349406469,0.026010699433132847,0.18138122655378464,-0.90972505003815407,-0.90971788188396607],"angle_rad":[-558.21639745538437,345.0029176047222,-766.72637122984884,2294.7880809894018,2294.7880641694337]},"command":[-0.020780280535536828,-0.099938731057360883,-0.26220568602386901,0.58703890212493637,0.58703890212493637],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.016716176274152131,-1.4947671965078051,-0.26869440183665616,2.0904414312806934e-05,-0.00039897978537230836,0.00010668419859231228]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":852,"step":6816,"t":34.079999999999998,"sim_time":34.079999999998982,"vehicle":{"origin_ned":[1.499863262294036,1.0001310885891146,3.4958288231946195],"origin_quat_xyzw":[-0.021448307671611377,0.053524099904284458,0.37890171392294508,0.92363879953892947],"cg_ned":[1.4392352081918542,0.9410664567066932,3.2033710658217056],"linear_velocity_ned":[0.00045662608711262063,-0.00065562042070464331,-0.00026993634039608965],"angular_velocity_ned":[-3.4542285991343409e-05,-4.4653844369337817e-05,0.002062056648651184]},"sensors":{"Odom":[1.499863262294036,1.0001310885891146,3.4958288231946195,-0.00010458444248007409,-0.00059678014644215353,-0.00028262839888320537,-0.021448307671611381,0.053524099904284472,0.37890171392294519,0.92363879953892947,-0.00029297784523989818,-5.59659099517887e-06,0.0020419102374866632],"Pressure":[26796.869311790131],"DVL":[-0.0051618896361477588,0.0056600953649378633,0.008671585604339907,7.3140969748132676,-0.016149485363542326,0.010062047216274017,0.0014993720062890159,0],"IMU":[0.00094605882428180411,0.11538332382148617,0.77863799651362875,-0.047603913864936967,0.0027748020514059739,0.057345618985132504,1.1271973838922262,-0.0051119440067750712,-9.7116809739854961],"FOG":[0.77521431075905478],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-2.2759769515530976,-10.50761522290828,-27.530681961275938,61.64212099666598,61.64212099666598],"omega_rad_s":[-2.2518991940137276,-10.432029045534939,-27.540463728805367,61.652277316287417,61.652287304192576],"thrust_n":[-0.065464053922573165,-1.3909979631570277,-9.6731156420474456,48.522325419166648,48.522143800341354],"torque_nm":[0.001227451011048247,0.026081211809194274,0.18137091828838961,-0.90979360160937472,-0.90979019625640045],"angle_rad":[-558.30459538618948,344.58587982401127,-767.82800503843384,2297.2541169079436,2297.2541004973618]},"command":[-0.021675970967172359,-0.10007252593245981,-0.26219697105977086,0.58706781901586647,0.58706781901586647],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,1.0778494253810979e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,-1.7347234759768071e-18,0,0,0],"servo_effort":[0.016483986386374716,-1.4948813471248632,-0.2687183754203063,2.0717961706702533e-05,-0.00039872408512979963,0.00010652651048668025]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":853,"step":6824,"t":34.119999999999997,"sim_time":34.119999999999003,"vehicle":{"origin_ned":[1.4998762986947713,1.0001105141920283,3.4958191187006715],"origin_quat_xyzw":[-0.02145139148990028,0.053522775995042855,0.37893974479385845,0.92362320243078389],"cg_ned":[1.4392535485668143,0.94104050547717066,3.2033613477856777],"linear_velocity_ned":[0.00045994076102185181,-0.00064348944627199767,-0.0002220058640560482],"angular_velocity_ned":[-3.0566501213427822e-05,-3.111736543587261e-05,0.0020610469009034824]},"sensors":{"Odom":[1.4998762986947713,1.0001105141920283,3.4958191187006715,-9.7304356776429311e-05,-0.00059410940572202076,-0.00023412711178172137,-0.021451391489900291,0.053522775995042876,0.37893974479385867,0.92362320243078389,-0.0002806063260265497,1.2473459672241388e-06,0.0020423210969565662],"Pressure":[26795.265011263651],"DVL":[-0.039024655375183001,0.010945252577877311,-0.064601077839653687,7.3283980674675044,0.0034441447382308568,-0.022126150812854756,0.046089155462952114,0],"IMU":[0.00094408595270414181,0.11538317616904142,0.77872022940843022,-0.003529290741149885,-0.016014955500531884,0.035356443059752503,1.1231644834940602,-0.006599676091440753,-9.7001236157618997],"FOG":[0.78154133938999504],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-2.3664616570678279,-10.522338977627983,-27.529625020869691,61.644972218155146,61.644972218155146],"omega_rad_s":[-2.3561081779437192,-10.446778380378387,-27.539475743596288,61.655336873389075,61.655346291613981],"thrust_n":[-0.07161953183588024,-1.3949537523925843,-9.672477901456686,48.52570700618044,48.525733635139083],"torque_nm":[0.0013428662219227545,0.026155382857360961,0.18135896065231288,-0.90985700636588351,-0.90985750565885792],"angle_rad":[-558.39706307690471,344.16826436878773,-768.92960142064464,2299.7202783407984,2299.7202623169364]},"command":[-0.022537730067312647,-0.10021275216788555,-0.26218690496066371,0.58709497350623951,0.58709497350623951],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,-4.3368086899420177e-19],"servo_effort":[0.016251644427389241,-1.4949904614929059,-0.26874196570441855,2.0532423090260495e-05,-0.00039847670443770254,0.00010637310085052783]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":854,"step":6832,"t":34.160000000000004,"sim_time":34.159999999999023,"vehicle":{"origin_ned":[1.4998896230874601,1.0000903712251132,3.4958112966032733],"origin_quat_xyzw":[-0.021454302265575639,0.05352167339698595,0.37897776539003847,0.92360759889200594],"cg_ned":[1.4392720168983475,0.94101503269152298,3.2033535360150811],"linear_velocity_ned":[0.00046305100501740231,-0.00063166187105984334,-0.00017456210008543353],"angular_velocity_ned":[-2.6971338197827771e-05,-1.764329847076703e-05,0.0020599614738712291]},"sensors":{"Odom":[1.4998896230874601,1.0000903712251132,3.4958112966032733,-9.0256815904847751e-05,-0.0005914281003172575,-0.00018616112724523546,-0.021454302265575643,0.053521673396985964,0.37897776539003852,0.92360759889200594,-0.0002685382019315274,8.3130853779365252e-06,0.0020426204100649045],"Pressure":[26797.473820113308],"DVL":[0.011896098725706272,-0.023775291909410089,0.0050545478452462666,7.2868025925438706,0.019617811778883144,-0.038473337359052298,0.034589097322364953,0],"IMU":[0.00094260292685763227,0.1153833074445262,0.77880247657328117,-0.0020764174756653917,0.0014039057413600161,-0.0082483338803409044,1.1418312075011361,-0.014786346549186497,-9.7112469381088857],"FOG":[0.76948633253184018],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-2.4537096134780261,-10.53773107975471,-27.528412909279666,61.647632859073994,61.647632859073994],"omega_rad_s":[-2.4551035160884909,-10.46223074735914,-27.538356111173172,61.658210597304375,61.658219440330839],"thrust_n":[-0.077722873912526691,-1.3991014327681786,-9.6717441417813319,48.528807622837363,48.529049403276261],"torque_nm":[0.0014573038858598753,0.026233151864403354,0.18134520265840001,-0.90991514292820086,-0.90991967631143011],"angle_rad":[-558.49357842655581,343.75004286429021,-770.03115531003073,2302.1865579281698,2302.1865422681094]},"command":[-0.023368662985505009,-0.10035934361671153,-0.26217536104075873,0.58712031294356182,0.58712031294356182],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,-4.3368086899420177e-19],"servo_effort":[0.01601900108502723,-1.4950951660625404,-0.26876526804836803,2.0345504699440652e-05,-0.00039823861083015683,0.00010622500428124458]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":855,"step":6840,"t":34.200000000000003,"sim_time":34.199999999999044,"vehicle":{"origin_ned":[1.4999032266324299,1.0000706518019322,3.4958053369485453],"origin_quat_xyzw":[-0.02145704796210051,0.05352079339213104,0.37901577394010272,0.92359198939359244],"cg_ned":[1.4392906052831755,0.94099002597904779,3.2033476112568393],"linear_velocity_ned":[0.00046596893719017294,-0.00062014809626967653,-0.00012759505100644209],"angular_velocity_ned":[-2.3785085278095746e-05,-4.2882157291268877e-06,0.0020588083630664953]},"sensors":{"Odom":[1.4999032266324299,1.0000706518019322,3.4958053369485453,-8.3447822219719639e-05,-0.00058873379590919481,-0.00013871932605824742,-0.021457047962100517,0.053520793392131054,0.37901577394010288,0.92359198939359244,-0.00025683383198173056,1.5580287322257024e-05,0.0020428092501026392],"Pressure":[26795.470887739808],"DVL":[-0.036975640239501041,0.02175386577845707,0.020198712506734898,7.3288175702389262,0.0036104892716627198,-0.040697782088261275,-0.017312275277334036,0],"IMU":[0.00094159574086181161,0.11538372602238332,0.77888473356363908,-0.010725907636191445,0.038031256539672251,-0.0069489112007054127,1.1280769882049979,-0.014147025272472408,-9.7336450232172833],"FOG":[0.78220252513968536],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-2.5380129423239515,-10.553776431445044,-27.527036001803797,61.650096050700753,61.650096050700753],"omega_rad_s":[-2.5495404604046503,-10.478371886562142,-27.53709332704581,61.660893467453228,61.660901731322525],"thrust_n":[-0.083777490704993088,-1.4034380279081291,-9.6709063037853422,48.531619348370725,48.532082553301635],"torque_nm":[0.0015708279507186203,0.026314463023277428,0.18132949319597516,-0.90996786278195119,-0.90997654787440574],"angle_rad":[-558.59394816538997,343.33118750593906,-771.1326611742461,2304.6529481245229,2304.6529328051633]},"command":[-0.02417155183165668,-0.10051215648995281,-0.26216224763622664,0.58714377191143574,0.58714377191143574],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.015782118267080491,-1.4951956847636385,-0.26878832593362983,2.0159986493540293e-05,-0.00039801027987518235,0.00010608284505371601]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":856,"step":6848,"t":34.240000000000002,"sim_time":34.239999999999064,"vehicle":{"origin_ned":[1.4999171003058036,1.0000513479901183,3.4958012203707969],"origin_quat_xyzw":[-0.021459637474273752,0.05352013644730285,0.37905376888937231,0.92357637434318185],"cg_ned":[1.4393093063111777,0.94096547257152663,3.2033435547773972],"linear_velocity_ned":[0.00046870721645010156,-0.00060895752716443052,-8.1089216309795931e-05],"angular_velocity_ned":[-2.1033597998341871e-05,8.8938500469948139e-06,0.0020576092054835943]},"sensors":{"Odom":[1.4999171003058036,1.0000513479901183,3.4958012203707969,-7.6882899307852186e-05,-0.00058602360036355745,-9.178500702021361e-05,-0.021459637474273752,0.05352013644730285,0.37905376888937231,0.92357637434318185,-0.00024555165865612849,2.3028737929927264e-05,0.002042902644636994],"Pressure":[26795.990500279713],"DVL":[0.011118644724456308,-0.018364996922822525,-0.0067250452134697885,7.4144235060821231,-0.010818354154339446,-0.00087202341385554107,0.031698289118630554,0],"IMU":[0.00094104806230334227,0.11538443947677578,0.77896699625048582,0.040839704070347226,-0.023310070062829417,-0.12608174827450061,1.1196758149556401,-0.0030382072551200547,-9.7705138622501781],"FOG":[0.77949914579649648],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-2.6196302299270826,-10.570457872318585,-27.525485487724836,61.65235336680847,61.65235336680847],"omega_rad_s":[-2.6399559844440481,-10.495185313399617,-27.535676997583487,61.663379402185718,61.663387084389704],"thrust_n":[-0.08978685006975072,-1.4079599908603115,-9.6699570826262811,48.534132441833201,48.5348227278877],"torque_nm":[0.0016835034388078263,0.026399249828630841,0.18131169529924274,-0.91001498328437247,-0.91002792614789429],"angle_rad":[-558.6980024708422,342.91167112559805,-772.23411305206605,2307.1194411601464,2307.1194261582591]},"command":[-0.024948859332638882,-0.1006710273554151,-0.26214748083547462,0.58716527016008069,0.58716527016008069],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,1.0778494253810979e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,-1.7347234759768071e-18,0,0,0],"servo_effort":[0.015547114607696534,-1.4952932276930255,-0.26881131266776098,1.9976270486289758e-05,-0.00039779225413436872,0.00010594715776709444]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":857,"step":6856,"t":34.280000000000001,"sim_time":34.279999999999085,"vehicle":{"origin_ned":[1.4999312344584863,1.0000324516251806,3.495798928371411],"origin_quat_xyzw":[-0.021462080378549585,0.053519702302849435,0.37909174896140346,0.92356075406040472],"cg_ned":[1.4393281125256443,0.94094135922783417,3.2033413486397544],"linear_velocity_ned":[0.00047123355786534555,-0.00059810848916073218,-3.5019330609235773e-05],"angular_velocity_ned":[-1.8725889539142955e-05,2.1866884959974954e-05,0.0020563715794824512]},"sensors":{"Odom":[1.4999312344584863,1.0000324516251806,3.495798928371411,-7.0606400087791206e-05,-0.00058327778748264148,-4.5336254485894083e-05,-0.021462080378549582,0.053519702302849421,0.37909174896140341,0.92356075406040472,-0.00023472402982673902,3.0639216011204206e-05,0.00204290449134661],"Pressure":[26796.398618328309],"DVL":[-0.012337995966165706,-0.0019241075301635565,-0.016213455559353874,7.2478768323818148,0.039099006826185473,-0.023261605656959103,-0.015520887333249092,0],"IMU":[0.00094094177174676777,0.11538545455648261,0.77904926098424354,0.066514224586226578,-0.083078106723429801,-0.090313639381233712,1.1359390628344874,0.0091509979807669634,-9.7513382158387607],"FOG":[0.78342319783586978],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-2.6987947888596966,-10.587771861789028,-27.523747619323466,61.654394185901673,61.654394185901673],"omega_rad_s":[-2.7267945081247982,-10.512658477111916,-27.534095511594039,61.665660881391823,61.665667980805821],"thrust_n":[-0.09575423193878102,-1.4126646939122525,-9.6688879826784202,48.536334747528095,48.537257162643883],"torque_nm":[0.0017953918488521445,0.026487463010854737,0.18129164967522041,-0.91005627651615173,-0.91007357179957293],"angle_rad":[-558.80559079954958,342.49146712331515,-773.33550453849489,2309.5860289900356,2309.5860142823258]},"command":[-0.025702807512949493,-0.10083592249322884,-0.26213092970784252,0.58718470653239685,0.58718470653239685],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,4.3368086899420177e-19],"servo_effort":[0.015317878525658973,-1.4953897375518026,-0.26883676790058808,1.9793191546062867e-05,-0.00039759067764287879,0.0001058240315347632]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":858,"step":6864,"t":34.32,"sim_time":34.319999999999105,"vehicle":{"origin_ned":[1.4999456136764473,1.000013952687917,3.4957984439445164],"origin_quat_xyzw":[-0.021464385727517611,0.053519490606961199,0.37912971195358974,0.92354512926250631],"cg_ned":[1.4393470105414843,0.94091767125701864,3.2033409763524778],"linear_velocity_ned":[0.00047333692424852112,-0.00058764247886293258,1.0654412107737966e-05],"angular_velocity_ned":[-1.6806513999023805e-05,3.4665458278051867e-05,0.0020549936261781755]},"sensors":{"Odom":[1.4999456136764473,1.000013952687917,3.4957984439445164,-6.4805430005680884e-05,-0.00058040469031080469,6.4640085097090281e-07,-0.021464385727517635,0.053519490606961255,0.37912971195359013,0.92354512926250631,-0.00022427587342067535,3.839734906134939e-05,0.0020427209630122789],"Pressure":[26793.925103183461],"DVL":[-0.0043050091917878775,0.017864596755276484,0.007435706954672632,7.439858919182349,-0.024804178764393128,0.021887369211414702,-0.033791822340979681,0],"IMU":[0.00094125953762873294,0.11538677744483757,0.7791315221420847,-0.028986451463442447,-0.01079164985311486,0.17258298051428791,1.1058458800275954,-0.0278585285089714,-9.7523693183812821],"FOG":[0.77614116250097909],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-2.7751326424313558,-10.605422957177586,-27.521753048821733,61.65620665731393,61.65620665731393],"omega_rad_s":[-2.8102981638965265,-10.530715575869317,-27.53232330264472,61.66772888147954,61.667735398201003],"thrust_n":[-0.10167320333909005,-1.4175317221686874,-9.667679220474243,48.538211686932954,48.53937085450093],"torque_nm":[0.0019063725626079385,0.02657871979066289,0.18126898538389211,-0.91009146912999284,-0.91011320352189262],"angle_rad":[-558.91657646571912,342.07055046531593,-774.43682850966172,2312.0527032332784,2312.052688796432]},"command":[-0.026429834689822438,-0.10100402816359606,-0.26211193379830222,0.58720196816489456,0.58720196816489456],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.015074974456368505,-1.4954876362740854,-0.26886787996124206,1.9609906888989044e-05,-0.00039741498128847042,0.00010572275447677106]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":859,"step":6872,"t":34.359999999999999,"sim_time":34.359999999999125,"vehicle":{"origin_ned":[1.4999602172844306,0.99999584137370512,3.4957997511689536],"origin_quat_xyzw":[-0.021466561670489413,0.053519500793629382,0.37916765432375177,0.92352950125021538],"cg_ned":[1.4393659814860635,0.94089439486590487,3.2033424224183911],"linear_velocity_ned":[0.00047491905839211961,-0.00057745231277571028,5.5945514325018414e-05],"angular_velocity_ned":[-1.5253476308576603e-05,4.7256899951876661e-05,0.0020534307888069379]},"sensors":{"Odom":[1.4999602172844306,0.99999584137370512,3.4957997511689536,-5.9487819787878614e-05,-0.00057726043277930503,4.6178790668230206e-05,-0.02146656167048942,0.053519500793629396,0.37916765432375193,0.92352950125021538,-0.00021420929378976287,4.6264460134054871e-05,0.0020423069959571312],"Pressure":[26794.72638252399],"DVL":[-0.0019478148890564768,0.0045493456638851879,-0.007749524263252993,7.3743058314392416,-0.0094825481657556734,0.0097538260359532718,-0.018214576327405922,0],"IMU":[0.00094198537581031798,0.11538841324511137,0.77921377125242852,0.026849984168952498,-0.016828277426384777,-0.11485464858990481,1.1299757813746736,-0.021460450912482075,-9.7423449219342473],"FOG":[0.76769423758792044],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-2.8483174620010487,-10.623113128442951,-27.519469933742247,61.657781063318019,61.657781063318019],"omega_rad_s":[-2.8904905885444916,-10.549182929978036,-27.530326453209771,61.669573854639225,61.669579790004796],"thrust_n":[-0.10752405528190791,-1.4225149079688399,-9.6663069200924046,48.539748292221873,48.541147755612165],"torque_nm":[0.0020160760365357734,0.026672154524415754,0.18124325475173264,-0.91012028047916005,-0.91014652041772803],"angle_rad":[-559.03082686430719,341.6489017596254,-775.53807654268348,2314.5194551330983,2314.5194409438336]},"command":[-0.027126832971438558,-0.10117250598517095,-0.26209018984516425,0.58721696250779065,0.58721696250779065],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.014870892528542992,-1.495596634027873,-0.26890119485510533,1.9165236678641252e-05,-0.00039725120537866481,0.000105595479764373]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":860,"step":6880,"t":34.399999999999999,"sim_time":34.399999999999146,"vehicle":{"origin_ned":[1.4999750199797177,0.99997811540360426,3.4958028337302256],"origin_quat_xyzw":[-0.021468615455107028,0.053519731270095218,0.37920557014817069,0.9235138723829861],"cg_ned":[1.439385001967042,0.94087152475915081,3.2033456707288215],"linear_velocity_ned":[0.00047590078196762365,-0.00056732488779449245,0.00010080944936553082],"angular_velocity_ned":[-1.3973623317789741e-05,5.9619793027594831e-05,0.0020514595381328853]},"sensors":{"Odom":[1.4999750199797177,0.99997811540360426,3.4958028337302256,-5.4579943919451493e-05,-0.0005736715080760696,9.1231289039789439e-05,-0.021468615455107028,0.053519731270095225,0.37920557014817069,0.9235138723829861,-0.00020444765491394051,5.4159711596800488e-05,0.0020414465215884579],"Pressure":[26794.260174089297],"DVL":[-0.0044831757185254222,0.002179156318436406,-0.015204713385776747,7.4182621517963163,-0.037422827217689338,0.01805257762705479,0.031719590522690563,0],"IMU":[0.00094310389297980234,0.11539036447672996,0.77929599465790911,0.085008534872538857,-0.012021683652852196,0.016450499245819036,1.1244650979236317,0.0067586368974938572,-9.7346950237670953],"FOG":[0.77548304926631206],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-2.9165109061612946,-10.640769191371266,-27.516981825326635,61.659111810664406,61.659111810664406],"omega_rad_s":[-2.9669093979429904,-10.567914391538823,-27.52809954936405,61.671186840303307,61.671192197544478],"thrust_n":[-0.11325101572122549,-1.4275755990076717,-9.6647691256024579,48.540932149660499,48.542573095940931],"torque_nm":[0.0021234565447729782,0.026767042481393853,0.1812144211050461,-0.91014247780613433,-0.91017324554889278],"angle_rad":[-559.14820070681947,341.22650795686786,-776.63923939106019,2316.9862755561944,2316.9862615913212]},"command":[-0.027776294344393281,-0.10134065896544063,-0.26206649357453937,0.58722963629204195,0.58722963629204195],"arm":{"servo_position":[2.2499312661440551e-24,3.2526065174565154e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,8.6736173798840355e-19,0,0,0,0],"servo_effort":[0.014796973762987334,-1.4956801235618034,-0.26892934559773296,1.9080731509398679e-05,-0.00039713832890539099,0.00010557881910985377]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":861,"step":6888,"t":34.439999999999998,"sim_time":34.439999999999166,"vehicle":{"origin_ned":[1.4999899987011163,0.99996077633821501,3.4958076726531133],"origin_quat_xyzw":[-0.021470553177083539,0.053520179513662849,0.37924344817322886,0.92349824729058072],"cg_ned":[1.4394040505301893,0.94084906087718312,3.2033507022955909],"linear_velocity_ned":[0.00047640063397409396,-0.00055711981622868828,0.00014515896403841964],"angular_velocity_ned":[-1.2961755622531939e-05,7.1688270685552134e-05,0.0020487728153918291]},"sensors":{"Odom":[1.4999899987011163,0.99996077633821501,3.4958076726531133,-4.9905224649509028e-05,-0.00056963479516465717,0.0001357408291975226,-0.021470553177083556,0.053520179513662891,0.37924344817322914,0.92349824729058072,-0.00019499790637257818,6.2032358795846215e-05,0.0020398296662525041],"Pressure":[26794.924695149602],"DVL":[0.018376948218309389,0.024505547809925393,-0.0039469697067408098,7.3479882474465041,-0.027118661206266582,-0.019195700271268094,-0.024595646986624836,0],"IMU":[0.00094460045523433295,0.11539263106708425,0.77937816713924135,0.029888186799713501,-0.0053142609646827203,-0.090603010024535524,1.1462957318670086,-0.0085790109975035032,-9.753419794236132],"FOG":[0.80008266264534733],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-2.9800538102870164,-10.658113751281698,-27.514492656378451,61.660215568475742,61.660215568475742],"omega_rad_s":[-3.0391408972338256,-10.58672972800855,-27.525699871650289,61.67256593340236,61.672570718358131],"thrust_n":[-0.11879976983325652,-1.43266587230291,-9.6631092436531425,48.541762747367763,48.543644673055098],"torque_nm":[0.0022274956843735595,0.026862485105679568,0.18118329831849647,-0.91015805151314566,-0.91019333761978316],"angle_rad":[-559.26853646934069,340.80336249355958,-777.740308971638,2319.4531551580817,2319.4531413945983]},"command":[-0.028381464859876346,-0.10150584525030189,-0.2620427872036043,0.58724014827119753,0.58724014827119753],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,-8.6736173798840355e-19,0,0,0,0],"servo_effort":[0.014894225538112781,-1.4957793594005386,-0.2689561690224917,1.8982350964240762e-05,-0.00039695499967595457,0.00010547629657225333]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":862,"step":6896,"t":34.480000000000004,"sim_time":34.479999999999187,"vehicle":{"origin_ned":[1.5000051336095019,0.99994383124483788,3.495814245738976],"origin_quat_xyzw":[-0.021472382030873188,0.053520841625947349,0.37928127433032449,0.92348263181498724],"cg_ned":[1.4394231096522765,0.94082700866602031,3.2033574947609078],"linear_velocity_ned":[0.00047648395957349758,-0.0005467656124486126,0.00018891985304442775],"angular_velocity_ned":[-1.2253069169399801e-05,8.3377171075165954e-05,0.0020453618845282262]},"sensors":{"Odom":[1.5000051336095019,0.99994383124483788,3.495814245738976,-4.5369707572999506e-05,-0.00056512123136627773,0.00017964664850438967,-0.021472382030873215,0.053520841625947418,0.37928127433032494,0.92348263181498724,-0.0001859433706049891,6.9846607089395162e-05,0.0020374380097189664],"Pressure":[26793.919833746801],"DVL":[0.038725952592839633,0.036057645115227598,-0.0012550950062241856,7.3319192495205678,0.012382538983284317,0.0160019724849115,0.015148499973117697,0],"IMU":[0.00094645697914760114,0.11539521123578332,0.7794602571382212,-0.0054768579294668116,-0.032713244326264247,0.057149400217512629,1.1325517474910154,0.004041492422066471,-9.7668005267162119],"FOG":[0.79355979565325618],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.0387064852467791,-10.675183146554536,-27.512221628309518,61.661111994996517,61.661111994996517],"omega_rad_s":[-3.1068980111739743,-10.605489430800207,-27.523247465015242,61.673716493284203,61.673720714383393],"thrust_n":[-0.12412430171298967,-1.4377486036496319,-9.6614134617727725,48.54225075615097,48.544371994149195],"torque_nm":[0.0023273306571185565,0.026957786318430602,0.18115150240823952,-0.91016720167783072,-0.91020697489029745],"angle_rad":[-559.39166006590881,340.37946544655324,-778.84128107610525,2321.9200846899776,2321.920071105174]},"command":[-0.028940061764255037,-0.10166841091956701,-0.26202115836485257,0.58724868566663346,0.58724868566663346],"arm":{"servo_position":[2.2499312661440551e-24,3.2526065174565154e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,8.6736173798840355e-19,0,0,0,0],"servo_effort":[0.014988752769166591,-1.4958702102814638,-0.2689814172696996,1.8864316932991615e-05,-0.0003968064177659195,0.00010539683191919402]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":863,"step":6904,"t":34.520000000000003,"sim_time":34.519999999999207,"vehicle":{"origin_ned":[1.500020405432398,0.99992728718862667,3.495822528539716],"origin_quat_xyzw":[-0.021474110165171673,0.053521712746632956,0.37931903544788681,0.9234670314657506],"cg_ned":[1.4394421632076926,0.9408053731672994,3.2033660234271837],"linear_velocity_ned":[0.00047617486022760773,-0.00053630315173007861,0.0002320420683576701],"angular_velocity_ned":[-1.1863844722392652e-05,9.4637956166301933e-05,0.0020412973660236919]},"sensors":{"Odom":[1.500020405432398,0.99992728718862667,3.495822528539716,-4.0985936387897798e-05,-0.00056015744669955249,0.00022289890057785184,-0.021474110165171686,0.053521712746632991,0.37931903544788709,0.9234670314657506,-0.00017733757876216516,7.7579514692060466e-05,0.0020343364599183476],"Pressure":[26795.828851085414],"DVL":[-0.0030574447950830548,-0.034120258001690426,0.0094848578526499031,7.3808161772361194,-0.02135382590539444,0.016895043572618812,-0.0086552100188015541,0],"IMU":[0.00094865298285059033,0.11539810214827011,0.77954223487314556,-0.084720621972316987,0.10393329972045418,0.12179611100477999,1.1337734146014309,-0.023540881245852206,-9.7285625567679936],"FOG":[0.78632008430712486],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.09277454647559,-10.692026651188348,-27.510152033300422,61.661818741417704,61.661818741417704],"omega_rad_s":[-3.1700449753637892,-10.624122370599139,-27.520831639061946,61.67464841699379,61.674652084893268],"thrust_n":[-0.12919044919766826,-1.4428044806150373,-9.6597443212599323,48.542413504102676,48.544771668869927],"torque_nm":[0.0024223209224562801,0.02705258401153195,0.18112020602362372,-0.91017025320192502,-0.91021446879131118],"angle_rad":[-559.51738890581521,339.95482076183299,-779.9421557500267,2324.3870552286176,2324.3870418001729]},"command":[-0.029454995680719905,-0.10182882524941284,-0.26200144793619451,0.58725541658493052,0.58725541658493052],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,4.3368086899420177e-19],"servo_effort":[0.015085750883985486,-1.4959598136584642,-0.26900712667256704,1.8739121274957217e-05,-0.00039666012237870956,0.00010531995906587171]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":864,"step":6912,"t":34.560000000000002,"sim_time":34.559999999999228,"vehicle":{"origin_ned":[1.5000357952686627,0.99991114989789087,3.4958324948899948],"origin_quat_xyzw":[-0.021475746213537612,0.05352278728858284,0.37935671973845508,0.92345145121696137],"cg_ned":[1.4394611960883492,0.9407841578376811,3.203376261796437],"linear_velocity_ned":[0.00047549964392172448,-0.00052577101819143877,0.00027448442939209975],"angular_velocity_ned":[-1.1795200057900548e-05,0.00010543518006299863,0.002036656289723261]},"sensors":{"Odom":[1.5000357952686627,0.99991114989789087,3.4958324948899948,-3.6764729389492004e-05,-0.00055477528663087873,0.00026545697277031109,-0.021475746213537622,0.053522787288582861,0.37935671973845525,0.92345145121696137,-0.00016921495099892804,8.5206811284962316e-05,0.0020305985930453422],"Pressure":[26793.700756919294],"DVL":[-0.0072465026914002072,-0.02447274145144435,-0.042521478564617167,7.3768200801102219,-0.0029550489203980287,-0.022985897400624143,-0.025944165134428637,0],"IMU":[0.0009511666993247674,0.11540129999419588,0.77962407346021512,-0.065878622695595246,0.0176887770852419,0.12176735555816584,1.1509662966583309,-0.014247905788516591,-9.7021615797965985],"FOG":[0.77965132081349409],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.142640364055489,-10.708691545397791,-27.508246026752367,61.66235027804251,61.66235027804251],"omega_rad_s":[-3.2286199923518448,-10.642594747739238,-27.518500680738846,61.675373570969867,61.675376698201894],"thrust_n":[-0.13397916989716291,-1.4478242067673666,-9.65813546638927,48.54227117615347,48.544863132464499],"torque_nm":[0.0025121094355718045,0.027146703876888122,0.18109003999479881,-0.91016758455287772,-0.91021618373370927],"angle_rad":[-559.64553908977791,339.52943436855935,-781.04293564535908,2326.8540582964511,2326.8540450025125]},"command":[-0.029929908229099897,-0.10198753852759801,-0.26198329549287969,0.58726047883850008,0.58726047883850008],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.015190040160579746,-1.4960491783792047,-0.26903345291409669,1.8958077570521377e-05,-0.00039651737639728415,0.00010524646769139755]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":865,"step":6920,"t":34.600000000000001,"sim_time":34.599999999999248,"vehicle":{"origin_ned":[1.5000512846332332,0.99989542389767183,3.4958441172418389],"origin_quat_xyzw":[-0.021477299372187914,0.053524058950215954,0.37939431672365548,0.92343589553523509],"cg_ned":[1.4394801942519182,0.94076336464504429,3.2033881819117802],"linear_velocity_ned":[0.00047448510317800463,-0.0005152053243731024,0.00031621386972901003],"angular_velocity_ned":[-1.2062038242868908e-05,0.00011572447106434583,0.0020315084843432604]},"sensors":{"Odom":[1.5000512846332332,0.99989542389767183,3.4958441172418389,-3.2714784894415987e-05,-0.00054900107994713238,0.0003072883835652082,-0.021477299372187928,0.053524058950215989,0.3793943167236557,0.92343589553523509,-0.00016162505616569935,9.2707568155990589e-05,0.0020262889764183153],"Pressure":[26795.288957101006],"DVL":[-0.037292055443934935,-0.010906493028291856,-0.022111670517994623,7.346179367770695,0.011998226417362383,0.0084732774685666711,0.01046417819158703,0],"IMU":[0.0009539749317063205,0.11540480006997211,0.77970574874483001,0.098868097624088547,0.11059893582674568,0.012252064841004481,1.1480607588479259,-0.01183211467925826,-9.7358291690103336],"FOG":[0.78127488791390787],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.1886370808673972,-10.725222037960167,-27.506469086671682,61.662718391723764,61.662718391723764],"omega_rad_s":[-3.2827693590928329,-10.660899759521486,-27.51627502837427,61.675904220251063,61.675906820954488],"thrust_n":[-0.13848235602480302,-1.4528057713031985,-9.6566010150792998,48.541844313687875,48.544666272694258],"torque_nm":[0.0025965441754650567,0.027240108211934979,0.18106126903273692,-0.91015958088164783,-0.9102124926130174],"angle_rad":[-559.77593089580319,339.10331289489648,-782.14362467696753,2329.321085902809,2329.3210727220644]},"command":[-0.030367972198737117,-0.10214497179009684,-0.26196637225401603,0.5872639846830835,0.5872639846830835],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.015297960830646384,-1.4961383126050403,-0.26906027539620997,1.9259207245896334e-05,-0.00039637663393814784,0.00010517645439799151]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":866,"step":6928,"t":34.640000000000001,"sim_time":34.639999999999269,"vehicle":{"origin_ned":[1.5000668554438412,0.99988011266349419,3.4958573669604101],"origin_quat_xyzw":[-0.021478779502995596,0.053525520708390256,0.3794318171372657,0.92342036841726083],"cg_ned":[1.4394991447261305,0.94074299417767737,3.2034017546585991],"linear_velocity_ned":[0.00047315784968924554,-0.00050463921776334065,0.00035720460617568876],"angular_velocity_ned":[-1.2677605979720857e-05,0.0001254633645123617,0.0020259191161792005]},"sensors":{"Odom":[1.5000668554438412,0.99988011266349419,3.4958573669604101,-2.8843652779776856e-05,-0.00054286004615945033,0.00034836809600615929,-0.021478779502995614,0.053525520708390298,0.37943181713726598,0.92342036841726083,-0.00015461442971318297,0.00010006105416033989,0.0020214678346175195],"Pressure":[26796.683366310499],"DVL":[-0.016016378801219307,-0.023561010320757751,0.030817199603530378,7.4220197388751368,-0.025705159178561941,0.0022398450686434198,-0.049133815274845005,0],"IMU":[0.00095705284408846895,0.11540859684443495,0.77978723908125092,-0.026210894813785884,0.011405503731835262,0.14013198920067568,1.1498425206475638,-0.0028682597801258022,-9.7562465591734249],"FOG":[0.78600782284053006],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.2310459288877027,-10.741659669687145,-27.504789172184783,61.662932566401437,61.662932566401437],"omega_rad_s":[-3.3326917668293028,-10.679047268101732,-27.514157452758592,61.676252086254443,61.676254175941885],"thrust_n":[-0.14269871607643919,-1.4577516992053583,-9.6551427042400437,48.541152390243091,48.544199928320445],"torque_nm":[0.0026756009264332346,0.027332844360100465,0.18103392570450083,-0.91014660731705821,-0.91020374865600839],"angle_rad":[-559.9083917369602,338.67646284327645,-783.24422715544063,2331.7881305370774,2331.7881174488102]},"command":[-0.030771865989406691,-0.1023015206636871,-0.2619503730684265,0.58726602444191844,0.58726602444191844],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,-8.6736173798840355e-19,0],"servo_effort":[0.015407325347917765,-1.4962279148076472,-0.26908765486649339,1.9541680484547991e-05,-0.00038290431992752348,0.00010511031047865817]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":867,"step":6936,"t":34.68,"sim_time":34.679999999999289,"vehicle":{"origin_ned":[1.5000824900529279,0.99986521870595713,3.4958722145776289],"origin_quat_xyzw":[-0.02148019705982343,0.053527164871048728,0.37946921282002632,0.92340487343141531],"cg_ned":[1.4395180355846662,0.94072304576866339,3.2034169500217753],"linear_velocity_ned":[0.00047154365126513405,-0.00049410277888793164,0.00039743651209813623],"angular_velocity_ned":[-1.3652933409313665e-05,0.00013461444701728993,0.0020199465522628226]},"sensors":{"Odom":[1.5000824900529279,0.99986521870595713,3.4958722145776289,-2.5157391252767404e-05,-0.0005363767034569281,0.0003886767623564685,-0.021480197059823441,0.053527164871048756,0.37946921282002655,0.92340487343141531,-0.00014822373572116783,0.0001072485749213886,0.0020161892255641852],"Pressure":[26796.511572387641],"DVL":[-0.036142315109037593,0.0086945034919089226,0.013694139339006369,7.3115560359749443,0.038629265273176353,-0.018257148962755418,-0.019641290809823204,0],"IMU":[0.00096037412538874144,0.11541268400075899,0.77986852511541149,-0.050183118376342144,0.014233731951988899,-0.10680129421163564,1.1253515982429398,0.00039753100565985411,-9.7450508660153332],"FOG":[0.78021059422828576],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.2701173627034743,-10.758042056383319,-27.503176784793208,61.663000220424671,61.663000220424671],"omega_rad_s":[-3.3786103722536804,-10.69705725117414,-27.512139536365215,61.676427781864568,61.676429377244894],"thrust_n":[-0.14663149866634487,-1.4626672969686587,-9.653754444907209,48.540212947557372,48.543481058707457],"torque_nm":[0.0027493405999939671,0.027425011818162346,0.18100789584201021,-0.91012899276670089,-0.91019026985076479],"angle_rad":[-560.04275758667052,338.24889007726898,-784.3447472332532,2334.2551851330386,2334.2551721171799]},"command":[-0.031143974882890231,-0.10245754339412684,-0.26193501699803057,0.58726666876594924,0.58726666876594924],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,-6.6174449004242214e-23,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,-1.3552527156068805e-20,0,-4.3368086899420177e-19],"servo_effort":[0.015518662775272562,-1.4963182277555025,-0.26911561945610479,1.9809452170168451e-05,-0.0003961025761096486,0.00010504867257176715]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":868,"step":6944,"t":34.719999999999999,"sim_time":34.71999999999931,"vehicle":{"origin_ned":[1.5000981712865558,0.99985074364061433,3.4958886299910907],"origin_quat_xyzw":[-0.021481562988138882,0.053528983156399881,0.37950649659007168,0.92338941376851313],"cg_ned":[1.4395368559070481,0.94070351761681348,3.2034337372906774],"linear_velocity_ned":[0.00046966709877818697,-0.00048362286788938385,0.00043689427564485059],"angular_velocity_ned":[-1.4995939669248921e-05,0.00014314525248306084,0.0020136421904698803]},"sensors":{"Odom":[1.5000981712865558,0.99985074364061433,3.4958886299910907,-2.1660808092313584e-05,-0.00052957470610063596,0.00042819990863657959,-0.021481562988138886,0.053528983156399888,0.3795064965900718,0.92338941376851313,-0.00014248718758294251,0.00011425276814188889,0.0020105009373541614],"Pressure":[26797.35129878499],"DVL":[0.02556840860009316,-0.0044665237007738435,-0.00065399014032873173,7.3763589778394225,0.027789667722350225,-0.046495416427147988,0.023326603713505742,0],"IMU":[0.00096391122016044155,0.11541705450716104,0.77994958951947801,-0.048656481988797309,-0.036139903843138324,-0.078086082911679205,1.1350607997501072,-0.0044941285492030155,-9.7526560670048354],"FOG":[0.77299147941096813],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.3060803945180006,-10.774400823680976,-27.501605942451505,61.662927224632881,61.662927224632881],"omega_rad_s":[-3.4207568040222927,-10.714954694359328,-27.510206431536279,61.676440614073861,61.676441732890133],"thrust_n":[-0.15028701153536694,-1.4675592761942986,-9.6524256658242997,48.539041315528209,48.542524456686237],"torque_nm":[0.0028178814662881304,0.0275167364286431,0.18098298123420561,-0.9101070246661539,-0.91017233356286698],"angle_rad":[-560.17887356745223,337.82059953571331,-785.44518856967272,2336.7222430194761,2336.7222300566509]},"command":[-0.031486479947790483,-0.10261334117791406,-0.26192005659477624,0.5872659735679322,0.5872659735679322],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,-6.6174449004242214e-23,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,-1.3552527156068805e-20,0,0],"servo_effort":[0.015631258120082512,-1.496409505389136,-0.26914417299579191,2.0058641479695626e-05,-0.00039597048386770018,0.00010499162430918875]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":869,"step":6952,"t":34.759999999999998,"sim_time":34.75999999999933,"vehicle":{"origin_ned":[1.5001138824698377,0.99983668826128702,3.495906582634416],"origin_quat_xyzw":[-0.021482888614501275,0.053530966768696578,0.37954366210125934,0.92337399229800199],"cg_ned":[1.4395555957233226,0.94068440691858424,3.2034520852343973],"linear_velocity_ned":[0.00046755136505298195,-0.00047322330852404533,0.00047556641765510703],"angular_velocity_ned":[-1.6710952798108905e-05,0.00015102925808052649,0.0020070473957349753]},"sensors":{"Odom":[1.5001138824698377,0.99983668826128702,3.495906582634416,-1.8357535691549788e-05,-0.00052247737136559391,0.00046692690610495956,-0.021482888614501282,0.053530966768696592,0.37954366210125945,0.92337399229800199,-0.00013743115985753046,0.00012105796928273909,0.0020044415645859267],"Pressure":[26795.52910054423],"DVL":[-0.027951078824560629,-0.0028234712926656904,-0.010127646652221047,7.3822668951916199,-0.0070634378102011628,0.013488637587195311,0.016064643360367302,0],"IMU":[0.00096763557411309214,0.11542170067352971,0.78003041670068385,0.099583231763751529,0.00059483428232862047,-0.024123976573308146,1.1435190169586193,-0.023189071079315615,-9.7301562554968193],"FOG":[0.75622330221908607],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.339140262632458,-10.79076221080024,-27.500053956037259,61.662718046083342,61.662718046083342],"omega_rad_s":[-3.45936033141657,-10.732766154107955,-27.508340044732666,61.67629851597389,61.676299176862699],"thrust_n":[-0.15367348055316196,-1.4724348188059089,-9.6511435550179616,48.537650528010523,48.541342667668644],"torque_nm":[0.0028813777603717864,0.027608152852610795,0.18095894165658682,-0.91008094740019729,-0.91015017501878703],"angle_rad":[-560.31659403324807,337.39159511385293,-786.54555414905451,2339.189297866179,2339.1892849377405]},"command":[-0.031801335834594838,-0.10276916391238325,-0.26190527577178341,0.5872639813912699,0.5872639813912699],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,-4.3368086899420177e-19],"servo_effort":[0.015749303395418916,-1.4965024481894262,-0.26917351651198318,2.0259566015141475e-05,-0.0003958425739487667,0.00010493917396223617]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":870,"step":6960,"t":34.800000000000004,"sim_time":34.799999999999351,"vehicle":{"origin_ned":[1.5001296073864816,0.99982305256598669,3.4959260415532509],"origin_quat_xyzw":[-0.02148418554140448,0.053533106330331932,0.37958070334288935,0.92335861177982481],"cg_ned":[1.4395742459352396,0.94066571001916321,3.2034719621603926],"linear_velocity_ned":[0.0004652169130641253,-0.00046292294003564681,0.0005134408620474691],"angular_velocity_ned":[-1.8795617566688433e-05,0.00015822846374896298,0.0020001597113396487]},"sensors":{"Odom":[1.5001296073864816,0.99982305256598669,3.4959260415532509,-1.5253460424417448e-05,-0.00051510531016518625,0.00050484735856944779,-0.021484185541404487,0.05353310633033196,0.37958070334288951,0.92335861177982481,-0.00013308028359952266,0.00012763561721785654,0.0019980058008376416],"Pressure":[26796.257875419473],"DVL":[0.027376851689094518,0.0043647328091129655,-9.9061419972507785e-05,7.3593179599039829,-0.0079087137616788757,-0.01618926756449374,0.024118349882932322,0],"IMU":[0.00097151771446801706,0.11542661394622318,0.78011099171746545,-0.074489228963765183,-0.021583291151389992,0.13604900970828113,1.1272150718551481,-0.0091682227535379423,-9.7497946289335662],"FOG":[0.78047609570333654],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.3694857459627983,-10.80712371292994,-27.498509143538563,61.662376614810697,61.662376614810697],"omega_rad_s":[-3.494642911995264,-10.75051247580372,-27.506522864347598,61.676008213350656,61.67600843578537],"thrust_n":[-0.15680037849776129,-1.4772995506146844,-9.6498958630499523,48.536051852291529,48.53994615131807],"torque_nm":[0.0029400070968330239,0.027699366574025341,0.18093554743218662,-0.91005097223046627,-0.91012399033721403],"angle_rad":[-560.4557823569296,336.96187973371485,-787.64584622918028,2341.6563436317092,2341.6563307197757]},"command":[-0.032090340437740936,-0.1029249877421899,-0.26189056327179583,0.58726072966486376,0.58726072966486376],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,4.3368086899420177e-19],"servo_effort":[0.015851301590441302,-1.4965995682177697,-0.26920410739764083,2.032899048480646e-05,-0.00039572051555929259,0.00010489124207267179]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":871,"step":6968,"t":34.840000000000003,"sim_time":34.839999999999371,"vehicle":{"origin_ned":[1.5001453301976504,0.99980983585732353,3.4959469754666985],"origin_quat_xyzw":[-0.021485465609167368,0.053535391828043358,0.37961761442601599,0.92334327495621893],"cg_ned":[1.4395927982336987,0.94064742256817524,3.2034933359650237],"linear_velocity_ned":[0.00046268322637342183,-0.00045273882496220857,0.00055050981097011856],"angular_velocity_ned":[-2.1251554345694582e-05,0.0001647178212879965,0.0019930044656340717]},"sensors":{"Odom":[1.5001453301976504,0.99980983585732353,3.4959469754666985,-1.2350796878009003e-05,-0.00050747666834840297,0.00054195457353743584,-0.021485465609167375,0.053535391828043365,0.3796176144260161,0.92334327495621893,-0.00012945615381240887,0.00013396918651625245,0.0019912166508327506],"Pressure":[26795.11168807248],"DVL":[-0.013075384794363883,-0.019910935978680495,-0.0003941309243864319,7.3088424117202981,-0.01428100491825679,0.0071313453750289696,-0.010578608811194592,0],"IMU":[0.0009755272524851836,0.11543178477974995,0.78019129981360469,-0.067106972859115613,-0.058663844377680414,-0.015989947613469051,1.1112775825927768,0.0013305027024885681,-9.7794773889266668],"FOG":[0.77824169850430114],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.3972694383566835,-10.823449609776397,-27.496971230377465,61.661906820413506,61.661906820413506],"omega_rad_s":[-3.5268101635351816,-10.768195333342716,-27.504743024680355,61.675575625709371,61.675575430112161],"thrust_n":[-0.15967737899494236,-1.4821538803314713,-9.6486742572527024,48.534255106934189,48.538344126080212],"torque_nm":[0.0029939508561551693,0.027790385256215088,0.18091264232348817,-0.91001728325501607,-0.91009395236400414],"angle_rad":[-560.59631043637148,336.53145594615108,-788.74606650326177,2344.1233745250033,2344.1233616124932]},"command":[-0.032354947031968416,-0.10308047247406092,-0.26187591647978536,0.58725625543250959,0.58725625543250959],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,-4.3368086899420177e-19],"servo_effort":[0.015950835842096688,-1.4966966488542282,-0.26923502660512399,2.0389292691020384e-05,-0.00039560344442161703,0.00010484837231329477]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":872,"step":6976,"t":34.880000000000003,"sim_time":34.879999999999391,"vehicle":{"origin_ned":[1.5001610355761406,0.99979703693576183,3.4959693529098654],"origin_quat_xyzw":[-0.021486740922293347,0.053537813026219641,0.37965439000203016,0.92332798435501462],"cg_ned":[1.4396112450578284,0.94062953956269724,3.2035161743427416],"linear_velocity_ned":[0.00045996833287121122,-0.00044268639049944189,0.00058676959900028167],"angular_velocity_ned":[-2.4087198409035622e-05,0.00017048877485839432,0.0019856095664224833]},"sensors":{"Odom":[1.5001610355761406,0.99979703693576183,3.4959693529098654,-9.6471650037453517e-06,-0.00049960916532913789,0.00057824513992039983,-0.021486740922293354,0.053537813026219662,0.37965439000203027,0.92332798435501462,-0.00012657395406346451,0.00014005867521510684,0.0019841004428703007],"Pressure":[26796.451293994065],"DVL":[0.010209194934664049,0.01130711578633602,0.01677624691156716,7.4142412893403513,-0.044854969190703517,0.02425240384991538,-0.0035822533258712216,0],"IMU":[0.00097963320389394854,0.11543720342232834,0.78027132736246729,-0.056143582031052498,0.024272325627972387,0.10842852995734525,1.1385902350248454,0.0049088311561045778,-9.7484008571566516],"FOG":[0.77088895164724336],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.4226290111631057,-10.839757926829956,-27.495426411307893,61.661310965629539,61.661310965629539],"omega_rad_s":[-3.5560498069644275,-10.785819789094193,-27.502988114804612,61.675005658462418,61.675005065919891],"thrust_n":[-0.16231397269508696,-1.486999158129978,-9.6474699652286766,48.532268141521911,48.536544409449689],"torque_nm":[0.0030433869880328807,0.027881234214937087,0.18089006184803771,-0.90998002765353581,-0.91006020767718165],"angle_rad":[-560.73805798148965,336.10032618617663,-789.84621618149424,2346.5903849691331,2346.5903720397973]},"command":[-0.032596466772981961,-0.10323578977933291,-0.26186120391721801,0.58725058062504321,0.58725058062504321],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,4.3368086899420177e-19],"servo_effort":[0.016048936120509519,-1.4967928746701922,-0.26926612500409497,2.0444977159177818e-05,-0.00039549137796420885,0.00010481044565974397]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":873,"step":6984,"t":34.920000000000002,"sim_time":34.919999999999412,"vehicle":{"origin_ned":[1.5001767087251057,0.99978465411168871,3.4959931423018524],"origin_quat_xyzw":[-0.021488023713204817,0.053540359522639608,0.37969102523075204,0.92331274230257843],"cg_ned":[1.4396295795491159,0.94061205542494242,3.2035404448541791],"linear_velocity_ned":[0.0004570893915766681,-0.00043277911374788421,0.00062221708762037764],"angular_velocity_ned":[-2.729858071111481e-05,0.00017553122893717408,0.0019780038545489514]},"sensors":{"Odom":[1.5001767087251057,0.99978465411168871,3.4959931423018524,-7.1424487770517146e-06,-0.00049152071074590219,0.0006137167480161534,-0.02148802371320482,0.053540359522639615,0.3796910252307521,0.92331274230257843,-0.00012444129446071992,0.00014589426522043753,0.0019766853318270656],"Pressure":[26796.548801290453],"DVL":[0.023615830308285752,-0.013225030778885087,-0.0046397726932879664,7.4110919499582915,-0.013778493985966955,0.019510714516477675,-0.0086419691274457165,0],"IMU":[0.00098380428078521671,0.11544285991544577,0.78035106181483183,0.040947010274210389,-0.020415555727893164,-0.076806369229383081,1.1462702871463055,-0.0040367526203210066,-9.7364983145501292],"FOG":[0.79475239045368329],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.4456967149563584,-10.856061548714635,-27.493863307632036,61.660590953579025,61.660590953579025],"omega_rad_s":[-3.5825347172485773,-10.803394062450231,-27.50124593028243,61.674302301900248,61.674301333862772],"thrust_n":[-0.16471952832746362,-1.4918376210975599,-9.646274376064552,48.53009744039926,48.534553226592223],"torque_nm":[0.0030884911561399426,0.02797195539557925,0.18086764455121035,-0.90993932700748636,-0.91002287299860429],"angle_rad":[-560.88091186018084,335.66849260811188,-790.94629598375343,2349.0573695618737,2349.0573566003159]},"command":[-0.032816159190060555,-0.1033910623687108,-0.26184631721554319,0.58724372336741926,0.58724372336741926],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,1.3552527156068805e-20,0,-4.3368086899420177e-19],"servo_effort":[0.016148602296939454,-1.4968908142941817,-0.26929795726478023,2.0493691414163277e-05,-0.00039538525164743601,0.00010477801663653806]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":874,"step":6992,"t":34.960000000000001,"sim_time":34.959999999999432,"vehicle":{"origin_ned":[1.5001923353049811,0.99977268519316709,3.4960183120000852],"origin_quat_xyzw":[-0.021489326186493327,0.053543020648288003,0.37972751578045849,0.92329755093312638],"cg_ned":[1.4396477954970028,0.94059496409770427,3.2035661149548162],"linear_velocity_ned":[0.00045406172536695554,-0.00042302775847593812,0.0006568499403357724],"angular_velocity_ned":[-3.087477025127505e-05,0.00017983271125229566,0.0019702090519679413]},"sensors":{"Odom":[1.5001923353049811,0.99977268519316709,3.4960183120000852,-4.8380104966896687e-06,-0.00048322755884009391,0.00064836828294553308,-0.021489326186493334,0.053543020648288017,0.3797275157804586,0.92329755093312638,-0.00012306171418278452,0.0001514595456085785,0.0019689927842623683],"Pressure":[26797.37076695912],"DVL":[0.021135630951605942,0.001408097218484787,0.039326994788401702,7.4129953035975404,0.021296269968067688,0.03050770105580226,0.005404512624171783,0],"IMU":[0.00098800910408201165,0.11544874378958049,0.78043049170392287,0.088470981223475978,0.059734883556256196,-0.069640168434755678,1.1279830207209458,-0.0088720639825568409,-9.7784516252811073],"FOG":[0.78482586343482152],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.4665912937051941,-10.872376384221427,-27.492267388133062,61.659748417085588,61.659748417085588],"omega_rad_s":[-3.6064243044353934,-10.820928986312659,-27.499503429558136,61.673468839554999,61.673467517789767],"thrust_n":[-0.16690323805374227,-1.4966722442186802,-9.6450783197857337,48.527748442839389,48.532375548939271],"torque_nm":[0.0031294357135076677,0.028062604579100255,0.18084521849598256,-0.90989528330323888,-0.9099820415426112],"angle_rad":[-561.02476555395265,335.23595697948707,-792.04630612422079,2351.5243230441279,2351.5243100358175]},"command":[-0.033015155178144705,-0.10354644175448978,-0.26183111798221964,0.58723569921033891,0.58723569921033891],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,-8.6736173798840355e-19,4.3368086899420177e-19],"servo_effort":[0.016240469322964139,-1.4969911464971566,-0.26933061769465583,2.0537214059023945e-05,-0.00038193957609499357,0.00010475163992289548]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":875,"step":7000,"t":35,"sim_time":34.999999999999453,"vehicle":{"origin_ned":[1.5002079012502876,0.99976112739367407,3.4960448303569924],"origin_quat_xyzw":[-0.021490660352092784,0.053545785133043013,0.37976385718712968,0.92328241247544085],"cg_ned":[1.4396658872330859,0.94057825918504545,3.2035931519884828],"linear_velocity_ned":[0.00045089763736506883,-0.00041343915144887724,0.00069066508432462815],"angular_velocity_ned":[-3.4789693382179684e-05,0.00018336082473746032,0.0019621975129032673]},"sensors":{"Odom":[1.5002079012502876,0.99976112739367407,3.4960448303569924,-2.7419869806315748e-06,-0.00047474427216352249,0.00068219921872758713,-0.021490660352092805,0.053545785133043061,0.37976385718713007,0.92328241247544085,-0.00012243630683531927,0.00015671324377542547,0.0019609948761921095],"Pressure":[26798.348607550619],"DVL":[-0.013025665661023953,0.017811012993983449,0.013923890048534898,7.3202375021990536,0.014874297904307682,-0.0015165824669654609,0.0060788159154329625,0],"IMU":[0.00099221617637662986,0.11545484331834779,0.78050960523777813,-0.029648273991116966,0.019387027314341835,0.045891978302104633,1.1261368181671618,-0.023824073215617497,-9.7278368655862621],"FOG":[0.77566209038663603],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.4854169743791674,-10.88866429816291,-27.490639056918404,61.658784819307655,61.658784819307655],"omega_rad_s":[-3.6278636123885324,-10.838425536453668,-27.497750116519029,61.672508001197052,61.672506348044884],"thrust_n":[-0.1688738789199625,-1.5015032477244408,-9.6438745921773386,48.525226043222474,48.530015082553845],"torque_nm":[0.0031663852297492971,0.028153185894833274,0.18082264860332511,-0.90984798831042124,-0.90993778279788484],"angle_rad":[-561.16951859454343,334.80272078337055,-793.14624633217511,2353.991240275071,2353.9912272063589]},"command":[-0.033194447375039689,-0.10370156474440867,-0.26181561006588955,0.58722652208864434,0.58722652208864434],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,4.3368086899420177e-19],"servo_effort":[0.016313197108081212,-1.4970979574838803,-0.26936501857847928,2.0573256856490139e-05,-0.00039519538715658683,0.00010473294519562726]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":876,"step":7008,"t":35.039999999999999,"sim_time":35.039999999999473,"vehicle":{"origin_ned":[1.5002233927902617,0.99974997740672111,3.4960726657377514],"origin_quat_xyzw":[-0.021492037992945912,0.053548641224274711,0.37980004491107705,0.92326732922349597],"cg_ned":[1.4396838495858211,0.94056193401231525,3.203621523221678],"linear_velocity_ned":[0.00044760985064627951,-0.00040402063245204077,0.00072366162319435214],"angular_velocity_ned":[-3.9030059258903784e-05,0.00018611116912681057,0.0019539875476775855]},"sensors":{"Odom":[1.5002233927902617,0.99974997740672111,3.4960726657377514,-8.54129608103996e-07,-0.00046608529021806874,0.00071520972578342117,-0.021492037992945929,0.053548641224274759,0.37980004491107733,0.92326732922349597,-0.00012256092191031693,0.0001616430212417967,0.001952710527288386],"Pressure":[26796.902548478705],"DVL":[0.024312306358460233,0.00055810095220518012,-0.0083151188183261272,7.385684670138315,0.026453124992095591,-0.0015098710143239187,-0.044633923523225677,0],"IMU":[0.0009963940398699132,0.11546114571349171,0.78058839043570882,0.076870568470643219,-0.047040982459624792,-0.048928730633427141,1.133227258000439,0.00063378737937741861,-9.730003441072876],"FOG":[0.79093715040968959],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5022659833137531,-10.904882157531679,-27.488981158800136,61.657701537210848,61.657701537210848],"omega_rad_s":[-3.6469832901946777,-10.855865829387819,-27.49598084829497,61.671422113442063,61.671420152098399],"thrust_n":[-0.17063967533587943,-1.5063256572188473,-9.6426596151651776,48.522534161378694,48.52747523355989],"torque_nm":[0.0031994939125477399,0.028243606072853384,0.18079986778434709,-0.90979751552585064,-0.90989016062924788],"angle_rad":[-561.31507598152712,334.36878596642936,-794.24611605787311,2356.4581162136028,2356.4581030717518]},"command":[-0.033354914126797648,-0.10385602054792076,-0.26179982056000128,0.5872162051162938,0.5872162051162938],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,-4.3368086899420177e-19],"servo_effort":[0.016383434655480447,-1.4972045001280061,-0.26939973034701803,2.0603809240280979e-05,-0.00039511188894626243,0.00010472058163151421]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":877,"step":7016,"t":35.079999999999998,"sim_time":35.079999999999494,"vehicle":{"origin_ned":[1.5002387966230946,0.99973923156932409,3.4961017865160038],"origin_quat_xyzw":[-0.021493470674135415,0.053551577112543644,0.37983607489204751,0.9232523032832044],"cg_ned":[1.4397016778829721,0.94054598163169234,3.2036511959067826],"linear_velocity_ned":[0.00044421049175715274,-0.00039477844287113482,0.00075583945684031483],"angular_velocity_ned":[-4.3582917746582279e-05,0.00018808927783778515,0.001945604897397266]},"sensors":{"Odom":[1.5002387966230946,0.99973923156932409,3.4961017865160038,8.2825796920196195e-07,-0.00045726520070695843,0.00074740043586391035,-0.021493470674135429,0.053551577112543679,0.37983607489204774,0.9232523032832044,-0.00012342556448152422,0.00016624384333337904,0.001944166808306128],"Pressure":[26797.380295057628],"DVL":[0.020046469805329044,-0.0045344715179810244,0.0033811053899001761,7.3309406785275897,0.017804105718902747,0.031355659589379956,0.0087369508319989769,0],"IMU":[0.0010005116556485287,0.11546763791984369,0.78066683637202727,0.053230544347103337,-0.061173696535610715,0.10458101002010953,1.13069227872721,-0.016523044588804364,-9.7746127271674119],"FOG":[0.78634785725559386],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.517228817468967,-10.921047595425938,-27.487281108832761,61.656499861244818,61.656499861244818],"omega_rad_s":[-3.6639031400473479,-10.873241526193288,-27.494188412721506,61.670213195529826,61.670210949768737],"thrust_n":[-0.17220851243910243,-1.5111371343203162,-9.6414283001237813,48.519676050367714,48.524759096387029],"torque_nm":[0.0032289096082331707,0.028333821268505928,0.18077678062732094,-0.90974392594439457,-0.90983923305725678],"angle_rad":[-561.46134768480169,333.93415499545222,-795.34591450407004,2358.9249459044381,2358.9249326776553]},"command":[-0.033497417309228256,-0.10400997709929465,-0.26178362960793106,0.58720476058328397,0.58720476058328397],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.01645068321748034,-1.4973104566743822,-0.26943468747899935,2.0630063221049422e-05,-0.00039503568403499392,0.00010471464162652296]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":878,"step":7024,"t":35.119999999999997,"sim_time":35.119999999999514,"vehicle":{"origin_ned":[1.5002540999261234,0.99972888588832864,3.4961321610469849],"origin_quat_xyzw":[-0.021494969649313543,0.053554581009784004,0.379871943534284,0.92323733657609797],"cg_ned":[1.4397193678964915,0.94053039488389412,3.2036821372615258],"linear_velocity_ned":[0.0004407097654874459,-0.00038571707474208334,0.00078719683395264586],"angular_velocity_ned":[-4.8431551601418253e-05,0.00018930472957705174,0.0019370723519252654]},"sensors":{"Odom":[1.5002540999261234,0.99972888588832864,3.4961321610469849,2.3079917423870014e-06,-0.00044829786732422514,0.00077877031117164685,-0.021494969649313554,0.053554581009784032,0.37987194353428416,0.92323733657609797,-0.00012501441456510016,0.0001705108924932618,0.0019353884943638939],"Pressure":[26797.782331710383],"DVL":[-0.038084598811273837,-0.017459192353306362,-0.014963746560889613,7.3671913023413449,-0.025532131578265425,-0.013955827337023566,-0.0032933611721715174,0],"IMU":[0.0010045386356264737,0.11547430668871632,0.78074493315898053,-0.030203753047231503,0.024656030555190479,-0.11252635917429479,1.1320297022976475,-0.017203354235566511,-9.7423693566888154],"FOG":[0.78890413053570307],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.53039200764414,-10.937176458760527,-27.485527542855273,61.655181328053807,61.655181328053807],"omega_rad_s":[-3.6787344828634096,-10.890552671525228,-27.492363983181981,61.668883099002215,61.668880592917354],"thrust_n":[-0.17358806151937761,-1.5159376562272591,-9.6401744353077916,48.516654731039061,48.52186954412926],"torque_nm":[0.0032547761534883301,0.028423831054261113,0.18075327066202115,-0.90968727620698242,-0.90978505395242393],"angle_rad":[-561.60824827043882,333.49883046950055,-796.44564054565694,2361.391724468564,2361.3917111460146]},"command":[-0.033622781025182284,-0.10416358532152883,-0.26176692897957404,0.58719220312432197,0.58719220312432197],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.016514795735970662,-1.4974152920316004,-0.26946980659699238,2.0651352992964207e-05,-0.00039496665356216274,0.00010471528616277601]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":879,"step":7032,"t":35.160000000000004,"sim_time":35.159999999999535,"vehicle":{"origin_ned":[1.5002692903730812,0.99971893603701734,3.4961637576592359],"origin_quat_xyzw":[-0.021496545766882473,0.053557641209717663,0.3799076476484039,0.92322243086181544],"cg_ned":[1.4397369157996021,0.94051516643876476,3.2037143144642282],"linear_velocity_ned":[0.00043711785436355277,-0.00037684082729720083,0.00081773395736531123],"angular_velocity_ned":[-5.3556907822536668e-05,0.00018977215735017361,0.0019284088219839682]},"sensors":{"Odom":[1.5002692903730812,0.99971893603701734,3.4961637576592359,3.5883616649991983e-06,-0.00043919885724614974,0.00080932017083238381,-0.02149654576688248,0.053557641209717677,0.37990764764840401,0.92322243086181544,-0.00012730602464521332,0.00017444128976416926,0.0019263971063363068],"Pressure":[26796.251901774791],"DVL":[-0.045628075045647913,-0.027808719324028921,-0.00082397594275861207,7.3828579817191633,-0.013825095461812223,0.0098629449994852639,-0.014513076680497613,0],"IMU":[0.001008445455905743,0.11548113861817691,0.78082267183426779,-0.046101355697890083,-0.037587445942963885,0.097757201546997879,1.1613269648911428,-0.0045301498291450736,-9.7139755125539438],"FOG":[0.77295932511506205],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5418393089556703,-10.953282113450031,-27.483710307900008,61.653747935900967,61.653747935900967],"omega_rad_s":[-3.6915812298552622,-10.907804207117582,-27.490498014905242,61.667433759973179,61.667431017790612],"thrust_n":[-0.17478580506454006,-1.5207285604445799,-9.6388913140694417,48.513473301642563,48.518809577320908],"torque_nm":[0.0032772338449601258,0.028513660508335873,0.18072921213880203,-0.90962762440579792,-0.90972767957476686],"angle_rad":[-561.7556965778773,333.06281486660174,-797.54529268587191,2363.8584471030945,2363.8584336749104]},"command":[-0.033731802942434955,-0.10431697250904792,-0.26174962198000007,0.58717855177048539,0.58717855177048539],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,-4.3368086899420177e-19],"servo_effort":[0.01657478494571147,-1.4975189195560856,-0.26950503848873036,2.0668364261514495e-05,-0.00039490506162194623,0.00010472281297259959]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":880,"step":7040,"t":35.200000000000003,"sim_time":35.199999999999555,"vehicle":{"origin_ned":[1.5002843561860526,0.99970937735138887,3.4961965447268222],"origin_quat_xyzw":[-0.021498209392543325,0.053560746154111757,0.37994318440531605,0.92320758775493006],"cg_ned":[1.439754318160386,0.94050028882399017,3.203747694731506],"linear_velocity_ned":[0.00043344420635459265,-0.00036815255500002793,0.00084745207052110594],"angular_velocity_ned":[-5.8937591939576818e-05,0.00018950963473918941,0.0019196318574678554]},"sensors":{"Odom":[1.5002843561860526,0.99970937735138887,3.4961965447268222,4.6732651981933081e-06,-0.00042998350674232794,0.00083905188365966373,-0.021498209392543346,0.053560746154111806,0.37994318440531638,0.92320758775493006,-0.00013027473348493278,0.0001780329452774888,0.0019172132833410473],"Pressure":[26797.706252675947],"DVL":[0.031375765576855702,0.02253106902302909,0.0044041018470447352,7.3433395175231908,0.023869007619652244,-0.011153708066206166,0.0011390858598537192,0],"IMU":[0.0010122036457378219,0.11548812021656633,0.78090004427379123,-0.027776751031571786,0.036259271605518444,-0.25929130355577695,1.1309196167326345,-0.0097633008653645256,-9.7310482394412716],"FOG":[0.78729604997835367],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5516618077542716,-10.969376371388366,-27.481820762279582,61.652200944150728,61.652200944150728],"omega_rad_s":[-3.7025448996668544,-10.925003670416602,-27.48858101961368,61.66586695360995,61.665863999528383],"thrust_n":[-0.17580944304862536,-1.5255119176398555,-9.637572278183006,48.510134553293412,48.515581922432503],"torque_nm":[0.0032964270571617265,0.028603348455747291,0.18070448021593141,-0.90956502287425156,-0.90966716104560941],"angle_rad":[-561.90361554521212,332.62611040509813,-798.64486904634566,2366.3251090792546,2366.3250955365352]},"command":[-0.033825350550040684,-0.10447025115607968,-0.26173162630742458,0.58716381851572119,0.58716381851572119],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,-4.3368086899420177e-19],"servo_effort":[0.016630604929009623,-1.4976212381307696,-0.26954034138475541,2.068099099616481e-05,-0.00039485078093444648,0.00010473738910002009]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":881,"step":7048,"t":35.240000000000002,"sim_time":35.239999999999576,"vehicle":{"origin_ned":[1.5002992861410469,0.99970020484588007,3.4962304906733688],"origin_quat_xyzw":[-0.021499970341221163,0.053563884467552413,0.37997855131308356,0.92319280873395215],"cg_ned":[1.4397715719105333,0.94048575447272953,3.2037822453234401],"linear_velocity_ned":[0.00042969765364286617,-0.00035965426939891951,0.00087635212136117334],"angular_velocity_ned":[-6.4549798492120468e-05,0.00018853807401934529,0.0019107568997016086]},"sensors":{"Odom":[1.5002992861410469,0.99970020484588007,3.4962304906733688,5.5668808848957413e-06,-0.00042066738717562961,0.00086796702663902289,-0.021499970341221166,0.053563884467552419,0.37997855131308361,0.92319280873395215,-0.0001338909515060177,0.00018128407976710802,0.0019078559974813117],"Pressure":[26798.440403565812],"DVL":[-0.037066601882127799,-0.0081873729795599766,-0.022408252085533119,7.3558665065259383,0.02390650118456451,0.020111818262315128,0.040030010233431383,0],"IMU":[0.001015785937795128,0.1154952379147734,0.78097704315062499,-0.018453737419444539,0.061331274994894734,-0.24564819074186775,1.1309043698362495,0.0094586533759039582,-9.745180348578776],"FOG":[0.78786138725732202],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5599465661859702,-10.985471262627277,-27.479850599258434,61.650541707600574,61.650541707600574],"omega_rad_s":[-3.7117241305938293,-10.942160451534562,-27.486603706847927,61.664184325031897,61.664181183108354],"thrust_n":[-0.17666679271037616,-1.5302903292110808,-9.6362108169700438,48.506641074421104,48.512189111339843],"torque_nm":[0.0033125023633195539,0.02869294367270777,0.18067895281818835,-0.9094995201453957,-0.90960354583762215],"angle_rad":[-562.05193210384073,332.18871895713562,-799.74436737329063,2368.7917057359696,2368.7916920707812]},"command":[-0.033904253011294953,-0.10462353583454549,-0.26171286285008033,0.58714801626286262,0.58714801626286262],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,-8.6736173798840355e-19,-4.3368086899420177e-19],"servo_effort":[0.016681715326646952,-1.4977220018754411,-0.26957566590295778,2.0688468912417968e-05,-0.00038144521351602062,0.00010475849935742964]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":882,"step":7056,"t":35.280000000000001,"sim_time":35.279999999999596,"vehicle":{"origin_ned":[1.5003140695707893,0.99969141320831378,3.4962655639952054],"origin_quat_xyzw":[-0.021501837811236549,0.053567045006098366,0.38001374617776618,0.9231780951560723],"cg_ned":[1.4397886743026584,0.94047155574781127,3.2038179335701815],"linear_velocity_ned":[0.00042588563270840621,-0.0003513475511294393,0.00090443648912649202],"angular_velocity_ned":[-7.036805649825894e-05,0.00018688214073583044,0.0019017970906861272]},"sensors":{"Odom":[1.5003140695707893,0.99969141320831378,3.4962655639952054,6.272983576070549e-06,-0.00041126609609706989,0.00089606844359748543,-0.021501837811236556,0.053567045006098386,0.38001374617776629,0.9231780951560723,-0.0001381210250115678,0.00018419439760734797,0.0018983423764914976],"Pressure":[26800.104022697506],"DVL":[0.020177180487932312,-0.040318464691870178,-0.0098768798137242268,7.2356195292141807,-0.008216195768495466,0.0080714949697513767,-0.052769814634613159,0],"IMU":[0.0010191664229187046,0.1155024781059219,0.78105366186021175,-0.048877864311469475,0.01976824952635638,-0.10378661461669822,1.1388720141916795,-0.0035735981501888361,-9.7599048243540985],"FOG":[0.77721071846730028],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5667807543411838,-11.00157682835221,-27.477792274014234,61.64877153932089,61.64877153932089],"omega_rad_s":[-3.7192156293083256,-10.959284650663982,-27.48455719171367,61.662387458040328,61.662384152100586],"thrust_n":[-0.17736582847695373,-1.535066605793713,-9.63480070200856,48.502995308269114,48.508633572132794],"torque_nm":[0.0033256092839428829,0.028782498858632124,0.18065251316266051,-0.90943116203004604,-0.90953687947749007],"angle_rad":[-562.20057708608192,331.75064199990373,-800.84378505048687,2371.25823247685,2371.2582186822156]},"command":[-0.033969340517535085,-0.10477692217478295,-0.2616932597525165,0.5871311575173418,0.5871311575173418],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,-4.3368086899420177e-19],"servo_effort":[0.01672770907912564,-1.4978210262259535,-0.26961097275051987,2.0694143592900403e-05,-0.00039476489783744526,0.00010478609996335116]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":883,"step":7064,"t":35.32,"sim_time":35.319999999999617,"vehicle":{"origin_ned":[1.5003286963776761,0.99968299680606221,3.4963017332781754],"origin_quat_xyzw":[-0.021503820323633887,0.053570216908310674,0.38004876705711516,0.92316344827460095],"cg_ned":[1.4398056228769338,0.94045768497452642,3.2038547268929189],"linear_velocity_ned":[0.00042201506256570021,-0.00034323285411018515,0.00093170734621424276],"angular_velocity_ned":[-7.6364954736289013e-05,0.00018456963860017872,0.0018927627293843098]},"sensors":{"Odom":[1.5003286963776761,0.99968299680606221,3.4963017332781754,6.7960498697336214e-06,-0.00040179535874694809,0.00092335877836039935,-0.021503820323633904,0.053570216908310715,0.38004876705711543,0.92316344827460095,-0.00014292740942050997,0.00018676445484463674,0.0018886871370330629],"Pressure":[26799.465557656113],"DVL":[0.0045258759283749086,-0.0066541328359134384,-0.00036704207285456097,7.3751981437746998,-0.040869746289666831,-0.023110344328324497,-0.0098441043361468337,0],"IMU":[0.0010223206962218687,0.11550982719336486,0.78112989442977754,-0.072335711638957648,0.034984936718289207,0.29698230190067859,1.1389873054526127,0.0022329275000456845,-9.7548960531936153],"FOG":[0.78343243479021929],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5722518689875211,-11.017701154239717,-27.475639420607482,61.646891665002038,61.646891665002038],"omega_rad_s":[-3.7251147192071317,-10.97638611193527,-27.482433166523588,61.660477826980838,61.660474380536087],"thrust_n":[-0.17791468935137739,-1.5398435023102,-9.6333361221974929,48.499199512241248,48.50491757674299],"torque_nm":[0.0033359004253383259,0.028872065668316252,0.18062505229120299,-0.90935999085452346,-0.90946720456393115],"angle_rad":[-562.34948515895985,331.31188061109503,-801.94311911824707,2373.7246847660917,2373.7246708359808]},"command":[-0.034021446371309723,-0.1049304871832354,-0.26167275638673793,0.58711325395240033,0.58711325395240033],"arm":{"servo_position":[2.2499312661440551e-24,3.2526065174565154e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,8.6736173798840355e-19,0,0,0,0],"servo_effort":[0.016768124789737639,-1.4979180430605981,-0.2696461903507561,2.0696244332758097e-05,-0.00039473282312822125,0.00010482006895612211]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":884,"step":7072,"t":35.359999999999999,"sim_time":35.359999999999637,"vehicle":{"origin_ned":[1.5003431570426753,0.99967494968729209,3.496338967184069],"origin_quat_xyzw":[-0.021505925665821726,0.053573389626703584,0.38008361223031867,0.92314886925084516],"cg_ned":[1.4398224154369001,0.94044413446882102,3.2038925927916697],"linear_velocity_ned":[0.0004180923404018268,-0.0003353102100520894,0.00095816646306665434],"angular_velocity_ned":[-8.2511495062795862e-05,0.00018163008805250854,0.001883663034433228]},"sensors":{"Odom":[1.5003431570426753,0.99967494968729209,3.496338967184069,7.1405573646129078e-06,-0.00039227100984445638,0.00094984026262768227,-0.021505925665821747,0.053573389626703632,0.38008361223031906,0.92314886925084516,-0.0001482701154960462,0.00018899489920353168,0.0018789041923204853],"Pressure":[26799.664174248101],"DVL":[-0.0015203914705114296,0.019626859924445166,-0.051033808261538902,7.3450102680866101,-0.023856213635535424,0.01187779175482679,-0.023877470392280609,0],"IMU":[0.0010252259821781058,0.11551727160565275,0.78120573546049699,0.0038711036363483424,-0.00068478991077425375,0.0091683924741120179,1.1423395224258432,-0.028641334805179552,-9.7426263307407588],"FOG":[0.77262185867855282],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5764481357796059,-11.033851213285091,-27.473386393797529,61.644903531983523,61.644903531983523],"omega_rad_s":[-3.7295159424059414,-10.993474066843856,-27.480224081683811,61.658456901417303,61.658453337600399],"thrust_n":[-0.17832169589394575,-1.5446236177620565,-9.6318118030730417,48.495255944688623,48.501043403077801],"torque_nm":[0.0033435317980114831,0.028961692833038562,0.18059647130761955,-0.90928604896291176,-0.90939456380770878],"angle_rad":[-562.49859478243286,330.8724354883658,-803.04236630240587,2376.1910581265097,2376.191044055824]},"command":[-0.034061410816948627,-0.10508429726938183,-0.26165129898854789,0.587094319352224,0.587094319352224],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.016802877438884655,-1.4980128883518753,-0.26968127863987018,2.0691962446694995e-05,-0.00039470776267964877,0.00010485954644492549]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":885,"step":7080,"t":35.399999999999999,"sim_time":35.399999999999658,"vehicle":{"origin_ned":[1.5003574426206916,0.99966726559471664,3.4963772344478565],"origin_quat_xyzw":[-0.021508160860850598,0.053576552961651272,0.38011828016933047,0.92313435916460251],"cg_ned":[1.4398390500164371,0.94043089656323142,3.2039314988458818],"linear_velocity_ned":[0.00041412270894339428,-0.00032757890545152455,0.00098381607166406421],"angular_velocity_ned":[-8.8778266286630546e-05,0.00017809584514236711,0.0018745050135602413]},"sensors":{"Odom":[1.5003574426206916,0.99966726559471664,3.4963772344478565,7.3111509701085102e-06,-0.00038270839987847365,0.00097551546579630489,-0.021508160860850611,0.053576552961651314,0.38011828016933075,0.92313435916460251,-0.00015410662430836419,0.00019088808929012749,0.0018690055222485998],"Pressure":[26800.45334950112],"DVL":[-0.032987898954168489,-0.010186555581939745,-0.0084526645463252597,7.3915294727301308,0.016382289947251678,0.032850232945215371,0.019148559676525029,0],"IMU":[0.0010278612141723078,0.11552479783558151,0.78128118007103442,0.047602402204519285,-0.1458238001925431,-0.027149607845581063,1.1338837752590243,-0.0062317156386470871,-9.7586245292329146],"FOG":[0.78649549214815584],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5794554812585533,-11.050033144897395,-27.471028230705691,61.642808761378788,61.642808761378788],"omega_rad_s":[-3.7325129420046426,-11.010557088557274,-27.477923075504677,61.656326220104887,61.656322561617749],"thrust_n":[-0.17859530040731617,-1.5494093781608604,-9.6302229555914298,48.491166945289791,48.497013456359532],"torque_nm":[0.0033486618826371792,0.029051425840516135,0.18056668041733931,-0.90920938022418363,-0.90931900230674123],"angle_rad":[-562.64784818127384,330.43230697432364,-804.14152304218499,2378.6573481412952,2378.6573339258525]},"command":[-0.034090052202462411,-0.1052384109037847,-0.26162884029243516,0.58707436915598843,0.58707436915598843],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,-4.3368086899420177e-19],"servo_effort":[0.016831530533628031,-1.4981052148686576,-0.26971616370425699,2.0687316867454855e-05,-0.00039468998058581945,0.00010490529321510626]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":886,"step":7088,"t":35.439999999999998,"sim_time":35.439999999999678,"vehicle":{"origin_ned":[1.5003715447450798,0.99965993797080444,3.4964165038855097],"origin_quat_xyzw":[-0.021510532126534216,0.053579697101529773,0.38015276950462024,0.92311991902683399],"cg_ned":[1.4398555248496059,0.94041796362902574,3.2039714127259629],"linear_velocity_ned":[0.00041011099940353035,-0.00032003776853331632,0.0010086584480106383],"angular_velocity_ned":[-9.5134540427292653e-05,0.0001740012926899006,0.0018652940567164609]},"sensors":{"Odom":[1.5003715447450798,0.99965993797080444,3.4964165038855097,7.3126512722716678e-06,-0.00037312309274897695,0.0010003869795132739,-0.021510532126534233,0.053579697101529815,0.38015276950462051,0.92311991902683399,-0.0001603918834732477,0.00019244688388401609,0.0018590017722587189],"Pressure":[26800.677196986944],"DVL":[-0.025589804439386615,-0.0085051218926214742,0.0022779267583736881,7.3448233825399178,0.0089173137781815553,-0.02151998300792923,-0.031232877072877724,0],"IMU":[0.0010302071370180974,0.11553239248303451,0.78135622383042502,0.03753502427692746,0.13518536480577437,0.017480837330168728,1.1431594784888992,-0.00351193030615454,-9.7369684370695193],"FOG":[0.78164523948754139],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5813603399727416,-11.066251466390657,-27.468560851922227,61.64060898674105,61.64060898674105],"omega_rad_s":[-3.7341983882362917,-11.027642732698739,-27.47552406878863,61.654087370003552,61.654083639059998],"thrust_n":[-0.17874404560737239,-1.554202935710759,-9.6285653449547937,48.486934917489762,48.492830226270705],"torque_nm":[0.0033514508551382325,0.029141305044576741,0.18053560021790238,-0.909130029702933,-0.90924056674257581],"angle_rad":[-562.79719130064859,329.99149509161032,-805.24058552015515,2381.1235504562483,2381.1235360927635]},"command":[-0.034108193714026111,-0.10539287110848244,-0.26160534144687836,0.58705341892134333,0.58705341892134333],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,4.3368086899420177e-19],"servo_effort":[0.01685383547955327,-1.4981948725538778,-0.26975079687160985,2.0679439200918116e-05,-0.00039467887307486173,0.00010495676693463455]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":887,"step":7096,"t":35.480000000000004,"sim_time":35.479999999999698,"vehicle":{"origin_ned":[1.500385455631857,0.99965295996158654,3.4964567443942336],"origin_quat_xyzw":[-0.021513044842188845,0.053582812649862852,0.38018707899962312,0.92310554978934112],"cg_ned":[1.439871838349863,0.94040532809475463,3.2040123021956552],"linear_velocity_ned":[0.00040606142830598984,-0.000312685171991586,0.0010326959642988748],"angular_velocity_ned":[-0.00010154889087196222,0.0001693825779655117,0.0018560341342323148]},"sensors":{"Odom":[1.500385455631857,0.99965295996158654,3.4964567443942336,7.1499781366213635e-06,-0.00036353052503251045,0.001024457440100062,-0.021513044842188862,0.053582812649862893,0.38018707899962345,0.92310554978934112,-0.00016707894924886986,0.00019367489052991209,0.0018489023781387674],"Pressure":[26800.394625485162],"DVL":[0.025156898293777118,-0.00099630020932352475,-0.027868073544296205,7.3894309577849437,-0.017595053472399404,0.029541833508047725,0.0097277293115008278,0],"IMU":[0.0010322463864411988,0.11554004227953661,0.78143086270802309,0.079699146430704956,0.032704311177302228,0.016974888239793349,1.1229600110067224,-0.017619693003887854,-9.7284061542482831],"FOG":[0.79711245514041129],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5822498893487791,-11.082509774717261,-27.465980823629987,61.638305953333216,61.638305953333216],"omega_rad_s":[-3.7346646778060477,-11.04473753719399,-27.473021742416744,61.651742007500701,61.651738225780456],"thrust_n":[-0.17877659902390378,-1.5590061665150756,-9.6268352733220688,48.482562362819905,48.488496322292406],"torque_nm":[0.0033520612316981966,0.029231365622157661,0.18050316137478881,-0.90904804430287345,-0.90915930604298267],"angle_rad":[-562.94657378603586,329.54999958375629,-806.3395496931289,2383.5896607822065,2383.5896462682708]},"command":[-0.034116665612845515,-0.10554771214016438,-0.26158076974885702,0.58703148526984017,0.58703148526984017],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,1.7347234759768071e-18,1.3552527156068805e-20,0,0],"servo_effort":[0.016869526374588353,-1.4982816291796814,-0.26978511800875182,2.0668222144220156e-05,-0.00039467410107804337,0.00010501360348028398]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":888,"step":7104,"t":35.520000000000003,"sim_time":35.519999999999719,"vehicle":{"origin_ned":[1.5003991680876316,0.99964632441846235,3.4964979249568824],"origin_quat_xyzw":[-0.021515703517704845,0.053585890655851919,0.38022120752452165,0.92309125235447431],"cg_ned":[1.439887989091619,0.94039298246083292,3.2040541351192768],"linear_velocity_ned":[0.00040197787153245729,-0.00030551918885462137,0.0010559312531571684],"angular_velocity_ned":[-0.00010798900534450537,0.00016427792546318083,0.0018467275870116479]},"sensors":{"Odom":[1.5003991680876316,0.99964632441846235,3.4964979249568824,6.8282430121879107e-06,-0.0003539464300585555,0.0010477296971473811,-0.021515703517704855,0.053585890655851946,0.38022120752452188,0.92309125235447431,-0.0001741186113890439,0.00019457655521522713,0.0018387153983224741],"Pressure":[26803.340414470564],"DVL":[0.006444867299645796,0.0073289239828319966,-0.029317986831632385,7.3753251796040704,-0.016066375656301014,-0.0098954760269818892,-0.0038132035191942499,0],"IMU":[0.0010339635667543764,0.11554773412084271,0.78150509302209126,-0.034526535532206346,-0.053046450271578907,-0.00057797228784518275,1.1314040922336437,-0.024309632566999115,-9.7548724762753114],"FOG":[0.78972356370575691],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.582212701812725,-11.098810724536021,-27.463285383633249,61.63590148120722,61.63590148120722],"omega_rad_s":[-3.7340042500188204,-11.061847021709516,-27.470411512626935,61.649291864608067,61.649288053214342],"thrust_n":[-0.17870175374941397,-1.5638206681375819,-9.6250295630560547,48.478051884508034,48.484014481312869],"torque_nm":[0.0033506578828015124,0.029321637527579665,0.18046930430730104,-0.90896347283452583,-0.90907527152461642],"angle_rad":[-563.09594897694706,329.10781995596318,-807.43841132185923,2386.0556748980175,2386.0556602320762]},"command":[-0.034116311445835476,-0.10570295928129543,-0.26155509889174522,0.58700858553530688,0.58700858553530688],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,-8.6736173798840355e-19,0,0,0,4.3368086899420177e-19],"servo_effort":[0.016878214899644001,-1.4983653367508383,-0.26981908399075027,2.0653749263745493e-05,-0.00039467650800038037,0.00010507554718404514]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":889,"step":7112,"t":35.560000000000002,"sim_time":35.559999999999739,"vehicle":{"origin_ned":[1.5004126754956411,0.99964002391384388,3.4965400146408103],"origin_quat_xyzw":[-0.021518511783652199,0.053588922633305044,0.38025515403827154,0.92307702758163623],"cg_ned":[1.4399039757818508,0.94038091931816137,3.2040968794629072],"linear_velocity_ned":[0.00039786321636351492,-0.00029853730871801131,0.0010783667878754245],"angular_velocity_ned":[-0.00011442319790481165,0.00015872580019730007,0.0018373763193333288]},"sensors":{"Odom":[1.5004126754956411,0.99964002391384388,3.4965400146408103,6.3524677320716302e-06,-0.00034438538695869935,0.0010702063784523298,-0.021518511783652203,0.053588922633305044,0.38025515403827159,0.92307702758163623,-0.0001814618815846808,0.00019515692402623906,0.00182844842619372],"Pressure":[26800.576145381128],"DVL":[0.030177833442536117,0.010698534858900498,-0.035302697723094967,7.3839567451152757,-0.0069359305785981285,0.021475027443823288,0.004788616732961261,0],"IMU":[0.0010353452815897656,0.11555545509406934,0.78157891140339808,-0.025610004120658402,0.068732098857677393,-0.1175279091998075,1.1152510757396501,0.023564328512408403,-9.7727172996334488],"FOG":[0.79329938753897511],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5813358242878413,-11.115156132960072,-27.46047226969182,61.633397500667499,61.633397500667499],"omega_rad_s":[-3.732309699081672,-11.078975693224914,-27.467689506150183,61.646738750306035,61.646734929727117],"thrust_n":[-0.17852841089129917,-1.568647759137545,-9.62314553491189,48.473406202397292,48.479387575856165],"torque_nm":[0.0033474077042118596,0.029412145483828974,0.18043397877959796,-0.90887636629494939,-0.90898851704730321],"angle_rad":[-563.2452739202954,328.66495551616373,-808.53716600041946,2388.5215886534447,2388.5215738347747]},"command":[-0.034107960231312774,-0.10585862983771498,-0.26152830733039828,0.58698473810159524,0.58698473810159524],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,1.0778494253810979e-21,1.5881867761018145e-24,-1.6940658945088655e-23,-1.1180834903756616e-21],"servo_velocity":[0,0,-1.7347234759768071e-18,0,0,-8.6736173798840355e-19],"servo_effort":[0.016880137933220869,-1.4984457537988309,-0.26985263326731856,2.0636891588343777e-05,-0.00039468490786310931,0.0001051425660547562]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":890,"step":7120,"t":35.600000000000001,"sim_time":35.59999999999976,"vehicle":{"origin_ned":[1.5004259718068282,0.99963405075449252,3.4965829825997083],"origin_quat_xyzw":[-0.021521472386928683,0.053591900580662266,0.38028891757113903,0.9230628762933879],"cg_ned":[1.4399197972374831,0.94036913136110567,3.2041405032990835],"linear_velocity_ned":[0.00039372011514439301,-0.00029173694136729072,0.0011000054411953034],"angular_velocity_ned":[-0.00012081997331658139,0.0001527662296806375,0.0018279806648421621]},"sensors":{"Odom":[1.5004259718068282,0.99963405075449252,3.4965829825997083,5.7278883987145327e-06,-0.00033486216685386314,0.0010918904345985135,-0.021521472386928694,0.053591900580662301,0.38028891757113925,0.9230628762933879,-0.0001890586303568642,0.00019542227374721492,0.001818107606037362],"Pressure":[26802.679401461268],"DVL":[0.0090913618154823492,-0.02068479992990949,0.023878652222547255,7.3695134135868052,-0.016469274876450179,0.013993727844380119,0.043698581101195788,0],"IMU":[0.0010363801552503832,0.11556319251108582,0.78165231475952268,-0.080032996061065315,-0.035286827793119389,-0.0921924406863385,1.1237137072965031,-0.021965591938001752,-9.7596791862796568],"FOG":[0.7836708654068445],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5797046678653217,-11.131547342073862,-27.457539569257268,61.630796059059186,61.630796059059186],"omega_rad_s":[-3.7296724878823571,-11.09612722459747,-27.464852420745792,61.644084576523042,61.644080766597106],"thrust_n":[-0.17826543245505311,-1.5734885268609908,-9.6211809128273806,48.468628175684564,48.474618651394287],"torque_nm":[0.0033424768585322458,0.029502909878643586,0.18039714211551341,-0.90878677829408572,-0.90889909971364291],"angle_rad":[-563.39450933733883,328.22140541106154,-809.63580918091066,2390.9873979730232,2390.9873830017054]},"command":[-0.034092425408241159,-0.10601473659117963,-0.26150037685006922,0.58695996246723037,0.58695996246723037],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,-1.1180834903756616e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.016874785897412255,-1.4985225636948283,-0.26988568617275388,2.0616360204766731e-05,-0.00039471574151154684,0.00010474497716256604]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":891,"step":7128,"t":35.640000000000001,"sim_time":35.63999999999978,"vehicle":{"origin_ned":[1.5004390515434953,0.99962839698963635,3.4966267980817749],"origin_quat_xyzw":[-0.021524587189020977,0.053594817006676163,0.38032249719965128,0.92304879928429795],"cg_ned":[1.4399354523721031,0.94035761139335194,3.204184974818884],"linear_velocity_ned":[0.0003895507785486553,-0.00028511508561396385,0.0011208500589686094],"angular_velocity_ned":[-0.00012714733134061717,0.00014643997365480535,0.0018185403318517555]},"sensors":{"Odom":[1.5004390515434953,0.99962839698963635,3.4966267980817749,4.9597668414490552e-06,-0.00032539124555318392,0.0011127847793990005,-0.021524587189020995,0.053594817006676211,0.38032249719965155,0.92304879928429795,-0.00019685778624049062,0.00019537903321946597,0.0018076985627303226],"Pressure":[26801.43651114569],"DVL":[-0.03261507564688014,-0.017110796339779716,-0.012724173096085239,7.3143132938029609,0.018449303664862832,-0.013513223130244041,0.0013039987836449519,0],"IMU":[0.0010370588526059279,0.11557093395438314,0.78172530022294495,-0.080543422748127314,0.10202461244322399,0.13077142934084005,1.1233027408333442,-0.0024686695499862056,-9.7334599840403513],"FOG":[0.77343953396408804],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5774058311133841,-11.147984273851007,-27.454486387736637,61.628099187566576,61.628099187566576],"omega_rad_s":[-3.726183898085861,-11.113304279810967,-27.461897660426175,61.641331320966842,61.641327540836713],"thrust_n":[-0.17792170887604231,-1.5783437771867284,-9.6191339186806299,48.463720757253085,48.469710863951484],"torque_nm":[0.0033360320414257934,0.029593945822251156,0.18035876097526182,-0.90869476419849526,-0.90880707869909039],"angle_rad":[-563.54361960383267,327.77716866309839,-810.73433619916318,2393.4530988593215,2393.4530837362145]},"command":[-0.034070531724889372,-0.10617127879858101,-0.2614712989308251,0.58693427797682451,0.58693427797682451],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,-1.1180834903756616e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.016862493837932077,-1.4985959142056287,-0.26991825177148843,2.0593568054181582e-05,-0.00039473611545534989,0.00010482119989545376]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":892,"step":7136,"t":35.68,"sim_time":35.679999999999801,"vehicle":{"origin_ned":[1.5004519097854452,0.99962305441712274,3.4966714304239828],"origin_quat_xyzw":[-0.021527857136468327,0.053597664927730861,0.38035589204839232,0.92303479732103166],"cg_ned":[1.4399509401769082,0.94034635235054898,3.2042302623238768],"linear_velocity_ned":[0.00038535696444194623,-0.00027866837444921077,0.0011409035325647106],"angular_velocity_ned":[-0.00013337293460792494,0.00013978822917400579,0.001809054732503024]},"sensors":{"Odom":[1.5004519097854452,0.99962305441712274,3.4966714304239828,4.0533157406683214e-06,-0.00031598670386257145,0.0011328923619023565,-0.021527857136468345,0.053597664927730902,0.38035589204839265,0.92303479732103166,-0.00020480769836259325,0.00019503369250078155,0.0017972266911477951],"Pressure":[26802.050378667824],"DVL":[0.0053968655751415948,0.0096464044172819095,-0.028780295111843882,7.3455155719664758,0.012628311506668455,0.011419874074099497,0.0050399107382888822,0],"IMU":[0.0010373741322058543,0.11557866724916549,0.781797865157427,0.013274321614506764,-0.080876981222146663,-0.042304564324341827,1.1348286041936615,-0.019793371548383891,-9.7259078490920103],"FOG":[0.77893676868287898],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5745253914518229,-11.164467631894844,-27.4513113700236,61.625309144831363,61.625309144831363],"omega_rad_s":[-3.7219349242769155,-11.130508936173767,-27.458823065551631,61.638481066647216,61.63847733474725],"thrust_n":[-0.17750612786166789,-1.5832141541638369,-9.6170030823075088,48.458687071776822,48.464667531440384],"torque_nm":[0.0033282398974062732,0.029685265390571938,0.18031880779326581,-0.90860038259581555,-0.90871251621450733],"angle_rad":[-563.69257274081485,327.33224420298092,-811.83274229808887,2395.9186873962985,2395.9186721230121]},"command":[-0.034043098966207837,-0.10632826316090328,-0.26144106066689143,0.5869077061412511,0.5869077061412511],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,4.3198680309969292e-21,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.016842931773860502,-1.4986655050932718,-0.26995025442633203,2.0566309309072203e-05,-0.00038136677761754691,0.0001053712398403463]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":893,"step":7144,"t":35.719999999999999,"sim_time":35.719999999999821,"vehicle":{"origin_ned":[1.5004645421625504,0.99961801459858834,3.4967168490615825],"origin_quat_xyzw":[-0.021531282277910013,0.053600437886286573,0.38038910127199094,0.92302087114829323],"cg_ned":[1.4399662597052822,0.94033534730380508,3.2042763342395872],"linear_velocity_ned":[0.00038114006573729774,-0.00027239335889364208,0.0011601690608859557],"angular_velocity_ned":[-0.00013946563786797889,0.00013285259842761907,0.0017995223956693536]},"sensors":{"Odom":[1.5004645421625504,0.99961801459858834,3.4967168490615825,3.0138479607388772e-06,-0.00030666221616186968,0.0011522163581250667,-0.021531282277910027,0.053600437886286614,0.38038910127199121,0.92302087114829323,-0.00021285716923660585,0.00019439385667763449,0.0017866964441563759],"Pressure":[26803.298002368676],"DVL":[0.0064297679187171955,0.020379595524477163,-0.053950182785688895,7.394092018902807,-0.0077988820520939594,-0.007662390827680588,0.0038388611667046274,0],"IMU":[0.0010373208266098593,0.11558638051014809,0.78187000711906873,-0.038477819365988597,0.079030958791773784,-0.014180279096242313,1.1262651873776595,-0.036424008660956256,-9.7188177199487598],"FOG":[0.77915945331387271],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5711487041060401,-11.180997098093522,-27.448013901813042,61.62242817557555,61.62242817557555],"omega_rad_s":[-3.7170160909152226,-11.147742673214941,-27.45562692371562,61.635535979889767,61.635532313924074],"thrust_n":[-0.17702753931308932,-1.5881001323620301,-9.6147872475161016,48.453530349522595,48.459492115524007],"torque_nm":[0.0033192663621204243,0.029776877481788065,0.18027726089092691,-0.90850369405354858,-0.90861547716607516],"angle_rad":[-563.84134039873629,326.886630891425,-812.93102264405991,2398.3841597532273,2398.3841443320912]},"command":[-0.034010940039105146,-0.10648568664850973,-0.26140965620774326,0.58688026833881479,0.58688026833881479],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,4.3198680309969292e-21,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,8.6736173798840355e-19,0],"servo_effort":[0.016816092747669979,-1.4987311812996444,-0.2699816454134053,2.0538261936103133e-05,-0.00039477681164722383,0.00010545590667168505]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":894,"step":7152,"t":35.759999999999998,"sim_time":35.759999999999842,"vehicle":{"origin_ned":[1.5004769448445694,0.99961326887376101,3.4967630235340428],"origin_quat_xyzw":[-0.021534861775646331,0.053603129960651114,0.3804221240430351,0.92300702149296288],"cg_ned":[1.4399814100586685,0.94032458946663999,3.2043231591236916],"linear_velocity_ned":[0.00037690114254106257,-0.00026628639298413727,0.0011786500263732658],"angular_velocity_ned":[-0.00014539499315572129,0.0001256747296692358,0.0017899412974666325]},"sensors":{"Odom":[1.5004769448445694,0.99961326887376101,3.4967630235340428,1.8467130525203857e-06,-0.00029743099202859193,0.0011707600900973398,-0.021534861775646345,0.053603129960651141,0.38042212404303533,0.92300702149296288,-0.00022095539508087766,0.00019346764302593676,0.0017761116728897892],"Pressure":[26802.670525288839],"DVL":[0.035083880399939128,-0.016929041369996883,-0.012069459390546041,7.3000460207199298,-0.016700119810021907,-0.021351013092704086,0.0019421712273551784,0],"IMU":[0.0010368958269968422,0.11559406216810715,0.78194172382995597,-0.028889314688082143,-0.066223569740911759,-0.081946287244412094,1.1296060863864119,-0.0092477620049600962,-9.7149386296339149],"FOG":[0.79026625495072167],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5673603272836751,-11.197571977726415,-27.444593706471,61.619458584578531,61.619458584578531],"omega_rad_s":[-3.7115173190026609,-11.165006381830937,-27.452307972568807,61.632498298324734,61.632494715242117],"thrust_n":[-0.176494726289947,-1.5930020196582193,-9.6124855749358211,48.448253920920813,48.454188194395435],"torque_nm":[0.0033092761179365059,0.02986878786859162,0.18023410453004671,-0.90840476101726553,-0.90851602864491454],"angle_rad":[-563.98989783565673,326.4403275435622,-814.02917234529878,2400.8495121876749,2400.8494966217108]},"command":[-0.033974860259844523,-0.10664354264501348,-0.26137708291877143,0.58685198651979553,0.58685198651979553],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,4.3198680309969292e-21,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.016781916804113253,-1.4987928027451005,-0.27001237137671058,2.0506562198069009e-05,-0.00038143096778932051,0.00010554397580559314]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":895,"step":7160,"t":35.800000000000004,"sim_time":35.799999999999862,"vehicle":{"origin_ned":[1.5004891145304837,0.999608808374844,3.4968099234902978],"origin_quat_xyzw":[-0.02153859391950708,0.053605735771533013,0.38045495954080977,0.92299324906803293],"cg_ned":[1.4399963903743231,0.94031407220138841,3.2043707056731523],"linear_velocity_ned":[0.00037264098329030756,-0.00026034372971734749,0.0011963499922545738],"angular_velocity_ned":[-0.00015113139595465216,0.00011829651539312124,0.0017803086993001113]},"sensors":{"Odom":[1.5004891145304837,0.999608808374844,3.4968099234902978,5.5734661330163367e-07,-0.00028830591145839605,0.0011885270080841624,-0.021538593919507087,0.053605735771533033,0.38045495954080988,0.92299324906803293,-0.00022905191127673194,0.0001922639246841845,0.0017654754697832883],"Pressure":[26803.948011393622],"DVL":[-0.0016919229354716791,0.00036352661953564455,0.036712094297271132,7.3414166195013681,0.0089622991520116446,-0.046732218081236038,-0.040710435981153356,0],"IMU":[0.0010360980611203961,0.11560170099223825,0.78201301315309757,-0.05477355797336899,-0.031219425144290856,0.029144092737016191,1.1430980552707186,-0.021722006891053934,-9.7704125884491244],"FOG":[0.76523214540961704],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5632435651714207,-11.21419120674077,-27.441050825598616,61.61640273327648,61.61640273327648],"omega_rad_s":[-3.7055277068849333,-11.182300420499214,-27.448865367341639,61.629370326282732,61.629366842255109],"thrust_n":[-0.17591637050708536,-1.5979199717381853,-9.6100975191810765,48.44286120741036,48.44875945817823],"torque_nm":[0.0032984319470078507,0.029960999470090986,0.18018932848464522,-0.90830364763894433,-0.90841423984084191],"angle_rad":[-564.13822388840651,325.99333295123205,-815.12718646917142,2403.3147410482443,2403.3147253411335]},"command":[-0.033935653001632579,-0.10680182101657876,-0.2613433411961773,0.58682288317406173,0.58682288317406173],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,4.3368086899420177e-19],"servo_effort":[0.016740315452573797,-1.4988501560992682,-0.27004237437541273,2.0472007363261473e-05,-0.00039485439217377055,0.00010563580174142802]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":896,"step":7168,"t":35.840000000000003,"sim_time":35.839999999999883,"vehicle":{"origin_ned":[1.500501048451945,0.99960462403331884,3.4968575186893109],"origin_quat_xyzw":[-0.021542476136818582,0.053608250501345441,0.38048760692920774,0.9229795545803624],"cg_ned":[1.4400111998182685,0.9403037890184438,3.2044189427284255],"linear_velocity_ned":[0.00036836018806110177,-0.00025456164728653968,0.0012132724857941389],"angular_velocity_ned":[-0.00015664625381249525,0.00011076028316725042,0.0017706207495739965]},"sensors":{"Odom":[1.500501048451945,0.99960462403331884,3.4968575186893109,-8.4865825631169818e-07,-0.00027929971128789013,0.0012055204591054924,-0.021542476136818593,0.053608250501345468,0.38048760692920791,0.9229795545803624,-0.00023709653146014443,0.00019079258470854104,0.0017547897744096201],"Pressure":[26802.834150594004],"DVL":[-0.015821571361183083,0.0089584771950293272,-0.0037667994605281923,7.3442064711696231,-0.012971860153333528,-0.0031237733719592896,0.00125456545770593,0],"IMU":[0.0010349284869552694,0.11560928613317517,0.78208387304531335,0.064321846669734214,0.031803498963927486,-0.055580340785248462,1.140965055760921,-0.01986900657462834,-9.760920185132651],"FOG":[0.81486209672695198],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5588842348570271,-11.23085265374012,-27.437386147215555,61.613263057571288,61.613263057571288],"omega_rad_s":[-3.6991362192509873,-11.19962450360754,-27.445298775026913,61.626154435718618,61.6261510661123],"thrust_n":[-0.17530110628385628,-1.6028539581145611,-9.6076228956860792,48.437355722305945,48.44320972160898],"torque_nm":[0.0032868957428223056,0.030053511714648019,0.18014292929411402,-0.90820041979323651,-0.90831018228016835],"angle_rad":[-564.2863009506799,325.54564590585699,-816.22506006035451,2405.7798427772336,2405.7798269332861]},"command":[-0.033894135570066923,-0.10696050146419162,-0.26130843949729099,0.58679298150067893,0.58679298150067893],"arm":{"servo_position":[2.2499312661440551e-24,3.2526065174565154e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,-8.6736173798840355e-19,4.3368086899420177e-19],"servo_effort":[0.016691661964623489,-1.4989031953226908,-0.27007163704469661,2.0408440243733336e-05,-0.00038151504198651276,0.00010572993647167595]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":897,"step":7176,"t":35.880000000000003,"sim_time":35.879999999999903,"vehicle":{"origin_ned":[1.5005127443382884,0.99960070660415001,3.4969057789582902],"origin_quat_xyzw":[-0.021546505020306764,0.053610669886040102,0.38052006534994831,0.92296593873330501],"cg_ned":[1.4400258375603772,0.94029373358761681,3.2044678392321435],"linear_velocity_ned":[0.00036405849773412887,-0.00024893599422029462,0.0012294192126394577],"angular_velocity_ned":[-0.0001619120174174307,0.00010310690907525181,0.0017608736184045331]},"sensors":{"Odom":[1.5005127443382884,0.99960070660415001,3.4969057789582902,-2.3658939746063325e-06,-0.00027042370003550211,0.0012217419610468664,-0.021546505020306767,0.053610669886040109,0.38052006534994831,0.92296593873330501,-0.00024504082073799387,0.00018906320081258548,0.0017440563460928836],"Pressure":[26803.230441734358],"DVL":[0.041797697598887976,-0.0025168666865016931,0.010708991480241497,7.3831465155241318,0.017564715827958721,0.016253583977154231,-0.0018153387409118326,0],"IMU":[0.0010333900338425626,0.11561680712881937,0.78215430153932575,0.048193833109781863,-0.0094036012231716558,-0.074767245500701851,1.1293097818179973,-0.0072415355401960115,-9.7290849624514113],"FOG":[0.78430057276092402],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5543630397359953,-11.247553859107143,-27.433600731780651,61.610042437725973,61.610042437725973],"omega_rad_s":[-3.6924309233260919,-11.216977702429226,-27.441608352138896,61.622853148265655,61.622849907619376],"thrust_n":[-0.17465743735180533,-1.607803762964173,-9.6050618636173954,48.431741260952798,48.437543075254048],"torque_nm":[0.00327482695034635,0.030146320555578254,0.1800949099428262,-0.908095148642865,-0.90820393266101362],"angle_rad":[-564.43411496224553,325.09726522543281,-817.3227881619074,2408.2448139146763,2408.2447979387994]},"command":[-0.033851076568914243,-0.10711956056292517,-0.26127238792172047,0.58676230893072356,0.58676230893072356],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.016636855416885737,-1.4989520532203588,-0.27010020034748888,2.0248828386488599e-05,-0.00039495051423122225,0.00010582416904057075]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":898,"step":7184,"t":35.920000000000002,"sim_time":35.919999999999924,"vehicle":{"origin_ned":[1.5005242003951667,0.99959704668215954,3.4969546741914663],"origin_quat_xyzw":[-0.021550676353084195,0.053612990205639886,0.38055233392471238,0.92295240222580743],"cg_ned":[1.4400403027640258,0.94028389974262339,3.2045173642279603],"linear_velocity_ned":[0.00035973590492245627,-0.0002434627178418627,0.0012447937690061126],"angular_velocity_ned":[-0.00016690230431240668,9.5376650851856205e-05,0.0017510638962809392]},"sensors":{"Odom":[1.5005242003951667,0.99959704668215954,3.4969546741914663,-3.9889496333735813e-06,-0.00026168902405880568,0.0012371949047961079,-0.021550676353084205,0.053612990205639914,0.38055233392471255,0.92295240222580743,-0.00025283764564959,0.0001870857246507053,0.0017332772167617577],"Pressure":[26803.8006914035],"DVL":[0.011044159227682303,0.011677561790217214,-0.012446727816103455,7.3429174352864237,0.029973927790687825,-0.00095602947212566154,-0.003936813829244646,0],"IMU":[0.001031487549172085,0.11562425390554075,0.78222429674538085,0.010816389074116787,0.046958579162036461,0.16891351629193188,1.1303695110160852,-0.012625794194236727,-9.7334803246965595],"FOG":[0.7873991081605175],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5497582188679626,-11.264292392904801,-27.429695637711173,61.606744076088418,61.606744076088418],"omega_rad_s":[-3.6854977341806503,-11.234358616090923,-27.437794590937283,61.619469263933254,61.61946616595111],"thrust_n":[-0.17399361282126519,-1.6127690330979745,-9.602414816150409,48.426022017290599,48.431764016489083],"torque_nm":[0.0032623802403987223,0.030239419370587019,0.18004527780282015,-0.90798791282419877,-0.90809557530917051],"angle_rad":[-564.58165533410943,324.64818977679073,-818.42036583126821,2410.7096511083014,2410.7096350059646]},"command":[-0.033807221132075835,-0.10727897517052191,-0.26123519654963023,0.58673089596274686,0.58673089596274686],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.016574840005239358,-1.4989964089461563,-0.27012793659553086,2.0081952858907706e-05,-0.00039500450734729277,0.00010592134717481429]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":899,"step":7192,"t":35.960000000000001,"sim_time":35.959999999999944,"vehicle":{"origin_ned":[1.5005354152974664,0.99959363472292695,3.4970041744126839],"origin_quat_xyzw":[-0.021554985143346157,0.053615208280029913,0.38058441175817365,0.92293894575060809],"cg_ned":[1.4400545945895096,0.94027428148351688,3.2045674869246619],"linear_velocity_ned":[0.00035539219986991251,-0.00023813758406190848,0.0012594004435118307],"angular_velocity_ned":[-0.00017159243542898313,8.760854939069039e-05,0.0017411884051525188]},"sensors":{"Odom":[1.5005354152974664,0.99959363472292695,3.4970041744126839,-5.7124107316381832e-06,-0.00025310593132846118,0.0012518833515943865,-0.021554985143346167,0.053615208280029948,0.38058441175817381,0.92293894575060809,-0.00026044194938761484,0.00018487043565043213,0.0017224544107412429],"Pressure":[26806.344841757273],"DVL":[-0.010690698972439017,-0.051080337096567001,0.014185677338892233,7.3413802934993111,0.023445949454681373,-0.0097838812011703854,0.014654143620153581,0],"IMU":[0.0010292277311889704,0.11563161679654871,0.78229385685441344,0.090666604047412974,-0.11690675340442994,-0.0049479368808739901,1.1431974132541474,-0.022845115029779262,-9.7238691634762571],"FOG":[0.78969547425995035],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5451475460615178,-11.281066294284273,-27.425672016251731,61.603370550420905,61.603370550420905],"omega_rad_s":[-3.6784211317580664,-11.25176569688931,-27.433858215187851,61.616005569085459,61.616002626628863],"thrust_n":[-0.17331769022263302,-1.6177493701982864,-9.5996823080337101,48.420202129596476,48.425876998985046],"torque_nm":[0.0032497066916743695,0.030332800691217875,0.17999404327563207,-0.90787878992993409,-0.90798519373096986],"angle_rad":[-564.72891488219238,324.19841848654869,-819.51778815084765,2413.1743511178665,2413.174334895069]},"command":[-0.033763309962490648,-0.10743872661223117,-0.26119687634525457,0.58669876714686575,0.58669876714686575],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.016505974379602759,-1.4990362121708158,-0.27015481272547204,1.9907790715946337e-05,-0.00039506287323363471,0.00010602102512244748]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":900,"step":7200,"t":36,"sim_time":35.999999999999964,"vehicle":{"origin_ned":[1.5005463881658023,0.99959046106207472,3.4970542497894193],"origin_quat_xyzw":[-0.021559425661597277,0.053617321459434771,0.38061629793927576,0.92292556999340847],"cg_ned":[1.4400687121843136,0.94026487297749461,3.2046181767110218],"linear_velocity_ned":[0.00035102698525882423,-0.00023295643217168929,0.0012732438888027825],"angular_velocity_ned":[-0.00017595920693031764,7.9840924437079316e-05,0.0017312439620860872]},"sensors":{"Odom":[1.5005463881658023,0.99959046106207472,3.4970542497894193,-7.5309319551142674e-06,-0.00024468413251785433,0.0012658116776955691,-0.021559425661597291,0.053617321459434805,0.38061629793927604,0.92292556999340847,-0.00026781021660491646,0.00018242813224464459,0.0017115897687313413],"Pressure":[26805.414321058604],"DVL":[-0.011585543530481378,0.021360295573155195,-0.038297813226815094,7.4191943250275756,-0.008942985087517898,-0.031387301999206862,0.016143534740648547,0],"IMU":[0.0010266190527934847,0.11563888655237793,0.78236298013669248,-0.00094353992091755225,-0.016541277272409196,0.098455600580435551,1.1364470247018017,-0.0093190064800872559,-9.776624714364198],"FOG":[0.775919445658527],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5406053308886438,-11.297873609197394,-27.42153093046225,61.599924454911495,61.599924454911495],"omega_rad_s":[-3.6712833826120517,-11.269197333765517,-27.429800097892723,61.612464821820581,61.612462046904092],"thrust_n":[-0.17263745981956191,-1.6227443536327606,-9.5968649965912913,48.414285676964056,48.419886429772802],"torque_nm":[0.0032369523716167868,0.030426456630614267,0.17994121868608676,-0.907767856443076,-0.90787287055824029],"angle_rad":[-564.87588975084725,323.74795034453371,-820.61505023563961,2415.6389108139447,2415.6388944771807]},"command":[-0.033720050770368035,-0.10759879627807042,-0.26115743743297382,0.58666594718963327,0.58666594718963327],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,4.3368086899420177e-19],"servo_effort":[0.016430319137222441,-1.4990712432590829,-0.2701807668192977,1.9727276669136239e-05,-0.00039512406295423878,0.00010612278957241905]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":901,"step":7208,"t":36.039999999999999,"sim_time":36.039999999999985,"vehicle":{"origin_ned":[1.5005571185510551,0.99958751594918316,3.4971048706386716],"origin_quat_xyzw":[-0.021563991490747218,0.053619327631502817,0.38064799153920209,0.92291227563214462],"cg_ned":[1.4400826546750531,0.94025566856392462,3.2046694031659668],"linear_velocity_ned":[0.0003466396774065809,-0.00022791487853896002,0.0012863289633650091],"angular_velocity_ned":[-0.00017998232088920339,7.2111204853901964e-05,0.0017212275442729731]},"sensors":{"Odom":[1.5005571185510551,0.99958751594918316,3.4971048706386716,-9.4387438639266595e-06,-0.00023643224622040535,0.0012789843966191899,-0.021563991490747249,0.053619327631502886,0.38064799153920259,0.92291227563214462,-0.00027490161910458935,0.0001797710206483856,0.0017006849798862904],"Pressure":[26806.995945118651],"DVL":[0.0082682693964505512,-0.034618618022390434,-0.0065772527081880633,7.4530858656257051,-0.005892688210038354,0.0051893646854132862,0.012531921533921313,0],"IMU":[0.0010236716738017512,0.1156460543919858,0.78243166493361482,-0.030736428195773619,-0.023825892885651689,0.059351534540779786,1.1263506228335733,0.0033709116771741907,-9.7494619410111696],"FOG":[0.79309449649711694],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5362021628379203,-11.314712850947114,-27.417273845850101,61.596408421286007,61.596408421286007],"omega_rad_s":[-3.6641642942860004,-11.286651944866984,-27.425621303634671,61.608849764939428,61.6088471687127],"thrust_n":[-0.17196042132849915,-1.6277535675348147,-9.5939636729309932,48.408276688885124,48.41379670998878],"torque_nm":[0.0032242578999093596,0.030520379391277771,0.17988681886745614,-0.90765518791659616,-0.90775868831228979],"angle_rad":[-565.0225793228027,323.29678440525305,-821.71214723959099,2418.1033271769943,2418.1033107332182]},"command":[-0.033678115836551621,-0.10775917000902013,-0.26111689377000097,0.58663246115510481,0.58663246115510481],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,-8.6736173798840355e-19,0,0,0,0],"servo_effort":[0.016348096204744963,-1.4991013145566934,-0.27020573041540336,1.9541029022330175e-05,-0.00039518907225140316,0.00010622621701701654]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":902,"step":7216,"t":36.079999999999998,"sim_time":36.080000000000005,"vehicle":{"origin_ned":[1.5005676064114688,0.99958478956490093,3.497156007438563],"origin_quat_xyzw":[-0.02156867556454594,0.05362122520145407,0.38067949160876086,0.92289906333833793],"cg_ned":[1.4400964211638325,0.94024666275503876,3.204721136069467],"linear_velocity_ned":[0.00034222963047806753,-0.00022300864116102536,0.001298660813244808],"angular_velocity_ned":[-0.00018364200206728425,6.4454735480151394e-05,0.0017111359436097024]},"sensors":{"Odom":[1.5005676064114688,0.99958478956490093,3.497156007438563,-1.1430560577883203e-05,-0.00022835839421794137,0.0012914063514514402,-0.021568675564545951,0.053621225201454098,0.38067949160876102,0.92289906333833793,-0.00028167713233755891,0.00017691018905634031,0.0016897413392257124],"Pressure":[26804.637266985425],"DVL":[-0.01220682619203396,0.024059883697430968,-0.023165963613117155,7.4028428115273828,0.0067941375120387035,0.010238698945133889,0.001450133273317144,0],"IMU":[0.0010203973540727134,0.1156531119950807,0.78249990964683946,0.053891069702332373,-0.038531137406354006,-0.020508886735388789,1.1172515545056523,-0.025441291614398509,-9.7463374512452496],"FOG":[0.79805695601766469],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5320058176796292,-11.331582285211086,-27.412902330590978,61.592825069942066,61.592825069942066],"omega_rad_s":[-3.6571406690457033,-11.304128024932428,-27.42132310574932,61.605163135084339,61.605160727819658],"thrust_n":[-0.17129373506642426,-1.6327766146756462,-9.5909792753094347,48.402179188686119,48.407612207215678],"torque_nm":[0.0032117575324954553,0.030614561525168369,0.1798308614120519,-0.90754085978786481,-0.90764272888529407],"angle_rad":[-565.1689861029555,322.84491978370687,-822.80907436427196,2420.5675972970766,2420.5675807536704]},"command":[-0.033638150644567898,-0.10791983128772463,-0.26107526029134265,0.58659833399944827,0.58659833399944827],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,4.3368086899420177e-19],"servo_effort":[0.016259358354685904,-1.4991265372634368,-0.27022960012127067,1.9358012337524269e-05,-0.0003952563838598935,0.00010633178091295768]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":903,"step":7224,"t":36.119999999999997,"sim_time":36.120000000000026,"vehicle":{"origin_ned":[1.500577852089279,0.99958227203344707,3.4972076308414017],"origin_quat_xyzw":[-0.021573470201500248,0.053623013067685452,0.38071079717374673,0.92288593377965067],"cg_ned":[1.4401100107253544,0.94023785023572259,3.2047733454138925],"linear_velocity_ned":[0.0003377961397120571,-0.0002182333738700904,0.0013102448679703001],"angular_velocity_ned":[-0.00018692005766669562,5.6905380320324982e-05,0.0017009658427527691]},"sensors":{"Odom":[1.500577852089279,0.99958227203344707,3.4972076308414017,-1.350110801484901e-05,-0.00022046998437778783,0.0013030826651827638,-0.021573470201500272,0.053623013067685514,0.38071079717374717,0.92288593377965067,-0.00028809986852409579,0.00017385678321841572,0.0016787597842349291],"Pressure":[26806.111164177339],"DVL":[0.015203531995805127,-0.0080399210164530544,0.0024966971266896692,7.3223284090838847,0.014586214889432441,0.009468455275407019,-0.019404059401056641,0],"IMU":[0.0010168093712760071,0.11566005148261325,0.78256771272301506,0.072277539676211852,0.046547242917811905,0.035648957955683493,1.1526460272968189,-0.0061391926684279813,-9.7335320688541547],"FOG":[0.78610346155098909],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5280815108680659,-11.348479524828095,-27.40841804580835,61.589177001961474,61.589177001961474],"omega_rad_s":[-3.6502865304922651,-11.321623851604652,-27.416906931228663,61.601407656406479,61.601405447510011],"thrust_n":[-0.17064424687038185,-1.6378130317824975,-9.5879128507071645,48.395997172956548,48.401337259078986],"torque_nm":[0.0031995796288196592,0.030708994345921829,0.17977336595075938,-0.90742494699293541,-0.90752507360773094],"angle_rad":[-565.31511560547403,322.39235565992334,-823.90582686566802,2423.0317183734464,2423.0317017381831]},"command":[-0.033600776293981581,-0.10808075737931519,-0.26103255281722237,0.58656359049487117,0.58656359049487117],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,-4.3368086899420177e-19],"servo_effort":[0.01616433664396584,-1.4991468939677126,-0.27025254620969308,1.9163482224828231e-05,-0.00039532722837650245,0.00010643877533659039]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":904,"step":7232,"t":36.160000000000004,"sim_time":36.160000000000046,"vehicle":{"origin_ned":[1.5005878562896682,0.99957995344627049,3.4972597116830126],"origin_quat_xyzw":[-0.021578367152112747,0.053624690607839337,0.38074190723408929,0.92287288761996367],"cg_ned":[1.4401234224041373,0.94022922586443947,3.2048260014141268],"linear_velocity_ned":[0.00033333837818393238,-0.00021358475785304394,0.0013210867985166488],"angular_velocity_ned":[-0.00018980040496539521,4.9495193091685016e-05,0.0016907143449902743]},"sensors":{"Odom":[1.5005878562896682,0.99957995344627049,3.4972597116830126,-1.5645185743492124e-05,-0.00021277350893232635,0.0013140186794142886,-0.021578367152112761,0.053624690607839372,0.38074190723408957,0.92287288761996367,-0.00029413574020031039,0.00017062214602010949,0.0016677413510027311],"Pressure":[26808.75035290969],"DVL":[0.022226813175578907,-0.017648967388995573,0.034761598301817041,7.363380724000959,0.0074218683017038458,-0.015431823716288326,0.008868063070795254,0],"IMU":[0.0010129224224382451,0.11566686542683778,0.78263507264648002,0.08298856203460149,-0.026840597336396307,-0.0014498869393443758,1.1320207440303378,-0.023631912320363463,-9.7349131939713978],"FOG":[0.7731429630638651],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5244910934911107,-11.365402160170918,-27.403822917180936,61.58546682258271,61.58546682258271],"omega_rad_s":[-3.6436729018279652,-11.339137514504024,-27.412374396404967,61.59758604283968,61.597584040860724],"thrust_n":[-0.17001847253030244,-1.6428622974996532,-9.5847655774403222,48.3897346118586,48.3949761840381],"torque_nm":[0.0031878463599431714,0.030803668078118494,0.17971435457700602,-0.90730752397234893,-0.90740580345071464],"angle_rad":[-565.46097623792605,321.93909128738198,-825.00240006112597,2425.4956877140708,2425.4956709950802]},"command":[-0.033566581842772482,-0.10824192533496112,-0.26098878968743749,0.58652825545316867,0.58652825545316867],"arm":{"servo_position":[2.2499312661440551e-24,3.2526065174565154e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,8.6736173798840355e-19,0,0,0,4.3368086899420177e-19],"servo_effort":[0.016063237616238936,-1.4991626779459912,-0.27027468577499836,1.8948149307391543e-05,-0.00039540055303517176,0.00010654722718656495]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":905,"step":7240,"t":36.200000000000003,"sim_time":36.200000000000067,"vehicle":{"origin_ned":[1.5005976200531892,0.99957782388326222,3.4973122209942873],"origin_quat_xyzw":[-0.021583357649913534,0.053626257658039113,0.38077282076681196,0.92285992551818752],"cg_ned":[1.4401366552101675,0.94022078467076464,3.2048790745190732],"linear_velocity_ned":[0.00032885550279875009,-0.0002090585313250157,0.0013311926040546285],"angular_velocity_ned":[-0.00019226877529811146,4.2254522500471037e-05,0.0016803784226929847]},"sensors":{"Odom":[1.5005976200531892,0.99957782388326222,3.4973122209942873,-1.7857663511906146e-05,-0.00020527477014936266,0.0013242200534688557,-0.021583357649913548,0.053626257658039155,0.38077282076681224,0.92285992551818752,-0.00029975311429919846,0.00016721768367840653,0.0016566866592122071],"Pressure":[26807.04531301625],"DVL":[-7.7947313760630844e-05,-0.0010405306544718673,-0.0029742994001806322,7.3773496563920187,0.0044669371200782319,0.021147247801615844,-0.038970125189529255,0],"IMU":[0.0010087525136693611,0.11567354685164213,0.78270198793929646,0.0020048262653745929,0.070794570735566456,0.10233729587482188,1.1218142630958456,0.0067002459694218454,-9.761168693428754],"FOG":[0.79490297484652628],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5212915670951954,-11.382347938831746,-27.39911868916111,61.581697125848038,61.581697125848038],"omega_rad_s":[-3.637367162386612,-11.356667039329652,-27.407727207763259,61.593700999720539,61.593699212362758],"thrust_n":[-0.16942254441943289,-1.6479238676523216,-9.5815386965340501,48.383395452505226,48.388533278195496],"torque_nm":[0.0031766727078643663,0.030898572518481035,0.17965385056001343,-0.90718866473447313,-0.90728499896616577],"angle_rad":[-565.60657916663718,321.48512599743748,-826.09878933489176,2427.9595027352989,2427.9594859410331]},"command":[-0.033536110162811383,-0.10840331370315949,-0.2609439875158201,0.58649235357950513,0.58649235357950513],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.015956195356132307,-1.4991733844480648,-0.27029559350760757,1.8740491905903875e-05,-0.00039547596013797564,0.0001066571021361118]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":906,"step":7248,"t":36.240000000000002,"sim_time":36.240000000000087,"vehicle":{"origin_ned":[1.5006071447362206,0.9995758734340604,3.497365130010933],"origin_quat_xyzw":[-0.021588432457742175,0.053627714497735131,0.38080353672157113,0.92284704812992158],"cg_ned":[1.4401497081177008,0.94021252185514126,3.2049325354219365],"linear_velocity_ned":[0.00032434656358847579,-0.00020465046444215329,0.0013405684935355767],"angular_velocity_ned":[-0.00019431268637333507,3.5212034967662488e-05,0.0016699553718876779]},"sensors":{"Odom":[1.5006071447362206,0.9995758734340604,3.497365130010933,-2.0133514535805542e-05,-0.00019797877079320294,0.0013336926413543308,-0.021588432457742186,0.053627714497735152,0.3808035367215713,0.92284704812992158,-0.00030492282920631809,0.00016365486353740836,0.0016455963677214612],"Pressure":[26809.259791038403],"DVL":[-0.0065945184057252422,-0.020813208641340994,-0.0079653626958821298,7.3406375381912508,0.033493297835127944,0.0080136173037217359,0.012676514170772644,0],"IMU":[0.0010043168620884684,0.11568008923967049,0.78276845714606813,-0.0055030503251862354,-0.010009620414631324,-0.058779226918409373,1.1259519497999768,0.00721493317667821,-9.7360428973459872],"FOG":[0.7769806729590365],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5185365670220428,-11.399314189714982,-27.394307546588482,61.577870496995544,61.577870496995544],"omega_rad_s":[-3.6314330780275856,-11.374210269348225,-27.402967250275037,61.589755219394362,61.589753653525484],"thrust_n":[-0.16886222201993989,-1.6529971409211592,-9.5782335732000536,48.376983613273715,48.382012812534228],"torque_nm":[0.0031661666628738728,0.030993696392271744,0.17959187949750099,-0.9070684427488821,-0.90716274023501697],"angle_rad":[-565.75193817181616,321.0304592046416,-827.19499014340101,2430.4231609613585,2430.4231441005613]},"command":[-0.033509872066876598,-0.10856489704490459,-0.26089816711036651,0.58645590949519566,0.58645590949519566],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.015843530923924983,-1.4991792093189105,-0.27031542479781467,1.852798580307654e-05,-0.00039555332007587074,0.00010676756313458461]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":907,"step":7256,"t":36.280000000000001,"sim_time":36.280000000000108,"vehicle":{"origin_ned":[1.5006164319920074,0.9995740922134847,3.4974184101824988],"origin_quat_xyzw":[-0.021593581913396793,0.053629061836154145,0.38083405401513259,0.92283425610947178],"cg_ned":[1.4401625800635292,0.94020443278286858,3.2049863550700004],"linear_velocity_ned":[0.00031981062007043149,-0.00020035646895111411,0.0013492208121923016],"angular_velocity_ned":[-0.00019592219492012026,2.8395151139832354e-05,0.0016594414331608056]},"sensors":{"Odom":[1.5006164319920074,0.9995740922134847,3.4974184101824988,-2.2467550216542656e-05,-0.00019088992505921409,0.0013424423771450985,-0.021593581913396814,0.0536290618361542,0.38083405401513293,0.92283425610947178,-0.00030961825978433928,0.00015994605367994154,0.0016344697777204978],"Pressure":[26807.718240407001],"DVL":[-0.016670039763490248,0.0062829116228871312,-0.028909753109543666,7.3681672420041959,-0.017415059673683123,0.017826996590826118,-0.0022896959848212541,0],"IMU":[0.00099963380002611804,0.11568648654195796,0.7828344788166447,0.080069011882650212,0.051725047599928686,-0.040863695708455515,1.1481069516002429,-0.035697304211069737,-9.7268503857469781],"FOG":[0.78547718391591315],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5162770677875135,-11.416298058724296,-27.389391613706351,61.57398948766992,61.57398948766992],"omega_rad_s":[-3.6259308240919799,-11.391764905175158,-27.398096516601946,61.585751379922918,61.585750041585371],"thrust_n":[-0.16834290279903188,-1.658081468381075,-9.5748516489654811,48.370502975932723,48.375419041297491],"torque_nm":[0.0031564294274818482,0.03108902753214516,0.1795284684181028,-0.90694693079873867,-0.90703910702432788],"angle_rad":[-565.89706950053744,320.57509041251052,-828.29099802084488,2432.8866600238998,2432.8866431055694]},"command":[-0.033488353026547749,-0.10872664817832663,-0.26085134870196525,0.58641894750161827,0.58641894750161827],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,4.3368086899420177e-19],"servo_effort":[0.01572794823696945,-1.4991818438003996,-0.27033463696853821,1.8311148227810686e-05,-0.00039563288506905443,0.0001068786434941472]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":908,"step":7264,"t":36.32,"sim_time":36.320000000000128,"vehicle":{"origin_ned":[1.5006254837654394,0.99957247039038466,3.4974720331687141],"origin_quat_xyzw":[-0.021598795991867231,0.053630300817445617,0.38086437150306462,0.92282155011979827],"cg_ned":[1.4401752699503316,0.94019651298062801,3.2050405046657167],"linear_velocity_ned":[0.00031524692177197503,-0.00019617254664478252,0.0013571561201398891],"angular_velocity_ned":[-0.0001970897930266622,2.1830093027051936e-05,0.0016488322597992171]},"sensors":{"Odom":[1.5006254837654394,0.99957247039038466,3.4974720331687141,-2.4854277576942323e-05,-0.0001840121410916419,0.0013504753739688215,-0.021598795991867249,0.053630300817445666,0.3808643715030649,0.92282155011979827,-0.000313815265185369,0.00015610448448302424,0.0016233053100672046],"Pressure":[26808.389356468375],"DVL":[0.023205764390174858,0.011383455606363214,0.055201780068303924,7.3804875509272705,-0.017859524192033654,0.0086255069943023052,0.016203940596197002,0],"IMU":[0.00099472265994832187,0.11569273323490879,0.78290005143947738,-0.068648171988172163,0.025865163605575718,-0.038043051838041186,1.1493334752065383,-0.0058740122383231057,-9.7689781457442315],"FOG":[0.78945260027999609],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5145604708304141,-11.433295007964754,-27.384374601918477,61.570056807638416,61.570056807638416],"omega_rad_s":[-3.6209170114260236,-11.409328050821888,-27.393117498847783,61.581692185761057,61.581691080157483],"thrust_n":[-0.16786963364636839,-1.6631760212800597,-9.5713947176258802,48.363957444038867,48.368756275331101],"torque_nm":[0.0031475556308694073,0.031184550399001122,0.17946365095548528,-0.90682420207572878,-0.90691418016245828],"angle_rad":[-566.04199172496465,320.11901922905963,-829.38680859130932,2435.3499976621601,2435.349980695516]},"command":[-0.033472004484099184,-0.1088885238853786,-0.26080356763731882,0.58638149340608015,0.58638149340608015],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,1.0778494253810979e-21,1.5881867761018145e-24,-4.3537493488871065e-21,1.0503208545953473e-21],"servo_velocity":[0,-8.6736173798840355e-19,-1.7347234759768071e-18,0,-8.6736173798840355e-19,0],"servo_effort":[0.015608521536433835,-1.4991805811556127,-0.27035300810843726,1.8091640372812557e-05,-0.00039571338912387761,0.00010699003521907447]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":909,"step":7272,"t":36.359999999999999,"sim_time":36.360000000000149,"vehicle":{"origin_ned":[1.5006343022507915,0.9995709982104054,3.4975259708598734],"origin_quat_xyzw":[-0.021604064357020496,0.053631432975330483,0.38089448800677539,0.92280893082280402],"cg_ned":[1.4401877766436022,0.94018875813821545,3.2050949556832249],"linear_velocity_ned":[0.00031065436086422869,-0.0001920945971852055,0.0013643813249510348],"angular_velocity_ned":[-0.00019780929153415222,1.5539033700298264e-05,0.0016381259575847344]},"sensors":{"Odom":[1.5006343022507915,0.9995709982104054,3.4975259708598734,-2.728900673810682e-05,-0.00017734768476970685,0.0013577981677213797,-0.021604064357020503,0.053631432975330504,0.38089448800677556,0.92280893082280402,-0.00031749375033702864,0.00015214144418860818,0.0016121033868073164],"Pressure":[26811.818898854108],"DVL":[-0.0098814041529793704,-0.0084457360487040674,-0.008575584691408334,7.435720266876471,0.030210220643282854,-0.015061712343291882,-0.014499249334525359,0],"IMU":[0.00098960364708055833,0.11569882427567101,0.78296517349171879,-0.026947051526377948,-0.13222506310704557,0.070628149062509055,1.1316278711881655,-0.0029594224126154589,-9.7233175913618215],"FOG":[0.78641520348668237],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5134278528804304,-11.450301956935954,-27.379259281567997,61.566075025883876,61.566075025883876],"omega_rad_s":[-3.6164442486180448,-11.426896607523441,-27.388032963759837,61.577580334199858,61.577579465699138],"thrust_n":[-0.16744707885680851,-1.6682799088733629,-9.5678647582533145,48.357350922382466,48.36202877172223],"torque_nm":[0.0031396327285651594,0.031280248291375559,0.1793974642172497,-0.9067003297946713,-0.90678803946979192],"angle_rad":[-566.18672559694812,319.66224538520771,-830.48241758683264,2437.8131717235306,2437.8131547179837]},"command":[-0.033461217646480287,-0.10905049482796146,-0.2607548503006476,0.58634357167508455,0.58634357167508455],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.015484422521455762,-1.4991745668154675,-0.27037028831652288,1.7866559375570943e-05,-0.0003957955270358188,0.00010710229961034468]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":910,"step":7280,"t":36.399999999999999,"sim_time":36.400000000000169,"vehicle":{"origin_ned":[1.5006428898491826,0.99956966602110164,3.4975801953903032],"origin_quat_xyzw":[-0.021609376421642471,0.053632460191130715,0.38092440232794411,0.92279639887442833],"cg_ned":[1.4402000989670887,0.9401811641086163,3.205149679879026],"linear_velocity_ned":[0.00030603198700060409,-0.00018811853609212827,0.0013709036042080377],"angular_velocity_ned":[-0.00019807692735521876,9.5418671918949354e-06,0.0016273206808437213]},"sensors":{"Odom":[1.5006428898491826,0.99956966602110164,3.4975801953903032,-2.9766951879215694e-05,-0.00017089796603661828,0.0013644175703166493,-0.021609376421642477,0.053632460191130729,0.38092440232794422,0.92279639887442833,-0.00032063692848126573,0.00014806831321873825,0.0016008640946052614],"Pressure":[26809.12529033998],"DVL":[-0.065945296862001013,0.011784573329648008,-0.041619637654928154,7.3130385014737236,-0.0059022188974952481,-0.013152851625200681,0.0082434075856624486,0],"IMU":[0.00098429769751762338,0.11570475507020002,0.78302984346146653,-0.018113778400978376,-0.024347904004001372,-0.01202273584380047,1.1351146738377762,0.0019080135382809216,-9.7535953366789396],"FOG":[0.77772423957651104],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5129127221172509,-11.467316037946604,-27.374047939890819,61.562046684986271,61.562046684986271],"omega_rad_s":[-3.6125594892781079,-11.444467599181113,-27.382845558019994,61.573418499745756,61.573417871915801],"thrust_n":[-0.16707937754583799,-1.6733922707030875,-9.5642636660362967,48.350687273884951,48.355240740685744],"torque_nm":[0.0031327383289844629,0.031376105075682892,0.17932994373818062,-0.90657538638534285,-0.90666076388785766],"angle_rad":[-566.33129384375798,319.20476873264056,-831.57782084712551,2440.2761801627894,2440.2761631279072]},"command":[-0.033456311639211915,-0.10921253369472957,-0.26070521847515066,0.58630520652367879,0.58630520652367879],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,-4.3368086899420177e-19],"servo_effort":[0.015355852475144651,-1.4991637149117674,-0.27038643370064602,1.7640156014866798e-05,-0.00039587928557083865,0.00010721449790033407]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":911,"step":7288,"t":36.439999999999998,"sim_time":36.44000000000019,"vehicle":{"origin_ned":[1.5006512491500439,0.99956846430012603,3.4976346791472532],"origin_quat_xyzw":[-0.021614721409745897,0.053633384681018692,0.38095411324780304,0.92278395492423737],"cg_ned":[1.4402122357053946,0.94017372690497025,3.2052046493028219],"linear_velocity_ned":[0.00030137878991658195,-0.00018424041904871471,0.0013767304144033951],"angular_velocity_ned":[-0.00019789170532636806,3.8571031496895418e-06,0.0016164148464859582]},"sensors":{"Odom":[1.5006512491500439,0.99956846430012603,3.4976346791472532,-3.2283209337130803e-05,-0.00016466356961084355,0.0013703406062213191,-0.021614721409745904,0.053633384681018713,0.38095411324780315,0.92278395492423737,-0.00032323095963634747,0.00014389744059277671,0.0015895874413020901],"Pressure":[26810.952360941395],"DVL":[-0.0063155609041431818,-0.014915946619913075,-0.032963646186275314,7.3720568377932096,-0.0013198261765676551,0.014233472536031633,-0.015279919737306474,0],"IMU":[0.00097882635270407766,0.1157105214972097,0.78309405983948566,-0.015657139470751893,0.040829720000667542,0.23481209509706427,1.1296906330893386,-0.023618936206009966,-9.7576570691142024],"FOG":[0.75675769771399914],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5130435002226559,-11.484334537889188,-27.36874316723021,61.557974305508168,61.557974305508168],"omega_rad_s":[-3.6093040981642921,-11.462038149692717,-27.377557948923542,61.569209331825803,61.569208947453106],"thrust_n":[-0.16677015973415246,-1.6785122691154335,-9.560593347954077,48.343970302395455,48.348396359834467],"torque_nm":[0.0031269404950153589,0.031472105045914398,0.17926112527413895,-0.90644944316991494,-0.90653243174689635],"angle_rad":[-566.47572094311943,318.74658923991052,-832.67301431811563,2442.7390210411113,2442.7390039865863]},"command":[-0.033457557144977675,-0.1093746146465637,-0.26065469683076392,0.58626642195722067,0.58626642195722067],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.015223108507689511,-1.4991477642271589,-0.27040136861860237,1.7409829671794925e-05,-0.00039596338700806008,0.00010732669735094344]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":912,"step":7296,"t":36.480000000000004,"sim_time":36.48000000000021,"vehicle":{"origin_ned":[1.5006593829257651,0.99956738367335951,3.4976893947763359],"origin_quat_xyzw":[-0.021620088405044657,0.053634208992765019,0.38098361950776105,0.92277159962248723],"cg_ned":[1.4402241856095275,0.9401664426948817,3.2052598363055207],"linear_velocity_ned":[0.0002966940660526362,-0.00018045652186218271,0.0013818693055874544],"angular_velocity_ned":[-0.0001972540078690164,-1.4976736592542644e-06,0.0016054047351756042]},"sensors":{"Odom":[1.5006593829257651,0.99956738367335951,3.4976893947763359,-3.4832731969001735e-05,-0.00015864515694647002,0.001375574384790908,-0.021620088405044667,0.053634208992765046,0.38098361950776122,0.92277159962248723,-0.0003252633726531372,0.00013964148731160134,0.0015782711249347312],"Pressure":[26813.528223822912],"DVL":[0.011119921002378463,0.0045011533535049717,-0.036074175491618912,7.3101877296025979,-0.012408915261287026,0.0015707967462748173,0.0034440427464385022,0],"IMU":[0.0009732116645661304,0.11571611993918218,0.78315782107244414,-0.11601750355440216,0.003175163764760082,-0.097520776796638078,1.1509685843441622,-0.017603470757439624,-9.7242667480859311],"FOG":[0.79371494606190995],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.513844920829075,-11.501354315049712,-27.363348239346823,61.553860402392544,61.553860402392544],"omega_rad_s":[-3.6067141628711212,-11.47960541132862,-27.372172974007174,61.56495545932161,61.56495532041221],"thrust_n":[-0.16652258463594735,-1.6836390670409245,-9.5568558353189879,48.337203768434435,48.341499778097287],"torque_nm":[0.0031222984619240133,0.031568232507017333,0.17919104691223106,-0.9063225706581457,-0.90640312083932417],"angle_rad":[-566.62003290393682,318.28770698871767,-833.76799405532415,2445.2016925251592,2445.2016754607771]},"command":[-0.033465189722181668,-0.10953670776237821,-0.26060331656520785,0.58622724192754805,0.58622724192754805],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.015090392625330393,-1.4991290880409247,-0.27041581233832707,1.7176808496195566e-05,-0.00039604854591046291,0.00010743853806606009]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":913,"step":7304,"t":36.520000000000003,"sim_time":36.520000000000231,"vehicle":{"origin_ned":[1.5006672941169026,0.99956641491573339,3.4977443151887613],"origin_quat_xyzw":[-0.021625466384873802,0.053634935981989616,0.38101291979324148,0.9227593336273946],"cg_ned":[1.4402359474011017,0.94015930778964252,3.2053152135448912],"linear_velocity_ned":[0.0002919770412801192,-0.00017676326320007887,0.001386328106989989],"angular_velocity_ned":[-0.00019616571476430394,-6.5078360640655241e-06,0.001594288052273426]},"sensors":{"Odom":[1.5006672941169026,0.99956641491573339,3.4977443151887613,-3.7410967305207053e-05,-0.0001528423994127847,0.0013801263283527909,-0.021625466384873813,0.053634935981989644,0.3810129197932417,0.9227593336273946,-0.00032672498514726311,0.00013531207412514678,0.0015669138967657073],"Pressure":[26811.71864399721],"DVL":[-0.0097693143996083719,0.027372816329508463,-0.011331620170129057,7.3394102510732555,0.02334215850074127,-0.0085968679741003154,-0.061381852029146436,0],"IMU":[0.00096747611229522508,0.11572154726431003,0.78322112552258616,0.01923791404554126,-0.048722814780726292,0.095790997363940686,1.1301735396475967,-0.010513233285081877,-9.7327390663123179],"FOG":[0.77674369412244149],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5153417963276614,-11.518369820847681,-27.35786727915864,61.549707523939595,61.549707523939595],"omega_rad_s":[-3.6048222596339032,-11.497165740273655,-27.366693949834588,61.560659507547491,61.560659615336078],"thrust_n":[-0.16633951127848862,-1.6887715884514862,-9.5530534907531202,48.330391431778118,48.334555116794746],"torque_nm":[0.0031188658364716621,0.031664467283465378,0.17911975295162103,-0.90619483934583966,-0.9062729084399016],"angle_rad":[-566.76425709771036,317.82812219234796,-834.86275623904874,2447.6641928866566,2447.6641758222654]},"command":[-0.033479445679311062,-0.10969876019854935,-0.260551116944368,0.58618769070418664,0.58618769070418664],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,1.7347234759768071e-18,0,0,4.3368086899420177e-19],"servo_effort":[0.014954645568372147,-1.4991060341546589,-0.27042921580334012,1.6940968360761739e-05,-0.00039613401291501424,0.00010754938075969242]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":914,"step":7312,"t":36.560000000000002,"sim_time":36.560000000000251,"vehicle":{"origin_ned":[1.5006749857793442,0.99956554898211591,3.4977994135800463],"origin_quat_xyzw":[-0.021630844289824303,0.053635568755139786,0.38104201277024313,0.92274715759173365],"cg_ned":[1.4402475197701305,0.94015231864590609,3.2053707539997327],"linear_velocity_ned":[0.00028722691455826171,-0.0001731569747326937,0.0013901149328024703],"angular_velocity_ned":[-0.00019463110939726923,-1.1162675684780045e-05,0.0015830641035042639]},"sensors":{"Odom":[1.5006749857793442,0.99956554898211591,3.4977994135800463,-4.0013678664022127e-05,-0.00014725344544990536,0.001384004202449073,-0.021630844289824317,0.05363556875513982,0.38104201277024341,0.92274715759173365,-0.00032761123563888818,0.00013091974064436397,0.0015555155832296214],"Pressure":[26813.704896606851],"DVL":[-0.020217795251827413,-0.028079377239329243,0.016525098290707672,7.3117404268690604,-0.020582301066728235,0.00040661459116391434,0.0074407690898263502,0],"IMU":[0.00096164243383409448,0.11572680077410341,0.78328397153588114,-0.0045370095521390175,0.038184312260583247,-0.1092693594440638,1.1253138512415668,-0.0036880206145982969,-9.774898397232052],"FOG":[0.77613269291371889],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5175483538815024,-11.535377720390338,-27.352303033510211,61.545518093316275,61.545518093316275],"omega_rad_s":[-3.6036556269701139,-11.514715471416755,-27.361124150011364,61.556324067313483,61.55632442229944],"thrust_n":[-0.16622333692654684,-1.6939087468580625,-9.5491886424795958,48.323537004038499,48.32756641229291],"torque_nm":[0.0031166875673727533,0.031760789003588669,0.17904728704649242,-0.90606631882572197,-0.90614187023049197],"angle_rad":[-566.90842208312756,317.36783521220417,-835.95729718245843,2450.1265205016548,2450.1265034471367]},"command":[-0.033500460513157165,-0.10986074019419369,-0.26049812412866868,0.5861477913649169,0.5861477913649169],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,-3.22931311140702e-23,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[-3.3881317890172014e-21,0,0,-6.7762635780344027e-21,0,0],"servo_effort":[0.014815701710268496,-1.4990783443524851,-0.27044146694948318,1.6704392549262462e-05,-0.00039622007516396958,0.00010766044052387962]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":915,"step":7320,"t":36.600000000000001,"sim_time":36.600000000000271,"vehicle":{"origin_ned":[1.5006824610554856,0.99956477702988211,3.4978546634391967],"origin_quat_xyzw":[-0.021636211082818456,0.053636110639633465,0.38107089708778574,0.92273507216217965],"cg_ned":[1.4402589013761977,0.94014547186232245,3.2054264309781275],"linear_velocity_ned":[0.00028244297586528289,-0.00016963424621860119,0.0013932381368909625],"angular_velocity_ned":[-0.00019265614811961369,-1.5452952030302791e-05,0.0015717318045093359]},"sensors":{"Odom":[1.5006824610554856,0.99956477702988211,3.4978546634391967,-4.2636732741618171e-05,-0.00014187607448980219,0.0013872159905185789,-0.021636211082818463,0.053636110639633479,0.38107089708778585,0.92273507216217965,-0.00032791972193043316,0.0001264751659075145,0.001544075366948986],"Pressure":[26812.107305417365],"DVL":[-0.0086212051652492256,0.037850851147008424,-0.004186675621020354,7.3077829384565245,0.011613224239830055,-0.0033246949578583334,0.018117386593881367,0],"IMU":[0.00095573349357765385,0.11573187819329042,0.78334635743936787,-0.0035748521959108538,-0.02320096957755027,0.071026491700233368,1.129498380164131,0.00085675353696415026,-9.745170043992978],"FOG":[0.7953884529469939],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5204719480089577,-11.552374557069516,-27.346658339952874,61.541294526148427,61.541294526148427],"omega_rad_s":[-3.6032350775733994,-11.532251056242963,-27.355466735565731,61.551951693418658,61.551952295404888],"thrust_n":[-0.16617590341926014,-1.6990494822645172,-9.5452635390514189,48.316644132827989,48.320537638674196],"torque_nm":[0.0031157981891111277,0.031857177792459695,0.17897369135721414,-0.90593707749052488,-0.90601008072514144],"angle_rad":[-567.05255736031654,316.90684655307882,-837.05161332671116,2452.5886738489889,2452.5886568142296]},"command":[-0.033528304266751977,-0.11002261482923349,-0.26044436514240832,0.58610756691569932,0.58610756691569932],"arm":{"servo_position":[2.2499312661440551e-24,3.2526065174565154e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,8.6736173798840355e-19,0,0,-8.6736173798840355e-19,4.3368086899420177e-19],"servo_effort":[0.014674655615048866,-1.4990467079242742,-0.27045277400919182,1.6465292057872311e-05,-0.00038290062774498624,0.00010777010680997783]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":916,"step":7328,"t":36.640000000000001,"sim_time":36.640000000000292,"vehicle":{"origin_ned":[1.5006897231558123,0.99956409043691619,3.497910038555188],"origin_quat_xyzw":[-0.021641555800333126,0.053636565163743141,0.38109957137199962,0.92272307798171738],"cg_ned":[1.4402700908521062,0.94013876417460396,3.2054822181240263],"linear_velocity_ned":[0.00027762459719043596,-0.00016619162149497535,0.0013957061662075202],"angular_velocity_ned":[-0.00019024918644488682,-1.9371971259308021e-05,0.0015602904307079482]},"sensors":{"Odom":[1.5006897231558123,0.99956409043691619,3.497910038555188,-4.5275951154936947e-05,-0.00013670703896824949,0.001389769785039645,-0.021641555800333147,0.05363656516374319,0.38109957137200001,0.92272307798171738,-0.00032765155493262799,0.00012198891765360242,0.0015325923844558742],"Pressure":[26814.221765770351],"DVL":[-0.0067229678140373486,-0.030486483557839939,-0.0209727927163696,7.4007156510477303,-5.3885369925513314e-05,-0.039994081853053934,0.00061005643104127059,0],"IMU":[0.00094977217109953112,0.11573677767178335,0.783408281521904,0.039345912482435796,-0.013471435855019172,0.15831858982703986,1.123612103788791,0.0063233079861222032,-9.7614309903249357],"FOG":[0.78142208824712667],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5241161761519222,-11.569356148084884,-27.34093644233112,61.537039225483028,61.537039225483028],"omega_rad_s":[-3.6035759338229587,-11.549768774309975,-27.349724918869782,61.547544909087058,61.547545757208809],"thrust_n":[-0.16619858813285238,-1.7041926775938523,-9.5412804648200034,48.309716412585772,48.313472715088494],"torque_nm":[0.0031162235274909819,0.031953612704884733,0.17889900871537509,-0.90580718273598326,-0.90587761340790929],"angle_rad":[-567.19669313785721,316.44515686540552,-838.14570124022509,2455.0506515089101,2455.0506345037725]},"command":[-0.033563011201446877,-0.11018434426747509,-0.26038987087934401,0.58606704024269551,0.58606704024269551],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.014531214578379146,-1.4990107093018279,-0.27046299341412339,1.6223785907163539e-05,-0.00039639291653328982,0.00010787905889115979]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":917,"step":7336,"t":36.68,"sim_time":36.680000000000312,"vehicle":{"origin_ned":[1.5006967753331004,0.99956348082403068,3.4979655130279776],"origin_quat_xyzw":[-0.021646867607743928,0.053636936024711229,0.38112803423708924,0.92271117568566696],"cg_ned":[1.4402810868092011,0.940132192453629,3.20553808942678],"linear_velocity_ned":[0.0002727712756209205,-0.00016282575657255817,0.001397527750387854],"angular_velocity_ned":[-0.00018742024849127079,-2.2915469055942423e-05,0.0015487400217197812]},"sensors":{"Odom":[1.5006967753331004,0.99956348082403068,3.4979655130279776,-4.7927342225866491e-05,-0.00013174234815442539,0.0013916739882020883,-0.021646867607743946,0.053636936024711271,0.38112803423708957,0.92271117568566696,-0.00032681080917842519,0.00011747102105769313,0.0015210661975597834],"Pressure":[26813.846904783506],"DVL":[-0.00082049441833820984,-0.0081200780120961758,-0.026245530454703452,7.3715732494980406,0.0082802541754790522,0.018355734959965668,-0.0052960402506306726,0],"IMU":[0.00094378123528640471,0.11574149776801003,0.7834697420501856,-0.060746506768626564,-0.027602755925770703,-0.11095061769342154,1.1262116074711301,0.0016493999590665078,-9.7247183111691236],"FOG":[0.77193521446591473],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5284786068857223,-11.586318999225096,-27.335140345026954,61.532754533046514,61.532754533046514],"omega_rad_s":[-3.6046875965960217,-11.567264941613262,-27.343901923058652,61.543106205466472,61.54310729822123],"thrust_n":[-0.16629226762121405,-1.7093372207182806,-9.5372417093313526,48.302757385597474,48.306375492521155],"torque_nm":[0.0031179800178977634,0.032050072888467764,0.1788232820499629,-0.90567670097995256,-0.90574454048477171],"angle_rad":[-567.34086010078033,315.98276694825609,-839.23955762054618,2457.5124521619496,2457.5124351962477]},"command":[-0.033604558160816402,-0.1103458952307152,-0.26033466995263765,0.58602623364806206,0.58602623364806206],"arm":{"servo_position":[1.9190590211230062e-23,-1.0842021724855024e-21,1.0778494253810979e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[3.3881317890172014e-21,0,-1.7347234759768071e-18,0,0,0],"servo_effort":[0.014385475026308827,-1.4989702173059898,-0.27047204399810365,1.5981547230964781e-05,-0.00039647838184543187,0.00010798728892405686]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":918,"step":7344,"t":36.719999999999999,"sim_time":36.720000000000333,"vehicle":{"origin_ned":[1.5007036208545277,0.99956294007504187,3.4980210612736578],"origin_quat_xyzw":[-0.021652135854826136,0.053637227058430145,0.38115628428876613,0.92269936590071833],"cg_ned":[1.4402918878390214,0.94012575370155638,3.2055940192250749],"linear_velocity_ned":[0.00026788255168493005,-0.0001595335007657078,0.0013987116061823562],"angular_velocity_ned":[-0.00018418137591774103,-2.6081268864123764e-05,0.0015370806084767973]},"sensors":{"Odom":[1.5007036208545277,0.99956294007504187,3.4980210612736578,-5.0587034795903716e-05,-0.00012697733233915293,0.0013929369803421564,-0.021652135854826147,0.053637227058430173,0.38115628428876636,0.92269936590071833,-0.00032540443968586568,0.00011293144708091024,0.001509496024396506],"Pressure":[26814.54585735024],"DVL":[-0.025198102070574605,0.019946248427368796,0.018392430259877513,7.3341080861842132,-0.028342584569310367,0.01226962971372322,-0.048102426127096615,0],"IMU":[0.00093778321843567436,0.11574603743529494,0.78353073726851519,-0.0048949968511035761,0.02317786521163856,0.053142896626606477,1.1265139325478608,-0.00025889146867117893,-9.7678210794444649],"FOG":[0.77212924887142254],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5335498578955744,-11.603259599806776,-27.3292730149651,61.528442788882508,61.528442788882508],"omega_rad_s":[-3.6065733436155476,-11.584735957003707,-27.338000933511992,61.538638040817425,61.53863937609762],"thrust_n":[-0.16645730065726255,-1.7144820167958084,-9.5331495342856716,48.295770543371944,48.299249766461884],"torque_nm":[0.0031210743873236737,0.032146537814921411,0.17874655376785642,-0.90554569768822391,-0.90561093312116014],"angle_rad":[-567.485089172127,315.5196777459268,-840.33317929320697,2459.9740745874801,2459.9740576709528]},"command":[-0.033652855789481663,-0.11050723428387406,-0.26027879061871523,0.58598516941792866,0.58598516941792866],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,4.3368086899420177e-19],"servo_effort":[0.014237477275727011,-1.4989251461217781,-0.27047991443506453,1.5737485677472742e-05,-0.00039656392308372486,0.00010809396484659671]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":919,"step":7352,"t":36.759999999999998,"sim_time":36.760000000000353,"vehicle":{"origin_ned":[1.5007102629948046,0.99956246034442298,3.4980766580162816],"origin_quat_xyzw":[-0.021657350120713799,0.053637442233570476,0.38118432011334558,0.92268764924871272],"cg_ned":[1.4403024925188472,0.94011944503732325,3.2056499822007174],"linear_velocity_ned":[0.00026295814524840807,-0.00015631202103670813,0.0013992663022244277],"angular_velocity_ned":[-0.00018054658985327916,-2.8868248459172651e-05,0.0015253118070247661]},"sensors":{"Odom":[1.5007102629948046,0.99956246034442298,3.4980766580162816,-5.3251042449323444e-05,-0.0001224070828230435,0.001393566950967405,-0.021657350120713813,0.053637442233570504,0.38118432011334585,0.92268764924871272,-0.00032344148378634328,0.00010838081811263226,0.0014978804225829355],"Pressure":[26813.244956117873],"DVL":[0.0036313545065442526,0.036951848916589515,0.0036905741942779586,7.2637974065198705,-0.024036756498460311,0.027688432642288371,-0.0067522796863244026,0],"IMU":[0.00093180032694434453,0.11575039604547797,0.78359126537053403,-0.020587223273330853,0.06008292239327067,0.066779336974885264,1.1286152880396747,-0.010719368110980817,-9.7483356509040338],"FOG":[0.76319622617066352],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5393190891937478,-11.620173629863936,-27.323337970730265,61.524106472235417,61.524106472235417],"omega_rad_s":[-3.6092312686289869,-11.602178059461604,-27.332025239982357,61.534142884020234,61.534144459130623],"thrust_n":[-0.16669361500357538,-1.7196259154680242,-9.5290062730115412,48.288759388884152,48.292099364801913],"torque_nm":[0.0031255052813170389,0.032242985915025453,0.17866886761896636,-0.90541423854157788,-0.90547686309003605],"angle_rad":[-567.62941128302623,315.05589034960906,-841.42656321284608,2462.435517663248,2462.4355008055386]},"command":[-0.033707800849464266,-0.11066832028441843,-0.2602222663879073,0.58594387116414681,0.58594387116414681],"arm":{"servo_position":[-1.4690727678941952e-23,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[-3.3881317890172014e-21,0,0,6.7762635780344027e-21,0,0],"servo_effort":[0.014087461815658734,-1.4988754681829994,-0.27048658173195572,1.5493462929217579e-05,-0.00039664948863745922,0.00010819907450122337]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":920,"step":7360,"t":36.800000000000004,"sim_time":36.800000000000374,"vehicle":{"origin_ned":[1.5007167050090471,0.99956203407717548,3.4981322783056061],"origin_quat_xyzw":[-0.021662500262030152,0.053637585613103812,0.38121214028677658,0.92267602634400836],"cg_ned":[1.4403128994174221,0.94011326369784154,3.2057059533934131],"linear_velocity_ned":[0.00025799788786720764,-0.00015315830174792618,0.0013992010201488764],"angular_velocity_ned":[-0.00017653110581456041,-3.1278759755275356e-05,0.0015134343927490827]},"sensors":{"Odom":[1.5007167050090471,0.99956203407717548,3.4981322783056061,-5.5915728480912904e-05,-0.00011802557903927793,0.0013935728041876826,-0.021662500262030173,0.053637585613103861,0.38121214028677697,0.92267602634400836,-0.00032093438695930042,0.00010382814155783954,0.0014862187219838905],"Pressure":[26816.211107293722],"DVL":[-0.0052207905849575367,-0.018176771282002659,0.026828614648666468,7.3255351507957451,-0.011099767417848978,0.01379738678432914,-0.043888820553484365,0],"IMU":[0.00092585432350964403,0.11575457335458827,0.78365132451108888,0.074689297674712204,0.020025971456075115,0.067368702713811165,1.1174890894295524,0.0086868207399774001,-9.7597282077419898],"FOG":[0.78081633629228742],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5457692052330838,-11.637057070459063,-27.317338533416336,61.519747931348149,61.519747931348149],"omega_rad_s":[-3.6126544484444394,-11.619587361885658,-27.325978241191489,61.529623203076099,61.529625014756988],"thrust_n":[-0.1670007207214399,-1.7247677244880888,-9.5248143341114897,48.281727425987725,48.284928071822307],"torque_nm":[0.0031312635135269978,0.032339394834151665,0.17859026876459044,-0.90528238923727,-0.90534240134666821],"angle_rad":[-567.7738571774147,314.59140600457766,-842.51970646891061,2464.8967803660189,2464.8967635766485]},"command":[-0.03376923052602937,-0.11082911495675297,-0.26016512888967941,0.58590236125093476,0.58590236125093476],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,4.3368086899420177e-19],"servo_effort":[0.013936037058823162,-1.4988214972783445,-0.27049208748116577,1.5248504804060585e-05,-0.00039673439784739607,0.00010830286674319628]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":921,"step":7368,"t":36.840000000000003,"sim_time":36.840000000000394,"vehicle":{"origin_ned":[1.500722950102247,0.99956165402475072,3.4981878975341729],"origin_quat_xyzw":[-0.02166757645911796,0.053637661315815321,0.38123974338496963,0.92266449779035098],"cg_ned":[1.4403231070969762,0.94010720703615747,3.2057619082147619],"linear_velocity_ned":[0.00025300167678315077,-0.00015006955647902252,0.0013985252036814381],"angular_velocity_ned":[-0.00017215149479138804,-3.3317140559098153e-05,0.0015014494395328107]},"sensors":{"Odom":[1.500722950102247,0.99956165402475072,3.4981878975341729,-5.8577735951100942e-05,-0.00011382629522158887,0.0013929637139104415,-0.021667576459117967,0.053637661315815335,0.3812397433849698,0.92266449779035098,-0.0003178979736650521,9.9281977761047312e-05,0.0014745102765728172],"Pressure":[26816.9098487681],"DVL":[0.0029704301555887372,0.02771620618055359,0.012908963861367452,7.3971847460115026,0.012989798113696308,0.018834458100115487,0.03779677251342755,0],"IMU":[0.00091996641300575084,0.11575856946706288,0.78371091282109051,-0.047345647418835755,-0.029266180515525805,-0.067546802275688878,1.1448459191387514,-0.012777770679636256,-9.7610190946838902],"FOG":[0.7615380612731395],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5528766155981351,-11.653906128442191,-27.311277701737719,61.515369421340502,61.515369421340502],"omega_rad_s":[-3.6168301722883678,-11.636960019837648,-27.319863270124163,61.525081413874332,61.525083458342408],"thrust_n":[-0.16737763616708579,-1.7299062572736319,-9.5205760773753898,48.274678075988014,48.277739572002659],"torque_nm":[0.0031383306781328588,0.032435742323880599,0.17851080145078854,-0.90515021392477546,-0.90520761697504981],"angle_rad":[-567.91845719042817,314.1262261105345,-843.61260628547302,2467.3578617700591,2467.3578450584068]},"command":[-0.033836920148553669,-0.11098958217563992,-0.26010740668321636,0.58586066115562385,0.58586066115562385],"arm":{"servo_position":[1.9190590211230062e-23,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[3.3881317890172014e-21,0,0,0,0,4.3368086899420177e-19],"servo_effort":[0.013783367450497238,-1.4987633531758728,-0.27049644870887513,1.500339585914535e-05,-0.00039681900552855182,0.00010840521187782247]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":922,"step":7376,"t":36.880000000000003,"sim_time":36.880000000000415,"vehicle":{"origin_ned":[1.5007290014173187,0.99956131325361275,3.498243491449669],"origin_quat_xyzw":[-0.021672569254405485,0.053637673493538804,0.38126712798173579,0.92265306418212911],"cg_ned":[1.44033311412224,0.94010127251433928,3.2058178224595117],"linear_velocity_ned":[0.00024796958887737152,-0.0001470431056400116,0.0013972484504936225],"angular_velocity_ned":[-0.0001674258022793238,-3.4989786191466041e-05,0.0014893580056168755]},"sensors":{"Odom":[1.5007290014173187,0.99956131325361275,3.498243491449669,-6.1233799253390117e-05,-0.00010980218161299805,0.0013917490340238326,-0.021672569254405499,0.053637673493538839,0.38126712798173601,0.92265306418212911,-0.00031434954516176009,9.475047355134046e-05,0.0014627541367297748],"Pressure":[26815.467509484275],"DVL":[-0.004900969645319735,0.010498889088062451,-0.0090715926527556792,7.4140448938003622,-0.037775091807154972,-0.034526833981734527,0.00041277973034509994,0],"IMU":[0.00091415715350540866,0.11576238482309006,0.78377002839755017,-0.0039327272033809401,0.064216708534556619,0.070644698556531438,1.1304508406337712,-0.024033014369274613,-9.7792848746310863],"FOG":[0.78544934219004015],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.560615615562158,-11.6707167414948,-27.305158696463955,61.510973086806672,61.510973086806672],"omega_rad_s":[-3.6217408135700917,-11.654292133028607,-27.31368364013219,61.520519865907183,61.520522138892687],"thrust_n":[-0.16782296390606433,-1.7350403038361488,-9.5162938489229028,48.267614653932426,48.270537432403529],"torque_nm":[0.0031466805732387067,0.032532005696927796,0.17843050966730442,-0.90501777476123302,-0.90507257685756626],"angle_rad":[-568.06324103375005,313.66035222215424,-844.7052600190392,2469.8187610448026,2469.8187444200862]},"command":[-0.033910624910115789,-0.11114968325233143,-0.26004913044251388,0.58581879130292069,0.58581879130292069],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,4.3368086899420177e-19],"servo_effort":[0.013629829453678393,-1.4987011922140918,-0.27049969272497792,1.4757677001287541e-05,-0.00039690232149311309,0.00010850577180138576]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":923,"step":7384,"t":36.920000000000002,"sim_time":36.920000000000435,"vehicle":{"origin_ned":[1.5007348620053194,0.9995610051528877,3.4982990361606743],"origin_quat_xyzw":[-0.021677469593977046,0.053637626296395,0.38129429265134174,0.92264172610434392],"cg_ned":[1.4403429190593375,0.94009545769590275,3.2058736723085155],"linear_velocity_ned":[0.00024290173139050351,-0.00014407648880942117,0.0013953804896699616],"angular_velocity_ned":[-0.00016237313240007156,-3.6305142688977318e-05,0.0014771615307793962]},"sensors":{"Odom":[1.5007348620053194,0.9995610051528877,3.4982990361606743,-6.3881011632254683e-05,-0.0001059456927797898,0.0013899382690449661,-0.021677469593977067,0.053637626296395048,0.38129429265134213,0.92264172610434392,-0.00031030862814309838,9.0241074395583883e-05,0.0014509494785544697],"Pressure":[26817.242640678753],"DVL":[0.021481600323817209,-0.0099729864799677232,0.018316001530497884,7.3885280845211572,-0.010311883344048407,-0.017038677165043255,0.0040894593786060937,0],"IMU":[0.00090844635268738552,0.11576602016620301,0.78382866930228867,0.12270959939220878,-0.05959574484713679,0.089776785391066413,1.1340980847155375,-0.02168181461959243,-9.7574266862835195],"FOG":[0.77095020935093339],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5689546292109848,-11.687484162243543,-27.298984498679591,61.506561085166744,61.506561085166744],"omega_rad_s":[-3.6273637097552904,-11.6715795817417,-27.307442633440147,61.515940859856251,61.515943356645394],"thrust_n":[-0.1683348735059918,-1.7401685815741752,-9.5119699698192477,48.26054040542985,48.2633251266165],"torque_nm":[0.0031562788782373459,0.032628160904515785,0.17834943693411087,-0.90488513260180981,-0.90493734612405929],"angle_rad":[-568.20823759975644,313.1937860545267,-845.79766515834842,2472.2794774525078,2472.2794609237631]},"command":[-0.033990044087723666,-0.11130937297374802,-0.25999032855885323,0.58577677223968327,0.58577677223968327],"arm":{"servo_position":[1.9190590211230062e-23,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[6.7762635780344027e-21,0,0,0,0,0],"servo_effort":[0.013475683121221188,-1.4986350597332163,-0.27050181074421409,1.4512479308010639e-05,-0.00039698459724028513,0.00010860441575915607]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":924,"step":7392,"t":36.960000000000001,"sim_time":36.960000000000456,"vehicle":{"origin_ned":[1.5007405348111138,0.99956072345261204,3.4983545081399199],"origin_quat_xyzw":[-0.021682268872716581,0.053637523854880756,0.38132123595987938,0.92263048413613469],"cg_ned":[1.4403525204806757,0.94008976024428126,3.2059294343320857],"linear_velocity_ned":[0.00023779823428439652,-0.00014116715751173633,0.0013929310462721873],"angular_velocity_ned":[-0.00015701511744165895,-3.7273502366076439e-05,0.0014648601085951681]},"sensors":{"Odom":[1.5007405348111138,0.99956072345261204,3.4983545081399199,-6.6516245295389725e-05,-0.00010224844925340905,0.001387540904432854,-0.021682268872716584,0.05363752385488077,0.38132123595987943,0.92263048413613469,-0.0003057976657462008,8.5761705534681602e-05,0.0014390937830194594],"Pressure":[26817.983023361216],"DVL":[-0.021084235300912399,-0.037981554380948947,0.017298243149593679,7.3787925023237424,-0.0029859017443712257,-0.029571676541795794,-0.0093202991008703683,0],"IMU":[0.000902852969177597,0.11576947654483377,0.78388683353751609,-0.11231905644490484,-0.055077377341778991,-0.23041621224162273,1.1245163097668094,0.021632326034112019,-9.7641652926707962],"FOG":[0.77578993967637311],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5778585435410326,-11.704203694367768,-27.292758338463226,61.502135547879568,61.502135547879568],"omega_rad_s":[-3.6336715447162375,-11.688818070777273,-27.301143525547396,61.511346653477204,61.511349368947549],"thrust_n":[-0.16891112969886132,-1.7452897469060762,-9.5076067594805505,48.253458501855782,48.256106065253775],"torque_nm":[0.0031670836818536493,0.03272418275448892,0.17826762674026037,-0.90475234690979589,-0.90480198872350848],"angle_rad":[-568.35347476840332,312.72652949147721,-846.88981932278693,2474.7400103464347,2474.7399939224993]},"command":[-0.034074843271819359,-0.11146860661302636,-0.25993103179488786,0.5857346242655197,0.5857346242655197],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[-3.3881317890172014e-21,0,0,0,0,4.3368086899420177e-19],"servo_effort":[0.013320582088145969,-1.4985648056182379,-0.27050276822426611,1.4265626779647106e-05,-0.00039706661384305696,0.00010870081425240012]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":925,"step":7400,"t":37,"sim_time":37.000000000000476,"vehicle":{"origin_ned":[1.5007460226614426,0.99956046224783135,3.4984098842264912],"origin_quat_xyzw":[-0.021686958987090072,0.053637370271186945,0.38134795642984087,0.92261933886466296],"cg_ned":[1.4403619169662416,0.94008417792369603,3.2059850854942318],"linear_velocity_ned":[0.00023265938961215745,-0.00013831272432759012,0.0013899100902168894],"angular_velocity_ned":[-0.00015137462421851923,-3.7906320518078589e-05,0.0014524532630282364]},"sensors":{"Odom":[1.5007460226614426,0.99956046224783135,3.4984098842264912,-6.9136385097546161e-05,-9.8701855539146555e-05,0.0013845666663756661,-0.021686958987090093,0.053637370271187,0.38134795642984126,0.92261933886466296,-0.00030084071798337168,8.1320344004972512e-05,0.0014271837692911352],"Pressure":[26818.375711060133],"DVL":[0.028887943852153597,0.029371182654506636,0.013588130574282591,7.314923882669591,-0.0019761183827349841,0.013254160050959923,0.0020136933564274956,0],"IMU":[0.00089739500344081528,0.1157727553368387,0.78394451896328088,0.077912366862489466,-0.062843950323721198,0.013000176938763043,1.1298183125124701,-0.024045867206199008,-9.73709950511331],"FOG":[0.79141998874227337],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5872863589925172,-11.720867688913225,-27.286485265824552,61.497698621117145,61.497698621117145],"omega_rad_s":[-3.6406318556101231,-11.706002395313197,-27.294790090311608,61.506739482143374,61.506742410776774],"thrust_n":[-0.16954903848094841,-1.750402174997967,-9.5032068863443158,48.246372069233246,48.248883622386728],"torque_nm":[0.0031790444715177825,0.032820040781211889,0.17818512911895595,-0.90461947629812345,-0.9046665679197512],"angle_rad":[-568.49897920918227,312.2585846072227,-847.98172027261046,2477.2003591696425,2477.2003428591406]},"command":[-0.034164631990404926,-0.11162731132298311,-0.25987128824594813,0.58569236782016332,0.58569236782016332],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,4.3368086899420177e-19],"servo_effort":[0.013165069557933557,-1.4984907017967433,-0.27050261059730568,1.4020050610970748e-05,-0.00039714721583157298,0.00010879557401020145]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":926,"step":7408,"t":37.039999999999999,"sim_time":37.040000000000497,"vehicle":{"origin_ned":[1.5007513282499856,0.99956021598608347,3.4984651416376673],"origin_quat_xyzw":[-0.021691532344602974,0.053637169583640038,0.38137445258148134,0.92260829086984375],"cg_ned":[1.4403711071143903,0.9400787085851362,3.2060406031595416],"linear_velocity_ned":[0.00022748578073434269,-0.00013551111727476225,0.0013863276486816972],"angular_velocity_ned":[-0.00014547406225850367,-3.8217076227656867e-05,0.0014399434838177354]},"sensors":{"Odom":[1.5007513282499856,0.99956021598608347,3.4984651416376673,-7.1738863995524576e-05,-9.5297173853848478e-05,0.0013810254243284766,-0.021691532344602981,0.053637169583640058,0.38137445258148145,0.92260829086984375,-0.00029546328386485126,7.6923218088361479e-05,0.0014152189762369877],"Pressure":[26819.550677354055],"DVL":[0.0033525231926504061,0.014340783752866111,-0.017786328276348014,7.3747055704057702,-0.0054445403973052975,0.020973671273101697,-0.0043360538192272523,0],"IMU":[0.00089208945807819375,0.11577585819104658,0.7840017233833847,-0.03237251573716593,-0.076613040201894536,0.055585914711771614,1.1122337859884091,-0.0085800516143209622,-9.7689766405541221],"FOG":[0.77594405716377823],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5971968817031903,-11.737470903664473,-27.280168613008236,61.493252361049159,61.493252361049159],"omega_rad_s":[-3.6482083479174756,-11.723127053288749,-27.288386194000168,61.502121538677834,61.502124674592487],"thrust_n":[-0.17024556029978999,-1.7555041474061055,-9.4987730732593896,48.23928418685184,48.241661070994574],"torque_nm":[0.0031921042556210628,0.032915702763864477,0.17810199512361358,-0.90448657850347214,-0.90453114508114829],"angle_rad":[-568.64477620254729,311.78995369483982,-849.07336592374656,2479.6605234536592,2479.6605072649854]},"command":[-0.034259017920982765,-0.11178543717775689,-0.25981112964769748,0.58565002248618248,0.58565002248618248],"arm":{"servo_position":[1.9190590211230062e-23,-1.0842021724855024e-21,9.7514668052651336e-21,-3.22931311140702e-23,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[3.3881317890172014e-21,0,0,-6.7762635780344027e-21,0,-4.3368086899420177e-19],"servo_effort":[0.013009867046323526,-1.4984129509764375,-0.27050136755267584,1.3775040271603587e-05,-0.00039722687790497965,0.00010888800385185841]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":927,"step":7416,"t":37.079999999999998,"sim_time":37.080000000000517,"vehicle":{"origin_ned":[1.5007564541236782,0.99955997947151343,3.498520257973893],"origin_quat_xyzw":[-0.021695981888965009,0.053636925740886021,0.38140072295199273,0.92259734071730204],"cg_ned":[1.4403800895499421,0.94007335016050964,3.2060959650957335],"linear_velocity_ned":[0.0002222780798189224,-0.00013276034432271481,0.0013821938047886633],"angular_velocity_ned":[-0.00013933698401088278,-3.8220882819254925e-05,0.0014273333567003039]},"sensors":{"Odom":[1.5007564541236782,0.99955997947151343,3.498520257973893,-7.4321219593055649e-05,-9.202520679702231e-05,0.0013769271214537308,-0.021695981888965023,0.053636925740886056,0.38140072295199295,0.92259734071730204,-0.00028969282260818093,7.2576210610085e-05,0.0014031988114051679],"Pressure":[26818.725551515719],"DVL":[-0.0055778866506296342,-0.01730558733617571,-0.0078148304060382638,7.3740894046181733,0.043914377256138684,0.004988718537670459,-0.020301225228697647,0],"IMU":[0.00088695227366366453,0.11577878699889434,0.78405844458251472,0.040669039015063996,-0.094690917089855164,-0.11935395269221226,1.1275100649844441,-0.016886404891839756,-9.7586554579302938],"FOG":[0.78354745695285044],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.6075464833926563,-11.754009110695129,-27.273811289232459,61.488798797956015,61.488798797956015],"omega_rad_s":[-3.6563614517570953,-11.740186936868799,-27.281935429481109,61.497494976351817,61.497498313345297],"thrust_n":[-0.17099735257826609,-1.7605940549759354,-9.4943078506378082,48.23219787457176,48.234441612475699],"torque_nm":[0.0032062003608424898,0.033011138530798796,0.1780182721994589,-0.90435371014822064,-0.90439578023391953],"angle_rad":[-568.79088950157109,311.32063925837031,-850.16475434024278,2482.120502816827,2482.1204867581355]},"command":[-0.034357585556120535,-0.11194294391138218,-0.25975058370697579,0.58560760759958108,0.58560760759958108],"arm":{"servo_position":[-1.4690727678941952e-23,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[-6.7762635780344027e-21,0,0,0,0,-4.3368086899420177e-19],"servo_effort":[0.012855247331593263,-1.4983316887359899,-0.27049906693909925,1.3530552801001536e-05,-0.00039730504905162494,0.00010897822185971762]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":928,"step":7424,"t":37.119999999999997,"sim_time":37.120000000000537,"vehicle":{"origin_ned":[1.5007614026629785,0.99955974787413382,3.4985752112205195],"origin_quat_xyzw":[-0.021700301134285133,0.053636642576896376,0.38142676609383858,0.9225864889596832],"cg_ned":[1.4403888629257136,0.94006810065898971,3.2061511494736821],"linear_velocity_ned":[0.00021703705685003716,-0.00013005854048406254,0.001377518684957015],"angular_velocity_ned":[-0.00013298778967884515,-3.7934379957089954e-05,0.0014146255716513179]},"sensors":{"Odom":[1.5007614026629785,0.99955974787413382,3.4985752112205195,-7.6881158868604237e-05,-8.8876419896259738e-05,0.001372281765555729,-0.021700301134285144,0.053636642576896397,0.38142676609383874,0.9225864889596832,-0.00028355847140034947,6.8284727303820385e-05,0.001391122592250716],"Pressure":[26818.347497437375],"DVL":[0.009015350817604623,-0.012041586416837094,-9.4569192393172867e-05,7.3101243282443846,0.011071047915849619,-0.026411539530886499,-0.0053762325742993319,0],"IMU":[0.000881998245818524,0.1157815438745247,0.78411468031732057,0.023468135355489569,0.0061638589652546118,0.054441547890755781,1.1450561209437928,0.0069715229451249479,-9.7428349587820655],"FOG":[0.78469204950683613],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.6182869715730743,-11.770477476507224,-27.267416303375743,61.484339981567942,61.484339981567942],"omega_rad_s":[-3.6650480116392985,-11.757177065069715,-27.275441233231934,61.492861922770345,61.492865454359581],"thrust_n":[-0.17180073150553585,-1.7656703179110222,-9.4898136383962814,48.225116117256817,48.227228397884097],"torque_nm":[0.0032212637157287968,0.033106318460831674,0.17793400571993029,-0.90422092719856539,-0.904260532460327],"angle_rad":[-568.93734119571752,310.85064400254026,-851.25588372605716,2484.5802969629849,2484.5802810421733]},"command":[-0.034459875919743567,-0.112099785490545,-0.25968967907976898,0.58556514268159943,0.58556514268159943],"arm":{"servo_position":[1.9190590211230062e-23,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[3.3881317890172014e-21,0,0,6.7762635780344027e-21,0,-4.3368086899420177e-19],"servo_effort":[0.012701413007898675,-1.4982470248839534,-0.27049573406823607,1.3286909102975519e-05,-0.00039738276941978895,0.0001090666904890561]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":929,"step":7432,"t":37.160000000000004,"sim_time":37.160000000000558,"vehicle":{"origin_ned":[1.5007661760759801,0.99955951673103516,3.4986299797538751],"origin_quat_xyzw":[-0.02170448418439198,0.053636323794985639,0.38145258057689302,0.92257573613621435],"cg_ned":[1.4403974259299952,0.94006295816104246,3.2062061348722444],"linear_velocity_ned":[0.00021176367382453199,-0.00012740398698647099,0.001372312515200799],"angular_velocity_ned":[-0.00012645143098549574,-3.7375249779021631e-05,0.0014018229459992044]},"sensors":{"Odom":[1.5007661760759801,0.99955951673103516,3.4986299797538751,-7.9416471695409173e-05,-8.5841181010945985e-05,0.0013670994843424458,-0.021704484184391984,0.053636323794985653,0.38145258057689307,0.92257573613621435,-0.00027709050043597284,6.4053830580671411e-05,0.0013789896326587439],"Pressure":[26819.279077049941],"DVL":[0.037459452301319439,0.032824841327888481,-0.054455180512477851,7.4242956157651596,-0.001258547805558526,-0.007153729484968922,-0.021840460791075905,0],"IMU":[0.00087724097732143509,0.11578413114018647,0.78417042831790973,0.038861395904844748,0.057256140698263895,-0.04729445239012859,1.1305255744173786,-0.0072736323372494492,-9.7254612862478726],"FOG":[0.77889603227738835],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.6293691800249133,-11.786871292975876,-27.260986628265801,61.479877903796144,61.479877903796144],"omega_rad_s":[-3.6742218651899043,-11.774092530384509,-27.268906930221561,61.48822447508519,61.488228194542565],"thrust_n":[-0.17265171668916476,-1.7707313705466989,-9.4852927772358839,48.218041852401392,48.220024520396549],"torque_nm":[0.0032372196879218397,0.033201213197750608,0.17784923957317283,-0.90408828473252623,-0.90412545975743541],"angle_rad":[-569.0841515776001,310.37997082969139,-852.34675241997081,2487.0399056804131,2487.0398899051143]},"command":[-0.03456542076214203,-0.11225591707596072,-0.25962844407872193,0.58552264670282039,0.58552264670282039],"arm":{"servo_position":[1.9190590211230062e-23,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[3.3881317890172014e-21,0,0,0,0,-4.3368086899420177e-19],"servo_effort":[0.012548573597084514,-1.4981590737943824,-0.27049137471218171,1.3043498547738445e-05,-0.00039745880820137101,0.00010915197206087713]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":930,"step":7440,"t":37.200000000000003,"sim_time":37.200000000000578,"vehicle":{"origin_ned":[1.5007707763911511,0.99955928194702848,3.4986845423449671],"origin_quat_xyzw":[-0.021708525751332652,0.053635972951747664,0.38147816498951376,0.92256508277273108],"cg_ned":[1.4404057772923982,0.94005792081246697,3.2062609002806512],"linear_velocity_ned":[0.00020645901847153746,-0.00012479510834987489,0.0013665855869558316],"angular_velocity_ned":[-0.00011975336215015871,-3.6562309495486361e-05,0.0013889284459713532]},"sensors":{"Odom":[1.5007707763911511,0.99955928194702848,3.4986845423449671,-8.19251014829389e-05,-8.2909700744700739e-05,0.0013613904913130032,-0.021708525751332676,0.053635972951747719,0.38147816498951415,0.92256508277273108,-0.00027032034598365351,5.9888139544149734e-05,0.0013667992608790542],"Pressure":[26820.845792591259],"DVL":[-0.031736699262327042,-0.00047598009883714537,-0.011004453744447612,7.4267650272651284,0.024215037181473775,0.011923148912273267,-0.034175803826379483,0],"IMU":[0.00087269283154320127,0.11578655131086192,0.784225686287087,0.015443325599776717,0.019038386961529041,-0.062519952250331745,1.1252706521516376,-0.0050271091938045766,-9.7320568339500682],"FOG":[0.77454336300313065],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.6407425218650626,-11.803185732374669,-27.254525252320317,61.475414540649695,61.475414540649695],"omega_rad_s":[-3.683834385886521,-11.790928451060829,-27.262335775113371,61.483584701070825,61.483588601456916],"thrust_n":[-0.1735460728881163,-1.7757756470259192,-9.4807475570464241,48.210977974586207,48.212833017271407],"torque_nm":[0.0032539888666521808,0.033295793381735987,0.17776401669462044,-0.90395583702349147,-0.90399061907383893],"angle_rad":[-569.23133903605628,309.90862283775743,-853.43735889211644,2489.4993288405999,2489.4993132181726]},"command":[-0.034673738303476788,-0.11241129268928256,-0.2595669071649554,0.58548013848237801,0.58548013848237801],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.012396944137103369,-1.4980679500421261,-0.27048600840019971,1.280177542980881e-05,-0.00039753363970511932,0.0001092357787291944]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":931,"step":7448,"t":37.240000000000002,"sim_time":37.240000000000599,"vehicle":{"origin_ned":[1.5007752054506165,0.99955903979430061,3.4987388781633246],"origin_quat_xyzw":[-0.021712421170634152,0.05363559344132493,0.38150351793891368,0.92255452938205162],"cg_ned":[1.4404139157892484,0.940052986819221,3.2063154251008856],"linear_velocity_ned":[0.00020112433769682524,-0.00012223046960482974,0.0013603482544518577],"angular_velocity_ned":[-0.00011291931416783897,-3.5515166039670201e-05,0.0013759450434317898]},"sensors":{"Odom":[1.5007752054506165,0.99955903979430061,3.4987388781633246,-8.4405093858627619e-05,-8.0072184323240158e-05,0.0013551650817466162,-0.021712421170634162,0.053635593441324951,0.38150351793891385,0.92255452938205162,-0.00026328019293664058,5.5791915137819523e-05,0.0013545507237781725],"Pressure":[26822.908211382779],"DVL":[-0.035823887635685447,-0.039009999688720536,0.012359648496433536,7.3301035705669433,-0.048181604404214949,0.020913206907995387,0.0073560860194994927,0],"IMU":[0.00086836489205735371,0.11578880707703491,0.78428045189839179,-0.04026837904309985,-0.0576756773490932,0.018913260902594133,1.1237468956390289,-0.0099763944465493717,-9.7592449569087645],"FOG":[0.79021074756329024],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.6523549197046621,-11.819415804025297,-27.248035168411196,61.470951842429805,61.470951842429805],"omega_rad_s":[-3.6938347892094443,-11.807679918056765,-27.255730970002269,61.478944639525238,61.478948713720627],"thrust_n":[-0.17447933030697385,-1.7808015654577518,-9.476180229733087,48.203927335533969,48.205656871029319],"torque_nm":[0.0032714874432557602,0.033390029352332852,0.17767837930749542,-0.90382363754126194,-0.90385606633179993],"angle_rad":[-569.37891996479846,309.43660332035677,-854.52770174151271,2491.9585663970729,2491.9585509345961]},"command":[-0.034784332568615829,-0.11256586480024093,-0.2595050968420114,0.5854376365945696,0.5854376365945696],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.012246652141106276,-1.4979737875277561,-0.27047966413839364,1.2561339096876952e-05,-0.0003976071719771572,0.00010931732966781033]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":932,"step":7456,"t":37.280000000000001,"sim_time":37.280000000000619,"vehicle":{"origin_ned":[1.5007794649106416,0.99955878691091427,3.4987929667819873],"origin_quat_xyzw":[-0.021716166411205683,0.053635188484837233,0.38152863805194726,0.92254407646400449],"cg_ned":[1.4404218402522009,0.94004815444282663,3.2063696891516726],"linear_velocity_ned":[0.00019576109127612536,-0.0001197086922740943,0.0013536109528961302],"angular_velocity_ned":[-0.00010597541704312279,-3.425423772363925e-05,0.0013628758115191032]},"sensors":{"Odom":[1.5007794649106416,0.99955878691091427,3.4987929667819873,-8.6854480682068766e-05,-7.7318772146797395e-05,0.001348433658451514,-0.02171616641120569,0.053635188484837254,0.38152863805194737,0.92254407646400449,-0.00025600308709415674,5.1769131322498325e-05,0.0013422432700087275],"Pressure":[26821.76674004535],"DVL":[-0.0065047939382535261,0.0061213206263500252,-0.015284262126467454,7.3867937197763167,0.0014228287805351861,0.022246577599172229,-0.042054769166477345,0],"IMU":[0.00086426693622527128,0.11579090129291056,0.78433472279598071,0.028682044266137179,0.11603394894979953,0.1663171150033691,1.1296207055628216,-0.0086720029180722153,-9.7338229356190098],"FOG":[0.77635312334825612],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.6641545155820232,-11.835556599916103,-27.241519404776287,61.466491706751505,61.466491706751505],"omega_rad_s":[-3.7041708056803304,-11.824341997964932,-27.249095694256201,61.474306295358858,61.474310536092581],"thrust_n":[-0.1754468403434829,-1.785807529360347,-9.4715930306575373,48.196892733933204,48.198499002415332],"torque_nm":[0.0032896282564403049,0.033483891175506507,0.17759236932482886,-0.90369173876124775,-0.90372185629528767],"angle_rad":[-569.52690869049809,308.96391576826892,-855.61777969469313,2494.4176183841769,2494.4176030884391]},"command":[-0.034896709672209744,-0.11271958666586765,-0.25944304195025036,0.58539515911191908,0.58539515911191908],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.01209792660875075,-1.497876673271805,-0.27047235619678595,1.2321040847357246e-05,-0.00039767914258460218,0.00010939567068329389]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":933,"step":7464,"t":37.32,"sim_time":37.32000000000064,"vehicle":{"origin_ned":[1.5007835562304135,0.99955852030192516,3.4988467881775729],"origin_quat_xyzw":[-0.021719758091615856,0.05363476111403933,0.38155352397605136,0.92253372450558047],"cg_ned":[1.4404295495697548,0.94004342199618074,3.2064236726670514],"linear_velocity_ned":[0.00019037066610179219,-0.00011722859132137131,0.0013463840427126053],"angular_velocity_ned":[-9.8948005561127556e-05,-3.280107126482225e-05,0.0013497239547541095]},"sensors":{"Odom":[1.5007835562304135,0.99955852030192516,3.4988467881775729,-8.927166757578093e-05,-7.4639407227184253e-05,0.0013412065606753286,-0.021719758091615866,0.053634761114039357,0.38155352397605158,0.92253372450558047,-0.00024852302459198866,4.7823113587864178e-05,0.0013298761702399706],"Pressure":[26822.425490491365],"DVL":[0.0035683259243256028,-0.010398054958437425,0.0015434562033112928,7.2991961598241568,-0.0065298777075209636,-0.0061040096809451948,0.030822798785319034,0],"IMU":[0.00086040739251546706,0.11579283695883025,0.78438849659375964,0.059401643021474868,-0.0044752374660739702,0.33731195746408349,1.1283943524454148,-0.0085524002703687638,-9.7477265708007153],"FOG":[0.78719002361351209],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.6760872764181722,-11.851603068620962,-27.234981010208251,61.462036042467581,61.462036042467581],"omega_rad_s":[-3.7147886424679113,-11.840909732621498,-27.242433126373967,61.469671646330077,61.469676046206636],"thrust_n":[-0.17644376508668641,-1.7907919265310066,-9.4669881913881735,48.189876935105886,48.191362281072891],"torque_nm":[0.0033083205953753705,0.033577348622456385,0.17750602858852824,-0.90356019253323527,-0.90358804277011673],"angle_rad":[-569.67531741512346,308.49056386988207,-856.70759160542673,2496.8764849157692,2496.8764697932666]},"command":[-0.035010355013506404,-0.11287241017734249,-0.25938077152579286,0.58535272421397699,0.58535272421397699],"arm":{"servo_position":[2.2499312661440551e-24,3.2526065174565154e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,8.6736173798840355e-19,0,0,0,0],"servo_effort":[0.01195096883974227,-1.4977768291418583,-0.27046413728184815,1.2082664624481239e-05,-0.00039775005679716397,0.000109472360227397]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":934,"step":7472,"t":37.359999999999999,"sim_time":37.36000000000066,"vehicle":{"origin_ned":[1.5007874806639037,0.99955823733233284,3.4989003227328204],"origin_quat_xyzw":[-0.02172319348590062,0.053634314155590737,0.38157817438031982,0.92252347398124002],"cg_ned":[1.4404370426891264,0.9400387878367803,3.2064773562968445],"linear_velocity_ned":[0.00018495462484974435,-0.00011478909319556113,0.0013386779475975427],"angular_velocity_ned":[-9.186336081551871e-05,-3.1177732417261893e-05,0.0013364927031782753]},"sensors":{"Odom":[1.5007874806639037,0.99955823733233284,3.4989003227328204,-9.1655142795336661e-05,-7.2024140963411259e-05,0.0013334942156916049,-0.021723193485900627,0.053634314155590751,0.38157817438031999,0.92252347398124002,-0.00024087433051226119,4.3956787770777725e-05,0.0013174486826502668],"Pressure":[26822.53284564738],"DVL":[-0.036802867271363823,0.0016046105087576049,0.010806352055216894,7.3065977696088149,0.021010551336562482,-0.024608285480433877,0.015683351981944944,0],"IMU":[0.0008567933177425661,0.11579461719680693,0.78444177087579647,-0.016555627493558732,0.064113355994897259,-0.096751651240000971,1.1294780389151462,-0.012064764364410703,-9.7660228130632536],"FOG":[0.78923880750661757],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.6880985584101134,-11.867549776949287,-27.228422870748965,61.457586742012658,61.457586742012658],"omega_rad_s":[-3.7256331282186763,-11.857378014060593,-27.235746386737656,61.465042651592761,61.465047203123575],"thrust_n":[-0.17746508498585123,-1.7957530918952158,-9.4623679014230166,48.182882679422498,48.184249536904822],"torque_nm":[0.0033274703434847111,0.03367037047303529,0.17741939815168156,-0.90342905023917186,-0.90345467881696551],"angle_rad":[-569.82415615629463,308.01655151520458,-857.79713645330219,2499.3351661844135,2499.3351512413433]},"command":[-0.035124748175334411,-0.11302428358999321,-0.25931831305475206,0.58531034992393005,0.58531034992393005],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,-3.22931311140702e-23,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,-6.7762635780344027e-21,0,4.3368086899420177e-19],"servo_effort":[0.011805890030810489,-1.4976743183245027,-0.27045500500358766,1.1845273226199723e-05,-0.00039781974089009021,0.00010954600047226484]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":935,"step":7480,"t":37.399999999999999,"sim_time":37.400000000000681,"vehicle":{"origin_ned":[1.5007912392631713,0.99955793572249452,3.4989535512399907],"origin_quat_xyzw":[-0.021726470524992127,0.053633850224004229,0.381602587956553,0.92251332535283026],"cg_ned":[1.4404443186238538,0.94003425036286536,3.206530721109071],"linear_velocity_ned":[0.00017951468504105671,-0.00011238922145321931,0.0013305031357265268],"angular_velocity_ned":[-8.4747616530515097e-05,-2.9406655078612851e-05,0.0013231853596868367]},"sensors":{"Odom":[1.5007912392631713,0.99955793572249452,3.4989535512399907,-9.4003467464987063e-05,-6.9463154684540535e-05,0.0013253071175095691,-0.021726470524992134,0.053633850224004249,0.38160258795655311,0.92251332535283026,-0.0002330914927081649,4.0172720717795036e-05,0.0013049601198876957],"Pressure":[26825.775680289575],"DVL":[-0.020632564847000462,0.023505841514707755,0.00039220737023910857,7.359525413331176,-0.0088355183718306467,0.012520451938912488,0.00027840463071278457,0],"IMU":[0.00085343038912069331,0.1157962452387699,0.78449454319785239,-0.041834817910376416,0.029886934938273404,-0.062914366776749928,1.1147480916142498,0.0085908633713627589,-9.7495982899570173],"FOG":[0.78516777169593532],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.7001342599952776,-11.88339145126405,-27.221847918840407,61.453145658683873,61.453145658683873],"omega_rad_s":[-3.736648311246618,-11.873741655575159,-27.229038566933284,61.460421244582719,61.460425940213732],"thrust_n":[-0.17850565050912506,-1.8006893291475341,-9.4577343288846816,48.17591266888045,48.177163551535685],"torque_nm":[0.0033469809470460955,0.033762924921516266,0.17733251866658781,-0.90329836254150864,-0.90332181659129418],"angle_rad":[-569.97343270565977,307.54188280058986,-858.8864133420393,2501.7936624604686,2501.7936477027256]},"command":[-0.035239373904716931,-0.11317515667870523,-0.25925569446514674,0.58526805389222736,0.58526805389222736],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,1.0778494253810979e-21,1.5881867761018145e-24,-1.6940658945088655e-23,-1.1180834903756616e-21],"servo_velocity":[0,-8.6736173798840355e-19,-1.7347234759768071e-18,0,0,-8.6736173798840355e-19],"servo_effort":[0.011662804102760556,-1.4975693026842967,-0.27044500297717472,1.160953025412693e-05,-0.00039788734652521031,0.00010961773981033745]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":936,"step":7488,"t":37.439999999999998,"sim_time":37.440000000000701,"vehicle":{"origin_ned":[1.5007948328794145,0.99955761354107264,3.4990064549025868],"origin_quat_xyzw":[-0.021729587795337613,0.053633371714032582,0.38162676341992963,0.92250327906975926],"cg_ned":[1.4404513764587683,0.94002980800880176,3.2065837485904081],"linear_velocity_ned":[0.00017405267940069952,-0.00011002812995137653,0.0013218700833545756],"angular_velocity_ned":[-7.7626680119059424e-05,-2.7510511724337179e-05,0.0013098052607179778]},"sensors":{"Odom":[1.5007948328794145,0.99955761354107264,3.4990064549025868,-9.6315311762858478e-05,-6.6946801537157914e-05,0.0013166557829498917,-0.02172958779533762,0.053633371714032596,0.38162676341992974,0.92250327906975926,-0.00022520901092565687,3.6473156137925046e-05,0.0012924098270306356],"Pressure":[26824.647907723367],"DVL":[0.0062110317796175213,0.03330935266483924,0.031096758311477405,7.3756499249702276,-0.024798270274531378,0.0096710346741089321,0.0067843444812363618,0],"IMU":[0.00085032290104934531,0.11579772441161597,0.78454681108829327,-0.015426749700823734,0.033908942417180572,0.0097166970059938476,1.1230249437656517,-0.0052399016063065743,-9.7288185344696707],"FOG":[0.77299120820238587],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.7121406721881534,-11.899122736328609,-27.215259070227823,61.448714628452997,61.448714628452997],"omega_rad_s":[-3.7477778591818547,-11.889995409040321,-27.222312733539187,61.455809333055022,61.455814165192749],"thrust_n":[-0.17956021646935102,-1.8055989156676653,-9.453089622601027,48.168969568873415,48.170107059399619],"torque_nm":[0.0033667540588003318,0.033854979668768735,0.17724543042376922,-0.90316817941637662,-0.90318950736374293],"angle_rad":[-570.12315260708408,307.06656203121622,-859.97542149843946,2504.2519740910293,2504.2519595242084]},"command":[-0.035353720687506224,-0.11332497844122486,-0.25919294352597927,0.58522585360431423,0.58522585360431423],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.011521855008868539,-1.4974618948163758,-0.27043414652644771,1.1374755380097956e-05,-0.00039795433160432045,0.00010968642353314614]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":937,"step":7496,"t":37.480000000000004,"sim_time":37.480000000000722,"vehicle":{"origin_ned":[1.500798262165068,0.99955726919746779,3.499059015337382],"origin_quat_xyzw":[-0.02173254453525356,0.053632880794848369,0.38165069951068686,0.92249333556870317],"cg_ned":[1.4404582153546215,0.94002545924067793,3.2066364206470968],"linear_velocity_ned":[0.0001685705541290981,-0.00010770506880681067,0.0013127892734287384],"angular_velocity_ned":[-7.0526095130167722e-05,-2.5512172836065469e-05,0.0012963558356580854]},"sensors":{"Odom":[1.500798262165068,0.99955726919746779,3.499059015337382,-9.8589452623687907e-05,-6.4465612881264552e-05,0.0013075507563390161,-0.021732544535253581,0.053632880794848417,0.3816506995106872,0.92249333556870317,-0.00021726127857738312,3.2859946107692588e-05,0.0012797972552223342],"Pressure":[26825.128853612056],"DVL":[0.011667366441294656,0.013156353007583889,0.011005698488862702,7.4072677136026028,-0.027988239073204257,0.011618426967389921,0.0057404419251391482,0],"IMU":[0.00084747376761154362,0.1157990581238377,0.78459857205155703,0.055724097331162958,-0.03901245724152963,-0.19836655674597575,1.1498197085506907,-0.016544175524588318,-9.7326894394205379],"FOG":[0.79514380142742558],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.7240646931135095,-11.914738336297065,-27.208659194682742,61.444295456679455,61.444295456679455],"omega_rad_s":[-3.7589654086975401,-11.906133990754334,-27.215571923358684,61.451208798728736,61.451213759764144],"thrust_n":[-0.18062347298215042,-1.8104801105966986,-9.4484359087775474,48.162056007700414,48.163082746508692],"torque_nm":[0.0033866901184153209,0.033946502073688094,0.177158173289579,-0.90303855014438283,-0.90305780149703796],"angle_rad":[-570.2733191497241,306.59059372312083,-861.06416027131718,2506.7101014989189,2506.7100871283083]},"command":[-0.035467282791557232,-0.11347369844092443,-0.25913008756840705,0.58518376625409008,0.58518376625409008],"arm":{"servo_position":[2.2499312661440551e-24,3.2526065174565154e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,8.6736173798840355e-19,0,0,0,4.3368086899420177e-19],"servo_effort":[0.011383155649161971,-1.4973522520019367,-0.27042248150821901,1.1142203433179474e-05,-0.00039801929758268337,0.00010975303197181196]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":938,"step":7504,"t":37.520000000000003,"sim_time":37.520000000000742,"vehicle":{"origin_ned":[1.5008015275786961,0.99955690143476561,3.4991112145747971],"origin_quat_xyzw":[-0.021735340628071805,0.053632379405770217,0.38167439499546846,0.92248349527343854],"cg_ned":[1.4404648345538993,0.94002120255386235,3.2066887196042311],"linear_velocity_ned":[0.00016307044263468807,-0.00010541930633814071,0.0013032711859511316],"angular_velocity_ned":[-6.3471025063914326e-05,-2.3434415553164788e-05,0.0012828405291003295]},"sensors":{"Odom":[1.5008015275786961,0.99955690143476561,3.4991112145747971,-0.00010082460758657348,-6.2010365174310683e-05,0.0012980026025069473,-0.021735340628071823,0.053632379405770259,0.38167439499546879,0.92248349527343854,-0.00020928235799340335,2.9334745652580229e-05,0.0012671219094024129],"Pressure":[26826.83067499418],"DVL":[-0.01715805525107205,0.0066057327383756753,-0.034952077380363607,7.3653733971514432,-0.017824710206776135,-0.016188097598628069,0.0028674602213955474,0],"IMU":[0.00084488453217444639,0.11580024985255341,0.78464982357132684,-0.033716995207305651,-0.040839889590460983,-0.072145070701189418,1.1472291927031368,0.0048590907045941156,-9.7378962374790792],"FOG":[0.77743298220471757],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.7358540397244857,-11.930233031440265,-27.202051131358076,61.439889939583196,61.439889939583196],"omega_rad_s":[-3.7701548472270336,-11.922152115447792,-27.208819137225611,61.446621500452089,61.446626582783509],"thrust_n":[-0.18169007128191547,-1.8153311656476971,-9.4437752878288457,48.155174580287067,48.156093258063571],"torque_nm":[0.0034066888365359149,0.034037459355894334,0.17707078664679088,-0.90290952338038244,-0.90292674858869204],"angle_rad":[-570.42393337311933,306.11398260386198,-862.15262913009781,2509.1680451816928,2509.168031012277]},"command":[-0.035579562283090338,-0.11362126696609776,-0.25906715363198168,0.58514180894841139,0.58514180894841139],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,4.3368086899420177e-19],"servo_effort":[0.011246761401168853,-1.4972404232719005,-0.27041000176794966,1.0910650172468148e-05,-0.00039808314509875384,0.0001098169792816727]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":939,"step":7512,"t":37.560000000000002,"sim_time":37.560000000000763,"vehicle":{"origin_ned":[1.5008046293895363,0.9995565093193024,3.4991630350606657],"origin_quat_xyzw":[-0.021737976592518856,0.053631869253823211,0.3816978486687877,0.92247375859458625],"cg_ned":[1.4404712333846643,0.94001703646826829,3.2067406282065445],"linear_velocity_ned":[0.00015755444668554041,-0.00010317035449355341,0.0012933263018989388],"angular_velocity_ned":[-5.6485901829694363e-05,-2.1300104579985842e-05,0.0012692628824546605]},"sensors":{"Odom":[1.5008046293895363,0.9995565093193024,3.4991630350606657,-0.0001030198602951276,-5.9572113199863218e-05,0.0012880218933766412,-0.021737976592518866,0.053631869253823246,0.38169784866878792,0.92247375859458625,-0.00020130586978216891,2.5898636259937313e-05,0.0012543834436761618],"Pressure":[26827.620433839504],"DVL":[0.0035718328309058962,0.023997205980761271,-0.014066979199517504,7.29538805024246,0.0022488029504100625,0.01991577271553192,0.0062461647115307503,0],"IMU":[0.00084255538355333605,0.1158013031318052,0.78470056311436409,0.0031276122242652757,0.081149602768735715,-0.076043748917987153,1.1161499379849498,-0.0057337672030997131,-9.7473784797722143],"FOG":[0.79664783609443746],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.7474576014680605,-11.945601761378239,-27.195437731384825,61.435499839141791,61.435499839141791],"omega_rad_s":[-3.7812906290767589,-11.938044560897959,-27.20205736309973,61.442049271780206,61.442054467832868],"thrust_n":[-0.18275465417022627,-1.8201503439042126,-9.4391098475799229,48.148327847542554,48.149141190898796],"torque_nm":[0.003426649765691743,0.034127818948203985,0.17698330964212361,-0.90278114714142299,-0.90279639732935246],"angle_rad":[-570.57499408444642,305.6367336109156,-863.24082766403558,2511.6258057106916,2511.6257917471521]},"command":[-0.035690072394933908,-0.1137676358226499,-0.25900416887033167,0.58509999846801708,0.58509999846801708],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.011112767837511266,-1.4971266571477679,-0.27039677427834385,1.0681503006734353e-05,-0.00039814648490853536,0.00010987888556868285]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":940,"step":7520,"t":37.600000000000001,"sim_time":37.600000000000783,"vehicle":{"origin_ned":[1.500807567678311,0.99955609222346387,3.4992144596572112],"origin_quat_xyzw":[-0.021740453567199287,0.05363135180793574,0.38172105935409467,0.92246412592985605],"cg_ned":[1.4404774112610921,0.94001295952087316,3.2067921296175022],"linear_velocity_ned":[0.00015202480181553398,-0.00010095780660228989,0.0012829650810183815],"angular_velocity_ned":[-4.9594480952530189e-05,-1.9131675573726874e-05,0.0012556262558292932]},"sensors":{"Odom":[1.500807567678311,0.99955609222346387,3.4992144596572112,-0.00010517430646971463,-5.7142310849321065e-05,0.0012776191922553961,-0.021740453567199308,0.053631351807935788,0.381721059354095,0.92246412592985605,-0.00019336463699927658,2.2552530052748638e-05,0.0012415814223905967],"Pressure":[26826.006975912722],"DVL":[-0.01655620969674907,0.017504884139918193,0.006311306012518442,7.3110255120702901,-0.026918247617056745,0.0013006304005658226,-0.0043642237678684402,0],"IMU":[0.00084048518047473593,0.11580222153010795,0.78475078813370691,0.021332116581674495,0.046726335930531694,-0.038901418008428695,1.1463859150482114,-0.0010051890612979104,-9.7471923904510955],"FOG":[0.77500235996125855],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.7588255410476226,-11.960839122262655,-27.188821550698218,61.43112690483467,61.43112690483467],"omega_rad_s":[-3.7923180361747697,-11.953806044294046,-27.195289487115943,61.437493923790107,61.437499226041126],"thrust_n":[-0.18381188240101454,-1.8249358827151019,-9.4344416033119813,48.141518339511784,48.142229100966667],"torque_nm":[0.0034464727950190236,0.03421754780090816,0.17689578006209969,-0.90265346886584596,-0.90266679564312513],"angle_rad":[-570.72649788727585,305.15885189191886,-864.32875557968543,2514.0833837300847,2514.0833699768014]},"command":[-0.035798338486167834,-0.11391275354535862,-0.2589411576256973,0.58505835147461593,0.58505835147461593],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.010981775000737092,-1.4970115544185283,-0.27038301739409537,1.0498204988417904e-05,-0.00039820955113245056,0.00010993770290405843]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":941,"step":7528,"t":37.640000000000001,"sim_time":37.640000000000803,"vehicle":{"origin_ned":[1.5008103423574133,0.99955564981481393,3.4992654716391947],"origin_quat_xyzw":[-0.021742773291984097,0.053630828314572589,0.3817440258942576,0.9224545976675006],"cg_ned":[1.4404833676899709,0.94000897026256169,3.2068432074167315],"linear_velocity_ned":[0.00014648386585333238,-9.8781359752667694e-05,0.001272197889574146],"angular_velocity_ned":[-4.2819881144529477e-05,-1.6950455724356586e-05,0.0012419334269182321]},"sensors":{"Odom":[1.5008103423574133,0.99955564981481393,3.4992654716391947,-0.00010728691685340106,-5.4712984970440104e-05,0.0012668049536109999,-0.021742773291984114,0.05363082831457263,0.38174402589425788,0.9224545976675006,-0.00018549018975613969,1.9297677947525329e-05,0.0012287149735383811],"Pressure":[26825.860371081995],"DVL":[0.015042696461780546,-0.0018075421029896792,0.01041210409933512,7.3725427049498116,0.019082159021765136,0.0055637295118136452,-0.0032792935494895263,0],"IMU":[0.00083867149697890153,0.115803008665307,0.78480049605104252,0.048100306164699125,0.030863243056128021,-0.0043587110515106164,1.1244384174725437,0.010836825921924333,-9.7386205971647009],"FOG":[0.78522823066849401],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.7699110822076749,-11.975939506750308,-27.182205655307918,61.426772895881214,61.426772895881214],"omega_rad_s":[-3.803183793444699,-11.969431196305157,-27.188518433989096,61.432957251695285,61.43296265268507],"thrust_n":[-0.1848564967354942,-1.8296859852282055,-9.4297725966949688,48.134748557615794,48.135359527879785],"torque_nm":[0.0034660593137905166,0.034306612223028853,0.17680823618803071,-0.90252653545529637,-0.90253799114774602],"angle_rad":[-570.87843922695697,304.68034280739892,-865.41641269930108,2516.5407799560758,2516.5407664171285]},"command":[-0.035903915068644522,-0.11405656673095531,-0.25887814909817064,0.58501688472267821,0.58501688472267821],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,1.0778494253810979e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,-1.7347234759768071e-18,0,0,-4.3368086899420177e-19],"servo_effort":[0.01085413738008555,-1.4968955500992078,-0.2703688830428142,1.0388919509545832e-05,-0.00039827563205304425,0.00010999459095234572]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":942,"step":7536,"t":37.68,"sim_time":37.680000000000824,"vehicle":{"origin_ned":[1.5008129531737426,0.99955518204365923,3.499316054690282],"origin_quat_xyzw":[-0.021744938090472565,0.053630299791247532,0.38176674715945058,0.92244517418382888],"cg_ned":[1.4404891022738624,0.9400050672559549,3.2068938455942604],"linear_velocity_ned":[0.000140934066795739,-9.6640721181551255e-05,0.0012610347304450799],"angular_velocity_ned":[-3.6184076306383065e-05,-1.4778312643153892e-05,0.0012281880491326357]},"sensors":{"Odom":[1.5008129531737426,0.99955518204365923,3.499316054690282,-0.00010935693441472031,-5.2276273083610255e-05,0.0012555893354159631,-0.021744938090472579,0.053630299791247574,0.38176674715945086,0.92244517418382888,-0.00017771373408327797,1.613414484669748e-05,0.0012157841453248181],"Pressure":[26827.452403362655],"DVL":[0.038038465903153365,-0.012628719264149345,0.0086841805271439913,7.3825084534624139,0.0057280645354739748,-0.010498998641677543,0.0044249668351458195,0],"IMU":[0.00083711065096524597,0.11580366817928398,0.78484968427486057,-0.009239946964030776,-0.027036829814216096,-0.074090767271137933,1.1264917552654483,-0.0071974842428441498,-9.7432661351237364],"FOG":[0.76415216190913371],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.780668533654342,-11.990897674184742,-27.175592801777995,61.422439548509772,61.422439548509772],"omega_rad_s":[-3.8138362722365371,-11.984914616686147,-27.181747150521613,61.428441038597157,61.428446530942729],"thrust_n":[-0.18588334146296598,-1.8343988399190194,-9.4251048819520911,48.128021005043145,48.128534980827823],"torque_nm":[0.0034853126524306125,0.034394978248481617,0.17672071653660171,-0.90240039384455917,-0.90241003089052163],"angle_rad":[-571.0308104569333,304.20121193420596,-866.50379896334016,2518.9979951764431,2518.9979818556144]},"command":[-0.036006366987184207,-0.11419902546842611,-0.2588151695407428,0.58497561474771209,0.58497561474771209],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,-4.3368086899420177e-19],"servo_effort":[0.010729017728367259,-1.496777841992172,-0.2703540607359069,1.028013515201524e-05,-0.00039834003119807235,0.00011004889609538485]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":943,"step":7544,"t":37.719999999999999,"sim_time":37.720000000000844,"vehicle":{"origin_ned":[1.5008153997058475,0.99955468912540058,3.499366192721717],"origin_quat_xyzw":[-0.021746950841872757,0.053629766996021393,0.38178922205657095,0.92243585584173382],"cg_ned":[1.4404946147192887,0.94000124907904004,3.2069440283626061],"linear_velocity_ned":[0.00013537816657752572,-9.4535416799782705e-05,0.0012494769046385438],"angular_velocity_ned":[-2.9706427341931593e-05,-1.263833657043058e-05,0.0012143938833515857]},"sensors":{"Odom":[1.5008153997058475,0.99955468912540058,3.499366192721717,-0.00011138304785170082,-4.9824708822946514e-05,0.0012439740303163169,-0.021746950841872763,0.053629766996021414,0.38178922205657106,0.92243585584173382,-0.000170065510561627,1.3059288618016315e-05,0.0012027892086299403],"Pressure":[26827.553985961778],"DVL":[0.049833776703193257,0.014027631012479832,0.01587101625612914,7.3240499746728203,0.0018853501577546891,0.027506491393392628,-0.017464113359467064,0],"IMU":[0.00083579773404004294,0.11580420366009404,0.78489835022071508,0.040827836287299399,0.015363745887982604,-0.19973174709209132,1.1349543073144017,-0.010832281586141353,-9.7202928484011135],"FOG":[0.78539293269382127],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.7910531676818788,-12.005709175844247,-27.168985574437695,61.418129911133562,61.418129911133562],"omega_rad_s":[-3.8242251843128625,-12.000251147170715,-27.17497847638343,61.423947316685357,61.423952893119939],"thrust_n":[-0.18688733925525466,-1.8390727102041444,-9.4204404527000829,48.121338809846051,48.121758518391751],"torque_nm":[0.0035041376110360261,0.034482613316327709,0.17663325848812655,-0.90227510268461364,-0.90228297221984555],"angle_rad":[-571.18360189572695,303.72146506034323,-867.59091442743465,2521.4550302537623,2521.4550171545429]},"command":[-0.036105268263636942,-0.11434008738899283,-0.25875224356607329,0.58493457058222442,0.58493457058222442],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,-8.6736173798840355e-19,0],"servo_effort":[0.010606471633181378,-1.4966574062553366,-0.27033842305792966,1.0170713430820847e-05,-0.00038500256492531449,0.0001101006852544663]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":944,"step":7552,"t":37.759999999999998,"sim_time":37.760000000000865,"vehicle":{"origin_ned":[1.5008176813741456,0.99955417152433013,3.4994158698058131],"origin_quat_xyzw":[-0.021748814953048885,0.053629230422819862,0.38181144953158569,0.92242664299064092],"cg_ned":[1.4404999048433274,0.93999751432510437,3.2069937400877473],"linear_velocity_ned":[0.00012981886339487713,-9.2465193495828453e-05,0.001237532406474708],"angular_velocity_ned":[-2.340640483608234e-05,-1.0551575140924741e-05,0.0012005546627250399]},"sensors":{"Odom":[1.5008176813741456,0.99955417152433013,3.4994158698058131,-0.00011336446101699901,-4.7351335695410889e-05,0.0012319672788615602,-0.021748814953048898,0.053629230422819897,0.38181144953158597,0.92242664299064092,-0.00016257440014116393,1.0071994021762522e-05,0.0011897305632248448],"Pressure":[26826.45793543987],"DVL":[0.019319832050580282,-0.023373093119233929,0.001451527168968253,7.3601686388706824,-0.019766322601983397,0.020855723054456782,0.001362258360402801,0],"IMU":[0.00083472666007278489,0.11580461861202047,0.78494649131841432,-0.015212318999349234,-0.034823068545292615,-0.089936884803396594,1.124966781635101,0.0054268513044329406,-9.7338607603573148],"FOG":[0.7855623798721264],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.8010225242253539,-12.02037024736183,-27.162386669113868,61.413848600507514,61.413848600507514],"omega_rad_s":[-3.8343018682112402,-12.015436087295594,-27.168215238838947,61.419479046704772,61.419484700133886],"thrust_n":[-0.18786352402132178,-1.8437059905173441,-9.4157812841178465,48.114706437751721,48.115034560960268],"torque_nm":[0.0035224410753997831,0.0345694873222002,0.17654589907720961,-0.9021507457078447,-0.90215689801800525],"angle_rad":[-571.33680188645781,303.24110816933791,-868.67775926066156,2523.9118861545699,2523.9118732801635]},"command":[-0.03620021451643194,-0.11447971664154125,-0.25868939684870351,0.58489379619530968,0.58489379619530968],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.010486425481585003,-1.4965356179623754,-0.27032216984255464,1.0061432111643317e-05,-0.00039846684411619268,0.00011015037322285692]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":945,"step":7560,"t":37.800000000000004,"sim_time":37.800000000000885,"vehicle":{"origin_ned":[1.5008197974613713,0.99955362994477281,3.4994650704263055],"origin_quat_xyzw":[-0.021750534343315968,0.053628690339083185,0.38183342856935004,0.92241753596474407],"cg_ned":[1.4405049725701908,0.93999386159381315,3.2070429655444355],"linear_velocity_ned":[0.00012425885346778307,-9.0429929682553134e-05,0.0012252119963620141],"angular_velocity_ned":[-1.7302819462229184e-05,-8.5377550846087202e-06,0.0011866740943822058]},"sensors":{"Odom":[1.5008197974613713,0.99955362994477281,3.4994650704263055,-0.00011530064974550612,-4.4849700426574044e-05,0.0012195800341173331,-0.021750534343315975,0.053628690339083206,0.38183342856935021,0.92241753596474407,-0.0001552678899768396,7.1716178874130737e-06,0.0011766087443751529],"Pressure":[26828.273891417379],"DVL":[-0.01630548332259309,-0.0054494566249367899,-0.00078396777716903626,7.3844445029283863,0.046938237807445299,0.013892470576481051,0.018005574041876592,0],"IMU":[0.00083389022242792363,0.11580491651374308,0.78499410501638389,-0.025511214692494649,-0.031662906799964183,-0.013407950824723283,1.1494627973659364,-0.0021965396005404507,-9.7730140443614388],"FOG":[0.78829195807703167],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.8105366777090981,-12.034876361840968,-27.155798364580374,61.409597242819352,61.409597242819352],"omega_rad_s":[-3.8440196302309504,-12.030464828428563,-27.161460125523895,61.415038905983174,61.415044629490019],"thrust_n":[-0.18880708002581817,-1.8482970944311485,-9.4111292437855951,48.108127783839038,48.10836698468075],"torque_nm":[0.0035401327504840916,0.034655570520584038,0.17645867332097992,-0.902027395946982,-0.90203188096276432],"angle_rad":[-571.49039686987999,302.76014743008926,-869.76433374216538,2526.3685639590644,2526.3685513123942]},"command":[-0.036290825501991412,-0.11461787011277112,-0.25862665109124167,0.58485330707447003,0.58485330707447003],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,4.3198680309969292e-21,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,8.6736173798840355e-19,-4.3368086899420177e-19],"servo_effort":[0.010368915203572393,-1.4964126215762505,-0.27030532824671005,9.9512463847442601e-06,-0.00039852897339968474,0.00011019764271277744]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":946,"step":7568,"t":37.840000000000003,"sim_time":37.840000000000906,"vehicle":{"origin_ned":[1.5008217471246581,0.99955306531582844,3.4995137795013389],"origin_quat_xyzw":[-0.021752113417905339,0.053628146793264428,0.38185515819596655,0.92240853508220955],"cg_ned":[1.4405098179334144,0.93999028948857588,3.2070916899386659],"linear_velocity_ned":[0.00011870089444433227,-8.842955568700443e-05,0.0012125264595839265],"angular_velocity_ned":[-1.1413256223618542e-05,-6.615763550249466e-06,0.0011727559446384659]},"sensors":{"Odom":[1.5008217471246581,0.99955306531582844,3.4995137795013389,-0.00011719116701895624,-4.2313853835507925e-05,0.0012068232878491663,-0.021752113417905353,0.053628146793264463,0.38185515819596677,0.92240853508220955,-0.00014817202358505957,4.3572484699998893e-06,0.0011634245150598812],"Pressure":[26828.968581184425],"DVL":[-0.0030154898046681855,0.003151515620839645,-0.020949950785014989,7.3938070082982366,-0.01903088179147986,0.0028123145025401885,0.013007867453425697,0],"IMU":[0.00083328014929041135,0.11580510081200111,0.78504118878985574,-0.0093909573957257891,-0.055577002316581532,0.011249223553663807,1.1350396790968689,-0.014175637376345305,-9.7801053023516804],"FOG":[0.7898885897025526],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.8195578764325937,-12.049223189169293,-27.149222808249714,61.405377402214171,61.405377402214171],"omega_rad_s":[-3.8533338980448661,-12.045332838842757,-27.154715673965718,61.410629215309029,61.410635002156191],"thrust_n":[-0.18971336346776299,-1.852844454447943,-9.4064860930390868,48.101606186224657,48.101759100075604],"torque_nm":[0.0035571255650205568,0.034740833520898934,0.17637161424448289,-0.90190511599171241,-0.90190798312641762],"angle_rad":[-571.64437146721559,302.27858919424523,-870.8506382551833,2528.8250648461162,2528.8250524298332]},"command":[-0.036376741680310416,-0.11475450656351707,-0.25856402674523538,0.58481311811632541,0.58481311811632541],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,4.3368086899420177e-19],"servo_effort":[0.010253891649832132,-1.4962885286048082,-0.27028792701652438,9.8418087771042108e-06,-0.00039858987128203581,0.00011024292004819324]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":947,"step":7576,"t":37.880000000000003,"sim_time":37.880000000000926,"vehicle":{"origin_ned":[1.5008235294092906,0.99955247877439124,3.4995619823845794],"origin_quat_xyzw":[-0.021753557036788537,0.053627599623348496,0.38187663748087647,0.92239964064454405],"cg_ned":[1.4405144410780621,0.93998679661452811,3.2071398989081374],"linear_velocity_ned":[0.00011314779601993299,-8.646404553533347e-05,0.0011994865979359484],"angular_velocity_ned":[-5.75400119428069e-06,-4.8034850274203552e-06,0.0011588039751479332]},"sensors":{"Odom":[1.5008235294092906,0.99955247877439124,3.4995619823845794,-0.00011903562383663476,-3.9738392452750668e-05,0.0011937080589205888,-0.021753557036788555,0.053627599623348537,0.3818766374808768,0.92239964064454405,-0.00014131122754154686,1.6277686373189907e-06,0.0011501788218171861],"Pressure":[26829.888456928715],"DVL":[-0.031292743189939125,-0.0079175289798222321,0.014950001881077334,7.2923938457466102,0.014770900847914631,-0.0091040698911931221,-0.024126336458737421,0],"IMU":[0.00083288716835999525,0.11580517491357556,0.78508774014897542,-0.038061861186427216,-0.08919982477655114,0.10031627535712363,1.1225004418558986,-0.019034186034029427,-9.7813310340812833],"FOG":[0.78360256286895469],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.8280510658426805,-12.063406639397703,-27.142662041865243,61.401190605708891,61.401190605708891],"omega_rad_s":[-3.8622024181575356,-12.060035719448498,-27.147984279795796,61.406252040086919,61.406257883720542],"thrust_n":[-0.1905779288250119,-1.8573465393984623,-9.4018534928040332,48.095144584280632,48.095213812898102],"torque_nm":[0.0035733361654689739,0.034825247613721168,0.17628475299007562,-0.90178396095526181,-0.90178525899183948],"angle_rad":[-571.798708569067,301.79643999181326,-871.93667328118227,2531.281390081394,2531.2813778978839]},"command":[-0.03645762919850172,-0.11488958704188289,-0.25850154325585945,0.58477324386389418,0.58477324386389418],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,1.0778494253810979e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,-1.7347234759768071e-18,3.3881317890172014e-21,0,0],"servo_effort":[0.010141332692367154,-1.4961634835493023,-0.27026999832936133,9.7318462297622708e-06,-0.00039865048213160733,0.00011028572540185816]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":948,"step":7584,"t":37.920000000000002,"sim_time":37.920000000000947,"vehicle":{"origin_ned":[1.5008251432622621,0.9995518716481594,3.4996096648655168],"origin_quat_xyzw":[-0.021754870482622729,0.053627048465436249,0.38189786553848887,0.92239085293617051],"cg_ned":[1.4405188422624517,0.93998338157701389,3.2071875785218529],"linear_velocity_ned":[0.00010760240913100458,-8.4533412675928923e-05,0.0011861031643512576],"angular_velocity_ned":[-3.3999696668086661e-07,-3.117756411173732e-06,0.0011448219512552758]},"sensors":{"Odom":[1.5008251432622621,0.9995518716481594,3.4996096648655168,-0.0001208336862400885,-3.7118465485922688e-05,0.0011802453278398192,-0.021754870482622746,0.053627048465436283,0.38189786553848915,0.92239085293617051,-0.00013470824962790449,-1.018144198920457e-06,0.0011368728103633627],"Pressure":[26830.348884128787],"DVL":[-0.024144319230249858,0.0073772201438872462,-0.016038315841057742,7.310278250356891,-0.0024165851096413114,0.0083553281785416298,-0.0024686973335813489,0],"IMU":[0.00083270107316608412,0.11580514217670547,0.78513375664599394,-0.035450855453289534,-0.010672119468842734,-0.17804099366524473,1.1465388138796075,-0.01004121615581609,-9.7849319022996912],"FOG":[0.78075242794681998],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.8359837149700486,-12.077422804298873,-27.136118010689902,61.397038339649058,61.397038339649058],"omega_rad_s":[-3.8705853904788605,-12.074569227245165,-27.141268208761865,61.401909258525549,61.401915152580919],"thrust_n":[-0.19139654940568385,-1.861801862132451,-9.3972330120901795,48.088745627132852,48.088733732242417],"torque_nm":[0.0035886853013565728,0.034908784914983462,0.17619811897669088,-0.90166398050874108,-0.90166375747954541],"angle_rad":[-571.95338943154206,301.31370652523594,-873.02243939445907,2533.7375410087666,2533.7375290601562]},"command":[-0.036533178237809986,-0.11502307432665594,-0.25843921914942763,0.58473369847284817,0.58473369847284817],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,-1.1180834903756616e-21],"servo_velocity":[0,0,1.7347234759768071e-18,0,0,0],"servo_effort":[0.010031202055702071,-1.4960375869023925,-0.27025156718681687,9.6218514047033207e-06,-0.00039872649493491035,0.00010985627724731766]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":949,"step":7592,"t":37.960000000000001,"sim_time":37.960000000000967,"vehicle":{"origin_ned":[1.5008265875463584,0.99955124543797735,3.4996568131679178],"origin_quat_xyzw":[-0.021756059427132386,0.053626492762975819,0.38191884153046912,0.92238217222373164],"cg_ned":[1.4405230218597589,0.93998004298004145,3.2072347152778735],"linear_velocity_ned":[0.00010206761423920707,-8.2637701190690731e-05,0.0011723868751034618],"angular_velocity_ned":[4.8152378091552623e-06,-1.5742923845875518e-06,0.0011308136239538656]},"sensors":{"Odom":[1.5008265875463584,0.99955124543797735,3.4996568131679178,-0.00012258508010135359,-3.4449793683876307e-05,0.0011664460488635948,-0.021756059427132404,0.053626492762975868,0.38191884153046946,0.92238217222373164,-0.00012838404785740787,-3.5820225674851161e-06,0.0011235078203561464],"Pressure":[26830.764125225065],"DVL":[0.043234471047243858,0.0064761906922689875,-0.025953367458631353,7.4006699403461687,-0.013065112148724647,0.011435108638819887,0.0039722810606443535,0],"IMU":[0.00083271079286728795,0.11580500590249065,0.78517923588408545,-0.026568733946701183,0.016912101968365931,-0.027055728457033412,1.1548702407185598,-0.00088948562410376148,-9.7634643163022279],"FOG":[0.77903945117296991],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.8433259605006205,-12.091268058978789,-27.129592524720906,61.39292207511707,61.39292207511707],"omega_rad_s":[-3.878445588724948,-12.088929313673484,-27.134569596253357,61.397602615870262,61.397608554178383],"thrust_n":[-0.19216523669176461,-1.8662089918490694,-9.3926261277253502,48.082411759052206,48.082321255854623],"torque_nm":[0.0036030981879705873,0.034991418597170046,0.17611173989485032,-0.90154522048222896,-0.90154352354727441],"angle_rad":[-572.10839377717798,300.83039566233293,-874.10793725698386,2536.1935190440877,2536.1935073322552]},"command":[-0.036603104385720196,-0.11515493389503609,-0.25837707166400864,0.58469449595349587,0.58469449595349587],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,-1.1180834903756616e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.0099234131048395752,-1.4959109418225773,-0.27023265993182388,9.5121660994448855e-06,-0.00039878511011771326,0.00010989497362239553]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":950,"step":7600,"t":38,"sim_time":38.000000000000988,"vehicle":{"origin_ned":[1.5008278610549566,0.99955060179999344,3.4997034139488519],"origin_quat_xyzw":[-0.021757129895514319,0.053625931777787357,0.38193956466746526,0.92237359875556979],"cg_ned":[1.4405269803588516,0.93997677942528957,3.2072812961017942],"linear_velocity_ned":[9.6546317136894769e-05,-8.0776982568993603e-05,0.0011583483857634026],"angular_velocity_ned":[9.6996055864802982e-06,-1.8761312830039927e-07,0.0011167827644816043]},"sensors":{"Odom":[1.5008278610549566,0.99955060179999344,3.4997034139488519,-0.00012428957313854536,-3.1728675310986302e-05,0.0011523211233936293,-0.021757129895514329,0.053625931777787385,0.38193956466746543,0.92237359875556979,-0.00012235774573669933,-6.0655561542661259e-06,0.0011100854253962469],"Pressure":[26831.917200295749],"DVL":[0.0069786514329057362,-0.030525829554235141,-0.0044424177493871623,7.3077544945559589,-0.014703773464018575,0.016960729034104984,-0.0055455747440486267,0],"IMU":[0.00083290446703131378,0.11580476932808466,0.78522417552528334,-0.036032261926869889,-0.024684741634287081,0.10650649670987772,1.1311735052996708,-0.0072446323020529876,-9.7406105587033593],"FOG":[0.80012921619903221],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.8500507149484582,-12.104938995241424,-27.123087292408815,61.388843250964001,61.388843250964001],"omega_rad_s":[-3.8857484757972571,-12.103112136602903,-27.127890452675729,61.39333375708695,61.393339733681103],"thrust_n":[-0.19288025923606986,-1.8705665583262707,-9.3880342280857292,48.076145270204954,48.075978622545236],"torque_nm":[0.0036165048606763089,0.03507312296861758,0.17602564177660743,-0.90142772381634295,-0.90142459917272344],"angle_rad":[-572.26369990053797,300.34651442822036,-875.19316761328639,2538.6493256706663,2538.6493141972469]},"command":[-0.036667149666175791,-0.11528513328801356,-0.25831511707056015,0.58465565000918096,0.58465565000918096],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,1.0778494253810979e-21,1.5881867761018145e-24,-1.6940658945088655e-23,-1.1180834903756616e-21],"servo_velocity":[0,0,-1.7347234759768071e-18,0,0,0],"servo_effort":[0.0098179197090785264,-1.4957836642587232,-0.27021330436825558,9.4020313133439762e-06,-0.00039884306892230028,0.00010993136320344959]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":951,"step":7608,"t":38.039999999999999,"sim_time":38.040000000001008,"vehicle":{"origin_ned":[1.5008289625274756,0.99954994252737428,3.4997494542968144],"origin_quat_xyzw":[-0.021758088230128845,0.053625364601832828,0.38196003421140395,0.92236513276094367],"cg_ned":[1.4405307183652625,0.93997358951083199,3.2073273083443925],"linear_velocity_ned":[9.1041439718211005e-05,-7.8951357231238904e-05,0.0011439983076835924],"angular_velocity_ned":[1.4302504957132748e-05,1.0290679325082716e-06,0.0011027331330806512]},"sensors":{"Odom":[1.5008289625274756,0.99954994252737428,3.4997494542968144,-0.00012594697656150632,-2.8952021840750532e-05,0.0011378814141577308,-0.021758088230128866,0.053625364601832884,0.38196003421140434,0.92236513276094367,-0.00011664649713719612,-8.4705658646600459e-06,0.0010966074172839991],"Pressure":[26831.122368121742],"DVL":[-0.03105535348220544,-0.0060227253194249965,-0.035422659152342419,7.3289076684315209,-0.030271924606947817,-0.024961926392062038,-0.0027034671729840106,0],"IMU":[0.00083326952238645243,0.11580443562070582,0.78526857329978517,0.053679585848319854,-0.06639508085705767,0.017848235397783224,1.1301833345468624,-0.01528150393180331,-9.7357293992587444],"FOG":[0.80393957326225618],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.8561337407075809,-12.118432505425639,-27.116603889152742,61.384803287815174,61.384803287815174],"omega_rad_s":[-3.8924622988159161,-12.117114095104192,-27.121232659304894,61.389104252826762,61.389110261948495],"thrust_n":[-0.19353815949235822,-1.8748732631938818,-9.383458610241096,48.069948337096001,48.069707953267724],"torque_nm":[0.0036288404904817172,0.035153873684885276,0.17593984894202061,-0.90131153132055009,-0.90130702412376995],"angle_rad":[-572.41928477784415,299.86206999623204,-876.27813128536934,2541.104962435867,2541.1049512022619]},"command":[-0.036725083244834103,-0.11541364290881562,-0.25825337037288326,0.5846171741696683,0.5846171741696683],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,-1.1180834903756616e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.0097146380655894881,-1.4956558362841779,-0.27019352136856462,9.2932665254644663e-06,-0.00039890033212309475,0.0001099658504418551]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":952,"step":7616,"t":38.079999999999998,"sim_time":38.080000000001029,"vehicle":{"origin_ned":[1.5008298906658095,0.99954926953225853,3.4997949217303259],"origin_quat_xyzw":[-0.021758941053596072,0.053624790169375831,0.38198024947711484,0.92235677444951725],"cg_ned":[1.4405342366027261,0.93997047183040749,3.2073727397797702],"linear_velocity_ned":[8.5555996839269349e-05,-7.7160950111939888e-05,0.0011293472274356248],"angular_velocity_ned":[1.8614747592386808e-05,2.063700487511458e-06,0.0010886684455802655]},"sensors":{"Odom":[1.5008298906658095,0.99954926953225853,3.4997949217303259,-0.00012755710321164904,-2.6117364894503611e-05,0.0011231377734506331,-0.021758941053596072,0.053624790169375838,0.3819802494771149,0.92235677444951725,-0.00011126564167467326,-1.0799047120053411e-05,0.0010830757543467604],"Pressure":[26830.624970039709],"DVL":[0.00067801981732482195,0.01986736510333003,-0.0094771800641977808,7.4084119564643691,0.0068772980618020422,-0.036520172679008915,-0.0033446015058263214,0],"IMU":[0.00083379275089209284,0.11580400787190147,0.78531242701388215,0.042068196865284263,0.03216535364910645,-0.028987217741321934,1.1401547129804002,0.0069953513965618653,-9.7752925150852192],"FOG":[0.78556337670577192],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.8615537005605369,-12.131745770926642,-27.110143777617331,61.380803584462306,61.380803584462306],"omega_rad_s":[-3.8985581930612128,-12.13093184819358,-27.114597969785667,61.384915615346216,61.384921651450497],"thrust_n":[-0.19413577141000879,-1.8791278865147436,-9.378900481793389,48.063823047303089,48.063511275092161],"torque_nm":[0.0036400457139376661,0.035233647872151448,0.1758543840336261,-0.90119668213693294,-0.90119083640797815],"angle_rad":[-572.5751241809362,299.37706967784163,-877.36282916755442,2543.5604309485075,2543.5604199558925]},"command":[-0.036776701910100351,-0.11554043591358706,-0.25819184550111746,0.58457908175678386,0.58457908175678386],"arm":{"servo_position":[2.2499312661440551e-24,3.2526065174565154e-21,1.0778494253810979e-21,1.5881867761018145e-24,-1.6940658945088655e-23,-1.1180834903756616e-21],"servo_velocity":[0,8.6736173798840355e-19,-1.7347234759768071e-18,0,0,0],"servo_effort":[0.0096134640488401719,-1.4955276042792605,-0.27017334541547472,9.1842735773958469e-06,-0.00039895672654746965,0.00010999865661266084]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":953,"step":7624,"t":38.119999999999997,"sim_time":38.120000000001049,"vehicle":{"origin_ned":[1.5008306441514747,0.99954858482775999,3.4998398041974879],"origin_quat_xyzw":[-0.021759695232192011,0.053624207269238902,0.38200020983423549,0.92234852401071665],"cg_ned":[1.4405375359154697,0.93996742497252006,3.2074175786044887],"linear_velocity_ned":[8.009288520975339e-05,-7.5405867067052042e-05,0.0011144056161040323],"angular_velocity_ned":[2.262880123924478e-05,2.9058031130154761e-06,0.0010745924220407529]},"sensors":{"Odom":[1.5008306441514747,0.99954858482775999,3.4998398041974879,-0.0001291198402230086,-2.322280606145712e-05,0.0011081009333205735,-0.021759695232192039,0.053624207269238972,0.38200020983423594,0.92234852401071665,-0.00010622825468515135,-1.3053055012365943e-05,0.0010694926626705111],"Pressure":[26832.290129493638],"DVL":[0.028272861234836036,0.015803780303446573,-0.015960455271564179,7.3317009359469534,-0.023266356188537087,0.023541246666385934,-0.017188718893885287,0],"IMU":[0.00083446038736354671,0.11580348909220851,0.78535573455848351,-0.018536810584221065,-0.10396336904142571,-0.067315829800540253,1.1323896174552466,-0.0098516859724820348,-9.742308056890268],"FOG":[0.78654101996637549],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.8662924632645934,-12.144876318703645,-27.103708343366375,61.376845476966913,61.376845476966913],"omega_rad_s":[-3.9040103151123722,-12.144562338213239,-27.107988025280473,61.380769299894432,61.380775357654571],"thrust_n":[-0.19467024034306707,-1.8833292943700861,-9.3743609703883006,48.057771402074458,48.057390526167048],"torque_nm":[0.0036500670064325076,0.035312424269439112,0.17576926819478067,-0.90108321378889622,-0.90107607236563236],"angle_rad":[-572.73119279555385,298.89152091183769,-878.44726222174017,2546.0157328766054,2546.0157221259396]},"command":[-0.036821832983472316,-0.11566548874955852,-0.25813055565110832,0.58454138549492296,0.58454138549492296],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,-1.1180834903756616e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.0095143248363921146,-1.4953989938721319,-0.27015279122867897,9.0745404759443965e-06,-0.00039901259165010274,0.00011002932692109801]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":954,"step":7632,"t":38.160000000000004,"sim_time":38.16000000000107,"vehicle":{"origin_ned":[1.5008312216567528,0.99954789050925652,3.4998840900689032],"origin_quat_xyzw":[-0.021760357830691919,0.053623614562317644,0.38201991470952179,0.92234038161281973],"cg_ned":[1.4405406172597275,0.9399644475222837,3.2074618134303465],"linear_velocity_ned":[7.4654942753412792e-05,-7.3686202367712159e-05,0.0010991838495667575],"angular_velocity_ned":[2.6338712833685055e-05,3.5463417613372983e-06,0.0010605087714322071]},"sensors":{"Odom":[1.5008312216567528,0.99954789050925652,3.4998840900689032,-0.00013063512450454883,-2.0267024192712701e-05,0.0010927815316654763,-0.021760357830691923,0.053623614562317651,0.38201991470952185,0.92234038161281973,-0.00010154528480693722,-1.5234736310390297e-05,0.0010558606047018253],"Pressure":[26834.098576078875],"DVL":[-0.017261817744930533,-0.010355539439889648,0.022383445016313445,7.4136097357102679,0.0070125868176315253,-0.015209666759323377,0.007453290723892554,0],"IMU":[0.00083525820707895009,0.11580288220897283,0.78539849391975736,0.094819133269437764,-0.036882398288014491,0.16795310508887998,1.14774881408952,-0.027639283947975969,-9.7178981802489446],"FOG":[0.77725756557069225],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.870334129030883,-12.157821868765076,-27.09729873249762,61.372930357263876,61.372930357263876],"omega_rad_s":[-3.9087957087070007,-12.15800278127282,-27.101404319389523,61.37666673351351,61.376672807823972],"thrust_n":[-0.19513901596291289,-1.887476436359425,-9.3698410991806149,48.051795363076302,48.051347602763386],"torque_nm":[0.0036588565493046172,0.035390183181739213,0.17568452060963655,-0.90097116305768066,-0.90096276755181348],"angle_rad":[-572.88746434002064,298.40543125299286,-879.53143147220067,2548.4708699456683,2548.4708594377016]},"command":[-0.03686032503838936,-0.11578877970252453,-0.25806951173807258,0.58450409864060837,0.58450409864060837],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,-8.6736173798840355e-19,0,0,0,4.3368086899420177e-19],"servo_effort":[0.0094171132699642831,-1.495270115252457,-0.27013188626325585,8.9657945313808408e-06,-0.00039905137531612544,0.00011052813949043149]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":955,"step":7640,"t":38.200000000000003,"sim_time":38.20000000000109,"vehicle":{"origin_ned":[1.5008316218634059,0.99954718873667381,3.4999277681378951],"origin_quat_xyzw":[-0.021760936076166953,0.053623010594351317,0.38203936358816631,0.92233234740251602],"cg_ned":[1.4405434817073481,0.93996153806052452,3.207505433284279],"linear_velocity_ned":[6.9245063731586067e-05,-7.2002064879687444e-05,0.0010836922918876673],"angular_velocity_ned":[2.9740013439733318e-05,3.9776203040031016e-06,0.0010464211258753356]},"sensors":{"Odom":[1.5008316218634059,0.99954718873667381,3.4999277681378951,-0.00013210289308594896,-1.7249338335464978e-05,0.0010771902030075348,-0.021760936076166987,0.0536230105943514,0.38203936358816687,0.92233234740251602,-9.7225690038286864e-05,-1.7346340108874718e-05,0.0010421821972295871],"Pressure":[26831.60477006478],"DVL":[-0.0093965111103556983,-0.0007731585574012118,-0.014444586989238553,7.3823916093613162,-0.029108938289143488,0.013596081864052565,0.015245695494034643,0],"IMU":[0.00083617160298190521,0.11580219006224089,0.78544070318638792,-0.027666731392229433,0.039325342813148617,0.01867612418728103,1.130611600991094,0.00041008010661816412,-9.7676628584130274],"FOG":[0.78466454784886663],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.873666132633196,-12.170580515746456,-27.090916034026286,61.369059553193445,61.369059553193445],"omega_rad_s":[-3.9128944263121226,-12.171250694357893,-27.094848212245846,61.37260931073353,61.372615396712213],"thrust_n":[-0.19553987056778152,-1.8915683550628024,-9.3653417982239251,48.045896841951432,48.045384347996112],"torque_nm":[0.0036663725731459033,0.035466906657427556,0.1756001587166986,-0.90086056578658957,-0.90085095652492719],"angle_rad":[-573.04391168249958,297.91880836061779,-880.61533799982931,2550.9258439375708,2550.9258336728544]},"command":[-0.036892058406030437,-0.11591029062615672,-0.25800872413358367,0.58446723383993759,0.58446723383993759],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,1.0778494253810979e-21,-1.5352472168984193e-23,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,-1.7347234759768071e-18,-3.3881317890172014e-21,0,-4.3368086899420177e-19],"servo_effort":[0.009321693130739054,-1.4951410556690037,-0.27011064394329798,8.8573972338755522e-06,-0.00039910606355674817,0.00011055511845142667]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":956,"step":7648,"t":38.240000000000002,"sim_time":38.24000000000111,"vehicle":{"origin_ned":[1.5008318434791057,0.99954648171700133,3.4999708276198334],"origin_quat_xyzw":[-0.021761437319477935,0.053622393810349479,0.38205855601519861,0.92232442150439642],"cg_ned":[1.440546130445697,0.93995869516399455,3.2075484276074815],"linear_velocity_ned":[6.3866124861020653e-05,-7.0353547597335595e-05,0.0010679412943618159],"angular_velocity_ned":[3.2829717064374763e-05,4.1933832326398416e-06,0.0010323330923978477]},"sensors":{"Odom":[1.5008318434791057,0.99954648171700133,3.4999708276198334,-0.00013352309150233886,-1.4169650378347064e-05,0.0010613375702484152,-0.021761437319477942,0.053622393810349493,0.38205855601519872,0.92232442150439642,-9.3276372420773466e-05,-1.9390144686621437e-05,0.0010284602710276267],"Pressure":[26831.709429523224],"DVL":[-0.0036965613649434913,0.0013717717876739815,0.027192852836818177,7.3608074794558114,-0.014700516219485735,0.036948822295489604,0.0029203184546815111,0],"IMU":[0.00083718566844616913,0.11580141540193675,0.78548236055736331,0.016983762377255546,-0.0015437082794118263,0.14706722521284141,1.1167215261048713,-0.014522627366834774,-9.73960880484276],"FOG":[0.77430682292460262],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.8762788373528045,-12.183150645777953,-27.084561218125753,61.365234355886408,61.365234355886408],"omega_rad_s":[-3.9162895945027096,-12.184303894948993,-27.088320939287531,61.368598390482724,61.368604483472502],"thrust_n":[-0.19587091066021636,-1.8956041863593769,-9.3608639099030793,48.040077695352394,48.039502548710018],"torque_nm":[0.0036725795748790572,0.035542578494238315,0.17551619831068277,-0.90075145678785751,-0.90074067278831293],"angle_rad":[-573.20050696340104,297.4316599865557,-881.69898293708741,2553.3806566891662,2553.3806466680617]},"command":[-0.036916941308121946,-0.11603000615026622,-0.25794820207738811,0.58443080338939435,0.58443080338939435],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,4.3368086899420177e-19],"servo_effort":[0.0092279398326606671,-1.4950118885577031,-0.2700890889899118,8.7488007503519019e-06,-0.00039915959475139777,0.00011058030830540055]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":957,"step":7656,"t":38.280000000000001,"sim_time":38.280000000001131,"vehicle":{"origin_ned":[1.5008318852532123,0.99954577168687897,3.5000132581508008],"origin_quat_xyzw":[-0.02176186899559885,0.053621762569835307,0.38207749159715004,0.92231660402030724],"cg_ned":[1.4405485647762202,0.93995591740608164,3.2075907862539257],"linear_velocity_ned":[5.8520962101433375e-05,-6.8740727400020204e-05,0.0010519411469592636],"angular_velocity_ned":[3.560640345703659e-05,4.1888208294427675e-06,0.0010182482719522602]},"sensors":{"Odom":[1.5008318852532123,0.99954577168687897,3.5000132581508008,-0.00013489570086400201,-1.1028444904382649e-05,0.0010452341973312218,-0.021761868995598857,0.053621762569835328,0.38207749159715015,0.92231660402030724,-8.9702118451851832e-05,-2.1368512746919768e-05,0.0010146978969767728],"Pressure":[26835.210489739682],"DVL":[0.0046489455744565915,0.012665048642286686,0.0021450110707652579,7.3259521890754487,-0.0013222187907444552,0.011266492505670158,-0.048567240304832761,0],"IMU":[0.00083828528287742464,0.11580056088564374,0.78552346435052045,-0.12743599193832572,0.0037058992615783535,-0.050337299886148955,1.1204260649994224,-0.011696481619393753,-9.7410785065944996],"FOG":[0.77203891312453754],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.8781655477946613,-12.195530943597088,-27.078235135640867,61.361456019087633,61.361456019087633],"omega_rad_s":[-3.9189674145994098,-12.197160511185455,-27.081823611251245,61.364635294074965,61.364641389644127],"thrust_n":[-0.19613058151402396,-1.8995831631934075,-9.3564081888952764,48.034339723280141,48.033703932836303],"torque_nm":[0.0036774484033879496,0.035617184309876392,0.17543265354178644,-0.90064386981150257,-0.90063194874068098],"angle_rad":[-573.35722171824091,296.94399396283393,-882.78236746301957,2555.8353100908021,2555.8353003134885]},"command":[-0.036934909978996774,-0.11614791374854369,-0.25788795367277018,0.58439481922940606,0.58439481922940606],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,-4.3368086899420177e-19],"servo_effort":[0.0091357627076133104,-1.4948827093349597,-0.27006724463721182,8.6414467920243195e-06,-0.00039921292793087057,0.00011060383153049931]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":958,"step":7664,"t":38.32,"sim_time":38.320000000001151,"vehicle":{"origin_ned":[1.5008317459924103,0.99954506089579598,3.5000550497852485],"origin_quat_xyzw":[-0.021762238584544544,0.053621115162101676,0.38209617000360468,0.92230889502874158],"cg_ned":[1.4405507861129845,0.93995320335780985,3.2076324994879015],"linear_velocity_ned":[5.3212370785430549e-05,-6.7163649485136144e-05,0.0010357020926660919],"angular_velocity_ned":[3.807014445121254e-05,3.9606146003690339e-06,0.0010041701446235917]},"sensors":{"Odom":[1.5008317459924103,0.99954506089579598,3.5000550497852485,-0.00013622070333689013,-7.8267819962008778e-06,0.0010288906005491531,-0.021762238584544555,0.053621115162101704,0.38209617000360485,0.92230889502874158,-8.6505605639496737e-05,-2.3283807667556018e-05,0.0010008982696624862],"Pressure":[26834.830590822665],"DVL":[0.00508174564118654,-0.0213246684591759,0.011662592081692433,7.392630844454315,0.0097387602406055433,0.032377756232812346,-0.0096054754648451125,0],"IMU":[0.00083945519618698291,0.11579962907685785,0.78556401301078282,0.022422102381246332,-0.019913646708439953,0.15731548423552028,1.1355369544758225,0.00022781571404233494,-9.7250304562346326],"FOG":[0.77248786794373192],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.8793224263199217,-12.207720465218358,-27.071938496406172,61.357725771196378,61.357725771196378],"omega_rad_s":[-3.9209171526180548,-12.209819001680394,-27.075357205064826,61.36072130846788,61.360727402410006],"thrust_n":[-0.19631766994508745,-1.9035046222827849,-9.3519752962896998,48.028684673352913,48.02799017552136],"torque_nm":[0.0036809563114703898,0.03569071166780223,0.17534953680543189,-0.90053783762536732,-0.90052481579102561],"angle_rad":[-573.51402700052392,296.45581818883517,-883.86549279802614,2558.2898060848865,2558.2897965513721]},"command":[-0.036945927869713541,-0.11626400443065103,-0.25782798568005877,0.58435929305901313,0.58435929305901313],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-4.3537493488871065e-21,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,-4.3368086899420177e-19],"servo_effort":[0.0090449729650715956,-1.494753578864324,-0.27004513163886917,8.5335302237849401e-06,-0.00039926572123364181,0.00011062560496283798]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":959,"step":7672,"t":38.359999999999999,"sim_time":38.360000000001172,"vehicle":{"origin_ned":[1.5008314245763426,0.999544351589706,3.5000961929951928],"origin_quat_xyzw":[-0.021762553572691468,0.053620449822302796,0.38211459096814515,0.92230129458441978],"cg_ned":[1.4405527959807889,0.93995055158891161,3.2076735579832607],"linear_velocity_ned":[4.794309810251345e-05,-6.5622334550655736e-05,0.0010192343551298376],"angular_velocity_ned":[4.0222473768221237e-05,3.5068946762318795e-06,0.00099010219974824233]},"sensors":{"Odom":[1.5008314245763426,0.999544351589706,3.5000961929951928,-0.0001374980983032943,-4.566270741986703e-06,0.0010123172752822046,-0.021762553572691475,0.053620449822302824,0.38211459096814532,0.92230129458441978,-8.3687468659288664e-05,-2.5138402508872169e-05,0.00098706483067796343],"Pressure":[26836.356245317573],"DVL":[0.0031945803530203432,0.014197358118748407,0.023663176169698999,7.2690861013592079,-0.015020369844811254,0.0046822153140146138,0.011070650289501422,0],"IMU":[0.00084068011310684226,0.11579862244508163,0.78560400511712847,0.051681164783515796,-0.033225607210767526,-0.12484180745538938,1.1308036127960306,-0.0058864545686363777,-9.78073890919541],"FOG":[0.77727342824054624],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.8797485684121225,-12.219718535826594,-27.065671917492395,61.354044793413117,61.354044793413117],"omega_rad_s":[-3.922131146485393,-12.222278137500888,-27.068922578501958,61.356857683588728,61.356863771921027],"thrust_n":[-0.19643130800788364,-1.9073679991258163,-9.3475658094334388,48.023114235569587,48.022362894188497],"torque_nm":[0.0036830870251478181,0.035763149983609049,0.17526685892687702,-0.90043339191692984,-0.90041930426603445],"angle_rad":[-573.6708935044943,295.96714061853015,-884.94836019889635,2560.7441466644809,2560.7441373746105]},"command":[-0.036949986365829739,-0.11637827176977709,-0.25776830397611805,0.58432423612774398,0.58432423612774398],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.0089554780752926326,-1.4946245744163837,-0.27002276590410423,8.4269233096583609e-06,-0.00039931797611499422,0.00011064625402546697]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":960,"step":7680,"t":38.399999999999999,"sim_time":38.400000000001192,"vehicle":{"origin_ned":[1.5008309199721319,0.99954364599523104,3.5001366786685928],"origin_quat_xyzw":[-0.021762821415079871,0.053619764746637127,0.38213275428890175,0.9222938027180646],"cg_ned":[1.4405545960128372,0.9399479606691965,3.2077139528217606],"linear_velocity_ned":[4.271582443783106e-05,-6.4116761639589729e-05,0.0010025481175335281],"angular_velocity_ned":[4.2066362447300498e-05,2.8271984358896329e-06,0.00097604777434858445]},"sensors":{"Odom":[1.5008309199721319,0.99954364599523104,3.5001366786685928,-0.00013872790468937298,-1.249043843718556e-06,0.00099552467550203367,-0.021762821415079882,0.053619764746637148,0.38213275428890192,0.9222938027180646,-8.1246327001538085e-05,-2.6934692359699286e-05,0.00097320110275709042],"Pressure":[26837.117011020477],"DVL":[0.034588977084598467,0.00053949453370326838,-0.019474539888497129,7.3932480107968157,-0.0078200453449665946,-0.0086268382920794626,0.019284834410945181,0],"IMU":[0.00084194477493064728,0.11579754336497584,0.78564343938852133,-0.036038050558616135,0.083986373313027662,-0.03218781430835492,1.131814468368475,0.0053669102762807352,-9.7686724808903893],"FOG":[0.78461709520532086],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.8794458643886505,-12.231524752315318,-27.059435913003096,61.350414232308466,61.350414232308466],"omega_rad_s":[-3.9226047695553978,-12.234537008907401,-27.062520466686788,61.353045631150991,61.353051710111934],"thrust_n":[-0.19647097146865328,-1.91117283051631,-9.3431802200492573,48.017630041444043,48.016823647114961],"torque_nm":[0.0036838307150372494,0.03583449057218082,0.17518462912592356,-0.90033056327707572,-0.90031544338340552],"angle_rad":[-573.82779168722584,295.47796924760246,-886.03097095386306,2563.1983338717673,2563.1983248252318]},"command":[-0.036947103470368101,-0.11649071192681255,-0.25770891345717234,0.58428965935531874,0.58428965935531874],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,-4.3368086899420177e-19],"servo_effort":[0.0088671116615154314,-1.4944957535736187,-0.27000015985730252,8.3198344565081723e-06,-0.00039936962028419516,0.00011066483988354933]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":961,"step":7688,"t":38.439999999999998,"sim_time":38.440000000001213,"vehicle":{"origin_ned":[1.500830231250734,0.99954294630427609,3.5001764981103922],"origin_quat_xyzw":[-0.021763049498941717,0.053619058107656971,0.38215065983029822,0.92228641943564471],"cg_ned":[1.4405561879505788,0.93994542916950385,3.2077536754941698],"linear_velocity_ned":[3.7533268693632104e-05,-6.2646899444416024e-05,0.00098565363813213065],"angular_velocity_ned":[4.3606146340788841e-05,1.9224701250634036e-06,0.00096201023191881598]},"sensors":{"Odom":[1.500830231250734,0.99954294630427609,3.5001764981103922,-0.0001399101070120256,2.1221762076478167e-06,0.00097852333211583139,-0.021763049498941721,0.053619058107656978,0.38215065983029828,0.92228641943564471,-7.9178856802981245e-05,-2.8675043496103453e-05,0.00095931086135957004],"Pressure":[26834.601222765225],"DVL":[0.010612214665096126,0.014092961808900026,-0.022602626747493221,7.3836128593790962,0.021907522659233666,-0.0099975178776426973,-0.0088068896003016661,0],"IMU":[0.00084323403922898898,0.11579639411667575,0.78568231469234573,0.028142032660245224,0.0065698852972851064,-0.04331528146644345,1.1316773307592167,-0.0082722747393962678,-9.7553883253936426],"FOG":[0.7934640237036501],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.87841916646257,-12.243139116770649,-27.053230869894698,61.346835171427308,61.346835171427308],"omega_rad_s":[-3.9223364231388937,-12.246595025960497,-27.056151487571089,61.349286319483618,61.349292385529964],"thrust_n":[-0.19643648050292939,-1.9149187556597069,-9.338818938029906,48.012233652334707,48.011373923164022],"torque_nm":[0.0036831840094299268,0.035904726668619498,0.17510285508806073,-0.90022938098127581,-0.90021326105932553],"angle_rad":[-573.98469188942829,294.98831210110285,-887.11332637794396,2565.6523697964494,2565.6523609927931]},"command":[-0.03693732539488162,-0.11660132492162523,-0.25764981780852092,0.58425557306121245,0.58425557306121245],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,4.3368086899420177e-19],"servo_effort":[0.0087797210655418123,-1.4943672109444943,-0.26997734089606129,8.2148468595820611e-06,-0.00039942072734582842,0.00011068253449987998]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":962,"step":7696,"t":38.480000000000004,"sim_time":38.480000000001233,"vehicle":{"origin_ned":[1.5008293575976346,0.99954225465999946,3.5002156430389846],"origin_quat_xyzw":[-0.021763245106250696,0.053618328070181791,0.38216830752295827,0.92227914471836614],"cg_ned":[1.440557573637149,0.93994295566460029,3.2077927178968291],"linear_velocity_ned":[3.2397844293693947e-05,-6.1212599135176078e-05,0.00096856096517365675],"angular_velocity_ned":[4.4847614607005195e-05,7.9515279833571951e-07,0.00094799277329054394]},"sensors":{"Odom":[1.5008293575976346,0.99954225465999946,3.5002156430389846,-0.00014104478811878369,5.5443427191724568e-06,0.00096132355005198176,-0.021763245106250714,0.053618328070181839,0.38216830752295861,0.92227914471836614,-7.747964224761488e-05,-3.03617914240381e-05,0.00094539796153456654],"Pressure":[26837.21343675326],"DVL":[-0.011786640816181304,0.02198577411808671,0.027499474706048896,7.3356605975054361,0.019126230447426298,-0.013987838699126523,-0.011693021478699333,0],"IMU":[0.00084453296161406631,0.11579517688646769,0.78572063004898729,0.055510842022167342,0.022384136256842137,0.018224731883481744,1.1335192238110179,-0.028988997468423254,-9.7154430914586438],"FOG":[0.80224823862809347],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.8766757554062892,-12.254561791813618,-27.047057082392648,61.34330866505438,61.34330866505438],"omega_rad_s":[-3.9213274998096286,-12.258451915051806,-27.049816143322005,61.345580869500502,61.3455869193035],"thrust_n":[-0.19632799598853642,-1.9186055147494523,-9.3344822916258678,48.006926560046537,48.006015142413787],"torque_nm":[0.0036811499247850583,0.035973853401552229,0.17502154296798506,-0.90012987300087277,-0.90011278392025862],"angle_rad":[-574.14156445726587,294.49817722012148,-888.19542780821803,2568.1062565738112,2568.106248012441]},"command":[-0.036920721480059898,-0.11671011230298683,-0.25759101983231092,0.5842219872862322,0.5842219872862322],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,-4.3368086899420177e-19],"servo_effort":[0.0086931927413550613,-1.4942389550886623,-0.26995431143995274,8.1090833889995017e-06,-0.00039947107776421259,0.00011069810287820592]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":963,"step":7704,"t":38.520000000000003,"sim_time":38.520000000001254,"vehicle":{"origin_ned":[1.5008282983262828,0.99954157314385539,3.5002541055841796],"origin_quat_xyzw":[-0.021763415379072646,0.053617572806397097,0.3821856973658595,0.92227197852171583],"cg_ned":[1.4405587550148606,0.93994053873556405,3.2078310723297672],"linear_velocity_ned":[2.7312126141708914e-05,-5.9813696912668658e-05,0.00095128023824080869],"angular_velocity_ned":[4.5797739094904889e-05,-5.5114731218114583e-07,0.00093399879600394582]},"sensors":{"Odom":[1.5008282983262828,0.99954157314385539,3.5002541055841796,-0.00014213192182596797,9.0138382191460571e-06,0.00094393574010573323,-0.021763415379072653,0.053617572806397111,0.38218569736585961,0.92227197852171583,-7.6141642900884467e-05,-3.1997286753421937e-05,0.00093146664538412704],"Pressure":[26835.222622431054],"DVL":[-0.015782858983633734,0.017370743743485954,0.014297284894008421,7.3146100541429533,0.012028850736059438,-0.003787859560183922,0.011157159680958144,0],"IMU":[0.00084582687196190149,0.11579389376809465,0.7857583846409727,0.013017876789253872,0.12717718466556588,-0.067162763986497315,1.1303077053331201,-0.01150080036603787,-9.756884640052073],"FOG":[0.79053166422610444],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.8742254263859639,-12.265793273680433,-27.040914725864059,61.339835739202229,61.339835739202229],"omega_rad_s":[-3.9195821522167611,-12.270107691452512,-27.043514817066107,61.341930368683869,61.341936399124428],"thrust_n":[-0.19614599654780462,-1.9222329421752764,-9.3301705266004777,48.001710202264277,48.00074867099223],"torque_nm":[0.0036777374352713376,0.036041867665786438,0.17494069737375897,-0.90003206629245525,-0.90001403758110454],"angle_rad":[-574.29837985495726,294.00757265028471,-889.27727659910795,2570.5599963832569,2570.5599880634522]},"command":[-0.036897385013199654,-0.11681707879695651,-0.25753252119870534,0.584188911801926,0.584188911801926],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,4.3198680309969292e-21,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,8.6736173798840355e-19,0],"servo_effort":[0.008607480692321489,-1.4941110997507674,-0.26993109461413761,8.004177690166412e-06,-0.00039952093560303124,0.00011071252308797985]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":964,"step":7712,"t":38.560000000000002,"sim_time":38.560000000001274,"vehicle":{"origin_ned":[1.500827052893791,0.99954090376363069,3.5002918782893446],"origin_quat_xyzw":[-0.021763567289251617,0.053616790508558165,0.38220282943019246,0.92226492077383193],"cg_ned":[1.4405597341274325,0.9399381769711489,3.2078687314988898],"linear_velocity_ned":[2.2278461535759784e-05,-5.8449970076966674e-05,0.00093382156598126927],"angular_velocity_ned":[4.6464769924351508e-05,-2.1113642092981445e-06,0.00092003131459777868]},"sensors":{"Odom":[1.500827052893791,0.99954090376363069,3.5002918782893446,-0.0001431715588010784,1.2526650420454078e-05,0.00092637026182435661,-0.021763567289251641,0.053616790508558228,0.38220282943019285,0.92226492077383193,-7.5155851222834144e-05,-3.3583753867104477e-05,0.00091752099815024921],"Pressure":[26836.694568034512],"DVL":[-0.025253538096072958,0.0021336561728207805,0.020162776187279845,7.3732854183443575,-0.01994113276686656,-0.019491659424531235,-0.044980297196360465,0],"IMU":[0.00084710144095343192,0.11579254676294488,0.78579557782522214,0.053876574124836679,-0.043010033687255492,-0.18694646827202829,1.1350317151228595,-0.0099536978461238976,-9.751112739322215],"FOG":[0.78248365513973317],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.871080931630547,-12.27683500591162,-27.034803738382408,61.336417319244553,61.336417319244553],"omega_rad_s":[-3.9171074445217804,-12.281562851772128,-27.037247743594584,61.33833584861749,61.338341856781994],"thrust_n":[-0.1958912922363627,-1.9258010261227978,-9.3258837854586591,47.996585928215943,47.995575789013117],"torque_nm":[0.0036729617294318012,0.036108769239802455,0.17486032097734991,-0.89993598615404913,-0.89991704604399592],"angle_rad":[-574.45510877934123,293.51650642608462,-890.35887411708927,2573.0135914464527,2573.013583367373]},"command":[-0.036867437444100447,-0.11692223815153924,-0.25747432131792769,0.58415635542137667,0.58415635542137667],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,1.7347234759768071e-18,3.3881317890172014e-21,0,4.3368086899420177e-19],"servo_effort":[0.0085221790454685399,-1.4939836352716931,-0.26990770117740681,7.9001384009133551e-06,-0.00039957106368034614,0.00011072596666984074]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":965,"step":7720,"t":38.600000000000001,"sim_time":38.600000000001295,"vehicle":{"origin_ned":[1.5008256209047739,0.99954024843682354,3.5003289539476778],"origin_quat_xyzw":[-0.021763707591101071,0.053615979388680228,0.38221970384889792,0.9222579713809701],"cg_ned":[1.4405605131120061,0.93993586897819903,3.2079056883491703],"linear_velocity_ned":[1.7299542698859913e-05,-5.7120597505502183e-05,0.00091618346489600125],"angular_velocity_ned":[4.6860429772545563e-05,-3.8812565194485174e-06,0.00090609306382667763]},"sensors":{"Odom":[1.5008256209047739,0.99954024843682354,3.5003289539476778,-0.0001441626606231884,1.6078366878200018e-05,0.00090862619024719034,-0.021763707591101081,0.053615979388680256,0.38221970384889814,0.9222579713809701,-7.4511369079743308e-05,-3.5126457971796386e-05,0.00090356504590077607],"Pressure":[26836.902371471988],"DVL":[0.027399707003631455,0.043514943254923021,0.011353954352600915,7.3146679339251666,0.019961449511123122,0.0063088420463565647,-0.0067319887311211917,0],"IMU":[0.00084834276630013042,0.11579113774312881,0.78583220911447749,-0.038544254414937217,-0.013353971384423244,0.030870911888292111,1.1320003023899434,-0.011952261430688522,-9.7265090198769943],"FOG":[0.80765348001750681],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.8672570032765945,-12.28768743353325,-27.028724355893413,61.333054671468915,61.333054671468915],"omega_rad_s":[-3.9139131320685729,-12.292818011418799,-27.031015113749181,61.334798360255448,61.334804343437042],"thrust_n":[-0.19556500031252538,-1.9293098043991359,-9.3216222009082053,47.991555389558918,47.990498009459003],"torque_nm":[0.0036668437558598516,0.0361745588324838,0.17478041626702889,-0.89984166355422968,-0.89982183767735646],"angle_rad":[-574.61172227178656,293.02498655846972,-891.44022173663802,2575.4670440260979,2575.4670361867916]},"command":[-0.03683101907882471,-0.11702559460507858,-0.25741642243708013,0.58412433020446586,0.58412433020446586],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,4.3368086899420177e-19],"servo_effort":[0.0084372765300476937,-1.4938543040937946,-0.26988381060869748,7.7961993770728819e-06,-0.00039961980888767568,0.00011073784377755711]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":966,"step":7728,"t":38.640000000000001,"sim_time":38.640000000001315,"vehicle":{"origin_ned":[1.5008240021210573,0.99953960897219463,3.5003653248100344],"origin_quat_xyzw":[-0.0217638427532812,0.053615137586810475,0.38223632082402043,0.92225113023138883],"cg_ned":[1.4405610942435456,0.93993361342028048,3.2079419352536775],"linear_velocity_ned":[1.2378980556871879e-05,-5.5824121705007677e-05,0.00089835066397722662],"angular_velocity_ned":[4.7000062225143092e-05,-5.8583615964627575e-06,0.00089218683084726273]},"sensors":{"Odom":[1.5008240021210573,0.99953960897219463,3.5003653248100344,-0.00014510265044591814,1.9663988951921553e-05,0.00089068922495910848,-0.021763842753281217,0.053615137586810517,0.38223632082402076,0.92225113023138883,-7.4196012767234338e-05,-3.6634484424203769e-05,0.00088960302024412104],"Pressure":[26836.948875441169],"DVL":[-0.0054485093387392864,-0.02792836173776532,0.018139248335260094,7.415891313715842,-0.043992101092604846,0.00026844662277803383,-0.0028975144516659029,0],"IMU":[0.00084953742923030032,0.11578966822938089,0.78586827819111227,0.012131344229846974,-0.083751393233481228,0.086533543336863084,1.1451805759754206,-0.010259618179665737,-9.7573322513890091],"FOG":[0.77849607848913582],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.8627714664583825,-12.298355689623584,-27.022678256440411,61.329758758476842,61.329758758476842],"omega_rad_s":[-3.9100117348693098,-12.303874972007806,-27.02481746002654,61.331321389854402,61.331327345654671],"thrust_n":[-0.19516855074735098,-1.9327597118987241,-9.3173861847065886,47.986624576296599,47.985521038545642],"torque_nm":[0.0036594103265128316,0.036239244598101079,0.17470099096324856,-0.89974921080556136,-0.89972851947273103],"angle_rad":[-574.76819182622125,292.533021011166,-892.52132084606455,2577.9203564725799,2577.9203488719918]},"command":[-0.036788299680556025,-0.11712719704403414,-0.25735884053752772,0.58409294055692229,0.58409294055692229],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,-8.6736173798840355e-19,0,0,0,0],"servo_effort":[0.0083525186237720251,-1.493723794273135,-0.26985951647137685,7.6935337429580399e-06,-0.00039966846540542063,0.00011074840016522542]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":967,"step":7736,"t":38.68,"sim_time":38.680000000001336,"vehicle":{"origin_ned":[1.5008221964889439,0.99953898706641631,3.5004009832369523],"origin_quat_xyzw":[-0.021763978965111605,0.053614263266624836,0.38225268062409179,0.92224439719072249],"cg_ned":[1.4405614799115329,0.9399314089896913,3.2079774646810382],"linear_velocity_ned":[7.519186311963095e-06,-5.4560111204444381e-05,0.00088033394600696608],"angular_velocity_ned":[4.6895227387331191e-05,-8.0338133073856678e-06,0.00087831530705171582]},"sensors":{"Odom":[1.5008221964889439,0.99953898706641631,3.5004009832369523,-0.00014599136245300854,2.3278113551132252e-05,0.00087257039973064336,-0.021763978965111622,0.053614263266624877,0.38225268062409212,0.92224439719072249,-7.4195744859882124e-05,-3.8109717839142793e-05,0.0008756392658853452],"Pressure":[26839.02088819693],"DVL":[0.034499442989044414,-0.0048036518200466824,0.016089928369904413,7.3527381753023962,0.012288534612009041,-0.0041921771081634323,0.0069293975746188268,0],"IMU":[0.00085067255624577732,0.11578813957273991,0.78590378490949353,-0.041316149399307896,0.094634898298627937,-0.14593848504830367,1.1349972526636583,-0.024876158893948681,-9.7731547327151098],"FOG":[0.78138473582954704],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.8576457554681198,-12.308842309733425,-27.016665883350516,61.326532876984928,61.326532876984928],"omega_rad_s":[-3.9054188608734495,-12.314736225398043,-27.018655439731507,61.327909404465167,61.327915330817092],"thrust_n":[-0.19470371450389298,-1.9361513787459308,-9.3131761747714581,47.981800244467074,47.980651559404357],"torque_nm":[0.0036506946469479938,0.036302838351486205,0.17462205327696487,-0.89965875458375766,-0.89963721673883157],"angle_rad":[-574.92448950735877,292.04061765475217,-893.60217286018553,2580.3735313125972,2580.3735239495854]},"command":[-0.036739483385410665,-0.11722706961650881,-0.25730157984143348,0.58406221787604695,0.58406221787604695],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.0082677815684553853,-1.4935936280719968,-0.26983503185139318,7.5907216227853053e-06,-0.0003997166532178966,0.00011075763888731403]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":968,"step":7744,"t":38.719999999999999,"sim_time":38.720000000001356,"vehicle":{"origin_ned":[1.5008202041492864,0.99953838429707231,3.5004359220082009],"origin_quat_xyzw":[-0.021764122118471382,0.053613354671192305,0.38226878358185379,0.92223777210010371],"cg_ned":[1.4405616725954398,0.93992925439807906,3.2080122695125861],"linear_velocity_ned":[2.7223167292910797e-06,-5.3328145947072903e-05,0.00086214459817971292],"angular_velocity_ned":[4.6558503516760957e-05,-1.0397678074597572e-05,0.0008644808839550302]},"sensors":{"Odom":[1.5008202041492864,0.99953838429707231,3.5004359220082009,-0.00014682886595167817,2.6915054690562181e-05,0.00085428122574428755,-0.0217641221184714,0.05361335467119234,0.38226878358185407,0.92223777210010371,-7.4495028619683416e-05,-3.9554010736779664e-05,0.0008616779999676917],"Pressure":[26839.7897066605],"DVL":[0.012225662089782036,0.0031713322916017673,0.003599813099152287,7.4152830110419892,-0.0033211792297484755,-0.0024781662772092746,-0.0072328242445936341,0],"IMU":[0.00085173589547825443,0.11578655304377919,0.78593872929767217,-0.058493005659981216,-0.026251426680826178,-0.0023904139040065945,1.1361788903976815,0.024367841711715736,-9.7528644433571507],"FOG":[0.77532266112012815],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.8519031862748272,-12.319149271775595,-27.010687206473651,61.323378267132149,61.323378267132149],"omega_rad_s":[-3.900152961319121,-12.3254041699812,-27.012529467634256,61.32456575809158,61.324571653202128],"thrust_n":[-0.19417257459353379,-1.9394854084957796,-9.3089924355898184,47.977087352471102,47.975894471516924],"torque_nm":[0.0036407357736287587,0.036365351409295879,0.17454360816730913,-0.89957038785883336,-0.89954802134094247],"angle_rad":[-575.08058806999986,291.54778426261038,-894.68277921436163,2582.8265712242214,2582.8265640975678]},"command":[-0.03668479225023645,-0.11732523115976758,-0.25724464006165382,0.58403217397268714,0.58403217397268714],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.0081828232619089985,-1.4934643162940555,-0.2698104423313698,7.488856443693571e-06,-0.00039976443191913678,0.00011076598362304467]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":969,"step":7752,"t":38.759999999999998,"sim_time":38.760000000001376,"vehicle":{"origin_ned":[1.5008180254460877,0.99953780211513721,3.5004701344429869],"origin_quat_xyzw":[-0.02176427779326635,0.053612410144919645,0.38228463009081731,0.92223125477665158],"cg_ned":[1.4405616748577326,0.93992714837229152,3.208046343165087],"linear_velocity_ned":[-2.0096306713706254e-06,-5.2127810363713284e-05,0.00084379696605491809],"angular_velocity_ned":[4.6002658174451637e-05,-1.2938477633005349e-05,0.00085068590809238439]},"sensors":{"Odom":[1.5008180254460877,0.99953780211513721,3.5004701344429869,-0.00014761541130627731,3.0568877364755943e-05,0.00083583619032477196,-0.021764277793266368,0.05361241014491968,0.38228463009081759,0.92223125477665158,-7.5077103888438108e-05,-4.0968259843045089e-05,0.00084772353579849226],"Pressure":[26837.088480852777],"DVL":[-0.033799915449598726,-0.0043496797507215652,-0.014892927842817446,7.4054716949411699,0.03371989193496458,-0.0077461611545215584,0.017390857716998054,0],"IMU":[0.00085271586016541793,0.11578490986198436,0.78597311155317173,-0.021367759121984572,0.02237100390508363,0.055945529238235668,1.1227336978764315,-0.012513046590244617,-9.7456527016312009],"FOG":[0.79999334120352439],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.8455692794495882,-12.329277844836851,-27.004742001234032,61.320294678154696,61.320294678154696],"omega_rad_s":[-3.8942351317205111,-12.335880960595997,-27.006439741876868,61.321292737619459,61.321298599918173],"thrust_n":[-0.19357750173269622,-1.9427623301968988,-9.3048350748679578,47.97248908660854,47.971252930674027],"torque_nm":[0.0036295781574880539,0.03642679369119186,0.1744656576537742,-0.89948417037391015,-0.89946099245013811],"angle_rad":[-575.23646106774254,291.05452851740347,-895.76314135558914,2585.2794789960358,2585.2794721044538]},"command":[-0.036624469328091318,-0.11742169376035096,-0.25718801905937172,0.58400280645861613,0.58400280645861613],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.0080975980183593081,-1.4933360133387497,-0.26978576109350655,7.3869060352787885e-06,-0.00039981151112801689,0.00011077247082171831]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":970,"step":7760,"t":38.800000000000004,"sim_time":38.800000000001397,"vehicle":{"origin_ned":[1.5008156609356231,0.99953724184308368,3.50050361443689],"origin_quat_xyzw":[-0.021764451235795963,0.053611428153944589,0.38230022060840546,0.92222484501148816],"cg_ned":[1.4405614893372811,0.93992508965940236,3.208079679629487],"linear_velocity_ned":[-6.6748027788855456e-06,-5.0958538091465776e-05,0.00082530534379282659],"angular_velocity_ned":[4.5241278949986708e-05,-1.5643672041105083e-05,0.00083693281433733506]},"sensors":{"Odom":[1.5008156609356231,0.99953724184308368,3.50050361443689,-0.00014835118754051287,3.4233475084595439e-05,0.00081724972147815102,-0.021764451235795984,0.053611428153944637,0.38230022060840579,0.92222484501148816,-7.5923899063731623e-05,-4.2353193678761606e-05,0.00083378042795854979],"Pressure":[26839.814956110964],"DVL":[-0.0015703085046482755,0.011275447437864168,-0.017711722193917524,7.4295809919217071,0.0090441325953207578,0.01296848812886414,-0.013294423185716225,0],"IMU":[0.00085360158493828309,0.11578321121680232,0.78600693205359873,-0.084921069938731539,0.049873441768333915,-0.076298833875090524,1.1409337287738264,-0.0048266735943002384,-9.7301746718898645],"FOG":[0.79023772792633618],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.8386711828531048,-12.339229932524461,-26.99882988362414,61.31728147607619,61.31728147607619],"omega_rad_s":[-3.8876888528638083,-12.346168706618752,-27.000386255833376,61.318091658344663,61.318097486434844],"thrust_n":[-0.19292112300230796,-1.9459826638329387,-9.300704057881326,47.968007104389358,47.966728572194171],"torque_nm":[0.0036172710562932748,0.036487174946867609,0.17438820108527486,-0.89940013320730072,-0.89937616072864079],"angle_rad":[-575.39208295326841,290.5608580173606,-896.84326073405919,2587.732257485126,2587.7322508272705]},"command":[-0.03655877317002957,-0.11751647554785201,-0.25713171317737277,0.58397410929596372,0.58397410929596372],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,-8.6736173798840355e-19,0,0,0,-4.3368086899420177e-19],"servo_effort":[0.0080119967301595374,-1.4932087683919923,-0.26976100365975564,7.2862925070767489e-06,-0.00039985862139822932,0.00011077816929232322]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":971,"step":7768,"t":38.840000000000003,"sim_time":38.840000000001417,"vehicle":{"origin_ned":[1.5008131113909506,0.99953670466870614,3.5005363564563634],"origin_quat_xyzw":[-0.021764647335842886,0.053610407296412393,0.38231555565678405,0.92221854256933233],"cg_ned":[1.440561118743096,0.93992307703066136,3.2081122734655598],"linear_velocity_ned":[-1.1271573918471606e-05,-4.9819736122420498e-05,0.00080668393471943454],"angular_velocity_ned":[4.4288714748076256e-05,-1.8499907428907054e-05,0.00082322391905696897]},"sensors":{"Odom":[1.5008131113909506,0.99953670466870614,3.5005363564563634,-0.00014903650351568204,3.7902586691534958e-05,0.00079853613859750703,-0.0217646473358429,0.053610407296412428,0.38231555565678427,0.92221854256933233,-7.7016222506106946e-05,-4.370950641971346e-05,0.00081985324190117417],"Pressure":[26839.319760435395],"DVL":[-0.025831463140005426,-0.016454296535934557,9.5920202393337864e-05,7.431423305256474,-0.034975663134966944,0.014015609214718068,-0.0023473144951311493,0],"IMU":[0.00085438297637443149,0.11578145826898981,0.78604019136142089,-0.093990652115941389,-0.018759368065943513,0.029626003923825462,1.1309402283572774,0.0017982192679216538,-9.7266921742415668],"FOG":[0.77559593562154683],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.8312379241411043,-12.34900779782102,-26.992950381859558,61.314337990849864,61.314337990849864],"omega_rad_s":[-3.880539806160364,-12.356269631601673,-26.994368830659045,61.314963158977882,61.314968951601649],"thrust_n":[-0.19220629802873967,-1.9491469699182582,-9.2965992301320881,47.963642007890293,47.962321976607114],"torque_nm":[0.0036038680880388693,0.036546505685967345,0.17431123556497669,-0.89931828764794308,-0.89929353706138349],"angle_rad":[-575.54742916878035,290.06678027396981,-897.92313879568439,2590.1849095851376,2590.1849031596116]},"command":[-0.036487980229915278,-0.11760959807448591,-0.25707571792247197,0.58394607610333205,0.58394607610333205],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.0079258951810700553,-1.4930826376459554,-0.26973618628138279,7.1859342281152763e-06,-0.00039990469890257825,0.00011078260268717158]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":972,"step":7776,"t":38.880000000000003,"sim_time":38.880000000001438,"vehicle":{"origin_ned":[1.50081037779936,0.9995361916379637,3.500568355534309],"origin_quat_xyzw":[-0.021764870611390191,0.053609346310262415,0.38233063582051818,0.92221234718937373],"cg_ned":[1.4405605658437841,0.93992110928117989,3.2081441197977192],"linear_velocity_ned":[-1.5798488943854246e-05,-4.8710754278578825e-05,0.00078794673839081744],"angular_velocity_ned":[4.3159812671356179e-05,-2.1493214018140103e-05,0.00080956138614343785]},"sensors":{"Odom":[1.50081037779936,0.9995361916379637,3.500568355534309,-0.00014967169962583281,4.156987001758881e-05,0.00077970954517884257,-0.021764870611390198,0.053609346310262443,0.38233063582051835,0.92221234718937373,-7.8334082467234727e-05,-4.5037811814045725e-05,0.00080594648249381908],"Pressure":[26839.716056122124],"DVL":[-0.0045210571201533736,-0.028765917777158617,0.028692640604050964,7.3192165228485742,-0.010677196775977369,-0.023663600882180086,0.0064504278435530095,0],"IMU":[0.00085505074707229248,0.11577965215320556,0.78607289022093318,-0.019135272596851181,-0.011625070584186296,0.12596539873441498,1.149066098361778,-0.017210645909337977,-9.7507999470335509],"FOG":[0.79774131090044298],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.8232995494716357,-12.358613403323872,-26.987102895829285,61.311463477096844,61.311463477096844],"omega_rad_s":[-3.8728155852601081,-12.366185982315598,-26.988387130457728,61.311907396706502,61.311913152719569],"thrust_n":[-0.1914360846776611,-1.9522558205230685,-9.2925203280086581,47.959393649903959,47.958032977506285],"torque_nm":[0.0035894265877061461,0.036604796634807542,0.17423475615016237,-0.89923863093569933,-0.89921311832824302],"angle_rad":[-575.70247622831721,289.57230270891239,-899.00277697560637,2592.6374382038716,2592.6374320092305]},"command":[-0.036412376661634625,-0.11770108003165593,-0.25702002757932652,0.58391869978187472,0.58391869978187472],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.0078391735659598741,-1.4929576210872024,-0.26971131097759382,7.0863517512581515e-06,-0.00039995075980060453,0.00011078581556980593]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":973,"step":7784,"t":38.920000000000002,"sim_time":38.920000000001458,"vehicle":{"origin_ned":[1.5008074613677087,0.99953570365198829,3.5005996072581507],"origin_quat_xyzw":[-0.021765125192925672,0.053608244079527113,0.38234546174307699,0.92220625858672156],"cg_ned":[1.440559833465479,0.93991918523446039,3.208175214303076],"linear_velocity_ned":[-2.0254150672414622e-05,-4.7630853764365177e-05,0.00076910743739891905],"angular_velocity_ned":[4.1870057249015455e-05,-2.4609102553258103e-05,0.00079594704951897288]},"sensors":{"Odom":[1.5008074613677087,0.99953570365198829,3.5005996072581507,-0.00015025708371603318,4.5228820479527426e-05,0.00076078373657256402,-0.021765125192925689,0.053608244079527162,0.38234546174307732,0.92220625858672156,-7.985663662657935e-05,-4.6338810036823231e-05,0.00079206442132665768],"Pressure":[26839.982864902191],"DVL":[0.011142245569696448,-0.0069151192852381256,0.013382021602398313,7.3970573247430211,0.047034498406662281,-0.0079873136120416945,0.03610101231398756,0],"IMU":[0.00085559644919774337,0.11577779397753656,0.78610502955262007,0.026892647363445876,0.043014135426648004,-0.059089141280677403,1.1407099353548633,0.0027957382949325739,-9.7577112424267618],"FOG":[0.79367007805175827],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.8148878205263994,-12.368048942334456,-26.981286934924558,61.308657194563899,61.308657194563899],"omega_rad_s":[-3.8645455755280826,-12.37592007095191,-26.982440730372311,61.308924200000327,61.308929918354103],"thrust_n":[-0.19061372139234992,-1.9553098134489864,-9.2884670285991007,47.955261378696079,47.953860901985955],"torque_nm":[0.0035740072761065609,0.036662059002168498,0.17415875678623313,-0.89916115085055159,-0.89913489191223672],"angle_rad":[-575.85720179037094,289.07743265248808,-900.082176693262,2595.0898462475898,2595.0898402823454]},"command":[-0.036332264957394278,-0.11779094230794719,-0.25696463747547199,0.58389197328156095,0.58389197328156095],"arm":{"servo_position":[2.2499312661440551e-24,3.2526065174565154e-21,9.7514668052651336e-21,-1.5352472168984193e-23,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,8.6736173798840355e-19,0,-3.3881317890172014e-21,0,-4.3368086899420177e-19],"servo_effort":[0.0077516265621504505,-1.4928337584845814,-0.26968638797293337,6.9876105179361575e-06,-0.00039999621785985023,0.00011078811539582481]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":974,"step":7792,"t":38.960000000000001,"sim_time":38.960000000001479,"vehicle":{"origin_ned":[1.5008043635240078,0.99953524146557537,3.5006301077576296],"origin_quat_xyzw":[-0.021765414810782365,0.053607099642058884,0.38236003412653746,0.92220027645237335],"cg_ned":[1.44055892448628,0.93991730374609395,3.2082055531996301],"linear_velocity_ned":[-2.4637338022263257e-05,-4.6579184302412086e-05,0.00075017942260366703],"angular_velocity_ned":[4.0435206337626145e-05,-2.7832424414986351e-05,0.00078238290134726677]},"sensors":{"Odom":[1.5008043635240078,0.99953524146557537,3.5006301077576296,-0.00015079289356045985,4.887295843957141e-05,0.00074177219923232142,-0.021765414810782379,0.053607099642058925,0.38236003412653774,0.92220027645237335,-8.1562405724211812e-05,-4.7612930855803778e-05,0.00077821156305258612],"Pressure":[26839.637554388552],"DVL":[-0.015952242548027285,-0.022659162561689154,-0.013716545793678293,7.3442545241415287,0.013252144641397564,0.018682859227549177,-0.00093100882748211634,0],"IMU":[0.00085601250390217017,0.11577588482799098,0.78613661045433691,0.068228243151302173,-0.018425797774985118,0.086248814099550278,1.1405113990125084,-0.013404620346577786,-9.7491123126261101],"FOG":[0.78666185197663796],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.806035722300833,-12.37731679314966,-26.975501985795891,61.305918404503096,61.305918404503096],"omega_rad_s":[-3.8557608639322902,-12.385474278759547,-26.976529157919821,61.306013176561059,61.306018856289221],"thrust_n":[-0.18974261221591163,-1.9583095732671634,-9.2844389756746715,47.95124420272407,47.949804744206936],"torque_nm":[0.0035576739790483432,0.036718304498759312,0.17408323079390009,-0.89908582880107657,-0.89905883895388006],"angle_rad":[-576.01158472852717,288.58217734139623,-901.1613393500719,2597.5421366104406,2597.5421308730647]},"command":[-0.036247959260007935,-0.11787920755380629,-0.25690954272186561,0.58386588956669616,0.58386588956669616],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.0076632626856697975,-1.4927110115110582,-0.26966141100967356,6.8889823406313177e-06,-0.00040004083550556116,0.00011078918674158839]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":975,"step":7800,"t":39,"sim_time":39.000000000001499,"vehicle":{"origin_ned":[1.5008010859195089,0.99953480569044739,3.5006598536900713],"origin_quat_xyzw":[-0.021765742787105392,0.053605912198391358,0.38237435373567391,0.92219440045118983],"cg_ned":[1.4405578418320957,0.9399154637089876,3.2082351332324137],"linear_velocity_ned":[-2.8946877298323753e-05,-4.5554748407487145e-05,0.00073117570403066128],"angular_velocity_ned":[3.887117644684623e-05,-3.1147535341222285e-05,0.00076887115896953249]},"sensors":{"Odom":[1.5008010859195089,0.99953480569044739,3.5006598536900713,-0.00015127918144396533,5.2495826475554401e-05,0.00072268803746284378,-0.021765742787105406,0.053605912198391392,0.38237435373567413,0.92219440045118983,-8.3429476817507207e-05,-4.8860368153108181e-05,0.00076439268915476084],"Pressure":[26841.560644629186],"DVL":[-0.025316867194757633,0.020965446620998435,0.026474982529526059,7.3414471788786573,-0.026494013762527718,-0.012659919411351949,0.0069367725620611701,0],"IMU":[0.00085629222358589918,0.11577392577863939,0.78616763421172209,0.10196310992974017,-0.075051718464651626,0.057232019618569503,1.1210734577077635,-0.0097194525485483612,-9.7671146026381059],"FOG":[0.78773291673732171],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.7967770439465642,-12.386419964217968,-26.969747449049731,61.303246391243412,61.303246391243412],"omega_rad_s":[-3.8464939438499957,-12.394851229044116,-26.970651876119671,61.303173790551483,61.303179430755648],"thrust_n":[-0.18882629192132946,-1.9612558067750496,-9.2804357691136303,47.947340913182167,47.945863288447576],"torque_nm":[0.0035404929735249283,0.03677354637703218,0.17400817067088059,-0.89901264212216592,-0.89898493665839219],"angle_rad":[-576.16560519240431,288.08654391208432,-902.24026632708615,2599.9943121674282,2599.9943066563551]},"command":[-0.036159781370919658,-0.11796590442112351,-0.25685473760999744,0.58384044182136585,0.58384044182136585],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,-4.3368086899420177e-19],"servo_effort":[0.0075740728410517155,-1.4925893426651253,-0.26963637562004106,6.7910569432858985e-06,-0.00040008533567975786,0.00011078885124610775]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":976,"step":7808,"t":39.039999999999999,"sim_time":39.04000000000152,"vehicle":{"origin_ned":[1.500797630424316,0.99953439679468059,3.5006888422301659],"origin_quat_xyzw":[-0.021766112027583908,0.053604681118076244,0.38238842139649415,0.92218863022232556],"cg_ned":[1.4405565884667526,0.93991366405602872,3.2082639516637328],"linear_velocity_ned":[-3.3181994943343892e-05,-4.4556541275534117e-05,0.00071210915036316511],"angular_velocity_ned":[3.7194235689267714e-05,-3.4538350720075974e-05,0.00075541367302312727]},"sensors":{"Odom":[1.500797630424316,0.99953439679468059,3.5006888422301659,-0.00015171624072041743,5.6091061668400403e-05,0.0007035441797698242,-0.021766112027583922,0.053604681118076272,0.38238842139649437,0.92218863022232556,-8.5435338326545474e-05,-5.0081256029022605e-05,0.00075061228140022365],"Pressure":[26841.210974588757],"DVL":[0.0067098696004454211,0.02271712781765332,-0.028692036061125255,7.4162758523152892,-0.018053254314824362,0.0054748529596556341,-0.010375864962400184,0],"IMU":[0.00085642983194777697,0.11577191789691106,0.78619810229631815,-0.014226044237401061,0.01990995906557972,0.0081106019710729185,1.1569989865578825,-0.0042280866501201754,-9.7509507463375513],"FOG":[0.79045543877374824],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.7871461392700567,-12.395361584796929,-26.964022672615648,61.300640434189795,61.300640434189795],"omega_rad_s":[-3.836778480324734,-12.404053842113601,-26.964808285363308,61.300405413870266,61.300411013706658],"thrust_n":[-0.18786839713091774,-1.964149318202929,-9.2764569641829286,47.943550161836235,47.942035181991287],"torque_nm":[0.0035225324462047074,0.036827799716304919,0.17393356807842991,-0.89894156553442939,-0.89891315966233665],"angle_rad":[-576.31924465884538,287.59053938850906,-903.31895898242783,2602.4463757699682,2602.4463704835975]},"command":[-0.036068058469238634,-0.1180510627123517,-0.25680021592967284,0.58381562318275992,0.58381562318275992],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.0074839253158994158,-1.4924687625676483,-0.26961128535400541,6.6933191032910501e-06,-0.00040012887185218883,0.00011078779315615194]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":977,"step":7816,"t":39.079999999999998,"sim_time":39.08000000000154,"vehicle":{"origin_ned":[1.5007939991236967,0.99953401510151862,3.5007170710572661],"origin_quat_xyzw":[-0.021766525014706495,0.053603405943282875,0.38240223799316991,0.92218296538044919],"cg_ned":[1.4405551673844692,0.93991190376208467,3.2082920062605935],"linear_velocity_ned":[-3.7341946535899194e-05,-4.3583498002611187e-05,0.00069299218065972082],"angular_velocity_ned":[3.542074980291638e-05,-3.798864605986113e-05,0.00074201227794076438]},"sensors":{"Odom":[1.5007939991236967,0.99953401510151862,3.5007170710572661,-0.0001521042823087884,5.9652314424018415e-05,0.00068435310914921664,-0.021766525014706498,0.053603405943282882,0.38240223799316997,0.92218296538044919,-8.7557309969890564e-05,-5.1275701107384998e-05,0.00073687482472105631],"Pressure":[26840.992637363768],"DVL":[-0.020855634959637371,0.004932339100858424,-0.035535749463799546,7.3895480068094548,0.007626281550100005,-0.014875604407666939,-0.015474482277436401,0],"IMU":[0.00085642047888948253,0.11576986224499564,0.78622801635981643,0.016802822765782675,-0.080209748042423035,0.029323780678465063,1.1404928413923292,-0.02463661874688796,-9.764150238231565],"FOG":[0.79823452218909507],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.7771780983090042,-12.40414467854135,-26.95832702016143,61.298099819106625,61.298099819106625],"omega_rad_s":[-3.8266491248154191,-12.413085144148406,-26.958997742275464,61.297707351611209,61.297712910280644],"thrust_n":[-0.18687264318788369,-1.9669909505434575,-9.2725020870558144,47.939870507359046,47.938318979898348],"torque_nm":[0.003503862059772819,0.036881080322689844,0.17385941413229655,-0.89887257201298221,-0.89884348087309418],"angle_rad":[-576.47248597377404,287.09417067556808,-904.39741864913947,2604.89833024271,2604.8983251794093]},"command":[-0.035973124745800042,-0.11813471122420334,-0.25674597162058505,0.5837914268486345,0.5837914268486345],"arm":{"servo_position":[-6.2203982063989485e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[-3.3881317890172014e-21,0,0,0,0,-4.3368086899420177e-19],"servo_effort":[0.0073927512533756628,-1.4923492577442814,-0.26958614575023587,6.5965063049058436e-06,-0.0004001719711498701,0.00011078564059069504]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":978,"step":7824,"t":39.119999999999997,"sim_time":39.120000000001561,"vehicle":{"origin_ned":[1.5007901943158393,0.99953366079026251,3.5007445383397311],"origin_quat_xyzw":[-0.021766983805865291,0.053602086391907319,0.38241580446741003,0.92217740551586558],"cg_ned":[1.4405535816054116,0.93991018184528163,3.2083192952794093],"linear_velocity_ned":[-4.1426151212784969e-05,-4.2634504560973628e-05,0.00067383689150406505],"angular_velocity_ned":[3.3567106014084744e-05,-4.1481986057257119e-05,0.00072866870560526716]},"sensors":{"Odom":[1.5007901943158393,0.99953366079026251,3.5007445383397311,-0.0001524435202263925,6.3173329580099824e-05,0.00066512697218211729,-0.021766983805865305,0.053602086391907347,0.38241580446741025,0.92217740551586558,-8.9772536355585685e-05,-5.2443678573336098e-05,0.00072318472093639585],"Pressure":[26840.552127514609],"DVL":[0.035106414618534726,-0.02567883133374451,0.01963799448547851,7.4023712446519472,-0.010257961841871662,-0.016154335748242786,0.0057748459454273413,0],"IMU":[0.00085626024635299005,0.11576775988406132,0.78625737823313702,-0.020076450339096191,-0.04727192161705681,0.10905373545549972,1.1457765446782915,0.0091360652385947989,-9.7627840424008223],"FOG":[0.79843896338685549],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.7669087806888237,-12.412772461833168,-26.952659823427485,61.295623875290133,61.295623875290133],"omega_rad_s":[-3.8161414744328672,-12.421948310390036,-26.953219570274818,61.295078881175165,61.295084397914451],"thrust_n":[-0.18584281510952397,-1.969781598745987,-9.2685706411561313,47.936300473503749,47.934713206229638],"torque_nm":[0.0034845527833035749,0.036933404976487262,0.17378569952167749,-0.89880563387819534,-0.89877587261680592],"angle_rad":[-576.62531339105419,286.59744455365416,-905.4756466337725,2607.3501783818188,2607.3501735399236]},"command":[-0.03587532172084594,-0.11821688058888731,-0.25669199831835698,0.58376784643133461,0.58376784643133461],"arm":{"servo_position":[1.0720260738687059e-23,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[1.6940658945086007e-21,0,1.7347234759768071e-18,0,0,4.3368086899420177e-19],"servo_effort":[0.0073004906087945024,-1.4922308167656873,-0.26956095288189119,6.4995838520782886e-06,-0.00040021422160805436,0.00011078201437957622]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":979,"step":7832,"t":39.160000000000004,"sim_time":39.160000000001581,"vehicle":{"origin_ned":[1.5007862185070597,0.99953333389905696,3.5007712427215711],"origin_quat_xyzw":[-0.021767490032537647,0.053600722359325087,0.38242912181731653,0.92217195019490683],"cg_ned":[1.4405518341696284,0.93990849736994897,3.2083458174528632],"linear_velocity_ned":[-4.5434179289623592e-05,-4.1708379512298718e-05,0.00065465504144915517],"angular_velocity_ned":[3.1649648122733401e-05,-4.5001898698899422e-05,0.00071538466407429654]},"sensors":{"Odom":[1.5007862185070597,0.99953333389905696,3.5007712427215711,-0.00015273417132159549,6.6648006581100305e-05,0.00064587756999257364,-0.021767490032537667,0.053600722359325136,0.38242912181731686,0.92217195019490683,-9.2058164003209185e-05,-5.3585109141335078e-05,0.00070954634748137692],"Pressure":[26842.48341028651],"DVL":[-0.0027899254211038171,-0.018243353727599301,0.013968083035448758,7.4198803328485328,-0.015319669217788292,0.013447343516134807,-0.032856592525743453,0],"IMU":[0.00085594615104306532,0.11576561187679212,0.78628618992416821,0.023046283906250901,-0.06871663626510309,-0.017500899880789414,1.1334393543172099,0.0051717124569746736,-9.7262398221478801],"FOG":[0.76427407426991378],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.7563743269940688,-12.421248257867017,-26.947020415651664,61.2932119493233,61.2932119493233],"omega_rad_s":[-3.8052918868590875,-12.430646646174196,-26.947473071578155,61.29251926805545,61.292524742129885],"thrust_n":[-0.18478274478485693,-1.9725222039234791,-9.2646621156903404,47.932838574568471,47.931216377177925],"torque_nm":[0.0034646764647160676,0.036984791323565226,0.17371241466919388,-0.8987407232731589,-0.89871030707208621],"angle_rad":[-576.77771260640134,286.10036767321446,-906.55364421534819,2609.8019229542469,2609.8019183320639]},"command":[-0.035774993590419704,-0.11829760245587635,-0.256638289672873,0.58374487570784095,0.58374487570784095],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[1.6940658945086007e-21,0,0,0,0,0],"servo_effort":[0.0072070773733531081,-1.4921134149596258,-0.26953570466106047,6.4039620413146125e-06,-0.0004002559974448372,0.00011077753689733424]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":980,"step":7840,"t":39.200000000000003,"sim_time":39.200000000001602,"vehicle":{"origin_ned":[1.500782074406928,0.99953303432883311,3.5007971833099552],"origin_quat_xyzw":[-0.021768044902871427,0.053599313919035253,0.38244219109715627,0.92216659895992836],"cg_ned":[1.4405499281323837,0.93990684944901204,3.2083715719776773],"linear_velocity_ned":[-4.9365638265956742e-05,-4.0803884594448753e-05,0.00063545812756942647],"angular_velocity_ned":[2.9684479681231946e-05,-4.8532062798595726e-05,0.0007021620030858058]},"sensors":{"Odom":[1.500782074406928,0.99953303432883311,3.5007971833099552,-0.0001529763894125096,7.0070404796390403e-05,0.00062661644250432775,-0.021768044902871438,0.053599313919035274,0.38244219109715644,0.92216659895992836,-9.4391630411522434e-05,-5.4699852069217049e-05,0.00069596419040261249],"Pressure":[26842.160992607605],"DVL":[-0.025215080710714079,-0.0065984643110663004,0.011312738542215151,7.2867062195393855,-0.0075523605100791171,-0.0068276615565567526,0.0048133490752228364,0],"IMU":[0.0008554761400954104,0.11576341929048939,0.78631445361709129,-0.036653319921662438,-0.036582333644452805,-0.028670009174009223,1.1337890692285704,-0.018424046133067931,-9.7321653661594656],"FOG":[0.79026955222539319],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.7456110709308748,-12.429575455322997,-26.941408139411038,61.29086340678171,61.29086340678171],"omega_rad_s":[-3.7941372881163922,-12.439183576244325,-26.941757532155091,61.290027777470982,61.290033208167699],"thrust_n":[-0.18369628816040789,-1.975213750321259,-9.2607759892585282,47.929483331597808,47.927827017832037],"torque_nm":[0.0034443054030076485,0.037035257818523612,0.17363954979859741,-0.89867781246745904,-0.89864675658435089],"angle_rad":[-576.92967078322738,285.6029465496544,-907.63141264455192,2612.2535666975459,2612.2535622933528]},"command":[-0.035672486389817855,-0.11837690909831426,-0.25658483942296229,0.58372250863601627,0.58372250863601627],"arm":{"servo_position":[-6.2203982063989485e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[-1.6940658945086007e-21,0,0,0,0,0],"servo_effort":[0.0071125994646189204,-1.4919970634311375,-0.26951039760880618,6.3081700959146207e-06,-0.00040029628208178069,0.00011077206020828538]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":981,"step":7848,"t":39.240000000000002,"sim_time":39.240000000001622,"vehicle":{"origin_ned":[1.5007777649250735,0.99953276184819528,3.5008223596624517],"origin_quat_xyzw":[-0.021768649207877518,0.05359786132176713,0.3824550134191862,0.92216135132845756],"cg_ned":[1.4405478665630458,0.9399052372454878,3.2083965585021055],"linear_velocity_ned":[-5.3220316101098776e-05,-3.991977026975203e-05,0.00061625718254686547],"angular_velocity_ned":[2.7687592872360642e-05,-5.2056091675419566e-05,0.00068900222323726057]},"sensors":{"Odom":[1.5007777649250735,0.99953276184819528,3.5008223596624517,-0.00015317035610996893,7.3434699456643621e-05,0.00060735464823110578,-0.021768649207877529,0.053597861321767151,0.38245501341918636,0.92216135132845756,-9.6750364841478094e-05,-5.5787643858656881e-05,0.00068244238496829456],"Pressure":[26842.044969818609],"DVL":[-0.0058219819182356832,0.0036821447257993057,0.017402098239479354,7.4131475819330701,-0.012248592075124241,5.2446326742165482e-05,7.9953471474899928e-06,0],"IMU":[0.00085484907911956667,0.11576118320009966,0.78634217167571296,0.076489572887164764,-0.041266400793945952,-0.1227772907950789,1.1228214556017568,0.0039269566525537772,-9.7583008414630452],"FOG":[0.78331229758330723],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.7346555579334937,-12.437758165539645,-26.935822199261136,61.288577595454903,61.288577595454903],"omega_rad_s":[-3.7827150432111298,-12.447562795931976,-26.93607219332862,61.287603670862083,61.287609057484282],"thrust_n":[-0.18258730891553535,-1.9778573127333801,-9.2569117104693923,47.926233270180155,47.924543661035457],"torque_nm":[0.0034235120421662883,0.037084824613750879,0.17356709457130107,-0.89861687381587796,-0.89858519364441503],"angle_rad":[-577.08117657221749,285.10518755568324,-908.70895314257712,2614.7051123197944,2614.7051081318391]},"command":[-0.035568148170795177,-0.11845483967180614,-0.25653163999296319,0.58370073900433239,0.58370073900433239],"arm":{"servo_position":[1.0720260738687059e-23,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[1.6940658945086007e-21,0,0,0,0,0],"servo_effort":[0.0070167342936392398,-1.4918816773937627,-0.26948503207478308,6.2127647681688621e-06,-0.0004003364204974428,0.00011076528487174249]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":982,"step":7856,"t":39.280000000000001,"sim_time":39.280000000001642,"vehicle":{"origin_ned":[1.5007732931602475,0.99953251609284011,3.5008467717662244],"origin_quat_xyzw":[-0.021769303320994821,0.053596364996165373,0.38246758994122038,0.92215620679832266],"cg_ned":[1.4405456525323805,0.93990365997326941,3.2084207771052005],"linear_velocity_ned":[-5.6998255069076848e-05,-3.9054705455708155e-05,0.00059706291772980175],"angular_velocity_ned":[2.5674793043243459e-05,-5.5558050960948337e-05,0.0006759065753975035]},"sensors":{"Odom":[1.5007732931602475,0.99953251609284011,3.5008467717662244,-0.00015331639349307983,7.673541480330198e-05,0.00058810292184519682,-0.021769303320994828,0.053596364996165387,0.38246758994122049,0.92215620679832266,-9.9112216785424433e-05,-5.6848410522454228e-05,0.00066898476619047431],"Pressure":[26841.524702200564],"DVL":[0.0083901532353038658,0.0033008525541474262,0.016892635219174532,7.4039780172967244,-0.018422512364610399,-0.0069279408856330275,0.0024986392578763166,0],"IMU":[0.00085406475196390019,0.1157589046890949,0.78636934661650493,-0.0056931127078063909,-0.001012320010219326,0.026631905757508657,1.137695458295912,-0.0038532517571833215,-9.7862979044616445],"FOG":[0.77972836375450205],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.7235448454038043,-12.44579928203845,-26.930262170164248,61.286354016852314,61.286354016852314],"omega_rad_s":[-3.7710629662957995,-12.455787916375254,-26.930416354505827,61.285246247699753,61.285251589561135],"thrust_n":[-0.18145967587960979,-1.9804539429523949,-9.2530687685583555,47.923086988991621,47.921364909268917],"torque_nm":[0.0034023689227426837,0.03713351143035741,0.17349503941046915,-0.8985578810435928,-0.89852559204879234],"angle_rad":[-577.2322201289935,284.6070969169553,-909.78626690127601,2617.1565625002777,2617.1565585267822]},"command":[-0.035462331860988613,-0.11853142173369953,-0.25647868733489759,0.58367956206526017,0.58367956206526017],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[1.6940658945086007e-21,0,0,0,0,-4.3368086899420177e-19],"servo_effort":[0.0069196761722264558,-1.4917673904099265,-0.26945962735881984,6.1174829405872503e-06,-0.00040037534790116671,0.00011075744795882238]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":983,"step":7864,"t":39.32,"sim_time":39.320000000001663,"vehicle":{"origin_ned":[1.5007686623855969,0.9995322965759138,3.5008704200337708],"origin_quat_xyzw":[-0.021770007213440568,0.053594825537178217,0.3824799218690873,0.92215116484694781],"cg_ned":[1.4405432891078851,0.93990211690142345,3.2084442282917087],"linear_velocity_ned":[-6.0699584195655233e-05,-3.8207332545931888e-05,0.00057788585413057778],"angular_velocity_ned":[2.3661235143053374e-05,-5.9022420385009184e-05,0.00066287631251797359]},"sensors":{"Odom":[1.5007686623855969,0.9995322965759138,3.5008704200337708,-0.00015341479355084146,7.996737581530943e-05,0.00056887179576644794,-0.021770007213440593,0.053594825537178287,0.38247992186908775,0.92215116484694781,-0.0001014557834747421,-5.7881912194919552e-05,0.00065559508394603743],"Pressure":[26843.684490796324],"DVL":[0.015552986080080817,-0.012087856472972957,0.026941403179757829,7.3415105126010189,0.00025925521366649255,0.019599594047196748,-0.051123183494677794,0],"IMU":[0.0008531238235624627,0.11575658483970282,0.78639598111152698,0.056787648865512512,-0.037927515939310243,-0.052558284281306725,1.1322308700254657,0.0011301956788249152,-9.7473292866464476],"FOG":[0.78418960370797419],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.7123137348920632,-12.453702068115426,-26.924727373094097,61.284192069308851,61.284192069308851],"omega_rad_s":[-3.7592186013640934,-12.463862502016676,-26.924789312624764,61.282954817688882,61.282960114115745],"thrust_n":[-0.18031719127713278,-1.9830046827852501,-9.2492466515156746,47.920043107341854,47.918289385488926],"torque_nm":[0.0033809473364462403,0.037181337802223456,0.17342337471591887,-0.89850080826265966,-0.89846792597791736],"angle_rad":[-577.38279311768315,284.10868071605665,-910.86335508462821,2619.6079198906009,2619.6079161297589]},"command":[-0.035355368903733933,-0.11860668636300406,-0.25642597498184855,0.58365897208865569,0.58365897208865569],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[1.6940658945086007e-21,-8.6736173798840355e-19,1.7347234759768071e-18,0,0,0],"servo_effort":[0.0068212814220064621,-1.4916540285776818,-0.26943415655623498,6.0233604666729145e-06,-0.00040041372450963183,0.00011074872213885227]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":984,"step":7872,"t":39.359999999999999,"sim_time":39.360000000001683,"vehicle":{"origin_ned":[1.5007638760447053,0.99953210269304149,3.5008933052910094],"origin_quat_xyzw":[-0.021770760461403221,0.053593243720568368,0.38249201045634346,0.92214622493046305],"cg_ned":[1.440540779343592,0.93990060735204517,3.2084669129828902],"linear_velocity_ned":[-6.4324754524486133e-05,-3.7376311205112782e-05,0.00055873630454619425],"angular_velocity_ned":[2.1661644299648974e-05,-6.2433233413725824e-05,0.00064991292038666781]},"sensors":{"Odom":[1.5007638760447053,0.99953210269304149,3.5008933052910094,-0.00015346587618675459,8.3125639564687249e-05,0.00054967153652852793,-0.021770760461403242,0.053593243720568423,0.38249201045634384,0.92214622493046305,-0.00010375967684705024,-5.8887291091173539e-05,0.00064227732013696697],"Pressure":[26844.580293600753],"DVL":[-0.0035237693120713739,0.040913611900732318,-0.018758980697233755,7.394471675011534,0.018418782276000283,0.0027128732482138945,-0.020232122159900036,0],"IMU":[0.00085202783776070921,0.11575422476522521,0.78642207798846375,-0.052552825991235605,-0.012767900623228528,-0.14468101273693221,1.1393250196085083,-0.01206836285197594,-9.7938650504629159],"FOG":[0.78600368646785057],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.7009977516566108,-12.461469963053114,-26.919217218860137,61.282091178955611,61.282091178955611],"omega_rad_s":[-3.7472193267166234,-12.471790131458404,-26.919190383938552,61.280728699495384,61.280733949814554],"thrust_n":[-0.17916359883839056,-1.9855105818704359,-9.2454448572714441,47.91710025586864,47.915315747013786],"torque_nm":[0.0033593174782198232,0.037228323410070673,0.17335209107383959,-0.89844562979753706,-0.89841217025650866],"angle_rad":[-577.53288869970424,283.60994489308831,-911.94021882902678,2622.0591871149622,2622.0591835649416]},"command":[-0.035247597634824865,-0.11868066631479156,-0.25637349732247749,0.58363896360910106,0.58363896360910106],"arm":{"servo_position":[-6.2203982063989485e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,-4.3368086899420177e-19],"servo_effort":[0.0067216680721384836,-1.4915416073404268,-0.2694086173274689,5.9289255925252229e-06,-0.00040045080337064518,0.00011073874123959166]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":985,"step":7880,"t":39.399999999999999,"sim_time":39.400000000001704,"vehicle":{"origin_ned":[1.5007589377403496,0.9995319337289762,3.500915428764551],"origin_quat_xyzw":[-0.021771562258585262,0.053591620493096549,0.38250385700409556,0.92214138648405464],"cg_ned":[1.4405381262769972,0.93989913070225617,3.208488832503047],"linear_velocity_ned":[-6.7874179638252184e-05,-3.6560251509060244e-05,0.00053962417712263844],"angular_velocity_ned":[1.9690240602049321e-05,-6.5775556650365084e-05,0.00063701768000054234]},"sensors":{"Odom":[1.5007589377403496,0.9995319337289762,3.500915428764551,-0.00015346996532210387,8.6205572462957198e-05,0.00053051203489893608,-0.021771562258585279,0.053591620493096598,0.38250385700409584,0.92214138648405464,-0.00010600356587417214,-5.9864063705292616e-05,0.00062903512776279363],"Pressure":[26843.658819344309],"DVL":[-0.0072634969092723323,-0.0024703057519764697,0.005686959592252178,7.3136132772591376,-0.0097864566064086757,-0.014032473294648094,0.018693235535292153,0],"IMU":[0.00085077918642948011,0.11575182560144844,0.78644764022822589,-0.10641823548338572,0.037673129936448543,0.095031778982931969,1.1355206772623261,-0.0050035366686174403,-9.7363258267384563],"FOG":[0.79071527529612629],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.6896313941544809,-12.469106460095741,-26.913731033477728,61.28005079004965,61.28005079004965],"omega_rad_s":[-3.735102160691143,-12.479574458241228,-26.913618855889929,61.278567221704812,61.278572425235609],"thrust_n":[-0.17800256432441666,-1.9879727186052101,-9.2416628667025531,47.914257096721173,47.912442670848982],"torque_nm":[0.0033375480810828124,0.037274488473847692,0.17328117875067289,-0.89839232056352214,-0.89835830007841844],"angle_rad":[-577.68250152400856,283.11089524300405,-913.01685924272488,2624.5103667704934,2624.5103634294346]},"command":[-0.035139346610995055,-0.11875339485805468,-0.25632124793788313,0.58361953133380617,0.58361953133380617],"arm":{"servo_position":[-6.2203982063989485e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.0066207886207508134,-1.4914301525409852,-0.26938302675470144,5.8350062708642558e-06,-0.00040048696981627983,0.00011072801113174275]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":986,"step":7888,"t":39.439999999999998,"sim_time":39.440000000001724,"vehicle":{"origin_ned":[1.5007538512263192,0.99953178886662841,3.5009367920719998],"origin_quat_xyzw":[-0.021772411430740973,0.053589956967159603,0.38251546285694404,0.92213664892362146],"cg_ned":[1.4405353329267006,0.9398976863868973,3.2085099885699053],"linear_velocity_ned":[-7.1348357506718465e-05,-3.5757644729270843e-05,0.00052055930132132561],"angular_velocity_ned":[1.7760639899524691e-05,-6.9034722876879385e-05,0.00062419177293076243]},"sensors":{"Odom":[1.5007538512263192,0.99953178886662841,3.5009367920719998,-0.00015342727949234702,8.9202856209521066e-05,0.00051140309428001816,-0.02177241143074098,0.053589956967159617,0.38251546285694421,0.92213664892362146,-0.00010816771911383973,-6.0811508540470237e-05,0.00061587198966791678],"Pressure":[26842.309395341872],"DVL":[0.012443496450509225,0.036169301326420281,0.0089637449955486826,7.2786109526730796,0.0029661375700461025,0.040077324948525658,-0.016300239866798179,0],"IMU":[0.0008493810778276294,0.11574938850783999,0.78647267095433337,0.010328703035382383,0.02744859680460468,0.053255147331029498,1.1354336390297648,0.0098907966786223808,-9.727882202715854],"FOG":[0.77612447445802868],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.6782484332962326,-12.476614898934278,-26.908268271493395,61.278070354286839,61.278070354286839],"omega_rad_s":[-3.7229036104897357,-12.487219122670913,-26.90807404030884,61.276469727692401,61.276474883743134],"thrust_n":[-0.17683766021846609,-1.9903921714114712,-9.2379001786774655,47.91151231659336,47.909668864381032],"torque_nm":[0.0033157061290962383,0.037319853213965096,0.17321062835020246,-0.89834085593612545,-0.89830629120714445],"angle_rad":[-577.83162770896058,282.61153741484424,-914.09327740594563,2626.9614614278412,2626.961458293857]},"command":[-0.03503093745996412,-0.11882490379937408,-0.25626922163327043,0.58360067004082705,0.58360067004082705],"arm":{"servo_position":[1.0720260738687059e-23,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[3.3881317890172014e-21,-8.6736173798840355e-19,0,0,0,0],"servo_effort":[0.0065186484322366954,-1.4913196293939648,-0.26935736402387944,5.7411476439245298e-06,-0.00040052219986488674,0.00011071593978237334]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":987,"step":7896,"t":39.480000000000004,"sim_time":39.480000000001745,"vehicle":{"origin_ned":[1.5007486203976812,0.99953166719719244,3.5009573972138357],"origin_quat_xyzw":[-0.021773306456291362,0.05358825441316864,0.38252682940729366,0.92213201164394731],"cg_ned":[1.4405324022919819,0.93989627389862895,3.2085303832866172],"linear_velocity_ned":[-7.4747813108590273e-05,-3.4967160480881235e-05,0.00050155101287642446],"angular_velocity_ned":[1.5885573379801471e-05,-7.2197321893364502e-05,0.00061143686948809083]},"sensors":{"Odom":[1.5007486203976812,0.99953166719719244,3.5009573972138357,-0.00015333820284332196,9.211354970179594e-05,0.00049235402452520248,-0.021773306456291379,0.053588254413168682,0.38252682940729393,0.92213201164394731,-0.00011023396606129465,-6.17291669507832e-05,0.00060279169932368499],"Pressure":[26842.781743032188],"DVL":[0.0029212475855515717,0.02297754919199518,0.013936171334037977,7.2682286485937837,-0.0033255706509525019,-0.008841585812059875,-0.018668555294094797,0],"IMU":[0.00084783749299924521,0.11574691466922475,0.78649717343976255,0.04585883741450001,0.056311311805963285,0.00094237683136672284,1.1329399053701392,-0.021524705840862239,-9.7381938222618043],"FOG":[0.78541338668984739],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.6668815508484456,-12.483999165477945,-26.902828321755834,61.276149250194258,61.276149250194258],"omega_rad_s":[-3.7106594910027906,-12.494727870837334,-26.902555271603521,61.274435548087652,61.27444065595072],"thrust_n":[-0.17567234885044161,-1.9927700570062212,-9.234156306740779,47.908864595519596,47.906993023536963],"torque_nm":[0.0032938565409457816,0.037364438568866648,0.17314043075138963,-0.89829121116599242,-0.8982561191913182],"angle_rad":[-577.98026481803618,282.111876910354,-915.16947437218641,2629.4124736311228,2629.4124707022988]},"command":[-0.034922681436651865,-0.11889523014740901,-0.25621741258815078,0.5835823738113739,0.5835823738113739],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.0064153606426631069,-1.4912100719010322,-0.26933165222156341,5.6477556842963312e-06,-0.0004005562172956809,0.00011070284709252133]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":988,"step":7904,"t":39.520000000000003,"sim_time":39.520000000001765,"vehicle":{"origin_ned":[1.5007432492658626,0.99953156772697682,3.500977246553826],"origin_quat_xyzw":[-0.021774245483188088,0.05358651424700514,0.38253795808605012,0.92212747402289696],"cg_ned":[1.4405293373375863,0.93989489278931337,3.2085500191212728],"linear_velocity_ned":[-7.8073638543522348e-05,-3.4187159652396904e-05,0.00048260842356830124],"angular_velocity_ned":[1.4077372074842054e-05,-7.5250328076662096e-05,0.00059875364173455953]},"sensors":{"Odom":[1.5007432492658626,0.99953156772697682,3.500977246553826,-0.00015320327133324936,9.4934408846696105e-05,0.00047337389104368737,-0.021774245483188105,0.053586514247005189,0.38253795808605046,0.92212747402289696,-0.00011218457205211589,-6.2616570857224635e-05,0.00058979699441260463],"Pressure":[26843.039601459815],"DVL":[-0.0017304315783839325,-0.012369856081755349,-0.0055821740093994392,7.2980990722652228,-0.017284087901808041,-0.028450133026099993,-0.029508873924145616,0],"IMU":[0.00084615314360754782,0.11574440528549233,0.78652115108405696,0.025760158625434709,0.038034791470930043,-0.10418651713981406,1.1441565474915065,-0.013384519754929004,-9.7939759717407053],"FOG":[0.80164417546937639],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.65556108526363,-12.491262150911359,-26.897410613699677,61.274287019093087,61.274287019093087],"omega_rad_s":[-3.6984045040638169,-12.502104375579705,-26.897061861703282,61.272464048451475,61.272469107406074],"thrust_n":[-0.1745099421681725,-1.9951074707197032,-9.2304307503538379,47.906312679901632,47.904413907614142],"torque_nm":[0.0032720614156532346,0.037408265075994443,0.17307057656913449,-0.89824336274815553,-0.89820776076776532],"angle_rad":[-578.12841182427519,281.61191908141677,-916.24545116735703,2631.8634058983889,2631.8634031727806]},"command":[-0.034814867478701238,-0.11896440143725104,-0.25616581536856836,0.58356463827707705,0.58356463827707705],"arm":{"servo_position":[1.0720260738687059e-23,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[3.3881317890172014e-21,0,0,0,0,4.3368086899420177e-19],"servo_effort":[0.0063108331972180909,-1.4911014690254722,-0.26930588401281608,5.5539620685684241e-06,-0.00040058920404408628,0.00011068856614239958]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":989,"step":7912,"t":39.560000000000002,"sim_time":39.560000000001786,"vehicle":{"origin_ned":[1.5007377419466761,0.99953148937984715,3.500996342808961],"origin_quat_xyzw":[-0.021775226346588499,0.053584738025311281,0.38254885036152525,0.92212303542173202],"cg_ned":[1.4405261409882524,0.93989354266395231,3.208568898897223],"linear_velocity_ned":[-8.1326734017528752e-05,-3.3416545532594128e-05,0.00046374018661902191],"angular_velocity_ned":[1.2347442492166263e-05,-7.8181616905582745e-05,0.00058614340407292726]},"sensors":{"Odom":[1.5007377419466761,0.99953148937984715,3.500996342808961,-0.00015302320884474045,9.7662102089762331e-05,0.00045447127490133566,-0.02177522634658851,0.053584738025311301,0.38254885036152542,0.92212303542173202,-0.0001140031588305683,-6.347323495375958e-05,0.00057689110143719908],"Pressure":[26843.655684174246],"DVL":[-0.011448825161242621,0.0094900351670361687,-0.012964555640003955,7.3148609322987701,-0.040211026541414389,-0.022267509245916372,0.015067509936362302,0],"IMU":[0.00084433343535464682,0.1157418615764237,0.78654460740893439,-0.025402199461323129,0.085392596163088946,0.040401628831980334,1.1205441080848975,-0.018483395543382006,-9.7594380868843249],"FOG":[0.78312348685564792],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.6443163945498784,-12.498406590874627,-26.892014544961096,61.272483162809948,61.272483162809948],"omega_rad_s":[-3.6861718981467146,-12.50935203942724,-26.89159316480659,61.270554610580845,61.270559619892673],"thrust_n":[-0.1733535727079194,-1.997405425063016,-9.2267230350886607,47.903855351851782,47.901930313749531],"torque_nm":[0.0032503794882734883,0.037451351719931546,0.17300105690791245,-0.89819728784722097,-0.89816119338280387],"angle_rad":[-578.27606905290781,281.11166913988558,-917.32120879132481,2634.3142607226473,2634.314258198282]},"command":[-0.034707775186189317,-0.1190324437226155,-0.25611442423772474,0.58354745869342806,0.58354745869342806],"arm":{"servo_position":[-6.2203982063989485e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[-1.6940658945086007e-21,0,0,0,0,-4.3368086899420177e-19],"servo_effort":[0.0062051454707486393,-1.4909938053164118,-0.26928006996129311,5.4608039440365514e-06,-0.00040062104352160975,0.00011067356362543558]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":990,"step":7920,"t":39.600000000000001,"sim_time":39.600000000001806,"vehicle":{"origin_ned":[1.5007321026566909,0.99953143100751829,3.5010146890386986],"origin_quat_xyzw":[-0.021776246592561749,0.053582927435751174,0.3825595077407859,0.9221186951845638],"cg_ned":[1.4405228161359471,0.9398922231800495,3.2085870257823097],"linear_velocity_ned":[-8.4507857604377808e-05,-3.2653897564803813e-05,0.00044495483743417822],"angular_velocity_ned":[1.070630640399132e-05,-8.0979880805482111e-05,0.00057360727921461764]},"sensors":{"Odom":[1.5007321026566909,0.99953143100751829,3.5010146890386986,-0.00015279838334832346,0.00010029376141066498,0.00043565467588947817,-0.021776246592561756,0.053582927435751194,0.38255950774078601,0.9221186951845638,-0.00011567452113511972,-6.4298625966135222e-05,0.00056407691737839292],"Pressure":[26843.75351798028],"DVL":[0.019865561330464361,1.0419777904717296e-05,0.026891119196745781,7.4613550385929015,-0.0016032129955923771,-0.00028196148818067184,0.0018445650784923138,0],"IMU":[0.000842384416631969,0.11573928478184348,0.78656754605822166,0.020187595739578193,0.040810974372397606,-0.057085279682758248,1.1414000816186287,-0.0074884115071586453,-9.7468876019290303],"FOG":[0.79335413138577082],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.6331762430998924,-12.505435556446042,-26.886639552468772,61.270737191968337,61.270737191968337],"omega_rad_s":[-3.6739940261405128,-12.516474205617087,-26.886148509553372,61.26870664215884,61.268711601080042],"thrust_n":[-0.17220624754753339,-1.9996649186571085,-9.2230326736523569,47.901491437496503,47.899541083974903],"torque_nm":[0.0032288671415162508,0.037493717224820797,0.17293186263098168,-0.89815296445305948,-0.89811639532452947],"angle_rad":[-578.42323814046426,280.61113216322491,-918.39674821708661,2636.7650405728941,2636.7650382477691]},"command":[-0.03460167850571326,-0.11909938625186706,-0.25606323383303592,0.58353083039969844,0.58353083039969844],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.0060982855454847522,-1.4908870573003512,-0.26925419119117638,5.3676571853809517e-06,-0.00040065147977063519,0.00011065714928301796]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":991,"step":7928,"t":39.640000000000001,"sim_time":39.640000000001827,"vehicle":{"origin_ned":[1.5007263356949574,0.99953139139480995,3.5010322886348084],"origin_quat_xyzw":[-0.021777303500404351,0.053581084286958444,0.38256993176413573,0.92211445264070635],"cg_ned":[1.4405193656315975,0.93989093404348523,3.2086044032785526],"linear_velocity_ned":[-8.7618342366769958e-05,-3.189803594824211e-05,0.00042626072241250983],"angular_velocity_ned":[9.1636410306587238e-06,-8.3634768317455033e-05,0.00056114605737716205]},"sensors":{"Odom":[1.5007263356949574,0.99953139139480995,3.5010322886348084,-0.00015252973687755015,0.0001028270995638281,0.00041693234347175078,-0.021777303500404365,0.053581084286958472,0.38256993176413595,0.92211445264070635,-0.00011718468011180392,-6.5092289361331696e-05,0.00055135686185190573],"Pressure":[26842.41776728104],"DVL":[0.015235228198813941,-0.018580919256480713,-0.020019770737956046,7.369685927785036,-0.019819251310462076,-0.00021088927818878903,-0.026882695137578131,0],"IMU":[0.00084031272864135414,0.11573667616013736,0.78658997078294079,0.056689569209495971,-0.069356569634818246,0.032525913040478978,1.1297336839244987,-0.0058590397938151281,-9.7483331896669068],"FOG":[0.78731805119877585],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.6221683748908662,-12.512351661610564,-26.881285095791856,61.269048661431604,61.269048661431604],"omega_rad_s":[-3.6619021290365716,-12.523474126188923,-26.880727265693071,61.266919567798716,61.266924475568153],"thrust_n":[-0.17107082964589193,-2.0018869214672921,-9.2193592033863414,47.899219798515468,47.897245093747777],"torque_nm":[0.0032075780558604738,0.037535379777511722,0.1728629850634939,-0.89811037122216519,-0.89807334550777085],"angle_rad":[-578.56992199180229,280.11031309623439,-919.47207039200248,2639.2157478947211,2639.215745766805]},"command":[-0.034496841665627297,-0.11916525392010062,-0.2560122390075415,0.58351474915649149,0.58351474915649149],"arm":{"servo_position":[2.2499312661440551e-24,3.2526065174565154e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,8.6736173798840355e-19,0,1.6940658945086007e-21,0,0],"servo_effort":[0.0059903152433387454,-1.4907812967325189,-0.26922827692552653,5.2747269043194905e-06,-0.00040068072892837279,0.000110639873811776]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":992,"step":7936,"t":39.68,"sim_time":39.680000000001847,"vehicle":{"origin_ned":[1.5007204454203029,0.99953136928318886,3.5010491453195738],"origin_quat_xyzw":[-0.021778394107937356,0.053579210502016777,0.38258012400866953,0.92211030710299013],"cg_ned":[1.4405157922721079,0.9398896750193082,3.2086210352209439],"linear_velocity_ned":[-9.0659435219073102e-05,-3.114739483799435e-05,0.00040766601982731226],"angular_velocity_ned":[7.7279594768856266e-06,-8.6136636400184832e-05,0.00054876140284117333]},"sensors":{"Odom":[1.5007204454203029,0.99953136928318886,3.5010491453195738,-0.00015221776223799089,0.00010526050174097053,0.00039831238248588829,-0.02177839410793737,0.053579210502016805,0.38258012400866975,0.92211030710299013,-0.00011852107265555204,-6.58534470150143e-05,0.00053873406945267974],"Pressure":[26843.767469703347],"DVL":[-0.026017756250163265,0.017006953790246179,0.016485808160232023,7.3110923728598509,0.012070423974558677,-0.003771475021082393,-0.026527063742485604,0],"IMU":[0.00083812555385920286,0.1157340369955935,0.78661188544619243,0.039567988764400833,-0.020590482561278864,-0.039352710316118325,1.1459304591100596,-0.01891156534156228,-9.7602993031299459],"FOG":[0.765203504746786],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.6113151267848904,-12.519157564167299,-26.8759505963518,61.267417001239501,61.267417001239501],"omega_rad_s":[-3.6499252500314996,-12.53035481779194,-26.875328801978778,61.265192800946032,61.265197656787528],"thrust_n":[-0.16994993871075054,-2.0040723336112003,-9.2157021623520183,47.897039277558648,47.895041208381038],"torque_nm":[0.0031865613508265732,0.037576356255210011,0.17279441554410041,-0.8980694864542248,-0.89803202265714466],"angle_rad":[-578.71612471512321,279.60921676061776,-920.54717623822103,2641.6663851105855,2641.6663831778142]},"command":[-0.034393477397951337,-0.11923007203968856,-0.25596143425096951,0.58349920953561429,0.58349920953561429],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.0058815499441586538,-1.4906764385244555,-0.26920230184338551,5.1816584126916382e-06,-0.00040070873256648274,0.00011062145544182101]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":993,"step":7944,"t":39.719999999999999,"sim_time":39.720000000001868,"vehicle":{"origin_ned":[1.5007144362297344,0.99953136337548243,3.5010652630929542],"origin_quat_xyzw":[-0.021779515229901038,0.053577308101690847,0.38259008608787176,0.92210625786847455],"cg_ned":[1.4405120987920279,0.93988844593019105,3.2086369257231504],"linear_velocity_ned":[-9.3633048717556535e-05,-3.0400528006519441e-05,0.00038917641378624689],"angular_velocity_ned":[6.4078204783227558e-06,-8.8477266263761717e-05,0.00053645422104731588]},"sensors":{"Odom":[1.5007144362297344,0.99953136337548243,3.5010652630929542,-0.00015186352708637408,0.00010759295861152222,0.00037980040845591527,-0.021779515229901052,0.053577308101690882,0.38259008608787198,0.92210625786847455,-0.00011967201755886718,-6.6582360409173975e-05,0.00052621080907180775],"Pressure":[26844.515026201123],"DVL":[0.0081266289211954033,0.027933626799378945,0.042050405346970382,7.3599027176125347,0.0036055914743959049,-0.013039079658372626,-0.0066734348652733371,0],"IMU":[0.00083583056888682184,0.11573136858148697,0.7866332940191223,-0.0093473516423672014,0.036829390787962095,0.095856614048257877,1.1359835348949896,-0.019707137245086027,-9.7466401840723567],"FOG":[0.77477002882443535],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.6006375426200514,-12.525855994858448,-26.87063533956989,61.265841943858199,61.265841943858199],"omega_rad_s":[-3.6380901567415833,-12.53711937890662,-26.869952441962536,61.263525798392784,61.263530601516997],"thrust_n":[-0.16884594821656659,-2.0062220829599395,-9.2120610584272686,47.894948856314727,47.892928406027295],"torque_nm":[0.0031658615290606237,0.037616664055498877,0.1727261448455113,-0.89803029105590126,-0.8979924076130118],"angle_rad":[-578.86185152766393,279.1078478539531,-921.62206665160556,2644.116954619959,2644.1169528802384]},"command":[-0.034291786120190966,-0.1192938666176995,-0.25591081275780847,0.58348420898912567,0.58348420898912567],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.0057719367824827505,-1.4905722307397815,-0.2691762562384325,5.0886923783460657e-06,-0.00040073535213615172,0.00011060191769303973]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":994,"step":7952,"t":39.759999999999998,"sim_time":39.760000000001888,"vehicle":{"origin_ned":[1.5007083125358216,0.99953137234416345,3.5010806461820634],"origin_quat_xyzw":[-0.021780663477086046,0.053575379189378117,0.38259981964426071,0.92210230422192918],"cg_ned":[1.4405082878527273,0.93988724665839141,3.2086520791258475],"linear_velocity_ned":[-9.6540817755009969e-05,-2.9655979341864555e-05,0.00037079839529031202],"angular_velocity_ned":[5.2103919487219721e-06,-9.0649069813404805e-05,0.00052422550016952712]},"sensors":{"Odom":[1.5007083125358216,0.99953137234416345,3.5010806461820634,-0.00015146782824732746,0.00010982369639474323,0.00036140283515825422,-0.021780663477086064,0.053575379189378158,0.38259981964426104,0.92210230422192918,-0.0001206272623909584,-6.7278752436570951e-05,0.00051378926624534246],"Pressure":[26844.564259694282],"DVL":[-0.0015588332632557437,-0.0059063550859747901,-0.015857947591031013,7.2487691146861062,-0.0022179355481995473,0.0084784611359755031,-0.0079688246108913698,0],"IMU":[0.00083343589638632031,0.11572867220692575,0.7866542005618401,0.011289797343776831,0.08919640912095321,0.049774274613111957,1.1250001044452869,-0.014119369911802845,-9.7333381964206218],"FOG":[0.78789188579245306],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5901527012676233,-12.53244892470571,-26.865338760304276,61.264323919304822,61.264323919304822],"omega_rad_s":[-3.62642083663291,-12.543770573700973,-26.864597514218712,61.261918301519515,61.261923051137387],"thrust_n":[-0.16776094358604324,-2.008336993564785,-9.2084354047838293,47.892947956370399,47.890906112461785],"torque_nm":[0.003145517692238311,0.037656318629339727,0.17265816383969682,-0.89799277418194501,-0.89795448960865842],"angle_rad":[-579.00710865418387,278.60621095805379,-922.6967425009135,2646.5674588070433,2646.5674572582461]},"command":[-0.034191930488263078,-0.11935665642576866,-0.255860369145755,0.58346975161242687,0.58346975161242687],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,4.3198680309969292e-21,1.0503208545953473e-21],"servo_velocity":[0,0,0,1.6940658945086007e-21,8.6736173798840355e-19,-4.3368086899420177e-19],"servo_effort":[0.005661454556306675,-1.4904689199566248,-0.26915015615979737,4.9953980039753501e-06,-0.00040076067478809688,0.000110581520975897]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":995,"step":7960,"t":39.800000000000004,"sim_time":39.800000000001909,"vehicle":{"origin_ned":[1.5007020787706624,0.99953139484538467,3.5010952991120798],"origin_quat_xyzw":[-0.021781835290303583,0.05357342595589306,0.38260932634654843,0.92209844543593877],"cg_ned":[1.4405043620513067,0.93988607714042227,3.208666500070557],"linear_velocity_ned":[-9.9384316737705734e-05,-2.8912512677544905e-05,0.00035253976678663985],"angular_velocity_ned":[4.1412915916465667e-06,-9.2645309562040286e-05,0.00051207619692484035]},"sensors":{"Odom":[1.5007020787706624,0.99953139484538467,3.5010952991120798,-0.00015103157675989273,0.00011195223737154209,0.0003431273415020727,-0.021781835290303586,0.053573425955893067,0.38260932634654848,0.92209844543593877,-0.00012137823674076553,-6.7941849828429991e-05,0.00050147139881003683],"Pressure":[26845.424723615564],"DVL":[-0.020278729311249417,-0.0028884558259817247,-0.017042500890467882,7.3550814958058615,0.018834505799583852,-0.016800681827261549,-0.018746625465102355,0],"IMU":[0.00083095004538385261,0.11572594919178728,0.78667460921463728,-0.11580705728219741,0.0011251857071946495,0.12991142214954118,1.1221312226841313,-0.0037231916182690694,-9.777072150287669],"FOG":[0.78267406878461654],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5798775067559689,-12.538938377509677,-26.860060512312081,61.262862378735335,61.262862378735335],"omega_rad_s":[-3.6149391913823834,-12.550311001786383,-26.85926341777418,61.260370007876325,61.260374703191651],"thrust_n":[-0.16669679172912044,-2.0104178376050013,-9.2048247604969156,47.891035878160771,47.888973653053149],"torque_nm":[0.003125564844921009,0.037695334455093779,0.17259046425931721,-0.89795692271551453,-0.89791825599474662],"angle_rad":[-579.15190323042373,278.10431054770339,-923.77120462945106,2649.0179000456142,2649.0178986855817]},"command":[-0.034094071492913991,-0.11941846073818739,-0.25581010011725791,0.58345583217843178,0.58345583217843178],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,-4.3368086899420177e-19],"servo_effort":[0.0055502205122798893,-1.4903666474546926,-0.26912403225019949,4.9022282930865103e-06,-0.00040078439130210167,0.00011056001915391526]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":996,"step":7968,"t":39.840000000000003,"sim_time":39.840000000001929,"vehicle":{"origin_ned":[1.5006957393644436,0.99953142951775664,3.5011092267033206],"origin_quat_xyzw":[-0.021783026978562537,0.05357145064570229,0.382618607895299,0.9220946807696212],"cg_ned":[1.4405003239268093,0.93988493735193623,3.2086801934938589],"linear_velocity_ned":[-0.0001021650348890924,-2.8169260777677702e-05,0.00033440773281319147],"angular_velocity_ned":[3.2051680816703478e-06,-9.4461696609182694e-05,0.0005000076721122463]},"sensors":{"Odom":[1.5006957393644436,0.99953142951775664,3.5011092267033206,-0.00015055612703579322,0.00011397852332948095,0.00032498104268539744,-0.021783026978562544,0.053571450645702311,0.38261860789529917,0.9220946807696212,-0.00012191881860304544,-6.8571922677731234e-05,0.00048925928758741159],"Pressure":[26844.500751402662],"DVL":[-0.013104346970560761,-0.012131094072497463,0.027343654268461016,7.2920852282083688,-0.019475820226410163,-0.01057018649333003,0.012663576271400374,0],"IMU":[0.00082838181503717457,0.11572320085355352,0.78669452420384745,-0.0053023951968114748,0.013403789706762011,-0.17006097580705001,1.1108493269431574,-0.0072494654728864983,-9.8057161919792684],"FOG":[0.79142491694987027],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5698270529211915,-12.545326189736071,-26.85479977774931,61.261456814832009,61.261456814832009],"omega_rad_s":[-3.6036651391881986,-12.556743067290046,-26.853949514059323,61.25888051048004,61.258885150694063],"thrust_n":[-0.16565515485282317,-2.0124653272941435,-9.2012286582938305,47.889211788724282,47.887130186835783],"torque_nm":[0.0031060341534904349,0.037733724886765185,0.17252303734300936,-0.8979227210385804,-0.897883691003171],"angle_rad":[-579.29624322274481,277.60215099823097,-924.8454538563135,2651.4682806946344,2651.4682795211775]},"command":[-0.03399835288496373,-0.11947929704510545,-0.25575999788332676,0.58344244585554295,0.58344244585554295],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.0054385343938284387,-1.4902654362619296,-0.26909789486704094,4.8089668579315613e-06,-0.00040080686309672687,0.00011053734111610754]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":997,"step":7976,"t":39.880000000000003,"sim_time":39.880000000001949,"vehicle":{"origin_ned":[1.5006892987329441,0.99953147499705841,3.5011224340661142],"origin_quat_xyzw":[-0.021784234739295163,0.053569455555536986,0.38262766602297377,0.92209100946821854],"cg_ned":[1.4404961759531427,0.93988382731167941,3.2086931646233419],"linear_velocity_ned":[-0.00010488458474704207,-2.7425039946964511e-05,0.00031640951720284015],"angular_velocity_ned":[2.4059296981941366e-06,-9.6093630468773816e-05,0.00048802143001883298]},"sensors":{"Odom":[1.5006892987329441,0.99953147499705841,3.5011224340661142,-0.00015004247568179644,0.00011590290688723945,0.00030697105114000896,-0.021784234739295159,0.053569455555536979,0.38262766602297371,0.92209100946821854,-0.00012224320279029054,-6.9168496926910291e-05,0.00047715512035024051],"Pressure":[26845.719035084647],"DVL":[-0.0099479009106466631,0.014727719765467934,-0.0098783153966256372,7.3877313720318627,-0.0010742164126621655,-0.0061310186691072811,0.00042942465208451526,0],"IMU":[0.0008257402560356194,0.11572042852028269,0.7867139498400092,0.07917339845934504,-0.022183784778104752,-0.11696314063432083,1.1272580888509425,-0.0074266952773010516,-9.7256239131389801],"FOG":[0.79167941665267616],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5600132641015163,-12.551614116901499,-26.849555833376783,61.260106645397919,61.260106645397919],"omega_rad_s":[-3.5926163032674565,-12.563068969018719,-26.848655099197888,61.257449335783626,61.257453920099017],"thrust_n":[-0.16463746447076849,-2.014480111582666,-9.1976465866291015,47.887474741393973,47.885374780547195],"torque_nm":[0.0030869524588269092,0.037771502092174995,0.17245587349929564,-0.89789015140113693,-0.89785077713525996],"angle_rad":[-579.44013734308589,277.09973659415664,-925.91949097325903,2653.9186030953647,2653.9186021062601]},"command":[-0.033904888229538251,-0.11953918206572857,-0.25571005555596937,0.58342958709902781,0.58342958709902781],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,3.2187251995663562e-21],"servo_velocity":[0,0,0,0,0,4.3368086899420177e-19],"servo_effort":[0.005326326186312777,-1.4901652463384196,-0.26907173004606405,4.7153042652900496e-06,-0.00040082786436131324,0.00011051386738712024]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":998,"step":7984,"t":39.920000000000002,"sim_time":39.92000000000197,"vehicle":{"origin_ned":[1.5006827612678857,0.99953152992365712,3.5011349265932887],"origin_quat_xyzw":[-0.02178545468779133,0.053567443017844739,0.38263650249538861,0.92208743076276256],"cg_ned":[1.4404919205453193,0.9398827470763742,3.2087054189693736],"linear_velocity_ned":[-0.00010754448078877987,-2.6679006215985798e-05,0.00029855212758241235],"angular_velocity_ned":[1.7462132486208896e-06,-9.7538622271295541e-05,0.00047611922448802772]},"sensors":{"Odom":[1.5006827612678857,0.99953152992365712,3.5011349265932887,-0.0001494919414603259,0.00011772615152857593,0.0002891042753621499,-0.021785454687791347,0.053567443017844774,0.38263650249538889,0.92208743076276256,-0.00012234798989366788,-6.9731689613811639e-05,0.00046516105689852757],"Pressure":[26846.590865738701],"DVL":[0.0038055930290702752,0.04082627041878116,-0.0012742571358112923,7.4152561608688794,-0.01808758749156085,0.017292242443201159,0.040413904404769899,0],"IMU":[0.00082303460336961311,0.11571763352260186,0.78673289051691919,0.025266678721883484,0.0032768619229149591,-0.0082804525516534978,1.1206421551966059,-0.0042184645292520509,-9.720825870770998],"FOG":[0.78246598085622698],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.550447001307965,-12.557803965674864,-26.844327972943738,61.258811292771043,61.258811292771043],"omega_rad_s":[-3.5818081864330606,-12.569290877761039,-26.843379447759986,61.256075953238032,61.256080480860177],"thrust_n":[-0.16364494287892736,-2.0164628324425435,-9.1940780193110534,47.885823714187445,47.883706409730294],"torque_nm":[0.0030683426789798879,0.037808678108297689,0.1723889628620823,-0.89785919464101471,-0.89781949518244286],"angle_rad":[-579.58359495861794,276.59707153192761,-926.99331674335633,2656.3688695687415,2656.3688687617355]},"command":[-0.03381378096483776,-0.11959813300642728,-0.25566026640898798,0.58341725040734327,0.58341725040734327],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.0052138828740057961,-1.4900661710405165,-0.26904555807337976,4.6213355197727438e-06,-0.00040084712249447395,0.00011048913020274758]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":999,"step":7992,"t":39.960000000000001,"sim_time":39.96000000000199,"vehicle":{"origin_ned":[1.5006761313066619,0.99953159295755278,3.5011467099584248],"origin_quat_xyzw":[-0.021786682879200464,0.053565415394540204,0.38264511910988291,0.92208394387068415],"cg_ned":[1.4404875600374494,0.9398816967453244,3.2087169623237863],"linear_velocity_ned":[-0.00011014696024899288,-2.5930027746719843e-05,0.00028084253955228551],"angular_velocity_ned":[1.2279029487984343e-06,-9.8794598458027224e-05,0.00046430215276087387]},"sensors":{"Odom":[1.5006761313066619,0.99953159295755278,3.5011467099584248,-0.00014890607188090092,0.00011944992091460341,0.0002713875441474259,-0.021786682879200464,0.053565415394540211,0.38264511910988297,0.92208394387068415,-0.00012223052470353293,-7.0261378799419373e-05,0.00045327850927263247],"Pressure":[26846.432216230791],"DVL":[-0.01122574797456824,-0.023245071836401072,0.0035791630825082513,7.316480104329413,-0.025459523550926382,0.024906358868831226,0.032274596579752769,0],"IMU":[0.00082027423043915882,0.11571481719905498,0.78675135070511704,-0.018358038865255204,0.029702539755387152,0.050169239955937896,1.1116514366834949,-0.0025390154368843424,-9.7666375722105023],"FOG":[0.79940198448828104],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5411336572169447,-12.563897447376993,-26.839115207967012,61.257570100708435,61.257570100708435],"omega_rad_s":[-3.5712534578702431,-12.575410868829429,-26.838121733039419,61.254759777459604,61.25476424759804],"thrust_n":[-0.16267854030952103,-2.0184141007431573,-9.1905223587991394,47.884257597641593,47.882123970503571],"torque_nm":[0.0030502226308035201,0.037845264388934201,0.17232229422748385,-0.89782982995577998,-0.89778982444694211],"angle_rad":[-579.72662599610976,276.09415992321891,-928.06693189834311,2658.8190824132848,2658.8190817860927]},"command":[-0.033725082449685188,-0.11965616616549517,-0.25561062102825727,0.58340542953055652,0.58340542953055652],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,0],"servo_effort":[0.0051010040323920354,-1.4899683246761202,-0.26901941288723441,4.5272634650769942e-06,-0.00040086504070903763,0.00011046336929052923]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}
{"sample":1000,"step":8000,"t":40,"sim_time":40.000000000002011,"vehicle":{"origin_ned":[1.500669413107435,0.99953166278213101,3.5011577901058559],"origin_quat_xyzw":[-0.02178791535120387,0.05356337505046363,0.38265351769012229,0.92208054799850714],"cg_ned":[1.4404830966815028,0.93988067644732576,3.2087278007484383],"linear_velocity_ned":[-0.00011269405689591284,-2.5177641807958175e-05,0.00026328744019195051],"angular_velocity_ned":[8.510532352719129e-07,-9.9861488227023884e-05,0.00045257186597647269]},"sensors":{"Odom":[1.500669413107435,0.99953166278213101,3.5011577901058559,-0.0001482867440000911,0.00012107610079638841,0.00025382736872743626,-0.02178791535120388,0.053563375050463657,0.38265351769012251,0.92208054799850714,-0.00012189090801633617,-7.0757560938154487e-05,0.00044150912686940938],"Pressure":[26843.587110538778],"DVL":[-0.026017262717344055,0.010836512331690033,-0.0050521681050712556,7.4183206853094301,0.015265197689714226,0.013313301698488846,0.04190100190709347,0],"IMU":[0.00081746854869638869,0.11571198087978349,0.78676933493437662,0.018561449596807014,0.022386143792697221,-0.18637908577484311,1.1255823610902806,-0.0083816474801102353,-9.7243955768825359],"FOG":[0.79714800830746024],"GPS":[1e+30,1e+30,0,0]},"thrusters":{"setpoint_rad_s":[-3.5320751549638278,-12.56989500143197,-26.833916644860345,61.25638245371406,61.25638245371406],"omega_rad_s":[-3.5609613539113778,-12.581430553393698,-26.832881108296508,61.25350018494062,61.253504596816306],"thrust_n":[-0.16173888737910197,-2.0203343790459862,-9.1869789915604674,47.882775236241507,47.880626303897273],"torque_nm":[0.0030326041383581625,0.037881269607112245,0.17225585609175875,-0.89780203567952832,-0.897761743198074],"angle_rad":[-579.8692408098716,275.59100580707707,-929.14033713671972,2661.2692439030948,2661.2692434534006]},"command":[-0.033638810999655502,-0.11971328572792353,-0.25556111090343187,0.58339411860680057,0.58339411860680057],"arm":{"servo_position":[2.2499312661440551e-24,-1.0842021724855024e-21,9.7514668052651336e-21,1.5881867761018145e-24,-1.6940658945088655e-23,1.0503208545953473e-21],"servo_velocity":[0,0,0,0,0,-4.3368086899420177e-19],"servo_effort":[0.0049878862958352239,-1.4898715679220864,-0.26899327029833348,4.4332897553220781e-06,-0.00040088137340184906,0.00011043673501667185]},"water_velocity_at_origin_ned":[0,0,0],"contact_points":0,"contact_pairs":[]}