[发明专利]一种轮式无人平台的漂移控制方法有效
申请号: | 202111544423.6 | 申请日: | 2021-12-16 |
公开(公告)号: | CN114148411B | 公开(公告)日: | 2022-12-13 |
发明(设计)人: | 付梦印;杨帅聪;杨毅;田晓辉 | 申请(专利权)人: | 北京理工大学 |
主分类号: | B62D6/00 | 分类号: | B62D6/00;B62D101/00;B62D105/00;B62D137/00 |
代理公司: | 北京理工大学专利中心 11120 | 代理人: | 高燕燕 |
地址: | 100081 *** | 国省代码: | 北京;11 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 轮式 无人 平台 漂移 控制 方法 | ||
1.一种轮式无人平台的漂移控制方法,其特征在于,包括:
获取车辆参数和路面摩擦系数;根据车辆参数和路面摩擦系数μ采用动力学模型和轮胎模型计算漂移平衡状态时的滑移角度、前轮转角、航向角速度之间的关系,并选取一组滑移角度βeq、航向角速度req和车辆速度Veq作为状态的期望稳定值;
根据车辆速度V、滑移角度β、航向角速度r、轮胎转速ω计算得到纵向速度Vx和横向速度Vy;然后根据所述纵向速度Vx 的变化率和横摆角速度观测车辆的纵向加速度最后根据车辆质量和纵向加速度,计算纵向的载荷转移,得到瞬时的前后轮垂向压力FzF和FzR;
根据期望的滑移角度、速度,和实时测量的滑移角度和速度,获得误差值eβ和eV,然后通过一阶动态获得滑移角度和速度的期望变化率最后根据双闭环原理和运动学方程将所述期望变化率引入到滑移角度的动态方程中,得到合成航向角速度rsyn,通过一阶动态计算,得到航向角速度的期望变化率
根据所述航向角速度的期望变化率使用枚举法实现动力学模型反演,使用最优控制方法设置代价函数得到最优控制量;将所述最优控制量直接作用在前轮转向执行机构。
2.如权利要求1所述的一种轮式无人平台的漂移控制方法,其特征在于,所述车辆参数包括:车辆质量m,转动惯量Iz,前后轴距a、b和总轴距L,重心高度h,前后轮胎侧偏刚度CαFCαR,轮胎半径R。
3.如权利要求2所述的一种轮式无人平台的漂移控制方法,其特征在于,所述转动惯量Iz采用摆动实验法或者锤击实验法测量,或是使用下述公式计算:
或Iz=m1a2+m2b2
其中,m1,m2为汽车前、后轴上的轴载质量。
4.如权利要求2或3所述的一种轮式无人平台的漂移控制方法,其特征在于,所述前后轮胎侧偏刚度CαFCαR采用以下方式获得:将驾驶车辆以固定速度行驶,不断增大轮胎转角,记录滑移角数据和轮胎力数据,拟合曲线,计算获得前后轮胎侧偏刚度。
5.如权利要求1或2或3所述的一种轮式无人平台的漂移控制方法,其特征在于,所述动力学模型如下式所示:
其中,等号左侧为航向角速度r、滑移角度β、车辆速度V的导数,δ为前轮转角,β为滑移角度,即车辆朝向和车速方向的夹角,FxFFyFFxRFyR分别为前轮和后轮收到的纵向和横向力。
6.如权利要求1或2或3所述的一种轮式无人平台的漂移控制方法,其特征在于,所述轮胎模型采用Fiala轮胎模型,具体如下:
z=tan α
αsl=arctan(3μFz/Cα)
其中Fz为轮胎的垂向载荷,α为轮胎的滑移角度,ξ为轮胎力的分配系数;前后轮的侧滑角度计算公式为:
7.如权利要求1或2或3所述的一种轮式无人平台的漂移控制方法,其特征在于,所述纵向速度Vx和横向速度Vy采用以下公式计算:
Vx=Vcosβ
Vy=Vsinβ
其中,V为车辆速度。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于北京理工大学,未经北京理工大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202111544423.6/1.html,转载请声明来源钻瓜专利网。