一 简介
Kinodynamic:Kinematic+Dynamic
满足动力学和运动学约束的运动规划.
三种车模型:
Simple car model
Reeds & Shepp’s car
Dubin’s car
二 状态栅格搜索算法(State Lattice Search)
构建可行的运动连接:
- 前向的积分:离散控制空间(A*)
- 后向的计算:离散状态空间(PRM)
控制空间采样的例子
通过状态空间模型表示状态:s’=As+Bu
通过状态转移方程得到路径.
通过离散控制,给控制量,构建graph
Note:可以引入启发函数,在搜索过程中构建必要的图,其他地方可以不构建.
状态空间采样
通过反向计算两点的连接方式 构建graph
三 两点边界值最优控制问题(OBVP)
将条件带进去,得到一个通解.得到解容易,得到最优解较难.
OBVP
实际例子
启发函数
Frent frame下的最动态约束规划问题
先参数化:5次多项式
解最优控制问题