Cartographer 基于ceres的扫描匹配

本文详细解释了在机器人定位中,如何通过调用路径中的函数实现位姿优化,包括使用correlative_scan_matching进行校准,以及计算地图和位姿的残差。重点介绍了平移和旋转残差的处理方式,以及优化目标是使残差最小化以逼近目标值。

摘要生成于 C知道 ,由 DeepSeek-R1 满血版支持, 前往体验 >

调用路径

global_trajectory_builder.AddSensorData
-->local_trajectory_builder.addRangeData
-->local_trajectory_builder.AddAccumulatedRangeData
-->local_trajectory_builder.ScanMatch-->ceres_scan_matcher

输入参数

 * @param[in] target_translation 预测出来的先验位置, 只有xy
 * @param[in] initial_pose_estimate (校正后的)先验位姿, 有xy与theta
 * @param[in] point_cloud 用于匹配的点云 点云的原点位于local坐标系原点
 * @param[in] grid 用于匹配的栅格地图
 * @param[out] pose_estimate 优化之后的位姿

如果不调用correlative_scan_matching,target_translation和initial_pose_estimate是一样的

correlative_scan_matching 目的是对先验位姿进行校准,先验位姿来自于位姿推测器。

评论 1
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包

打赏作者

CHAO_^

你的鼓励将是我创作的最大动力

¥1 ¥2 ¥4 ¥6 ¥10 ¥20
扫码支付:¥1
获取中
扫码支付

您的余额不足,请更换扫码支付或充值

打赏作者

实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

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

余额充值