没有找到对应内容,换一个词试试。
原课件第1页 / 32页定位与导航:我在哪里,怎样过去
原课件第2页 / 32页全讲路线与几个关键词
原课件第3页 / 32页定位、建图和导航怎样相互依赖
原课件第4页 / 32页位姿不只是一个坐标点
原课件第5页 / 32页借助外部基准定位
原课件第6页 / 32页从传播时间得到距离信息

图中彩色圆圈代表不同信标发出的波向外传播。发射时刻已知、接收端时间同步时,传播距离d=cΔt;c是信号速度,Δt=接收时刻−发射时刻。
例如声速取340 m/s,传播时间10 ms=0.01 s,距离为340×0.01=3.4 m。这个计算使用声波速度;无线电测距需使用电磁波的传播速度。
若两个信标同时发射同类信号,到达时刻分别为t_1、t_2,则d_1−d_2=c(t_1−t_2)。例:左侧信号早2 ms到达,t_左−t_右=−0.002 s,距离差=340×(−0.002)=−0.68 m,说明机器人离左侧近0.68米。只知道这个距离差时,候选位置构成双曲线;知道各自距离时,才分别画测距圆。
课堂补充(11-16 Part01 00:00:00–00:10:50):课堂用信号到达的先后比较机器人离两侧信标的远近。读本页时,先分清测的是传播时间还是两信号的到达时间差。
原课件第7页 / 32页两个信标为什么可能仍不够

知道某个信标到机器人的距离,就以信标为圆心、这段距离为半径画圆。两个圆相交时通常留下两个候选点。
例:信标A在(0,0),B在(6,0),两段距离都是5米。机器人位置(x,y)满足:
x²+y²=25;(x−6)²+y²=25。
展开第二式为x²−12x+36+y²=25。用它减第一式,得到−12x+36=0,所以x=3。代回第一式:9+y²=25,y²=16,因此y=4或−4。两个候选位置为(3,4)、(3,−4)。第三个位置合适的信标可帮助选出正确点。
“两个信号同时到达”只表示等距离;所有等距点构成连线的垂直平分线,中点只是其中一个。只测到达时间差时,应使用距离差约束,而不是把它当成两个已知半径的圆。
原课件第8页 / 32页知道位置后,怎样知道朝向
原课件第9页 / 32页光信标:先测相对方向
原课件第10页 / 32页两个角度为何对应许多位置
原课件第11页 / 32页导航是一整条处理链
原课件第12页 / 32页全局规划与局部处理各做什么
原课件第13页 / 32页Dijkstra:从起点向外确定最短距离
原课件第14页 / 32页把Dijkstra伪代码逐句读懂

初始化三类记录:dist[S]=0,其余dist=∞;Ready为空;pre全部留空。dist记目前最短距离,Ready记已确定节点,pre记路线前驱。
每轮按以下次序处理:
- 在未确定的节点中,选择dist最小的n。
- 把n加入Ready。
- 对n的每个邻居m,计算candidate=dist[n]+edge(n,m)。
- 若candidate<dist[m],更新dist[m]=candidate,同时记pre[m]=n;否则保留原记录。
- 回到第1步,直到需要的节点都处理完。
第3、4步叫松弛:问“改从n走到m,会不会更短?”例如dist[n]=5、边长3,候选=5+3=8;原来到m记12,所以改成8,前驱改为n。先比较距离,再同步改前驱,路线记录才能与距离一致。
原课件第15页 / 32页算例第0步:全部距离怎样初始化
原课件第16页 / 32页算例第1、2步:先S,再c
原课件第17页 / 32页算例第3、4、5步:得到最终表
原课件第18页 / 32页从前驱表还原真正的路线
原课件第19页 / 32页A*:同时看已走距离和剩余估计

Dijkstra按从起点已走的代价g排序;A*按f=g+h排序。h是从当前节点到目标的剩余代价估计,f是这条候选路线的预计总代价。例如路线长度作为代价时,可用直线距离作为h。
候选A的g=5、h=3,所以f=8;候选B的g=6、h=1,所以f=7。A*先处理B,因为B的预计总代价更小。这里的h是估计,h较小不等于真实剩余路程一定更短。
“扩展”是把选中的路线再向邻居延长一步,然后把新候选放回待选列表,重新比较。用不高估真实剩余距离的 h 作下界。一般实现遇到更小的 g 时要更新记录,必要时把已扩展节点重新放回候选表。若每条边都满足 h(当前) ≤ 边权 + h(邻居),称为启发函数一致,可以只扩展每个节点一次。课件这组边权和 h 满足这一条件。目标路线成为列表中最优并被取出时,才按相应条件停止。
课堂补充(11-16 Part01 00:24:14–00:35:36):A*部分讨论直线距离估计、候选路线比较和最佳优先扩展。把本页的已走代价g与剩余估计h分开读,再看候选为什么换序。
原课件第20页 / 32页A*算例:先比较S的三条支路

