本文整理汇总了Python中sensor_msgs.msg.JointState.data方法的典型用法代码示例。如果您正苦于以下问题:Python JointState.data方法的具体用法?Python JointState.data怎么用?Python JointState.data使用的例子?那么恭喜您, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在类sensor_msgs.msg.JointState
的用法示例。
在下文中一共展示了JointState.data方法的1个代码示例,这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞,您的评价将有助于系统推荐出更棒的Python代码示例。
示例1: state_publisher
# 需要导入模块: from sensor_msgs.msg import JointState [as 别名]
# 或者: from sensor_msgs.msg.JointState import data [as 别名]
def state_publisher(self):
rate = rospy.Rate(1.0/self.dt)
while not rospy.is_shutdown():
time = rospy.Time.now()
# write to JointState
header = Header(stamp=time)
msg = JointState(header=header, name=self.lnames, position=self.joints,
velocity=numpy.zeros(self.dof), effort=numpy.zeros(self.dof))
self.joint_publisher.publish(msg)
msg = Float64MultiArray()
msg.data = self.joints
self.joint_publisher2.publish( msg )
# write to tf
t = []
for k in range(0, self.dof):
t = t + [pack_pose(time, self.links[k+1], self.links[k], matrix=self.transformations[k](self.joints[k]))]
self.tf_publisher.sendTransform(t)
rate.sleep()