发明内容
本发明所要解决的技术问题是提供一种基于陀螺仪和加速度计的实现杆塔稳固性监测和预警的系统及方法,用于解决现有技术中不易实现对杆塔稳固性进行实时监测与预警的问题。
本发明解决上述技术问题的技术方案如下:一种实现杆塔稳固性监测和预警的系统,包括电源模块、数据采集及处理模块和远程终端;
所述电源模块,其与所述数据采集及处理模块连接,用于为所述数据采集及处理模块供电;
所述数据采集及处理模块,其与所述远程终端相连,用于采集杆塔的旋转角速度数据和加速度数据,并对旋转角速度数据和加速度数据进行时间同步,再对已同步的旋转角速度数据和加速度数据进行数据滤波和融合处理,再对经滤波和融合后的旋转角速度数据和加速度数据进行积分计算,得到杆塔的状态信息,并将状态信息传输至所述远程终端;
所述远程终端,其用于存储和分析状态信息,并根据分析结果实现预警。
在上述技术方案的基础上,本发明还可以做如下改进。
进一步,所述数据采集及处理模块包括陀螺仪、加速度计、主控制模块和无线传输模块;
所述陀螺仪,其输出端与所述主控制模块的输入端相连,用于采集旋转角速度数据,并将旋转角速度数据传输至所述主控制模块;
所述加速度计,其输出端与所述主控制模块的输入端相连,用于采集加速度数据,并将所述加速度数据传输至所述主控制模块;
所述主控制模块,其输出端与所述无线传输模块相连,用于对加速度数据和旋转角速度数据进行时间同步,并对已同步的旋转角速度数据和加速度数据进行数据滤波和融合处理,再对经滤波和融合后的旋转角速度数据和加速度数据进行积分计算,得到并输出杆塔的状态信息;
所述无线传输模块,其用于将所述主控制模块输出的状态信息传送至所述远程终端。
进一步,所述陀螺仪为MEMS三轴陀螺仪,用于测量三个轴向的旋转角速度数据;所述加速度计为MEMS三轴加速度计,用于测量三个轴向的加速度数据。
进一步,所述主控制模块包括数据同步模块和数据滤波及融合模块;
所述数据同步模块,用于对旋转角速度数据和加速度数据进行时间同步,并将获得的同步数据传输给所述数据滤波及融合模块;
所述数据滤波及融合模块,用于根据数据滤波与融合算法处理已同步的旋转角速度数据和加速度数据,再对经滤波和融合后的旋转角速度数据和加速度数据进行积分计算,得到杆塔的状态信息。
同时,本发明还相应地给出了一种实现杆塔稳固性监测和预警的方法,具体包括:
步骤1,采集杆塔的加速度数据和旋转角速度数据;
步骤2,对旋转角速度数据和加速度数据进行时间同步,再对已同步的旋转角速度数据和加速度数据进行数据滤波和融合处理;
步骤3,对经滤波和融合后的旋转角速度数据和加速度数据进行积分计算,得到杆塔的状态信息,并将状态信息传输至远程终端;
步骤4,远程终端存储和分析状态信息,并根据分析结果实现预警。
对于该技术方案,本发明也还可以做如下改进。
进一步,所述步骤1中利用基于MEMS技术的三轴陀螺仪采集旋转角速度数据,且利用基于MEMS技术的三轴加速度计采集加速度数据。
进一步,所述步骤2中利用单片机技术对加速度数据和旋转角速度数据进行时间同步和对已同步的旋转角速度数据和加速度数据进行数据滤波和融合处理。
进一步,对已同步的旋转角速度数据和加速度数据进行数据融合处理具体包括:依据上一时刻的重力矢量方向的估计值,结合陀螺仪测得的旋转角速度值计算当前时刻的重力矢量方向,再与当前时刻加速度计返回的矢量方向进行加权平均,得到当前矢量方向的最优估计值。
进一步,所述步骤3中利用单片机技术对经滤波和融合后的旋转角速度数据和加速度数据进行积分计算,且通过无线传输的方式将状态信息传输至远程终端。
进一步,所述步骤3和步骤4中的状态信息包括杆塔的位置信息、速度信息和/或姿态信息。
本发明的有益效果是:主要有以下几个方面:
一、具有结构简单、成本低、适用范围广等优点。由于采用了加速度计和陀螺仪的数据滤波与融合,加速度计和陀螺仪误差对测量精度的影响被有效地抑制,拓展了惯性测量系统新的应用领域。
二、陀螺仪用于测量方向,加速度计用于测量位移,两者结合起来就可以直接测量物体运动的矢量,再利用单片机技术将陀螺仪数据和加速度计数据进行时间同步,并对数据进行滤波和融合计算获得高精度的稳固性监测信息,克服了使用单一传感器时各自的缺陷,并利用现代无线通信技术进行数据传输,实现电力、通信杆塔远程实时监控。
三、基于MEMS技术的陀螺仪和加速度计结合的杆塔稳固性监测和预警系统具有成本低、耗能低、体积小、自动化程度高的特点,能够应用在地形复杂、自然条件恶劣、常规手段难以到达、难以维护的地方。
四、由陀螺仪和加速度计组成的惯性测量单元,不需要从杆塔中传送信号或者从外部接收信号,不受环境及无线电干扰的影响,能连续地提供杆塔位置、速度和姿态等状态参数,其数据更新效率快、量程较大,且具有较高的精度。
具体实施方式
以下结合附图对本发明的原理和特征进行描述,所举实例只用于解释本发明,并非用于限定本发明的范围。
如图1所示,本实施例给出了一种基于陀螺仪和加速度计组成的惯性测量单元的杆塔稳固性监测和预警系统,包括电源模块1、数据采集及处理模块2和远程终端3;
所述电源模块1,其与所述数据采集及处理模块2连接,用于为所述数据采集及处理模块2供电;
所述数据采集及处理模块2,其与所述远程终端3相连,用于采集杆塔的旋转角速度数据和加速度数据,并对旋转角速度数据和加速度数据进行时间同步,再对已同步的旋转角速度数据和加速度数据进行数据滤波和融合处理,再对经滤波和融合后的旋转角速度数据和加速度数据进行积分计算,得到杆塔的状态信息,并将状态信息传输至所述远程终端3;
所述远程终端3,其用于存储和分析状态信息,并根据分析结果实现预警。
可知,所述数据采集及处理模块2为本系统的核心,其包括陀螺仪4、加速度计5、主控制模块6和无线传输模块7;
所述陀螺仪4,其输出端与所述主控制模块6的输入端相连,用于采集旋转角速度数据,并将旋转角速度数据传输至所述主控制模块6;
所述加速度计5,其输出端与所述主控制模块6的输入端相连,用于采集加速度数据,并将所述加速度数据传输至所述主控制模块6;
所述主控制模块6,其输出端与所述无线传输模块7相连,用于对加速度数据和旋转角速度数据进行时间同步,并对已同步的旋转角速度数据和加速度数据进行数据滤波和融合处理,再对经滤波和融合后的旋转角速度数据和加速度数据进行积分计算,得到并输出杆塔的状态信息;
所述无线传输模块7,其用于将所述主控制模块6输出的状态信息传送至所述远程终端3。
所述陀螺仪4为MEMS三轴陀螺仪,可测量三个轴向的旋转角速度。所述加速度计5为MEMS三轴加速度计,可测量三个轴向的加速度。所述主控制模块6采用单片机技术开发,其包括数据同步模块8和数据滤波及融合模块9;
所述数据同步模块8,用于对旋转角速度数据和加速度数据进行时间同步,并将获得的同步数据传输给所述数据滤波及融合模块;
所述数据滤波及融合模块9,用于根据数据滤波与融合算法处理已同步的旋转角速度数据和加速度数据,再对经滤波和融合后的旋转角速度数据和加速度数据进行积分计算,得到杆塔的状态信息。
如图2所示,上述系统的具体工作流程如下:
1)向数据采集及处理模块供电后,系统首先进行自检,并初始化;
2)系统正常运行后,三轴陀螺仪开始测量测站点处三轴的旋转角速度,并将测量数据传输至主控制模块;与此同时,三轴加速度计开始测量测站点处的三轴加速度,并将测量数据传输至主控制模块;
3)主控制模块接收到陀螺仪和加速度计的测量数据后,通过其数据同步模块得到同一时间标记的角速度测量数据和加速度测量数据,并传输至数据滤波及融合模块;
4)数据滤波及融合模块接收到数据同步模块输出的同步数据后,对观测数据进行滤波,再对数据进行融合并通过积分计算获取杆塔高精度的位置、速度、姿态等状态信息,并传输至远程终端;系统还需根据计算结果对塔杆偏离状态进行判定,当回到塔杆初始位置及陀螺仪转速归零时,系统初始化重新开始积分计算。
5)远程终端获取各时刻杆塔的位置信息后,对各类数据进行入库存储,计算获得杆塔高精度的空间位置变化信息,对监测结果进行统计分析,并根据阈值判断是否播发预警信息。
如图3所示,对应上述系统,本实施例还给出了一种实现杆塔稳固性监测和预警的方法,具体包括:
步骤1,采集杆塔的加速度数据和旋转角速度数据;
步骤2,对旋转角速度数据和加速度数据进行时间同步,再对已同步的旋转角速度数据和加速度数据进行数据滤波和融合处理;
步骤3,对经滤波和融合后的旋转角速度数据和加速度数据进行积分计算,得到杆塔的状态信息,并将状态信息传输至远程终端;
步骤4,远程终端存储和分析状态信息,并根据分析结果实现预警。
其中,所述步骤1中利用基于MEMS技术的三轴陀螺仪采集旋转角速度数据,且利用基于MEMS技术的三轴加速度计采集加速度数据;所述步骤2中利用单片机技术对加速度数据和旋转角速度数据进行时间同步和对已同步的旋转角速度数据和加速度数据进行数据滤波和融合处理;所述步骤3中利用单片机技术对经滤波和融合后的旋转角速度数据和加速度数据进行积分计算,且通过无线传输的方式将状态信息传输至远程终端。
另外,所述步骤3和步骤4中的状态信息包括杆塔的位置信息、速度信息和/或姿态信息。
可知,对加速度计与陀螺仪采集的数据进行融合计算是本实施例的核心,目前在现有技术中相关的融合算法比较多,适用于本发明的融合算法也较多,本实施例中选择其中一种算法,并列出相应公式进行说明。本实施例采用的融合算法的具体方法为依据上一时刻的重力矢量方向的估计值,结合陀螺仪测得的角度值计算当前时刻的重力矢量方向,再与当前时刻加速度计返回的矢量方向进行加权平均,得到当前矢量方向的最优估计值。具体流程如下:
1)加速度数据处理
主控制模块从加速度计获得三轴加速度分别为G
x,G
y,G
z,静止时,系统三轴加速度值的矢量和为重力矢量
可得:
由归一化矢量方向可得到重力矢量同坐标轴的夹角θx,θy,θz:
2)陀螺仪数据处理
陀螺仪能够提供瞬间的动态角度变化,但是由于其本身的固有特征、温度及积分过程的影响,它会随着工作时间的延长产生漂移误差。为了克服这些影响,对陀螺仪数据建立低通数字滤波器,设置陀螺仪的滤波器截频和采样率,后续数据为已经过低通滤波的数据。
主控制模块从陀螺仪获得当前系统滤波后的转动角速度ωx,ωy,ωz得到系统的转动角度,其中T为采样间隔。
由上一时刻的加速度矢量估计值
和当前转动角度可得到当前时刻重力矢量的另一个估计值
利用式(3)得:
由 可得
同理可得:
其中θx,θy,θz为当前时刻重力矢量同坐标轴的夹角与系统转动角度Δθx,Δθy,Δθz之和,此时重力矢量的估计值为:
3)传感器数据加权融合
当前时刻的重力矢量估计
由从加速度计测得的当前重力加速度矢量
与
加权平均得到:
其中,W为陀螺仪权值:
当加速度矢量绝对值接近1g,系统不受其他外力作用时,陀螺仪的权值最小,此时系统的重力矢量估计值以加速度计返回值为准;当加速度矢量绝对值偏离1g时,此时系统受到外力作用,加速度计返回值偏离重力矢量方向,此时陀螺仪权值增加,系统以陀螺仪估值为准。
4)积分计算位置
实施步骤3),经陀螺仪校正后,加速度计中包含的噪声被有效地平滑,系统因受外力而出现的重力矢量偏移被有效地减小。对经过融合校正过的加速度数据进行积分计算,即可获取各时刻的位置和姿态。
以上所述仅为本发明的较佳实施例,并不用以限制本发明,凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。