Use header frame instead of world_frame for goal