一种轮式无人平台的漂移控制方法

1.本发明涉及车辆的动力学控制和最优化控制领域，具体涉及一种轮式无人平台的漂移控制方法，用于提高不确定条件下的轮式车辆的行驶稳定性。


背景技术：

2.随着无人驾驶车辆的快速发展，无人驾驶过程中的车辆安全受到越来越严峻的挑战。目前的无人车辆控制方法大部分针对于小侧滑角的常规行驶工况，当遭遇低附着度的冰雪路面、高速下的快速转向等极限工况，轮胎的饱和程度增加，难以维持车辆的稳定运行状态。漂移是一种让汽车以大角度侧滑行驶的极限运动，可以提高不确定条件下的车辆行驶性能。侧滑即车辆速度方向与车辆轴线朝向不一致，侧滑角为车辆速度与车身方向的教教。漂移为车辆行驶的不稳定状态，为在进入漂移后维持稳定，需要使用不同于常规工况下的车辆运动控制器。
3.目前已有的针对轮式平台的漂移控制算法，仍然存在着明显的不足，包括：
4.1.现阶段的漂移控制器，大多采用线性二次型方法，其做出的线性化近似难以反映大侧滑角时车辆的行驶模型。
5.2.当前轮式平台的驱动形式仍分为多种，如内燃机驱动、电动机驱动、四轮独立驱动等多种形式。大部分控制方法在输出为扭矩，但内燃机驱动的车辆难以实现精准的扭矩控制。
6.3.现阶段的漂移控制器，大多在未进入漂移状态时采用开环控制，其对车辆的状态控制并不全面。


技术实现要素：

