【读书笔记】自动驾驶与机器人中的SLAM技术——高翔

文章会对本书第五章节及以后章节进行总结概括。每日更新一部分。一起读书吧。


第五章------基础点云处理

重点:点云的相邻关系是许多算法的基础

5.1 激光雷达传感器与点云的数学模型

5.1.1激光雷达传感器的数学模型

雷达有两种:机械旋转式激光雷达;固态激光雷达

单个激光探头可测量:某空间点离自身的距离,记作 r

RAE模型------ 距离 r , 方位角 A (水平的航向角), 俯仰角 E

5.1.2 点云的表达

(留个悬念:在很多算法里我们会问:离某个点最近的是哪个点?这个点和周边的点一起呈现了什么形状?为了实现这些功能,我们必须引入一些特殊的数据结构)

我们存储点云信息,最方便是定义点云结构体

可储存的信息除了点云的x,y,z坐标,还有反射率,所属线束,RGB颜色信息。

来自RGBD相机的点云,还可以储存每个点在图像中的行数和列数信息。

还有整个点云的位置和姿态等。

5.1.3 Packet的表达

雷达与计算机通过udp通讯,包里面有用的信息有两个:物体的探测距离与反射率

不过对算法来说,我们还是更希望直接访问每个点的坐标,所以Packet通常作为压缩后的数据,在驱动程序,原始传感器数据包或者地图压缩等模块中使用。

5.1.4 俯视图和距离图

俯视图干什么用?

很多规划算法如A*,D*等,需要用栅格地图来规划,点云转栅格,得到的栅格地图就是俯视图,在转栅格之后,大部分的障碍物信息都可以的到有效的保留,但某些动态物体在地图中出现了拖影现象。第六章会介绍栅格地图的概率机制,可以有效抑制动态物体的影响。

距离图干什么用?

距离图,取图像的横坐标为激光雷达的方向角,纵坐标为俯仰角,这种投影为距离图。

我们可以从距离图中提取出垂直方向上的物体作为定位的特征。比如哪些是地面,哪些是杆子。

5.2最近邻问题

最紧邻问题的描述:

在一个含n个点 {x1,x2,...xn} 的点云中,离某个点xm最近的点是哪一个?离它最近的k个点又有哪些?或者与它距离小于固定范围r的点有哪些?前者成为k近邻查找(knn),后者称为范围查找。

5.2.1 暴力最近邻法

也叫BF最近邻搜索

5.2.2 栅格与体素方法

栅格最近邻

体素最近邻

5.2.3 二分树与K-d树

K-d树的构建

K-d树的查找

5.2.4四叉树与八叉树

八叉树的构建

八叉树的查找

5.3拟合问题

5.3.1平面拟合

5.3.2平面拟合的实现

PCA

5.3.3直线拟合

5.3.4直线拟合的实现

待续...每日更新

相关推荐
时速GEO系统5 分钟前
初元 AI V1.1 版本升级,首个正式版发布一周・实现生成、部署、上线、优化全流程自动化闭环
人工智能·数据挖掘·node.js
咕泡科技9 分钟前
咕泡科技FDE系列最新产品重磅发布!
人工智能·大模型·ai落地·fde·前沿部署工程师
犀利豆20 分钟前
为什么全世界的 AI 都画不好一只骑自行车的鹈鹕
人工智能·llm·aigc
天天被压力29 分钟前
【跨市场数据实战 #08】可转债折价机会怎么筛:3个接口抓比价、列表和实时盘口
java·人工智能·python
baopixiaoz1 小时前
BeeQuant × BeeAgent:用AI加速策略验证
大数据·人工智能·python·区块链
咸鱼老弟1 小时前
AI Agent 的"自主性悖论"——为什么给它的自由度越大,越要配一套更硬的护栏
前端·人工智能
tq10861 小时前
对字节AI战略的评价
人工智能
专职八阿哥1 小时前
GPT-6 Astar 是什么?从模型名称、A*算法到实际接入讲清楚
人工智能
龙腾AI白云2 小时前
大语言模型:从语言理解到通用智能的跃迁
数据库·人工智能·机器学习·知识图谱
EatFans2 小时前
AI Agent 为什么总是失忆?一篇讲透 Agent Memory
人工智能