cartographer的node.cc回调函数与数据走向

 trajectory_id 轨迹id
 sensor_id 里程计的topic名字
 msg 里程计的ros格式的数据

void Node::HandleOdometryMessage(const int trajectory_id,
                                 const std::string& sensor_id,
                                 const nav_msgs::Odometry::ConstPtr& msg) {
  absl::MutexLock lock(&mutex_);
  if (!sensor_samplers_.at(trajectory_id).odometry_sampler.Pulse()) {
    return;
  }
  auto sensor_bridge_ptr = map_builder_bridge_.sensor_bridge(trajectory_id);
  auto odometry_data_ptr = sensor_bridge_ptr->ToOdometryData(msg);
  // extrapolators_使用里程计数据进行位姿预测
  if (odometry_data_ptr != nullptr) {
    extrapolators_.at(trajectory_id).AddOdometryData(*odometry_data_ptr);
  }
  sensor_bridge_ptr->HandleOdometryMessage(sensor_id, msg);
}

例如(odom的回调函数):
absl::MutexLock lock(&mutex_);(上锁)

在node.h中有如下这个成员,因为回调函数用到了所以上锁

MapBuilderBridge map_builder_bridge_ GUARDED_BY(mutex_);

if (!sensor_samplers_.at(trajectory_id).odometry_sampler.Pulse()) {
    return;
  }

 查看有没有数据;

auto sensor_bridge_ptr = map_builder_bridge_.sensor_bridge(trajectory_id);
 
sensor_bridge_ptr->HandleOdometryMessage(sensor_id, msg);

获取SensorBridge类的指针,调用trajectory_builder_的AddSensorData进行数据的处理

 auto odometry_data_ptr = sensor_bridge_ptr->ToOdometryData(msg);

调用函数将数据格式转换

// extrapolators_使用里程计数据进行位姿预测
  if (odometry_data_ptr != nullptr) {
    extrapolators_.at(trajectory_id).AddOdometryData(*odometry_data_ptr);
  }

 odom准确就可以用,在lua文件中可以设置。

  • 9
    点赞
  • 7
    收藏
    觉得还不错? 一键收藏
  • 1
    评论

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论 1
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值