Python at_pose示例

示例#1

文件： move_tasks.py 项目： pep8speaks/robosub-ros

 def _on_task_run(self):
     self.publish_desired_pose_global(self.transformed_pose)
     if task_utils.at_pose(self.transformed_pose, self.state.pose.pose):
         self.finish()

示例#2

 def _on_task_run(self):
     self.publish_desired_pose_global(self.transformed_pose)
     at_desired_pose = task_utils.at_pose(self.state.pose.pose, self.transformed_pose)
     at_desired_vel = task_utils.at_vel(self.state.twist.twist, self.desired_twist)
     if at_desired_pose and at_desired_vel:
         self.finish()