CN113865616A - 车辆悬架姿态测量方法和测量系统 - Google Patents

车辆悬架姿态测量方法和测量系统 Download PDF

Info

Publication number
CN113865616A
CN113865616A CN202111448813.3A CN202111448813A CN113865616A CN 113865616 A CN113865616 A CN 113865616A CN 202111448813 A CN202111448813 A CN 202111448813A CN 113865616 A CN113865616 A CN 113865616A
Authority
CN
China
Prior art keywords
motion
acceleration
measurement
coordinate system
vehicle suspension
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.)
Granted
Application number
CN202111448813.3A
Other languages
English (en)
Other versions
CN113865616B (zh
Inventor
廖安志
唐兵
王介阳
李柏宏
邵翀
冯红国
陈维福
孙双德
李庆伟
李标
李国华
袁秀安
吴萍
李风云
李皓龙
葛文军
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Chengdu Jiuding Technology Group Co Ltd
Original Assignee
Chengdu Jiuding Technology Group Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Chengdu Jiuding Technology Group Co Ltd filed Critical Chengdu Jiuding Technology Group Co Ltd
Priority to CN202111448813.3A priority Critical patent/CN113865616B/zh
Publication of CN113865616A publication Critical patent/CN113865616A/zh
Application granted granted Critical
Publication of CN113865616B publication Critical patent/CN113865616B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

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中，根据获取的角速度数据得到方向余弦矩阵，包括以下步骤：
将测量位置的角位置用四元数表示为
Figure 100002_DEST_PATH_IMAGE001
，用矩阵表示为
Figure 875709DEST_PATH_IMAGE002
，得到其微分方程为
Figure 100002_DEST_PATH_IMAGE003
；
其中，
Figure 902440DEST_PATH_IMAGE004
、
Figure 100002_DEST_PATH_IMAGE005
、
Figure 55204DEST_PATH_IMAGE006
、
Figure 100002_DEST_PATH_IMAGE007
分别为四元数，
Figure 301640DEST_PATH_IMAGE008
为该位置处的角速度数据，
Figure 100002_DEST_PATH_IMAGE009
，
Figure 830841DEST_PATH_IMAGE010
为从四元数导出的旋转矩阵，
Figure 100002_DEST_PATH_IMAGE011
，
Figure 243237DEST_PATH_IMAGE012
、
Figure 100002_DEST_PATH_IMAGE013
、
Figure 98060DEST_PATH_IMAGE014
分别为绕x、y、z轴旋转的角速度；
将得到的微分方程进行离散化微分运算得到：
Figure 100002_DEST_PATH_IMAGE015
；
其中，
Figure 972738DEST_PATH_IMAGE016
为单位矩阵，
Figure 100002_DEST_PATH_IMAGE017
为当前时刻，
Figure 820477DEST_PATH_IMAGE018
为离散的时间周期，
Figure 100002_DEST_PATH_IMAGE019
为上一次计算的时刻；
得到方向余弦矩阵
Figure 572532DEST_PATH_IMAGE020
为：
Figure 100002_DEST_PATH_IMAGE021
。
作为对本发明技术方案的进一步改进，所述步骤S3中，根据获取的加速度数据对方向余弦矩阵进行修正，包括以下步骤：
获取测量位置处测量的重力向量，将其转换为单位向量
Figure 337271DEST_PATH_IMAGE022
，
Figure 100002_DEST_PATH_IMAGE023
；其中，
Figure 541987DEST_PATH_IMAGE024
、
Figure 100002_DEST_PATH_IMAGE025
、
Figure 193417DEST_PATH_IMAGE026
分别为测量得到的重力向量
Figure 268820DEST_PATH_IMAGE022
分解到x、y、z方向上的加速度分量；
重力向量投影到方向余弦矩阵中，其值对应方向余弦矩阵
Figure 950600DEST_PATH_IMAGE028
的第3行，即得到根据方向余弦矩阵推算出的重力向量
Figure 100002_DEST_PATH_IMAGE029
为：
Figure 100002_DEST_PATH_IMAGE031
；
其中，
Figure 173771DEST_PATH_IMAGE032
、
Figure 100002_DEST_PATH_IMAGE033
、
Figure 238679DEST_PATH_IMAGE034
分别为重力向量
Figure 293222DEST_PATH_IMAGE029
分解到x、y、z方向上的分量；
由于
Figure 880324DEST_PATH_IMAGE022
与
Figure 653108DEST_PATH_IMAGE029
为同一物理量，得到两者之间的误差为：
Figure 100002_DEST_PATH_IMAGE035
；
其中，
Figure 600335DEST_PATH_IMAGE036
、
Figure 100002_DEST_PATH_IMAGE037
、
Figure 368440DEST_PATH_IMAGE038
分别为误差
Figure 100002_DEST_PATH_IMAGE039
在x、y、z方向上的分量；
得到测量位置处修正后的角速度向量
Figure 126443DEST_PATH_IMAGE040
为：
Figure 100002_DEST_PATH_IMAGE041
；
根据修正后的角速度向量
Figure 793047DEST_PATH_IMAGE040
，通过龙格库塔法求解四元数微分方程求出
Figure 403020DEST_PATH_IMAGE042
，得到修正后的方向余弦矩阵
Figure 100002_DEST_PATH_IMAGE043
。
作为对本发明技术方案的进一步改进，所述步骤S4包括以下步骤：
将测量得到的载体坐标系下的运动加速度
Figure 87948DEST_PATH_IMAGE044
转换为惯性坐标系下的运动加速度
Figure 100002_DEST_PATH_IMAGE045
，
Figure 531699DEST_PATH_IMAGE046
；
其中，
Figure 100002_DEST_PATH_IMAGE047
、
Figure 170753DEST_PATH_IMAGE048
分别为惯性坐标系下的运动加速度
Figure 584417DEST_PATH_IMAGE045
在x、y方向的加速度分量；
对惯性坐标系下的运动加速度进行处理，消除其中由重力所带来的影响，得到
Figure 100002_DEST_PATH_IMAGE049
；其中，
Figure 609005DEST_PATH_IMAGE050
为修正后的惯性坐标系下的运动加速度在重力方向的分量，
Figure 100002_DEST_PATH_IMAGE051
为惯性坐标系下的运动加速度
Figure 472924DEST_PATH_IMAGE045
在重力方向的加速度分量，
Figure 442017DEST_PATH_IMAGE052
为重力加速度；
得到处理后的惯性坐标系下的运动加速度为
Figure 100002_DEST_PATH_IMAGE053
。
作为对本发明技术方案的进一步改进，所述步骤S5包括以下步骤：
计算位于悬架弹簧下方测量位置处的运动加速度
Figure 800318DEST_PATH_IMAGE054
为：
Figure 100002_DEST_PATH_IMAGE055
；其中，
Figure 961303DEST_PATH_IMAGE056
为载体坐标系到悬架弹簧下方垂直于车身坐标系的方向余弦矩阵，
Figure 100002_DEST_PATH_IMAGE057
为从惯性坐标系到载体坐标系的方向余弦矩阵，
Figure 12435DEST_PATH_IMAGE058
、
Figure 100002_DEST_PATH_IMAGE059
分别为运动加速度
Figure 531141DEST_PATH_IMAGE054
中在x和y向的加速度分量，
Figure 286608DEST_PATH_IMAGE060
为加速度
Figure 505362DEST_PATH_IMAGE054
中垂直于车身向上的加速度分量；
计算位于悬架弹簧上方测量位置处的运动加速度
Figure 100002_DEST_PATH_IMAGE061
为：
Figure 461816DEST_PATH_IMAGE062
；其中，
Figure 100002_DEST_PATH_IMAGE063
为载体坐标系到悬架弹簧上方垂直于车身坐标系的方向余弦矩阵，
Figure 61294DEST_PATH_IMAGE057
为从惯性坐标系到载体坐标系的方向余弦矩阵，
Figure 620451DEST_PATH_IMAGE064
、
Figure 100002_DEST_PATH_IMAGE065
分别为运动加速度
Figure 693712DEST_PATH_IMAGE061
中在x和y向的加速度分量，
Figure 289909DEST_PATH_IMAGE066
为加速度
Figure 720891DEST_PATH_IMAGE061
中垂直于车身向上的加速度分量；
对得到的运动加速度
Figure 942793DEST_PATH_IMAGE054
、
Figure 775620DEST_PATH_IMAGE061
积分得到悬架弹簧下方测量位置与悬架弹簧上方测量位置处的运动速度
Figure 100002_DEST_PATH_IMAGE067
、
Figure 808298DEST_PATH_IMAGE068
，其中：
Figure 100002_DEST_PATH_IMAGE069
；
Figure 895552DEST_PATH_IMAGE070
。
作为对本发明技术方案的进一步改进，所述步骤S6包括以下步骤：
对测量位置处的运动速度
Figure 671878DEST_PATH_IMAGE067
、
Figure 93632DEST_PATH_IMAGE068
进行误差修正，得到对应测量位置处修正后的运动速度
Figure 100002_DEST_PATH_IMAGE071
、
Figure 15320DEST_PATH_IMAGE072
，分别为：
Figure 100002_DEST_PATH_IMAGE073
，
Figure 250255DEST_PATH_IMAGE074
；
其中，
Figure 100002_DEST_PATH_IMAGE075
、
Figure 610698DEST_PATH_IMAGE076
分别为悬架弹簧下方测量位置和悬架弹簧上方测量位置处的加速度误差修正参数；
并使当修正计算的时间大于第一阈值时，则
Figure 27904DEST_PATH_IMAGE071
、
Figure 887538DEST_PATH_IMAGE072
趋于0，当修正计算的时间小于第二阈值时，则
Figure 249249DEST_PATH_IMAGE071
、
Figure 616645DEST_PATH_IMAGE072
小于车辆悬架的最大速度值；
对修正后的运动速度积分得到悬架弹簧下方测量位置与悬架弹簧上方测量位置处的运动位移
Figure 100002_DEST_PATH_IMAGE077
、
Figure 419516DEST_PATH_IMAGE078
，分别为：
Figure 100002_DEST_PATH_IMAGE079
,
Figure 246789DEST_PATH_IMAGE080
。
作为对本发明技术方案的进一步改进，所述步骤S7中，对测量位置处的运动位移进行误差修正，得到对应测量位置处修正后的运动位移
Figure 100002_DEST_PATH_IMAGE081
、
Figure 767900DEST_PATH_IMAGE082
，分别为：
Figure 100002_DEST_PATH_IMAGE083
，
Figure 204566DEST_PATH_IMAGE084
；
其中，
Figure 100002_DEST_PATH_IMAGE085
、
Figure 127523DEST_PATH_IMAGE086
分别为悬架弹簧下方测量位置和悬架弹簧上方测量位置处的速度误差修正参数；
并使当修正计算的时间大于第一阈值时，则
Figure 702861DEST_PATH_IMAGE081
、
Figure 304744DEST_PATH_IMAGE082
趋于0，当修正计算的时间小于第二阈值时，则
Figure 515407DEST_PATH_IMAGE081
、
Figure 886346DEST_PATH_IMAGE082
小于对应测量位置处车辆悬架的最大位移值。
作为对本发明技术方案的进一步改进，所述根据测量得到的车辆悬架对应测量位置处的运动数据计算减振器的伸缩运动数据，包括以下步骤：
设定悬架弹簧上方测量位置和悬架弹簧下方测量位置处的运动速度分别为
Figure 100002_DEST_PATH_IMAGE087
和
Figure 304689DEST_PATH_IMAGE088
、运动位移分别为
Figure 100002_DEST_PATH_IMAGE089
和
Figure 518501DEST_PATH_IMAGE090
；
根据车辆悬架的运动学几何模型计算得到减振器的伸缩运动数据，包括：
减振器的伸缩运动速度
Figure 100002_DEST_PATH_IMAGE091
为：
Figure 313282DEST_PATH_IMAGE092
，
减振器的伸缩运动位移
Figure 100002_DEST_PATH_IMAGE093
为：
Figure 430405DEST_PATH_IMAGE094
。
作为对本发明技术方案的进一步改进，所述步骤S9中，对减振器的伸缩运动数据进行误差修正，得到修正后的减振器伸缩运动数据分别为：
修正后的减振器伸缩运动速度
Figure 100002_DEST_PATH_IMAGE095
为：
Figure 550808DEST_PATH_IMAGE096
,
修正后的减振器伸缩运动位移
Figure 100002_DEST_PATH_IMAGE097
为：
Figure 720758DEST_PATH_IMAGE098
；
并使当修正计算的时间大于第一阈值时，
Figure 273224DEST_PATH_IMAGE097
趋于0，当修正计算的时间小于第二阈值时，则
Figure 494121DEST_PATH_IMAGE097
小于减振器的最大行程；
其中，
Figure 100002_DEST_PATH_IMAGE099
为减振器伸缩运动速度的修正参数。
作为对本发明技术方案的进一步改进，所述第一阈值为车轮和车身固有频率周期的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模块分别获取对应测量位置处的运动参数，包括各个测量位置处的角速度数据和加速度数据。
对获取的角速度数据进行低通滤波处理，除去高频噪声；得到经过处理的角速度数据
Figure 769113DEST_PATH_IMAGE008
，其中
Figure 567305DEST_PATH_IMAGE009
；
Figure 172730DEST_PATH_IMAGE012
、
Figure 107188DEST_PATH_IMAGE013
、
Figure 523388DEST_PATH_IMAGE014
分别为绕x、y、z轴旋转的角速度。
根据角速度数据按四元数微分方程积分，得到方向余弦矩阵；具体地，将测量位置的角位置用四元数表示为
Figure 808876DEST_PATH_IMAGE001
，用矩阵表示为
Figure 483571DEST_PATH_IMAGE002
，其中，
Figure 662748DEST_PATH_IMAGE004
、
Figure 889330DEST_PATH_IMAGE005
、
Figure 271901DEST_PATH_IMAGE006
、
Figure 343762DEST_PATH_IMAGE007
分别为四元数，该四元数具有单位范数，即
Figure 132772DEST_PATH_IMAGE100
，得到其微分方程为
Figure 999097DEST_PATH_IMAGE003
；
其中，
Figure 134543DEST_PATH_IMAGE008
为该位置处的角速度数据，
Figure 744516DEST_PATH_IMAGE010
为从四元数导出的旋转矩阵，
Figure 898285DEST_PATH_IMAGE011
。
将得到的微分方程进行离散化微分运算得到：
Figure 935511DEST_PATH_IMAGE015
；
其中，
Figure 558254DEST_PATH_IMAGE016
为单位矩阵，
Figure 971918DEST_PATH_IMAGE017
为当前时刻，
Figure 481659DEST_PATH_IMAGE018
为离散的时间周期，
Figure 955365DEST_PATH_IMAGE019
为上一次计算的时刻；
得到方向余弦矩阵
Figure 534245DEST_PATH_IMAGE020
为：
Figure 672971DEST_PATH_IMAGE021
。
这里
Figure 552066DEST_PATH_IMAGE020
的推导计算过程在现有的文献中已有公开，这里不再赘述。
根据获取的加速度数据进行低通滤波处理后，对方向余弦矩阵进行修正，以消除IMU模块中角速度积分造成的累计误差；具体包括：
在IMU模块坐标系中，将通过加速度计测量得到的重力向量转换为单位向量
Figure 665515DEST_PATH_IMAGE022
，
Figure 121904DEST_PATH_IMAGE023
，这里
Figure DEST_PATH_IMAGE101
、
Figure 34628DEST_PATH_IMAGE102
、
Figure DEST_PATH_IMAGE103
分别为IMU模块测得的重力向量
Figure 33808DEST_PATH_IMAGE022
分解到x、y、z方向上的加速度分量；
重力向量投影到方向余弦矩阵中，其值对应方向余弦矩阵
Figure 973951DEST_PATH_IMAGE028
的第3行，即得到根据方向余弦矩阵推算出的重力向量
Figure 917636DEST_PATH_IMAGE029
为：
Figure DEST_PATH_IMAGE105
；
这里
Figure 352160DEST_PATH_IMAGE106
、
Figure DEST_PATH_IMAGE107
、
Figure 222158DEST_PATH_IMAGE108
分别为重力向量
Figure 208568DEST_PATH_IMAGE029
分解到x、y、z方向上的分量；
由于
Figure 514916DEST_PATH_IMAGE022
与
Figure 612185DEST_PATH_IMAGE029
为同一物理量，以此作为修正依据，得到两者之间的误差为：
Figure 38487DEST_PATH_IMAGE035
；
其中，
Figure 195799DEST_PATH_IMAGE036
、
Figure 989443DEST_PATH_IMAGE037
、
Figure 359244DEST_PATH_IMAGE038
分别为误差
Figure 46577DEST_PATH_IMAGE039
在x、y、z方向上的分量；
得到测量位置处修正后的角速度向量
Figure 889DEST_PATH_IMAGE040
为：
Figure 140884DEST_PATH_IMAGE041
；
通过误差对陀螺仪的角速度数据进行修正，根据修正后的角速度向量
Figure 455321DEST_PATH_IMAGE040
，并通过龙格库塔法求解四元数微分方程求出
Figure 997161DEST_PATH_IMAGE042
，将得到的
Figure 620909DEST_PATH_IMAGE042
代入到方向余弦矩阵
Figure 248200DEST_PATH_IMAGE020
中，即可得到修正后的方向余弦矩阵
Figure 100749DEST_PATH_IMAGE043
。
同时，还可以计算得到姿态变换欧拉角
Figure DEST_PATH_IMAGE109
，其中，姿态变换欧拉角为：
Figure 185511DEST_PATH_IMAGE110
。
根据修正后的方向余弦矩阵，将测量得到的载体坐标系下的运动加速度转换为惯性坐标系下的运动加速度，对得到的惯性坐标系下的运动加速度进行处理，消除由重力所带来的影响；具体包括：
将测量得到的载体坐标系下的运动加速度
Figure 855527DEST_PATH_IMAGE044
转换为惯性坐标系下的运动加速度
Figure 845480DEST_PATH_IMAGE045
，其中：
Figure 626354DEST_PATH_IMAGE046
；
其中，
Figure 1840DEST_PATH_IMAGE047
、
Figure 842757DEST_PATH_IMAGE048
分别为惯性坐标系下的运动加速度
Figure 320006DEST_PATH_IMAGE045
在x、y方向的加速度分量。
对惯性坐标系下的运动加速度进行处理，消除其中由重力所带来的影响，得到
Figure 904571DEST_PATH_IMAGE049
；其中，
Figure 901608DEST_PATH_IMAGE050
为修正后的惯性坐标系下的运动加速度在重力方向的分量，
Figure 913427DEST_PATH_IMAGE051
为惯性坐标系下的运动加速度
Figure 612392DEST_PATH_IMAGE045
在重力方向的加速度分量，
Figure 648DEST_PATH_IMAGE052
为重力加速度；
得到处理后的惯性坐标系下的运动加速度为
Figure 960514DEST_PATH_IMAGE053
。
根据处理后的惯性坐标系运动加速度得到测量位置处的运动加速度，对得到的运动加速度积分得到测量位置处的运动速度；具体包括：
对得到的运动加速度滤波处理去掉高频噪声，计算位于悬架弹簧下方测量位置处的运动加速度
Figure 267868DEST_PATH_IMAGE054
为：
Figure 844343DEST_PATH_IMAGE055
；其中，
Figure 646076DEST_PATH_IMAGE056
为载体坐标系到悬架弹簧下方垂直于车身坐标系的方向余弦矩阵，可根据IMU模块的传感器标定得到；
Figure 460449DEST_PATH_IMAGE057
为从惯性坐标系到载体坐标系的方向余弦矩阵，
Figure 705747DEST_PATH_IMAGE060
为加速度
Figure 503939DEST_PATH_IMAGE054
中垂直于车身向上的加速度分量，
Figure 702839DEST_PATH_IMAGE058
、
Figure 43822DEST_PATH_IMAGE059
分别为运动加速度
Figure 568344DEST_PATH_IMAGE054
中在x和y向的加速度分量，即与车身平面平行方向上的分量；
计算位于悬架弹簧上方测量位置处的加速度
Figure 712887DEST_PATH_IMAGE061
为：
Figure 246636DEST_PATH_IMAGE062
；其中，
Figure 176546DEST_PATH_IMAGE063
为载体坐标系到悬架弹簧上方垂直于车身坐标系的方向余弦矩阵，可根据IMU模块的传感器标定得到；
Figure 871970DEST_PATH_IMAGE057
为从惯性坐标系到载体坐标系的方向余弦矩阵，
Figure 16992DEST_PATH_IMAGE066
为加速度
Figure 88853DEST_PATH_IMAGE061
中垂直于车身向上的加速度分量，
Figure 873269DEST_PATH_IMAGE064
、
Figure 5173DEST_PATH_IMAGE065
分别为运动加速度
Figure 734095DEST_PATH_IMAGE061
中在x和y向的加速度分量，即与车身平面平行方向上的分量；
对得到的运动加速度
Figure 734281DEST_PATH_IMAGE054
、
Figure 763417DEST_PATH_IMAGE061
积分得到悬架弹簧下方测量位置与悬架弹簧上方测量位置处的运动速度
Figure 410430DEST_PATH_IMAGE067
、
Figure 157806DEST_PATH_IMAGE068
，其中：
Figure 463148DEST_PATH_IMAGE069
；
Figure 81211DEST_PATH_IMAGE070
。
对测量位置处的运动速度进行误差修正，并对修正后的运动速度积分得到测量位置处的运动位移；具体包括：
对测量位置处的运动速度
Figure 430284DEST_PATH_IMAGE067
、
Figure 399377DEST_PATH_IMAGE068
进行误差修正（包括运动加速度累计误差），得到对应测量位置处修正后的运动速度
Figure 475786DEST_PATH_IMAGE071
、
Figure 479514DEST_PATH_IMAGE072
，分别为：
Figure 733909DEST_PATH_IMAGE073
，
Figure 190298DEST_PATH_IMAGE074
；
其中，
Figure 571863DEST_PATH_IMAGE075
、
Figure 430098DEST_PATH_IMAGE076
分别为悬架弹簧下方测量位置和悬架弹簧上方测量位置处的加速度误差修正参数；
并使当修正计算的时间大于第一阈值时，则
Figure 980028DEST_PATH_IMAGE071
、
Figure 533500DEST_PATH_IMAGE072
趋于0，当修正计算的时间小于第二阈值时，则
Figure 92657DEST_PATH_IMAGE071
、
Figure 195611DEST_PATH_IMAGE072
小于车辆悬架的最大速度值，这里的最大速度值是指车辆悬架在实际的物理运动模型中能够达到的最大速度，通常通过对车辆悬架系统进行仿真或试验标定得到，或通过经验得到；这里第一阈值为车轮和车身固有频率周期的5倍，所述第二阈值为车轮和车身固有频率周期的1/2；
对修正后的运动速度积分得到悬架弹簧下方测量位置与悬架弹簧上方测量位置处的运动位移
Figure 57388DEST_PATH_IMAGE077
、
Figure 488370DEST_PATH_IMAGE078
，分别为：
Figure 320059DEST_PATH_IMAGE079
,
Figure 513406DEST_PATH_IMAGE080
。
对测量位置处的运动位移进行误差修正，得到修正后的运动位移；具体包括：
对测量位置处的运动位移进行误差修正，得到对应测量位置处修正后的运动位移
Figure 405138DEST_PATH_IMAGE081
、
Figure 933203DEST_PATH_IMAGE082
，分别为：
Figure 99742DEST_PATH_IMAGE083
，
Figure 646130DEST_PATH_IMAGE084
；
其中，
Figure 974343DEST_PATH_IMAGE085
、
Figure 989703DEST_PATH_IMAGE086
分别为悬架弹簧下方测量位置和悬架弹簧上方测量位置处的速度误差修正参数；
并使当修正计算的时间大于第一阈值时，则
Figure 163196DEST_PATH_IMAGE081
、
Figure 596713DEST_PATH_IMAGE082
趋于0，当修正计算的时间小于第二阈值时，则
Figure 95828DEST_PATH_IMAGE081
、
Figure 598484DEST_PATH_IMAGE082
小于对应测量位置处车辆悬架的最大位移值，这里的最大位移值是指车辆悬架结构所限定的最大运动范围，可由车辆悬架的结构通过计算得到，属于车辆悬架系统的设计参数；这里第一阈值为车轮和车身固有频率周期的5倍，所述第二阈值为车轮和车身固有频率周期的1/2。
至此测量得到车辆悬架对应测量位置处的运动数据，包括运动加速度、运动速度和运动位移。
根据测量得到的车辆悬架对应测量位置处的运动数据，计算减振器的伸缩运动数据，并对减振器的伸缩运动数据进行误差修正，得到修正后的减振器运动速度、运动位移；具体包括以下步骤：
参照图4，设定悬架弹簧上方和下方测量位置处的运动速度分别为
Figure 575668DEST_PATH_IMAGE087
和
Figure 237593DEST_PATH_IMAGE088
、运动位移分别为
Figure 32243DEST_PATH_IMAGE089
和
Figure 881250DEST_PATH_IMAGE090
；
根据车辆悬架的运动学几何模型计算得到减振器的伸缩运动数据，包括：
减振器的伸缩运动速度
Figure 537490DEST_PATH_IMAGE091
为：
Figure 53922DEST_PATH_IMAGE092
，
减振器的伸缩运动位移
Figure 520938DEST_PATH_IMAGE093
为：
Figure 591662DEST_PATH_IMAGE094
；
其中这里的
Figure 176227DEST_PATH_IMAGE112
=
Figure 422532DEST_PATH_IMAGE072
，
Figure 434350DEST_PATH_IMAGE114
=
Figure 382584DEST_PATH_IMAGE071
，
Figure 505260DEST_PATH_IMAGE089
=
Figure 871651DEST_PATH_IMAGE082
，
Figure 54371DEST_PATH_IMAGE090
=
Figure 99687DEST_PATH_IMAGE081
；
对减振器的伸缩运动数据进行误差修正，得到修正后的减振器伸缩运动数据分别为：
修正后的减振器伸缩运动速度
Figure 652153DEST_PATH_IMAGE095
为：
Figure 997684DEST_PATH_IMAGE096
,
修正后的减振器伸缩运动位移
Figure 226671DEST_PATH_IMAGE097
为：
Figure 24863DEST_PATH_IMAGE098
；
并使当修正计算的时间大于第一阈值时，
Figure 613976DEST_PATH_IMAGE097
趋于0，当修正计算的时间小于第二阈值时，则
Figure 814013DEST_PATH_IMAGE097
小于减振器的最大行程，这里减振器的最大行程为减振器的设计参数；这里第一阈值为车轮和车身固有频率周期的5倍，所述第二阈值为车轮和车身固有频率周期的1/2；
其中，
Figure 213902DEST_PATH_IMAGE099
为减振器伸缩运动速度的修正参数。
此时即可得到车辆悬架中减振器的运动速度和运动位移。
至此通过本实施例中的测量方法，利用IMU模块得到车辆悬架中位于悬架弹簧上方和下方测量位置以及减振器的运动数据。
同时，本实施例中还涉及一种车辆悬架姿态测量系统，包括：
设置于各车轮所对应悬架弹簧上方测量位置和悬架弹簧下方测量位置处的参数采集模块，参数采集模块用于采集测量位置处的运动参数；该参数采集模块为IMU模块，位于悬架弹簧上方的测量位置位于靠近减振器与车身连接点位置的车身上，位于悬架弹簧下方的测量位置位于车轮车架或减振器缸筒外壁上；
和车辆悬架姿态测量模块，车辆悬架姿态测量模块获取参数采集模块采集的运动参数，并采用上述的车辆悬架姿态测量方法，以测量得到对应车辆悬架和减振器伸缩运动的运动数据。
在本发明的描述中，需要说明的是，所采用的术语“中心”、“上”、“下”、“左”、“右”、“竖直”、“水平”、“内”、“外”等指示的方位或位置关系为基于附图所示的方位或位置关系，或者是该发明产品使用时惯常摆放的方位或位置关系，仅是为了便于描述本发明和简化描述，而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作，因此不能理解为对本发明的限制。
此外，本发明的描述中若出现“水平”、“竖直”等术语并不表示要求部件绝对水平或悬垂，而是可以稍微倾斜。如“水平”仅仅是指其方向相对“竖直”而言更加水平，并不是表示该结构一定要完全水平，而是可以稍微倾斜。
在本发明的描述中，还需要说明的是，除非另有明确的规定和限定，若出现术语“设置”、“安装”、“相连”、“连接”应做广义理解，例如，可以是固定连接，也可以是可拆卸连接，或一体地连接；可以是机械连接，也可以是电连接；可以是直接相连，也可以通过中间媒介间接相连，可以是两个元件内部的连通。对于本领域的普通技术人员而言，可以具体情况理解上述术语在本发明中的具体含义。
以上所述仅为本发明的优选实施例而已，并不用于限制本发明，对于本领域的技术人员来说，本发明可以有各种更改和变化。凡在本发明的精神和原则之内，所作的任何修改、等同替换、改进等，均应包含在本发明的保护范围之内。

Claims (14)

1.车辆悬架姿态测量方法，其特征在于，包括以下步骤：
S1.选取位于悬架弹簧上方的至少一个测量位置和位于悬架弹簧下方的至少一个测量位置，获取测量位置处的运动参数，所述运动参数包括测量位置处的角速度数据、加速度数据；
S2.根据获取的角速度数据得到方向余弦矩阵；
S3.根据获取的加速度数据对方向余弦矩阵进行修正；
S4.根据修正后的方向余弦矩阵，将测量得到的载体坐标系下的运动加速度转换为惯性坐标系下的运动加速度，对得到的惯性坐标系下的运动加速度进行处理，消除由重力所带来的影响；
S5.根据处理后的惯性坐标系下的运动加速度得到测量位置处的运动加速度，对得到的测量位置处的运动加速度积分得到测量位置处的运动速度；
S6.对测量位置处的运动速度进行误差修正，并对修正后的运动速度积分得到测量位置处的运动位移；
S7.对测量位置处的运动位移进行误差修正，得到修正后的运动位移；
测量得到车辆悬架对应测量位置处的运动数据，包括运动加速度、运动速度和运动位移。
2.根据权利要求1所述的车辆悬架姿态测量方法，其特征在于，根据测量得到的车辆悬架对应测量位置处的运动数据，计算减振器的伸缩运动数据，并对减振器的伸缩运动数据进行误差修正，得到修正后的减振器运动速度、运动位移。
3.根据权利要求1所述的车辆悬架姿态测试方法，其特征在于，所述步骤S2中，根据获取的角速度数据得到方向余弦矩阵，包括以下步骤：
将测量位置的角位置用四元数表示为
Figure DEST_PATH_IMAGE001
，用矩阵表示为
Figure 935656DEST_PATH_IMAGE002
，得到其微分方程为
Figure DEST_PATH_IMAGE003
；
其中，
Figure 94105DEST_PATH_IMAGE004
、
Figure DEST_PATH_IMAGE005
、
Figure 602447DEST_PATH_IMAGE006
、
Figure DEST_PATH_IMAGE007
分别为四元数，
Figure 795531DEST_PATH_IMAGE008
为该位置处的角速度数据，
Figure DEST_PATH_IMAGE009
，
Figure 357224DEST_PATH_IMAGE010
为从四元数导出的旋转矩阵，
Figure DEST_PATH_IMAGE011
，
Figure 206232DEST_PATH_IMAGE012
、
Figure DEST_PATH_IMAGE013
、
Figure 783844DEST_PATH_IMAGE014
分别为绕x、y、z轴旋转的角速度；
将得到的微分方程进行离散化微分运算得到：
Figure DEST_PATH_IMAGE015
；
其中，
Figure 67320DEST_PATH_IMAGE016
为单位矩阵，
Figure DEST_PATH_IMAGE017
为当前时刻，
Figure 439395DEST_PATH_IMAGE018
为离散的时间周期，
Figure DEST_PATH_IMAGE019
为上一次计算的时刻；
得到方向余弦矩阵
Figure 165911DEST_PATH_IMAGE020
为：
Figure DEST_PATH_IMAGE021
。
4.根据权利要求3所述的车辆悬架姿态测试方法，其特征在于，所述步骤S3中，根据获取的加速度数据对方向余弦矩阵进行修正，包括以下步骤：
获取测量位置处测量的重力向量，将其转换为单位向量
Figure 783100DEST_PATH_IMAGE022
，
Figure DEST_PATH_IMAGE023
；其中，
Figure 419618DEST_PATH_IMAGE024
、
Figure DEST_PATH_IMAGE025
、
Figure 697015DEST_PATH_IMAGE026
分别为测量得到的重力向量
Figure 582932DEST_PATH_IMAGE022
分解到x、y、z方向上的加速度分量；
重力向量投影到方向余弦矩阵中，其值对应方向余弦矩阵
Figure 643291DEST_PATH_IMAGE028
的第3行，即得到根据方向余弦矩阵推算出的重力向量
Figure DEST_PATH_IMAGE029
为：
Figure DEST_PATH_IMAGE031
；
其中，
Figure 494835DEST_PATH_IMAGE032
、
Figure DEST_PATH_IMAGE033
、
Figure 943134DEST_PATH_IMAGE034
分别为重力向量
Figure 316346DEST_PATH_IMAGE029
分解到x、y、z方向上的分量；
由于
Figure 540917DEST_PATH_IMAGE022
与
Figure 824130DEST_PATH_IMAGE029
为同一物理量，得到两者之间的误差为：
Figure DEST_PATH_IMAGE035
；
其中，
Figure 302385DEST_PATH_IMAGE036
、
Figure DEST_PATH_IMAGE037
、
Figure 631735DEST_PATH_IMAGE038
分别为误差
Figure DEST_PATH_IMAGE039
在x、y、z方向上的分量；
得到测量位置处修正后的角速度向量
Figure 128838DEST_PATH_IMAGE040
为：
Figure DEST_PATH_IMAGE041
；
根据修正后的角速度向量
Figure 594454DEST_PATH_IMAGE040
，通过龙格库塔法求解四元数微分方程求出
Figure 915714DEST_PATH_IMAGE042
，得到修正后的方向余弦矩阵
Figure DEST_PATH_IMAGE043
。
5.根据权利要求4所述的车辆悬架姿态测试方法，其特征在于，所述步骤S4包括以下步骤：
将测量得到的载体坐标系下的运动加速度
Figure 732361DEST_PATH_IMAGE044
转换为惯性坐标系下的运动加速度
Figure DEST_PATH_IMAGE045
，
Figure 44873DEST_PATH_IMAGE046
；
其中，
Figure DEST_PATH_IMAGE047
、
Figure 364996DEST_PATH_IMAGE048
分别为惯性坐标系下的运动加速度
Figure 122736DEST_PATH_IMAGE045
在x、y方向的加速度分量；
对惯性坐标系下的运动加速度进行处理，消除其中由重力所带来的影响，得到
Figure DEST_PATH_IMAGE049
；其中，
Figure 161099DEST_PATH_IMAGE050
为修正后的惯性坐标系下的运动加速度在重力方向的分量，
Figure DEST_PATH_IMAGE051
为惯性坐标系下的运动加速度
Figure 5DEST_PATH_IMAGE045
在重力方向的加速度分量，
Figure 971372DEST_PATH_IMAGE052
为重力加速度；
得到处理后的惯性坐标系下的运动加速度为
Figure DEST_PATH_IMAGE053
。
6.根据权利要求5所述的车辆悬架姿态测试方法，其特征在于，所述步骤S5包括以下步骤：
计算位于悬架弹簧下方测量位置处的运动加速度
Figure 634434DEST_PATH_IMAGE054
为：
Figure DEST_PATH_IMAGE055
；其中，
Figure 894514DEST_PATH_IMAGE056
为载体坐标系到悬架弹簧下方垂直于车身坐标系的方向余弦矩阵，
Figure DEST_PATH_IMAGE057
为从惯性坐标系到载体坐标系的方向余弦矩阵，
Figure 396165DEST_PATH_IMAGE058
、
Figure DEST_PATH_IMAGE059
分别为运动加速度
Figure 425301DEST_PATH_IMAGE054
中在x和y向的加速度分量，
Figure 665789DEST_PATH_IMAGE060
为加速度
Figure 209903DEST_PATH_IMAGE054
中垂直于车身向上的加速度分量；
计算位于悬架弹簧上方测量位置处的运动加速度
Figure DEST_PATH_IMAGE061
为：
Figure 656190DEST_PATH_IMAGE062
；其中，
Figure DEST_PATH_IMAGE063
为载体坐标系到悬架弹簧上方垂直于车身坐标系的方向余弦矩阵，
Figure 805412DEST_PATH_IMAGE057
为从惯性坐标系到载体坐标系的方向余弦矩阵，
Figure 341436DEST_PATH_IMAGE064
、
Figure DEST_PATH_IMAGE065
分别为运动加速度
Figure 841687DEST_PATH_IMAGE061
中在x和y向的加速度分量，
Figure 996725DEST_PATH_IMAGE066
为加速度
Figure 298655DEST_PATH_IMAGE061
中垂直于车身向上的加速度分量；
对得到的运动加速度
Figure 880947DEST_PATH_IMAGE054
、
Figure 399653DEST_PATH_IMAGE061
积分得到悬架弹簧下方测量位置与悬架弹簧上方测量位置处的运动速度
Figure DEST_PATH_IMAGE067
、
Figure 686277DEST_PATH_IMAGE068
，其中：
Figure DEST_PATH_IMAGE069
；
Figure 75670DEST_PATH_IMAGE070
。
7.根据权利要求6所述的车辆悬架姿态测试方法，其特征在于，所述步骤S6包括以下步骤：
对测量位置处的运动速度
Figure 297704DEST_PATH_IMAGE067
、
Figure 539592DEST_PATH_IMAGE068
进行误差修正，得到对应测量位置处修正后的运动速度
Figure DEST_PATH_IMAGE071
、
Figure 223383DEST_PATH_IMAGE072
，分别为：
Figure DEST_PATH_IMAGE073
，
Figure 201703DEST_PATH_IMAGE074
；
其中，
Figure DEST_PATH_IMAGE075
、
Figure 689579DEST_PATH_IMAGE076
分别为悬架弹簧下方测量位置和悬架弹簧上方测量位置处的加速度误差修正参数；
并使当修正计算的时间大于第一阈值时，则
Figure 917298DEST_PATH_IMAGE071
、
Figure 952250DEST_PATH_IMAGE072
趋于0，当修正计算的时间小于第二阈值时，则
Figure 847394DEST_PATH_IMAGE071
、
Figure 801443DEST_PATH_IMAGE072
小于车辆悬架的最大速度值；
对修正后的运动速度积分得到悬架弹簧下方测量位置与悬架弹簧上方测量位置处的运动位移
Figure DEST_PATH_IMAGE077
、
Figure 486765DEST_PATH_IMAGE078
，分别为：
Figure DEST_PATH_IMAGE079
,
Figure 59829DEST_PATH_IMAGE080
。
8.根据权利要求7所述的车辆悬架姿态测试方法，其特征在于，所述步骤S7中，对测量位置处的运动位移进行误差修正，得到对应测量位置处修正后的运动位移
Figure DEST_PATH_IMAGE081
、
Figure 137375DEST_PATH_IMAGE082
，分别为：
Figure DEST_PATH_IMAGE083
，
Figure 996746DEST_PATH_IMAGE084
；
其中，
Figure DEST_PATH_IMAGE085
、
Figure 808845DEST_PATH_IMAGE086
分别为悬架弹簧下方测量位置和悬架弹簧上方测量位置处的速度误差修正参数；
并使当修正计算的时间大于第一阈值时，则
Figure 534400DEST_PATH_IMAGE081
、
Figure 200874DEST_PATH_IMAGE082
趋于0，当修正计算的时间小于第二阈值时，则
Figure 903250DEST_PATH_IMAGE081
、
Figure 327278DEST_PATH_IMAGE082
小于对应测量位置处车辆悬架的最大位移值。
9.根据权利要求2所述的车辆悬架姿态测试方法，其特征在于，所述根据测量得到的车辆悬架对应测量位置处的运动数据计算减振器的伸缩运动数据，包括以下步骤：
设定悬架弹簧上方测量位置和悬架弹簧下方测量位置处的运动速度分别为
Figure DEST_PATH_IMAGE087
和
Figure 602664DEST_PATH_IMAGE088
、运动位移分别为
Figure DEST_PATH_IMAGE089
和
Figure 530169DEST_PATH_IMAGE090
；
根据车辆悬架的运动学几何模型计算得到减振器的伸缩运动数据，包括：
减振器的伸缩运动速度
Figure DEST_PATH_IMAGE091
为：
Figure 200185DEST_PATH_IMAGE092
，
减振器的伸缩运动位移
Figure DEST_PATH_IMAGE093
为：
Figure 845930DEST_PATH_IMAGE094
。
10.根据权利要求9所述的车辆悬架姿态测试方法，其特征在于，所述步骤S9中，对减振器的伸缩运动数据进行误差修正，得到修正后的减振器伸缩运动数据分别为：
修正后的减振器伸缩运动速度
Figure DEST_PATH_IMAGE095
为：
Figure 925006DEST_PATH_IMAGE096
,
修正后的减振器伸缩运动位移
Figure DEST_PATH_IMAGE097
为：
Figure 707018DEST_PATH_IMAGE098
；
并使当修正计算的时间大于第一阈值时，
Figure 610252DEST_PATH_IMAGE097
趋于0，当修正计算的时间小于第二阈值时，则
Figure 149817DEST_PATH_IMAGE097
小于减振器的最大行程；
其中，
Figure DEST_PATH_IMAGE099
为减振器伸缩运动速度的修正参数。
11.根据权利要求7、8或10中任一所述的车辆悬架姿态测试方法，其特征在于，所述第一阈值为车轮和车身固有频率周期的5倍，所述第二阈值为车轮和车身固有频率周期的1/2。
12.根据权利要求1所述的车辆悬架姿态测量方法，其特征在于，所述位于悬架弹簧上方的测量位置位于靠近减振器与车身连接点位置的车身上，所述位于悬架弹簧下方的测量位置位于车轮车架或减振器缸筒外壁上。
13.根据权利要求1所述的车辆悬架姿态测量方法，其特征在于，在测量位置处分别设置IMU模块，以获取对应测量位置处的运动参数。
14.车辆悬架姿态测量系统，其特征在于，包括：
设置于各车轮所对应悬架弹簧上方测量位置和悬架弹簧下方测量位置处的参数采集模块，所述参数采集模块用于采集测量位置处的运动参数；
车辆悬架姿态测量模块，所述车辆悬架姿态测量模块获取参数采集模块采集的运动参数，并采用权利要求1-13中任一所述的车辆悬架姿态测量方法，测量得到对应车辆悬架和减振器伸缩运动的运动数据。
CN202111448813.3A 2021-12-01 2021-12-01 车辆悬架姿态测量方法和测量系统 Active CN113865616B (zh)

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 true CN113865616A (zh) 2021-12-31
CN113865616B 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)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114312202A (zh) * 2022-03-10 2022-04-12 成都九鼎科技(集团)有限公司 一种基于路况识别的半主动悬架控制方法及控制系统

