自动驾驶控制模块——车辆运动学
参考资料来源:B站老王、《自动驾驶汽车决策与控制》一书
注:大家学习过程中可以自己手推一遍,理解更加深刻,也可以配合老王大佬视频食用
1 模型假设
汽车运动模型是指用数学公式描述汽车运动而不考虑影响汽车运动的力。运动方程基于控制对象的几何关系而建立的。建立汽车的运动模型需要以下假设作为前提:
- 不考虑汽车在Z轴方向的运动,只考虑XY水平面的运动
- 左右侧车轮转角一致,这样可将左右侧轮胎合并为一个轮胎
- 汽车行驶速度变化缓慢,忽略前后轴载荷的转移
- 车身及悬架系统是刚性的
2 模型建立
汽车可以简化为两轮模型,如下图所示。
变量说明:
- A点:车的前轮
- B点:车的后轮
- δ f \delta_{f} δf:前轮转角(与车辆坐标系)
- δ r \delta_{r} δr:后轮转角
- C点:汽车质心
- l f l_{f} lf:质点C到A点的距离
- l r l_{r} lr:质点C到B点的距离
- L = l f + l r L = l_{f}+l_{r} L=lf+lr:汽车的轴距
- V:汽车质心点的速度
- β \beta β:侧偏角
- ψ \psi ψ:横摆角
- R:汽车行驶轨迹的半径
3 运动总方程推导
在 Δ O C A \Delta OCA ΔOCA上用正弦定理,有
s i n ( δ f − β ) l f = s i n ( π 2 − δ f ) R \frac{sin(\delta_{f}-\beta)}{l_{f}} = \frac{sin(\frac{\pi}{2} -\delta_{f})}{R} lfsin(δf−β)=Rsin(2π−δf)
在 Δ O C B \Delta OCB ΔOCB上用正弦定理,有
s i n ( β − δ r ) l r = s i n ( π 2 + δ r ) R \frac{sin(\beta-\delta_{r})}{l_{r}} = \frac{sin(\frac{\pi}{2} +\delta_{r})}{R} lrsin(β−δr)=Rsin(2π+δr)
由 L = l f + l r L = l_{f}+l_{r} L=lf+lr以及上面两式,整理得:
L R = cos β ( tan δ f − tan δ r ) \frac{L}{R}=\cos \beta (\tan\delta_{f} -\tan \delta_{r} ) RL=cosβ(tanδf−tanδr)
如果汽车轨迹半径变化缓慢,那么汽车行驶方向的变化率将等于汽车的角速度,即
ψ
˙
=
V
R
\dot{\psi}=\frac{V}{R}
ψ˙=RV
因此,运动的总方程为:
X方向速度:
X
˙
=
V
cos
(
ψ
+
β
)
\dot{X}=V\cos(\psi +\beta )
X˙=Vcos(ψ+β)
Y方向速度:
Y
˙
=
V
sin
(
ψ
+
β
)
\dot{Y}=V\sin(\psi +\beta )
Y˙=Vsin(ψ+β)
横摆角变化率:
ψ
˙
=
V
R
=
V
c
o
s
(
β
)
(
t
a
n
(
δ
f
)
−
t
a
n
(
δ
r
)
)
L
\dot{\psi}=\frac{V}{R}=\frac{Vcos(\beta)(tan(\delta_{f})-tan(\delta_{r}))}{L}
ψ˙=RV=LVcos(β)(tan(δf)−tan(δr))
4 简略版本
低速情况下,认为
δ
r
\delta_{r}
δr和
β
\beta
β近似为0,故运动的总方程为:
X方向速度:
X
˙
=
V
cos
(
ψ
)
\dot{X}=V\cos(\psi )
X˙=Vcos(ψ)
Y方向速度:
Y
˙
=
V
sin
(
ψ
)
\dot{Y}=V\sin(\psi )
Y˙=Vsin(ψ)
横摆角变化率:
ψ
˙
=
V
R
=
V
t
a
n
(
δ
f
)
L
\dot{\psi}=\frac{V}{R}=\frac{Vtan(\delta_{f})}{L}
ψ˙=RV=LVtan(δf)