挠曲形变测量网络的分布式POS传递对准建模方法和装置与流程

文档序号:15162116发布日期:2018-08-14 16:47阅读:170来源:国知局

本发明涉及测量技术领域,具体而言,涉及一种挠曲形变测量网络的分布式pos传递对准建模方法和装置。



背景技术:

分布式位置姿态测量系统(distributedpositionandorientationsystem,dpos)是目前机载高分辨率对地观测系统获取多节点位置、速度、姿态等运动参数的重要设备,其主要组成包括一个高精度惯性/卫星组合测量主系统、多个低精度的惯性测量单元子系统(inertialmeasurementunit,imu)和pos计算机(poscomputersystem,pcs)、后处理软件组成。其中,主系统一般安装在载机机舱内,而子系统尽可能地安装在遥感载荷的成像中心处,一般分布安装在机体的不同位置(包括机翼)。在分布式pos中,子系统依靠主系统的高精度位置、速度、姿态等运动参数,通过传递对准实现运动信息的精确测量。由于飞机机体存在复杂时变的挠曲变形,特别是机翼部分,因此主、子系统间的空间距离(杆臂)和相对姿态不再是恒定不变而是随时间变化。如果不对飞机的挠曲变形进行测量和补偿,势必会在主、子系统传递对准中引入复杂的随机误差,严重影响子系统运动参数的测量精度。

目前挠曲变形角测量方法主要有两种,第一种是基于ansys辅助建模的挠曲变形测量,该方法所建立的模型随飞机材质的变化而变化,并且没有考虑外挂载荷对飞机挠曲变形的影响;第二种是基于马尔科夫过程的机翼挠曲形变建模方法,但该方法存在的问题是马尔科夫过程参数的选取多凭经验确定且固定不变,在实际工程应用中难以保证该参数的准确性。

随着光纤光栅传感器测量技术的快速发展,利用光纤光栅测量分布式pos柔性杆臂的形变角和形变位移可达一定的精度水平。光纤光栅传感器具有误差不随时间积累、分辨率高、成本低的优点,与传统惯性导航的误差时间累积性形成优势互补。光纤光栅测量网络可为分布式pos提供更加准确的形变量,为传递对准提供高精度的量测信息。



技术实现要素:

为了解决现有技术中分布式pos柔性杆臂难以精确建模引起的传递对准量测信息不准确的问题,本发明实施例提供了一种挠曲形变测量网络的分布式pos传递对准建模方法和装置,相比较现有的技术,该方法可提高分布式pos的传递对准精度。

第一方面,本发明实施例提供了一种挠曲形变测量网络的分布式pos传递对准建模方法,包括以下步骤:建立六自由度挠曲形变测量网络,并将横截面垂线定义为微段纵轴线;通过六自由度挠曲形变解算方法,计算由分布式pos柔性杆臂引起的主系统载体坐标系下三维形变位移以及三维形变角;通过六自由度挠曲形变测量网络输出的主系统载体坐标系下三维形变位移以及三维形变角,采用姿态与位置的匹配方式,建立基于挠曲形变姿态补偿的分布式pos姿态量测方程以及基于挠曲形变位置补偿的分布式pos位置量测方程。

在其中一个实施例中,还包括:在杆臂微段表面粘贴6个光纤光栅传感器;上下表面相互平行的2个光纤光栅传感器,其敏感轴与微段纵轴线夹角为0度,且距离不小于2厘米;下表面相互平行的2个光纤光栅传感器,其敏感轴与微段纵轴线夹角为0度,且距离不小于2厘米;下表面相互垂直的2个光纤光栅传感器,其敏感轴与微段纵轴线夹角为±45度。

在其中一个实施例中,所述分布式pos传递对准的量测方程的变量为:

式中ψs、θs、γs子系统的航向角、俯仰角、横滚角,ψm、θm、γm子系统的航向角、俯仰角、横滚角,为子系统的纬度、经度、高度,为主系统的纬度、经度、高度,ta(ij)为姿态矩阵的元素,rm、rn为地球子午面半径和卯酉面半径,r=[rxryrz]t为分布式pos柔性杆臂,包括固定杆臂r以及六自由度挠曲形变输出的三维形变位移δr,σ=[σxσyσz]t为六自由度挠曲形变输出的三维形变角。

