我正在编写用于快速探索树木以进行机械臂运动的代码。我有两个疑问
i) 我必须使用什么距离度量来查找图中最近的节点？如果是欧式距离，我该如何计算，因为机器人的每个手臂配置中有两个链接，我不知道在这种情况下如何找到欧式距离。 如果 ABC 是树中最接近 ADE 的配置，我如何找到 ADE 和 ABC 之间的距离？
ii) 我如何为目标生成随机配置，因为即使经过 5000 次迭代，我的随机配置似乎也从未达到目标。
提前致谢。
【问题讨论】：
标签： algorithm path-finding robotics motion-planning
两个旋转关节臂的距离度量
RRT 对您选择的（伪）指标非常稳健，但如果您的某些东西不是特别好，树木（以及路径）的质量会受到影响。为了获得良好的整体性能，度量函数应该很快，所以在你转向更复杂的东西之前，我肯定会尝试更简单的东西。
在机器人手臂的情况下，许多指标是可能的。也许最简单的方法就是在两种配置中使用末端执行器之间的欧几里得距离。如果您正在测试计划算法，您几乎肯定必须已经让这个工作。
如果您拥有系统的完整动态模型，那么基于将手臂从一种配置移动到另一种配置所需的能量的其他指标可能会表现得更好。
基于在关节处扫过的（关节局部）角度的其他指标可能是可以接受的——但我在实践中没有尝试过。这也可能是了解您是否需要实现连接配置功能的有用技术。
提高收敛性
一旦您的度量函数正常工作，RRT 应该正常工作。但是，在实践中，您几乎总是需要在目标配置附近进行过采样，以鼓励算法利用在树构建阶段的其余部分完成的工作。最常见的做法是，以大约 5% 的概率对目标配置状态进行抽样。
【讨论】：