should be mocap but will use gazebo since it is still sim <-->