7.为解决现有技术存在的上述问题，本发明公开一种轮式无人平台的漂移控制方法，能够提高车辆漂移状态的稳定控制性能，实现轮式平台的稳定漂移控制。
8.本发明通过以下技术方案实现。
9.一种轮式无人平台的漂移控制方法，包括：
10.获取车辆参数和路面摩擦系数；根据所述车辆参数和路面摩擦系数采用动力学模型和轮胎模型计算漂移平衡状态时的滑移角度、前轮转角、航向角速度之间的关系，并选取一组滑移角度、航向角速度和车辆速度作为状态的期望稳定值；
11.根据车辆速度、滑移角度、航向角速度、轮胎转速计算得到纵向速度和横向速度；然后根据所述纵向速度的变化率和横摆角速度观测车辆的纵向加速度；最后根据所述车辆质量和纵向加速度，计算纵向的载荷转移，得到瞬时的前后轮垂向压力；
12.根据期望的侧滑角度、速度，和实时测量的侧滑角度和速度，获得误差值，然后通过一阶动态获得滑移角和速度的期望变化率；最后根据双闭环原理和运动学方程将所述期望变化率引入到滑移角的动态方程中，得到合成航向角速度，通过一阶动态计算，得到航向角速度的期望变化率；
13.根据所述航向角速度的期望变化使用枚举法实现动力学模型反演，使用最优控制方法设置代价函数得到最优控制量；将所述最优控制量直接作用在前轮转向执行机构。
14.本发明的有益效果：
15.本发明使用动力学模型计算先验漂移平衡态状态量，可以提高漂移时的稳定性，使用一阶动态和运动学方程计算出期望的状态变化率，使用基于优化方法的模型反演，可以快速、精确获取符合期望状态量变化速率的控制量；使用推力角公式将期望纵向力映射为期望驱动轮转速，可以提高漂移控制的精度，使算法可应用于油车和电车，可应用于前驱、后驱、四轮驱动等多种轮式平台。
附图说明
16.图1为本发明具体实施方式轮式无人平台的漂移控制方法流程图；
17.图2为本发明实施例中四驱车辆两轮动力学模型示意图；
18.图3为本发明实施例中后轮轮胎推力角分析示意图。
具体实施方式
19.下面结合附图对本发明作详细说明。
20.如图1所示，本实施方式中的一种轮式无人平台的漂移控制方法，具体包括：
21.步骤一、获取车辆参数和路面摩擦系数；
22.本实施例中，所述车辆参数包括：车辆质量m，转动惯量iz，前后轴距a、b和总轴距l，重心高度h，前后轮胎侧偏刚度c
afcar
，轮胎半径r；
23.具体实施时，所述转动惯量iz采用摆动实验法或者锤击实验法测量，或是使用下述公式计算：
24.或iz＝m1a2+m2b225.其中，m1，m2为汽车前、后轴上的轴载质量。
26.具体实施时，所述前后轮胎侧偏刚度c
αfcαr
采用以下方式获得：将驾驶车辆以固定速度行驶，不断增大轮胎转角，记录滑移角数据和轮胎力数据，拟合曲线，计算获得前后轮胎侧偏刚度。
27.步骤二、根据所述车辆参数和路面摩擦系数采用动力学模型和轮胎模型计算漂移平衡状态时的滑移角度、前轮转角、航向角速度之间的关系，并选取一组滑移角度β
eq
、航向角速度r
eq
和车辆速度v
eq
作为状态的期望稳定值；
28.本实施例中，如图2所示，所述动力学模型如下式所示：
[0029][0030][0031][0032]
其中等号左侧为航向角速度r、滑移角度β、车辆速度v的导数，δ为前轮转角，β为滑移角度，即车辆朝向和车速方向的夹角，f
xffyffxrfyr
分别为前轮和后轮收到的纵向和横向力。
[0033]
本实施例中，所述轮胎模型采用fiala轮胎模型，具体如下：
[0034][0035]
z＝tanα
[0036]asl
＝arctan(3μfz/c
α
)
[0037][0038]
其中fz为轮胎的垂向载荷，α为轮胎的滑移角度，ξ为轮胎力的分配系数；前后轮的侧滑角度计算公式为：
[0039][0040][0041]
步骤三、根据车辆速度v、滑移角度β、航向角速度r、轮胎转速ω计算得到纵向速度v
x
和横向速度vy；然后根据所述纵向速度v
x
的变化率和横摆角速度观测车辆的纵向加速度最后根据所述车辆质量和纵向加速度，计算纵向的载荷转移，得到瞬时的前后轮垂向压力f
zf
和f
zr
；
[0042]
本实施例中，所述纵向速度v
x
和横向速度vy采用以下公式计算：
[0043]vx
＝vcosβ
[0044]vy
＝vsinβ
[0045]
本实施例中，所述纵向加速度采用以下公式计算：
[0046][0047]
本实施例中，所述瞬时的前后轮垂向压力f
zf
和f
zr
采用以下公式计算：
[0048][0049][0050]
步骤四、根据期望的侧滑角度、速度，和实时测量的侧滑角度和速度，获得误差值e
β
和ev，然后通过一阶动态获得滑移角和速度的期望变化率具体如下式所示：
[0051]eβ
＝β-β
eq
[0052]
ev＝v-v
eq
[0053][0054][0055]
[0056][0057]
其中k
β
和kv是需要调整的反馈增益系数。
[0058]
最后根据双闭环原理和运动学方程将所述期望变化率引入到滑移角的动态方程中，得到合成航向角速度r
syn
，通过一阶动态计算，得到航向角速度的期望变化率具体如下式所示：
[0059][0060][0061][0062]
步骤五、根据所述航向角速度的期望变化率使用枚举法实现动力学模型反演，使用最优控制方法设置代价函数得到最优控制量；具体为：
[0063]
5.1使用双层循环分别遍历控制量纵向力f
x
和轮胎转向角度δ的可行解，将每组可行的控制量带入到动力学方程中，得到该控制量计算出的状态量的变化率，即实现了动力学模型反演；
[0064]
5.2根据每组控制量计算出的状态量变化率和步骤四中计算出的期望变化率计算代价；
[0065][0066]
其中，状态量变化率的最大值由每次输出结果的状态导数获得；
[0067]
5.3在双层循环中，选取代价值最小的控制量进行输出，此为最优控制量；
[0068]
步骤六、将所述最优控制量直接作用在前轮转向执行机构；
[0069]
当被控轮式平台为电机驱动时，通过控制驱动电机的扭矩，实现平台的纵向力控制；
[0070]
当被控轮式平台为内燃机驱动时，使用轮胎推力角公式通过控制驱动轮速度实现对驱动力的控制；如图3所示，所述轮胎推力角公式如下：
[0071][0072]
然后根据期望的纵向力，计算驱动轮的期望横向力和纵向力，计算出驱动轮的期望转速，然后通过驱动轮的轮速闭环控制，使得车辆获得期望的纵向力；
[0073]
所述期望转速如下式所示：
[0074][0075]
步骤七、循环计算上述步骤3至6，实现持续的车辆漂移控制。
[0076]
综上所述，以上仅为本发明的较佳实例而已，并非用于限定本发明的保护范围。凡在本发明的精神和原则之内，所作的任何修改、等同替换、改进等，均应包含在本发明的保护范围之内。