Citations (13)

* Cited by examiner, † Cited by third party
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
US20030149528A1 (en) * 2002-02-06 2003-08-07 Ching-Fang Lin Positioning and navigation method and system thereof
CN101387518A (zh) * 2008-11-05 2009-03-18 北京科技大学 一种具有加减速补偿功能的车辆用磁电子罗盘及其测量方法
US20120022780A1 (en) * 2010-07-22 2012-01-26 Qualcomm Incorporated Apparatus and methods for calibrating dynamic parameters of a vehicle navigation system
US20150369704A1 (en) * 2013-01-31 2015-12-24 Compagnie Generale Des Etablissements Michelin Method for characterizing the behaviour of a vehicle and use in the selection of the tyres of the vehicle
CN105203098A (zh) * 2015-10-13 2015-12-30 上海华测导航技术股份有限公司 基于九轴mems传感器的农业机械全姿态角更新方法
CN106767804A (zh) * 2016-12-28 2017-05-31 华中科技大学 一种运动物体的多维数据测量装置及方法
CN106767847A (zh) * 2016-12-15 2017-05-31 北京三驰科技发展有限公司 一种车辆姿态安全预警方法及系统
CN108051866A (zh) * 2017-10-30 2018-05-18 中国船舶重工集团公司第七0七研究所 基于捷联惯性/gps组合辅助水平角运动隔离的重力测量方法
JP2018132378A (ja) * 2017-02-14 2018-08-23 三菱電機株式会社 加速度センサ較正装置、加速度センサ較正プログラム及び加速度センサ較正方法
CN110398244A (zh) * 2019-07-05 2019-11-01 云南省交通规划设计研究院有限公司 一种基于加速度传感器的车辆倾斜状态检测方法
CN112339517A (zh) * 2020-11-13 2021-02-09 成都九鼎科技(集团)有限公司 一种半主动悬架控制方法及控制系统
CN112577527A (zh) * 2021-02-25 2021-03-30 北京主线科技有限公司 车载imu误差标定方法及装置

