CN114395953B - 一种便携式高压水射流钢轨打磨入射角标定方法及系统 - Google Patents

Abstract

本发明公开了一种便携式高压水射流钢轨打磨入射角标定方法及系统，本方法采用加速度计和陀螺仪来采集加速度原始数据和角速度原始数据，结合两种传感器的灵敏度求得三轴加速度数据和三轴角速度数据，然后通过定义求得加速度计的惯性力矢量，求出该矢量与各轴之间的第一组夹角数据，为降低打磨作业中机械振动和噪声的影响，将受外界振动影响较小的陀螺仪得到的三轴角速度数据作为第二组夹角数据，将两组数据采用一阶互补算法得到精确值，即给两组数据赋值不同的权重进行修正，最终确定入射角度，将两种传感器的劣势互补，解决了水射流钢轨打磨入射角标定时易受机械振动和噪声影响带来误差的问题。

Description

一种便携式高压水射流钢轨打磨入射角标定方法及系统

技术领域

本发明涉及高压水射流打磨技术领域，更具体地，涉及一种便携式高压水射流钢轨打磨入射角标定方法及系统。

背景技术

随着我国铁路交通飞速发展，铁路的里程、范围高速增长，同时列车的运行速度、载重也有很大的提升，这些情况给钢轨带来了很大的压力，由此引发的钢轨疲劳、磨损等问题越来越突出。现有的钢轨修复技术主要有钢轨打磨车修复和钢轨铣磨车修复两种，这两种作业方式环境比较恶劣，作业过程中产生的金属火花、粉尘和噪音使钢轨维护作业的费用高，同时这两种作业方式通用性较差，我国目前并不具有自主开发钢轨打磨车和铣磨车的技术，在已有的技术方案之外，磨料高压水射流加工技术也可以应用于钢轨的打磨和修复，在高压水射流对钢轨进行打磨时，需要一种装置对高压水射流喷嘴的入射角度进行标定。

现有技术存在的缺点：目前，针对水射流领域的角度标定系统较少，已有的倾角仪设备大多适合在机械振动和噪声不大的环境下工作，在受机械振动较大时容易影响测算数据，并且大多数角度标定系统采用激光技术、红外测距技术，成本高昂。

发明内容

针对现有技术的以上缺陷或改进需求，本发明提供一种便携式高压水射流钢轨打磨入射角标定方法，本方法采用加速度计和陀螺仪来采集加速度原始数据和角速度原始数据，结合两种传感器的灵敏度求得三轴加速度数据和三轴角速度数据，然后通过定义求得加速度计的惯性力矢量，求出该矢量与各轴之间的第一组夹角数据，为降低打磨作业中机械振动和噪声的影响，将受外界振动影响较小的陀螺仪得到的三轴角速度数据作为第二组夹角数据，将两组数据采用一阶互补算法得到精确值，即给两组数据赋值不同的权重进行修正，最终确定入射角度，将两种传感器的劣势互补，解决了水射流钢轨打磨入射角标定时易受机械振动和噪声影响带来误差的问题。

为了实现上述目的，按照本发明的一个方面，提供一种便携式高压水射流钢轨打磨入射角标定方法，包括以下步骤：

S100，固定标定系统并采集原始数据,测得角速度原始数据A_x、A_y、A_z，以及加速度原始数据Ω_x、Ω_y、Ω_z；

S200，计算加速度数据和陀螺仪数据，S100中的原始数据，以及三轴加速度计和三轴陀螺仪的灵敏度，由以下公式计算得到加速度数据α_x,y,z和角速度数据ω_x,y,z：

α_x,y,z(ω_x,y,z)＝A_x,y,z(Ω_x,y,z)/Sensitivity_α(ω)；

S300，解算得到第一组入射角度，水射流的入射角度即喷嘴相对于工件表面的倾斜度，以垂直于工件表面的方向为Z轴建立坐标系，θ和Φ分别等于

和

由S200可知各轴加速度数据分别为R_x、R_y、R_z，且满足：

R_α ²＝R_x ²+R_y ²+R_z ²；

α_α ²＝α_x ²+α_y ²+α_z ²；

然后通过如下的公式得到加速度矢量R_α与X、Y轴之间的夹角：

S400，解算得到第二组入射角度，由角速度数据得到的倾角计算公式为：B_x,y＝∫ω_x,ydt；

S500，通过融合算法得到入射角度，对S300和S400得到的数据，给加速度计和陀螺仪计算得到的值赋以不同的权重，最终通过以下计算式得到入射角度的确定值：

高压水射流钢轨打磨入射角度最终通过与工件坐标系X,Y轴方向夹角，即俯仰角θ和滚转角Φ完成标定。

