fixed issue with centroid computation

...ination_formation_control_pkg/config/formationConfig.yaml

...nt_6_formation_3_uav_2_ugv/result_crazyflie_1_logdata.bag

...nt_6_formation_3_uav_2_ugv/result_crazyflie_2_logdata.bag

...nt_6_formation_3_uav_2_ugv/result_crazyflie_3_logdata.bag

...nt_6_formation_3_uav_2_ugv/result_omniwheel_1_logdata.bag

...nt_6_formation_3_uav_2_ugv/result_omniwheel_2_logdata.bag

...tion_control_pkg/scripts/plot_real_experiment_pgf_plot.py

...dination_formation_control_pkg/src/mission_controller.cpp