[发明专利]基于时延补偿的无模型船体变形测量方法有效
申请号: | 201710058077.8 | 申请日: | 2017-01-23 |
公开(公告)号: | CN106840151B | 公开(公告)日: | 2019-05-17 |
发明(设计)人: | 彭侠夫;何荧;张霄力;仲训昱;杨功流 | 申请(专利权)人: | 厦门大学 |
主分类号: | G01C21/16 | 分类号: | G01C21/16;G01C1/00 |
代理公司: | 厦门南强之路专利事务所(普通合伙) 35200 | 代理人: | 马应森 |
地址: | 361005 *** | 国省代码: | 福建;35 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | 基于时延补偿的无模型船体变形测量方法,涉及船体变形测量领域。提供一种在没有变形角先验模型的情况下能够实时快速地估算舰船变形角,并对数据之间存在的时间延迟进行估计和补偿的基于时延补偿的无模型船体变形测量方法。在舰船中心惯导系统附近和舰载设备附近安装两套激光陀螺系统,根据安装点处的姿态信息构建形变滤波观测量,基于四元数姿态矩阵通过引入时间延迟量推导出理想姿态矩阵与实际姿态矩阵之间的数学关系,并将时延量扩展到系统状态变量中,利用神经网络对舰船变形角进行估计,将神经网络的连接权系数扩展到系统状态变量中,利用非线性滤波器对构建的系统状态方程和观测方程进行求解,估算出舰船变形角及时延大小。 | ||
搜索关键词: | 基于 补偿 模型 船体 变形 测量方法 | ||
【主权项】:
1.基于时延补偿的无模型船体变形测量方法,其特征在于包括以下步骤:1)将两套三轴激光陀螺第一套三轴激光陀螺LGU1和第二套三轴激光陀螺LGU2分别安装在舰船的中心惯导附近和舰载设备附近,第一套三轴激光陀螺LGU1的三个敏感轴命名为xyz,第二套三轴激光陀螺LGU2的三个敏感轴命名为x’y’z’,oy、oy’轴沿舰船的纵轴,oz、oz’轴与甲板平面垂直并指向上方,ox、ox’轴分别与其他两个轴构成右手正交坐标系;2)第一套三轴激光陀螺LGU1和第二套三轴激光陀螺LGU2所使用的惯性坐标系分别取为各自在初始时刻对应的载体坐标系,利用两套陀螺输出的角速率信息相对于各自的惯性空间对姿态矩阵C1、C2进行更新,记C1、C2为:
3)在实际运行环境中两套LGU输出的角速率信息并不同步,设定第一套三轴激光陀螺LGU1不存在时间延迟,第二套三轴激光陀螺LGU2存在时间延迟Δt,将第二套三轴激光陀螺LGU2理想的姿态阵C2(q(t))在时间t‑Δt处泰勒展开,若只保留前两项,则有:
上式即为第二套三轴激光陀螺LGU2理想姿态矩阵与实际姿态矩阵之间的近似关系,其中q=[q1,q2,q3,q4]T为旋转四元数,
式中T为采样时间,qi,k为qi第k次采样值,qi,k‑1为qi第k‑1次采样值,i=1,2,3,4;
表达为:
4)建立激光陀螺常值漂移和随机漂移模型第一套三轴激光陀螺LGU1常值漂移:
第一套三轴激光陀螺LGU1随机漂移:
第二套三轴激光陀螺LGU2常值漂移:
第二套三轴激光陀螺LGU2随机漂移:
其中ε0、ε′0分别为第一套三轴激光陀螺LGU1和第二套三轴激光陀螺LGU2的陀螺常值漂移,εr、ε′r分别为第一套三轴激光陀螺LGU1和第二套三轴激光陀螺LGU2的陀螺随机漂移,μi为陀螺随机漂移的一阶马尔科夫系数,σi为陀螺漂移的均方差,w(t)为白噪声;5)构建系统状态方程:系统状态向量选取为:
其中,
为t0时刻的变形角,θi、θ′i为第一套三轴激光陀螺LGU1和第二套三轴激光陀螺LGU2的陀螺对应的真实惯性系与计算惯性系之间的误差角,Δt为时间延迟;
基于上述方程,将状态方程写为矩阵形式:
6)构建系统观测方程:系统观测向量选取为:
记:![]()
则系统的观测方程表达为:Z=h(X)+g(Z,W)+v(t)其中,
为方便计算,忽略h(X)中的二阶小量采用公式![]()
为包含变形角
的神经网络函数,Z为神经网络的输入,W为神经网络的连接权系数,Z‑h(X)为神经网络的目标输出,因此,只要计算出g(Z,W),即计算出变形角
v(t)为量测噪声;7)扩展状态变量:将系统状态变量X和神经网络连接权系数W联合起来形成新的状态变量
并认为W是时不变的,对于两层参数神经网络,连接权系数W包含输入系数Wr、输入阈值br、输出系数Wc及输出阈值bc四个部分,即:W=[Wr,br,Wc,bc]T,其中:
l为中间层神经元个数![]()
![]()
对状态方程
离散化得到:Xk+1=f(Xk)+G·wk扩展状态变量后的状态方程为:
其中
nw为连接权系数W的维数;扩展状态变量后的系统状态方程和观测方程离散化为:
8)利用非线性滤波器对上述问题进行求解,实时估计状态变量
根据公式
计算出变形角![]()
下载完整专利技术内容需要扣除积分,VIP会员可以免费下载。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于厦门大学,未经厦门大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/patent/201710058077.8/,转载请声明来源钻瓜专利网。