按照本发明的另一个方面，提供一种便携式高压水射流钢轨打磨入射角标定系统，包括：

传感器单元，用于采集角速度原始数据和加速度原始数据；

控制单元，用于解算得到第一组入射角度、第二组入射角度和入射角的确定值；

显示屏，用于显示数据解算模块得到的最终结果；

所述传感器单元和所述控制单元信号连通，所述控制单元与所述显示屏信号连通。

进一步地，包括防护壳体，所述传感器单元和所述控制单元固定于所述防护壳体内，所述显示屏固定安装于所述防护壳体表面。

进一步地，所述固定模块包括卡爪和卡盘，所述卡盘固定设于所述防护壳体的侧部，所述卡爪设于所述卡盘上。

总体而言，通过本发明所构思的以上技术方案与现有技术相比，能够取得下列有益效果：

1.本发明提供一种便携式高压水射流钢轨打磨入射角标定方法，采用加速度计和陀螺仪来采集加速度原始数据和角速度原始数据，结合两种传感器的灵敏度求得三轴加速度数据和三轴角速度数据，然后通过定义求得加速度计的惯性力矢量，求出该矢量与各轴之间的第一组夹角数据，为降低打磨作业中机械振动和噪声的影响，将受外界振动影响较小的陀螺仪得到的三轴角速度数据作为第二组夹角数据，将两组数据采用一阶互补算法得到精确值，即给两组数据赋值不同的权重进行修正，最终确定入射角度，将两种传感器的劣势互补，解决了水射流钢轨打磨入射角标定时易受机械振动和噪声影响带来误差的问题。

2.本发明提供一种便携式高压水射流钢轨打磨入射角标定系统，包括防护壳体、显示屏、卡爪、卡盘，将传感器单元和控制单元集成于防护壳体内，防止打磨时损伤标定系统，并在防护壳体表面固定显示屏，将最终解算得到的数据显示在显示屏上，方便操作人员实时查看数据，而通过卡盘套在喷嘴上，可以将防护壳体快速定位，然后将卡爪锁定，增加了标定系统的使用便携性。

附图说明

图1是本发明实施例便携式高压水射流钢轨打磨入射角标定系统的结构示意图一；

图2是本发明实施例传感器单元与控制单元的引脚连接图；

图3是本发明实施例便携式高压水射流钢轨打磨入射角标定方法图；

图4是本发明实施例便携式高压水射流钢轨打磨入射角标定系统的信号传输图。

在所有附图中，同样的附图标记表示相同的技术特征，具体为：1-防护壳体、2-显示屏、3-卡爪、4-卡盘、5-喷嘴、11-传感器单元、12-控制单元。

具体实施方式

为了使本发明的目的、技术方案及优点更加清楚明白，以下结合附图及实施例，对本发明进行进一步详细说明。应当理解，此处所描述的具体实施例仅用以解释本发明，并不用于限定本发明。此外，下面所描述的本发明各个实施方式中所涉及到的技术特征只要彼此之间未构成冲突就可以相互组合。

如图1、图2和图4所示，按照本发明的一个方面，本发明提供便携式高压水射流钢轨打磨入射角标定系统，包括传感器单元11，用于采集角速度原始数据和加速度原始数据；控制单元12，用于解算得到第一组入射角度、第二组入射角度和入射角的确定值；显示屏2，用于显示数据解算模块得到的最终结果；以及防护壳体1、卡爪3和卡盘4，其中，防护壳体1为金属外壳，其内设置传感器单元11和控制单元12，两者通过外接电源供电，传感器单元11内设多种传感器用于采集喷嘴的倾角等信息，然后将该信息传送至控制单元12，在防护壳体1表面固定安装有显示屏2，显示屏2与控制单元12信号连通，该屏幕用于显示加工过程中高压水射流的入射角度，既而保证加工的精度，在防护壳体1的侧面还固定有固定模块，固定模块包括卡盘4和卡爪3，卡盘4中心设置通孔供喷嘴穿入，在卡盘4上还设置有卡爪3，通过调整卡爪3夹紧或松弛，可以调整卡盘4的上下位置，从而调整防护壳体1的位置，整个标定系统便于拆卸和安装，解决了水射流喷嘴入射角标定容易受振动影响和使用不够便捷的问题。

进一步地，如图1所示，所述传感器单元11集成了三轴陀螺仪、三轴加速度计以及姿态解算器，优选地，传感器单元11采用MPU-6050模块，陀螺仪的有以下4个倍率：±250°/s、±500°/s、±1000°/s、±2000°/s，加速度计以重力加速度的倍数为单位，有一下4个倍率：±2g、±4g、±8g、±16g，陀螺仪和加速度计将采集到的数据通过I2C读取传输给控制单元12。

