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 169941d6df118e3a2278d0595d025bd085ecc95f..38428aa1887c32423e8085ec318671949044d72a 100644
--- a/real_robot/coordination_formation_control_pkg/src/drone_node.cpp
+++ b/real_robot/coordination_formation_control_pkg/src/drone_node.cpp
@@ -289,7 +289,7 @@ int main(int argc, char **argv) {
       current_command.vy = 0;
       current_command.yawrate = 0;
       current_command.zDistance = 0.5;
-      // vel_cmd_publisher.publish(current_command);
+      vel_cmd_publisher.publish(current_command);
 
 
     }
@@ -410,7 +410,7 @@ int main(int argc, char **argv) {
       // std::cout << "vy: transformed: " << vxl << "vy transformed: " << vyl << std::endl;
 
 
-      // vel_cmd_publisher.publish(current_command);
+      vel_cmd_publisher.publish(current_command);
 
     }
 
diff --git a/real_robot/coordination_formation_control_pkg/src/omniwheel_node.cpp b/real_robot/coordination_formation_control_pkg/src/omniwheel_node.cpp
index ed28944cb64c6b0596b179e9f0f253bebc781fb5..d9179d85b81a89e58fb6e839b1e0cff1c42d2fc2 100644
--- a/real_robot/coordination_formation_control_pkg/src/omniwheel_node.cpp
+++ b/real_robot/coordination_formation_control_pkg/src/omniwheel_node.cpp
@@ -315,7 +315,7 @@ int main(int argc, char **argv) {
 
 
       }
-      // vel_cmd_publisher.publish(current_command);
+      vel_cmd_publisher.publish(current_command);
 
     }
     if(coord_config->stop_demo)