CN113865616B - 车辆悬架姿态测量方法和测量*** - Google Patents
车辆悬架姿态测量方法和测量*** Download PDFInfo
- Publication number
- CN113865616B CN113865616B CN202111448813.3A CN202111448813A CN113865616B CN 113865616 B CN113865616 B CN 113865616B CN 202111448813 A CN202111448813 A CN 202111448813A CN 113865616 B CN113865616 B CN 113865616B
- Authority
- CN
- China
- Prior art keywords
- motion
- acceleration
- measurement
- coordinate system
- shock absorber
- 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.)
- Active
Links
- 239000000725 suspension Substances 0.000 title claims abstract description 141
- 238000005259 measurement Methods 0.000 title claims abstract description 92
- 238000000691 measurement method Methods 0.000 title claims abstract description 22
- 230000001133 acceleration Effects 0.000 claims abstract description 95
- 239000006096 absorbing agent Substances 0.000 claims abstract description 59
- 230000035939 shock Effects 0.000 claims abstract description 59
- 239000011159 matrix material Substances 0.000 claims abstract description 49
- 230000005484 gravity Effects 0.000 claims abstract description 38
- 238000000034 method Methods 0.000 claims abstract description 25
- 238000004364 calculation method Methods 0.000 claims abstract description 24
- 238000012545 processing Methods 0.000 claims abstract description 9
- 238000012937 correction Methods 0.000 claims description 53
- 238000006073 displacement reaction Methods 0.000 claims description 41
- 230000008569 process Effects 0.000 abstract description 9
- 238000001514 detection method Methods 0.000 abstract description 5
- 230000006872 improvement Effects 0.000 description 13
- 238000001914 filtration Methods 0.000 description 3
- 238000009434 installation Methods 0.000 description 3
- 238000013461 design Methods 0.000 description 2
- 230000010354 integration Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 230000009466 transformation Effects 0.000 description 2
- 102000002274 Matrix Metalloproteinases Human genes 0.000 description 1
- 108010000684 Matrix Metalloproteinases Proteins 0.000 description 1
- 238000005299 abrasion Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000007774 longterm Effects 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C23/00—Combined instruments indicating more than one navigational value, e.g. for aircraft; Combined measuring devices for measuring two or more variables of movement, e.g. distance, speed or acceleration
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01M—TESTING STATIC OR DYNAMIC BALANCE OF MACHINES OR STRUCTURES; TESTING OF STRUCTURES OR APPARATUS, NOT OTHERWISE PROVIDED FOR
- G01M17/00—Testing of vehicles
- G01M17/007—Wheeled or endless-tracked vehicles
- G01M17/04—Suspension or damping
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Aviation & Aerospace Engineering (AREA)
- Vehicle Body Suspensions (AREA)
Abstract
本发明中公开了一种车辆悬架姿态测量方法和测量***,该测量方法和测量***在测量处理过程中通过姿态解算得到方向余弦矩阵,将载体加速度数据换算到惯性坐标系,同时消除重力的影响,能够对车轮支架和车身在车辆悬架运动边界内的运动(非车辆行驶的运动)进行准确的测量,使得到的减振器伸缩运动数据更加精确;同时具有很好的低频或0频测量精度,在测量过程中不受地形和车辆姿态的影响,能够准确测量车辆悬架***中关键点的位姿运动状态,为车辆悬架***的检测、控制提供可靠的参考。
Description
技术领域
本发明涉及车辆悬架状态检测技术领域,特别涉及一种车辆悬架姿态测量方法和测量***。
背景技术
悬架***作为车辆的重要组成部分,直接影响到车辆的平顺性和操作稳定性。在可调悬架***(半主动悬架和主动悬架***)中,对车辆悬架位姿的测量是必不可少的。目前,悬架***位姿测量主要通过在车辆车身(簧上)和车轮支架(簧下)之间安装加速度传感器或者位移传感器来实现;采用这种检测方式时,由于车辆行驶过程中位姿在随时变化的,因此往往存在重力对检测结果造成影响的问题。如果采用压电式的加速度传感器,则对于0频甚至低频状态的加速度测量不准确;而如果采用位移传感器,由于其测量的是车身和车轮支架之间的相对位移,无法准确解算车身和车轮支架在悬架***中各自的运动状态,并且位移传感器作为相对运动部件对车辆底盘的安装空间要求较高,使用场景受到很大的限制。因此目前在对车辆悬架姿态的准确测量方面还存在诸多的问题,难以进行有效的推广应用。
发明内容
本发明针对目前在车辆悬架姿态测量方面存在的准确性不高、实用性不强等问题,提供一种车辆悬架姿态测量方法和测量***。
为解决上述技术问题,本发明采用的技术方案如下:
车辆悬架姿态测量方法,包括以下步骤:
S1.选取位于悬架弹簧上方的至少一个测量位置和位于悬架弹簧下方的至少一个测量位置,获取测量位置处的运动参数,所述运动参数包括测量位置处的角速度数据、加速度数据;
S2.根据获取的角速度数据得到方向余弦矩阵;
S3.根据获取的加速度数据对方向余弦矩阵进行修正;
S4.根据修正后的方向余弦矩阵,将测量得到的载体坐标系下的运动加速度转换为惯性坐标系下的运动加速度,对得到的惯性坐标系下的运动加速度进行处理,消除由重力所带来的影响;
S5.根据处理后的惯性坐标系下的运动加速度得到测量位置处的运动加速度,对得到的测量位置处的运动加速度积分得到测量位置处的运动速度;
S6.对测量位置处的运动速度进行误差修正,并对修正后的运动速度积分得到测量位置处的运动位移;
S7.对测量位置处的运动位移进行误差修正,得到修正后的运动位移;
测量得到车辆悬架对应测量位置处的运动数据,包括运动加速度、运动速度和运动位移。
作为对本发明技术方案的进一步改进,根据测量得到的车辆悬架对应测量位置处的运动数据,计算减振器的伸缩运动数据,并对减振器的伸缩运动数据进行误差修正,得到修正后的减振器运动速度、运动位移。
作为对本发明技术方案的进一步改进,所述步骤S2中,根据获取的角速度数据得到方向余弦矩阵,包括以下步骤:
将得到的微分方程进行离散化微分运算得到:
其中,I为单位矩阵,t+T为当前时刻,T为离散的时间周期,t为上一次计算的时刻;
作为对本发明技术方案的进一步改进,所述步骤S3中,根据获取的加速度数据对方向余弦矩阵进行修正,包括以下步骤:
其中,vx、vy、vz分别为重力向量vg分解到x、y、z方向上的分量;
由于ag与vg为同一物理量,得到两者之间的误差为:
其中,ex、ey、ez分别为误差eg在x、y、z方向上的分量;
得到测量位置处修正后的角速度向量w*为:w*=f(w,eg);
作为对本发明技术方案的进一步改进,所述步骤S4包括以下步骤:
作为对本发明技术方案的进一步改进,所述步骤S5包括以下步骤:
计算位于悬架弹簧下方测量位置处的运动加速度at为:
计算位于悬架弹簧上方测量位置处的运动加速度ac为:
对得到的运动加速度at、ac积分得到悬架弹簧下方测量位置与悬架弹簧上方测量位置处的运动速度vt、vc,其中:
作为对本发明技术方案的进一步改进,所述步骤S6包括以下步骤:
对测量位置处的运动速度vt、vc进行误差修正,得到对应测量位置处修正后的运动速度vt *、vc *,分别为:
其中,eat、eac分别为悬架弹簧下方测量位置和悬架弹簧上方测量位置处的加速度误差修正参数;
并使当修正计算的时间大于第一阈值时,则vt *、vc *趋于0,当修正计算的时间小于第二阈值时,则vt *、vc *小于车辆悬架的最大速度值;
对修正后的运动速度积分得到悬架弹簧下方测量位置与悬架弹簧上方测量位置处的运动位移st、sc,分别为:
st=∫vt *,
sc=∫vc *。
作为对本发明技术方案的进一步改进,所述步骤S7中,对测量位置处的运动位移进行误差修正,得到对应测量位置处修正后的运动位移st *、sc *,分别为:
st *=∫(vt *+evt),
sc *=∫(vc *+evc);
其中,evt、evc分别为悬架弹簧下方测量位置和悬架弹簧上方测量位置处的速度误差修正参数;
并使当修正计算的时间大于第一阈值时,则st *、sc *趋于0,当修正计算的时间小于第二阈值时,则st *、sc *小于对应测量位置处车辆悬架的最大位移值。
作为对本发明技术方案的进一步改进,所述根据测量得到的车辆悬架对应测量位置处的运动数据计算减振器的伸缩运动数据,包括以下步骤:
设定悬架弹簧上方测量位置和悬架弹簧下方测量位置处的运动速度分别为vup和vdown、运动位移分别为sup和sdown;
根据车辆悬架的运动学几何模型计算得到减振器的伸缩运动数据,包括:
减振器的伸缩运动速度Vdamper为:vdamper=f(vup,vdown),
减振器的伸缩运动位移sdamper为:sdamper=f(sup,sdown)。
作为对本发明技术方案的进一步改进,对减振器的伸缩运动数据进行误差修正,得到修正后的减振器伸缩运动数据分别为:
修正后的减振器伸缩运动速度vdamper *为:
vdamper *=vdamper+evdamper,
修正后的减振器伸缩运动位移sdamper *为:
sdamper *=∫vdamper *;
并使当修正计算的时间大于第一阈值时,sdamper *趋于0,当修正计算的时间小于第二阈值时,则sdamper *小于减振器的最大行程;
其中,evdamper为减振器伸缩运动速度的修正参数。
作为对本发明技术方案的进一步改进,所述第一阈值为车轮和车身固有频率周期的5倍,所述第二阈值为车轮和车身固有频率周期的1/2。
作为对本发明技术方案的进一步改进,所述位于悬架弹簧上方的测量位置位于靠近减振器与车身连接点位置的车身上,所述位于悬架弹簧下方的测量位置位于车轮车架或减振器缸筒外壁上。
作为对本发明技术方案的进一步改进,在测量位置处分别设置IMU模块,以获取对应测量位置处的运动参数。
本发明还涉及一种车辆悬架姿态测量***,包括:
设置于各车轮所对应悬架弹簧上方测量位置和悬架弹簧下方测量位置处的参数采集模块,所述参数采集模块用于采集测量位置处的运动参数;
车辆悬架姿态测量模块,所述车辆悬架姿态测量模块获取参数采集模块采集的运动参数,并采用车辆悬架姿态测量方法,测量得到对应车辆悬架和减振器伸缩运动的运动数据。
本发明所具有的有益效果:
1)本发明测量方法在处理过程中通过姿态解算得到方向余弦矩阵,将载体加速度数据换算到惯性坐标系,同时消除重力的影响,能够对车轮支架和车身在车辆悬架运动边界内的运动(非车辆行驶的运动)进行准确的测量,使得到的减振器伸缩运动数据更加精确;同时具有很好的低频或0频测量精度,在测量过程中不受地形和车辆姿态的影响,能够准确测量车辆悬架中关键点的位姿运动状态,为车辆悬架***的检测、控制提供可靠的参考。
2)本发明测量方法结合车辆悬架***中各关键位置处均在局部范围内做往复运动,且运动边界明确的特点,具有对其加速度和速度的时间积分长期趋于0,短期则会小于运动边界值的特性,在测量过程中利用这些特性进行积分修正,能够有效消除在测量过程中的积分累计误差,使得到的测量结果更加准确。
3)本发明测量方法和测量***中采用IMU模块进行单点测量,所需的安装空间小,在车辆悬架***中可灵活安装,方便整车的集成;且IMU模块在车辆悬架***中无运动部件,使用过程中无磨损,使用寿命长,不受使用环境的限制,具有很好的适用性能。
附图说明
为了更清楚地说明本发明实施例的技术方案,下面将对实施例中的附图作简单地介绍,应当理解,以下附图仅示出了本发明的某些实施例,因此不应被看作是对范围的限定,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他相关的附图。
图1为本发明实施例中IMU模块在车辆悬架上的安装示意图。
图2为本发明实施例车辆悬架姿态测量方法中车辆运动参考坐标系示意图;其中,n为惯性坐标系,b为载体坐标系,c为悬架弹簧上方位置的车身坐标系,t为悬架弹簧下方位置的车轮坐标系。
图3为本发明实施例中车辆悬架姿态测量方法中车辆悬架运动数据测量流程图。
图4为本发明实施例中车辆悬架姿态测量方法中减振器伸缩运动数据测量流程图。
图中:1、减振器;
P1、位于悬架弹簧下方的测量位置,P2、位于悬架弹簧上方的测量位置。
具体实施方式
为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。
参照图1,本实施例中采用8个IMU模块用于分别采集车辆悬架四个车轮对应位置处的数据,这里的IMU模块为现有的惯性测量单元,通常为由3个加速度计和3个陀螺仪组成的组合单元,用于采集安装位置处的加速度和角速度数据。
下面结合图1和图2对本实施例中车辆悬架姿态测量方法进行详细的说明,本实施例中车辆运动参考坐标系如图2所示,其中,n为惯性坐标系,其z轴与重力方向平行;b为载体坐标系,c为悬架弹簧上方位置的车身坐标系,其z轴垂直于车身向上,x轴与车辆前进方向重合;t为悬架弹簧下方位置的车轮坐标系,其z轴垂直于路面向上,x轴与车辆前进方向重合。
车辆悬架包括有分别设置在车辆车轮位置处的车轮支架、减振器1和悬架弹簧;车辆悬架中在4个车轮的对应位置处,选取分别位于悬架弹簧上方和下方的两个测量位置,其中位于悬架弹簧下方的测量位置位于车轮车架或减振器缸筒外壁上,如图1中P1所示的位置;位于悬架弹簧上方的测量位置位于靠近减振器与车身连接点位置的车身上,如图1中P2所示的位置。
参照图3,本实施例中车辆悬架姿态测量方法,包括以下步骤:
通过IMU模块分别获取对应测量位置处的运动参数,包括各个测量位置处的角速度数据和加速度数据。
根据角速度数据按四元数微分方程积分,得到方向余弦矩阵;具体地,将测量位置的角位置用四元数表示为q=q0+q1i+q2j+q3k,用矩阵表示为其中,q0、q1、q2、q3分别为四元数,该四元数具有单位范数,即得到其微分方程为
将得到的微分方程进行离散化微分运算得到:
其中,I为单位矩阵,t+T为当前时刻,T为离散的时间周期,t为上一次计算的时刻;
根据获取的加速度数据进行低通滤波处理后,对方向余弦矩阵进行修正,以消除IMU模块中角速度积分造成的累计误差;具体包括:
这里vx、vy、vz分别为重力向量vg分解到x、y、z方向上的分量;
由于ag与vg为同一物理量,以此作为修正依据,得到两者之间的误差为:
其中,ex、ey、ez分别为误差eg在x、y、z方向上的分量;
得到测量位置处修正后的角速度向量w*为:w*=f(w,eg);
根据修正后的方向余弦矩阵,将测量得到的载体坐标系下的运动加速度转换为惯性坐标系下的运动加速度,对得到的惯性坐标系下的运动加速度进行处理,消除由重力所带来的影响;具体包括:
将测量得到的载体坐标系下的运动加速度ab转换为惯性坐标系下的运动加速度an,其中:
根据处理后的惯性坐标系运动加速度得到测量位置处的运动加速度,对得到的运动加速度积分得到测量位置处的运动速度;具体包括:
对得到的运动加速度滤波处理去掉高频噪声,计算位于悬架弹簧下方测量位置处的运动加速度at为:
其中,为载体坐标系到悬架弹簧下方垂直于车身坐标系的方向余弦矩阵,可根据IMU模块的传感器标定得到;为从惯性坐标系到载体坐标系的方向余弦矩阵,为加速度at中垂直于车身向上的加速度分量,分别为运动加速度at中在x和y向的加速度分量,即与车身平面平行方向上的分量;
计算位于悬架弹簧上方测量位置处的加速度ac为:
其中,为载体坐标系到悬架弹簧上方垂直于车身坐标系的方向余弦矩阵,可根据IMU模块的传感器标定得到;为从惯性坐标系到载体坐标系的方向余弦矩阵,为加速度ac中垂直于车身向上的加速度分量,分别为运动加速度ac中在x和y向的加速度分量,即与车身平面平行方向上的分量;
对得到的运动加速度at、ac积分得到悬架弹簧下方测量位置与悬架弹簧上方测量位置处的运动速度vt、vc,其中:
对测量位置处的运动速度进行误差修正,并对修正后的运动速度积分得到测量位置处的运动位移;具体包括:
对测量位置处的运动速度vt、vc进行误差修正(包括运动加速度累计误差),得到对应测量位置处修正后的运动速度vt *、vc *,分别为:
其中,eat、eac分别为悬架弹簧下方测量位置和悬架弹簧上方测量位置处的加速度误差修正参数;
并使当修正计算的时间大于第一阈值时,则vt *、vc *趋于0,当修正计算的时间小于第二阈值时,则vt *、vc *小于车辆悬架的最大速度值,这里的最大速度值是指车辆悬架在实际的物理运动模型中能够达到的最大速度,通常通过对车辆悬架***进行仿真或试验标定得到,或通过经验得到;这里第一阈值为车轮和车身固有频率周期的5倍,所述第二阈值为车轮和车身固有频率周期的1/2;
对修正后的运动速度积分得到悬架弹簧下方测量位置与悬架弹簧上方测量位置处的运动位移st、sc,分别为:
st=∫vt *,
sc=∫vc *。
对测量位置处的运动位移进行误差修正,得到修正后的运动位移;具体包括:
对测量位置处的运动位移进行误差修正,得到对应测量位置处修正后的运动位移st *、sc *,分别为:
st *=∫(vt *+evt),
sc *=∫(vc *+evc);
其中,evt、evc分别为悬架弹簧下方测量位置和悬架弹簧上方测量位置处的速度误差修正参数;
并使当修正计算的时间大于第一阈值时,则st *、sc *趋于0,当修正计算的时间小于第二阈值时,则st *、sc *小于对应测量位置处车辆悬架的最大位移值,这里的最大位移值是指车辆悬架结构所限定的最大运动范围,可由车辆悬架的结构通过计算得到,属于车辆悬架***的设计参数;这里第一阈值为车轮和车身固有频率周期的5倍,所述第二阈值为车轮和车身固有频率周期的1/2。
至此测量得到车辆悬架对应测量位置处的运动数据,包括运动加速度、运动速度和运动位移。
根据测量得到的车辆悬架对应测量位置处的运动数据,计算减振器的伸缩运动数据,并对减振器的伸缩运动数据进行误差修正,得到修正后的减振器运动速度、运动位移;具体包括以下步骤:
参照图4,设定悬架弹簧上方和下方测量位置处的运动速度分别为vup和vdown、运动位移分别为sup和sdown;
根据车辆悬架的运动学几何模型计算得到减振器的伸缩运动数据,包括:
减振器的伸缩运动速度vdamper为:vdamper=f(vup,vdown),
减振器的伸缩运动位移sdamper为:sdamper=f(sup,sdown);
其中这里的vup=vc *,vdown=vt *,sup=sc *,sdown=st *;
对减振器的伸缩运动数据进行误差修正,得到修正后的减振器伸缩运动数据分别为:
修正后的减振器伸缩运动速度vdamper *为:
vdamper *=vdamper+evdamper,
修正后的减振器伸缩运动位移sdamper *为:
sdamper *=∫vdamper *;
并使当修正计算的时间大于第一阈值时,sdamper *趋于0,当修正计算的时间小于第二阈值时,则sdamper *小于减振器的最大行程,这里减振器的最大行程为减振器的设计参数;这里第一阈值为车轮和车身固有频率周期的5倍,所述第二阈值为车轮和车身固有频率周期的1/2;
其中,evdamper为减振器伸缩运动速度的修正参数。
此时即可得到车辆悬架中减振器的运动速度和运动位移。
至此通过本实施例中的测量方法,利用IMU模块得到车辆悬架中位于悬架弹簧上方和下方测量位置以及减振器的运动数据。
同时,本实施例中还涉及一种车辆悬架姿态测量***,包括:
设置于各车轮所对应悬架弹簧上方测量位置和悬架弹簧下方测量位置处的参数采集模块,参数采集模块用于采集测量位置处的运动参数;该参数采集模块为IMU模块,位于悬架弹簧上方的测量位置位于靠近减振器与车身连接点位置的车身上,位于悬架弹簧下方的测量位置位于车轮车架或减振器缸筒外壁上;
和车辆悬架姿态测量模块,车辆悬架姿态测量模块获取参数采集模块采集的运动参数,并采用上述的车辆悬架姿态测量方法,以测量得到对应车辆悬架和减振器伸缩运动的运动数据。
在本发明的描述中,需要说明的是,所采用的术语“中心”、“上”、“下”、“左”、“右”、“竖直”、“水平”、“内”、“外”等指示的方位或位置关系为基于附图所示的方位或位置关系,或者是该发明产品使用时惯常摆放的方位或位置关系,仅是为了便于描述本发明和简化描述,而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作,因此不能理解为对本发明的限制。
此外,本发明的描述中若出现“水平”、“竖直”等术语并不表示要求部件绝对水平或悬垂,而是可以稍微倾斜。如“水平”仅仅是指其方向相对“竖直”而言更加水平,并不是表示该结构一定要完全水平,而是可以稍微倾斜。
在本发明的描述中,还需要说明的是,除非另有明确的规定和限定,若出现术语“设置”、“安装”、“相连”、“连接”应做广义理解,例如,可以是固定连接,也可以是可拆卸连接,或一体地连接;可以是机械连接,也可以是电连接;可以是直接相连,也可以通过中间媒介间接相连,可以是两个元件内部的连通。对于本领域的普通技术人员而言,可以具体情况理解上述术语在本发明中的具体含义。
以上所述仅为本发明的优选实施例而已,并不用于限制本发明,对于本领域的技术人员来说,本发明可以有各种更改和变化。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (10)
1.车辆悬架姿态测量方法,其特征在于,包括以下步骤:
S1.选取位于悬架弹簧上方的至少一个测量位置和位于悬架弹簧下方的至少一个测量位置,获取测量位置处的运动参数,所述运动参数包括测量位置处的角速度数据、加速度数据;
S2.根据获取的角速度数据得到方向余弦矩阵;
S3.根据获取的加速度数据对方向余弦矩阵进行修正;
S4.根据修正后的方向余弦矩阵,将测量得到的载体坐标系下的运动加速度转换为惯性坐标系下的运动加速度,对得到的惯性坐标系下的运动加速度进行处理,消除由重力所带来的影响;
S5.根据处理后的惯性坐标系下的运动加速度得到测量位置处的运动加速度,对得到的测量位置处的运动加速度积分得到测量位置处的运动速度;
S6.对测量位置处的运动速度进行误差修正,并对修正后的运动速度积分得到测量位置处的运动位移;
S7.对测量位置处的运动位移进行误差修正,得到修正后的运动位移;
测量得到车辆悬架对应测量位置处的运动数据,包括运动加速度、运动速度和运动位移;
所述步骤S2中,根据获取的角速度数据得到方向余弦矩阵,包括以下步骤:
将得到的微分方程进行离散化微分运算得到:
其中,I为单位矩阵,t+T为当前时刻,T为离散的时间周期,t为上一次计算的时刻;
所述步骤S3中,根据获取的加速度数据对方向余弦矩阵进行修正,包括以下步骤:
其中,vx、vy、vz分别为重力向量vg分解到x、y、z方向上的分量;
由于ag与vg为同一物理量,得到两者之间的误差为:
其中,ex、ey、ez分别为误差eg在x、y、z方向上的分量;
得到测量位置处修正后的角速度向量w*为:w*=f(w,eg);
所述步骤S4包括以下步骤:
所述步骤S5包括以下步骤:
计算位于悬架弹簧下方测量位置处的运动加速度at为:
计算位于悬架弹簧上方测量位置处的运动加速度ac为:
对得到的运动加速度at、ac积分得到悬架弹簧下方测量位置与悬架弹簧上方测量位置处的运动速度vt、vc,其中:
2.根据权利要求1所述的车辆悬架姿态测量方法,其特征在于,根据测量得到的车辆悬架对应测量位置处的运动数据,计算减振器的伸缩运动数据,并对减振器的伸缩运动数据进行误差修正,得到修正后的减振器运动速度、运动位移。
4.根据权利要求3所述的车辆悬架姿态测量方法,其特征在于,所述步骤S7中,对测量位置处的运动位移进行误差修正,得到对应测量位置处修正后的运动位移st *、sc *,分别为:
st *=∫(vt *+evt),
sc *=∫(vc *+evc);
其中,evt、evc分别为悬架弹簧下方测量位置和悬架弹簧上方测量位置处的速度误差修正参数;
并使当修正计算的时间大于第一阈值时,则st *、sc *趋于0,当修正计算的时间小于第二阈值时,则st *、sc *小于对应测量位置处车辆悬架的最大位移值。
5.根据权利要求2所述的车辆悬架姿态测量方法,其特征在于,所述根据测量得到的车辆悬架对应测量位置处的运动数据计算减振器的伸缩运动数据,包括以下步骤:
设定悬架弹簧上方测量位置和悬架弹簧下方测量位置处的运动速度分别为vup和vdown、运动位移分别为sup和sdown;
根据车辆悬架的运动学几何模型计算得到减振器的伸缩运动数据,包括:
减振器的伸缩运动速度vdamper为:vdamper=f(vup,vdown),
减振器的伸缩运动位移sdamper为:sdamper=f(sup,sdown)。
6.根据权利要求5所述的车辆悬架姿态测量方法,其特征在于,对减振器的伸缩运动数据进行误差修正,得到修正后的减振器伸缩运动数据分别为:
修正后的减振器伸缩运动速度vdamper *为:
vdamper *=vdamper+evdamper,
修正后的减振器伸缩运动位移sdamper *为:
sdamper *=∫vdamper *;
并使当修正计算的时间大于第一阈值时,sdamper *趋于0,当修正计算的时间小于第二阈值时,则sdamper *小于减振器的最大行程;
其中,evdamper为减振器伸缩运动速度的修正参数。
7.根据权利要求3、4或6中任一所述的车辆悬架姿态测量方法,其特征在于,所述第一阈值为车轮和车身固有频率周期的5倍,所述第二阈值为车轮和车身固有频率周期的1/2。
8.根据权利要求1所述的车辆悬架姿态测量方法,其特征在于,所述位于悬架弹簧上方的测量位置位于靠近减振器与车身连接点位置的车身上,所述位于悬架弹簧下方的测量位置位于车轮车架或减振器缸筒外壁上。
9.根据权利要求1所沭的车辆悬架姿态测量方法,其特征在于,在测量位置处分别设置IMU模块,以获取对应测量位置处的运动参数。
10.车辆悬架姿态测量***,其特征在于,包括:
设置于各车轮所对应悬架弹簧上方测量位置和悬架弹簧下方测量位置处的参数采集模块,所述参数采集模块用于采集测量位置处的运动参数;
车辆悬架姿态测量模块,所述车辆悬架姿态测量模块获取参数采集模块采集的运动参数,并采用权利要求1-9中任一所述的车辆悬架姿态测量方法,测量得到对应车辆悬架和减振器伸缩运动的运动数据。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111448813.3A CN113865616B (zh) | 2021-12-01 | 2021-12-01 | 车辆悬架姿态测量方法和测量*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111448813.3A CN113865616B (zh) | 2021-12-01 | 2021-12-01 | 车辆悬架姿态测量方法和测量*** |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113865616A CN113865616A (zh) | 2021-12-31 |
CN113865616B true CN113865616B (zh) | 2022-04-05 |
Family
ID=78985563
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111448813.3A Active CN113865616B (zh) | 2021-12-01 | 2021-12-01 | 车辆悬架姿态测量方法和测量*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113865616B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114312202B (zh) * | 2022-03-10 | 2022-06-03 | 成都九鼎科技(集团)有限公司 | 一种基于路况识别的半主动悬架控制方法及控制*** |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106767804A (zh) * | 2016-12-28 | 2017-05-31 | 华中科技大学 | 一种运动物体的多维数据测量装置及方法 |
EP3364153A1 (en) * | 2015-10-13 | 2018-08-22 | Shanghai Huace Navigation Technology Ltd. | Method for updating all attitude angles of agricultural machine on the basis of nine-axis mems sensor |
Family Cites Families (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4038527A (en) * | 1975-10-21 | 1977-07-26 | The Singer Company | Simplified strapped down inertial navigation utilizing bang-bang gyro torquing |
US6697736B2 (en) * | 2002-02-06 | 2004-02-24 | American Gnc Corporation | Positioning and navigation method and system thereof |
CN101387518B (zh) * | 2008-11-05 | 2010-10-27 | 北京科技大学 | 一种具有加减速补偿功能的车辆用磁电子罗盘及其测量方法 |
US8843290B2 (en) * | 2010-07-22 | 2014-09-23 | Qualcomm Incorporated | Apparatus and methods for calibrating dynamic parameters of a vehicle navigation system |
FR3001541B1 (fr) * | 2013-01-31 | 2016-02-05 | Michelin & Cie | Procede de caracterisation du comportement d'un vehicule et application au choix des pneumatiques du vehicule |
CN106767847B (zh) * | 2016-12-15 | 2020-11-20 | 北京三驰科技发展有限公司 | 一种车辆姿态安全预警方法及*** |
JP2018132378A (ja) * | 2017-02-14 | 2018-08-23 | 三菱電機株式会社 | 加速度センサ較正装置、加速度センサ較正プログラム及び加速度センサ較正方法 |
CN108051866B (zh) * | 2017-10-30 | 2019-04-26 | 中国船舶重工集团公司第七0七研究所 | 基于捷联惯性/gps组合辅助水平角运动隔离的重力测量方法 |
CN110398244B (zh) * | 2019-07-05 | 2023-02-14 | 云南省交通规划设计研究院有限公司 | 一种基于加速度传感器的车辆倾斜状态检测方法 |
CN112339517B (zh) * | 2020-11-13 | 2023-10-10 | 成都九鼎科技(集团)有限公司 | 一种半主动悬架控制方法及控制*** |
CN112577527B (zh) * | 2021-02-25 | 2021-09-17 | 北京主线科技有限公司 | 车载imu误差标定方法及装置 |
-
2021
- 2021-12-01 CN CN202111448813.3A patent/CN113865616B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP3364153A1 (en) * | 2015-10-13 | 2018-08-22 | Shanghai Huace Navigation Technology Ltd. | Method for updating all attitude angles of agricultural machine on the basis of nine-axis mems sensor |
CN106767804A (zh) * | 2016-12-28 | 2017-05-31 | 华中科技大学 | 一种运动物体的多维数据测量装置及方法 |
Also Published As
Publication number | Publication date |
---|---|
CN113865616A (zh) | 2021-12-31 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106679649B (zh) | 一种手部运动追踪***及追踪方法 | |
CN106959110B (zh) | 一种云台姿态检测方法及装置 | |
CN105203129B (zh) | 一种惯导装置初始对准方法 | |
CN108061855B (zh) | 一种基于mems传感器的球形电机转子位置检测方法 | |
CN110146077A (zh) | 移动机器人姿态角解算方法 | |
CN110125936B (zh) | 一种空间机器人的地面实验验证*** | |
CN109682377B (zh) | 一种基于动态步长梯度下降的姿态估计方法 | |
JP4281777B2 (ja) | 傾斜角推定機構を有する移動体 | |
WO2017175844A1 (ja) | 姿勢推定装置及び輸送機器 | |
CN108731676B (zh) | 一种基于惯性导航技术的姿态融合增强测量方法及*** | |
CN106370178B (zh) | 移动终端设备的姿态测量方法及装置 | |
CN103743378B (zh) | 一种管道检测器姿态检测*** | |
CN105371846B (zh) | 载体姿态检测方法及其*** | |
CN108827301A (zh) | 一种改进误差四元数卡尔曼滤波机器人姿态解算方法 | |
CN113865616B (zh) | 车辆悬架姿态测量方法和测量*** | |
CN106403940A (zh) | 一种抗大气参数漂移的无人机飞行导航***高度信息融合方法 | |
CN112720476A (zh) | 机械臂控制方法、装置、介质及电子设备 | |
CN110793515A (zh) | 一种基于单天线gps和imu的大机动条件下无人机姿态估计方法 | |
CN111398631A (zh) | 一种无人机加速度计误差识别及校正方法 | |
CN112567097A (zh) | 用于确定机器的作业设备的角度的方法 | |
CN108444468B (zh) | 一种融合下视视觉与惯导信息的定向罗盘 | |
Hoang et al. | Noise attenuation on IMU measurement for drone balance by sensor fusion | |
CN106197376B (zh) | 基于单轴mems惯性传感器的车身倾角测量方法 | |
CN108871323A (zh) | 一种低成本惯性传感器在机动环境下的高精度导航方法 | |
CN113063416B (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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |