[发明专利]基于惯性测量组件的船体微小形变测量方法在审
申请号: | 201710395809.2 | 申请日: | 2017-05-31 |
公开(公告)号: | CN107356246A | 公开(公告)日: | 2017-11-17 |
发明(设计)人: | 高伟;吴鹏飞;王茁;王国臣;李倩 | 申请(专利权)人: | 哈尔滨工业大学 |
主分类号: | G01C21/16 | 分类号: | G01C21/16;G01C9/00 |
代理公司: | 暂无信息 | 代理人: | 暂无信息 |
地址: | 150001 黑龙*** | 国省代码: | 黑龙江;23 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 基于 惯性 测量 组件 船体 微小 形变 测量方法 | ||
1.基于惯性测量组件的船体微小形变测量方法,其实现步骤包括:
(1)分别在船体首尾各安装一个光纤陀螺作为子惯导系统,分别记为FGU1和FGU2;船舶自身还有一个主惯导系统,记为FGU3。
(2)如果FGU1和FGU2之间没有形变角时,两个坐标系平行;如果有形变角,两个坐标系将不平行,那么光纤陀螺三个轴敏感到的横摇、纵摇和航向角速度也不相等。所以角速度信息是直接反应船体变形角的变量,因此将主、子捷联惯导系统输出的角速度信息差值作为观测量,即迭代法中迭代方程的输入量。
(3)将主惯导系统FGU3对准并处于高精度导航状态,即正常工作。
(4)将惯导系统FGU1和FGU2预热后,分别采集光纤陀螺仪和加速度计的输出数据。
(5)建立以主惯导系统FGU3和子惯导系统FGU1或FGU2的角速率误差关系式:
两套惯导系统(主、子惯导系统)可以测得角速度信息、加速度信息以及姿态信息。主惯导系统的陀螺输出的角速度即为主惯导坐标系相对于惯性空间坐标系的绝对角速度ωib为:
ωib=ωie+ωeb (1)
其中,ωie为地理坐标系相对于惯性坐标系的牵连角速度,ωeb为主惯导坐标系相对于地理坐标系的相对角速度。将上式投影到载体坐标系并写成三轴投影的形式可得:
同理可得到子惯导系统的陀螺输出的角速度在载体坐标系上三轴投影的形式
其中μθ=[μθx μθy μθz]T为由船体变形产生的主惯导系统坐标系相对子惯导系统坐标系的变形角速率。将主惯导系统的陀螺输出的角速度投影到子惯导系统坐标系上可得:
其中转换矩阵为
式(5)中φ=[φx φy φz]T为主惯导系统载体坐标系与子惯导系统载体坐标系之间的失准角,它是由静态变形角和挠曲变形角θ组成。由于和的分量都可以由安装在其部位的陀螺直接测定,因此首先取两套惯导系统陀螺输出的差值,由式(3)、(4)可得:
(6)建立以惯导系统FGU1和惯导系统FGU2的角速率误差为输入量的迭代关系式:
由上式(6)可以得到由于舰船形变引起的形变角速度μθ在子惯导坐标系上的投影。由转动的方向余弦矩阵微分方程:
其中,
将式(7)展开写为
由于船体形变产生的角速度μθ在子惯导坐标系上的投影已知,所以我们就可以通过求解上述微分方程组求出方向余弦项cij(其中i,j=1,2,3),然后就可以求解变形角φx、φy、φz:
另外根据欧拉角方程也可以求出变形角
对该式求逆可得:
进一步展开:
考虑主子惯导系统载体坐标系之间的失准角一般为小角度,故上式可近似变为:
忽略掉二阶小量,式(14)可写为:
从上边的分析可以得出,根据两套陀螺的输出差值进行积分就可以求得变形角,将求得的变形角代入式(5)中,求出新的转换矩阵进而进行下一步的迭代。
(7)从理论仿真角度出发,利用迭代方程,实时的估计出船体理论上的动态变形角和静态变形角。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于哈尔滨工业大学,未经哈尔滨工业大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201710395809.2/1.html,转载请声明来源钻瓜专利网。