在其中一个实施例中,所述六自由度挠曲形变解算方法,包括:在分布式pos主系统和子系统之间的柔性杆臂微段中建立微段变形坐标系,坐标系原点为微段中心,xi轴沿微段纵轴线切线向右,yi轴垂直于xi轴向前,zi轴与xi轴、yi轴成右手坐标系。

在其中一个实施例中,所述六自由度挠曲形变解算方法,还包括:利用杆臂微段上下表面相互平行的2个光纤光栅传感器,分别为a光纤光栅和b光纤光栅,计算yi轴弯曲应变,通过建立yi轴应变曲率模型,计算yi轴弯曲形变位移、yi轴弯曲形变角,计算公式为:

式中δrxz是yi轴弯曲形变位移,σy是yi轴弯曲形变角,l是微段长度,d是微段厚度,分别为沿xi轴、yi轴、zi轴的单位向量,εa是a光纤光栅应变量测,εb是b光纤光栅应变量测,εmy是yi轴弯曲应变。

在其中一个实施例中,所述六自由度挠曲形变解算方法,还包括:通过杆臂微段下表面相互平行的2个光纤光栅传感器,分别为c光纤光栅和d光纤光栅,获得zi轴弯曲应变,建立zi轴应变曲率模型,计算zi轴弯曲形变位移、zi轴弯曲形变角,计算公式为:

式中δrxy是zi轴弯曲形变位移,σz是zi轴弯曲形变角,εc是c光纤光栅应变量测,εd是d光纤光栅应变量测,εmz是zi轴弯曲应变。

在其中一个实施例中,所述六自由度挠曲形变解算方法,还包括:利用杆臂微段下表面±45度相互垂直的2个光纤光栅传感器,得到xi轴扭转应变,建立xi轴扭转单元体形变模型,计算xi轴扭转形变位移、xi轴扭转形变角,计算公式为:

式中δryz是x轴扭转形变位移,σx是x轴扭转形变角,εe是e光纤光栅应变量测,εf是f光纤光栅应变量测。

在其中一个实施例中,所述六自由度挠曲形变解算方法,还包括:利用微段变形坐标系下的弯曲形变角、弯曲形变位移、扭转形变位移、扭转形变角,计算主系统载体坐标系下3维形变位移、3维形变角。其中载体坐标系原点为载体重心,x轴沿载体横轴向右,y轴沿载体纵轴向前,z轴沿载体竖轴向上,用s和m分别代表主系统和子系统的载体坐标系,主系统载体坐标系下3维形变位移、3维形变角表示为:

式中δr、σ分别为主系统载体坐标系下3维形变位移、3维形变角。

第二方面,本发明实施例提供了一种计算机可读存储介质,所述计算机可读存储介质上存储有计算机程序,所述计算机程序被处理器执行时实现上述第一方面的挠曲形变测量网络的分布式pos传递对准建模方法。

第三方面,本发明实施例提供了一种包含指令的计算机程序产品,当该计算机程序产品在计算机上运行时,使得计算机执行上述第一方面所述的方法。

第四方面,本发明实施例提供了一种挠曲形变测量网络的分布式pos传递对准建模装置,包括:建立与定义模块,用于建立六自由度挠曲形变测量网络,并将横截面垂线定义为微段纵轴线;计算模块,用于通过六自由度挠曲形变解算方法,计算由分布式pos柔性杆臂引起的主系统载体坐标系下三维形变位移以及三维形变角;建立模型模块,用于通过六自由度挠曲形变测量网络输出的主系统载体坐标系下三维形变位移以及三维形变角,采用姿态与位置的匹配方式,建立基于挠曲形变姿态补偿的分布式pos姿态量测方程以及基于挠曲形变位置补偿的位置量测方程。

在其中一个实施例中,还包括:设置模块,用于在杆臂微段表面粘贴6个光纤光栅传感器;上下表面相互平行的2个光纤光栅传感器,其敏感轴与微段纵轴线夹角为0度,且距离不小于2厘米;下表面相互平行的2个光纤光栅传感器,其敏感轴与微段纵轴线夹角为0度,且距离不小于2厘米;下表面相互垂直的2个光纤光栅传感器,其敏感轴与微段纵轴线夹角为±45度。

