铰接角是在对铰接式车辆进行运动分析时,关乎车辆稳定性的重要参数,当车辆前进时,铰接角过大会使车辆陷入原地转向的状态,倒车的时候,铰接角过大会导致车辆发生折叠失稳,甚至导致车辆侧翻。为了保证半挂牵引车在整体的工况下保持稳定,我们需要找到不同场景下铰接角的临界值,确定车辆稳定对应铰接角稳定域。
前向运动的稳定域
根据我们之前带挂牵引车前向运动模型推导及仿真实现推导的运动学模型
{
x
r
˙
=
v
cos
φ
y
r
˙
=
v
sin
φ
φ
˙
=
v
tan
δ
f
L
φ
1
˙
=
v
L
1
(
sin
θ
+
L
b
tan
δ
f
cos
θ
L
)
θ
=
φ
−
φ
1
\begin{cases} \dot{x_r}=v\cos{\varphi}\\ \dot{y_r}=v\sin{\varphi}\\ \dot{\varphi}=\frac{v\tan\delta_f}{L}\\ \dot{\varphi_1}=\frac{v}{L_1}(\sin\theta+\frac{L_b\tan\delta_f\cos\theta}{L})\\ \theta=\varphi-\varphi_1\\ \end{cases}
⎩
⎨
⎧xr˙=vcosφyr˙=vsinφφ˙=Lvtanδfφ1˙=L1v(sinθ+LLbtanδfcosθ)θ=φ−φ1
- ( x r , y r ) (x_r,y_r) (xr,yr):牵引车后轮中心点;
- L L L:牵引车的轴距;
- L b L_b Lb:铰接点 C C C到 B B B的距离;
- L 1 L1 L1:半挂车的轴距;
- δ f \delta_f δf:牵引车前轮转角;
- φ \varphi φ:牵引车航向角;
- φ 1 \varphi_1 φ1:半挂车的航向角;
- θ \theta θ:铰接角,即牵引车与半挂车的航向的夹角;
- v v v:牵引车的纵向速度;
可知,带挂牵引车的前向运动是开环稳定的,但铰接角过大的话也会导致车辆陷入折叠或挂车原地转向的状态。当牵引车以恒定的前轮转角前向运动的时候 ,牵引车与挂车的运动轨迹最终会近似两个同心圆,即铰接角度为一个稳定的数值,因此牵引车的前向运动时铰接角临界稳定值的定义为:车辆以不同的前轮进行前向运动时,铰接角能够维持稳定的值,即最终铰接角 θ ˙ = 0 \dot{\theta}=0 θ˙=0的 θ \theta θ值。
结合上面的公式,可得临界铰接角需满足:
θ
˙
=
φ
˙
−
φ
1
˙
=
v
tan
δ
f
L
−
v
L
1
(
sin
θ
+
L
b
tan
δ
f
cos
θ
L
)
=
0
\dot{\theta}=\dot{\varphi}-\dot{\varphi_1}=\frac{v\tan\delta_f}{L}-\frac{v}{L_1}(\sin\theta+\frac{L_b\tan\delta_f\cos\theta}{L})=0
θ˙=φ˙−φ1˙=Lvtanδf−L1v(sinθ+LLbtanδfcosθ)=0
化简后可得:
tan
δ
f
L
(
1
−
L
b
cos
θ
L
1
)
−
sin
θ
L
1
=
0
\frac{\tan\delta_f}{L}(1-\frac{L_b\cos\theta}{L_1})-\frac{\sin\theta}{L_1}=0
Ltanδf(1−L1Lbcosθ)−L1sinθ=0
将
δ
f
\delta_f
δf作为自变量,
θ
\theta
θ作为因变量(
L
=
3.0
L=3.0
L=3.0,
L
b
=
0.3
L_b=0.3
Lb=0.3,
L
1
=
7.0
L_1=7.0
L1=7.0 ),绘制出函数图像如下所示:
从图中的曲线即为前轮转角 δ f \delta_f δf和铰接角 θ \theta θ的临界稳定值,如果车辆当前时刻的铰接角小于其前轮转角对应铰接角临界稳定值,就不存在原地转向的风险。从图中可以看到,当 ∣ δ f ∣ > 23. 1 ∘ |\delta_f|>23.1^\circ ∣δf∣>23.1∘时不存在对应 θ ˙ = 0 \dot{\theta}=0 θ˙=0的情况。因此在该车身参数下,前向运动中牵引车前轮转角可以长时间控制在 − 23. 0 ∘ ∼ 23. 0 ∘ -23.0^\circ \sim 23.0^\circ −23.0∘∼23.0∘之间,不能长时间处于 ∣ δ f ∣ > 23. 0 ∘ |\delta_f|>23.0^\circ ∣δf∣>23.0∘的工况下,以防止出现车辆原地转向的风险,而且不管在何种工况下,牵引车都可以通过反打方向盘来减小铰接角的数值,使其逐渐趋于0,来使车辆恢复稳定状态。
后向运动的稳定域
带挂牵引车在前进过程中,挂车与其的运动趋势一致,而带挂牵引车在恒定前轮转角的后退的过程中,铰接角度会越来越大,因此不能以上一章节的方法来确定倒车的情况下铰接角度的临界值。
在恒定前轮转角的后退过程中,当铰接角度超过某一个范围阈值的时候,无论怎么改变前轮转角都无法使得铰接角 θ \theta θ趋于0,继而导致铰接角度愈发增大,引起车辆进入折叠的不稳定工况。结合文献的分析后,可得:当挂车在铰接点横向速度 v 2 v_2 v2大于纵向速度 v 1 v_1 v1的时候,车辆有陷入折叠的风险;因此可以根据该结论对其稳定域进行分析。
根据带挂牵引车倒车运动模型推导及仿真实现的推导过程可知半挂车的纵向速度
v
1
v_1
v1有
v
1
=
v
1
f
cos
δ
1
f
=
v
(
cos
θ
−
L
b
tan
δ
f
L
sin
θ
)
v_1=v_{1f}\cos\delta_{1f}=v(\cos\theta-\frac{L_b\tan\delta_f}{L}\sin\theta)
v1=v1fcosδ1f=v(cosθ−LLbtanδfsinθ)
根据文章中的几何关系,易得
v
1
f
v_{1f}
v1f在挂车上的横向速度分量
v
2
v_2
v2有
v
2
=
v
1
f
sin
δ
1
f
=
v
cos
α
sin
δ
1
f
=
v
cos
α
sin
(
θ
−
α
)
=
v
(
sin
θ
−
tan
α
cos
θ
)
=
v
(
sin
θ
−
L
b
R
cos
θ
)
=
v
(
sin
θ
−
L
b
tan
δ
f
L
cos
θ
)
\begin{split} v_2&=v_{1f}\sin\delta_{1f}\\ &=\frac{v}{\cos\alpha}\sin\delta_{1f}\\ &=\frac{v}{\cos\alpha}\sin(\theta-\alpha)\\ &=v(\sin\theta-\tan\alpha\cos\theta)\\ &=v(\sin\theta-\frac{L_b}{R}\cos\theta)\\ &=v(\sin\theta-\frac{L_b\tan\delta_f}{L}\cos\theta) \end{split}
v2=v1fsinδ1f=cosαvsinδ1f=cosαvsin(θ−α)=v(sinθ−tanαcosθ)=v(sinθ−RLbcosθ)=v(sinθ−LLbtanδfcosθ)
其中
α
\alpha
α为挂车虚拟前轮与牵引车航向的夹角,令
v
1
=
v
2
v_1=v_2
v1=v2,化简可得
tan
θ
=
L
+
L
b
tan
δ
f
L
−
L
b
tan
δ
f
\tan\theta=\frac{L+L_b\tan\delta_f}{L-L_b\tan\delta_f}
tanθ=L−LbtanδfL+Lbtanδf
上面的推导都是基于对应的角度,没有完全考虑物理意义上的正负号,下面我们分场景对其进行讨论(所有场景的初始状态都是
θ
=
0
,
δ
f
=
0
\theta=0,\delta_f=0
θ=0,δf=0):
- 当 δ f > 0 \delta_f>0 δf>0的时候, θ < 0 \theta<0 θ<0
- 当 δ f < 0 \delta_f<0 δf<0的时候, θ > 0 \theta>0 θ>0
将 δ f \delta_f δf作为自变量, θ \theta θ作为因变量( L = 3.0 L=3.0 L=3.0, L b = 0.3 L_b=0.3 Lb=0.3 ),绘制出从初始状态,以不同的固定前轮转角到达临界条件的图像如下
从图中可以看出,在当前车身参数下,倒车过程中铰接角的稳定域为 4 5 ∘ ∼ − 41.6 9 ∘ 45^\circ\sim-41.69^\circ 45∘∼−41.69∘,因此在倒车场景下的路径规划,需要将铰接角严格控制在稳定区域内,才能避免发生折叠的不稳定工况。
参考文献
[1] 赵名卓.半挂汽车列车倒车安全与诱导控制研究[D].合肥工业大学,2021.
[2] 贾生超.半挂牵引车自动泊车路径规划与运动控制方法研究[D].燕山大学,2023.