本文整理匯總了Python中hrl_geom.pose_converter.PoseConv.to_twist_stamped_msg方法的典型用法代碼示例。如果您正苦於以下問題：Python PoseConv.to_twist_stamped_msg方法的具體用法？Python PoseConv.to_twist_stamped_msg怎麽用？Python PoseConv.to_twist_stamped_msg使用的例子？那麽, 這裏精選的方法代碼示例或許可以為您提供幫助。您也可以進一步了解該方法所在類hrl_geom.pose_converter.PoseConv的用法示例。
在下文中一共展示了PoseConv.to_twist_stamped_msg方法的1個代碼示例，這些例子默認根據受歡迎程度排序。您可以為喜歡或者感覺有用的代碼點讚，您的評價將有助於係統推薦出更棒的Python代碼示例。
示例1: main
# 需要導入模塊: from hrl_geom.pose_converter import PoseConv [as 別名]
# 或者: from hrl_geom.pose_converter.PoseConv import to_twist_stamped_msg [as 別名]
def main():
rospy.init_node("cartesian_manager")
arm_char = sys.argv[1]
assert arm_char in ['r', 'l']
cart_man = CartesianControllerManager(arm_char)
if False:
cart_man.enable_controller(
end_link="%s_gripper_tool_frame" % arm_char,
ctrl_name="%s_cart_jt_task_tool" % arm_char,
ctrl_params="$(find hrl_face_adls)/params/%s_jt_task_tool.yaml" % arm_char,
frame_rot=FLIP_PERSPECTIVE_ROT)
rospy.sleep(1)
#t = PoseConv.to_twist_stamped_msg("l_gripper_tool_frame", (-0.15, 0, 0), (0, 0, 0))
#t = PoseConv.to_twist_stamped_msg("torso_lift_link", (0, 0, 0), (-np.pi/6, 0, 0))
t = PoseConv.to_twist_stamped_msg("torso_lift_link", (0, 0.1, 0), (0, 0, 0))
cart_man.command_move_cb(t)
return
rospy.spin()