本发明提供的一种挠曲形变测量网络的分布式pos传递对准建模方法和装置,首先,建立六自由度挠曲形变测量网络,根据分布式pos柔性杆臂挠曲形变的应变梯度,将柔性杆臂离散为多个长度不大于10厘米的杆臂微段。在每个杆臂微段表面粘贴6个光纤光栅传感器,利用光纤光栅传感器输出的应变量测,采用六自由度挠曲形变解算方法,计算由弯曲、扭转引起的主系统载体坐标系下3维形变角、3维形变位移,为分布式pos传递对准提供量测信息。采用姿态与位置的匹配方式,建立基于挠曲形变姿态补偿的分布式pos姿态量测方程、基于挠曲形变位置补偿的位置量测方程,进而建立传递对准系统模型。

附图说明

为了更清楚地说明本发明实施例的技术方案,下面对实施例描述中所需要使用的附图作简单地介绍:

图1为本发明一个实施例的挠曲形变测量网络的分布式pos传递对准建模方法的步骤流程图;

图2为本发明一个实施例的挠曲形变测量网络的分布式pos传递对准建模方法中机翼的形变示意图;

图3为本发明一个实施例的挠曲形变测量网络的分布式pos传递对准建模方法中光纤光栅传感器测点平面示意图;

图4为本发明一个实施例的挠曲形变测量网络的分布式pos传递对准建模方法中光纤光栅传感器布局示意图;

图5为本发明一个实施例的挠曲形变测量网络的分布式pos传递对准建模方法中光纤光栅传感器测量y轴弯曲形变示意图;

图6为本发明一个实施例的挠曲形变测量网络的分布式pos传递对准建模方法中光纤光栅传感器测量z轴弯曲形变示意图;

图7为本发明一个实施例的挠曲形变测量网络的分布式pos传递对准建模方法中梁弯曲变形后微小弧段示意图;

图8为本发明一个实施例的挠曲形变测量网络的分布式pos传递对准建模方法中光纤光栅传感器测量x轴扭转形变示意图;

图9为本发明一个实施例的挠曲形变测量网络的分布式pos传递对准建模方法中扭转形变示意图;

图10为本发明一个实施例的挠曲形变测量网络的分布式pos传递对准建模方法中扭转形变几何关系图;

图11为本发明一个实施例的挠曲形变测量网络的分布式pos传递对准建模装置的结构示意图。

具体实施方式

下面结合附图和实施例对本申请进行进一步的详细介绍。

在下述介绍中,术语“第一”、“第二”仅为用于描述的目的,而不能理解为指示或暗示相对重要性。下述介绍提供了本发明的多个实施例,不同实施例之间可以替换或者合并组合,因此本申请也可认为包含所记载的相同和/或不同实施例的所有可能组合。因而,如果一个实施例包含特征a、b、c,另一个实施例包含特征b、d,那么本申请也应视为包括含有a、b、c、d的一个或多个所有其他可能的组合的实施例,尽管该实施例可能并未在以下内容中有明确的文字记载。

本发明涉及一种基于六自由度挠曲形变测量网络的分布式pos传递对准建模方法,可以应用于分布式位置姿态测量系统(distributedpositionandorientationsystem,distributedpos),也可以应用于惯性网络协同导航、ins(inertialnavigationsystem,惯性导航系统)/gps(globalpositionsystem,全球定位系统)组合导航系统、传递对准的柔性基线形变测量。

其所应用的原理为,基于光纤光栅应变测量原理,研究光纤光栅传感器在分布式pos柔性杆臂表面的安装与布局方式,建立六自由度挠曲形变测量网络,利用六自由度挠曲形变解算方法,实现分布式pos柔性杆臂形变的高精度测量,为分布式pos传递对准提供更精确的量测信息。

本发明与现有技术相比的优点在于:针对分布式pos柔性杆臂难以精确建模引起的传递对准量测信息不准确的问题,提出一种基于六自由度挠曲形变测量网络的分布式pos传递对准建模方法,首先建立基于光纤光栅的六自由度挠曲形变测量网络,计算分布式pos柔性杆臂挠曲变形的3维形变角、3维形变位移,为分布式pos传递对准提供量测信息。采用姿态与位置的匹配方式,建立基于挠曲形变姿态补偿的分布式pos姿态量测方程、基于挠曲形变位置补偿的位置量测方程,进而建立传递对准系统模型。

