add some functions for gazebo support