正文

激光slam学习笔记3--轨迹建图经验接口介绍(代码片段)

鸿_H  鸿_H  2023-03-02  549

关键词：

背景：如果给了一条轨迹和轨迹时间戳上的激光点云，那么拼接地图是一个有趣的事情。

概要：先介绍来自liosam里面手动计算的接口，后面介绍一种pcl自带的接口。

1、手动计算的接口

该接口采用手撕方式写的，定制性，运行速度更快些，但通用性不行。

pcl::PointCloud<PointType>::Ptr transformPointCloud(pcl::PointCloud<PointType>::Ptr cloudIn, PointTypePose* transformIn)

pcl::PointCloud<PointType>::Ptr cloudOut(new pcl::PointCloud<PointType>());

int cloudSize = cloudIn->size();
cloudOut->resize(cloudSize);

Eigen::Affine3f transCur = pcl::getTransformation(transformIn->x, transformIn->y, transformIn->z, transformIn->roll, transformIn->pitch, transformIn->yaw);
// 多线程处理方式
#pragma omp parallel for num_threads(numberOfCores)
for (int i = 0; i < cloudSize; ++i)

const auto &pointFrom = cloudIn->points[i];
cloudOut->points[i].x = transCur(0,0) * pointFrom.x + transCur(0,1) * pointFrom.y + transCur(0,2) * pointFrom.z + transCur(0,3);
cloudOut->points[i].y = transCur(1,0) * pointFrom.x + transCur(1,1) * pointFrom.y + transCur(1,2) * pointFrom.z + transCur(1,3);
cloudOut->points[i].z = transCur(2,0) * pointFrom.x + transCur(2,1) * pointFrom.y + transCur(2,2) * pointFrom.z + transCur(2,3);
cloudOut->points[i].intensity = pointFrom.intensity;

return cloudOut;

2、pcl自带的接口

pcl::PointCloud<pcl::PointXYZI>::Ptr temp;// 单帧点云
pcl::PointCloud<pcl::PointXYZI>::Ptr globalTemp(new pcl::PointCloud<pcl::PointXYZI>());// 拼接后的点云
Eigen::Isometry3d temp_iso = Eigen::Isometry3d::Identity(); //存储轨迹对应的变换矩阵
pcl::transformPointCloud(*temp, *globalTemp, temp_iso.matrix());	// 拼接的接口

注意，对于pcl自带接口，需要转换为xyzi类型的点云进行计算
3、补充点
初学者或者会疑惑，上面说的是轨迹，怎么没看见，反而是一个变换矩阵。在slam里面，轨迹也就是一些带有时间戳的变换矩阵，整体包含时间戳、位置、姿态信息，位置和姿态信息就是变换矩阵

#####################
不积硅步，无以至千里
好记性不如烂笔头
觉得nice，记得点赞收藏

激光slam课程学习笔记－－第11课：3d激光slam介绍

前言：这系列笔记是学习曾书格老师的激光slam课程所得，这里分享只是个人理解，有误之处，望大佬们赐教。这节课主要介绍一些3dslam数学知识，以及典型代表loam。1.３d激光SLAM1.1介绍［在地图上，... 查看详情

激光slam课程学习笔记－－第2课：2d激光slam

前言：这系列笔记是学习曾书格老师的激光slam课程所得，这里分享只是个人理解，有误之处，望大佬们赐教。这节课介绍的是２Ｄ激光slam。1.2d激光slam的介绍激光slam的输入：ＩＭＵ数据ÿ... 查看详情

激光slam课程学习笔记－－第１课：激光slam的发展和应用

前言：这系列笔记是学习曾书格老师的激光slam课程所得，这里分享只是个人理解，有误之处，望大佬们赐教。这节课介绍的是激光slam的发展和应用。1.　slam是什么1.1　slam的定义localization:在给定地图的情况下࿰... 查看详情