如图1所示,为一个实施例中的一种挠曲形变测量网络的分布式pos传递对准建模方法的流程示意图,具体包括以下步骤:

步骤102,建立六自由度挠曲形变测量网络,并将横截面垂线定义为微段纵轴线。

步骤104,通过六自由度挠曲形变解算方法,计算由分布式pos柔性杆臂引起的主系统载体坐标系下三维形变位移以及三维形变角。

步骤106,通过六自由度挠曲形变测量网络输出的主系统载体坐标系下三维形变位移以及三维形变角,采用姿态与位置的匹配方式,建立基于挠曲形变姿态补偿的分布式pos姿态量测方程以及基于挠曲形变位置补偿的分布式pos位置量测方程。

本实施例中,分布式pos传递对准的量测方程的变量为:

式中ψs、θs、γs子系统的航向角、俯仰角、横滚角,ψm、θm、γm子系统的航向角、俯仰角、横滚角,为子系统的纬度、经度、高度,为主系统的纬度、经度、高度,ta(ij)为姿态矩阵的元素,rm、rn为地球子午面半径和卯酉面半径,r=[rxryrz]t为分布式pos柔性杆臂,包括固定杆臂r以及六自由度挠曲形变输出的三维形变位移δr,σ=[σxσyσz]t为六自由度挠曲形变输出的三维形变角。

此外,六自由度挠曲形变解算方法,包括:在分布式pos主系统和子系统之间的柔性杆臂微段中建立微段变形坐标系,坐标系原点为微段中心,xi轴沿微段纵轴线切线向右,yi轴垂直于xi轴向前,zi轴与xi轴、yi轴成右手坐标系。

另外,六自由度挠曲形变解算方法,还包括:利用杆臂微段上下表面相互平行的2个光纤光栅传感器,分别为a光纤光栅和b光纤光栅,计算yi轴弯曲应变,通过建立yi轴应变曲率模型,计算yi轴弯曲形变位移、yi轴弯曲形变角,计算公式为:

式中δrxz是yi轴弯曲形变位移,σy是yi轴弯曲形变角,l是微段长度,d是微段厚度,分别为沿xi轴、yi轴、zi轴的单位向量,εa是a光纤光栅应变量测,εb是b光纤光栅应变量测,εmy是yi轴弯曲应变。

进一步地,六自由度挠曲形变解算方法,还包括:通过杆臂微段下表面相互平行的2个光纤光栅传感器,分别为c光纤光栅和d光纤光栅,获得zi轴弯曲应变,建立zi轴应变曲率模型,计算zi轴弯曲形变位移、zi轴弯曲形变角,计算公式为:

式中δrxy是zi轴弯曲形变位移,σz是zi轴弯曲形变角,εc是c光纤光栅应变量测,εd是d光纤光栅应变量测,εmz是zi轴弯曲应变。

更进一步地,六自由度挠曲形变解算方法,还包括:利用杆臂微段下表面±45度相互垂直的2个光纤光栅传感器,得到xi轴扭转应变,建立xi轴扭转单元体形变模型,计算xi轴扭转形变位移、xi轴扭转形变角,计算公式为:

式中δryz是x轴扭转形变位移,σx是x轴扭转形变角,εe是e光纤光栅应变量测,εf是f光纤光栅应变量测。

更进一步地,六自由度挠曲形变解算方法,还包括:利用微段变形坐标系下的弯曲形变角、弯曲形变位移、扭转形变位移、扭转形变角,计算主系统载体坐标系下3维形变位移、3维形变角。其中载体坐标系原点为载体重心,x轴沿载体横轴向右,y轴沿载体纵轴向前,z轴沿载体竖轴向上,用s和m分别代表主系统和子系统的载体坐标系,主系统载体坐标系下3维形变位移、3维形变角表示为:

式中δr、σ分别为主系统载体坐标系下3维形变位移、3维形变角。

需要说明的是,在一个实施例中,本公开提出的一种挠曲形变测量网络的分布式pos传递对准建模方法,还包括:在杆臂微段表面粘贴6个光纤光栅传感器;上下表面相互平行的2个光纤光栅传感器,其敏感轴与微段纵轴线夹角为0度,且距离不小于2厘米;下表面相互平行的2个光纤光栅传感器,其敏感轴与微段纵轴线夹角为0度,且距离不小于2厘米;下表面相互垂直的2个光纤光栅传感器,其敏感轴与微段纵轴线夹角为±45度。

