一种轨道平整度测量方法技术

技术编号:15301886 阅读:374 留言:0更新日期:2017-05-13 10:58
本发明专利技术提供一种轨道平整度测量方法,包括以下步骤:(1)将具有加速度传感器、角速度传感器、磁传感器的行走机构放置在轨道上,并移动到轨道相应位置;(2)获取加速度传感器、角速度传感器的原始数据,根据原始数据得出行走机构的俯仰角、偏航角和翻滚角;(3)判断步骤(2)中获得的俯仰角、偏航角、翻滚角是否位于标准阈值区间内,如果位于标准阈值区间内则说明轨道平整,否则,轨道不平整。本发明专利技术可以智能判断轨道安装的平整度,实现轨道安装检测过程操作的简易性、安全性和效率。

A method for measuring track roughness

The invention provides a rail flatness measurement method, which comprises the following steps: (1) the walking mechanism will have an acceleration sensor, angular velocity sensor, magnetic sensor placed on the track, and move to the corresponding position of the track; (2) the original data acquisition acceleration sensor, angular velocity sensor, based on the original data that pitch walk the angle, yaw angle and roll angle; (3) judging step (2) in the pitch angle, yaw angle and roll angle is in the standard range of threshold value, if in the standard range of threshold value indicates that the track is smooth, otherwise, track irregularity. The invention can intelligently judge the smoothness of the rail installation, and realize the simplicity, the safety and the efficiency of the track installation and detection process operation.

【技术实现步骤摘要】