Patent Citations (15)

* Cited by examiner, † Cited by third party
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
US20030149528A1 (en) * 2002-02-06 2003-08-07 Ching-Fang Lin Positioning and navigation method and system thereof
CN101387518A (zh) * 2008-11-05 2009-03-18 北京科技大学 一种具有加减速补偿功能的车辆用磁电子罗盘及其测量方法
US20120022780A1 (en) * 2010-07-22 2012-01-26 Qualcomm Incorporated Apparatus and methods for calibrating dynamic parameters of a vehicle navigation system
US20150369704A1 (en) * 2013-01-31 2015-12-24 Compagnie Generale Des Etablissements Michelin Method for characterizing the behaviour of a vehicle and use in the selection of the tyres of the vehicle
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
CN105203098A (zh) * 2015-10-13 2015-12-30 上海华测导航技术股份有限公司 基于九轴mems传感器的农业机械全姿态角更新方法
US20170350721A1 (en) * 2015-10-13 2017-12-07 Shanghai Huace Navigation Technology Ltd Method of Updating All-Attitude Angle of Agricultural Machine Based on Nine-Axis MEMS Sensor
CN106767847A (zh) * 2016-12-15 2017-05-31 北京三驰科技发展有限公司 一种车辆姿态安全预警方法及系统
CN106767804A (zh) * 2016-12-28 2017-05-31 华中科技大学 一种运动物体的多维数据测量装置及方法
JP2018132378A (ja) * 2017-02-14 2018-08-23 三菱電機株式会社 加速度センサ較正装置、加速度センサ較正プログラム及び加速度センサ較正方法
CN108051866A (zh) * 2017-10-30 2018-05-18 中国船舶重工集团公司第七0七研究所 基于捷联惯性/gps组合辅助水平角运动隔离的重力测量方法
CN110398244A (zh) * 2019-07-05 2019-11-01 云南省交通规划设计研究院有限公司 一种基于加速度传感器的车辆倾斜状态检测方法
CN112339517A (zh) * 2020-11-13 2021-02-09 成都九鼎科技(集团)有限公司 一种半主动悬架控制方法及控制系统
CN112577527A (zh) * 2021-02-25 2021-03-30 北京主线科技有限公司 车载imu误差标定方法及装置