本发明提供的一种挠曲形变测量网络的分布式pos传递对准建模方法,建立六自由度挠曲形变测量网络,并将横截面垂线定义为微段纵轴线;通过六自由度挠曲形变解算方法,计算由分布式pos柔性杆臂引起的主系统载体坐标系下三维形变位移以及三维形变角;通过六自由度挠曲形变测量网络输出的主系统载体坐标系下三维形变位移以及三维形变角,采用姿态与位置的匹配方式,建立基于挠曲形变姿态补偿的分布式pos姿态量测方程以及基于挠曲形变位置补偿的分布式pos位置量测方程。上述方法建立六自由度挠曲形变测量网络,根据分布式pos柔性杆臂挠曲形变的应变梯度,将柔性杆臂离散为多个长度不大于10厘米的杆臂微段。在每个杆臂微段表面粘贴6个光纤光栅传感器,利用光纤光栅传感器输出的应变量测,采用六自由度挠曲形变解算方法,计算由弯曲、扭转引起的主系统载体坐标系下3维形变角、3维形变位移,为分布式pos传递对准提供量测信息。采用姿态与位置的匹配方式,建立基于挠曲形变姿态补偿的分布式pos姿态量测方程、基于挠曲形变位置补偿的位置量测方程,进而建立传递对准系统模型。

为了更加清楚理解与运用本公开提出的挠曲形变测量网络的分布式pos传递对准建模方法,对该方法进行示例。需要说明的是,本公开的保护范围不限于以下示例。

机翼的形变三视图如图2所示,在每一视图内,f为机翼所受的广义外力,r为初始基线,r′为形变后的基线,δrmzx、δrmyx和δrmyz分别为柔性基线绕着主系统y轴、z轴和x轴产生的挠曲变形位移矢量,σmx、σmy和σmz为子节点绕着主系统x轴、y轴和z轴的挠曲变形角。

光纤光栅辅助惯性的测量方法,首先要利用光纤光栅测量模拟机翼的应变量,其次将测量的应变量通过建模计算转化成图2中所示的三维变形量(包括位移量和姿态量),最终转化成辅助传递对准的匹配参量。理想杆件为圆形或矩形横截面,如图3所示,由上下表面0°测点敏感该轴向的正应变,而后通过建模计算x-z平面的位移矢量及y轴方向的形变角。由±45°测点敏感切应变,可计算y-z平面的位移矢量及x轴方向的形变角。模拟机翼结构的横截面并不是理想的圆形或矩形,因此光纤光栅传感器布局需有所改变,示意图如图4所示。可以通过上下(a、b光纤光栅传感器)和前后(c、d光纤光栅传感器)布设光纤光栅实现绕y轴和z轴方向的正应变测量,通过±45°(e、f光纤光栅传感器)布设光纤光栅实现绕x轴的切应变测量。

由光纤光栅传感器直接测量的线应变计算三维变形角及三维线位移,可分为两个部分:第一部分是弯曲形变的计算,即由a、b光纤光栅测量的应变建模计算y轴弯曲形变位移δrzx与沿y轴弯曲形变角σy,以及c、d光纤光栅测量的应变建模计算z轴弯曲形变位移δrxy,z轴弯曲形变角σz,第二部分是扭转形变的计算,即e、f光纤光栅测量的应变,建模计算x轴扭转形变位移δrzy,沿x轴扭转形变角σx。传递对准中需要将主系统高精度测量信息经过挠曲变形补偿之后,传递到子节点。主子节点位置匹配量为主系统坐标系下(m系下)rm+δrm,其中rm为初始基线矢量,δrm为柔性变形矢量,姿态匹配量为主系统坐标系下(m系下)绕着三个轴向的转角σx、σy、σz。

由a、b光纤光栅传感器测量的应变计算y轴弯曲应变。如图5所示,n个光纤光栅传感器离散粘贴在机翼上下表面,第i对a、b光纤光栅传感器量测值为εa和εb。首先,对a、b光纤光栅传感器测量的应变解耦,分离y轴弯曲应变εmy。由第i对上下对称粘贴的光纤光栅传感器敏感应变为

