3.3 确定性采样:基于控制空间采样

tags

password

icon

要往前走，就得先忘掉过去。

—《阿甘正传》

🏰代码及环境配置：请参考环境配置和代码运行!

确定性采样运动规划是一种采用确定性采样策略进行运动规划的方法。它通过按照预定规则生成采样点来构建解空间，并用于后续的路径搜索或优化过程。这种方法具有确定性和可重复性、高效性和适应性等优势，但也面临采样策略设计、高维空间问题和计算复杂度等挑战。其主要分为基于控制空间的采样和基于状态空间的采样，接下来将分别介绍这两种采样方式。

基于控制空间（control space）的采样是运动规划中的一种重要方法，它侧重于在控制量的空间内进行采样，以生成可能的控制输入，进而通过这些控制输入来规划出运动轨迹。这种方法特别适用于需要考虑车辆或机器人动力学/运动学约束的情况。

假设一个机器人运动的状态方程为，其中表示所有可能的状态，例如位置信息，，速度信息，等，表示控制输入。如下图所示：当前状态为，在采取不同的控制输入时，可以产生不同的终点状态和不同的运动轨迹。

3.3.1 基本概念

控制空间：由车辆或机器人的控制量构成的空间（例如对于车辆而言，可以将方向盘转角速率和纵向加加速度作为控制变量）。在这个空间中，每一个点都代表了一组特定的控制输入。

采样策略：指在运动规划过程中，直接在控制空间内按照一定的规则或策略进行采样，生成一系列的控制输入组合。然后，通过车辆或机器人的动力学/运动学模型，将这些控制输入转化为相应的运动轨迹，并进行评估和优化。

车辆的动力学/运动学模型：具体细节在1.1节中讲解，此处不再赘述

3.3.2 优缺点

优点

符合动力学/运动学约束：直接在控制空间内进行采样，能够确保生成的轨迹符合车辆或机器人的动力学/运动学约束。

灵活性：采样策略可以根据具体问题的需求进行调整和优化，提高算法的灵活性

缺点

计算复杂性：需要对每个采样的控制序列进行状态推演，可能导致高计算成本。

优化难度：在控制空间中进行优化可能比在状态空间中更复杂。

采样效率：需要有效的采样策略来确保搜索效率和解的质量。

3.3.3 应用实例

3.3.3.1 无人机

若将无人机的状态为三维位置（）和三维速度（），控制输入为三维加速度（），并以此构建状态方程，采用不同的控制输入，采样出来的轨迹如下图所示：

若将状态为三维位置（）、三维速度（），三维加速度（），输入选为三维，则采用不同的控制输入，采样出来的轨迹如下图所示：

3.3.3.1 自动驾驶车辆

以自动驾驶车辆为例，一般情况下使用1.1节中的运动状态方程即可。此处的状态空间相比于1.1节中有更丰富的信息，不详细介绍，仅仅列出相应的公式，有兴趣者可自行研究。

状态空间为：

控制量为：

状态转移模型为：

并且基于状态量，我们可以基于以下公式得到kappa和dkappa：

其中：是车辆的位置，是车辆的航向角（横摆角），是前轮转角，是前轮转角，前轮转角速度，是车辆轴距，是车辆速度，是车辆加速度，是车辆加加速度。

下一节, 我们会解析和运行代码。