《一种轮式装载机侧倾翻预测的方法.pdf》由会员分享，可在线阅读，更多相关《一种轮式装载机侧倾翻预测的方法.pdf（9页珍藏版）》请在专利查询网上搜索。
1、10申请公布号CN102767208A43申请公布日20121107CN102767208ACN102767208A21申请号201210285387022申请日20120809E02F9/2420060171申请人厦门大学地址361005福建省厦门市思明南路422号72发明人祝青园陈浩宇谢文怡盛世岳李聪叶添杰74专利代理机构厦门南强之路专利事务所35200代理人马应森刘勇54发明名称一种轮式装载机侧倾翻预测的方法57摘要一种轮式装载机侧倾翻预测的方法，涉及铰接式车辆倾翻预测方法。提供一种在轮式装载机工作时，能实时监测轮式装载机运动参数及计算倾翻危险指标，达到主动预防倾翻危险的轮式装载机侧倾翻。
2、预测的方法。在车体上建立坐标系，利用车辆仪表盘测得车速，结合铰接点夹角计算出车辆离心加速度，由三轴陀螺仪计算出车辆相对中立加速度转角，从而在车辆坐标系中表示出中立加速度，并由离心加速度重力加速度求出和加速度。采集四个轮的支持力，结合车辆动力学方程，由XY轴动平衡关系计算出车辆质心坐标以及整车质量。定义质心和车辆倾翻时的转动轴线倾翻面，该转动轴线倾翻面的法向量和加速度夹角减去90度为稳态余量角，故可作为评判依据。51INTCL权利要求书1页说明书6页附图1页19中华人民共和国国家知识产权局12发明专利申请权利要求书1页说明书6页附图1页1/1页21一种轮式装载机侧倾翻预测的方法，其特征在于所采用。
3、的装置包括三轴陀螺仪、胎压传感器、倾角传感器、传统速度仪表、数据采集系统和数据处理器；将三轴陀螺仪固装在轮式装载机前车架与后车架之间的铰接点处，将胎压传感器固装在轮胎气门上，将倾角传感器安装在铰接点处，速度仪表直接采用驾驶室的传统速度仪表，数据采集系统和数据处理器设于轮式装载机的控制电路中；三轴陀螺仪、胎压传感器、倾角传感器和速度仪表分别均与轮式装载机的控制电路电信号连接，所述预测方法包括以下步骤1）静止状态下标定三轴陀螺仪的Z轴零偏，消除陀螺仪零偏重复性误差；2）由车辆仪表盘输出车辆速度，倾角传感器读出铰接点转角，以计算车辆转弯半径，以及离心加速度大小以及方向，在车辆自身坐标系中用向量表示出。
4、该加速度；3）由三轴陀螺仪输出参数计算原重力方向相对车辆自身的转角，并在车辆坐标系中表示出重力加速度方向；4）将重力加速度和离心加速度矢量相加，得出加速度向量值；5）建立车辆动力学方程，通过胎压传感器采集到的数据计算出四个车轮法向作用力，结合步骤4）中的加速度向量值，求出车辆质量大小以及车辆质心坐标值；6）计算倾翻面法向量值以及倾翻轴线坐标值；7）由车辆瞬时转向半径和车速计算出未来某时刻后的车辆坐标系相对当前车辆的旋转和平移量，从而计算出未来重力加速度向量值；8）将步骤7）得到的重力加速度向量值与步骤2）中的离心加速度经矢量合成，求得未来合力矢量值；9）求出各个面的稳态余量角与安全阈值0比较，。
5、当稳态余量角N5时即表明存在倾翻危险，应采取相应措施；10）按设定的时间间隔，重新采集数据，跳转到步骤1）循环开始。2如权利要求1所述的一种轮式装载机侧倾翻预测的方法，其特征在于所述的步骤5）中，车辆质心坐标值的确定由轮式装载机四轮法向力以及通过轮式装载机动力学翻转模型计算得，再通过步骤9）中求出稳态余量角，所述稳态余量角由下述表达式求得，稳态余量角用来反映轮式装载机倾翻的危险状态式中，向量为重力和惯性力合力方向，向量为某个倾翻面的法向量，N为向量和的夹角，即为稳态余量角；当N5时，表示装载机即将发生倾翻，系统报警提示。3如权利要求1所述的一种轮式装载机侧倾翻预测的方法，其特征在于在步骤10）。
6、中，所述设定的时间间隔为01S。权利要求书CN102767208A1/6页3一种轮式装载机侧倾翻预测的方法技术领域0001本发明涉及铰接式车辆倾翻预测方法，尤其是涉及一种轮式装载机侧倾翻预测的方法。背景技术0002伴随我国经济建设的发展，我国工程车辆发展异常迅速，其中轮式装载机是典型量大、面广的工程车辆，而工程车辆倾翻（包括侧倾翻、前后倾翻）事故比例高、危害大，其中又以轮式装载机尤为突出。对于轮式装载机来讲，在实际应用中常使用翻车保护结构（ROLLOVERPROTECTSTRUCTURE，ROPS）来抵御倾翻给驾驶员带来的危害。翻车保护结构，是指车辆驾驶室在翻车时受到巨大的冲击载荷，其翻车保护。
7、结构应具有足够的侧向刚度来阻止其变形,同时又要能够吸收一定的能量，减小事故给驾驶员带来的危害（1KENNETHFORLOWSKICRASHTESTSTHEINFLUENCEOFROOFSTRENGTHONINJURYMECHANICS,SAEPAPER851734）。0003但翻车保护结构只是被动防御倾翻带来的危害，并不能从根本上防止倾翻的发生，所以才有了倾翻主动防御的出现。倾翻主动防御是借助于车上的各种传感器、电脑和其他一些电子装置来实现的，通过倾翻主动防御最大限度的避免倾翻的发生。其中应用广泛的有TIMETOROLL（以下简称TTR，对倾翻发生时间的预测）预警机制；其原理通常都是通过测量当。
8、前各种运动参数，对比倾翻参考模型，预测未来时间段的倾翻危险来达到主动预防倾翻（2CHEN,B，PENG,HROLLOVERWARNINGFORARTICULATEDVEHICLESBASEDONATIMETOROLLOVERMETRICCPROCEEDINGSOFTHE1999ASMEINTERNATIONALCONGRESSANDEXPOSITION,KNOXVILLE,TN,NOVEMBER1999）。该方法能提供提前预警功能并具备一定的精确性。0004上述方法存在以下缺点现有公路车辆倾翻预警算法以及预警参考模型不能应用于轮式装载机，因为当系统工作时，系统的参考模型是假设车辆的结构和质心不。
9、变，而实际情况是轮式装载机在工作时结构发生变化，质心变化无规律，使得公路车辆的倾翻预警算法以及预警参考模型应用到轮式装载机上并不适用。0005中国专利2007100643203提供了一种车辆防侧翻惯性测量及控制方法，该方法所采用的装置包括一个微观形测量单元和传统速度仪表，可自主计算车辆防侧翻系数，自动发出提示信息以及执行制动控制指令，但由于公路车辆具有轮式装载机所不具有的悬挂结构，而轮式装载机本身具有摆动式驱动桥这类特殊结构，两者差异明显，并且轮式装载机翻车事故中还有部分是倾翻而不是侧翻，因而上述发明专利并不适用于轮式装载机这类工程车辆。现有技术中存在的技术缺陷，成为本领域技术人员急待解决的一。
10、个重要技术问题。发明内容0006本发明的目的是提供一种在轮式装载机工作时，能实时监测轮式装载机运动参数及计算倾翻危险指标，达到主动预防倾翻危险的轮式装载机侧倾翻预测的方法。说明书CN102767208A2/6页40007本发明的技术方案为一种轮式装载机倾翻预测方法，所采用的装置包括三轴陀螺仪、胎压传感器、倾角传感器、传统速度仪表、数据采集系统和数据处理器；将三轴陀螺仪固装在轮式装载机前车架与后车架之间的铰接点处，将胎压传感器固装在轮胎气门上，将倾角传感器安装在铰接点处，速度仪表直接采用驾驶室的传统速度仪表，数据采集系统和数据处理器设于轮式装载机的控制电路中；三轴陀螺仪、胎压传感器、倾角传感器和。
11、速度仪表分别均与轮式装载机的控制电路电信号连接。0008本发明包括以下步骤00091）静止状态下标定三轴陀螺仪的Z轴零偏，消除陀螺仪零偏重复性误差；00102）由车辆仪表盘输出车辆速度，倾角传感器读出铰接点转角，以计算车辆转弯半径，以及离心加速度大小以及方向，在车辆自身坐标系中用向量表示出该加速度；00113）由三轴陀螺仪输出参数计算原重力方向相对车辆自身的转角，并在车辆坐标系中表示出重力加速度方向；00124）将重力加速度和离心加速度矢量相加，得出加速度向量值；00135）建立车辆动力学方程，通过胎压传感器采集到的数据计算出四个车轮法向作用力，结合步骤4）中的加速度向量值，求出车辆质量大小以。
12、及车辆质心坐标值；00146）计算倾翻面法向量值以及倾翻轴线坐标值；00157）由车辆瞬时转向半径和车速计算出未来某时刻后的车辆坐标系相对当前车辆的旋转和平移量，从而计算出未来重力加速度向量值；00168）将步骤7）得到的重力加速度向量值与步骤2）中的离心加速度经矢量合成，求得未来合力矢量值；00179）求出各个面的稳态余量角与安全阈值0比较，当稳态余量角N5时即表明存在倾翻危险，应采取相应措施；001810）按设定的时间间隔，重新采集数据，跳转到步骤1）循环开始。0019在步骤5）中，质心坐标值的确定由轮式装载机四轮法向力以及通过轮式装载机动力学翻转模型计算得，再通过步骤9）中求出稳态余量角。
13、，所述稳态余量角由下述表达式求得，稳态余量角用来反映轮式装载机倾翻的危险状态00200021式中，向量为重力和惯性力合力方向，向量为某个倾翻面的法向量，N为向量和的夹角，即为稳态余量角；当N5时，表示装载机即将发生倾翻，系统报警提示。0022在步骤10）中，所述设定的时间间隔可为01S。0023本发明的原理如下0024本发明是在车体上建立坐标系，利用车辆仪表盘测得车速，结合铰接点夹角计算出车辆离心加速度，由三轴陀螺仪计算出车辆相对中立加速度转角，从而在车辆坐标系中表示出中立加速度，并由离心加速度重力加速度求出和加速度。采集四个轮的支持力，结合车辆动力学方程，由XY轴动平衡关系计算出车辆质心坐标。
14、以及整车质量。定义质心和车辆倾翻时的转动轴线倾翻面，该转动轴线倾翻面的法向量和和加速度夹角减去90度为稳说明书CN102767208A3/6页5态余量角，故可作为评判依据。0025根据TTR基本思想，认为在足够小的时间段内车辆参数不变，根据轮式装载机动态参考模型，计算出未来时刻在车辆坐标系中重力加速度的矢量值。因车辆坐标系随车一起转动，故认为离心加速度不变。从而求得未来时刻和加速度。将失稳面法向量和和加速度向量矢量相乘，利用三角函数关系，求出未来时刻车辆稳态余量角，将该值与阈值比较，即可判断出车辆稳定状态情况。0026与现有技术比较，本发明具有如下突出优点00271、可实时计算车辆质心位置，自。
15、动发出提示信息，并可提供未来某时刻的倾翻危险预测，具有一定的时间提前量，从而具备预警功能。00282、可在静止状态快速标定Z轴陀螺仪零偏，消除陀螺仪零偏重复性误差。00293、特别适用于轮式装载机这种质心运动不确定的铰接式工程车辆。00304、可从根本上最大限度地避免倾翻（包括侧倾翻、前后倾翻等各种倾翻形式）事故的发生，安全性显著提高。0031总之，本发明可从根本上预防轮式装载机倾翻危险，该预测方法检测率高、误警率低，检测性能可靠性高。此外，该预测方法建模收敛速度快，无须参数调整，而且由于计算量少，工程实现容易，填补了轮式装载机倾翻预警系统的空白。附图说明0032图1为本发明实施例所述轮式装载。
16、机在坡面上的转向示意图。具体实施方式0033参见图1，图1中的各标号表示1轮式装载机右前轮，2轮式装载机前车架，3轮式装载机左前轮，4三轴坐标系X轴，5三轴坐标系Y轴，6三轴坐标系Z轴，7轮式装载机前车架与后车架之间的铰接点，8轮式装载机后车架，9轮式装载机左后轮，10轮式装载机后车架摆动桥，11轮式装载机右后轮，12轮式装载机质心坐标。0034为了实现本发明所述的轮式装载机侧倾翻预测的方法，本发明所采用的装置包括MEMS三轴陀螺仪、胎压传感器（4个）、倾角传感器、传统速度仪表、数据采集系统和数据处理器，其中MEMS三轴陀螺仪主要包括微机械敏感元件、驱动元件；提供车体的转角速度和装载机工作过程。
17、中的姿态；数据采集和数据处理系统由NI（NATIONALINSTRUMENTS）公司的COMPACTRIO系统以及LABVIEW程序编程，NICOMPACTRIO系统是一个开放的嵌入式构架，包括内置嵌入式控制器、实时操作系统、可编程FPGA现场可编程门阵列以及工业INPUT/OUTPUT模块，可以快速实现测量与控制系统的设计、原型和发布。利用NI9205模拟信号采集模块和NI9422数字信号采集模块实现动态预测模型中输入参数的实时在线采集，并将研究得到的倾翻动态预测模型植入到FPGA现场可编程门阵列中，当系统判断有倾翻危险时，控制器通过NI9263模拟量输出模块输出5V电压信号，驱动相应报警装。
18、置进行报警。0035本发明实施例的具体实施步骤为00361）首先根据车载传统速度仪表（通过装载机四轮转速计算装载机运行线速度）测得装载机速度V，判断V是否小于微小量（取传统速度仪表测量噪声值），当V时，标定陀螺仪零偏，对陀螺仪输出数据清零；说明书CN102767208A4/6页600372）由角度传感器读出铰接点7转角，再根据装载机运行线速度V，以计算车辆转弯半径R0，以及铰接点离心加速度大小以及方向；00380039004000410042则0043以轮式装载机前车架与后车架之间的铰接点7为原点，轮式装载机前车架2对称中心线为X轴，建立三轴坐标系（X轴4，Y轴5，Z轴6），该坐标系建立在前车。
19、架上令装载机前车架2方向为X轴4，在自身坐标系中用向量表示出该加速度；00443）由三轴陀螺仪输出参数计算原重力方向相对车辆自身的转角，并在车辆坐标系中表示出重力加速度00454）将重力加速度和离心加速度矢量相加，得出合加速度向量值00465）建立车辆动力学方程0047绕Z轴力矩平衡方程00480049绕Y轴平衡方程00500051绕X轴力矩平衡方程00520053根据4个胎压传感器采集到的数据经过计算得出四个车轮（右前轮1、左前轮3、左后轮9、右后轮11）的法向作用力，结合加速度，求出车辆质量大小以及轮式装载机质心坐标12GX,Y,Z；00546）由上步骤4）确定的轮式装载机质心坐标12，结。
20、合装载机倾翻轴线坐标值（右前轮1和AXA,YA,ZA、左前轮3和BXB,YB,ZB以及轮式装载机后车架摆动桥10与轮式装载机后车架8连接点EXE,YE,ZE）计算倾翻面法向量值；0055前倾翻面0056后倾翻面说明书CN102767208A5/6页70057左侧翻面0058右侧翻面00597）由车辆瞬时转向半径和车速计算出未来某时刻后的车辆坐标系相对当前车辆的旋转和平移量，假设在微小时间内装载机运行状态不变，可计算出未来某时刻（由T表示）后车辆坐标系相对当前坐标系旋转和平移量，则坐标系原点相对于初始时刻转角00600061则重力实际方向相对坐标系转角为，旋转矩阵为T00620063计算出未来T。
21、时刻重力加速度向量值00648）将未来T时刻重力加速度向量值与第一阶段步骤2）中离心加速度矢量合成，因坐标系随车辆一起运动，离心加速度表示方式不变，求得未来X时刻合力矢量值006500669）求装载机各个面的稳态余量角N00670068与安全阈值0比较，若N0，取0为5，微小时间后刷新数据，重新开始计算，否则输出报警；006910）01S后，重新采集数据，跳转到步骤1）循环开始。0070上述说明书中所出现的符号分别表示0071N稳态余量角；定义为重力和惯性力合力方向与倾翻面的法向量之间的夹角00720安全阈值，通常取50073A右前轮坐标0074B左前轮坐标0075E摆动桥与车架连接点0076。
22、E/后车轴中心点0077重力和惯性力合力矢量0078F1左边车轮所受垂直载荷0079F2右边车轮所受垂直载荷0080G重力加速度0081重力加速度向量值0082未来T时刻重力加速度向量值0083H重心到侧倾中心的距离0084倾翻面法向量0085R0装载机转弯半径0086微小量，取速度仪表测量噪声值说明书CN102767208A6/6页80087V装载机线速度0088VX整机在X方向速度0089VY整机在Y方向速度0090L前后轴轴距0091L1前轴到铰接点的距离0092L2后轴到铰接点的距离0093K比例系数0094Q轴的长度0095前车架转弯角0096坐标系原点相对于初始时刻转角0097整机航向角0098后车轴延长线与车辆转向中心和铰接店连线所夹的锐角。0099A铰接点离心加速度0100铰接点离心加速度矢量0101FY1前轮在Y方向受的侧向力0102FY2后轮在Y方向受的侧向力0103IZZ整机绕Z轴的转动惯量0104IR整机绕侧倾轴的转动惯量0105T未来某时刻0106T旋转矩阵0107M整机质量。说明书CN102767208A1/1页9图1说明书附图CN102767208A。