技术标签: slam 深蓝学院 多传感器融合定位 作业
对应任乾 从零开始做激光SLAM(文章汇总) 前八讲
预备知识 ROS学习教程:
古月 · ROS入门21讲
ROS/Tutorials
使用 kitti2bag工具包 制作rosbag:
使用的 KITTI rosbag信息如下:
jevin@jevin-GS65-Stealth-9SE:/media/jevin/File/my_file/BaiduyunDownload/转换后的bag文件/2011_10_03/bag$ rosbag info kitti_2011_10_03_drive_0027_synced.bag
path: kitti_2011_10_03_drive_0027_synced.bag
version: 2.0
duration: 7:50s (470s)
start: Oct 03 2011 12:55:34.00 (1317617735.00)
end: Oct 03 2011 13:03:25.83 (1317618205.83)
size: 24.0 GB
messages: 63616
compression: none [18184/18184 chunks]
types: geometry_msgs/TwistStamped [98d34b0043a2093cf9d9345ab6eef12e]
sensor_msgs/CameraInfo [c9a58c1b0b154e0e6da7578cb991d214]
sensor_msgs/Image [060021388200f6f0f447d0fcd9c64743]
sensor_msgs/Imu [6a62c6daae103f4ff57a132d6f95cec2]
sensor_msgs/NavSatFix [2d3a8cd499b9b4a0249fb98fd05cfa48]
sensor_msgs/PointCloud2 [1158d486dd51d683ce2f1be655c3c181]
tf2_msgs/TFMessage [94810edda583a504dfda3829e70d7eec]
topics: /kitti/camera_color_left/camera_info 4544 msgs : sensor_msgs/CameraInfo
/kitti/camera_color_left/image_raw 4544 msgs : sensor_msgs/Image
/kitti/camera_color_right/camera_info 4544 msgs : sensor_msgs/CameraInfo
/kitti/camera_color_right/image_raw 4544 msgs : sensor_msgs/Image
/kitti/camera_gray_left/camera_info 4544 msgs : sensor_msgs/CameraInfo
/kitti/camera_gray_left/image_raw 4544 msgs : sensor_msgs/Image
/kitti/camera_gray_right/camera_info 4544 msgs : sensor_msgs/CameraInfo
/kitti/camera_gray_right/image_raw 4544 msgs : sensor_msgs/Image
/kitti/oxts/gps/fix 4544 msgs : sensor_msgs/NavSatFix
/kitti/oxts/gps/vel 4544 msgs : geometry_msgs/TwistStamped
/kitti/oxts/imu 4544 msgs : sensor_msgs/Imu
/kitti/velo/pointcloud 4544 msgs : sensor_msgs/PointCloud2
/tf 4544 msgs : tf2_msgs/TFMessage
/tf_static 4544 msgs : tf2_msgs/TFMessage
bool FrontEndFlow::Run() {
if (!ReadData())
return false;
if (!InitCalibration())
return false;
if (!InitGNSS())
return false;
while(HasData()) {
if (!ValidData())
continue;
UpdateGNSSOdometry();
if (UpdateLaserOdometry()) {
PublishData();
SaveTrajectory();
}
}
return true;
}
ReadData()
:获取来自 Subscriber 的原始数据存储在std::deque中,同步各传感器数据
InitCalibration()
:获取 lidar_to_imu_ 坐标系变换矩阵
InitGNSS()
:初始化GNSS数据
UpdateGNSSOdometry()
:更新GNSS位置,并通过 lidar_to_imu_ 变换到雷达坐标系下
UpdateLaserOdometry()
:更新–>
bool FrontEnd::Update(const CloudData& cloud_data, Eigen::Matrix4f& cloud_pose)
滤波 pcl::VoxelGrid<CloudData::POINT>
局部地图容器中没有关键帧,代表是第一帧数据,把当前帧数据作为第一个关键帧,并更新局部地图容器和全局地图容器
使用NDT匹配 pcl::NormalDistributionsTransform<CloudData::POINT, CloudData::POINT>::Ptr
// 不是第一帧,就正常匹配
registration_ptr_->ScanMatch(filtered_cloud_ptr, predict_pose, result_cloud_ptr_, current_frame_.pose);
cloud_pose = current_frame_.pose;
// 更新相邻两帧的相对运动
step_pose = last_pose.inverse() * current_frame_.pose;
predict_pose = current_frame_.pose * step_pose;
last_pose = current_frame_.pose;
bool FrontEnd::UpdateWithNewFrame(const Frame& new_key_frame)
pcl::transformPointCloud
,根据NDT匹配获得的pose将局部地图中每个关键帧位姿统一SetInputTarget(local_map_ptr_)
运行代码执行步骤如下:
cat bag_file*>bag.tar.gz
mkdir -p ros_workspace/src
cd ros_workspace
catkin_make
source ./devel/setup.bash
sh /opt/clion-2020.1.1/bin/clion.sh
roscore
roslaunch lidar_localization test_frame.launch
rviz -d display_bag.rviz
rosbag play kitti_2011_10_03_drive_0027_synced.bag
... logging to /home/jevin/.ros/log/83be515c-1801-11eb-9b4a-803253b3bbcc/roslaunch-jevin-GS65-Stealth-9SE-9962.log
Checking log directory for disk usage. This may take a while.
Press Ctrl-C to interrupt
Done checking log file disk usage. Usage is <1GB.
started roslaunch server http://jevin-GS65-Stealth-9SE:37849/
SUMMARY
========
PARAMETERS
* /rosdistro: melodic
* /rosversion: 1.14.9
NODES
/
front_end_node (lidar_localization/front_end_node)
rviz (rviz/rviz)
auto-starting new master
process[master]: started with pid [9972]
ROS_MASTER_URI=http://localhost:11311
setting /run_id to 83be515c-1801-11eb-9b4a-803253b3bbcc
process[rosout-1]: started with pid [9983]
started core service [/rosout]
process[rviz-2]: started with pid [9987]
process[front_end_node-3]: started with pid [9991]
Could not create logging file: No such file or directory
COULD NOT CREATE A LOGGINGFILE 20201027-110715.9991!I20201027 11:07:15.661072 9991 front_end.cpp:61] 地图点云存放地址:/home/jevin/code/multi-sensors-homework/hw1/catkin-ws/src/lidar_localization/slam_data
I20201027 11:07:15.661288 9991 front_end.cpp:70] 关键帧点云存放地址:/home/jevin/code/multi-sensors-homework/hw1/catkin-ws/src/lidar_localization/slam_data/key_frames
I20201027 11:07:15.661334 9991 front_end.cpp:78] 点云匹配方式为:NDT
I20201027 11:07:15.661494 9991 ndt_registration.cpp:35] NDT 的匹配参数为:
res: 1, step_size: 0.1, trans_eps: 0.01, max_iter: 30
I20201027 11:07:15.661507 9991 front_end.cpp:92] local_map选择的滤波方法为:voxel_filter
I20201027 11:07:15.661557 9991 voxel_filter.cpp:27] Voxel Filter 的参数为:
0.6, 0.6, 0.6
I20201027 11:07:15.661564 9991 front_end.cpp:92] frame选择的滤波方法为:voxel_filter
I20201027 11:07:15.661571 9991 voxel_filter.cpp:27] Voxel Filter 的参数为:
1.3, 1.3, 1.3
I20201027 11:07:15.661576 9991 front_end.cpp:92] display选择的滤波方法为:voxel_filter
I20201027 11:07:15.661583 9991 voxel_filter.cpp:27] Voxel Filter 的参数为:
0.5, 0.5, 0.5
用ROS的service实现生成地图:
rosservice call /save_map
地图默认路径是在工程目录下的slam_data文件夹下,使用
pcl_viewer map.pcd
查看点云地图,但地图太大没加载出来,查看了一个关键帧:
学习PCL:
pointclouds.org
Tutorials
ICP documentation
The algorithm has several termination criteria:
1. Number of iterations has reached the maximum user imposed number of iterations (via setMaximumIterations)
2. The epsilon (difference) between the previous transformation and the current estimated transformation is smaller than an user imposed value (via setTransformationEpsilon)
3. The sum of Euclidean squared errors is smaller than a user defined threshold (via setEuclideanFitnessEpsilon)
Usage example:
IterativeClosestPoint<PointXYZ, PointXYZ> icp;
// Set the input source and target
icp.setInputCloud (cloud_source);
icp.setInputTarget (cloud_target);
// Set the max correspondence distance to 5cm (e.g., correspondences with higher distances will be ignored)
icp.setMaxCorrespondenceDistance (0.05);
// Set the maximum number of iterations (criterion 1)
icp.setMaximumIterations (50);
// Set the transformation epsilon (criterion 2)
icp.setTransformationEpsilon (1e-8);
// Set the euclidean distance difference epsilon (criterion 3)
icp.setEuclideanFitnessEpsilon (1);
// Perform the alignment
icp.align (cloud_source_registered);
// Obtain the transformation that aligned cloud_source to cloud_source_registered
Eigen::Matrix4f transformation = icp.getFinalTransformation ();
从以上介绍中得知使用PCL中的ICP方法需要设置4个参数
记录一个很傻逼的bug:
我创建icp_registration.hpp为了方便修改直接从ndt_registration.hpp复制过来修改了一下文件名,但下面预编译指令忘记修改
#ifndef LIDAR_LOCALIZATION_MODELS_REGISTRATION_ICP_REGISTRATION_HPP_
#define LIDAR_LOCALIZATION_MODELS_REGISTRATION_ICP_REGISTRATION_HPP_
导致一直编译报错找不到ICPRegistration类,检查了好久才看出来,这么低级的错误,自闭
使用evo计算轨迹误差参考:
evo/wiki
理解具体参数
比较好的博客
evo_rpe kitti ground_truth.txt laser_odom.txt -r trans_part --delta 100 --plot --plot_mode xyz
evo_rpe 相对姿态误差是用于调查SLAM轨迹的局部一致性的度量。时间戳对齐之后, 真实位姿和估计位姿均每隔一段相同时间计算位姿的变化量, 然后对该变化量做差, 以获得相对位姿误差
-r trans_part 只计算位置误差
–delta 100 相隔固定差100帧位姿差的精度
–plot 画图
–plot_mode xyz 画图模式
(运行结果展示在上一节)
RPE w.r.t. translation part (m)
for delta = 100 (frames) using consecutive pairs
(not aligned)
max 1.856809
mean 0.816793
median 0.721714
min 0.185244
rmse 0.906731
sse 36.997272
std 0.393714
运行结果:
jevin@jevin-GS65-Stealth-9SE:~/code/multi-sensors-homework/hw1/catkin-ws/src/lidar_localization/launch$ roslaunch front_end.launch
... logging to /home/jevin/.ros/log/8674a6ce-190c-11eb-85f1-803253b3bbcc/roslaunch-jevin-GS65-Stealth-9SE-11001.log
Checking log directory for disk usage. This may take a while.
Press Ctrl-C to interrupt
Done checking log file disk usage. Usage is <1GB.
started roslaunch server http://jevin-GS65-Stealth-9SE:40079/
SUMMARY
========
PARAMETERS
* /rosdistro: melodic
* /rosversion: 1.14.9
NODES
/
front_end_node (lidar_localization/front_end_node)
rviz (rviz/rviz)
auto-starting new master
process[master]: started with pid [11011]
ROS_MASTER_URI=http://localhost:11311
setting /run_id to 8674a6ce-190c-11eb-85f1-803253b3bbcc
process[rosout-1]: started with pid [11022]
started core service [/rosout]
process[rviz-2]: started with pid [11025]
process[front_end_node-3]: started with pid [11030]
I20201028 18:58:35.906061 11030 front_end.cpp:63] 地图点云存放地址:/home/jevin/code/multi-sensors-homework/hw1/catkin-ws/src/lidar_localization/slam_data
I20201028 18:58:35.906211 11030 front_end.cpp:72] 关键帧点云存放地址:/home/jevin/code/multi-sensors-homework/hw1/catkin-ws/src/lidar_localization/slam_data/key_frames
I20201028 18:58:35.906220 11030 front_end.cpp:80] 点云匹配方式为:ICP
I20201028 18:58:35.906759 11030 icp_registration.cpp:45] ICP params:
max_corr_dist: 1, trans_eps: 0.01, euc_fitness_eps: 0.01, max_iter: 30
I20201028 18:58:35.906774 11030 front_end.cpp:98] local_map选择的滤波方法为:voxel_filter
I20201028 18:58:35.906781 11030 voxel_filter.cpp:27] Voxel Filter 的参数为:
0.6, 0.6, 0.6
I20201028 18:58:35.906787 11030 front_end.cpp:98] frame选择的滤波方法为:voxel_filter
I20201028 18:58:35.906793 11030 voxel_filter.cpp:27] Voxel Filter 的参数为:
1.3, 1.3, 1.3
I20201028 18:58:35.906798 11030 front_end.cpp:98] display选择的滤波方法为:voxel_filter
I20201028 18:58:35.906805 11030 voxel_filter.cpp:27] Voxel Filter 的参数为:
0.5, 0.5, 0.5
evo精度评估:
RPE w.r.t. translation part (m)
for delta = 100 (frames) using consecutive pairs
(not aligned)
max 2222.513729
mean 291.544767
median 83.780087
min 0.660096
rmse 555.821329
sse 13902180.756229
std 473.221934
参数按照讲评中设置,调用PCL库的ICP方法效果不是很好,一开始轨迹基本相差不大,之后尺度飘移激光前端里程计的地图逐渐变大,最终发散
文章浏览阅读645次。这个肯定是末尾的IDAT了,因为IDAT必须要满了才会开始一下个IDAT,这个明显就是末尾的IDAT了。,对应下面的create_head()代码。,对应下面的create_tail()代码。不要考虑爆破,我已经试了一下,太多情况了。题目来源:UNCTF。_攻防世界困难模式攻略图文
文章浏览阅读2.9k次,点赞3次,收藏10次。偶尔会用到,记录、分享。1. 数据库导出1.1 切换到dmdba用户su - dmdba1.2 进入达梦数据库安装路径的bin目录,执行导库操作 导出语句:./dexp cwy_init/[email protected]:5236 file=cwy_init.dmp log=cwy_init_exp.log 注释: cwy_init/init_123..._达梦数据库导入导出
文章浏览阅读1.9k次。1. 在官网上下载KindEditor文件,可以删掉不需要要到的jsp,asp,asp.net和php文件夹。接着把文件夹放到项目文件目录下。2. 修改html文件,在页面引入js文件:<script type="text/javascript" src="./kindeditor/kindeditor-all.js"></script><script type="text/javascript" src="./kindeditor/lang/zh-CN.js"_kindeditor.js
文章浏览阅读2.3k次,点赞6次,收藏14次。SPI的详情简介不必赘述。假设我们通过SPI发送0xAA,我们的数据线就会变为10101010,通过修改不同的内容,即可修改SPI中0和1的持续时间。比如0xF0即为前半周期为高电平,后半周期为低电平的状态。在SPI的通信模式中,CPHA配置会影响该实验,下图展示了不同采样位置的SPI时序图[1]。CPOL = 0,CPHA = 1:CLK空闲状态 = 低电平,数据在下降沿采样,并在上升沿移出CPOL = 0,CPHA = 0:CLK空闲状态 = 低电平,数据在上升沿采样,并在下降沿移出。_stm32g431cbu6
文章浏览阅读1.2k次,点赞2次,收藏8次。数据链路层习题自测问题1.数据链路(即逻辑链路)与链路(即物理链路)有何区别?“电路接通了”与”数据链路接通了”的区别何在?2.数据链路层中的链路控制包括哪些功能?试讨论数据链路层做成可靠的链路层有哪些优点和缺点。3.网络适配器的作用是什么?网络适配器工作在哪一层?4.数据链路层的三个基本问题(帧定界、透明传输和差错检测)为什么都必须加以解决?5.如果在数据链路层不进行帧定界,会发生什么问题?6.PPP协议的主要特点是什么?为什么PPP不使用帧的编号?PPP适用于什么情况?为什么PPP协议不_接收方收到链路层数据后,使用crc检验后,余数为0,说明链路层的传输时可靠传输
文章浏览阅读587次。软件测试工程师移民加拿大 无证移民,未受过软件工程师的教育(第1部分) (Undocumented Immigrant With No Education to Software Engineer(Part 1))Before I start, I want you to please bear with me on the way I write, I have very little gen...
文章浏览阅读304次。Thinkpad X250笔记本电脑,装的是FreeBSD,进入BIOS修改虚拟化配置(其后可能是误设置了安全开机),保存退出后系统无法启动,显示:secure boot failed ,把自己惊出一身冷汗,因为这台笔记本刚好还没开始做备份.....根据错误提示,到bios里面去找相关配置,在Security里面找到了Secure Boot选项,发现果然被设置为Enabled,将其修改为Disabled ,再开机,终于正常启动了。_安装完系统提示secureboot failure
文章浏览阅读10w+次,点赞93次,收藏352次。1、用strtok函数进行字符串分割原型: char *strtok(char *str, const char *delim);功能:分解字符串为一组字符串。参数说明:str为要分解的字符串,delim为分隔符字符串。返回值:从str开头开始的一个个被分割的串。当没有被分割的串时则返回NULL。其它:strtok函数线程不安全,可以使用strtok_r替代。示例://借助strtok实现split#include <string.h>#include <stdio.h&_c++ 字符串分割
文章浏览阅读2.3k次。1 .高斯日记 大数学家高斯有个好习惯:无论如何都要记日记。他的日记有个与众不同的地方,他从不注明年月日,而是用一个整数代替,比如:4210后来人们知道,那个整数就是日期,它表示那一天是高斯出生后的第几天。这或许也是个好习惯,它时时刻刻提醒着主人:日子又过去一天,还有多少时光可以用于浪费呢?高斯出生于:1777年4月30日。在高斯发现的一个重要定理的日记_2013年第四届c a组蓝桥杯省赛真题解答
文章浏览阅读851次,点赞17次,收藏22次。摘要:本文利用供需算法对核极限学习机(KELM)进行优化,并用于分类。
文章浏览阅读1.1k次。一、系统弱密码登录1、在kali上执行命令行telnet 192.168.26.1292、Login和password都输入msfadmin3、登录成功,进入系统4、测试如下:二、MySQL弱密码登录:1、在kali上执行mysql –h 192.168.26.129 –u root2、登录成功,进入MySQL系统3、测试效果:三、PostgreSQL弱密码登录1、在Kali上执行psql -h 192.168.26.129 –U post..._metasploitable2怎么进入
文章浏览阅读257次。本文将为初学者提供Python学习的详细指南,从Python的历史、基础语法和数据类型到面向对象编程、模块和库的使用。通过本文,您将能够掌握Python编程的核心概念,为今后的编程学习和实践打下坚实基础。_python人工智能开发从入门到精通pdf