式中εfx为x轴拉伸应变,εmx为x轴扭转应变,εmy为y轴弯曲应变,εmz为z轴弯曲应变。则y轴弯曲应变εmy可计算为

同理,针对光纤光栅形变测量布局方案中,由c、d光纤光栅测量的应变计算z轴弯曲应变εmz,如图6,由第i对下表面对称粘贴的光纤光栅传感器敏感应变为:

则z轴弯曲应变εmz可计算为

机翼弯曲变形后微小弧段如图7所示,σi是长为l的微小弧段两端截面的相对转角,εi为弯曲产生的光纤光栅传感器测量的线应变。ρ是中性层变形后形成的微小圆弧段对应的曲率半径,d是梁的直径.ri及ri′为变形前后的矢量。

由几何关系可得

所以

由图7中的几何关系,将公式(2)代入(6)(7),节点坐标系下y轴弯曲形变位移δrxz、y轴弯曲形变角σy可计算为:

将公式(4)代入(6)(7),节点坐标系下z轴弯曲形变位移δrxy、z轴弯曲形变角σz可计算为:

由机翼的应力应变分析可知,机翼根部的应变最大,翼尖处最小。由公式(7)可知,应变与建模计算获得的曲率半径成反比例,即当机翼根部应变趋于0时,曲率半径趋于无穷大。光纤光栅传感器量测的应变存在很小的误差时,曲率半径会产生较大误差,由曲率半径计算得到的位移矢量也会存在较大误差。由于翼尖处应变量较小,变形角较小,假设基线ri变形前后长度不变,即|ri|≈|ri′|=l。根据几何关系求解节点坐标系下x-z平面位移矢量rxz及节点坐标系下x-y平面位移矢量rxy:

综上所述,节点坐标系下y轴弯曲形变位移δrxz、y轴弯曲形变角σy、z轴弯曲形变位移δrxy、z轴弯曲形变角σz可表示为:

实际测量中,光纤光栅传感器同步采集到的多个离散点的应变,可求出多个离散点的曲率。由于机翼变形曲线光滑且连续,可用线性插值拟合求出相邻离散点间曲线线段上各点上的曲率,进而通过微小弧段内坐标地推计算求得机翼上连续点的坐标及位移量。

由于光纤光栅传感器仅敏感单方向上的线应变,因此在测量扭转力矩作用下机翼产生的切应变,只能通过建模的方式求取。斜45°方向上的光纤光栅传感器可以敏感不同方向上变形所产生的线应变,因此首先需解耦出由于扭转变形产生的测点处的线应变。如图8,机翼下表面斜45°对称粘贴e、f光纤光栅,量测值为εe、εf。

式中εfy为y轴拉伸应变。x轴扭转应变εmx可以计算为:

根据光纤光栅安装的几何关系及公式(4),可以得出斜45度方向安装的光纤光栅敏感的线应变ε′mz与0°安装的光纤光栅之间存在关系:

将公式(17)代入(16)可得

由于光纤光栅传感器只能敏感一个方向上的线位移,要得到扭转作用下机翼的切应变γ,需要通过建模计算。如图所示机翼的非圆横截面在扭转力矩作用下产生翘曲现象,即横向线变成曲线,横截面不在保持平面。因此扭转力矩作用下,机翼表面±45°粘贴的光纤光栅传感器在变形前后处于不同平面。

由于光纤光栅栅区长度较短,假设光纤光栅为均匀变形,切变形后仍保持直线。因此横截面为圆截面的梁扭转变形后,梁表面的单元体矩形adcd会在同一平面内变形为平行四边形abef。而非圆横截面量由于存在翘曲,因此变形后的平行四边形abef与原矩形abcd不在同一平面,如图9所示。对变形前后的光纤光栅传感器进行建模分析如图10。图10中σx为变形角,γ为切应变。设变形前的光纤光栅传感器长度为l,在平面adbe中,由几何关系可得:

由公式(19)-(20)可求解出:

由图中在直角三角形abc由几何关系可得:

则可计算出

当ε值很小时,ε2为高阶小量,可近似为0,则变形角σx及位移矢量可计算为:

将公式(16)代入公式(24)及(25),则x轴扭转变形位移δryz、x轴扭转变形角σx及可表示为

