[发明专利]四轮转向四轮驱动智能底盘稳定性控制方法有效
申请号: | 202111478737.0 | 申请日: | 2021-12-06 |
公开(公告)号: | CN114194178B | 公开(公告)日: | 2023-08-29 |
发明(设计)人: | 马芳武;邢彪;王佳伟;吴量;袁道发;冯曙 | 申请(专利权)人: | 尚元智行(宁波)科技有限公司 |
主分类号: | B60W30/02 | 分类号: | B60W30/02;B60W10/08;B60W10/119 |
代理公司: | 上海众象合一知识产权代理有限公司 31395 | 代理人: | 王纪营 |
地址: | 315191 浙江省*** | 国省代码: | 浙江;33 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 轮转 四轮驱动 智能 底盘 稳定性 控制 方法 | ||
1.四轮转向四轮驱动智能底盘稳定性控制方法,其特征在于,包括以下步骤:
S1:整车控制器获取驾驶员输入的前轮转角及请求的车速的信息,并控制底盘反馈实时的质心侧偏角、横摆角速度、纵向加速度、横向加速度和纵向车速的信息;
S2:整车控制器根据驾驶员输入的前轮转角及底盘反馈的纵向车速,通过前轮转向理想二自由度模型求得理想值Xd,其中前轮转向理想二自由度模型为:
其中,m为底盘质量;a为底盘的前轴距质心距离,b为底盘的后轴距质心距离;u为底盘反馈的纵向车速;k1为底盘的前轴等效侧偏刚度,k2为底盘的后轴等效侧偏刚度;Iz为底盘的横摆转动惯量;βd为底盘的理想质心侧偏角,γd为底盘的理想横摆角速度;为底盘的理想质心侧偏角的导数,为底盘的理想横摆角速度的导数;δf为前轮转角;
底盘在稳态情况下,和分别等于零,代入上述公式,求取底盘在稳态情况下的横摆角速度值,并以此值作为底盘的理想横摆角速度γd;由于底盘的质心侧偏角越小越好,因此将底盘的理想质心侧偏角βd设为零,取:
求得理想值Xd;
S3:通过自适应终端滑模控制,求得后轮转角δr及底盘的附加横摆力矩ΔM,具体流程为:
S31:建立四轮转向四轮驱动智能底盘动力学模型如下:
令:
则:
其中,β为底盘反馈的质心侧偏角,为β的导数;γ为底盘反馈的横摆角速度,为γ的导数;
为了后续便于描述,令:
则A、E、B分别表示为:
S32:取跟踪误差e为:
为了描述方便,令:
取滑模面s为:
其中,c1,c2,d1,d2,p,q均为常数,c1,c2,d1,d2>0,p,q为正奇数,且p>q;
对滑模面进行求导:
其中,为s的导数,为e的导数,为Xd的导数,
该滑模面引入了一项非线性项,当跟踪误差e远离平衡原点时,ce起主要作用,保证e具有较快的收敛速度;当e接近平衡原点时,deq/p起主要作用,保证系统状态的有限时间收敛特性;
取指数趋近控制律为:
其中,ka,kb为正数;
因此,控制律为:
S33:取Lyapunov函数为:
其中,sT为矩阵s的转置矩阵;为rk的估计值,k取值为111,112,121,122,21,22,τk为常数;
S34:A、E、B矩阵的自适应律的求解
对Lyapunov函数求导:
其中,为的导数;
取自适应率为:
因此,当且仅当s=0时,根据Lasalle不变性原理,闭环系统为渐进稳定,即当t→∞时,s→0;
为了防止因过大而导致控制律U不准确,需要通过自适应率的设计使的变化在范围内,采用一种映射自适应算法,对自适应率进行修正:
其中:
取分别为A、E、B的估计值,则:
S35:控制律U可表示为:
求得δr和ΔM,其中δr由整车控制器直接施加给底盘执行;
S4:进行速度跟随控制,即根据驾驶员请求的车速ud与底盘反馈的纵向车速u的差值eu做PI控制,求得维持驾驶员请求的车速所需的纵向力矩请求T:
其中,Kp为比例项系数,Ki为积分项系数;
S5:进行驱动力分配控制,即根据自适应终端滑模控制求得的ΔM与速度跟随控制求得的T,通过序列二次规划算法SQP求取底盘的车轮转矩:
为了便于表述,引入轮胎负荷率ρj:
其中,fl,fr,rl,rr分别代表底盘的前左轮、前右轮、后左轮、后右轮,Fxj为车轮纵向力,Fzj为车轮垂向载荷,μ为路面附着系数,Tj为底盘的车轮转矩,r为轮胎滚动半径;
Fzj通过以下公式求得:
其中,g为重力加速度,ax为底盘反馈的纵向加速度,ay为底盘反馈的横向加速度,h为质心高度,W为轮距;
底盘的车轮转矩Tj通过求解如下优化目标函数获得:
min J=∑[ρj-E(ρj)]2+εE(ρj)
s.t.
Tfl+Tfr+Trl+Trr=T
0≤Tj≤min(Tmax,μFzir)
其中,E(ρj)为轮胎负荷率的平均值,ε为权重系数,Tmax为轮毂电机所能提供的最大力矩;
整车控制器将所求得的底盘的车轮转矩Tj发送给底盘各轮毂电机控制执行。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于尚元智行(宁波)科技有限公司,未经尚元智行(宁波)科技有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202111478737.0/1.html,转载请声明来源钻瓜专利网。