进一步地，如图1所示，所述控制单元12优选采用基于Cortex-M3内核的STM32微控制器，该控制器是一种具有油量引脚兼容性和外设兼容性的32位微处理器，系统时钟默认采用8MHz，一般经过倍频后采用72MHz作为系统时钟，通过控制器单元处理采集到的数据，解算得到水射流实际入射角度，控制单元12再将该角度数据传输至显示屏2。进一步地，显示屏2用于实时显示加工过程中高压水射流的入射角度，优选地，采用有机发光二极管(OLED)显示屏，相较于传统的液晶显示，采用OLED单元结构简单轻便，相应迅速，还具有良好的可视角度。

如图1-图3所示，按照本发明的另一个方面，本发明提供便携式高压水射流钢轨打磨入射角标定方法，具体包括：

S100，固定标定系统并采集原始数据；

具体地，将卡盘4套装于喷嘴5上，调整好位置后转动卡爪3卡设在喷嘴5上，从而将标定系统固定，使用I2C串行通信至系统控制单元12接口，通过I2C读取到传感器单元11测得的六个数据，分别是三轴陀螺仪测得的角速度原始数据A_x、A_y、A_z，以及三轴加速度计测得的加速度原始数据Ω_x、Ω_y、Ω_z，测量之前传感器单元11坐标系与工件坐标系方向保持一致，因此入射角度可用包括与工件坐标系X,Y轴方向的夹角，即姿态角中的俯仰角θ和滚转角Φ来确定；

S200，计算加速度数据和陀螺仪数据；

具体地，由于MPU-6050的加速计和陀螺仪都采用16位二进制补码来分别储存最近的X、Y、Z轴的加速度原始数据和角速度原始数据，陀螺仪的有以下4个倍率：±250°/s、±500°/s、±1000°/s、±2000°/s，加速度计以重力加速度的倍数为单位，有一下4个倍率：±2g、±4g、±8g、±16g，MPU6050的初始化设置的加速度计满量程范围为±2g，陀螺仪满量程范围为±2000°/s，以上的六个分量都是16位的二进制补码值，其输出范围为-32768至32768，加速度计的灵敏度为32767/2＝16384，陀螺仪的灵敏度为32767/2000＝16.4，具体计算公式为：α_x,y,z(ω_x,y,z)＝A_x,y,z(Ω_x,y,z)/Sensitivity_α(ω)，α_x,y,z为加速度数据，ω_x,y,z为角速度数据，即：

加速度数据＝加速度原始数据/加速度计灵敏度；

角速度数据＝角速度原始数据/陀螺仪灵敏度；

S300，解算得到第一组入射角度；

具体地，由加速度计和陀螺仪得到的数据可以定义一个惯性力矢量，其方向与加速度矢量R_α方向一致，水射流的入射角度即喷嘴相对于工件表面的倾斜度，以垂直于工件表面的方向为Z轴建立坐标系，θ和Φ分别等于

和

由S200得出的α_x,y,z可知，各轴加速度数据分别为R_x、R_y、R_z，且满足：

R_α ²＝R_x ²+R_y ²+R_z ²；

α_α ²＝α_x ²+α_y ²+α_z ²；

可以通过如下的公式得到加速度矢量R_a与X、Y轴之间的夹角：

由加速度计测得的数据可以初步得到了各轴的倾斜角度，但是仅由此得到的数据是不够准确的，理想状态下，加速度计测量的惯性力只由引力引起，但在实际作业中，由于水射流喷嘴的运动，加速度计还会受其他的力作用，除此以外，高压水射流进行钢轨打磨作业时，产生的机械振动和噪声也会影响数据的准确性，因此，需要对加速度计和陀螺仪采集到的数据进行综合分析；

加速度计采集到的数值没有累积误差，可以计算得到倾角，但是在水射流加工作业时水射流喷嘴会产生加速度，磨料水射流从喷嘴中高速喷出，工件的振动也会产生加速度等，因此不能直接将加速度计的数据作为最终数据，而陀螺仪受外界的振动影响较小，具有可靠的精度，通过对角速度ω积分可以计算得到倾角的数值，但是同时会在这个过程中产生累积误差。因此，不能单独使用加速度计或者陀螺仪来得到倾角的最终结果；

S400，解算得到第二组入射角度；

具体地，由陀螺仪得到的倾角计算公式为：

B_x,y＝∫ω_x,ydt；

由于读取数据的采样频率是有限的，因此上式实际上可写成：

