近来在Gazebo上搭了一个ur5双臂仿真平台。
差不多就是以下这样。
使用rostopic list查看一下话题,如下
显然,采用/left_arm_controller/follow_joint_trajectory/goal和/right_arm_controller/follow_joint_trajectory/goal两个话题来控制双臂的运动。
现在的问题是,如何保证双臂运动的一致性,即如何能保证双臂能同时接受到以上两个消息。
思路一:设置/left_arm_controller/follow_joint_trajectory里面的时间戳,试了一下,好像不好使,后续再试试。
思路二:采用Python的多线程方法。会有一定时差,但应该可以忽略。
程序如下:
from trajector