本专利技术涉及一种轨道平整度测量方法
技术介绍
轨道机器人日常巡检监控任务都是在轨道上进行的,因此机器人对于轨道的稳定性和平整度存在着较高要求。为了保障巡检监控任务地顺利运行,需要对前期轨道安装工艺进行严格把关,轨道安装过程中会存在三维空间的角度偏差,而常见的人工采取倾角仪测量的方法只能获取轨道在二维角度上的偏差,并且测量误差较大,过程繁琐,当人工爬高去进行测量时存在安全隐患,效率较低。
技术实现思路
为解决现有技术存在的问题,本专利技术提供一种轨道平整度测量方法,智能判断轨道安装的平整度,实现轨道安装检测过程操作的简易性、安全性和效率。本专利技术提供的轨道平整度测量方法,包括以下步骤:(1)将具有加速度传感器、角速度传感器、磁传感器的行走机构放置在轨道上,并移动到轨道相应位置;(2)获取加速度传感器、角速度传感器的原始数据,根据原始数据得出行走机构的俯仰角、偏航角和翻滚角;行走机构的俯仰角、偏航角和翻滚角与轨道的俯仰角、偏航角和翻滚角相同。(3)判断步骤(2)中获得的俯仰角、偏航角、翻滚角是否位于标准阈值区间内,如果位于标准阈值区间内则说明轨道平整,否则,轨道不平整。优选地,所述步骤(2)具体包括;(2.1)获取加速度传感器、角速度传感器的原始数据作为四元素,利用该四元素作为初值初始化四元素q0、q1、q2、q3,将四元素q0、q1、q2、q3转化为欧拉角θ、ψ、该组欧拉角作为第一组姿态角Q0,θ、ψ、分别表示俯仰角、偏航角、翻滚角;(2.2)对加速度传感器的原始数据进行中值滤波,得到加速度数据A-data,A-data包含分别对应x轴,y轴,z轴的Ax,Ay,Az三个分量,利用这三个分量进行姿态解算,得到俯仰角θ,翻滚角以及z轴与重力加速度的夹角γ,其中(2.3)获取磁传感器的原始数据并进行中值滤波,得到磁数据M-data,该数据包含三个分量Mx,My,Mz,然后进行倾斜补偿:根据倾斜补偿结果得到偏航角其中θ、为步骤(2.2)中得到俯仰角、翻滚角。(2.4)对角速度传感器的原始数据进行均值滤波得到角速度数据ω-data,对ω-data积分运算后得到对应的角度Qk=(ωk-ωb)dt+Qk-1,其中,Qk为当前时刻的角度;ωk为角速度传感器当前时刻的角速度;ωb为当前时刻角速度的偏移量;dt为采样周期;Qk-1为前一时刻的角度值。(2.5)将步骤(2.2)、(2.3)、(2.4)获得的俯仰角θ、翻滚角偏航角ψ、当前时刻的角度Qk通过卡尔曼滤波算法进行融合得到第二组姿态角Q1;(2.6)将第一组姿态角Q0和第二组姿态角Q1通过一阶互补滤波进行融合,得到融合后数据Qt=αQ0+βQ1,根据融合后数据Q得到最终准确的俯仰角、翻滚角、偏航角,其中,α,β对应Q0、Q1置信权重,α+β=1。α取值范围为0.3-0.5,β取值范围:0.7~0.5。为实现对不平整轨道位置的准确定位,本专利技术所述行走机构上还安装有定位系统,该定位系统用于对行走机构进行定位,确定行走机构在轨道上的位置,当检测到轨道不平整时,可以利用行走机构的位置确定不平整轨道的位置。当俯仰角、偏航角、翻滚角不在标准阈值区间内时,行走机构停止走动并发出报警,直至该轨道被修复平整,将行走机构重新放回该处,测得相关数据符合要求后,行走机构继续检测下一段轨道。为了实现前期轨道安装工艺地严格把控,本专利技术使用陀螺仪对轨道稳定性和平整性进行测量,使用ARM处理器对数据进行处理,使用手持数据分析液晶屏显示轨道平整度信息,减少人工测量的误差。为了实现对轨道三维角度偏差的测量精确反馈,使用AHRS扩展分时算法和卡尔曼滤波算法对测量数据进行处理,使用数据分析液晶屏的偏差量及偏差曲线作为反馈量,使用异常指示灯判断轨道平整度,智能精准定位出异常倾斜的轨道区域。本专利技术使用行走机构装载测量设备,将测量设备拓展成为一个移动平台,使操作简易安全,提高轨道安装效率。本专利技术实现智能判断轨道安装的平整度,自动进行具体区域地标定,反馈偏差值,进行精准修正,使得机器人导轨的稳定性和平整性得到保证。附图说明图1为本专利技术流程图;图2为手持数据分析液晶屏的控制界面;图3为手持数据分析液晶屏的三维姿态角界面;图4为手持数据分析液晶屏的偏差角界面。具体实施方式本专利技术的行走机构可采用申请号为201610186221.1的专利技术专利提供的机器人行走机构,该行走机构采用一个高性能有刷电机为动力,在驱动轮的下面有定位系统,结合电机编码器位置环能精准采集行走的距离,该行走机构具有八个导向轮,在行走机构与轨道接触的两端,各有4个导向轮,相互配合,紧贴轨道,不会产生晃动影响陀螺仪数据;导向模块可在水平面上转动一定角度以适应转向调节,可实现无死角转向,在转弯处不会产生运动方向受力。行走机构上安装有定位系统,采取9个磁钢与霍尔传感器配合,可实现无接触性,轨道不需要安装供电的情况下,准确定位机构行走的距离。行走机构上安装有陀螺仪、ARM处理器、三轴MEMS模块测量模块,也可以直接使用MPU9250传感器,该传感器集成了陀螺仪、加速度传感器和磁传感器。本专利技术整体方案描述如下:1、将行走机构放在需要测试平整度的轨道上;2、将行走机构的上的ARM处理器、三轴MEMS模块测量模块上电;3、在手持数据分析液晶屏设置轨道平整度的标准阈值区间(-0.6°~+0.6°),该标准阈值区间是根据机器在轨道上运行保证水平姿态而设定,通过无线模块发送给轨道上的行走机构;4、输入需要测试的轨道的距离,点击运行,如图2所示,为手持数据分析液晶屏的控制界面;5、轨道的行走机构会在轨道上移动,当遇到某一段平整度不在标准阈值区间内的区域时会自动停止行走并发出红色闪烁灯;该段轨道平整度数据传输给手持数据分析液晶屏;由于测得翻滚角、俯仰角、偏航角三个数据,只要任意一个数据不再标准阈值区间内,都会停止行走。6、手持数据分析液晶屏显示轨道平整度异常信息,在手持数据分析液晶屏观察偏差量及偏差曲线,如图3所示为手持数据分析液晶屏的三维姿态角界面,显示的是该段轨道的翻滚角、俯仰角、偏航角数据,图4所示为手持数据分析液晶屏的偏差角界面,显示偏差量及偏差曲线;7、工人在异常轨道区域进行人工修正,直至异常闪烁红色变为正常(表示数据正常),该段轨道平整度达到要求。如图1所示,本专利技术获得准确的俯仰角、翻滚角、偏航角的具体步骤如下:①第一组姿态角Q0使用InvenSense公司生产的MPU9250,MPU9250自带DMP(数字运动处理器)和MPL(嵌入式运动处理库)对MPU9250的加速度传感器和角速度传感器的原始数据进行处理,得到四元数并输出,用这个四元数作为初值初始化四元数q0、q1、q2、q3,由于欧拉角比较直观,xb、yb、zb为该模块载体三轴的坐标,xn、yn、zn:为参考坐标系下的坐标,需要将四元数转换成欧拉角:首先,从四元素q0、q1、q2、q3转换成方向余弦矩阵:然后再通过方向余弦矩阵转换成欧拉角:式中Tij(i,j=1,2,3)表示方向余弦矩阵的第i行、第j列元素。这样就可以得到第一组姿态角Q0(包括俯仰角、翻滚角、偏航角)。②第二组姿态角Q11)加速度数据处理得到加速度计原始数据后,进行一次中值滤波,得到处理后的加速度数据A-data,A-data包含Ax,A本文档来自技高网...
一种轨道平整度测量方法