根据公式(14)与(26),主子系统相对位移可计算为:

主子系统相对姿态可计算为:

式中上标i表示第i个光纤光栅对应的微小弧段。

进一步地,利用六自由度挠曲形变测量网络输出的3维形变位移、3维形变角,分别建立基于光纤光栅的分布式pos姿态补偿方程、位置补偿方程。基于姿态与位置的匹配方式,确定分布式pos传递对准的量测变量为。

首先定义主系统导航坐标系与子系统导航坐标系之间的坐标转换,记φn为主系统导航坐标系n与子系统计算导航坐标系n1之间的失准角,假设φn为小角度,则n系到n1系的坐标转换矩阵可表示为:

式中为n系到n1系的坐标转换矩阵。[φn×]为子系统的n1系相对主系统的n系的失准角φe、φn、φu组成的反对称阵。

然后定义主系统载体坐标系m与子系统载体坐标系s之间的坐标转换。令主系统与子系统之间的姿态误差角为θ=[θxθyθz]t,且θ由两部分组成,包括安装误差角和挠曲形变角。令ρ=[ρxρyρz]t为安装误差角,σ=[σxσyσz]t为六自由度挠曲形变测量网络输出的由挠曲形变角,则有关系:

θ=ρ+σ(30)

当θ为小角度时,主、子系统载体坐标系间的关系可由如下方向余弦阵来确定:

式中[θ×]为姿态误差角θ的反对称阵,为主系统的姿态矩阵。为子系统的姿态矩阵。根据传递对准原理有以下关系成立:

将式(29)、式(31)代入式(32),得到:

tb=(i-φ×)ta[i+(ρ+σ)×](34)

忽略二阶小量的乘积,取其近似,得到分布式pos挠曲形变姿态补偿关系:

tb=ta+ta[(ρ+σ)×]-(φ×)ta(35)

设主、子系统计算出的航向角、俯仰角及横滚角分别为ψm、θm、γm和ψs、θs、γs,记姿态误差为:

将式(37)-(39)两边按泰勒级数展开,均取前两项并忽略二阶小量,整理得到:

式中v1,v2,v3为量测噪声。

在分布式pos传递对准中,需考虑主子系统之间的柔性杆臂,包括固定杆臂以及六自由度挠曲形变输出的3维形变位移,即:

r=[rxryrz]t=r+δrm(43)

式中r为主子系统之间的固定杆臂,r为柔性杆臂。设主、子系统计算出的位置矢量分别为pm和ps,则分布式pos挠曲形变位置补偿关系为:

式中δp为位置误差,νp为位置量测噪声。

分布式pos传递对准的系统模型包括状态方程、量测方程,选取传统15维系统状态量:

式中φe、φn和φu分别为东向、北向、天向失准角,下标e、n和u分别表示东向、北向和天向,δve、δvn和δvu分别为东向、北向和天向速度误差,δl、δλ、δh分别为子系统纬度误差、经度误差、高度误差,gx、gy和gz分别为子系统载体坐标系x轴、y轴和z轴陀螺常值漂移,分别为子系统载体坐标系x轴、y轴和z轴加速度计常值偏置。

完整的状态方程如下:

其中,系统噪声其中分别为子系统载体坐标系x轴、y轴和z轴陀螺的随机误差和子系统载体坐标系x轴、y轴和z轴加速度计的随机误差,不包括随机常值误差;量测噪声v为

其中vδψ、vδθ、vδγ分别为主系统航向角、俯仰角、横滚角的量测噪声,分别为主系统东向、北向、天向速度的量测噪声,vδl′、vδλ′、vδh′分别为主系统的纬度、经度和高度量测噪声。g为系统噪声矩阵,f为系统转移矩阵,可由捷联惯性导航误差方程确定。

取主、子pos的姿态角误差和位置误差作为量测量,量测量可表示为:

完整的量测方程如下:

z=hx+v(47)

式中v是量测噪声,假定其为零均值的高斯白噪声,其协方差为e[vvt]=r;量测矩阵为:

式中h1、h2可由式(40)-(42)获得。

