Comments (3)
高博您好,我做了个简单的实验验证了这个问题,如果有分析不对的地方还希望您能给出指正。
首先我注释掉了 laser_mapping.cc 中的第323行
// Timer::Evaluate([&, this]() { MapIncremental(); }, " Incremental Mapping");
即不再进行地图更新,地图中仅保存第一帧点云。正常情况下仅依靠第一帧点云,在雷达移动距离较近时,也会约束住。应该表现为能维持一段时间的稳定位姿估计,当新的点云与第一帧点云共同区域较小时位姿估计失败。
接下来我分别进行了三次测试
1. UrbanLoco Hong Kong Dataset Dataset 5: HK-Data20190117
roslaunch faster_lio mapping_velodyne_ulhk.launch
2. utbm utbm_robocar_dataset_20180713_noimage.bag
roslaunch faster_lio mapping_velodyne_utbm.launch
3. hku_main_building.bag
roslaunch faster_lio mapping_avia.launch
现象是持续了一段时间的稳定估计,雷达与第一帧点云无共同视野时飘走。
4. 分析
- ulhk数据集中雷达坐标系与IMU坐标系之间存在较大的旋转角度偏差,由于该角度偏差,导致随后世界坐标系下的点云无法与第一帧雷达坐标系下的点云配准成功,进而导致飞走。
extrinsic_T: [ 0, 0, -0.28]
extrinsic_R: [ 0, -1, 0, 1, 0, 0, 0, 0, 1]
- utbm数据集中雷达坐标系与IMU坐标系之间外参平移分量较大,而旋转保持相同,因而能在几帧之内将位姿纠正,体现为平移震荡。
extrinsic_T: [ -0.5, 1.4, 1.5]
extrinsic_R: [ 1, 0, 0, 0, 1, 0, 0, 0, 1]
- hku_main_building数据集使用avia雷达,其内置IMU,雷达坐标系和IMU坐标系在旋转和平移上都没有太大差异,因而测试起来效果最合乎预期。
extrinsic_T: [ 0.04165, 0.02326, -0.0284 ]
extrinsic_R: [ 1, 0, 0, 0, 1, 0, 0, 0, 1 ]
5. 补充实验
我将第一帧的点云转换到世界坐标系下后,再加入到IVox中,重复上述实验,均为正常表现,即维持了一段时间的稳定位姿估计,当新的点云与第一帧点云共同区域较小时位姿估计失败。
6. 总结
根据上面的实验,我还是认为第一帧点云应当转换到世界坐标系下后再加入到IVox中。虽然实际上由于每次估计后会对地图进行更新,新的点云很快会覆盖掉第一帧点云,导致最终的差异并不明显。
期待着您的回复。
from faster-lio.
这个其实有一些个人的考虑:因为fastlio系列整体用的点数比较少(大概每帧2k-3k点),但初始的时候如果点太少了,运动快了就可能找不到最近邻(而且初始的时候imu和系统状态的估计不够准确)。所以就在第一帧的时候多用一些点数来做后续帧的匹配。sad书也是类似的策略,并且sad书用的增量ndt,点少的时候无法准确估计ndt的分布。所以甚至可以把前一段时间的scan不作降采样,来增加前期可用的点数。
from faster-lio.
感谢高博的回复,我理解您的意思。但是为什么不将第一帧的点云转换到世界坐标系下再加入到ivox中呢? scan_undistort_ 中点的坐标是在雷达坐标系下的,而第二帧以后 lasermapping::MapIncremental() 中均是使用转换后的世界坐标系下的点云来更新地图。如果IMU坐标系和雷达坐标系几乎重合,那可能不会有太大影响。但当二者之间存在较大的旋转或平移时,ivox中前两帧点云可能会发生错位。
from faster-lio.
Related Issues (20)
- ba收敛性讨论
- 作者你好,我使用你的项目过程中将velodyne替换成Robosense的激光雷达,同时也参考了LiDAR_IMU_Init项目进行了改写。但还是报了以下错误,不知道如何修改,麻烦指导一下,谢谢。 HOT 2
- Do you have any plans to make rosbag public without requiring specific access right? HOT 2
- 疑似BUG HOT 1
- 对fastlio2和fasterlio的近邻搜索发现ivox搜索时间长 HOT 4
- 关于bags数据访问权限 HOT 1
- Anderson Acceleration for on-Manifold Iterated Error State Kalman Filters论文中是否存在笔误?
- 关于数据包bag无法访问的问题 HOT 4
- 加入RTK/GNSS数据 HOT 2
- 为什么回调函数需要添加线程锁,而同步函数不需要添加线程锁? HOT 2
- There is no implementation of runtime_pos_log_enable
- 同一个rosbag每一次运行的结果都不一样 HOT 8
- 里程计发布频率 HOT 2
- 接收点云的代码中对blind的处理有误
- so3_math.h的Exp函数报错
- M2DGR dataset error
- iVox reconstruct 功能
- 卡尔曼get_x的state_point 内成员的变换
- [laserMapping-2] process has died HOT 1
Recommend Projects
-
React
A declarative, efficient, and flexible JavaScript library for building user interfaces.
-
Vue.js
🖖 Vue.js is a progressive, incrementally-adoptable JavaScript framework for building UI on the web.
-
Typescript
TypeScript is a superset of JavaScript that compiles to clean JavaScript output.
-
TensorFlow
An Open Source Machine Learning Framework for Everyone
-
Django
The Web framework for perfectionists with deadlines.
-
Laravel
A PHP framework for web artisans
-
D3
Bring data to life with SVG, Canvas and HTML. 📊📈🎉
-
Recommend Topics
-
javascript
JavaScript (JS) is a lightweight interpreted programming language with first-class functions.
-
web
Some thing interesting about web. New door for the world.
-
server
A server is a program made to process requests and deliver data to clients.
-
Machine learning
Machine learning is a way of modeling and interpreting data that allows a piece of software to respond intelligently.
-
Visualization
Some thing interesting about visualization, use data art
-
Game
Some thing interesting about game, make everyone happy.
Recommend Org
-
Facebook
We are working to build community through open source technology. NB: members must have two-factor auth.
-
Microsoft
Open source projects and samples from Microsoft.
-
Google
Google ❤️ Open Source for everyone.
-
Alibaba
Alibaba Open Source for everyone
-
D3
Data-Driven Documents codes.
-
Tencent
China tencent open source team.
from faster-lio.