终点为b,图中节点旁的h值为a=1、b=0、c=3、d=5,边上的数才是实际路程。先从S生成三条候选:
| 候选路线 | 已走g | 剩余估计h | 合计f |
|---|---|---|---|
| S→a | 10 | 1 | 11 |
| S→c | 5 | 3 | 8 |
| S→d | 9 | 5 | 14 |
取最小f=8的S→c,把它从待选表取出,再向c的邻居延长一步。本算例不重复经过路线中已有的节点,所以不走回S。新候选为:S→c→a,f=(5+3)+1=9;S→c→b,f=(5+9)+0=14;S→c→d,f=(5+2)+5=12。
原来的S→a(11)、S→d(14)仍留在表中。把旧候选和新候选一起按f排序,下次取S→c→a(9)。g累加沿途边长,h只取当前末端节点的一次估计。
小演示 · 逐步运行 Dijkstra 和 A*
原课件第21页 / 32页A*算例:继续扩展最有希望的路线
原课件第22页 / 32页为什么到b的9可以确定为最短

当前待选表最小的是S→c→a→b,已经到达目标,真实总代价为5+3+1=9。其余候选的预计总代价依次为11、12、14、14。
这里h不高估真实剩余距离,因此f=g+h只是最终代价的下界。比如S→a的下界为11,它继续走完后总长至少11;其他候选同样至少12或14。它们都超过9,所以无法得到更短路线,可以停止。
本页原文把次小候选写成12;按上一页保留全部路线的表,S→a仍在,次小应为11。两者都大于9,最短路线结论相同。停止判断要比较整个待选表,不能在刚生成任意一条到终点的路线时就立即结束。
课堂补充(11-16 Part01 00:24:14–00:35:36):回听A*候选比较及到达目标后的停止判断,再用本页的下界比较检查为什么可以停止。
原课件第23页 / 32页SLAM:没有地图时边走边建立
原课件第24页 / 32页SLAM里的三种工作
原课件第25页 / 32页SLAM的一次更新怎样发生
原课件第26页 / 32页几类SLAM分别以什么为线索
原课件第27页 / 32页把SLAM放进ROS 2系统
原课件第28页 / 32页slam_toolbox与Nav2分工
原课件第29页 / 32页Cartographer与RTAB-Map这两个例子
原课件第30页 / 32页ROS 2建图流程与命令含义

先确认雷达在 /scan 提供激光数据,里程计与 TF 能把雷达观测放到机器人和地图坐标中。SLAM Toolbox 的本页流程使用二维激光扫描。
在课件使用的 Ubuntu / ROS 2 Jazzy 环境中,如果是仿真,启动建图时指定仿真时间:
ros2 launch slam_toolbox online_async_launch.py use_sim_time:=true
使用实机传感器且没有仿真时钟时,把 true 改成 false。launch 启动一个配置好的节点组合,slam_toolbox 是包名,online_async_launch.py 是启动文件。原页还列 Cartographer 作为另一套工具,它的启动文件按实际安装的机器人配置选择。
另开终端用 RViz 查看地图:
rviz2 -d "$(ros2 pkg prefix --share slam_toolbox)/config/slam_toolbox_default.rviz"
$(...) 先查找软件包的共享目录。-d 后面是 RViz 显示配置。用遥控让机器人探索,观察 /map 的空闲、占据和未知栅格怎样变化。
地图完成后保存:
ros2 run nav2_map_server map_saver_cli -f my_map
run 运行包中的一个程序,map_saver_cli 把地图保存为图像与 YAML。-f my_map 指定文件名前缀。下次导航加载 YAML,才能按同样的原点和尺度读地图。
原课件第31页 / 32页SLAM四个重要主题怎样连接

/map通常发布占据栅格,表示哪里空闲、哪里有障碍;/scan发布激光扫描的角度与距离测量;/odom发布里程计运动估计;/tf传递坐标系之间的变换。
常见坐标链是map→odom→base_link→传感器。激光测到“前方2米”先在雷达坐标系里表达,借助TF转换到地图后,才能把障碍放对位置。/odom消息与TF有关联但并非同一消息;两者应保持一致。时间戳也要对应,否则移动中的扫描会被放到错误的位置。
课堂补充(11-16 Part01 00:35:36–00:47:20):本段提到map与scan。用本页对照它们:map是逐步建立的环境表示,scan是传感器当前取得的一次扫描。























