ros中的消息同步"message_filters/subscriber.h"

该博客围绕ROS中的消息同步展开,涉及使用“message_filters/subscriber.h”进行同步操作,在机器人操作系统开发中,消息同步对数据处理和系统运行至关重要。
https://www.cnblogs.com/yebo92/p/5600249.html
#include <message_filters/subscriber.h> #include <message_filters/synchronizer.h> #include <message_filters/sync_policies/approximate_time.h> #include <boost/thread/thread.hpp> using namespace message_filters; void imu_callback(const sensor_msgs::ImuConstPtr &imu_msg_accel, const sensor_msgs::ImuConstPtr &imu_msg_gyro) { double t = imu_msg_accel->header.stamp.toSec(); double dx = imu_msg_accel->linear_acceleration.x; double dy = imu_msg_accel->linear_acceleration.y; double dz = imu_msg_accel->linear_acceleration.z; double rx = imu_msg_gyro->angular_velocity.x; double ry = imu_msg_gyro->angular_velocity.y; double rz = imu_msg_gyro->angular_velocity.z; Vector3d gyr(rx, ry, rz); Vector3d acc(dx, dy, dz); /** 处理函数 ...... */ } int main(int argc, char** argv) { // 需要用message_filter容器对两个话题的数据发布进行初始化,这里不能指定回调函数 message_filters::Subscriber<sensor_msgs::Imu> sub_imu_accel(n,IMU_TOPIC_ACCEL,2000,ros::TransportHints().tcpNoDelay()); message_filters::Subscriber<sensor_msgs::Imu> sub_imu_gyro(n,IMU_TOPIC_GYRO,2000,ros::TransportHints().tcpNoDelay()); // 将两个话题的数据进行同步 typedef sync_policies::ApproximateTime<sensor_msgs::Imu, sensor_msgs::Imu> syncPolicy; Synchronizer<syncPolicy> sync(syncPolicy(10), sub_imu_accel, sub_imu_gyro); // 指定一个回调函数,就可以实现两个话题数据的同步获取 sync.registerCallback(boost::bind(&imu_callback, _1, _2)); ros::spin(); return 0; } ———————————————— 详细解释
07-29
评论
成就一亿技术人!
拼手气红包6.0元
还能输入1000个字符
 
红包 添加红包
表情包 插入表情
 条评论被折叠 查看
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值