CN114953886A - 一种载人月球车悬架状态计算方法及系统 - Google Patents
一种载人月球车悬架状态计算方法及系统 Download PDFInfo
- Publication number
- CN114953886A CN114953886A CN202210554602.6A CN202210554602A CN114953886A CN 114953886 A CN114953886 A CN 114953886A CN 202210554602 A CN202210554602 A CN 202210554602A CN 114953886 A CN114953886 A CN 114953886A
- Authority
- CN
- China
- Prior art keywords
- suspension
- state
- acceleration
- vertical
- vehicle
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60G—VEHICLE SUSPENSION ARRANGEMENTS
- B60G17/00—Resilient suspensions having means for adjusting the spring or vibration-damper characteristics, for regulating the distance between a supporting surface and a sprung part of vehicle or for locking suspension during use to meet varying vehicular or surface conditions, e.g. due to speed or load
- B60G17/015—Resilient suspensions having means for adjusting the spring or vibration-damper characteristics, for regulating the distance between a supporting surface and a sprung part of vehicle or for locking suspension during use to meet varying vehicular or surface conditions, e.g. due to speed or load the regulating means comprising electric or electronic elements
- B60G17/018—Resilient suspensions having means for adjusting the spring or vibration-damper characteristics, for regulating the distance between a supporting surface and a sprung part of vehicle or for locking suspension during use to meet varying vehicular or surface conditions, e.g. due to speed or load the regulating means comprising electric or electronic elements characterised by the use of a specific signal treatment or control method
- B60G17/0182—Resilient suspensions having means for adjusting the spring or vibration-damper characteristics, for regulating the distance between a supporting surface and a sprung part of vehicle or for locking suspension during use to meet varying vehicular or surface conditions, e.g. due to speed or load the regulating means comprising electric or electronic elements characterised by the use of a specific signal treatment or control method involving parameter estimation, e.g. observer, Kalman filter
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60G—VEHICLE SUSPENSION ARRANGEMENTS
- B60G17/00—Resilient suspensions having means for adjusting the spring or vibration-damper characteristics, for regulating the distance between a supporting surface and a sprung part of vehicle or for locking suspension during use to meet varying vehicular or surface conditions, e.g. due to speed or load
- B60G17/015—Resilient suspensions having means for adjusting the spring or vibration-damper characteristics, for regulating the distance between a supporting surface and a sprung part of vehicle or for locking suspension during use to meet varying vehicular or surface conditions, e.g. due to speed or load the regulating means comprising electric or electronic elements
- B60G17/019—Resilient suspensions having means for adjusting the spring or vibration-damper characteristics, for regulating the distance between a supporting surface and a sprung part of vehicle or for locking suspension during use to meet varying vehicular or surface conditions, e.g. due to speed or load the regulating means comprising electric or electronic elements characterised by the type of sensor or the arrangement thereof
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60G—VEHICLE SUSPENSION ARRANGEMENTS
- B60G17/00—Resilient suspensions having means for adjusting the spring or vibration-damper characteristics, for regulating the distance between a supporting surface and a sprung part of vehicle or for locking suspension during use to meet varying vehicular or surface conditions, e.g. due to speed or load
- B60G17/015—Resilient suspensions having means for adjusting the spring or vibration-damper characteristics, for regulating the distance between a supporting surface and a sprung part of vehicle or for locking suspension during use to meet varying vehicular or surface conditions, e.g. due to speed or load the regulating means comprising electric or electronic elements
- B60G17/019—Resilient suspensions having means for adjusting the spring or vibration-damper characteristics, for regulating the distance between a supporting surface and a sprung part of vehicle or for locking suspension during use to meet varying vehicular or surface conditions, e.g. due to speed or load the regulating means comprising electric or electronic elements characterised by the type of sensor or the arrangement thereof
- B60G17/01908—Acceleration or inclination sensors
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60G—VEHICLE SUSPENSION ARRANGEMENTS
- B60G2400/00—Indexing codes relating to detected, measured or calculated conditions or factors
- B60G2400/10—Acceleration; Deceleration
- B60G2400/102—Acceleration; Deceleration vertical
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60G—VEHICLE SUSPENSION ARRANGEMENTS
- B60G2600/00—Indexing codes relating to particular elements, systems or processes used on suspension systems or suspension control systems
- B60G2600/18—Automatic control means
- B60G2600/187—Digital Controller Details and Signal Treatment
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60G—VEHICLE SUSPENSION ARRANGEMENTS
- B60G2600/00—Indexing codes relating to particular elements, systems or processes used on suspension systems or suspension control systems
- B60G2600/18—Automatic control means
- B60G2600/187—Digital Controller Details and Signal Treatment
- B60G2600/1871—Optimal control; Kalman Filters
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Vehicle Body Suspensions (AREA)
Abstract
本发明涉及一种载人月球车悬架状态计算方法及系统,包括在载人月球车车体质心布置惯性测量组合模块,在独立悬架顶端布置加速度测量模块,在轮毂处布置加速度测量模块,对车体的垂向加速度、俯仰及侧倾角速度进行测量,对独立悬架和车轮的垂向加速度进行测量;建立载人月球车七自由度整车悬架系统垂向与角向运动微分方程;根据所述七自由度整车悬架系统垂向与角向运动微分方程,以悬架性能评价指标作为输出变量,建立载人月球车七自由度整车悬架系统状态方程;建立载人月球车悬架状态观测模型;按照卡尔曼预估计算方法进行运算,得到悬架状态量。
Description
技术领域
本发明涉及一种载人月球车悬架状态计算方法及系统,可用于载人月球车悬架控制,属于载人月球探测技术领域。
背景技术
载人月球车移动系统作为一个具有非线性、时变性、时滞性的多自由度复杂系统,行驶中的转向、加减速等都会引起车体振动,同时低重力环境和非结构崎岖月表都加剧了的振动效应。当振动达到一定的程度时,会影响载人月球车的正常行驶、零部件的疲劳寿命,直接影响航天员在车上的乘坐舒适性、操作稳定性和安全性。与无人月球车不同,载人月球车选用具有弹性的主动悬架系统来连接车身和车轮,作为衰减车体振动的主要装置,因此,悬架性能的直接决定了载人月球车的综合性能。为了提高载人月球车的操纵稳定性和平顺性,针对其主动悬架控制,研究人员提出了基于各种控制理论的控制器,然而这些理论均基于悬架参数完全精确可测量。车体质心垂向加速度、侧倾角加速度、俯仰角加速度、悬架动挠度及对车轮动载荷是体现悬架性能的主要指标,因此实时准确的获取车辆悬架状态参数是提高车辆半主动悬架的控制性能的前提。
传统的悬架状态计算方法主要是采用卡尔曼滤波器、改进型龙贝格预估法、鲁棒预估法、滑模预估法对1/4悬架或1/2悬架模型进行车速、车身姿态等状态量的计算。在传统悬架状态计算方法中,主要针对的是在地面环境单一路况的条件下,复杂路况下对车辆纵向车速算法研究很少,对车辆悬架状态估计准确度也不高,未见针对月面低重力环境条件下、复杂非结构月表的载人月球车悬架状态计算和平顺性研究。
为实现载人月球车在月面的操纵稳定性和平顺性,悬架状态信息在载人月球车主动悬架闭环控制中不可或缺。因此,有必要针对载人月球车提出一种基于多传感器测量融合和准确数学建模的悬架状态计算方法,能够适应月面复杂工况,并满足易于硬件实现、保证计算准确度和实时性的要求。
发明内容
本发明的技术解决问题是:克服现有技术的不足,提供了一种载人月球车悬架状态计算方法,用于进一步提高载人月球车的平顺性和稳定性控制。
本发明的技术解决方案是:
一种载人月球车悬架状态计算方法,包括:
在载人月球车车体质心布置惯性测量组合模块,在独立悬架顶端布置加速度测量模块,在轮毂处布置加速度测量模块,对车体的垂向加速度、俯仰及侧倾角速度进行测量,对独立悬架和车轮的垂向加速度进行测量;
建立载人月球车七自由度整车悬架系统垂向与角向运动微分方程;
根据所述七自由度整车悬架系统垂向与角向运动微分方程,以悬架性能评价指标作为输出变量,建立载人月球车七自由度整车悬架系统状态方程;
建立载人月球车悬架状态观测模型;
按照卡尔曼预估计算方法进行运算,得到悬架状态量。
进一步的,所述载人月球车七自由度整车悬架系统垂向与角向运动微分方程,具体为:
非簧载质量垂向运动方程为:
其中,m和mu分别为簧载质量和非簧载质量;z和zu分别为簧载质量和非簧载质量的垂向位移,和分别为簧载质量和非簧载质量的垂向速度,为车身质心处的垂向加速度;Ix、Iy分别为侧倾角加速度、俯仰角加速度、X轴和Y轴的转动惯量;k、c分别为悬架弹簧刚度和不可调节的阻尼系数;kt为轮胎刚度;f为磁流变阻尼器的可调阻尼力;q为车轮路面激励;dl、dr、df、db分别为质心到左轮、右轮、前轴及后轴的距离;
其中下标lf、rf、rr、lr分别表示左前、右前、右后、左后;
簧载质量的位移及速度为:
进一步的,所述载人月球车七自由度整车悬架系统状态方程,具体为:
x=[x1 x2 x3 x4 x5 x6 x7 x8 x9 x10 x11 x12 x13 x14 x15]T
状态变量x1~x4为左前、右前、右后和左后悬架的相对位移,状态变量x5~x8为左前、右前、右后和左后车轮的垂向位移,状态变量x9~x12为左前、右前、右后和左后车轮的垂向速度,状态变量x13~x15为车身质心处的垂向运动速度、侧倾角速度和俯仰角速度,得到:
其中,状态变量为左前、右前、右后和左后悬架垂向速度,状态变量为左前、右前、右后和左后车轮的垂向速度,状态变量为左前、右前、右后和左后车轮的垂向加速度,状态变量为车身质心处的垂向加速度、侧倾角加速度和俯仰角加速度,mf和mr分别为前悬架和后悬架承载的车体质量,kf和kr分别为前悬架和后悬架弹簧刚度,cf和cr分别为前悬架和后悬架阻尼系数;
悬架系统的四个可调阻尼力为系统的输入变量,表示为:
u=[flf frf frr flr]T
悬架系统的四轮路面激励为系统的扰动输入,表示为:
w=[qlf qrf qrr qlr]T
根据悬架系统的性能评价指标,选取系统的输出变量为:
则其状态方程、输出方程和各系数矩阵为:
其中系统状态矩阵A中右下角的系数为:
进一步的,所述载人月球车悬架状态观测模型,具体为:
其中,为测量计算值,Vk为测量噪声序列,其测量噪声功率矩阵由所使用的传感器特性决定;Zk为观测量,由传感器所采集的车身质心处的垂向加速度、俯仰角速度、侧倾角速度以及四个独立悬架上下两端的加速度构成,alf、arf、arr和alr分别为左前、右前、右后和左后悬架上端加速度,aulf、aurf、aurr和aulr分别为左前、右前、右后和左后悬架上端加速度,非线性函数h(x)代表了11个悬架状态的测量计算方程:
其中,h(1)、h(2)和h(3)分别为车体垂向加速度、侧倾角加速度和俯仰加速度;la和lb分别为质心到前、后轮轴的距离,lc和ld分别为质心到左、右轮的距离;
应用科里奥利效应得到,车身四角处的加速度与质心垂向加速度有关,其关系表示为:
ai=aCG+ω×(ω×ri)+α×ri
式中,aCG为车体质心的垂向加速度,aCG+ω×(ω×ri)+α×ri为转动加速度,ri是车身每个角在车体参考系下的反馈向量,i=lf、rf、rr、lr;α和ω为角向运动矩阵,表示为:
忽略车身的横摆运动,四个减振器上端连接车身处的垂向加速度经计算表示为:
四个轮毂处的垂向加速度表示为:
进一步的,所述按照卡尔曼预估计算方法进行运算,得到悬架状态量,具体为:
应用前一时刻的悬架状态参数和七自由度整车悬架系统垂向与角向运动微分方程做一次先验估计,再通过惯性测量组合模块和加速度测量模块采集的信号来更新估计状态,并结合状态信息进行加权计算获得准确的汽车悬架状态信息;
所述悬架状态参数包括:垂向加速度、侧倾角加速度、俯仰角加速度;
测量更新表示为:
式中,Pk(-)为先验估计协方差矩阵,Rk为测量噪声协方差矩阵,Hk为t=k时刻悬架状态先验估计的雅可比矩阵,可由泰勒级数展开得到
为了降低误差协方差矩阵为负的概率,通过下式进行修正:
其中,I为单位阵;
悬架状态的更新:
其中,uk为控制量矩阵,wk为高斯白噪声,上式中状态转移矩阵Ф(k+1,k)为指数矩阵:
Φ(k+1,k)=exp(AΔT)
ΔT为传感器采样周期;
则输入矩阵Bd表示为:
悬架状态的误差协方差更新为:
Pk+1(-)=Φ(k+1,k)Pk(-)Φ(k+1,k)T+Qk
式中,Qk为离散过程噪声功率,与连续过程白噪声协方差矩阵有关。
进一步的,本发明还提出一种载人月球车悬架状态计算系统,包括:
参数测量模块:在载人月球车车体质心布置惯性测量组合模块,在独立悬架顶端布置加速度测量模块,在轮毂处布置加速度测量模块,对车体的垂向加速度、俯仰及侧倾角速度进行测量,对独立悬架和车轮的垂向加速度进行测量;
微分方程建立模块:建立载人月球车七自由度整车悬架系统垂向与角向运动微分方程;
状态方程建立模块:根据所述七自由度整车悬架系统垂向与角向运动微分方程,以悬架性能评价指标作为输出变量,建立载人月球车七自由度整车悬架系统状态方程;
状态观测模型建立模块:建立载人月球车悬架状态观测模型;
悬架状态量计算模块:按照卡尔曼预估计算方法进行运算,得到悬架状态量。
本发明与现有技术相比的有益效果是:
(1)本发明所提出的载人月球车悬架状态计算方法建立了载人月球车主动悬架的整车七自由度运动状态方程,能够适应月面低重力环境条件下、复杂非结构地形中悬架状态的准确计算。
(2)本发明提出的载人月球车悬架状态计算方法具有高实时性,可以进一步应用于载人月球车悬架的闭环控制。
(3)本发明计算方法通过惯性测量单元和加速度计配置对载人月球车悬架振动的状态信息进行测量,并将其作为主动悬架系统的观测值,在建立七自由度整车模型系统状态方程的基础上,根据悬架状态变量、状态变量与悬架自身参数的数学关系建立观测方程,采用离散扩展卡尔曼滤波算法对悬架的状态信息进行计算,可用于进一步提高载人月球车的平顺性和稳定性控制。
附图说明
图1为本发明实施例中一种载人月球车悬架状态计算方法的流程图;
图2为本发明实施例中一种载人月球车七自由度整车悬架模型示意图;
图3为本发明实施例中卡尔曼预估计算方法步骤流程图;
图4为本发明实施例中对车体垂直加速度的计算结果示意图;
图5为本发明实施例中对车体侧倾角速度的计算结果示意图;
图6为本发明实施例中对车体俯仰角速度的计算结果示意图。
具体实施方式
下面结合附图对本发明的具体实施方式进行进一步的详细描述。
本发明提供一种载人月球车悬架状态计算方法。该方法通过惯性测量单元和加速度计配置对载人月球车悬架振动的状态信息进行测量,并将其作为主动悬架系统的观测值,在建立七自由度整车模型系统状态方程的基础上,根据悬架状态变量、状态变量与悬架自身参数的数学关系建立观测方程,采用离散扩展卡尔曼滤波算法对悬架的状态信息进行计算,可用于进一步提高载人月球车的平顺性和稳定性控制。下面结合附图对本发明方法进行详细说明。
如图1所示,本发明提出一种载人月球车悬架状态计算方法,包括如下步骤:
步骤一:在载人月球车车体质心布置惯性测量组合模块,在独立悬架顶端布置加速度测量模块,在轮毂处布置加速度测量模块,对车体的垂向加速度、俯仰及侧倾角速度进行测量,对独立悬架和车轮的垂向加速度进行测量;
步骤二:建立载人月球车七自由度整车悬架系统垂向与角向运动微分方程:
非簧载质量垂向运动方程为:
其中,m和mu分别为簧载质量和非簧载质量;z和zu分别为簧载质量和非簧载质量的垂向位移,和分别为簧载质量和非簧载质量的垂向速度,为车身质心处的垂向加速度;Ix、Iy分别为侧倾角加速度、俯仰角加速度、X轴和Y轴的转动惯量;k、c分别为悬架弹簧刚度和不可调节的阻尼系数;kt为轮胎刚度;f为磁流变阻尼器的可调阻尼力;q为车轮路面激励;dl、dr、df、db分别为质心到左轮、右轮、前轴及后轴的距离;
其中下标lf、rf、rr、lr分别表示左前、右前、右后、左后;
步骤三:根据步骤二中建立的悬架动力学运动微分方程组,以悬架性能评价指标作为输出变量,建立载人月球车七自由度整车悬架系统状态方程:
x=[x1 x2 x3 x4 x5 x6 x7 x8 x9 x10 x11 x12 x13 x14 x15]T
状态变量x1~x4为左前、右前、右后和左后悬架的相对位移,状态变量x5~x8为左前、右前、右后和左后车轮的垂向位移,状态变量x9~x12为左前、右前、右后和左后车轮的垂向速度,状态变量x13~x15为车身质心处的垂向运动速度、侧倾角速度和俯仰角速度。
可得到:
其中,状态变量为左前、右前、右后和左后悬架垂向速度,状态变量为左前、右前、右后和左后车轮的垂向速度,状态变量为左前、右前、右后和左后车轮的垂向加速度,状态变量为车身质心处的垂向加速度、侧倾角加速度和俯仰角加速度,mf和mr分别为前悬架和后悬架承载的车体质量,kf和kr分别为前悬架和后悬架弹簧刚度,cf和cr分别为前悬架和后悬架阻尼系数;
悬架系统的四个可调阻尼力为系统的输入变量,可表示为:
u=[flf frf frr flr]T
悬架系统的四轮路面激励为系统的扰动输入,可表示为:
w=[qlf qrf qrr qlr]T
根据悬架系统的性能评价指标,选取系统的输出变量为:
则其状态方程、输出方程和各系数矩阵为:
其中系统状态矩阵A中右下角的系数为:
步骤四:建立载人月球车悬架状态观测模型:
其中,为测量计算值,Vk为测量噪声序列,其测量噪声功率矩阵由所使用的传感器特性决定;Zk为观测量,由传感器所采集的车身质心处的垂向加速度、俯仰角速度、侧倾角速度以及四个独立悬架上下两端的加速度构成,alf、arf、arr和alr分别为左前、右前、右后和左后悬架上端加速度,aulf、aurf、aurr和aulr分别为左前、右前、右后和左后悬架上端加速度,非线性函数h(x)代表了11个悬架状态的测量计算方程:
其中,h(1)、h(2)和h(3)分别为车体垂向加速度、侧倾角加速度和俯仰加速度;la和lb分别为质心到前、后轮轴的距离,lc和ld分别为质心到左、右轮的距离。
应用科里奥利效应可得到,车身四角处的加速度与质心垂向加速度有关,其关系可表示为:
ai=aCG+ω×(ω×ri)+α×ri
式中,aCG为车体质心的垂向加速度,aCG+ω×(ω×ri)+α×ri为转动加速度,ri是车身每个角在车体参考系下的反馈向量,i=lf、rf、rr、lr;α和ω为角向运动矩阵,表示为:
忽略车身的横摆运动,四个减振器上端连接车身处的垂向加速度经计算表示为:
四个轮毂处的垂向加速度表示为:
步骤五:通过悬架状态及测量方程中非线性部分用泰勒级数展开省略高次项得到离散状态及测量方程,然后按照经典卡尔曼预估计算方法进行运算,得到悬架状态量:
应用前一时刻的悬架状态参数和七自由度整车悬架系统垂向与角向运动微分方程做一次先验估计,再通过惯性测量组合模块和加速度测量模块采集的信号来更新估计状态,并结合状态信息进行加权计算获得准确的汽车悬架状态信息。测量更新表示为:
式中,Pk(-)为先验估计协方差矩阵,Rk为测量噪声协方差矩阵,Hk为t=k时刻悬架状态先验估计的雅可比矩阵,可由泰勒级数展开得到
为了降低误差协方差矩阵为负的概率,通过下式进行修正:
其中,I为单位阵;
悬架状态的更新:
其中,uk为控制量矩阵,wk为高斯白噪声,上式中状态转移矩阵Ф(k+1,k)为指数矩阵:
Φ(k+1,k)=exp(AΔT)
ΔT为传感器采样周期;
则输入矩阵Bd表示为:
悬架状态的误差协方差更新为:
Pk+1(-)=Φ(k+1,k)Pk(-)Φ(k+1,k)T+Qk
式中,Qk为离散过程噪声功率,与连续过程白噪声协方差矩阵有关。
本发明还提出一种载人月球车悬架状态计算系统,包括:
参数测量模块:在载人月球车车体质心布置惯性测量组合模块,在独立悬架顶端布置加速度测量模块,在轮毂处布置加速度测量模块,对车体的垂向加速度、俯仰及侧倾角速度进行测量,对独立悬架和车轮的垂向加速度进行测量;
微分方程建立模块:建立载人月球车七自由度整车悬架系统垂向与角向运动微分方程;
状态方程建立模块:根据所述七自由度整车悬架系统垂向与角向运动微分方程,以悬架性能评价指标作为输出变量,建立载人月球车七自由度整车悬架系统状态方程;
状态观测模型建立模块:建立载人月球车悬架状态观测模型;
悬架状态量计算模块:按照卡尔曼预估计算方法进行运算,得到悬架状态量。
实施例:
参照图1,示出了本发明实施例中一种载人月球车悬架状态计算方法的步骤流程图。在本发明实施例子中,所述载人月球车悬架状态计算方法,包括:
步骤S1,惯性测量模块和加速度测量模块对车体加速度和角速度以及悬架、车轮加速度进行测量。
在本实施例中,在载人月球车车体质心布置惯性测量组合模块用于测量车体角向运动速度及载体坐标系内沿坐标轴的加速度,在四个独立悬架上下两端布置加速度测量模块,分别测量车辆悬架和非簧载质量的运动状态。
步骤S2,建立载人月球车七自由度整车悬架系统垂向与角向运动微分方程。
为方便建模需要简化载人月球车模型:1)轮毂、轮轴、车架是刚性连接。2)将车轮当作弹性元件处理且始终与路面接触。3)将车辆悬架和车轮当作具有一定刚度的弹簧处理。4)车身始终垂直于路面。
整车悬架模型包括七个自由度:分别是车体垂向运动、车体俯仰运动、车体侧倾运动和四个车轮的垂向运动,七自由度悬架模型参见图2。车身垂向、侧倾和俯仰运动微分方程为:
非簧载质量垂向运动方程为:
其中,m、mu分别为簧载质量和非簧载质量;z为车身质心处的垂向位移;z、zu分别为簧载质量和非簧载质量的垂向位移;θ、Ix、Iy分别为侧倾角、俯仰角、X轴和Y轴的转动惯量;k、c分别为悬架弹簧刚度和不可调节的阻尼系数;kt为轮胎刚度;f为磁流变阻尼器的可调阻尼力;q为车轮路面激励;dl、dr、df、db分别为质心到左轮、右轮、前轴及后轴的距离。其中下标lf、rf、rr、lr分别表示左前、右前、右后、左后。
将式(3)代入式(1)和式(2)可得到载人月球车悬架模型的方程组为:
步骤S3,建立载人月球车七自由度整车悬架系统状态方程。
根据悬架模型、式(4)和式(5)表示的悬架动力学运动微分方程组,选取影响平顺性和操控稳定性的悬架状态参数作为系统的状态变量,建立悬架系统的状态方程,并以悬架性能评价指标作为输出变量,建立输出方程。
建立载人月球车七自由度整车悬架系统状态方程为:
x=[x1 x2 x3 x4 x5 x6 x7 x8 x9 x10 x11 x12 x13 x14 x15]T (6)
其中,状态变量x1~x4为左前、右前、右后和左后悬架的相对位移,状态变量x5~x12为左前、右前、右后和左后车轮的垂向位移和速度,状态变量x13~x15为车身质心处的垂向运动速度、侧倾角速度和俯仰角速度,可得:
悬架系统的四个可调阻尼力为系统的输入变量,可表示为:
u=[flf frf frr flr]T (7)
悬架系统的四轮路面激励为系统的扰动输入,可表示为:
w=[qlf qrf qrr qlr]T (8)
根据悬架系统的性能评价指标,选取系统的输出变量为:
则其状态方程、输出方程和各系数矩阵为:
其中系统状态矩阵A中右下角的系数为:
步骤S4,建立载人月球车悬架状态观测模型:
其中,为测量计算值,Vk为测量噪声序列,其测量噪声功率矩阵由所使用的传感器特性决定;Zk为观测量,由传感器所采集的车身质心处的垂向加速度、俯仰角速度、侧倾角速度以及四个独立悬架上下两端的加速度构成,alf、arf、arr和alr分别为左前、右前、右后和左后悬架上端加速度,aulf、aurf、aurr和aulr分别为左前、右前、右后和左后悬架上端加速度,非线性函数h(x)代表了11个悬架状态的测量计算方程:
其中,h(1)、h(2)和h(3)分别为车体垂向加速度、侧倾角加速度和俯仰加速度;la和lb分别为质心到前、后轮轴的距离,lc和ld分别为质心到左、右轮的距离。
应用科里奥利效应可得到,车身四角处的加速度与质心垂向加速度有关,其关系可表示为:
ai=aCG+ω×(ω×ri)+α×ri
式中,aCG为车体质心的垂向加速度,aCG+ω×(ω×ri)+α×ri为转动加速度,ri是车身每个角在车体参考系下的反馈向量,i=lf、rf、rr、lr;α和ω为角向运动矩阵,表示为:
忽略车身的横摆运动,四个减振器上端连接车身处的垂向加速度经计算表示为:
四个轮毂处的垂向加速度表示为:
步骤S5,通过卡尔曼预估方法进行运算,得到悬架状态量。
参考载人月球车悬架模型参数设定模型参数,如下表:
以上表参数为输入代入步骤S4中悬架状态方程,路面激励利用滤波白噪声随机路面输入产生路面不平度时间轮廓,运用已建立的路,面激励模型,仿真实验条件设定为中等车速5km/h,路面等级设定B级,通过悬架状态及测量方程中非线性部分用泰勒级数展开省略高次项得到离散状态及测量方程,然后按照经典卡尔曼预估计算方法进行运算,卡尔曼预估算法步骤参见图3,经算法预测估计,得到载人月球车悬架状态量,包括车体垂向俯仰侧倾方向的动态参数、悬架振动参数和车轮的振动参数,参见图4~图6。
下表为载人月球车悬架各状态参数计算值与参考值的均方根误差。
悬架状态参数 | 均方根误差 |
车体垂向加速度 | 0.0683 |
车体侧倾角速度 | 0.0577 |
车体俯仰角速度 | 0.0701 |
上表各状态参数的计算值和参考值之间的均方根误差很小,表明了计算值偏离真值小,算法精度高,验证了本发明可应用于载人月球车主动悬架状态参数的计算,能够实现载人月球车悬架状态的实时、有效计算,进一步应用于载人月球车悬架的闭环控制。
本发明说明书中未作详细描述的内容属于本领域技术人员的公知技术。
Claims (10)
1.一种载人月球车悬架状态计算方法,其特征在于包括:
在载人月球车车体质心布置惯性测量组合模块,在独立悬架顶端布置加速度测量模块,在轮毂处布置加速度测量模块,对车体的垂向加速度、俯仰及侧倾角速度进行测量,对独立悬架和车轮的垂向加速度进行测量;
建立载人月球车七自由度整车悬架系统垂向与角向运动微分方程;
根据所述七自由度整车悬架系统垂向与角向运动微分方程,以悬架性能评价指标作为输出变量,建立载人月球车七自由度整车悬架系统状态方程;
建立载人月球车悬架状态观测模型;
按照卡尔曼预估计算方法进行运算,得到悬架状态量。
2.根据权利要求1所述的一种载人月球车悬架状态计算方法,其特征在于:所述载人月球车七自由度整车悬架系统垂向与角向运动微分方程,具体为:
非簧载质量垂向运动方程为:
其中,m和mu分别为簧载质量和非簧载质量;z和zu分别为簧载质量和非簧载质量的垂向位移,和分别为簧载质量和非簧载质量的垂向速度,为车身质心处的垂向加速度;Ix、Iy分别为侧倾角加速度、俯仰角加速度、X轴和Y轴的转动惯量;k、c分别为悬架弹簧刚度和不可调节的阻尼系数;kt为轮胎刚度;f为磁流变阻尼器的可调阻尼力;q为车轮路面激励;dl、dr、df、db分别为质心到左轮、右轮、前轴及后轴的距离;
其中下标lf、rf、rr、lr分别表示左前、右前、右后、左后;
簧载质量的位移及速度为:
3.根据权利要求2所述的一种载人月球车悬架状态计算方法,其特征在于:所述载人月球车七自由度整车悬架系统状态方程,具体为:
x=[x1 x2 x3 x4 x5 x6 x7 x8 x9 x10 x11 x12 x13 x14 x15]T
状态变量x1~x4为左前、右前、右后和左后悬架的相对位移,状态变量x5~x8为左前、右前、右后和左后车轮的垂向位移,状态变量x9~x12为左前、右前、右后和左后车轮的垂向速度,状态变量x13~x15为车身质心处的垂向运动速度、侧倾角速度和俯仰角速度,得到:
其中,状态变量为左前、右前、右后和左后悬架垂向速度,状态变量为左前、右前、右后和左后车轮的垂向速度,状态变量为左前、右前、右后和左后车轮的垂向加速度,状态变量为车身质心处的垂向加速度、侧倾角加速度和俯仰角加速度,mf和mr分别为前悬架和后悬架承载的车体质量,kf和kr分别为前悬架和后悬架弹簧刚度,cf和cr分别为前悬架和后悬架阻尼系数;
悬架系统的四个可调阻尼力为系统的输入变量,表示为:
u=[flf frf frr flr]T
悬架系统的四轮路面激励为系统的扰动输入,表示为:
w=[qlf qrf qrr qlr]T
根据悬架系统的性能评价指标,选取系统的输出变量为:
则其状态方程、输出方程和各系数矩阵为:
其中系统状态矩阵A中右下角的系数为:
4.根据权利要求3所述的一种载人月球车悬架状态计算方法,其特征在于:所述载人月球车悬架状态观测模型,具体为:
其中,为测量计算值,Vk为测量噪声序列,其测量噪声功率矩阵由所使用的传感器特性决定;Zk为观测量,由传感器所采集的车身质心处的垂向加速度、俯仰角速度、侧倾角速度以及四个独立悬架上下两端的加速度构成,alf、arf、arr和alr分别为左前、右前、右后和左后悬架上端加速度,aulf、aurf、aurr和aulr分别为左前、右前、右后和左后悬架上端加速度,非线性函数h(x)代表了11个悬架状态的测量计算方程:
其中,h(1)、h(2)和h(3)分别为车体垂向加速度、侧倾角加速度和俯仰加速度;la和lb分别为质心到前、后轮轴的距离,lc和ld分别为质心到左、右轮的距离;
应用科里奥利效应得到,车身四角处的加速度与质心垂向加速度有关,其关系表示为:
ai=aCG+ω×(ω×ri)+α×ri
式中,aCG为车体质心的垂向加速度,aCG+ω×(ω×ri)+α×ri为转动加速度,ri是车身每个角在车体参考系下的反馈向量,i=lf、rf、rr、lr;α和ω为角向运动矩阵,表示为:
忽略车身的横摆运动,四个减振器上端连接车身处的垂向加速度经计算表示为:
四个轮毂处的垂向加速度表示为:
5.根据权利要求4所述的一种载人月球车悬架状态计算方法,其特征在于:所述按照卡尔曼预估计算方法进行运算,得到悬架状态量,具体为:
应用前一时刻的悬架状态参数和七自由度整车悬架系统垂向与角向运动微分方程做一次先验估计,再通过惯性测量组合模块和加速度测量模块采集的信号来更新估计状态,并结合状态信息进行加权计算获得准确的汽车悬架状态信息;
所述悬架状态参数包括:垂向加速度、侧倾角加速度、俯仰角加速度;
测量更新表示为:
式中,Pk(-)为先验估计协方差矩阵,Rk为测量噪声协方差矩阵,Hk为t=k时刻悬架状态先验估计的雅可比矩阵,可由泰勒级数展开得到
为了降低误差协方差矩阵为负的概率,通过下式进行修正:
其中,I为单位阵;
悬架状态的更新:
其中,uk为控制量矩阵,wk为高斯白噪声,上式中状态转移矩阵Ф(k+1,k)为指数矩阵:
Φ(k+1,k)=exp(AΔT)
ΔT为传感器采样周期;
则输入矩阵Bd表示为:
悬架状态的误差协方差更新为:
Pk+1(-)=Φ(k+1,k)Pk(-)Φ(k+1,k)T+Qk
式中,Qk为离散过程噪声功率,与连续过程白噪声协方差矩阵有关。
6.一种载人月球车悬架状态计算系统,其特征在于包括:
参数测量模块:在载人月球车车体质心布置惯性测量组合模块,在独立悬架顶端布置加速度测量模块,在轮毂处布置加速度测量模块,对车体的垂向加速度、俯仰及侧倾角速度进行测量,对独立悬架和车轮的垂向加速度进行测量;
微分方程建立模块:建立载人月球车七自由度整车悬架系统垂向与角向运动微分方程;
状态方程建立模块:根据所述七自由度整车悬架系统垂向与角向运动微分方程,以悬架性能评价指标作为输出变量,建立载人月球车七自由度整车悬架系统状态方程;
状态观测模型建立模块:建立载人月球车悬架状态观测模型;
悬架状态量计算模块:按照卡尔曼预估计算方法进行运算,得到悬架状态量。
7.根据权利要求6所述的一种载人月球车悬架状态计算系统,其特征在于:所述载人月球车七自由度整车悬架系统垂向与角向运动微分方程,具体为:
非簧载质量垂向运动方程为:
其中,m和mu分别为簧载质量和非簧载质量;z和zu分别为簧载质量和非簧载质量的垂向位移,和分别为簧载质量和非簧载质量的垂向速度,为车身质心处的垂向加速度;Ix、Iy分别为侧倾角加速度、俯仰角加速度、X轴和Y轴的转动惯量;k、c分别为悬架弹簧刚度和不可调节的阻尼系数;kt为轮胎刚度;f为磁流变阻尼器的可调阻尼力;q为车轮路面激励;dl、dr、df、db分别为质心到左轮、右轮、前轴及后轴的距离;
其中下标lf、rf、rr、lr分别表示左前、右前、右后、左后;
簧载质量的位移及速度为:
8.根据权利要求7所述的一种载人月球车悬架状态计算系统,其特征在于:所述载人月球车七自由度整车悬架系统状态方程,具体为:
x=[x1 x2 x3 x4 x5 x6 x7 x8 x9 x10 x11 x12 x13 x14 x15]T
状态变量x1~x4为左前、右前、右后和左后悬架的相对位移,状态变量x5~x8为左前、右前、右后和左后车轮的垂向位移,状态变量x9~x12为左前、右前、右后和左后车轮的垂向速度,状态变量x13~x15为车身质心处的垂向运动速度、侧倾角速度和俯仰角速度,得到:
其中,状态变量为左前、右前、右后和左后悬架垂向速度,状态变量为左前、右前、右后和左后车轮的垂向速度,状态变量为左前、右前、右后和左后车轮的垂向加速度,状态变量为车身质心处的垂向加速度、侧倾角加速度和俯仰角加速度,mf和mr分别为前悬架和后悬架承载的车体质量,kf和kr分别为前悬架和后悬架弹簧刚度,cf和cr分别为前悬架和后悬架阻尼系数;
悬架系统的四个可调阻尼力为系统的输入变量,表示为:
u=[flf frf frr flr]T
悬架系统的四轮路面激励为系统的扰动输入,表示为:
w=[qlf qrf qrr qlr]T
根据悬架系统的性能评价指标,选取系统的输出变量为:
则其状态方程、输出方程和各系数矩阵为:
其中系统状态矩阵A中右下角的系数为:
9.根据权利要求8所述的一种载人月球车悬架状态计算系统,其特征在于:所述载人月球车悬架状态观测模型,具体为:
其中,为测量计算值,Vk为测量噪声序列,其测量噪声功率矩阵由所使用的传感器特性决定;Zk为观测量,由传感器所采集的车身质心处的垂向加速度、俯仰角速度、侧倾角速度以及四个独立悬架上下两端的加速度构成,alf、arf、arr和alr分别为左前、右前、右后和左后悬架上端加速度,aulf、aurf、aurr和aulr分别为左前、右前、右后和左后悬架上端加速度,非线性函数h(x)代表了11个悬架状态的测量计算方程:
其中,h(1)、h(2)和h(3)分别为车体垂向加速度、侧倾角加速度和俯仰加速度;la和lb分别为质心到前、后轮轴的距离,lc和ld分别为质心到左、右轮的距离;
应用科里奥利效应得到,车身四角处的加速度与质心垂向加速度有关,其关系表示为:
ai=aCG+ω×(ω×ri)+α×ri
式中,aCG为车体质心的垂向加速度,aCG+ω×(ω×ri)+α×ri为转动加速度,ri是车身每个角在车体参考系下的反馈向量,i=lf、rf、rr、lr;α和ω为角向运动矩阵,表示为:
忽略车身的横摆运动,四个减振器上端连接车身处的垂向加速度经计算表示为:
四个轮毂处的垂向加速度表示为:
10.根据权利要求9所述的一种载人月球车悬架状态计算系统,其特征在于:所述按照卡尔曼预估计算方法进行运算,得到悬架状态量,具体为:
应用前一时刻的悬架状态参数和七自由度整车悬架系统垂向与角向运动微分方程做一次先验估计,再通过惯性测量组合模块和加速度测量模块采集的信号来更新估计状态,并结合状态信息进行加权计算获得准确的汽车悬架状态信息;
所述悬架状态参数包括:垂向加速度、侧倾角加速度、俯仰角加速度;
测量更新表示为:
式中,Pk(-)为先验估计协方差矩阵,Rk为测量噪声协方差矩阵,Hk为t=k时刻悬架状态先验估计的雅可比矩阵,可由泰勒级数展开得到
为了降低误差协方差矩阵为负的概率,通过下式进行修正:
其中,I为单位阵;
悬架状态的更新:
其中,uk为控制量矩阵,wk为高斯白噪声,上式中状态转移矩阵Ф(k+1,k)为指数矩阵:
Φ(k+1,k)=exp(AΔT)
ΔT为传感器采样周期;
则输入矩阵Bd表示为:
悬架状态的误差协方差更新为:
Pk+1(-)=Φ(k+1,k)Pk(-)Φ(k+1,k)T+Qk
式中,Qk为离散过程噪声功率,与连续过程白噪声协方差矩阵有关。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210554602.6A CN114953886A (zh) | 2022-05-19 | 2022-05-19 | 一种载人月球车悬架状态计算方法及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210554602.6A CN114953886A (zh) | 2022-05-19 | 2022-05-19 | 一种载人月球车悬架状态计算方法及系统 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN114953886A true CN114953886A (zh) | 2022-08-30 |
Family
ID=82985222
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210554602.6A Pending CN114953886A (zh) | 2022-05-19 | 2022-05-19 | 一种载人月球车悬架状态计算方法及系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114953886A (zh) |
-
2022
- 2022-05-19 CN CN202210554602.6A patent/CN114953886A/zh active Pending
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108594652B (zh) | 一种基于观测器信息迭代的车辆状态融合估计方法 | |
CN111845775B (zh) | 一种分布式驱动电动汽车行驶状态与惯性参数联合估计方法 | |
WO2020052367A1 (zh) | 基于车辆位姿偏差的惯性调控主动悬挂系统及控制方法 | |
CN106970524B (zh) | 用于主动悬架的车辆侧倾运动安全线性二次型最优lqg控制器设计方法 | |
CN110588657B (zh) | 一种针对车辆运动状态及道路坡度的联合估计方法 | |
CN112009577B (zh) | 一种用于重卡驾驶室半主动悬置的控制方法 | |
CN111796522B (zh) | 一种车辆状态估计方法 | |
CN115406446A (zh) | 基于神经网络与无迹卡尔曼滤波的多轴特种车状态估计方法 | |
JP2020117196A (ja) | 車両運動状態推定装置 | |
CN109204599B (zh) | 基于同轴式轮腿结构的主动姿态与全轮转向协同控制方法 | |
CN114953886A (zh) | 一种载人月球车悬架状态计算方法及系统 | |
CN113071282B (zh) | 一种车辆调节方法及装置 | |
CN116766853A (zh) | 主动悬架车辆及其控制方法 | |
CN116049608A (zh) | 一种非结构性路面下的路面峰值附着系数估计方法及系统 | |
CN112590483B (zh) | 一种基于观测器的汽车横向稳定性与主动悬架多目标集成控制方法 | |
CN108595817A (zh) | 一种基于观测器的半主动悬架汽车侧倾参数在线估计方法 | |
CN113449378A (zh) | 一种基于车辆悬架变形量的横向载荷转移率计算方法 | |
CN114834263A (zh) | 电动汽车主动前轮转向与扭矩矢量的协调控制方法及装置 | |
CN112784355A (zh) | 一种基于多体动力学的十四自由度车辆动力学模型建模方法 | |
Ukamnal et al. | Design of Trailing Arm Suspension | |
CN113650621B (zh) | 面向复杂工况的分布式驱动电动汽车状态参数估计方法 | |
Mihon et al. | The behaviour of a vehicle’s suspension system on dynamic testing conditions | |
CN111814258A (zh) | 用于四轮独立电驱动车辆线控转向系统传动比的设计方法 | |
Biglarbegian et al. | Design of a novel fuzzy controller to enhance stability of vehicles | |
CN112613125B (zh) | 一种路面激励情况下汽车侧倾中心辨识和动态修正的方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination |