fixed plot problem

...ination_formation_control_pkg/include/swamControllerAlg.h

...riment_1_trianglular_no_formation_crazyflie_1_logdata.bag

...riment_1_trianglular_no_formation_crazyflie_2_logdata.bag

...riment_1_trianglular_no_formation_crazyflie_3_logdata.bag

...oordination_formation_control_pkg/scripts/plot_results.py

...bot/coordination_formation_control_pkg/src/drone_node.cpp

...coordination_formation_control_pkg/src/omniwheel_node.cpp

...rdination_formation_control_pkg/src/swamControllerAlg.cpp