文章目录 模型概述运动学模型假设运动学方程雅克比矩阵状态误差变化量(重要) 动力学模型假设动力学方程 模型概述 运动学 模型假设 运动学方程 车身与大地X的夹角φ角是车子当前的航向角,也叫横摆角德塔角是前轮的转角,最后一个公式表示,表达式在参考点 r 进行展开,用到泰勒级数。就是任意一个函数,在函数定义域上某一点进行展开。 雅克比矩阵 状态误差变化量(重要) 就是将泰勒展开式的右边第一项往右边移动,就变成差值项。右边是泰勒一次项 动力学 模型假设 动力学方程 向心加速度公式为a(n)=rω2=v2/r=4π2/T2 = v*w