基于同一发明构思,还提供了一种挠曲形变测量网络的分布式pos传递对准建模装置。由于挠曲形变测量网络的分布式pos传递对准建模装置解决问题的原理与前述一种挠曲形变测量网络的分布式pos传递对准建模方法相似,因此,该挠曲形变测量网络的分布式pos传递对准建模装置的实施可以按照前述方法的具体步骤时限,重复之处不再赘述。

如图11所示,为一个实施例中的一种挠曲形变测量网络的分布式pos传递对准建模装置的结构示意图。

具体的,挠曲形变测量网络的分布式pos传递对准建模装置包括:建立与定义模块100用于建立六自由度挠曲形变测量网络,并将横截面垂线定义为微段纵轴线;计算模块200用于通过六自由度挠曲形变解算方法,计算由分布式pos柔性杆臂引起的主系统载体坐标系下三维形变位移以及三维形变角;建立模型模块300用于通过六自由度挠曲形变测量网络输出的主系统载体坐标系下三维形变位移以及三维形变角,采用姿态与位置的匹配方式,建立基于挠曲形变姿态补偿的分布式pos姿态量测方程以及基于挠曲形变位置补偿的分布式pos位置量测方程。

进一步地,本公开的挠曲形变测量网络的分布式pos传递对准建模装置,还包括:设置模块(图中未示出)用于在杆臂微段表面粘贴6个光纤光栅传感器;上下表面相互平行的2个光纤光栅传感器,其敏感轴与微段纵轴线夹角为0度,且距离不小于2厘米;下表面相互平行的2个光纤光栅传感器,其敏感轴与微段纵轴线夹角为0度,且距离不小于2厘米;下表面相互垂直的2个光纤光栅传感器,其敏感轴与微段纵轴线夹角为±45度。

本发明提供的一种挠曲形变测量网络的分布式pos传递对准建模装置,包括建立与定义模块用于建立六自由度挠曲形变测量网络,并将横截面垂线定义为微段纵轴线;计算模块用于通过六自由度挠曲形变解算方法,计算由分布式pos柔性杆臂引起的主系统载体坐标系下三维形变位移以及三维形变角;建立模型模块用于通过六自由度挠曲形变测量网络输出的主系统载体坐标系下三维形变位移以及三维形变角,采用姿态与位置的匹配方式,建立基于挠曲形变姿态补偿的分布式pos姿态量测方程以及基于挠曲形变位置补偿的分布式pos位置量测方程。上述装置建立六自由度挠曲形变测量网络,根据分布式pos柔性杆臂挠曲形变的应变梯度,将柔性杆臂离散为多个长度不大于10厘米的杆臂微段。在每个杆臂微段表面粘贴6个光纤光栅传感器,利用光纤光栅传感器输出的应变量测,采用六自由度挠曲形变解算方法,计算由弯曲、扭转引起的主系统载体坐标系下3维形变角、3维形变位移,为分布式pos传递对准提供量测信息。采用姿态与位置的匹配方式,建立基于挠曲形变姿态补偿的分布式pos姿态量测方程、基于挠曲形变位置补偿的位置量测方程,进而建立传递对准系统模型。

本领域的技术人员可以清楚地了解到本发明实施例的技术方案可借助软件和/或硬件来实现。本说明书中的“单元”是指能够独立完成或与其他部件配合完成特定功能的软件和/或硬件,其中硬件例如可以是fpga(field-programmablegatearray,现场可编程门阵列)、ic(integratedcircuit,集成电路)等。

本发明实施例还提供了一种计算机可读存储介质,其上存储有计算机程序,该程序被处理器执行时实现上述用于处理触摸数据的方法的步骤。其中,计算机可读存储介质可以包括但不限于任何类型的盘,包括软盘、光盘、dvd、cd-rom、微型驱动器以及磁光盘、rom、ram、eprom、eeprom、dram、vram、闪速存储器设备、磁卡或光卡、纳米系统(包括分子存储器ic),或适合于存储指令和/或数据的任何类型的媒介或设备。

本发明实施例还提供了一种计算机设备,包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,处理器执行程序时实现用于处理触摸数据的方法的步骤。在本发明实施例中,处理器为计算机系统的控制中心,可以是实体机的处理器,也可以是虚拟机的处理器。

以上介绍仅为本发明的优选实施例而已,并不用于限制本发明,对于本领域的技术人员来说,本发明可以有各种更改和变化。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。

当前第1页1 2 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1