diff --git a/gz_ros2_control/src/gz_system.cpp b/gz_ros2_control/src/gz_system.cpp index 5c9952b..41e9c1e 100644 --- a/gz_ros2_control/src/gz_system.cpp +++ b/gz_ros2_control/src/gz_system.cpp @@ -654,7 +654,7 @@ hardware_interface::return_type GazeboSimSystem::write( { this->dataPtr->ecm->CreateComponent( this->dataPtr->joints_[i].sim_joint, - sim::components::JointVelocityCmd({0})); + sim::components::JointVelocityCmd({this->dataPtr->joints_[i].joint_velocity_cmd})); } else { const auto jointVelCmd = this->dataPtr->ecm->Component(