技术特征：
1.一种轮式无人平台的漂移控制方法，其特征在于，包括：获取车辆参数和路面摩擦系数；根据所述车辆参数和路面摩擦系数采用动力学模型和轮胎模型计算漂移平衡状态时的滑移角度、前轮转角、航向角速度之间的关系，并选取一组滑移角度、航向角速度和车辆速度作为状态的期望稳定值；根据车辆速度、滑移角度、航向角速度、轮胎转速计算得到纵向速度和横向速度；然后根据所述纵向速度的变化率和横摆角速度观测车辆的纵向加速度；最后根据所述车辆质量和纵向加速度，计算纵向的载荷转移，得到瞬时的前后轮垂向压力；根据期望的侧滑角度、速度，和实时测量的侧滑角度和速度，获得误差值，然后通过一阶动态获得滑移角和速度的期望变化率；最后根据双闭环原理和运动学方程将所述期望变化率引入到滑移角的动态方程中，得到合成航向角速度，通过一阶动态计算，得到航向角速度的期望变化率；根据所述航向角速度的期望变化使用枚举法实现动力学模型反演，使用最优控制方法设置代价函数得到最优控制量；将所述最优控制量直接作用在前轮转向执行机构。2.如权利要求1所述的一种轮式无人平台的漂移控制方法，其特征在于，所述车辆参数包括：车辆质量m，转动惯量i
z
，前后轴距a、b和总轴距l，重心高度h，前后轮胎侧偏刚度c
αf
c
ar
，轮胎半径r。3.如权利要求2所述的一种轮式无人平台的漂移控制方法，其特征在于，所述转动惯量i
z
采用摆动实验法或者锤击实验法测量，或是使用下述公式计算：或i
z
＝m1a2+m2b2其中，m1，m2为汽车前、后轴上的轴载质量。4.如权利要求1或2或3所述的一种轮式无人平台的漂移控制方法，其特征在于，所述前后轮胎侧偏刚度c
af
c
ar
采用以下方式获得：将驾驶车辆以固定速度行驶，不断增大轮胎转角，记录滑移角数据和轮胎力数据，拟合曲线，计算获得前后轮胎侧偏刚度。5.如权利要求1或2或3所述的一种轮式无人平台的漂移控制方法，其特征在于，所述动力学模型如下式所示：力学模型如下式所示：力学模型如下式所示：其中，等号左侧为航向角速度r、滑移角度β、车辆速度v的导数，δ为前轮转角，β为滑移角度，即车辆朝向和车速方向的夹角，f
xf
f
yf
f
xr
f
yr
分别为前轮和后轮收到的纵向和横向力。6.如权利要求1或2或3所述的一种轮式无人平台的漂移控制方法，其特征在于，所述轮胎模型采用fiala轮胎模型，具体如下：z＝tanαα
sl
＝arctan(3μf
z
/c
a
)
其中f
z
为轮胎的垂向载荷，α为轮胎的滑移角度，ξ为轮胎力的分配系数；前后轮的侧滑角度计算公式为：角度计算公式为：7.如权利要求1或2或3所述的一种轮式无人平台的漂移控制方法，其特征在于，所述纵向速度v
x
和横向速度v
y
采用以下公式计算：v
x
＝vcosβv
y
＝vsinβ。8.如权利要求7所述的一种轮式无人平台的漂移控制方法，其特征在于，所述纵向加速度采用以下公式计算：9.如权利要求8所述的一种轮式无人平台的漂移控制方法，其特征在于，所述瞬时的前后轮垂向压力f
zf
和f
zr
采用以下公式计算：采用以下公式计算：10.如权利要求9所述的一种轮式无人平台的漂移控制方法，其特征在于，所述误差值e
β
和ev、所述期望变化率通过下式所示：e
β
＝β-β
eq
ev＝v-v
eqeqeqeq
其中k
β
和kv是需要调整的反馈增益系数。11.如权利要求10所述的一种轮式无人平台的漂移控制方法，其特征在于，所述航向角速度的期望变化率具体如下式所示：具体如下式所示：具体如下式所示：12.如权利要求11所述的一种轮式无人平台的漂移控制方法，其特征在于，所述最优控制量具体采用以下步骤：
5.1使用双层循环分别遍历控制量纵向力和轮胎转向角度的可行解，将每组可行的控制量带入到动力学方程中，得到该控制量计算出的状态量的变化率；5.2根据每组控制量计算出的状态量变化率和步骤四中计算出的期望变化率计算代价；5.3在双层循环中，选取代价值最小的控制量进行输出，此为最优控制量。13.如权利要求12所述的一种轮式无人平台的漂移控制方法，其特征在于，所述将所述最优控制量直接作用在前轮转向执行机构，具体为：当被控轮式平台为电机驱动时，通过控制驱动电机的扭矩，实现平台的纵向力控制；当被控轮式平台为内燃机驱动时，使用轮胎推力角公式通过控制驱动轮速度实现对驱动力的控制；然后根据期望的纵向力，计算驱动轮的期望横向力和纵向力，计算出驱动轮的期望转速，然后通过驱动轮的轮速闭环控制，使得车辆获得期望的纵向力。

技术总结
本发明公开一种轮式无人平台的漂移控制方法，能够提高车辆漂移状态的稳定控制性能，实现轮式平台的稳定漂移控制。本发明使用动力学模型计算先验漂移平衡态状态量，可以提高漂移时的稳定性，使用一阶动态和运动学方程计算出期望的状态变化率，使用基于优化方法的模型反演，可以快速、精确获取符合期望状态量变化速率的控制量；使用推力角公式将期望纵向力映射为期望驱动轮转速，可以提高漂移控制的精度，使算法可应用于油车和电车，可应用于前驱、后驱、四轮驱动等多种轮式平台。四轮驱动等多种轮式平台。四轮驱动等多种轮式平台。


技术研发人员：付梦印 杨帅聪 杨毅 田晓辉
受保护的技术使用者：北京理工大学
技术研发日：2021.12.16
技术公布日：2022/3/8