其中n为采样次数，t为采样时间，ω_i为实时角速度；

S500，通过融合算法得到入射角度；

具体地，对加速度计和陀螺仪得到的两组数据采用一阶互补算法来得到精确值，即给加速度计和陀螺仪计算得到的值赋以不同的权重，进行修正，最终得到入射角度的确定值；

计算公式如下：

因此，入射角度最终通过与工件坐标系X,Y轴方向夹角，即俯仰角θ和滚转角Φ完成确定。

本领域的技术人员容易理解，以上所述仅为本发明的较佳实施例而已，并不用于限制本发明，凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等，均应包含在本发明的保护范围之内。

Claims (8)

1.一种便携式高压水射流钢轨打磨入射角标定方法，包括以下步骤:

S100，固定标定系统并采集原始数据,测得角速度原始数据A_x、A_y、A_z，以及加速度原始数据Ω_x、Ω_y、Ω_z；

S200，计算加速度数据和陀螺仪数据，S100中的原始数据，以及三轴加速度计和三轴陀螺仪的灵敏度，由以下公式计算得到加速度数据α_x,y,z和角速度数据ω_x,y,z：

α_x,y,z(ω_x,y,z)＝A_x,y,z(Ω_x,y,z)/Sensitivity_α(ω)；

S300，解算得到第一组入射角度，水射流的入射角度即喷嘴相对于工件表面的倾斜度，以垂直于工件表面的方向为Z轴建立坐标系，θ和Φ分别等于

和

由S200可知，定义R_α为加速度矢量，各轴加速度数据分别为R_x、R_y、R_z，R_α的具体数值为加速度数据α_α，且满足：

R_α ²＝R_x ²+R_y ²+R_z ²；

α_α ²＝α_x ²+α_y ²+α_z ²；

然后通过如下的公式得到加速度矢量R_α与X、Y轴之间的夹角：

S400，解算得到第二组入射角度，由角速度数据得到的倾角计算公式为：B_x,y＝∫ω_{x, y}dt；

S500，通过融合算法得到入射角度，对S300和S400得到的数据，给加速度计和陀螺仪计算得到的值赋以不同的权重，最终通过以下计算式得到入射角度的确定值：

高压水射流钢轨打磨入射角度最终通过与工件坐标系X,Y轴方向夹角，即俯仰角θ和滚转角Φ完成标定。

2.根据权利要求1所述的一种便携式高压水射流钢轨打磨入射角标定方法，其特征在于，所述S100包括：固定三轴加速度计和三轴陀螺仪，通过三轴陀螺仪和通过三轴加速度计分别测得角速度原始数据和加速度原始数据。

3.根据权利要求2所述的一种便携式高压水射流钢轨打磨入射角标定方法，其特征在于，所述三轴加速度计和所述三轴陀螺仪的坐标系与工件坐标系方向相同。

4.根据权利要求1所述的一种便携式高压水射流钢轨打磨入射角标定方法，其特征在于，所述S300包括：加速度数据和角速度数据可以定义一个惯性力矢量，其方向与加速度矢量R_α方向一致。

5.根据权利要求1所述的一种便携式高压水射流钢轨打磨入射角标定方法，其特征在于，所述S500包括：

读取数据的采样频率是有限的，B_x,y＝∫ω_x,ydt转化为以下公式：

其中n为采样次数，t为采样时间，ω_i为实时角速度。

6.一种便携式高压水射流钢轨打磨入射角标定系统，应用于权利要求1-5中任一项所述的便携式高压水射流钢轨打磨入射角标定方法及实现，其特征在于，包括：传感器单元(11)，用于采集角速度原始数据和加速度原始数据；

控制单元(12)，用于解算得到第一组入射角度

与

第二组入射角度B_x与B_y，以及入射角度θ与Φ的确定值；

显示屏(2)，用于显示数据解算模块得到的最终结果；

所述传感器单元(11)和所述控制单元(12)信号连通，所述控制单元(12)与所述显示屏(2)信号连通。

7.根据权利要求6所述的一种便携式高压水射流钢轨打磨入射角标定系统，其特征在于，包括防护壳体(1)，所述传感器单元(11)和所述控制单元(12)固定于所述防护壳体(1)内，所述显示屏(2)固定安装于所述防护壳体(1)表面。

8.根据权利要求7所述的一种便携式高压水射流钢轨打磨入射角标定系统，其特征在于，包括固定模块，所述固定模块包括卡爪(3)和卡盘(4)，所述卡盘(4)固定设于所述防护壳体(1)的侧部，所述卡爪(3)设于所述卡盘(4)上。

Images