Vehicles now correctly receive vel_cmds from ROS