本文整理汇总了Python中moveit_commander.RobotCommander.get_current_variable_values方法的典型用法代码示例。如果您正苦于以下问题:Python RobotCommander.get_current_variable_values方法的具体用法?Python RobotCommander.get_current_variable_values怎么用?Python RobotCommander.get_current_variable_values使用的例子?那么恭喜您, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在类moveit_commander.RobotCommander
的用法示例。
在下文中一共展示了RobotCommander.get_current_variable_values方法的1个代码示例,这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞,您的评价将有助于系统推荐出更棒的Python代码示例。
示例1: RobotCommander
# 需要导入模块: from moveit_commander import RobotCommander [as 别名]
# 或者: from moveit_commander.RobotCommander import get_current_variable_values [as 别名]
robot = RobotCommander()
pose = PoseStamped()
rospy.sleep(1)
# clean the scene
scene.remove_world_object("grasp_point")
scene.remove_world_object("right_shoe")
# move_group
group_right = MoveGroupCommander("r_arm")
group_left = MoveGroupCommander("l_arm")
#Get Current state
state = robot.get_current_variable_values()
# Link off contact
links_off=[]
links_off.append("r_thumb1")
links_off.append("r_thumb2")
links_off.append("r_thumb3")
links_off.append("r_index1")
links_off.append("r_index2")
links_off.append("r_middle1")
links_off.append("r_middle2")
links_off.append("r_ring1")
links_off.append("r_ring2")
links_off.append("r_pinky1")
links_off.append("r_pinky2")