ugv code not finished

real_robot/coordination_formation_control_pkg/CMakeLists.txt

...ination_formation_control_pkg/config/formationConfig.yaml

...rdination_formation_control_pkg/config/missionConfig.yaml

.../coordination_formation_control_pkg/include/integration.h

...nation_formation_control_pkg/include/shared_definitions.h

...ination_formation_control_pkg/include/swamControllerAlg.h

...on_formation_control_pkg/launch/mission_controller.launch

...robot/coordination_formation_control_pkg/msg/waypoint.msg

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

...coordination_formation_control_pkg/src/omniwheel_node.cpp

...rdination_formation_control_pkg/src/swamControllerAlg.cpp

simulation/controller/SwamControllerAlg.m