文章目录
1.序言
牵引车-半挂车的车辆结构与普通的车辆相比增加了一个半挂车,它们之间通过鞍座相连接,为了分析半挂牵引车运动过程中的位姿和状态,本文将基于车辆的机械结构建立对应的运动学模型,该模型基于以下假设:
- 车辆行驶过程中,道路平坦且无凸凹;
- 车辆低速行驶,且运行过程中车身无侧倾和俯仰运动;
- 车辆行驶过程中,轮胎无形变,无侧向滑动,且无侧向力;
- 牵引车和半挂车均满足阿克曼转向几何原理;
- 牵引车与半挂车不会发现折叠。
2. 运动学模型及推导
牵引车带挂前向运动是开环稳定的,其对应的自行车模型如下所示:

其中:
- A A A:牵引车的前轮中心点,其坐标为 ( x f , y f ) (x_f,y_f) (xf,yf);
- B B B:牵引车后轮中心点,其坐标为 ( x r , y r ) (x_r,y_r) (xr,yr);
- C C C:牵引车与半挂车的铰接点,也是半挂车的等效前轮中心点,其坐标为 ( x 1 f , y 1 f ) (x_{1f},y_{1f}) (x1f,y1f);
- D D D:半挂车后轮中心点,其坐标为 ( x 1 r , y 1 r ) (x_{1r},y_{1r}) (x1r,y1r);
- L L L:牵引车的轴距;
- L a L_a La:铰接点 C C C到 A A A的距离;
- L b L_b Lb:铰接点 C C C到 B B B的距离;
- L 1 L1 L1:半挂车的轴距;
- δ f \delta_f δf:牵引车前轮转角;
- δ 1 f \delta_{1f} δ1f:半挂车虚拟前轮转角;
- φ \varphi φ:牵引车航向角;
- φ 1 \varphi_1 φ1:半挂车的航向角;
- θ \theta θ:铰接角,即牵引车与半挂车的航向的夹角;
- v v v:牵引车的纵向速度;
- v 1 v_1 v1:半挂车的纵向速度;
- v 1 f v_{1f} v1f:挂车虚拟前轮速度;
- α \alpha α:挂车虚拟前轮与牵引车航向的夹角。
结合我们前面车辆运动学方程推导和代码实现的推导,可得牵引车的运动学模型如下
{ x r ˙ = v cos φ y r ˙ = v sin φ φ ˙ = v tan δ f L (1) \begin{cases} \dot{x_r}=v\cos{\varphi}\\ \dot{y_r}=v\sin{\varphi}\\ \dot{\varphi}=\frac{v\tan\delta_f}{L} \end{cases}\tag{1} ⎩
⎨
⎧xr˙=vcosφyr˙=vsinφφ˙=Lvtanδf(1)
对于半挂车我们也把其等效为自行车模型,则其也有
{ x 1 r ˙ = v 1 cos φ 1 y 1 r ˙ = v 1 sin φ 1 φ 1 ˙ = v 1 tan δ 1 f L 1 (2) \begin{cases} \dot{x_{1r}}=v_1\cos{\varphi_1}\\ \dot{y_{1r}}=v_1\sin{\varphi_1}\\ \dot{\varphi_1}=\frac{v_1\tan\delta_{1f}}{L_1} \end{cases}\tag{2} ⎩
⎨
⎧x1r˙=v1cosφ1y1r˙=v1sinφ1φ1˙=L1v1tanδ
531



被折叠的 条评论
为什么被折叠?



