Kinodynamic path finding
不考虑动力学约束，得到的轨迹是左边的紫色虚线，考虑动力学模型得到的是右边的虚线
control space
state space
系统状态方程：s（导数）=As+Bu
三个运动学模型：自行车模型、差速机器人模型、小车模型
-------------------------------------------------------------------------------------------------------------------------------------------------------------------------
分界线
-------------------------------------------------------------------------------------------------------------------------------------------------------------------------
在状态空间的离散和在控制空间的离散方法
给定一个重点一个起点，计算链接这个两个点的“曲线”或者是“路线”
这个东西叫latic graph。
在控制空间采样不太好，在状态空间采样还是不错的
虽然状态空间的采样很好，但是很难实现！！！
-------------------------------------------------------------------------------------------------------------------------------------------------------------------------
分界线
-------------------------------------------------------------------------------------------------------------------------------------------------------------------------
BOUNDING VALUE PROBLEM (BVP)
为了得到这么一个图，假设x(t)是一个5阶方程
-------------------------------------------------------------------------------------------------------------------------------------------------------------------------
分界线
-------------------------------------------------------------------------------------------------------------------------------------------------------------------------
Hybrid A*路径搜索算法 *****************应用广泛，用于自动驾驶。
结合了kinodynamic ，让路径变得更光滑，特点是，保证了每个栅格里有一个路径结点
-------------------------------------------------------------------------------------------------------------------------------------------------------------------------
分界线
-------------------------------------------------------------------------------------------------------------------------------------------------------------------------
动力学约束的RRT算法
在创建一个新的结点后，会进行局部重连接，找一个新的父节点，此时，应用动力学约束模型，优化连接线。具体的理论，在论证中有