激光slam课程学习笔记－－第８课：cartographer代码基本介绍(代码片段)

前言：这系列笔记是学习曾书格老师的激光slam课程所得，这里分享只是个人理解，有误之处，望大佬们赐教。这节课主要介绍cartographer源码重点关注点。1．cartographer使用的版本是16年２月份发布的版本ÿ... 查看详情

激光slam学习笔记１－－rtk组合惯导激光雷达传感器一些经验知识分享(代码片段)

前言：跟组合惯导和激光雷达打交道半年了，过程中查找学习了这两方面的资料，这里来个小结。如果有理解错误的，望大佬们不吝赐教。一、RTK组合惯导个人理解有两部分组成，一个提供gps信息的rtk，另... 查看详情

激光slam课程学习笔记－－第５课：传感器数据处理ii：激光雷达运动畸变去除

前言：这系列笔记是学习曾书格老师的激光slam课程所得，这里分享只是个人理解，有误之处，望大佬们赐教。这节课主要介绍激光的运动畸变去除相关知识。1.概念介绍1.1激光雷达传感器介绍1.1.1　测距原理三角... 查看详情

激光slam课程学习笔记－－第11课：3d激光slam介绍

激光slam课程学习笔记－－第９课：基于图优化的激光slam方法(grid-based)

前言：这系列笔记是学习曾书格老师的激光slam课程所得，这里分享只是个人理解，有误之处，望大佬们赐教。这节课主要介绍基于图优化的激光slam方法(Grid-based)１．Graph-basedSLAM［front-end是前端处理ÿ... 查看详情

激光slam课程学习笔记－－第９课：基于图优化的激光slam方法(grid-based)

激光slam课程学习笔记－－第7课：基于滤波的slam方法（ｇrid-based）

前言：这系列笔记是学习曾书格老师的激光slam课程所得，这里分享只是个人理解，有误之处，望大佬们赐教。这节课主要介绍基于滤波的slam方法，重点学习其中的滤波数学理论，而非应用在slam。［当... 查看详情

激光slam课程学习笔记－－第１课：激光slam的发展和应用

slam+语音机器人diy系列：slam建图与自主避障导航——2.google-cartographer机器人slam建图(代码片段)

...人巡航与现场监控2.google-cartographer机器人SLAM建图主流的激光SLAM算法有hector、gmapping、karto、cartographer。hector是一种结合了鲁棒性较好的扫描匹方法2D_SLAM方法和使用惯性传感系统的导航技术。传感器的要求较高，高更新频率小测... 查看详情

激光slam课程学习笔记－－第８课：cartographer代码基本介绍(代码片段)

《ros理论与实践》学习笔记机器人slam建图(代码片段)

《ROS理论与实践》学习笔记（八）机器人SLAM建图课程内容常用SLAM功能包应用gmappinghectorcartographerrtabmap本讲作业1.在Gazebo中构建一个用于建图和导航的虚拟环境2.将自己构建的机器人模型放置到虚拟环境中，使用gmapping... 查看详情

激光slam课程学习笔记－－第10课：基于已知位姿的构图算法(grid-based)

前言：这系列笔记是学习曾书格老师的激光slam课程所得，这里分享只是个人理解，有误之处，望大佬们赐教。这节课主要介绍基于已知位姿的构图算法(grid-based)[slam里面最难的是位姿估计]［位姿估计，前... 查看详情

激光slam课程学习笔记－－第10课：基于已知位姿的构图算法(grid-based)

激光slam课程学习笔记－－第９课：基于图优化的激光slam方法(grid-based)

学习笔记之——激光雷达slam（loam系列的复现与学习）(代码片段)

概述SLAM问题被认为是真正意义上实现机器人自主移动的关键。其问题可以理解为如下的生活问题。当你来到一个陌生的环境时，为了迅速熟悉环境并完成自己的任务（比如找饭馆，找旅馆），你应当做以下事... 查看详情