Non-Patent Citations (4)

* Cited by examiner, † Cited by third party
Title
T IWATA等: ""Precision Attitude Determination for the Advanced Land Observing Satellite (ALOS): Design, Verification, and On-Orbit Calibration"", 《AIAA GUIDANCE, NAVIGATION AND CONTROL CONFERENCE AND EXHIBIT》 *
戎红俊等: ""基于 AMESim 的汽车液压减振器动态特性仿真研究"", 《机床与液压》 *
马芳等: ""三轴稳定平台自标定修正算法研究"", 《中国航天电子技术研究院科学技术委员会2020年学术年会论文集》 *
黄培奎等: ""田间作业车辆外部加速度辨识与姿态测量系统研制"", 《农业工程学报》 *

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114312202A (zh) * 2022-03-10 2022-04-12 成都九鼎科技(集团)有限公司 一种基于路况识别的半主动悬架控制方法及控制系统

Also Published As

Publication number Publication date
CN113865616B (zh) 2022-04-05

Similar Documents

Publication Publication Date Title
CN106679649B (zh) 一种手部运动追踪系统及追踪方法
CN106959110B (zh) 一种云台姿态检测方法及装置
CN108061855B (zh) 一种基于mems传感器的球形电机转子位置检测方法
CN109682377B (zh) 一种基于动态步长梯度下降的姿态估计方法
CN107560613B (zh) 基于九轴惯性传感器的机器人室内轨迹跟踪系统及方法
CN106370178B (zh) 移动终端设备的姿态测量方法及装置
CN108731676B (zh) 一种基于惯性导航技术的姿态融合增强测量方法及系统
CN108827301A (zh) 一种改进误差四元数卡尔曼滤波机器人姿态解算方法
CN106403940A (zh) 一种抗大气参数漂移的无人机飞行导航系统高度信息融合方法
JPWO2017175844A1 (ja) 姿勢推定装置及び輸送機器
CN110702113B (zh) 基于mems传感器的捷联惯导系统数据预处理和姿态解算的方法
CN110793515A (zh) 一种基于单天线gps和imu的大机动条件下无人机姿态估计方法
CN110873563B (zh) 一种云台姿态估计方法及装置
CN112720476A (zh) 机械臂控制方法、装置、介质及电子设备
CN113865616B (zh) 车辆悬架姿态测量方法和测量系统
CN108444468B (zh) 一种融合下视视觉与惯导信息的定向罗盘
CN109827580A (zh) 一种汽车姿态数据采集系统
CN112567097A (zh) 用于确定机器的作业设备的角度的方法
CN110058324B (zh) 利用重力场模型的捷联式重力仪水平分量误差修正方法
CN106197376B (zh) 基于单轴mems惯性传感器的车身倾角测量方法
CN109506674B (zh) 一种加速度的校正方法及装置
CN111307114A (zh) 基于运动参考单元的水面舰船水平姿态测量方法
CN104546391A (zh) 一种用于盲杖的陀螺稳定装置及其互补滤波方法
CN109674480B (zh) 一种基于改进互补滤波的人体运动姿态解算方法
CN113063416A (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