lio-sam实车调试之定位测试

1.首先阅读一下recolization的源码,看一下和mapping有啥区别:

-imageProjection.cpp中:

cloudInfo.imuPreintegrationResetId = round(startOdomMsg.pose.covariance[0]);

计算相对变换(从雷达的起始时刻到当前imu数据来的时候)

-imuPreintegration.cpp中:

int imuPreintegrationResetId = 0;
订阅odom的里程计?猜测应该是方便显示
    ros::Subscriber subPoseOdomToMap;
    geometry_msgs::PoseStamped poseOdomToMap;
    subPoseOdomToMap = nh.subscribe<geometry_msgs::PoseStamped>("lio_sam/mapping/pose_odomTo_map", 1,&IMUPreintegration::odomToMapPoseHandler,      this, ros::TransportHints().tcpNoDelay());
    pubImuPath = nh.advertise<nav_msgs::Path>("lio_sam/imu/path", 1);
    map_to_odom    = tf::Transform(tf::createQuaternionFromRPY(0, 0, 0), tf::Vector3(0, 0, 0));

void odomToMapPoseHandler(const geometry_msgs::Pos
  • 2
    点赞
  • 14
    收藏
    觉得还不错? 一键收藏
  • 8
    评论

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

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

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值