本文整理汇总了Python中std_msgs.msg.Header.secs方法的典型用法代码示例。如果您正苦于以下问题:Python Header.secs方法的具体用法?Python Header.secs怎么用?Python Header.secs使用的例子?那么恭喜您, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在类std_msgs.msg.Header
的用法示例。
在下文中一共展示了Header.secs方法的1个代码示例,这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞,您的评价将有助于系统推荐出更棒的Python代码示例。
示例1: rawIMU
# 需要导入模块: from std_msgs.msg import Header [as 别名]
# 或者: from std_msgs.msg.Header import secs [as 别名]
def rawIMU():
raw_imu = IMU()
pub_imu = rospy.Publisher('imu/data_raw', sensor_msgs.msg.Imu, queue_size = 10)
pub_magno = rospy.Publisher('imu/mag', Vector3, queue_size = 10)
r = rospy.Rate(10) # 10 Hz
while not rospy.is_shutdown():
angular_vel = Vector3()
linear_accel = Vector3()
magnometer = Vector3()
header = Header()
angular_vel.x = IMU.getRawGyroX()
angular_vel.y = IMU.getRawGyroY()
angular_vel.z = IMU.getRawGyroZ()
linear_accel.x = IMU.getRawAccelX()
linear_accel.y = IMU.getRawAccelY()
linear_accel.z = IMU.getRawAccelZ()
magnometer.x = IMU.getRawMagX()
magnometer.y = IMU.getRawMagY()
magnometer.z = IMU.getRawMagZ()
# Fill header and for timestamps
rostime = rospy.get_rostime()
header.secs = rostime.secs
header.nsecs = rostime.nsecs
header.frame_id = 1 # Declare to be the global frame
raw_imu_data = sensor_msgs.msg.Imu()
raw_imu_data.angular_velocity = angular_velocity
raw_imu_data.linear_acceleration = linear_accel
raw_imu_data.header = header
pub_imu.publish(raw_imu_data)
pub_magno.publish(magnometer)
r.sleep()