diff --git a/real_robot/coordination_formation_control_pkg/results/angle.csv b/real_robot/coordination_formation_control_pkg/results/angle.csv new file mode 100644 index 0000000000000000000000000000000000000000..447f77aca0b975f898411d6650e1747ba9544c98 --- /dev/null +++ b/real_robot/coordination_formation_control_pkg/results/angle.csv @@ -0,0 +1,162 @@ +0.000000000000000000e+00,0.000000000000000000e+00 +-1.624186933040618896e-01,1.027282476425170898e+00 +-2.114833444356918335e-01,1.167885065078735352e+00 +-1.811449229717254639e-01,1.216748714447021484e+00 +-2.198748737573623657e-01,1.066293478012084961e+00 +-2.205687612295150757e-01,1.058767676353454590e+00 +-2.196720987558364868e-01,1.063477754592895508e+00 +-2.224885821342468262e-01,1.050099968910217285e+00 +-2.163585275411605835e-01,1.075332880020141602e+00 +-2.197116017341613770e-01,1.081187129020690918e+00 +-2.131524831056594849e-01,1.065727353096008301e+00 +-2.134290188550949097e-01,1.085066676139831543e+00 +-2.142369747161865234e-01,1.086621165275573730e+00 +-2.110711485147476196e-01,1.063112497329711914e+00 +-2.096409797668457031e-01,1.078520536422729492e+00 +-2.070798426866531372e-01,1.066942095756530762e+00 +-2.130766659975051880e-01,1.064068078994750977e+00 +-2.099575102329254150e-01,1.065781712532043457e+00 +-2.085962742567062378e-01,1.068991184234619141e+00 +-2.020037770271301270e-01,1.071776747703552246e+00 +-2.024561166763305664e-01,1.068706989288330078e+00 +-2.066778242588043213e-01,1.069287419319152832e+00 +-1.984831392765045166e-01,1.063418626785278320e+00 +-1.956074684858322144e-01,1.043921709060668945e+00 +-1.907450407743453979e-01,1.069079875946044922e+00 +-1.987958401441574097e-01,1.044007062911987305e+00 +-2.004132866859436035e-01,1.052876591682434082e+00 +-2.009772360324859619e-01,1.070895910263061523e+00 +-2.058069109916687012e-01,1.066816926002502441e+00 +-2.119364142417907715e-01,1.044474601745605469e+00 +-2.041852325201034546e-01,1.050229430198669434e+00 +-2.069534659385681152e-01,1.070442199707031250e+00 +-1.675197482109069824e-01,9.976004958152770996e-01 +-1.733607500791549683e-01,9.982299804687500000e-01 +-1.768017113208770752e-01,9.918226003646850586e-01 +-1.782060861587524414e-01,9.786713123321533203e-01 +-1.923603713512420654e-01,1.160884499549865723e+00 +-2.168278396129608154e-01,1.044409990310668945e+00 +-2.290111333131790161e-01,1.012012362480163574e+00 +-2.218666374683380127e-01,1.008954048156738281e+00 +-2.206018716096878052e-01,1.039815306663513184e+00 +-2.206018716096878052e-01,1.039815306663513184e+00 +-2.163348197937011719e-01,1.044031262397766113e+00 +-2.132236659526824951e-01,1.031984686851501465e+00 +-2.096954435110092163e-01,1.038158774375915527e+00 +-2.063728272914886475e-01,1.062424540519714355e+00 +-2.071557641029357910e-01,1.047261238098144531e+00 +-2.120216339826583862e-01,1.055302381515502930e+00 +-2.117087393999099731e-01,1.079220533370971680e+00 +-2.126739472150802612e-01,1.084190845489501953e+00 +-2.149126678705215454e-01,1.061164855957031250e+00 +-2.163244485855102539e-01,1.082310199737548828e+00 +-2.072485238313674927e-01,1.081779837608337402e+00 +-2.060866802930831909e-01,1.068128347396850586e+00 +-2.031614035367965698e-01,1.063081741333007812e+00 +-1.994420737028121948e-01,1.087440490722656250e+00 +-2.046215236186981201e-01,1.083337306976318359e+00 +-2.101049721240997314e-01,1.071282863616943359e+00 +-2.161883115768432617e-01,1.069317221641540527e+00 +-2.057091593742370605e-01,1.069509983062744141e+00 +-2.106851935386657715e-01,1.077860593795776367e+00 +-1.980383098125457764e-01,1.071046471595764160e+00 +-1.945239603519439697e-01,1.091577887535095215e+00 +-2.090086936950683594e-01,1.072982072830200195e+00 +-2.009851038455963135e-01,1.077872395515441895e+00 +-1.854831427335739136e-01,1.008196115493774414e+00 +-1.654570251703262329e-01,1.018875002861022949e+00 +-2.121291458606719971e-01,1.175671339035034180e+00 +-1.837521642446517944e-01,1.185593366622924805e+00 +-1.944370418787002563e-01,1.073340058326721191e+00 +-1.978336721658706665e-01,1.043239831924438477e+00 +-1.916855126619338989e-01,1.045876502990722656e+00 +-1.861427724361419678e-01,1.048074126243591309e+00 +-1.954767256975173950e-01,1.046391606330871582e+00 +-1.974119395017623901e-01,1.030340790748596191e+00 +-2.026146799325942993e-01,1.034811377525329590e+00 +-1.997056305408477783e-01,1.047666788101196289e+00 +-2.009107172489166260e-01,1.059810996055603027e+00 +-2.057144939899444580e-01,1.052866816520690918e+00 +-1.972069144248962402e-01,1.048317313194274902e+00 +-1.988994330167770386e-01,1.055314660072326660e+00 +-1.992465406656265259e-01,1.067765951156616211e+00 +-2.007853537797927856e-01,1.044358968734741211e+00 +-1.983946114778518677e-01,1.052633047103881836e+00 +-1.933227032423019409e-01,1.056407451629638672e+00 +-2.028331607580184937e-01,1.040400147438049316e+00 +-2.052883505821228027e-01,1.045460224151611328e+00 +-2.064621597528457642e-01,1.061243653297424316e+00 +-2.064504325389862061e-01,1.060743689537048340e+00 +-2.049445211887359619e-01,1.063907861709594727e+00 +-2.086257040500640869e-01,1.040966391563415527e+00 +-2.094084620475769043e-01,1.055038809776306152e+00 +-2.031542211771011353e-01,1.042692899703979492e+00 +-1.935019791126251221e-01,1.017814278602600098e+00 +-1.531656831502914429e-01,1.014465332031250000e+00 +-1.956162005662918091e-01,1.190629243850708008e+00 +-1.544154137372970581e-01,1.151822447776794434e+00 +-1.877938061952590942e-01,1.037922501564025879e+00 +-1.930921971797943115e-01,1.040934920310974121e+00 +-1.851036548614501953e-01,1.042582035064697266e+00 +2.961820125579833984e+00,4.141931533813476562e+00 +7.134841084480285645e-01,6.208178997039794922e-01 +-4.636158645153045654e-01,-5.507702827453613281e-01 +-7.655028104782104492e-01,-8.763421177864074707e-01 +-7.691375613212585449e-01,-8.897261023521423340e-01 +-7.255496382713317871e-01,-8.119906187057495117e-01 +-5.408914685249328613e-01,-7.124267220497131348e-01 +-3.040046989917755127e-01,-4.982781708240509033e-01 +-2.139288038015365601e-01,-4.633646011352539062e-01 +-1.566798239946365356e-01,-4.088748097419738770e-01 +-2.098718583583831787e-01,-4.186469018459320068e-01 +-2.371947169303894043e-01,-2.889790534973144531e-01 +-1.636405438184738159e-01,-2.067052125930786133e-01 +-1.520507484674453735e-01,-9.640473872423171997e-02 +-1.397857367992401123e-01,-6.915260851383209229e-02 +-1.241356804966926575e-01,-7.757026702165603638e-02 +-9.390990436077117920e-02,3.758250176906585693e-02 +-1.139274835586547852e-01,-7.731961458921432495e-02 +-2.132117450237274170e-01,-5.910732597112655640e-02 +-5.406882986426353455e-02,7.101114392280578613e-01 +-1.273942738771438599e-01,4.373150467872619629e-01 +-1.763027906417846680e-01,-1.473363190889358521e-01 +-1.289368420839309692e-01,2.640116028487682343e-02 +-4.740413650870323181e-02,1.677638441324234009e-01 +-6.105224788188934326e-02,4.930399730801582336e-02 +-7.573840022087097168e-02,-7.134862709790468216e-03 +-7.515952736139297485e-02,-1.195511501282453537e-02 +-4.817031696438789368e-02,-1.574482582509517670e-02 +-1.494206022471189499e-02,-1.072020037099719048e-03 +3.356693312525749207e-02,-1.960643753409385681e-02 +3.845546767115592957e-02,3.050466440618038177e-02 +5.172057449817657471e-02,3.736112639307975769e-02 +2.235867679119110107e-01,5.824106279760599136e-03 +2.345706969499588013e-01,-8.234073966741561890e-02 +2.502658069133758545e-01,-6.592391431331634521e-02 +2.096616774797439575e-01,-4.549517482519149780e-02 +1.951817125082015991e-01,-4.598626121878623962e-02 +1.647223085165023804e-01,-4.845062270760536194e-02 +9.140996634960174561e-02,-8.841546252369880676e-03 +5.268905311822891235e-02,-3.655241057276725769e-02 +-2.662389911711215973e-02,5.564356222748756409e-02 +-2.543167583644390106e-02,3.699579834938049316e-02 +-5.506427586078643799e-02,8.673383854329586029e-03 +-2.864123694598674774e-02,2.742844820022583008e-02 +-9.065335616469383240e-03,-8.825000375509262085e-03 +7.484535872936248779e-02,4.918664693832397461e-02 +2.992221713066101074e-02,-4.326717555522918701e-02 +-1.777672767639160156e-02,-2.636432275176048279e-02 +-6.068634614348411560e-02,-1.311195194721221924e-01 +-6.810632348060607910e-02,-1.480315029621124268e-01 +-6.702153384685516357e-02,-6.029232591390609741e-02 +-3.101871907711029053e-02,9.871453791856765747e-02 +7.115812040865421295e-03,6.374870240688323975e-02 +5.145920813083648682e-02,-3.132069408893585205e-01 +-1.375250816345214844e-01,-9.801705181598663330e-02 +-1.951642148196697235e-02,2.120808660984039307e-01 +1.817027851939201355e-02,1.008227020502090454e-01 +5.530827865004539490e-02,7.071786373853683472e-02 +7.697486877441406250e-02,9.678349643945693970e-02 +1.341220829635858536e-02,-1.541217352496460080e-04 +-1.439808774739503860e-02,2.249432262033224106e-03 +-3.092991001904010773e-02,9.346410632133483887e-03 diff --git a/real_robot/coordination_formation_control_pkg/results/experiment_13_working_with_integral_good_result/notes.txt b/real_robot/coordination_formation_control_pkg/results/experiment_13_working_with_integral_good_result/notes.txt new file mode 100644 index 0000000000000000000000000000000000000000..56f5bc9b9f73e67a8139c605ab26b6e331c43391 --- /dev/null +++ b/real_robot/coordination_formation_control_pkg/results/experiment_13_working_with_integral_good_result/notes.txt @@ -0,0 +1,61 @@ +# Uav +uav_c1_alpha: 0.20 +uav_c2_alpha: 0.3 # this is recomputed +uav_c1_beta: 0.3 +uav_c2_beta: 0.1 # this is recomputed +uav_c1_gamma: 0.25 +uav_c2_gamma: 0.2 +uav_c1_theta: 0.2 +uav_c1_delta: 0.05 + +# uav_c1_alpha: 0.035 +# uav_c2_alpha: 0.04 # this is recomputed +# uav_c1_beta: 0.04 +# uav_c2_beta: 0.02 # this is recomputed +# uav_c1_gamma: 0.02 +# uav_c2_gamma: 0.03 +# uav_c1_theta: 0.3 +# uav_c1_delta: 0.01 + +uav_d: 0.8 +uav_formation_t: 2 #/* type must be minimum 2, 3: tuangle formation, 4 suare, 5 pentagon*/ +uav_k: 7 +uav_ratio: 0.8 # /* ratio between dist inter and obstacle*/ +uav_eps: 0.1 +uav_a: 5 +uav_b: 5 +uav_h_alpha: 0.2 +uav_h_beta: 0.9 +uav_d_obs: 0 +uav_nav_type: 1 #/* convergence approach -1, parallel approach 2*/ +uav_integrator: 2 #/* single/ double integrator*/ +uav_dt: 0.01 #/* sample time*/ +uav_int_max: 0.01 #/* maximum integral*/ + +# ugv + +# Uav +ugv_c1_alpha: 0.2 +ugv_c2_alpha: 1 # this is recomputed +ugv_c1_beta: 0.3 +ugv_c2_beta: 1 # this is recomputed +ugv_c1_gamma: 0.25 +ugv_c2_gamma: 0.2 +ugv_c1_theta: 0.2 +ugv_c1_delta: 0.09 + + +ugv_d: 0.5 +ugv_formation_t: 2 #/* type must be minimum 2, 3: tuangle formation, 4 suare, 5 pentagon*/ +ugv_k: 7 +ugv_ratio: 0.8 # /* ratio between dist inter and obstacle*/ +ugv_eps: 0.1 +ugv_a: 5 +ugv_b: 5 +ugv_h_alpha: 0.2 +ugv_h_beta: 0.9 +ugv_d_obs: 0 +ugv_nav_type: 1 #/* convergence approach -1, parallel approach 2*/ +ugv_integrator: 1 #/* single/ double integrator*/ +ugv_dt: 0.02 #/* sample time*/ +ugv_int_max: 0.1 #/* maximum integral*/ diff --git a/real_robot/coordination_formation_control_pkg/results/t.csv b/real_robot/coordination_formation_control_pkg/results/t.csv new file mode 100644 index 0000000000000000000000000000000000000000..5dc184b1a09d7c0de04baa72757d5f7afa37379e --- /dev/null +++ b/real_robot/coordination_formation_control_pkg/results/t.csv @@ -0,0 +1,162 @@ +0.000000000000000000e+00 +2.017712593078613281e-02 +1.201667785644531250e-01 +2.201883792877197266e-01 +3.202633857727050781e-01 +4.201838970184326172e-01 +5.201370716094970703e-01 +6.203386783599853516e-01 +7.201554775238037109e-01 +8.201725482940673828e-01 +9.201653003692626953e-01 +1.020339012145996094e+00 +1.120172023773193359e+00 +1.220165729522705078e+00 +1.320181608200073242e+00 +1.420163869857788086e+00 +1.520101547241210938e+00 +1.620176315307617188e+00 +1.720177650451660156e+00 +1.820190429687500000e+00 +1.920169353485107422e+00 +2.020128726959228516e+00 +2.120168447494506836e+00 +2.220182657241821289e+00 +2.320175409317016602e+00 +2.420181274414062500e+00 +2.520184516906738281e+00 +2.620161056518554688e+00 +2.720051527023315430e+00 +2.820122003555297852e+00 +2.920165538787841797e+00 +3.020190954208374023e+00 +3.120182275772094727e+00 +3.220144271850585938e+00 +3.320196866989135742e+00 +3.420121431350708008e+00 +3.520190477371215820e+00 +3.620205163955688477e+00 +3.720179796218872070e+00 +3.820178747177124023e+00 +3.920155525207519531e+00 +4.020176410675048828e+00 +4.120189428329467773e+00 +4.220183372497558594e+00 +4.320180654525756836e+00 +4.420157909393310547e+00 +4.520182609558105469e+00 +4.620193481445312500e+00 +4.720357656478881836e+00 +4.820173263549804688e+00 +4.920166969299316406e+00 +5.020172595977783203e+00 +5.120168209075927734e+00 +5.220160961151123047e+00 +5.320180654525756836e+00 +5.420346260070800781e+00 +5.520300865173339844e+00 +5.620127677917480469e+00 +5.720083475112915039e+00 +5.820205926895141602e+00 +5.920132637023925781e+00 +6.020179271697998047e+00 +6.120128154754638672e+00 +6.220129966735839844e+00 +6.320342540740966797e+00 +6.420180559158325195e+00 +6.520165443420410156e+00 +6.620180130004882812e+00 +6.720172405242919922e+00 +6.820084095001220703e+00 +6.920169830322265625e+00 +7.020385265350341797e+00 +7.120336532592773438e+00 +7.220137357711791992e+00 +7.320183515548706055e+00 +7.420181751251220703e+00 +7.520203351974487305e+00 +7.620201826095581055e+00 +7.720236778259277344e+00 +7.820168495178222656e+00 +7.920166730880737305e+00 +8.020160198211669922e+00 +8.120171546936035156e+00 +8.220104932785034180e+00 +8.320231914520263672e+00 +8.420199632644653320e+00 +8.520165920257568359e+00 +8.620144367218017578e+00 +8.720156431198120117e+00 +8.820081233978271484e+00 +8.920199632644653320e+00 +9.020111083984375000e+00 +9.120227813720703125e+00 +9.220336914062500000e+00 +9.320299863815307617e+00 +9.420261144638061523e+00 +9.520393371582031250e+00 +9.620224714279174805e+00 +9.720311641693115234e+00 +9.820272445678710938e+00 +9.920220851898193359e+00 +1.002017378807067871e+01 +1.012022137641906738e+01 +1.022024059295654297e+01 +1.032019615173339844e+01 +1.042020583152770996e+01 +1.052023577690124512e+01 +1.062026548385620117e+01 +1.072021317481994629e+01 +1.082019448280334473e+01 +1.092017793655395508e+01 +1.102018022537231445e+01 +1.112021470069885254e+01 +1.122026205062866211e+01 +1.132023406028747559e+01 +1.142026686668395996e+01 +1.152027034759521484e+01 +1.162029170989990234e+01 +1.172039508819580078e+01 +1.182033872604370117e+01 +1.192040562629699707e+01 +1.202045941352844238e+01 +1.212041759490966797e+01 +1.222036099433898926e+01 +1.232043862342834473e+01 +1.242039442062377930e+01 +1.252053260803222656e+01 +1.262042212486267090e+01 +1.272045922279357910e+01 +1.282043433189392090e+01 +1.292042827606201172e+01 +1.302046203613281250e+01 +1.312050008773803711e+01 +1.322045826911926270e+01 +1.332044196128845215e+01 +1.342047023773193359e+01 +1.352046298980712891e+01 +1.362039995193481445e+01 +1.370055961608886719e+01 +1.382048392295837402e+01 +1.392047643661499023e+01 +1.400056672096252441e+01 +1.412042903900146484e+01 +1.422057557106018066e+01 +1.430061554908752441e+01 +1.442043352127075195e+01 +1.452045488357543945e+01 +1.460060262680053711e+01 +1.470056343078613281e+01 +1.482045388221740723e+01 +1.492044878005981445e+01 +1.502045464515686035e+01 +1.512045598030090332e+01 +1.522040033340454102e+01 +1.532046627998352051e+01 +1.542060041427612305e+01 +1.550062608718872070e+01 +1.560063362121582031e+01 +1.572043919563293457e+01 +1.582044076919555664e+01 +1.592043352127075195e+01 +1.602046060562133789e+01 diff --git a/real_robot/coordination_formation_control_pkg/results/vel.csv b/real_robot/coordination_formation_control_pkg/results/vel.csv new file mode 100644 index 0000000000000000000000000000000000000000..b196ade7705a3a63bcdaa9a61c0c580588ccf105 --- /dev/null +++ b/real_robot/coordination_formation_control_pkg/results/vel.csv @@ -0,0 +1,162 @@ +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-6.000000052154064178e-03,-9.999999776482582092e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-3.000000026077032089e-03,1.300000026822090149e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-6.000000052154064178e-03,1.300000026822090149e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-2.000000094994902611e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-3.000000026077032089e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-3.000000026077032089e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-3.000000026077032089e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-2.000000094994902611e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-2.000000094994902611e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-2.000000094994902611e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-2.000000094994902611e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-2.000000094994902611e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-2.000000094994902611e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-4.999999888241291046e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-4.999999888241291046e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-2.000000094994902611e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-2.000000094994902611e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-2.000000094994902611e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-2.000000094994902611e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-3.000000026077032089e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-2.000000094994902611e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-3.000000026077032089e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-2.000000094994902611e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-2.000000094994902611e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-2.000000094994902611e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-2.000000094994902611e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-3.000000026077032089e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-3.000000026077032089e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-8.999999612569808960e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-6.000000052154064178e-03,-1.200000010430812836e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-7.000000216066837311e-03,-1.400000043213367462e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-7.000000216066837311e-03,-1.799999922513961792e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-8.999999612569808960e-03,-2.099999971687793732e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-4.000000189989805222e-03,9.999999776482582092e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-6.000000052154064178e-03,4.999999888241291046e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-7.000000216066837311e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-8.000000379979610443e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-8.000000379979610443e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-8.000000379979610443e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-7.000000216066837311e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-8.000000379979610443e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-7.000000216066837311e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-7.000000216066837311e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-6.000000052154064178e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-7.000000216066837311e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-6.000000052154064178e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-6.000000052154064178e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-4.999999888241291046e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-2.000000094994902611e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-4.000000189989805222e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-1.000000047497451305e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-1.000000047497451305e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-2.000000094994902611e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-4.999999888241291046e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-4.999999888241291046e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-4.000000189989805222e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-2.000000094994902611e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-2.000000094994902611e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-4.999999888241291046e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-3.000000026077032089e-03,-1.099999994039535522e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-6.000000052154064178e-03,-1.099999994039535522e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,3.000000026077032089e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-3.000000026077032089e-03,1.300000026822090149e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,0.000000000000000000e+00 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-3.000000026077032089e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-6.000000052154064178e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-2.000000094994902611e-03,-4.999999888241291046e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-6.000000052154064178e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-2.000000094994902611e-03,-4.999999888241291046e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-4.000000189989805222e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-3.000000026077032089e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-2.000000094994902611e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-3.000000026077032089e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-3.000000026077032089e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-2.000000094994902611e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-4.999999888241291046e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-6.000000052154064178e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-4.999999888241291046e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-4.000000189989805222e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-4.999999888241291046e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-4.999999888241291046e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-4.999999888241291046e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-4.999999888241291046e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-4.999999888241291046e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-2.000000094994902611e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-6.000000052154064178e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-4.000000189989805222e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-3.000000026077032089e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-7.000000216066837311e-03,-1.200000010430812836e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,9.999999776482582092e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-4.999999888241291046e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-4.000000189989805222e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-3.000000026077032089e-03,1.999999955296516418e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-9.200000017881393433e-02,1.190000027418136597e-01 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.570000052452087402e-01,1.840000003576278687e-01 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.809999942779541016e-01,1.829999983310699463e-01 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.640000045299530029e-01,1.580000072717666626e-01 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.400000005960464478e-01,1.319999992847442627e-01 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.169999986886978149e-01,1.030000001192092896e-01 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.040000021457672119e-01,9.000000357627868652e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-9.399999678134918213e-02,7.999999821186065674e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-8.200000226497650146e-02,6.599999964237213135e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-7.800000160932540894e-02,6.400000303983688354e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-7.299999892711639404e-02,5.000000074505805969e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-7.000000029802322388e-02,5.200000107288360596e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-6.400000303983688354e-02,4.199999943375587463e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-6.199999898672103882e-02,4.899999871850013733e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-5.799999833106994629e-02,3.999999910593032837e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-5.400000140070915222e-02,4.100000113248825073e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-4.500000178813934326e-02,7.599999755620956421e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-4.500000178813934326e-02,7.100000232458114624e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-2.800000086426734924e-02,2.300000004470348358e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-4.199999943375587463e-02,1.049999967217445374e-01 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-3.700000047683715820e-02,1.129999980330467224e-01 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-2.099999971687793732e-02,6.100000068545341492e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-2.600000053644180298e-02,8.500000089406967163e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-2.500000037252902985e-02,8.699999749660491943e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-2.300000004470348358e-02,8.600000292062759399e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.899999938905239105e-02,8.299999684095382690e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.600000075995922089e-02,8.100000023841857910e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.600000075995922089e-02,8.100000023841857910e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.400000043213367462e-02,7.900000363588333130e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.400000043213367462e-02,7.800000160932540894e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.499999966472387314e-02,7.900000363588333130e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.499999966472387314e-02,7.999999821186065674e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.499999966472387314e-02,7.299999892711639404e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.799999922513961792e-02,7.400000095367431641e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-2.300000004470348358e-02,7.500000298023223877e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-3.200000151991844177e-02,8.299999684095382690e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-3.599999845027923584e-02,8.600000292062759399e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-3.700000047683715820e-02,7.900000363588333130e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-3.999999910593032837e-02,8.100000023841857910e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-4.399999976158142090e-02,9.300000220537185669e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-4.300000146031379700e-02,8.699999749660491943e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-4.300000146031379700e-02,9.000000357627868652e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-4.199999943375587463e-02,9.200000017881393433e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-4.199999943375587463e-02,1.019999980926513672e-01 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-4.100000113248825073e-02,9.499999880790710449e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-4.100000113248825073e-02,9.700000286102294922e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-4.399999976158142090e-02,1.040000021457672119e-01 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-4.300000146031379700e-02,9.600000083446502686e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-4.199999943375587463e-02,9.499999880790710449e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-4.199999943375587463e-02,1.010000035166740417e-01 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-4.199999943375587463e-02,1.000000014901161194e-01 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-3.599999845027923584e-02,1.220000013709068298e-01 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-3.900000080466270447e-02,1.239999979734420776e-01 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-4.300000146031379700e-02,1.230000033974647522e-01 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-3.900000080466270447e-02,6.499999761581420898e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-5.000000074505805969e-02,1.070000007748603821e-01 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-5.000000074505805969e-02,1.110000014305114746e-01 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-5.000000074505805969e-02,1.120000034570693970e-01 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-4.800000041723251343e-02,1.059999987483024597e-01 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-4.800000041723251343e-02,1.059999987483024597e-01 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-4.500000178813934326e-02,1.049999967217445374e-01 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-4.600000008940696716e-02,1.110000014305114746e-01 diff --git a/real_robot/coordination_formation_control_pkg/scripts/plot_results.py b/real_robot/coordination_formation_control_pkg/scripts/plot_results.py index 1c483ef842d557084a76c9be11169f9a67db9e0d..8860e399e350b6ccf51bd74cffa1d62e4a65177a 100644 --- a/real_robot/coordination_formation_control_pkg/scripts/plot_results.py +++ b/real_robot/coordination_formation_control_pkg/scripts/plot_results.py @@ -18,6 +18,7 @@ else: bag = rosbag.Bag(bag_name) topic_name = robot_name+"result" t_ = [] +t1_ = [] pose_data = [] vel_data = [] acc_data = [] @@ -54,6 +55,7 @@ for topics, msg, t in bag.read_messages(topics =[topic_name]): # ang_row_[ind*2] = msg.angle[ind].x # ang_row_[ind*2+1] = msg.angle[ind].y # ang_row_[ind*2+2] = msg.angle[ind].z + t1_.append(t.secs + t.nsecs*1e-9); # print(pose_row_) # print(pose_row_) @@ -80,6 +82,12 @@ for topics, msg, t in bag.read_messages(topics =[topic_name]): bag.close() t_np = np.array(t_) +t1_np = np.array(t1_) +t_np = t_np -t_np[0] +t1_np = t1_np -t1_np[0] + +print(np.array([t_np, t1_np])) + # remove the offset t_np = t_np -t_np[0] pose_data_np = np.array(pose_data); @@ -104,6 +112,13 @@ input_obstacle_data_np = np.array(input_obstacle_data); input_integration_data_np = np.array(input_integration_data); input_to_system_data_np = np.array(input_to_system_data); +# save data to csv for analysis*/ +# np.savetxt("../results/angle.csv",ang_data_np , delimiter=",") +# np.savetxt("../results/vel.csv",vel_data_np , delimiter=",") +# np.savetxt("../results/t.csv",t_np , delimiter=",") +# + + # Start plotting ####################### command vs centroid ################################### fig1, axs1 = plt.subplots(nrows=2, ncols=2, figsize=(7, 7)) diff --git a/real_robot/coordination_formation_control_pkg/src/drone_node.cpp b/real_robot/coordination_formation_control_pkg/src/drone_node.cpp index 48c26155526f2d450704026795d8f6a18d48431b..0d45050e0add5a5146299ace482435e26b2bd4e3 100644 --- a/real_robot/coordination_formation_control_pkg/src/drone_node.cpp +++ b/real_robot/coordination_formation_control_pkg/src/drone_node.cpp @@ -24,6 +24,8 @@ std::stringstream ss_log_naming; rosbag::Bag bag; std::string robot_name; bool enable_log; +bool compute_offset = true; +float roll_offset = 0, pitch_offset = 0; bool waypoint_received = false; @@ -198,7 +200,7 @@ int main(int argc, char **argv) { ss_log_naming << log_data_name << "_crazyflie_" << std::to_string(robotid) << "_logdata.bag"; // bag_ptr = new rosbag::bag(); - ros::Timer writeTobagfileTimer = nh.createTimer(ros::Duration(1.0/10.0), logCallback); + ros::Timer writeTobagfileTimer = nh.createTimer(ros::Duration(1.0/hz_freq), logCallback); if(enable_log) { @@ -259,13 +261,20 @@ int main(int argc, char **argv) { uav_state_o(2, i-1) = current_state.o(2); } + if (compute_offset) + { + /*todo*/ + roll_offset = uav_state_o(0, robotid-1); + pitch_offset = uav_state_o(1, robotid-1); + } // std::cout << uav_state_q << std::endl; if(coord_config->initialize_robot && coord_config->init_formation ==false && coord_config->stop_demo == false) { // send the robot to hover at zero velocity in plane // std::cout << "Here" << std::endl; - current_command.roll = 0; - current_command.pitch = 0; + compute_offset = false; + current_command.roll = 0 + roll_offset; + current_command.pitch = 0 + pitch_offset; current_command.yawrate = 0; current_command.zDistance = 0.5; vel_cmd_publisher.publish(current_command); diff --git a/simulation/angle.csv b/simulation/angle.csv new file mode 100644 index 0000000000000000000000000000000000000000..447f77aca0b975f898411d6650e1747ba9544c98 --- /dev/null +++ b/simulation/angle.csv @@ -0,0 +1,162 @@ +0.000000000000000000e+00,0.000000000000000000e+00 +-1.624186933040618896e-01,1.027282476425170898e+00 +-2.114833444356918335e-01,1.167885065078735352e+00 +-1.811449229717254639e-01,1.216748714447021484e+00 +-2.198748737573623657e-01,1.066293478012084961e+00 +-2.205687612295150757e-01,1.058767676353454590e+00 +-2.196720987558364868e-01,1.063477754592895508e+00 +-2.224885821342468262e-01,1.050099968910217285e+00 +-2.163585275411605835e-01,1.075332880020141602e+00 +-2.197116017341613770e-01,1.081187129020690918e+00 +-2.131524831056594849e-01,1.065727353096008301e+00 +-2.134290188550949097e-01,1.085066676139831543e+00 +-2.142369747161865234e-01,1.086621165275573730e+00 +-2.110711485147476196e-01,1.063112497329711914e+00 +-2.096409797668457031e-01,1.078520536422729492e+00 +-2.070798426866531372e-01,1.066942095756530762e+00 +-2.130766659975051880e-01,1.064068078994750977e+00 +-2.099575102329254150e-01,1.065781712532043457e+00 +-2.085962742567062378e-01,1.068991184234619141e+00 +-2.020037770271301270e-01,1.071776747703552246e+00 +-2.024561166763305664e-01,1.068706989288330078e+00 +-2.066778242588043213e-01,1.069287419319152832e+00 +-1.984831392765045166e-01,1.063418626785278320e+00 +-1.956074684858322144e-01,1.043921709060668945e+00 +-1.907450407743453979e-01,1.069079875946044922e+00 +-1.987958401441574097e-01,1.044007062911987305e+00 +-2.004132866859436035e-01,1.052876591682434082e+00 +-2.009772360324859619e-01,1.070895910263061523e+00 +-2.058069109916687012e-01,1.066816926002502441e+00 +-2.119364142417907715e-01,1.044474601745605469e+00 +-2.041852325201034546e-01,1.050229430198669434e+00 +-2.069534659385681152e-01,1.070442199707031250e+00 +-1.675197482109069824e-01,9.976004958152770996e-01 +-1.733607500791549683e-01,9.982299804687500000e-01 +-1.768017113208770752e-01,9.918226003646850586e-01 +-1.782060861587524414e-01,9.786713123321533203e-01 +-1.923603713512420654e-01,1.160884499549865723e+00 +-2.168278396129608154e-01,1.044409990310668945e+00 +-2.290111333131790161e-01,1.012012362480163574e+00 +-2.218666374683380127e-01,1.008954048156738281e+00 +-2.206018716096878052e-01,1.039815306663513184e+00 +-2.206018716096878052e-01,1.039815306663513184e+00 +-2.163348197937011719e-01,1.044031262397766113e+00 +-2.132236659526824951e-01,1.031984686851501465e+00 +-2.096954435110092163e-01,1.038158774375915527e+00 +-2.063728272914886475e-01,1.062424540519714355e+00 +-2.071557641029357910e-01,1.047261238098144531e+00 +-2.120216339826583862e-01,1.055302381515502930e+00 +-2.117087393999099731e-01,1.079220533370971680e+00 +-2.126739472150802612e-01,1.084190845489501953e+00 +-2.149126678705215454e-01,1.061164855957031250e+00 +-2.163244485855102539e-01,1.082310199737548828e+00 +-2.072485238313674927e-01,1.081779837608337402e+00 +-2.060866802930831909e-01,1.068128347396850586e+00 +-2.031614035367965698e-01,1.063081741333007812e+00 +-1.994420737028121948e-01,1.087440490722656250e+00 +-2.046215236186981201e-01,1.083337306976318359e+00 +-2.101049721240997314e-01,1.071282863616943359e+00 +-2.161883115768432617e-01,1.069317221641540527e+00 +-2.057091593742370605e-01,1.069509983062744141e+00 +-2.106851935386657715e-01,1.077860593795776367e+00 +-1.980383098125457764e-01,1.071046471595764160e+00 +-1.945239603519439697e-01,1.091577887535095215e+00 +-2.090086936950683594e-01,1.072982072830200195e+00 +-2.009851038455963135e-01,1.077872395515441895e+00 +-1.854831427335739136e-01,1.008196115493774414e+00 +-1.654570251703262329e-01,1.018875002861022949e+00 +-2.121291458606719971e-01,1.175671339035034180e+00 +-1.837521642446517944e-01,1.185593366622924805e+00 +-1.944370418787002563e-01,1.073340058326721191e+00 +-1.978336721658706665e-01,1.043239831924438477e+00 +-1.916855126619338989e-01,1.045876502990722656e+00 +-1.861427724361419678e-01,1.048074126243591309e+00 +-1.954767256975173950e-01,1.046391606330871582e+00 +-1.974119395017623901e-01,1.030340790748596191e+00 +-2.026146799325942993e-01,1.034811377525329590e+00 +-1.997056305408477783e-01,1.047666788101196289e+00 +-2.009107172489166260e-01,1.059810996055603027e+00 +-2.057144939899444580e-01,1.052866816520690918e+00 +-1.972069144248962402e-01,1.048317313194274902e+00 +-1.988994330167770386e-01,1.055314660072326660e+00 +-1.992465406656265259e-01,1.067765951156616211e+00 +-2.007853537797927856e-01,1.044358968734741211e+00 +-1.983946114778518677e-01,1.052633047103881836e+00 +-1.933227032423019409e-01,1.056407451629638672e+00 +-2.028331607580184937e-01,1.040400147438049316e+00 +-2.052883505821228027e-01,1.045460224151611328e+00 +-2.064621597528457642e-01,1.061243653297424316e+00 +-2.064504325389862061e-01,1.060743689537048340e+00 +-2.049445211887359619e-01,1.063907861709594727e+00 +-2.086257040500640869e-01,1.040966391563415527e+00 +-2.094084620475769043e-01,1.055038809776306152e+00 +-2.031542211771011353e-01,1.042692899703979492e+00 +-1.935019791126251221e-01,1.017814278602600098e+00 +-1.531656831502914429e-01,1.014465332031250000e+00 +-1.956162005662918091e-01,1.190629243850708008e+00 +-1.544154137372970581e-01,1.151822447776794434e+00 +-1.877938061952590942e-01,1.037922501564025879e+00 +-1.930921971797943115e-01,1.040934920310974121e+00 +-1.851036548614501953e-01,1.042582035064697266e+00 +2.961820125579833984e+00,4.141931533813476562e+00 +7.134841084480285645e-01,6.208178997039794922e-01 +-4.636158645153045654e-01,-5.507702827453613281e-01 +-7.655028104782104492e-01,-8.763421177864074707e-01 +-7.691375613212585449e-01,-8.897261023521423340e-01 +-7.255496382713317871e-01,-8.119906187057495117e-01 +-5.408914685249328613e-01,-7.124267220497131348e-01 +-3.040046989917755127e-01,-4.982781708240509033e-01 +-2.139288038015365601e-01,-4.633646011352539062e-01 +-1.566798239946365356e-01,-4.088748097419738770e-01 +-2.098718583583831787e-01,-4.186469018459320068e-01 +-2.371947169303894043e-01,-2.889790534973144531e-01 +-1.636405438184738159e-01,-2.067052125930786133e-01 +-1.520507484674453735e-01,-9.640473872423171997e-02 +-1.397857367992401123e-01,-6.915260851383209229e-02 +-1.241356804966926575e-01,-7.757026702165603638e-02 +-9.390990436077117920e-02,3.758250176906585693e-02 +-1.139274835586547852e-01,-7.731961458921432495e-02 +-2.132117450237274170e-01,-5.910732597112655640e-02 +-5.406882986426353455e-02,7.101114392280578613e-01 +-1.273942738771438599e-01,4.373150467872619629e-01 +-1.763027906417846680e-01,-1.473363190889358521e-01 +-1.289368420839309692e-01,2.640116028487682343e-02 +-4.740413650870323181e-02,1.677638441324234009e-01 +-6.105224788188934326e-02,4.930399730801582336e-02 +-7.573840022087097168e-02,-7.134862709790468216e-03 +-7.515952736139297485e-02,-1.195511501282453537e-02 +-4.817031696438789368e-02,-1.574482582509517670e-02 +-1.494206022471189499e-02,-1.072020037099719048e-03 +3.356693312525749207e-02,-1.960643753409385681e-02 +3.845546767115592957e-02,3.050466440618038177e-02 +5.172057449817657471e-02,3.736112639307975769e-02 +2.235867679119110107e-01,5.824106279760599136e-03 +2.345706969499588013e-01,-8.234073966741561890e-02 +2.502658069133758545e-01,-6.592391431331634521e-02 +2.096616774797439575e-01,-4.549517482519149780e-02 +1.951817125082015991e-01,-4.598626121878623962e-02 +1.647223085165023804e-01,-4.845062270760536194e-02 +9.140996634960174561e-02,-8.841546252369880676e-03 +5.268905311822891235e-02,-3.655241057276725769e-02 +-2.662389911711215973e-02,5.564356222748756409e-02 +-2.543167583644390106e-02,3.699579834938049316e-02 +-5.506427586078643799e-02,8.673383854329586029e-03 +-2.864123694598674774e-02,2.742844820022583008e-02 +-9.065335616469383240e-03,-8.825000375509262085e-03 +7.484535872936248779e-02,4.918664693832397461e-02 +2.992221713066101074e-02,-4.326717555522918701e-02 +-1.777672767639160156e-02,-2.636432275176048279e-02 +-6.068634614348411560e-02,-1.311195194721221924e-01 +-6.810632348060607910e-02,-1.480315029621124268e-01 +-6.702153384685516357e-02,-6.029232591390609741e-02 +-3.101871907711029053e-02,9.871453791856765747e-02 +7.115812040865421295e-03,6.374870240688323975e-02 +5.145920813083648682e-02,-3.132069408893585205e-01 +-1.375250816345214844e-01,-9.801705181598663330e-02 +-1.951642148196697235e-02,2.120808660984039307e-01 +1.817027851939201355e-02,1.008227020502090454e-01 +5.530827865004539490e-02,7.071786373853683472e-02 +7.697486877441406250e-02,9.678349643945693970e-02 +1.341220829635858536e-02,-1.541217352496460080e-04 +-1.439808774739503860e-02,2.249432262033224106e-03 +-3.092991001904010773e-02,9.346410632133483887e-03 diff --git a/simulation/low_passfilter.asv b/simulation/low_passfilter.asv new file mode 100644 index 0000000000000000000000000000000000000000..dfb133ade6e4edeef845acdb645f48f5171097ef --- /dev/null +++ b/simulation/low_passfilter.asv @@ -0,0 +1,28 @@ +N = 100; % FIR filter order +Fp = 20e3; % 20 kHz passband-edge frequency +Fs = 96e3; % 96 kHz sampling frequency +Rp = 0.00057565; % Corresponds to 0.01 dB peak-to-peak ripple +Rst = 1e-4; % Corresponds to 80 dB stopband attenuation + +tic +% +% lowpassFilt = dsp.LowpassFilter('DesignForMinimumOrder',false, ... +% 'FilterOrder',N,'PassbandFrequency',Fp,'SampleRate',Fs,... +% 'PassbandRipple',0.01, 'StopbandAttenuation',80); +tic + +% import csv +Ta = table2array(readtable('angle.csv')); +Tt = table2array(readtable('t.csv')); +Ts = mean(Tt(2:end,1)-Tt(1:end-1,1)); +scope = spectrumAnalyzer('SampleRate',1/Ts,'AveragingMethod','exponential','ForgettingFactor',0.5); +show(scope); + + scope(x); + +% +% while toc < 10 +% x = randn(256,1); +% % y = lowpassFilt(x); +% scope(x); +% end \ No newline at end of file diff --git a/simulation/low_passfilter.m b/simulation/low_passfilter.m new file mode 100644 index 0000000000000000000000000000000000000000..2e5dc06b34e21ec8ca16cea859484d2efaf90ba4 --- /dev/null +++ b/simulation/low_passfilter.m @@ -0,0 +1,28 @@ +N = 100; % FIR filter order +Fp = 20e3; % 20 kHz passband-edge frequency +Fs = 96e3; % 96 kHz sampling frequency +Rp = 0.00057565; % Corresponds to 0.01 dB peak-to-peak ripple +Rst = 1e-4; % Corresponds to 80 dB stopband attenuation + +tic +% +% lowpassFilt = dsp.LowpassFilter('DesignForMinimumOrder',false, ... +% 'FilterOrder',N,'PassbandFrequency',Fp,'SampleRate',Fs,... +% 'PassbandRipple',0.01, 'StopbandAttenuation',80); +tic + +% import csv +Ta = table2array(readtable('angle.csv')); +Tt = table2array(readtable('t.csv')); +Ts = mean(Tt(2:end,1)-Tt(1:end-1,1)); +scope = spectrumAnalyzer('SampleRate',1/Ts,'AveragingMethod','exponential','ForgettingFactor',0.5); +show(scope); + +scope(Ta(:,1)); + +% +% while toc < 10 +% x = randn(256,1); +% % y = lowpassFilt(x); +% scope(x); +% end \ No newline at end of file diff --git a/simulation/t.csv b/simulation/t.csv new file mode 100644 index 0000000000000000000000000000000000000000..5dc184b1a09d7c0de04baa72757d5f7afa37379e --- /dev/null +++ b/simulation/t.csv @@ -0,0 +1,162 @@ +0.000000000000000000e+00 +2.017712593078613281e-02 +1.201667785644531250e-01 +2.201883792877197266e-01 +3.202633857727050781e-01 +4.201838970184326172e-01 +5.201370716094970703e-01 +6.203386783599853516e-01 +7.201554775238037109e-01 +8.201725482940673828e-01 +9.201653003692626953e-01 +1.020339012145996094e+00 +1.120172023773193359e+00 +1.220165729522705078e+00 +1.320181608200073242e+00 +1.420163869857788086e+00 +1.520101547241210938e+00 +1.620176315307617188e+00 +1.720177650451660156e+00 +1.820190429687500000e+00 +1.920169353485107422e+00 +2.020128726959228516e+00 +2.120168447494506836e+00 +2.220182657241821289e+00 +2.320175409317016602e+00 +2.420181274414062500e+00 +2.520184516906738281e+00 +2.620161056518554688e+00 +2.720051527023315430e+00 +2.820122003555297852e+00 +2.920165538787841797e+00 +3.020190954208374023e+00 +3.120182275772094727e+00 +3.220144271850585938e+00 +3.320196866989135742e+00 +3.420121431350708008e+00 +3.520190477371215820e+00 +3.620205163955688477e+00 +3.720179796218872070e+00 +3.820178747177124023e+00 +3.920155525207519531e+00 +4.020176410675048828e+00 +4.120189428329467773e+00 +4.220183372497558594e+00 +4.320180654525756836e+00 +4.420157909393310547e+00 +4.520182609558105469e+00 +4.620193481445312500e+00 +4.720357656478881836e+00 +4.820173263549804688e+00 +4.920166969299316406e+00 +5.020172595977783203e+00 +5.120168209075927734e+00 +5.220160961151123047e+00 +5.320180654525756836e+00 +5.420346260070800781e+00 +5.520300865173339844e+00 +5.620127677917480469e+00 +5.720083475112915039e+00 +5.820205926895141602e+00 +5.920132637023925781e+00 +6.020179271697998047e+00 +6.120128154754638672e+00 +6.220129966735839844e+00 +6.320342540740966797e+00 +6.420180559158325195e+00 +6.520165443420410156e+00 +6.620180130004882812e+00 +6.720172405242919922e+00 +6.820084095001220703e+00 +6.920169830322265625e+00 +7.020385265350341797e+00 +7.120336532592773438e+00 +7.220137357711791992e+00 +7.320183515548706055e+00 +7.420181751251220703e+00 +7.520203351974487305e+00 +7.620201826095581055e+00 +7.720236778259277344e+00 +7.820168495178222656e+00 +7.920166730880737305e+00 +8.020160198211669922e+00 +8.120171546936035156e+00 +8.220104932785034180e+00 +8.320231914520263672e+00 +8.420199632644653320e+00 +8.520165920257568359e+00 +8.620144367218017578e+00 +8.720156431198120117e+00 +8.820081233978271484e+00 +8.920199632644653320e+00 +9.020111083984375000e+00 +9.120227813720703125e+00 +9.220336914062500000e+00 +9.320299863815307617e+00 +9.420261144638061523e+00 +9.520393371582031250e+00 +9.620224714279174805e+00 +9.720311641693115234e+00 +9.820272445678710938e+00 +9.920220851898193359e+00 +1.002017378807067871e+01 +1.012022137641906738e+01 +1.022024059295654297e+01 +1.032019615173339844e+01 +1.042020583152770996e+01 +1.052023577690124512e+01 +1.062026548385620117e+01 +1.072021317481994629e+01 +1.082019448280334473e+01 +1.092017793655395508e+01 +1.102018022537231445e+01 +1.112021470069885254e+01 +1.122026205062866211e+01 +1.132023406028747559e+01 +1.142026686668395996e+01 +1.152027034759521484e+01 +1.162029170989990234e+01 +1.172039508819580078e+01 +1.182033872604370117e+01 +1.192040562629699707e+01 +1.202045941352844238e+01 +1.212041759490966797e+01 +1.222036099433898926e+01 +1.232043862342834473e+01 +1.242039442062377930e+01 +1.252053260803222656e+01 +1.262042212486267090e+01 +1.272045922279357910e+01 +1.282043433189392090e+01 +1.292042827606201172e+01 +1.302046203613281250e+01 +1.312050008773803711e+01 +1.322045826911926270e+01 +1.332044196128845215e+01 +1.342047023773193359e+01 +1.352046298980712891e+01 +1.362039995193481445e+01 +1.370055961608886719e+01 +1.382048392295837402e+01 +1.392047643661499023e+01 +1.400056672096252441e+01 +1.412042903900146484e+01 +1.422057557106018066e+01 +1.430061554908752441e+01 +1.442043352127075195e+01 +1.452045488357543945e+01 +1.460060262680053711e+01 +1.470056343078613281e+01 +1.482045388221740723e+01 +1.492044878005981445e+01 +1.502045464515686035e+01 +1.512045598030090332e+01 +1.522040033340454102e+01 +1.532046627998352051e+01 +1.542060041427612305e+01 +1.550062608718872070e+01 +1.560063362121582031e+01 +1.572043919563293457e+01 +1.582044076919555664e+01 +1.592043352127075195e+01 +1.602046060562133789e+01 diff --git a/simulation/vel.csv b/simulation/vel.csv new file mode 100644 index 0000000000000000000000000000000000000000..b196ade7705a3a63bcdaa9a61c0c580588ccf105 --- /dev/null +++ b/simulation/vel.csv @@ -0,0 +1,162 @@ +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-6.000000052154064178e-03,-9.999999776482582092e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-3.000000026077032089e-03,1.300000026822090149e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-6.000000052154064178e-03,1.300000026822090149e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-2.000000094994902611e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-3.000000026077032089e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-3.000000026077032089e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-3.000000026077032089e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-2.000000094994902611e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-2.000000094994902611e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-2.000000094994902611e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-2.000000094994902611e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-2.000000094994902611e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-2.000000094994902611e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-4.999999888241291046e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-4.999999888241291046e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-2.000000094994902611e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-2.000000094994902611e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-2.000000094994902611e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-2.000000094994902611e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-3.000000026077032089e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-2.000000094994902611e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-3.000000026077032089e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-2.000000094994902611e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-2.000000094994902611e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-2.000000094994902611e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-2.000000094994902611e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-3.000000026077032089e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-3.000000026077032089e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-8.999999612569808960e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-6.000000052154064178e-03,-1.200000010430812836e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-7.000000216066837311e-03,-1.400000043213367462e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-7.000000216066837311e-03,-1.799999922513961792e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-8.999999612569808960e-03,-2.099999971687793732e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-4.000000189989805222e-03,9.999999776482582092e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-6.000000052154064178e-03,4.999999888241291046e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-7.000000216066837311e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-8.000000379979610443e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-8.000000379979610443e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-8.000000379979610443e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-7.000000216066837311e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-8.000000379979610443e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-7.000000216066837311e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-7.000000216066837311e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-6.000000052154064178e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-7.000000216066837311e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-6.000000052154064178e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-6.000000052154064178e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-4.999999888241291046e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-2.000000094994902611e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-4.000000189989805222e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-1.000000047497451305e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-1.000000047497451305e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-2.000000094994902611e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-4.999999888241291046e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-4.999999888241291046e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-4.000000189989805222e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-2.000000094994902611e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-2.000000094994902611e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-4.999999888241291046e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-3.000000026077032089e-03,-1.099999994039535522e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-6.000000052154064178e-03,-1.099999994039535522e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,3.000000026077032089e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-3.000000026077032089e-03,1.300000026822090149e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,0.000000000000000000e+00 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-3.000000026077032089e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-6.000000052154064178e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-2.000000094994902611e-03,-4.999999888241291046e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-6.000000052154064178e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-2.000000094994902611e-03,-4.999999888241291046e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-4.000000189989805222e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-3.000000026077032089e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-2.000000094994902611e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-3.000000026077032089e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-3.000000026077032089e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-2.000000094994902611e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-4.999999888241291046e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-6.000000052154064178e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-4.999999888241291046e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-4.000000189989805222e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-4.999999888241291046e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-4.999999888241291046e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-4.999999888241291046e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-4.999999888241291046e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-4.999999888241291046e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-2.000000094994902611e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-6.000000052154064178e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-4.000000189989805222e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,-3.000000026077032089e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-7.000000216066837311e-03,-1.200000010430812836e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,9.999999776482582092e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00,0.000000000000000000e+00 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-4.999999888241291046e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.000000047497451305e-03,-4.000000189989805222e-03 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-3.000000026077032089e-03,1.999999955296516418e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-9.200000017881393433e-02,1.190000027418136597e-01 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.570000052452087402e-01,1.840000003576278687e-01 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.809999942779541016e-01,1.829999983310699463e-01 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.640000045299530029e-01,1.580000072717666626e-01 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.400000005960464478e-01,1.319999992847442627e-01 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.169999986886978149e-01,1.030000001192092896e-01 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.040000021457672119e-01,9.000000357627868652e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-9.399999678134918213e-02,7.999999821186065674e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-8.200000226497650146e-02,6.599999964237213135e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-7.800000160932540894e-02,6.400000303983688354e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-7.299999892711639404e-02,5.000000074505805969e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-7.000000029802322388e-02,5.200000107288360596e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-6.400000303983688354e-02,4.199999943375587463e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-6.199999898672103882e-02,4.899999871850013733e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-5.799999833106994629e-02,3.999999910593032837e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-5.400000140070915222e-02,4.100000113248825073e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-4.500000178813934326e-02,7.599999755620956421e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-4.500000178813934326e-02,7.100000232458114624e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-2.800000086426734924e-02,2.300000004470348358e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-4.199999943375587463e-02,1.049999967217445374e-01 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-3.700000047683715820e-02,1.129999980330467224e-01 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-2.099999971687793732e-02,6.100000068545341492e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-2.600000053644180298e-02,8.500000089406967163e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-2.500000037252902985e-02,8.699999749660491943e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-2.300000004470348358e-02,8.600000292062759399e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.899999938905239105e-02,8.299999684095382690e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.600000075995922089e-02,8.100000023841857910e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.600000075995922089e-02,8.100000023841857910e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.400000043213367462e-02,7.900000363588333130e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.400000043213367462e-02,7.800000160932540894e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.499999966472387314e-02,7.900000363588333130e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.499999966472387314e-02,7.999999821186065674e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.499999966472387314e-02,7.299999892711639404e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-1.799999922513961792e-02,7.400000095367431641e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-2.300000004470348358e-02,7.500000298023223877e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-3.200000151991844177e-02,8.299999684095382690e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-3.599999845027923584e-02,8.600000292062759399e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-3.700000047683715820e-02,7.900000363588333130e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-3.999999910593032837e-02,8.100000023841857910e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-4.399999976158142090e-02,9.300000220537185669e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-4.300000146031379700e-02,8.699999749660491943e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-4.300000146031379700e-02,9.000000357627868652e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-4.199999943375587463e-02,9.200000017881393433e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-4.199999943375587463e-02,1.019999980926513672e-01 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-4.100000113248825073e-02,9.499999880790710449e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-4.100000113248825073e-02,9.700000286102294922e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-4.399999976158142090e-02,1.040000021457672119e-01 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-4.300000146031379700e-02,9.600000083446502686e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-4.199999943375587463e-02,9.499999880790710449e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-4.199999943375587463e-02,1.010000035166740417e-01 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-4.199999943375587463e-02,1.000000014901161194e-01 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-3.599999845027923584e-02,1.220000013709068298e-01 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-3.900000080466270447e-02,1.239999979734420776e-01 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-4.300000146031379700e-02,1.230000033974647522e-01 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-3.900000080466270447e-02,6.499999761581420898e-02 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-5.000000074505805969e-02,1.070000007748603821e-01 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-5.000000074505805969e-02,1.110000014305114746e-01 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-5.000000074505805969e-02,1.120000034570693970e-01 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-4.800000041723251343e-02,1.059999987483024597e-01 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-4.800000041723251343e-02,1.059999987483024597e-01 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-4.500000178813934326e-02,1.049999967217445374e-01 +0.000000000000000000e+00,8.456797831697401549e-19,0.000000000000000000e+00,0.000000000000000000e+00,-4.600000008940696716e-02,1.110000014305114746e-01