【技术保护点】
一种轨道平整度测量方法,其特征在于,包括以下步骤:(1)将具有加速度传感器、角速度传感器、磁传感器的行走机构放置在轨道上,并移动到轨道相应位置;(2)获取加速度传感器、角速度传感器的原始数据,根据原始数据得出行走机构的俯仰角、偏航角和翻滚角;(3)判断步骤(2)中获得的俯仰角、偏航角、翻滚角是否位于标准阈值区间内,如果位于标准阈值区间内则说明轨道平整,否则,轨道不平整。

【技术特征摘要】
1.一种轨道平整度测量方法,其特征在于,包括以下步骤:(1)将具有加速度传感器、角速度传感器、磁传感器的行走机构放置在轨道上,并移动到轨道相应位置;(2)获取加速度传感器、角速度传感器的原始数据,根据原始数据得出行走机构的俯仰角、偏航角和翻滚角;(3)判断步骤(2)中获得的俯仰角、偏航角、翻滚角是否位于标准阈值区间内,如果位于标准阈值区间内则说明轨道平整,否则,轨道不平整。2.如权利要求1所述的轨道平整度测量方法,其特征在于,所述步骤(2)具体包括;(2.1)获取加速度传感器、角速度传感器的原始数据作为四元素,利用该四元素作为初值初始化四元素q0、q1、q2、q3,将四元素q0、q1、q2、q3转化为欧拉角θ、ψ、该组欧拉角作为第一组姿态角Q0,θ、ψ、分别表示俯仰角、偏航角、翻滚角;(2.2)对加速度传感器的原始数据进行中值滤波,得到加速度数据A-data,A-data包含分别对应x轴,y轴,z轴的Ax,Ay,Az三个分量,利用这三个分量进行姿态解算,得到俯仰角θ,翻滚角以及z轴与重力加速度的夹角γ,其中(2.3)获取磁传感器的原始数据并进行中值滤波,得到磁数据M-data,该数据包含三个分量Mx,My,Mz,然后进行倾斜补偿:根据倾斜补偿结果得到偏航角其...

【专利技术属性】
技术研发人员:祝国富马震程敏赵伟许春山
申请(专利权)人:亿嘉和科技股份有限公司
类型:发明
国别省市:江苏;32

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1