一种杆塔倾斜测量系统及倾斜解算方法与流程
本发明属于输电线路安全领域，具体涉及一种基于mimu的杆塔倾斜测量系统及倾斜解算方法。
背景技术：
我国国土面积达960万平方公里，输电线路遍布全国，杆塔数量不计其数。随之面临的杆塔损坏问题，成为输电网络的一大难题。2008年初我国出现大范围持续强降雪，各省均出现一定程度的杆塔倒塌，倾斜，覆冰等情况。综合以上情况，杆塔的倾斜损坏一般是发生在受到如台风，覆冰，舞动等导致杆塔两侧受力不均匀的情况下，进而产生导线断股，杆塔倒塌，输电线路中断等严重后果。如何实现高精度，低成本的检测杆塔倾斜状态是工程上十分关注的问题，特别是随着我国特/超高压输电线路的建成运行，现场测量的需求日益增加。
目前，不少学者对杆塔倾斜检测算法进行了研究。采用北斗卫星对塔型监测，利用rtk算法及静态处理技术确定输电杆塔的地理位置信息，并采用高精度的二维倾角传感器检测输电杆塔的姿态信息。通过光纤传感技术对杆塔发生倾斜时，传感器的中心波长变化变化进行监测，从而监测杆塔倾斜情况。通过无人机航拍，借助杆塔结构知识模型的交叉点分析法提取中轴位置，并与杆塔所处地面法线参考方向的夹角对杆塔的倾斜进行判定；将倾角传感器测量得到的三轴重力加速度转换为杆塔在三个方向上的倾斜角度作为监测杆塔倾斜依据。采用加权最小二乘法估计杆塔垂度，并在杆塔倾斜的初始阶段进行预警。采用地理编码的方法，根据塔点在不同时刻的地理坐标，得到杆塔的倾斜角度。
由于杆塔所处环境十分复杂，一般监测方法不足以胜任。近年来，mimu以其成本低、体积小、寿命长、集成化、抗冲击能力强和可靠性高等优势，发展迅猛，应用广泛。因此本发明提出一种基于mimu的杆塔倾斜测量系统及倾斜解算方法。
技术实现要素：
在实际中我们目测的杆塔好像是静止不动的，但由于外部因素的影响，其实杆塔一直处于摇摆状态，可采用mimu微惯性测量单元中陀螺仪和加速度计输出的信号进行测量到杆塔的姿态变化，从而实现杆塔的倾斜测量。
杆塔倾斜测量系统包括两部分：mimu惯性测量单元和倾斜解算单元。
mimu惯性测量单元包括：三轴mems加速度计、三轴mems陀螺仪和温度计，采集杆塔的三轴加速度、三轴角速度和测量系统环境温度数据，通过高速采集卡或spi接口把数据传输到倾斜解算单元。
将mimu测量单元与杆塔固连在一起，当杆塔发生运动时，测量单元可准确测量出杆塔的加速度和角速度数据。
倾斜解算单元也即是该测量系统的核心，由高速的嵌入式处理器、静/动态存储器、外围辅助电路和zigbee模块及电源模块构成，通过zigbee无线与电网在线监测系统连接。
倾斜解算单元对采集的数据先经过低通滤波器去除高频噪声，然后进行温度漂移和零偏补偿，采用卡尔曼滤波进行动态误差处理，最后根据处理后的加速度和角速度数据进行倾斜计算和预测，并把加速度、角速度、倾斜角及变化规律和温度通过zigbee接口传输到电网在线监测系统。
由于测量系统功耗很低，并且采用5v电源模块供电。
杆塔倾斜解算方法，其步骤如下：
由于mems陀螺仪存在常值误差和随机漂移误差，在短时间内能够保证出输出角度的准确性，但是随着时间的增加，其输出的角度的误差也随之增加，不能独立使用陀螺仪进行倾斜姿态解算。加速度计在静止或匀速运动条件下通过测量重力场，解算出侧倾角和前倾角；通过陀螺仪数据解算出杆塔扭转角，实现传感器数据融合来提高倾斜解算精度。
陀螺仪测量模型：ωb＝aωω+bω+w，其中ωb表示陀螺仪输出的角速度；aω为陀螺仪系统参数矩阵；ω为陀螺仪实际测量角速度；w为陀螺仪测量误差矩阵，满足正态分布p(w)～n(0,q)，bω表示陀螺仪漂移矩阵。
加速度计测量模型
选取三轴加速度和三轴角速度测量信号作为量测量，杆塔运动的四元数为状态量，建立如下杆塔运动状态方程和量测方程
采用kalman估计角速度ω和加速度a。
定义杆塔坐标系(b系)o-xbybzb，采用东北天地理坐标系作为导航坐标系(n系)o-xnynzn。
按照z-x-y的顺序令坐标系进行旋转，首先令o-xnynzn绕zn轴旋转γ角度得到o-x1y1z1，然后令o-x1y1z1绕x1轴旋转β角度得到o-x2y2z2,最后令o-x2y2z2绕y2轴旋转α角度得到o-xbybzb，每次旋转的角度α、β和γ，即杆塔的侧倾角α、前倾角β和扭转角γ经过三次旋转可得到旋转矩阵：
杆塔倾斜姿态可利用四元数进行倾斜姿态解算。
定义杆塔倾斜四元数：q＝[q0q1q2q3]t＝[q0e]t，其中q0是标量部分，e＝[q1q2q3]t是矢量部分。
一个向量x从b系到n系之间的转换可用下式表示
杆塔倾斜姿态角可表示为
四元数姿态解算的根本在于求解四元数，只要得到一组准确的四元数，就可结算出当前时刻杆塔倾斜姿态，从而判断杆塔的倾斜程度。
初始化四元数：假定杆塔处于静止状态即杆塔在没有外力的作用下仅受地球重力影响，此时加速度计测得数据ab＝(abxabyabz)t是重力在b系三个轴向上的投影，在地理坐标系中重力加速度在三个轴向上的投影为gn＝(00g)t；陀螺仪测得的是杆塔所在纬度(纬度l)的地球的自转角速度，陀螺仪输出的数据为gb＝(ωbxωbyωbz)t，在纬度l下的地球自转角速度
已知旋转矩阵
以四元数表示的旋转矩阵与姿态角旋转矩阵内元素一一对应，因此可得到方程
四元数更新：利用四元数法对杆塔倾斜姿态进行解算关键在于得到q0,q1,q2,q3，即更新的四元数，采用一阶龙格库塔方法更新四元数：
本发明测量系统结构简单，可直接把测量信息接入在线监测系统，能够极大程度的降低信号噪声，提高系统测量精度，且解决了杆塔变形程度低带来的实际姿态解算的困难，可以准确检测出杆塔的倾斜姿态状态，并及时预警以避免不必要的损失
附图说明
图1是杆塔倾斜测量系统结构图。
图2是杆塔倾斜姿态解算步骤。
具体实施方式
如图1所示，杆塔倾斜测量系统包括两部分：mimu惯性测量单元和倾斜解算单元。
mimu惯性测量单元包括：三轴mems加速度计、三轴mems陀螺仪和温度计，采集杆塔的三轴加速度、三轴角速度和测量系统环境温度数据，通过高速采集卡或spi接口把数据传输到倾斜解算单元。
将mimu测量单元与杆塔固连在一起，当杆塔发生运动时，测量单元可准确测量出杆塔的加速度和角速度数据。
倾斜解算单元也即是该测量系统的核心，硬件上由1ghz时钟频率的armf4嵌入式处理器，rom/ram存储器、sd卡、外围辅助电子元件和zigbee无线模块及电源模块构成。
由于测量系统功耗很低，并且采用5v电源模块供电。
如图2所示的杆塔倾斜解算方法，其解算步骤如下：
倾斜解算单元对测量单元采集的数据先经过低通滤波器去除高频噪声，然后进行温度漂移和零偏补偿。
陀螺仪测量模型：ωb＝aωω+bω+w，其中ωb表示陀螺仪输出的角速度；aω为陀螺仪系统参数矩阵；ω为陀螺仪实际测量角速度；w为陀螺仪测量误差矩阵，满足正态分布p(w)～n(0,q)，bω表示陀螺仪漂移矩阵。
加速度计测量模型
选取三轴加速度和三轴角速度测量信号作为量测量，杆塔运动的四元数为状态量，建立如下杆塔运动状态方程和量测方程
采用kalman估计角速度ω和加速度a。
定义杆塔坐标系(b系)o-xbybzb，采用东北天地理坐标系作为导航坐标系(n系)o-xnynzn。
按照z-x-y的顺序令坐标系进行旋转，首先令o-xnynzn绕zn轴旋转γ角度得到o-x1y1z1，然后令o-x1y1z1绕x1轴旋转β角度得到o-x2y2z2,最后令o-x2y2z2绕y2轴旋转α角度得到o-xbybzb，每次旋转的角度α、β和γ，即杆塔的侧倾角α、前倾角β和扭转角γ经过三次旋转可得到旋转矩阵：
杆塔倾斜姿态可利用四元数进行倾斜姿态解算。
定义杆塔倾斜四元数：q＝[q0q1q2q3]t＝[q0e]t，其中q0是标量部分，e＝[q1q2q3]t是矢量部分。
一个向量x从b系到n系之间的转换可用下式表示
杆塔倾斜姿态角可表示为
四元数姿态解算的根本在于求解四元数，只要得到一组准确的四元数，就可结算出当前时刻杆塔倾斜姿态，从而判断杆塔的倾斜程度。
初始化四元数：假定杆塔处于静止状态即杆塔在没有外力的作用下仅受地球重力影响，此时加速度计测得数据ab＝(abxabyabz)t是重力在b系三个轴向上的投影，在地理坐标系中重力加速度在三个轴向上的投影为gn＝(00g)t；陀螺仪测得的是杆塔所在纬度(纬度l)的地球的自转角速度，陀螺仪输出的数据为gb＝(ωbxωbyωbz)t，在纬度l下的地球自转角速度
已知旋转矩阵
以四元数表示的旋转矩阵与姿态角旋转矩阵内元素一一对应，因此可得到方程
四元数更新：利用四元数法对杆塔倾斜姿态进行解算关键在于得到q0,q1,q2,q3，即更新的四元数，采用一阶龙格库塔方法更新四元数：
最后说明的是以上实施案例仅用于说明本发明的技术方案而非限制，可以对本发明进行修改或更换，而不脱离本技术方案的范围，其均应涵盖在本发明的权利要求范围当中。
- 还没有人留言评论。精彩留言会获得点赞！