通过自己手动实现定位相关的功能,来达到学习定位的各个算法的目的。
文章将在 公众号, CSDN, 知乎 三个途径进行同步更新.
- 公众号名称: 从零开始搭SLAM
- CSDN专栏地址: https://blog.csdn.net/tiancailx/category_11916472.html?spm=1001.2014.3001.5482
- 知乎专栏地址: https://www.zhihu.com/column/c_1530947688660631552
代码是处于更新状态的,所有需要安装的依赖库都会写在 install_dependence.sh 脚本中,如果发现编译时由于依赖库报错,按照如下命令安装下依赖库即可.
cd /path_to_workspace/Learning_localization_from_scratch_ws
chmod +x install_dependence.sh
./install_dependence.sh
- ubuntu 18.04
- ros melodic
- gtsam 4.0.2
目前, 所用的数据集是Kaist数据集,其官方链接为 Complex Urban Dataset
数据集的使用方式见:kaist数据集体验
我将所有的数据集汇总到一个在线表格中,地址如下 公众号数据集汇总
- 本仓库已带有clang-format文件,请在IDE中使用格式化之后再进行提交; 如不使用IDE,也可以手动使用clang-format后再提交,具体命令为
find . -regex '.*\.\(cpp\|hpp\|c\|h\)' -exec clang-format -style=file -i {} \;
- [working] xx
- [done] xx
- [TODO] xx
以下为每篇文章对应的节点如何运行,以及对应节点的功能简介
Kaist数据集的使用也可以通过工具将数据转成bag从而进行使用。使用的工具是kaist2bag,这个工具已经在工程的kaist_tool文件夹里了,可以直接使用。
具体的使用方法为:
- 先修改kaist2bag/config/config.yaml, 将dataset与save_to的文件夹设置好
- 执行命令
roslaunch kaist2bag kaist2bag.launch
, 即可将每种传感器数据写成独立的bag - 再执行命令
rosrun kaist2bag mergebag.py merged.bag <bag_file_1> ... <bag_file_8>
, 即可将多个bag合成一个bag
数据就使用之前转录好的bag,将bag的地址填写在 LIO-SAM/launch/run.launch 中,通过命令 roslaunch lio_sam run.launch
, 开始建图。
- 将左右点云转换到IMU系下并合并点云,配置文件中添加Lidar到IMU的外参
- 替换原始EKF节点,增加原始gps数据转Odometry节点,发布因子图需要的gps数据类型
- 去除原代码中ring和time字段的检查,在数据集转rosbag过程中添加此字段
- 代码中一些参数的改动,IMU频率,是否启用gps,IMU内参
- 增加轮式里程计约束,可以在配置文件中选择是否启用
- 在launch直接播放rosbag,无需手动播放rosbag
- 可选参数配置如下
# GPS Settings
useGPS: true
# LidarOdom Settings
useLidarOdom: false
# WheelOdom Settings
useWheelOdom: true
这一步需要安装依赖项
pip3 install numpy scipy
已经填写在 install_dependence.sh 文件中。
执行步骤为
./src/scripts/kaist2evo.py -p /media/trunk/Trunk/0-LX/Kaist/Urban08
-p 后边接的是数据集的文件夹,之后可以加 -o 加输出轨迹文件的地址。
执行之后会在Urban08文件夹下生成2个txt文件,分别是 tum_ground_truth.txt 与 tum_vrs_gps.txt。
- tum_ground_truth.txt 是将 global_pose.csv 转成的tum格式的轨迹文件
- tum_vrs_gps.txt 是将 sensor_data/vrs_gps.csv 转成的tum格式的轨迹文件
当然,这个我已经转好了,放在了 src/doc/ground_truth 文件夹下,不再需要自己转了。
roslaunch lio_sam run.launch
执行完建图之后,会在 src/doc/mapping_results 文件夹下生成轨迹文件
然后将 src/doc/ground_truth/tum_ground_truth.txt 与 src/doc/mapping_results/tum_lio_sam_pose.txt 这两个文件,分别填在 src/scripts/evo.sh 的 txt1 与 txt2 中
在执行 src/scripts/evo.sh
即可绘制轨迹图,ape图,rpe图。
代码文件在./lidar_odometry 基于点面匹配,借鉴了LIO-SAM中的匹配方式,不同的是LIO-SAM采用的是帧与附近的帧组成的局部地图匹配,本方案借鉴了A-LOAM的**,提取面特征,先用前后两帧的面特征点构建点面残差,得到一个粗略的帧间里程计,然后将多帧累计,组成地图与当前帧匹配,修正里程计坐标系和世界坐标系之间的转换关系,得到一个更加精确的里程计。 LIO-SAM角点和平面匹配的残差构建和雅克比推导可以参考:https://zhuanlan.zhihu.com/p/548579394
-
将LIO-SAM中点面匹配部分拆分为三个节点,特征提取、scan_to_scan匹配、scan_to_map匹配
-
由于角点较少,只提取平面点,简化特征点提取条件,低于阈值即为平面点
-
采用ceres自动求导的方式,代替LIO-SAM中手动求导的方式,只需构建点面残差,省去了求雅可比的过程
-
发布scan_to_scan的里程计和scan_to_map的里程计
roslaunch lidar_odometry run.launch