CN107764268A - 一种机载分布式pos传递对准的方法和装置 - Google Patents
一种机载分布式pos传递对准的方法和装置 Download PDFInfo
- Publication number
- CN107764268A CN107764268A CN201710953526.5A CN201710953526A CN107764268A CN 107764268 A CN107764268 A CN 107764268A CN 201710953526 A CN201710953526 A CN 201710953526A CN 107764268 A CN107764268 A CN 107764268A
- Authority
- CN
- China
- Prior art keywords
- subsystem
- msub
- mtd
- mrow
- angle
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000012546 transfer Methods 0.000 title claims abstract description 69
- 238000000034 method Methods 0.000 title claims abstract description 40
- 230000003287 optical effect Effects 0.000 claims abstract description 71
- 238000006073 displacement reaction Methods 0.000 claims abstract description 70
- 238000001914 filtration Methods 0.000 claims abstract description 55
- 238000005259 measurement Methods 0.000 claims abstract description 52
- 239000011159 matrix material Substances 0.000 claims description 36
- 238000013178 mathematical model Methods 0.000 claims description 33
- 239000004576 sand Substances 0.000 claims description 12
- 238000004422 calculation algorithm Methods 0.000 claims description 9
- 238000004364 calculation method Methods 0.000 claims description 9
- 230000003068 static effect Effects 0.000 claims description 9
- 238000005452 bending Methods 0.000 claims description 7
- 238000012937 correction Methods 0.000 claims description 7
- 238000006243 chemical reaction Methods 0.000 claims description 6
- 238000004590 computer program Methods 0.000 claims description 3
- 238000009434 installation Methods 0.000 description 3
- 230000009466 transformation Effects 0.000 description 3
- 230000007547 defect Effects 0.000 description 2
- 238000011161 development Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000003384 imaging method Methods 0.000 description 2
- 230000005540 biological transmission Effects 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 239000000835 fiber Substances 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 230000001131 transforming effect Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/18—Stabilised platforms, e.g. by gyroscope
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Gyroscopes (AREA)
- Navigation (AREA)
Abstract
本发明实施例提供了一种机载分布式POS系统传递对准的方法和装置,该方法采取引入高精度光学设备获得的变形位移和挠曲变形角测量值,分别建立二者与状态变量中位置误差和挠曲变形角之间的直接约束关系,在传统的“姿态+速度”匹配的基础上,增加“位置+挠曲变形角”匹配,形成新的“姿态+速度+位置+挠曲变形角”的匹配方式获得新的量测方程,通过卡尔曼滤波消除光学设备测量值的随机误差,实现对位置误差和挠曲变形角状态变量的更准确的估计,从而提高子系统位置、速度和姿态的估计精度。
Description
技术领域
本发明涉及导航系统领域,具体涉及机载分布式POS传递对准的方法和装置。
背景技术
集成多个和多种遥控载荷的机载综合对地观测系统已成为目前对地观测的重点发展方向之一,如集成相机、成像光谱仪、大视场红外扫描仪、激光雷达、合成孔径雷达(Synthetic Aperture Radar,简称SAR)于同一载机的多任务载荷,以及机载阵列天线SAR等。每一个遥感载荷或每部SAR天线都需要所在处的高精度运动参数以实现高精度成像。
分布式位置姿态测量系统(Distributed Position and Orientation System,简称DPOS)是目前机载对地观测遥感载荷获取多节点位置、速度、姿态等运动参数的主要手段,其主要组成包括一个高精度惯性/卫星组合测量系统(主系统)、多个低精度的惯性测量单元(Inertial Measurement Unit,简称IMU)(子系统)和数据处理计算机组成。其中,主系统由高精度主IMU和卫星导航系统接收设备组成,主IMU一般安装在载机机舱内,而子系统尽可能地安装在遥感载荷的成像中心处,一般分布安装在机体的不同位置(包括机翼)。在DPOS中,子系统依靠主系统的高精度位置、速度、姿态等运动参数对其进行传递对准已实现所在处运动信息的精确测量。由于飞机机体存在复杂时变得挠曲变形,特别是机翼部分,因此主、子系统间的空间距离(杆臂)和相对姿态不再是恒定不变而是随时间变化,从而在主、子系统传递对准中引入复杂的随机误差,严重影响子系统运动参数的测量精度。
发明内容
本发明实施例提供机载分布式POS对准传递的方法和装置,以期克服传统主、子系统传递对准中存在随机误差的问题,该方法可提高载机机体存在挠曲变形式分布式POS的传递对准精度。
第一方面,本发明实施例提供机载分布式POS系统传递对准的方法,包括:
建立所述子系统对所述主系统的传递对准误差模型,所述传递对准误差模型包括所述子系统的惯导误差模型、固定安装误差角模型和机体挠曲变形角模型;
建立所述子系统传递对准滤波估计的数学模型,所述数学模型包括状态方程和量测方程,其中,所述状态方程根据所述传递对准误差模型获得,所述量测方程根据光学设备量测得到的变形位移与所述状态方程中的位置误差之间的约束关系、所述光学设备量测得到的挠曲变形角与所述状态方程中的挠曲变形角之间的约束关系、以及所述主系统与所述子系统的姿态之间的关系、所述主系统的速度与所述子系统的速度之间的关系确定的量测变量获得;
利用卡尔曼滤波和所述子系统的对准滤波估计的数学模型估计所述子系统的预设状态变量,并根据所述预设状态变量的估计值修正所述子系统的捷联解算结果。
在第一方面的第一种可能的实施方式中,所述建立所述子系统传递对准滤波估计的数学模型,包括:
根据所述子系统的预设状态变量建立状态方程
其中,X为所述子系统预设状态变量;所述子系统的转移矩阵F由所述传递对准误差模型确定;系统噪声其中分别为所述子系统载体坐标系x轴、y轴和z轴陀螺的随机误差,分别为所述子系统载体坐标系x轴、y轴和z轴加速度计的随机误差;G为所述子系统的系统噪声矩阵:
其中,为所述子系统载体坐标系到所述子系统导航坐标系的姿态转换矩阵。
结合第一方面的第一种可能的实施方式,在第一方面的第二种可能的实施方式中,所述预设状态变量X包含位置变量和挠曲变形角变量;
所述建立所述子系统传递对准滤波估计的数学模型,包括建立所述子系统的量测方程,包括:
接收光学设备量测得到的变形位移和挠曲变形角;
建立所述状态方程中的位置误差与所述光学设备测量得到的变形位移之间的约束关系:其中,Pm和Ps分别为所述主系统和所述子系统的位置,固定杆臂rb为载机飞行前静止时测量得到的所述主系统和所述子系统间的空间距离在子系统载体坐标系上的投影,子系统变形位移r′b为所述光学设备测量得到的所述子系统相对所述主系统的位移在子系统载体坐标系上的投影;为所述主系统载体坐标系到所述主系统导航坐标系的姿态转换矩阵;δPs为子系统位置误差;δPm为主系统位置误差,δr′b为子系统变形位移r′b的误差,
建立所述状态方程中的挠曲变形角与所述挠曲变形角之间的约束关系:θ′=θ-vθ′,其中θ′为光学设备测量得到的挠曲变形角,θ为状态方程中的挠曲变形角,vθ′为光学设备挠曲变形角测量误差;
建立所述主系统的姿态与所述子系统的姿态之间的关系,以及所述主系统的速度与所述子系统的速度之间的关系;
根据所述状态方程中的位置误差与所述光学设备测量得到的变形位移之间的约束关系、所述状态方程中的挠曲变形角与所述挠曲变形角之间的约束关系,以及所述主系统的姿态与所述子系统的姿态之间的关系,以及所述主系统的速度与所述子系统的速度之间的关系确定所述子系统的量测变量;
根据所述量测变量建立所述子系统的量测方程。
结合第一方面的第二种可能的实施方式,在第一方面的第三种可能的实施方式中,所述主系统和所述子系统的位置包括纬度、经度和高度;
固定杆臂rb=[rbx rby rbz]T,rbx、rby、rbz分别为载机飞行前静止时测量得到的主、子系统间的空间距离在子系统载体坐标系x轴、y轴和z轴上的投影,子系统变形位移r′b=[r′bx r′by r′bz]T,r′bx、r′by、r′bz分别为光学设备测量得到的子系统相对主系统的位移在子系统载体坐标系x轴、y轴和z轴上的投影;其中δL′、δλ′、δh′分别为主系统补偿固定杆臂rb和子系统变形位移r′b后与子系统的纬度、经度、高度之差;子系统位置误差δPs=[δL δλ δh]T;主系统位置误差 分别为主系统的纬度、经度和高度量测噪声; 分别为光学设备在子系统载体坐标系x轴、y轴和z轴上的变形位移量测噪声;
θ′=[θ′x θ′y θ′z]T,θ′x、θ′y、θ′z分别为θ′在所述子系统载体坐标系的x轴、y轴和z轴上的分量。
结合第一方面的第二种可能的实施方式,在第一方面的第四种可能的实施方式中,
所述利用卡尔曼滤波和所述子系统的对准滤波估计的数学模型估计所述子系统的预设状态变量,并根据所述预设状态变量的估计值修正所述子系统的捷联解算结果,具体包括:
利用卡尔曼滤波算法估计得到所述子系统tk时刻的平台失准角φE、φN、φU;
根据所述平台失准角φE、φN、φU修正所述子系统的捷联解算结果中的姿态,包括:计算tk时刻所述子系统地理坐标系n1与计算地理坐标系n′1间的姿态转换矩阵
计算tk时刻子系统载体坐标系b与真实地理坐标系n1之间的姿态转换矩阵 其中,为tk时刻子系统捷联解算得到的姿态矩阵;
根据所述姿态矩阵计算tk时刻所述子系统的航向角ψs、俯仰角θs和横滚角γs,将记为
其中Tl′m′为矩阵中第l′行、第m′列的元素,l′=1,2,3,m′=1,2,3;则子系统航向角ψs、俯仰角θs和横滚角γs的主值,即ψs主、θs主和γs主分别为:
θs主=arcsin(T32)
由所述ψs主、θs主和γs主分别得到所述航向角ψs、俯仰角θs和横滚角γs,
θs=θs主,
其中,所述航向角ψs、俯仰角θs和横滚角γs的取值范围分别为[0,2π]、[-π,+π]。
结合第一方面的第二种可能的实施方式,在第一方面的第五种可能的实施方式中,
所述利用卡尔曼滤波和所述子系统的对准滤波估计的数学模型估计所述子系统的预设状态变量,并根据所述预设状态变量的估计值修正所述子系统的捷联解算结果,具体包括:
利用卡尔曼滤波算法估计得到所述子系统tk时刻速度误差δVE、δVN、δVU;
根据所述速度误差δVE、δVN、δVU修正所述子系统的捷联解算结果中的速度,包括:
其中和分别为所述子系统修正后的东向、北向和天向速度;和分别为所述子系统捷联解算得到的东向、北向和天向速度;δVE、δVN和δVU分别为tk时刻卡尔曼滤波估计出的子系统捷联解算东向、北向和天向速度误差。
结合第一方面的第二种可能的实施方式,在第一方面的第五种可能的实施方式中,所述利用卡尔曼滤波和所述子系统的对准滤波估计的数学模型估计所述子系统的预设状态变量,并根据所述预设状态变量的估计值修正所述子系统的捷联解算结果,具体包括:
利用卡尔曼滤波算法估计得到所述子系统tk时刻的位置误差δL、δλ、δh;
根据位置误差δL、δλ、δh修正所述子系统的捷联解算结果中的位置,包括:
Lnew=Lold-δL
λnew=λold-δλ
Hnew=Hold-δh
其中Lold、λold和Hold分别为所述子系统捷联解算得到的纬度、经度和高度;Lnew、λnew和Hnew分别为子系统修正后的纬度、经度和高度;δL、δλ和δh分别为tk时刻卡尔曼滤波估计出的子系统捷联解算纬度、经度和高度误差。
第二方面,本发明实施例提供一种机载分布式POS系统传递对准的装置,所述机载分布式POS系统包括主系统和两个以上的子系统,包括:
第一建立模块,用于建立所述子系统对所述主系统的传递对准误差模型,所述传递对准误差模型包括所述子系统的惯导误差模型、固定安装误差角模型和机体挠曲变形角模型;
第二建立模块,用于建立所述子系统传递对准滤波估计的数学模型,所述数学模型包括状态方程和量测方程,其中,所述状态方程根据所述传递对准误差模型获得,所述量测方程根据光学设备量测得到的变形位移与所述状态方程中的位置误差之间的约束关系、所述光学设备量测得到的挠曲变形角与所述状态方程中的挠曲变形角之间的约束关系、以及所述主系统与所述子系统的姿态之间的关系、所述主系统的速度与所述子系统的速度之间的关系确定的量测变量获得;
修正模块,用于利用卡尔曼滤波和所述子系统的对准滤波估计的数学模型估计所述子系统的预设状态变量,并根据所述预设状态变量的估计值修正所述子系统的捷联解算结果。
本发明实施例提供的机载分布式POS系统传递对准的方法,将机体挠曲变形视为二阶马尔科夫过程,建立传递对准误差模型;然后,在传递对准滤波器中,引入光学设备获得的变形位移和挠曲变形角,并分别建立二者与状态变量中位置误差和挠曲变形角之间的直接约束关系,以基于光学辅助的“姿态+速度+位置+挠曲变形角”的匹配方式构建子系统传递对准数学模型;其次,利用卡尔曼滤波消除光学设备测量值的随机误差,实现对位置误差等状态变量的更准确的估计;最后,利用上述误差修正子系统捷联解算结果,计算出更加准确的子系统的位置、速度和姿态。
附图说明
图1是本发明实施例提供的一种机载分布式POS系统传递对准的方法的流程示意图;
图2是本发明实施例提供的机载POS系统参考坐标系示意图;
图3是本发明实施例提供的一种机载分布式POS系统传递对准的装置的结构示意图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清查、完整的描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
以下分别进行详细说明。
本发明的说明书和权利要求书及上述附图中的术语“第一”、“第二”、“第三”等是用于区别类似的对象,而不必用于描述特定的顺序和先后次序。应该理解这样使用的数据在适当的情况下可以互换,以便这里描述的本发明实施例能够以除了在这里图示或者描述的那些以外的顺序实施。
此外,术语“包括”和“具有”以及他们的任何变形,意图在于覆盖不排他的包含,例如,包含了一系列步骤或单元的过程、方法、系统、产品或设备不必限于清楚的列出的那些步骤或单元,而是可包括没有清楚地列出的或对于这些过程、方法、产品、或设备固有的其他步骤或单元。
请参阅图1,图1为本发明实施例提供的机载分布式POS系统传递对准的方法的一个实施例流程示意图,本发明实施例提供的机载分布式POS系统传递对准的方法应用于包含主系统和两个以上的子系统的机载分布式POS系统中,该方法包括:
S101、建立子系统对所述主系统的传递对准误差模型,所述传递对准误差模型包括所述子系统的惯导误差模型、固定安装误差角模型和机体挠曲变形角模型;
本发明实施例将集体挠曲变形视为二阶马尔科夫过程,建立包含子系统惯导误差模型、固定安装误差角模型和挠曲变形角模型的传递对准模型。具体传递对准误差模型的构建过程包括:
1)建立子系统的惯导误差模型
在本发明实施例中,相关参考坐标系统的定义包括:记i为地心惯性坐标系;e为地球坐标系;主系统和子系统导航坐标系均为东北天地理坐标系,分别用n和n1表示;载体坐标系原点为载体重心,x轴沿载体横轴向右,y轴沿载体纵轴向前,z轴沿载体竖轴向上,该坐标系固定在载体上,称为右前上载体坐标系,用a和b分别代表主系统和子系统的载体坐标系;根据上述定义,子系统惯导误差模型为:
a)姿态角误差微分方程:
b)速度误差微分方程:
c)位置误差微分方程:
d)惯性仪表误差微分方程:
其中为子系统姿态失准角,φE、φN和φU分别为东向、北向、天向失准角,下标E、N和U分别表示东向、北向和天向;为子系统导航坐标系相对地心惯性坐标系的角速度;为的误差角速度;为子系统载体坐标系到其导航坐标系的姿态转换矩阵的估计值;和分别为子系统的速度和速度误差,其中VE、VN和VU分别为东向、北向和天向速度,δVE、δVN和δVU分别为东向、北向和天向速度误差;是子系统的比力,其中fE、fN和fU分别为东向、北向和天向比力;和分别为子系统地球坐标系相对地心惯性坐标系的角速度及其误差;和分别为子系统导航坐标系相对地球坐标系的角速度及其误差;L、λ、h和δL、δλ、δh分别为子系统纬度、经度、高度和纬度误差、经度误差、高度误差;为纬度的一阶导数,为经度的一阶导数;RM和RN分别为沿子午圈和卯酉圈的主曲率半径;εb=[εx εy εz]T和分别为子系统陀螺常值漂离和加速度计常值偏置,其中εx、εy和εz分别为子系统载体坐标系x轴、y轴和z轴陀螺常值漂移,其中和分别为子系统载体坐标系x轴、y轴和z轴加速度计常值偏置。
2)建立固定安装误差角模型:
其中ρ=[ρx ρy ρz]T为子系统固定安装误差角,ρx、ρy和ρz分别为子系统载体坐标系x轴、y轴和z轴安装误差角。
3)建立挠曲变形角模型:
其中θj为子系统载体坐标系第j轴上的挠曲变形角,θ=[θx θy θz]T为挠曲变形角;βj=2.146τj,τj为二阶马尔科夫过程相关时间;ηj为零均值白噪声,其方差满足:
其中σj 2为挠曲变形角θj的方差,βj和为描述挠曲变形角θ的二阶马尔科夫过程的参数,在传递对准之前根据载机实际结构以及飞行情况确定。
S102、建立子系统传递对准滤波估计的数学模型,所述数学模型包括状态方程和量测方程,其中,所述状态方程根据所述传递对准误差模型获得,所述量测方程根据光学设备量测得到的变形位移与所述状态方程中的位置误差之间的约束关系、所述光学设备量测得到的挠曲变形角与所述状态方程中的挠曲变形角之间的约束关系、以及所述主系统与所述子系统的姿态之间的关系、所述主系统的速度与所述子系统的速度之间的关系确定的量测变量获得;
具体的,在本发明实施例中,所述建立所述子系统传递对准滤波估计的数学模型,包括:
根据所述子系统的预设状态变量建立状态方程
其中,X为所述子系统预设状态变量;所述子系统的转移矩阵F由所述传递对准误差模型确定;系统噪声其中分别为所述子系统载体坐标系x轴、y轴和z轴陀螺的随机误差,分别为所述子系统载体坐标系x轴、y轴和z轴加速度计的随机误差;G为所述子系统的系统噪声:
其中,为所述子系统载体坐标系到所述子系统导航坐标系的姿态转换矩阵。
所述预设状态变量X包含位置变量和挠曲变形角变量;
所述建立所述子系统传递对准滤波估计的数学模型,包括建立所述子系统的量测方程,具体包括:
接收光学设备量测得到的变形位移和挠曲变形角;
建立所述状态方程中的位置误差与所述光学设备测量得到的变形位移之间的约束关系:其中,Pm和Ps分别为所述主系统和所述子系统的位置,固定杆臂rb为载机飞行前静止时测量得到的所述主系统和所述子系统间的空间距离在子系统载体坐标系上的投影,子系统变形位移r′b为所述光学设备测量得到的所述子系统相对所述主系统的位移在子系统载体坐标系上的投影;为所述主系统载体坐标系到所述主系统导航坐标系的姿态转换矩阵;δPs为子系统位置误差;δPm为主系统位置误差,δr′b为子系统变形位移r′b的误差,
建立所述状态方程中的挠曲变形角与所述光学设备测量得到的挠曲变形角之间的约束关系:θ′=θ-vθ′,其中θ′为光学设备测量得到的挠曲变形角,θ为状态方程中的挠曲变形角,vθ′为光学设备挠曲变形角测量误差;
建立所述主系统的姿态与所述子系统的姿态之间的关系,以及所述主系统的速度与所述子系统的速度之间的关系;
根据所述状态方程中的位置误差与所述光学设备测量得到的变形位移之间的约束关系、所述状态方程中的挠曲变形角与所述挠曲变形角之间的约束关系,以及所述主系统的姿态与所述子系统的姿态之间的关系,以及所述主系统的速度与所述子系统的速度之间的关系确定所述子系统的量测变量;
根据所述量测变量建立所述子系统的量测方程。
主系统和子系统的位置包括纬度、经度和高度;
固定杆臂rb=[rbx rby rbz]T,rbx、rby、rbz分别为载机飞行前静止时测量得到的主、子系统间的空间距离在子系统载体坐标系x轴、y轴和z轴上的投影,子系统变形位移r′b=[r′bx r′by r′bz]T,r′bx、r′by、r′bz分别为光学设备测量得到的子系统相对主系统的位移在子系统载体坐标系x轴、y轴和z轴上的投影;其中δL′、δλ′、δh′分别为主系统补偿固定杆臂rb和子系统变形位移r′b后与子系统的纬度、经度、高度之差;子系统位置误差δPs=[δL δλ δh]T;主系统位置误差 分别为主系统的纬度、经度和高度量测噪声; 分别为光学设备在子系统载体坐标系x轴、y轴和z轴上的变形位移量测噪声;
θ′=[θ′x θ′y θ′z]T,θ′x、θ′y、θ′z分别为θ′在所述子系统载体坐标系的x轴、y轴和z轴上的分量。
S103、利用卡尔曼滤波和所述子系统的对准滤波估计的数学模型估计所述子系统的预设状态变量,并根据所述预设状态变量的估计值修正所述子系统的捷联解算结果。
具体的,包括:
利用卡尔曼滤波算法估计得到所述子系统tk时刻的平台失准角φE、φN、φU;
根据所述平台失准角φE、φN、φU修正所述子系统的捷联解算结果中的姿态,包括:计算tk时刻所述子系统地理坐标系n1与计算地理坐标系n′1间的姿态转换矩阵
计算tk时刻子系统载体坐标系b与真实地理坐标系n1之间的姿态转换矩阵 其中,为tk时刻子系统捷联解算得到的姿态矩阵;
根据所述姿态矩阵计算tk时刻所述子系统的航向角ψs、俯仰角θs和横滚角γs,将记为
其中Tl′m′为矩阵中第l′行、第m′列的元素,l′=1,2,3,m′=1,2,3;则子系统航向角ψs、俯仰角θs和横滚角γs的主值,即ψs主、θs主和γs主分别为:
θs主=arcsin(T32)
由所述ψs主、θs主和γs主分别得到所述航向角ψs、俯仰角θs和横滚角γs,
θs=θs主,
其中,所述航向角ψs、俯仰角θs和横滚角γs的取值范围分别为[0,2π]、[-π,+π]。
以及/或者,利用卡尔曼滤波算法估计得到所述子系统tk时刻速度误差δVE、δVN、δVU;
根据所述速度误差δVE、δVN、δVU修正所述子系统的捷联解算结果中的速度,包括:
其中和分别为所述子系统修正后的东向、北向和天向速度;和分别为所述子系统捷联解算得到的东向、北向和天向速度;δVE、δVN和δVU分别为tk时刻卡尔曼滤波估计出的子系统捷联解算东向、北向和天向速度误差。
以及/或者,利用卡尔曼滤波算法估计得到所述子系统tk时刻的位置误差δL、δλ、δh;
根据位置误差δL、δλ、δh修正所述子系统的捷联解算结果中的位置,包括:
Lnew=Lold-δL
λnew=λold-δλ
Hnew=Hold-δh
其中Lold、λold和Hold分别为所述子系统捷联解算得到的纬度、经度和高度;Lnew、λnew和Hnew分别为子系统修正后的纬度、经度和高度;δL、δλ和δh分别为tk时刻卡尔曼滤波估计出的子系统捷联解算纬度、经度和高度误差。
需要说明的是,在本发明中所说的天向是相对地理坐标系来说的,参见图2所示,地理坐标系的三个轴向定义为东向、北向及天向,坐标系原点为当前位置点,正东方向及正北方向分别定义为x、y轴;天向为z轴,其延长线经过地心。
目前随着光学技术的快速发展,利用设备测量挠曲变形角和挠曲变形位移已经能够达到很高的精度。例如在机翼结构上布设光纤光栅测量设备,位移变形量分辨率可达0.01毫米,远远高于最高精度惯性/卫星组合测量系统厘米级的定位精度。虽然光学方法具有绝对测量精度高、设备成本低的优点,但存在随机误差,无法直接用于主系统到子系统的运动参数传递,本发明实施例提供的机载分布式POS系统对准传递的方法克服了现有技术的不足,采取将挠曲变形视为二阶马尔科夫过程,建立传递对准误差模型;引入光学设备获得的变形位移和挠曲变形角,建立变形位移、挠曲变形角分别与状态变量中位置误差、挠曲变形角之间的直接约束关系,基于约束关系构建子系统传递对准数学模型,并利用卡尔曼滤波消除光学设备测量值的随机误差,实现对位置误差等状态变量的更准确的估计,最后,利用误差修正子系统捷联解算结果,计算出更加准确的子系统的位置、速度和姿态。
在本发明的另一实施中,子系统传递对准滤波估计的数学模型包括状态方程和量测方程,具体建立的步骤为:
1)状态变量选取。
系统状态变量X取为:
X=[X1 X2]T
2)状态方程建立。
状态方程为:
其中,系统转移矩阵F可由传递对准误差模型确定;系统噪声其中和 分别为子系统载体坐标系x轴、y轴和z轴陀螺的随机误差和子系统载体坐标系x轴、y轴和z轴加速度计的随机误差,不包括随机常值误差;系统噪声W为零均值的高斯白噪声,其方差阵Q由陀螺随机误差水平、加速度计随机误差水平和二阶马尔科夫过程参数决定;系统噪声矩阵G的表达式为:
其中为子系统载体坐标系到子系统导航坐标系的姿态转换矩阵;
3)匹配方式确定。
引入光学设备获得的变形位移和挠曲变形角,并分别建立二者与状态变量中位置误差和挠曲变形角之间的直接约束关系,在传统的“姿态+速度”匹配的基础上,增加“位置+挠曲变形角”匹配,形成新的“姿态+速度+位置+挠曲变形角”的匹配方式;
光学设备获得的变形位移和挠曲变形角与状态变量中位置误差和挠曲变形角之间的约束关系建立如下:
θ′=θ-vθ′
其中,Pm和Ps分别为主系统的位置和子系统的位置(均包括纬度、经度和高度),Ps=[L λ h]T,为主系统载体坐标系到主系统导航坐标系的姿态转换矩阵,固定杆臂rb=[rbx rby rbz]T为载机飞行前静止时测量得到的主、子系统间的空间距离在子系统载体坐标系上的投影,子系统变形位移r′b=[r′bx r′by r′bz]T为光学设备测量得到的子系统相对主系统的位移在子系统载体坐标系上的投影;记其中δL′、δλ′、δh′分别为主系统补偿固定杆臂rb和子系统变形位移r′b后与子系统的纬度、经度、高度之差;子系统位置误差δPs=[δL δλ δh]T;主系统位置误差 分别为主系统的纬度、经度和高度量测噪声;为子系统变形位移r′b的误差,分别为光学设备在子系统载体坐标系x轴、y轴和z轴上的变形位移量测噪声;θ′为光学设备测量得到的挠曲变形角,θ′=[θ′x θ′y θ′z]T,θ′j为θ′在子系统载体坐标系第j轴上的分量,j=x,y,z;vθ′为光学设备挠曲变形角测量误差, 分别为光学设备在子系统载体坐标系x轴、y轴和z轴挠曲变形角量测噪声;
主系统的姿态和速度分别与子系统的姿态和速度之差的关系式如下:
其中δψ、δθ、δγ分别为主系统与子系统的航向角、俯仰角、横滚角之差;ψm、θm、γm分别为主系统的航向角、俯仰角、横滚角,ψs、θs、γs分别为子系统的航向角、俯仰角、横滚角;将主系统载体坐标系到主系统导航坐标系的姿态转换矩阵记为为Ta第l′行、第m′列的元素,l′=1,2,3,m′=1,2,3;vδψ、vδθ、vδγ分别为主系统航向角、俯仰角、横滚角的量测噪声;记δVE′、δVN′、δVU′分别为主系统补偿杆臂速度后与子系统的东向、北向、天向速度之差,杆臂速度 为子系统载体坐标系相对地心惯性坐标系的角速度,和分别为rb和r′b的导数;子系统速度误差δVs=[δVE δVN δVU]T;主系统速度误差 分别为主系统东向、北向、天向速度的量测噪声.
因此,“姿态+速度+位置+挠曲变形角”匹配方式对应的量测变量Z=[δψ δθ δγ δV′E δV′N δV′U δL′ δλ′ δh′ θ′x θ′y θ′z]T;
4)量测方程建立。
量测方程为:
Z=HX+V
其中,系统量测噪声其中vδL′、vδλ′和vδh′分别为主系统的纬度、经度和高度量测噪声与光学设备在子系统载体坐标系x轴、y轴和z轴上的变形位移量测噪声之和,即V为零均值的高斯白噪声,其方差阵R由主系统的位置和速度精度、光学设备挠曲变形角和变形位移测量精度决定;量测矩阵H为:
上式中和的表达式分别为:
在本发明实施例中,针对实际应用中机体挠曲变形难以精确建模从而影响传递对准精度的问题,提出基于光学辅助的“姿态+速度+位置+挠曲变形角”的匹配方式进行分布式POS传递对准。在传递对准滤波器中,引入高精度光学设备获得的变形位移和挠曲变形角测量值,分别建立二者与状态变量中位置误差和挠曲变形角之间的直接约束关系,在传统的“姿态+速度”匹配的基础上,增加“位置+挠曲变形角”匹配,形成新的“姿态+速度+位置+挠曲变形角”的匹配方式获得新的量测方程,通过卡尔曼滤波消除光学设备测量值的随机误差,实现对位置误差和挠曲变形角状态变量的更准确的估计,从而提高子系统位置、速度和姿态的估计精度。克服了传统方法无法准确描述挠曲变形导致传递对准精度低的不足,提高了传递对准的精度。
参阅图3所示,本发明实施例还提供一种机载分布式POS系统传递对准的装置,所述机载分布式POS系统包括主系统和两个以上的子系统,包括:
第一建立模块301,用于建立所述子系统对所述主系统的传递对准误差模型,所述传递对准误差模型包括所述子系统的惯导误差模型、固定安装误差角模型和机体挠曲变形角模型;
第二建立模块302,用于建立所述子系统传递对准滤波估计的数学模型,所述数学模型包括状态方程和量测方程,其中,所述状态方程根据所述传递对准误差模型获得,所述量测方程根据光学设备量测得到的变形位移与所述状态方程中的位置误差之间的约束关系、所述光学设备量测得到的挠曲变形角与所述状态方程中的挠曲变形角之间的约束关系、以及所述主系统与所述子系统的姿态之间的关系、所述主系统的速度与所述子系统的速度之间的关系确定的量测变量获得;
修正模块303,用于利用卡尔曼滤波和所述子系统的对准滤波估计的数学模型估计所述子系统的预设状态变量,并根据所述预设状态变量的估计值修正所述子系统的捷联解算结果。
进一步的,第二建立模块302具体用于:
根据所述子系统的预设状态变量建立状态方程
其中,X为所述子系统预设状态变量;所述子系统的转移矩阵F由所述传递对准误差模型确定;系统噪声其中分别为所述子系统载体坐标系x轴、y轴和z轴陀螺的随机误差,分别为所述子系统载体坐标系x轴、y轴和z轴加速度计的随机误差;G为所述子系统的系统噪声矩阵:
其中,为所述子系统载体坐标系到所述子系统导航坐标系的姿态转换矩阵。
具体的,预设状态变量X包含位置变量和挠曲变形角变量;
第二建立模块302具体用于:
接收光学设备量测得到的变形位移和挠曲变形角;
建立所述状态方程中的位置误差与所述光学设备测量得到的变形位移之间的约束关系:其中,Pm和Ps分别为所述主系统和所述子系统的位置,固定杆臂rb为载机飞行前静止时测量得到的所述主系统和所述子系统间的空间距离在子系统载体坐标系上的投影,子系统变形位移r′b为所述光学设备测量得到的所述子系统相对所述主系统的位移在子系统载体坐标系上的投影;为所述主系统载体坐标系到所述主系统导航坐标系的姿态转换矩阵;δPs为子系统位置误差;δPm为主系统位置误差,δr′b为子系统变形位移r′b的误差,
建立所述状态方程中的挠曲变形角与所述挠曲变形角之间的约束关系:θ′=θ-vθ′,其中θ′为光学设备测量得到的挠曲变形角,vθ′为光学设备挠曲变形角测量误差;
建立所述主系统的姿态与所述子系统的姿态之间的关系,以及所述主系统的速度与所述子系统的速度之间的关系;
根据所述状态方程中的位置误差与所述光学设备测量得到的变形位移之间的约束关系、所述状态方程中的挠曲变形角与所述挠曲变形角之间的约束关系,以及所述主系统的姿态与所述子系统的姿态之间的关系,以及所述主系统的速度与所述子系统的速度之间的关系确定所述子系统的量测变量;
根据所述量测变量建立所述子系统的量测方程。
本发明实施例提供的机载分布式POS系统传递对准的装置中的第二建立模块302,利用“姿态+速度+位置+挠曲变形角”的匹配方式建立新的量测方程,克服了传统装置无法准确描述挠曲变形导致传递对准精低的不足,提高了传递对准的精度。
在本发明另一实施例中,还提供一种计算机可读存储介质,计算机可读存储介质上存储有计算机程序,计算机程序被处理器执行时实现以上机载分布式POS系统传递对准的方法。
本领域普通技术人员可以理解上述实施例的各种流程中的全部或部分步骤是可以通过程序来指令相关的硬件来完成,该程序可以存储于一计算机可读存储介质中,存储介质可以包括:只读存储器(ROM,Read Only Memory)、随机存取存储器(RAM,RandomAccess Memory)、磁盘或光盘等。
同时,在上述实施例中,对各个实施例的描述都各有侧重,某个实施例中没有详述的部分,可以参见其他实施例的相关描述。
以上对本发明实施例所提供的机载分布式POS系统传递对准的方法进行了详细介绍,本文中应用了具体个例对交互的本发明的原理及实施方式进行了阐述,以上实施例的说明只是用于帮助理解本发明的方法及其核心思想;同时,对于本领域的一般技术人员,依据本发明的思想,在具体实施方式及应用范围上均会有改变之处,综上所述,本说明书内容不应理解为对本发明的限制。
Claims (11)
1.一种机载分布式POS系统传递对准的方法,所述机载分布式POS系统包括主系统和两个以上的子系统,其特征在于,包括:
建立所述子系统对所述主系统的传递对准误差模型,所述传递对准误差模型包括所述子系统的惯导误差模型、固定安装误差角模型和机体挠曲变形角模型;
建立所述子系统传递对准滤波估计的数学模型,所述数学模型包括状态方程和量测方程,其中,所述状态方程根据所述传递对准误差模型获得,所述量测方程根据光学设备量测得到的变形位移与所述状态方程中的位置误差之间的约束关系、所述光学设备量测得到的挠曲变形角与所述状态方程中的挠曲变形角之间的约束关系、以及所述主系统与所述子系统的姿态之间的关系、所述主系统的速度与所述子系统的速度之间的关系确定的量测变量获得;
利用卡尔曼滤波和所述子系统的对准滤波估计的数学模型估计所述子系统的预设状态变量,并根据所述预设状态变量的估计值修正所述子系统的捷联解算结果。
2.根据权利要求1所述的方法,其特征在于,所述建立所述子系统传递对准滤波估计的数学模型,包括:
根据所述子系统的预设状态变量建立状态方程
<mrow>
<mover>
<mi>X</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>=</mo>
<mi>F</mi>
<mi>X</mi>
<mo>+</mo>
<mi>G</mi>
<mi>W</mi>
</mrow>
其中,X为所述子系统预设状态变量;所述子系统的转移矩阵F由所述传递对准误差模型确定;系统噪声其中分别为所述子系统载体坐标系x轴、y轴和z轴陀螺的随机误差,分别为所述子系统载体坐标系x轴、y轴和z轴加速度计的随机误差;G为所述子系统的系统噪声矩阵:
<mrow>
<mi>G</mi>
<mo>=</mo>
<msub>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msubsup>
<mi>C</mi>
<mi>b</mi>
<msub>
<mi>n</mi>
<mn>1</mn>
</msub>
</msubsup>
</mtd>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>3</mn>
<mo>&times;</mo>
<mn>3</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>3</mn>
<mo>&times;</mo>
<mn>3</mn>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>3</mn>
<mo>&times;</mo>
<mn>3</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msubsup>
<mi>C</mi>
<mi>b</mi>
<msub>
<mi>n</mi>
<mn>1</mn>
</msub>
</msubsup>
</mtd>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>3</mn>
<mo>&times;</mo>
<mn>3</mn>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>15</mn>
<mo>&times;</mo>
<mn>3</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>15</mn>
<mo>&times;</mo>
<mn>3</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>13</mn>
<mo>&times;</mo>
<mn>3</mn>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>3</mn>
<mo>&times;</mo>
<mn>3</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>3</mn>
<mo>&times;</mo>
<mn>3</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>I</mi>
<mrow>
<mn>3</mn>
<mo>&times;</mo>
<mn>3</mn>
</mrow>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mrow>
<mn>24</mn>
<mo>&times;</mo>
<mn>9</mn>
</mrow>
</msub>
</mrow>
其中,为所述子系统载体坐标系到所述子系统导航坐标系的姿态转换矩阵。
3.根据权利要求2所述的方法,其特征在于,所述预设状态变量X包含位置变量和挠曲变形角变量;
所述建立所述子系统传递对准滤波估计的数学模型,包括建立所述子系统的量测方程,包括:
接收光学设备量测得到的变形位移和挠曲变形角;
建立所述状态方程中的位置误差与所述光学设备测量得到的变形位移之间的约束关系:其中,Pm和Ps分别为所述主系统和所述子系统的位置,固定杆臂rb为载机飞行前静止时测量得到的所述主系统和所述子系统间的空间距离在子系统载体坐标系上的投影,子系统变形位移rb′为所述光学设备测量得到的所述子系统相对所述主系统的位移在子系统载体坐标系上的投影;为所述主系统载体坐标系到所述主系统导航坐标系的姿态转换矩阵;δPs为子系统位置误差;δPm为主系统位置误差,δrb′为子系统变形位移rb′的误差,
建立所述状态方程中的挠曲变形角与所述光学设备测量得到的挠曲变形角之间的约束关系:θ′=θ-vθ′,其中θ′为光学设备测量得到的挠曲变形角,θ为状态方程中的挠曲变形角,vθ′为光学设备挠曲变形角测量误差;
建立所述主系统的姿态与所述子系统的姿态之间的关系,以及所述主系统的速度与所述子系统的速度之间的关系;
根据所述状态方程中的位置误差与所述光学设备测量得到的变形位移之间的约束关系、所述状态方程中的挠曲变形角与所述挠曲变形角之间的约束关系,以及所述主系统的姿态与所述子系统的姿态之间的关系,以及所述主系统的速度与所述子系统的速度之间的关系确定所述子系统的量测变量;
根据所述量测变量建立所述子系统的量测方程。
4.根据权利要求3所述的方法,其特征在于,所述主系统和所述子系统的位置包括纬度、经度和高度;
固定杆臂rb=[rbx rby rbz]T,rbx、rby、rbz分别为载机飞行前静止时测量得到的主、子系统间的空间距离在子系统载体坐标系x轴、y轴和z轴上的投影,子系统变形位移rb′=[rb′xrb′y rb′z]T,rb′x、rb′y、rb′z分别为光学设备测量得到的子系统相对主系统的位移在子系统载体坐标系x轴、y轴和z轴上的投影;其中δL′、δλ′、δh′分别为主系统补偿固定杆臂rb和子系统变形位移rb′后与子系统的纬度、经度、高度之差;子系统位置误差δPs=[δL δλ δh]T;主系统位置误差 分别为主系统的纬度、经度和高度量测噪声; 分别为光学设备在子系统载体坐标系x轴、y轴和z轴上的变形位移量测噪声;
θ′=[θx′ θy′ θz′]T,θx′、θy′、θz′分别为θ′在所述子系统载体坐标系的x轴、y轴和z轴上的分量。
5.根据权利要求3所述的方法,其特征在于,所述利用卡尔曼滤波和所述子系统的对准滤波估计的数学模型估计所述子系统的预设状态变量,并根据所述预设状态变量的估计值修正所述子系统的捷联解算结果,具体包括:
利用卡尔曼滤波算法估计得到所述子系统tk时刻的平台失准角φE、φN、φU;
根据所述平台失准角φE、φN、φU修正所述子系统的捷联解算结果中的姿态,包括:计算tk时刻所述子系统地理坐标系n1与计算地理坐标系n1′间的姿态转换矩阵
<mrow>
<msubsup>
<mi>C</mi>
<msubsup>
<mi>n</mi>
<mn>1</mn>
<mo>&prime;</mo>
</msubsup>
<msub>
<mi>n</mi>
<mn>1</mn>
</msub>
</msubsup>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>&phi;</mi>
<mi>U</mi>
</msub>
</mrow>
</mtd>
<mtd>
<msub>
<mi>&phi;</mi>
<mi>N</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>&phi;</mi>
<mi>U</mi>
</msub>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>&phi;</mi>
<mi>E</mi>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>&phi;</mi>
<mi>N</mi>
</msub>
</mrow>
</mtd>
<mtd>
<msub>
<mi>&phi;</mi>
<mi>E</mi>
</msub>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
计算tk时刻子系统载体坐标系b与真实地理坐标系n1之间的姿态转换矩阵 其中,为tk时刻子系统捷联解算得到的姿态矩阵;
根据所述姿态矩阵计算tk时刻所述子系统的航向角ψs、俯仰角θs和横滚角γs,将记为
<mrow>
<msubsup>
<mi>C</mi>
<mi>b</mi>
<msub>
<mi>n</mi>
<mn>1</mn>
</msub>
</msubsup>
<mo>=</mo>
<msub>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>T</mi>
<mn>11</mn>
</msub>
</mtd>
<mtd>
<msub>
<mi>T</mi>
<mn>12</mn>
</msub>
</mtd>
<mtd>
<msub>
<mi>T</mi>
<mn>13</mn>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>T</mi>
<mn>21</mn>
</msub>
</mtd>
<mtd>
<msub>
<mi>T</mi>
<mn>22</mn>
</msub>
</mtd>
<mtd>
<msub>
<mi>T</mi>
<mn>23</mn>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>T</mi>
<mn>31</mn>
</msub>
</mtd>
<mtd>
<msub>
<mi>T</mi>
<mn>32</mn>
</msub>
</mtd>
<mtd>
<msub>
<mi>T</mi>
<mn>33</mn>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mrow>
<mn>3</mn>
<mo>&times;</mo>
<mn>3</mn>
</mrow>
</msub>
</mrow>
其中Tl′m′为矩阵中第l′行、第m′列的元素,l′=1,2,3,m′=1,2,3;则子系统航向角ψs、俯仰角θs和横滚角γs的主值,即ψs主、θs主和γs主分别为:
θs主=arcsin(T32)
由所述ψs主、θs主和γs主分别得到所述航向角ψs、俯仰角θs和横滚角γs,
θs=θs主,
其中,所述航向角ψs、俯仰角θs和横滚角γs的取值范围分别为[0,2π]、[-π,+π]。
6.根据权利要求3所述的方法,其特征在于,所述利用卡尔曼滤波和所述子系统的对准滤波估计的数学模型估计所述子系统的预设状态变量,并根据所述预设状态变量的估计值修正所述子系统的捷联解算结果,具体包括:
利用卡尔曼滤波算法估计得到所述子系统tk时刻速度误差δVE、δVN、δVU;
根据所述速度误差δVE、δVN、δVU修正所述子系统的捷联解算结果中的速度,包括:
<mrow>
<msubsup>
<mi>V</mi>
<mi>E</mi>
<mrow>
<mi>n</mi>
<mi>e</mi>
<mi>w</mi>
</mrow>
</msubsup>
<mo>=</mo>
<msubsup>
<mi>V</mi>
<mi>E</mi>
<mrow>
<mi>o</mi>
<mi>l</mi>
<mi>d</mi>
</mrow>
</msubsup>
<mo>-</mo>
<msub>
<mi>&delta;V</mi>
<mi>E</mi>
</msub>
</mrow>
<mrow>
<msubsup>
<mi>V</mi>
<mi>N</mi>
<mrow>
<mi>n</mi>
<mi>e</mi>
<mi>w</mi>
</mrow>
</msubsup>
<mo>=</mo>
<msubsup>
<mi>V</mi>
<mi>N</mi>
<mrow>
<mi>o</mi>
<mi>l</mi>
<mi>d</mi>
</mrow>
</msubsup>
<mo>-</mo>
<msub>
<mi>&delta;V</mi>
<mi>N</mi>
</msub>
</mrow>
<mrow>
<msubsup>
<mi>V</mi>
<mi>U</mi>
<mrow>
<mi>n</mi>
<mi>e</mi>
<mi>w</mi>
</mrow>
</msubsup>
<mo>=</mo>
<msubsup>
<mi>V</mi>
<mi>U</mi>
<mrow>
<mi>o</mi>
<mi>l</mi>
<mi>d</mi>
</mrow>
</msubsup>
<mo>-</mo>
<msub>
<mi>&delta;V</mi>
<mi>U</mi>
</msub>
</mrow>
其中和分别为所述子系统修正后的东向、北向和天向速度;和分别为所述子系统捷联解算得到的东向、北向和天向速度;δVE、δVN和δVU分别为tk时刻卡尔曼滤波估计出的子系统捷联解算东向、北向和天向速度误差。
7.根据权利要求3所述的方法,其特征在于,所述利用卡尔曼滤波和所述子系统的对准滤波估计的数学模型估计所述子系统的预设状态变量,并根据所述预设状态变量的估计值修正所述子系统的捷联解算结果,具体包括:
利用卡尔曼滤波算法估计得到所述子系统tk时刻的位置误差δL、δλ、δh;
根据位置误差δL、δλ、δh修正所述子系统的捷联解算结果中的位置,包括:
Lnew=Lold-δL
λnew=λold-δλ
Hnew=Hold-δh
其中Lold、λold和Hold分别为所述子系统捷联解算得到的纬度、经度和高度;Lnew、λnew和Hnew分别为子系统修正后的纬度、经度和高度;δL、δλ和δh分别为tk时刻卡尔曼滤波估计出的子系统捷联解算纬度、经度和高度误差。
8.一种机载分布式POS系统传递对准的装置,所述机载分布式POS系统包括主系统和两个以上的子系统,其特征在于,包括:
第一建立模块,用于建立所述子系统对所述主系统的传递对准误差模型,所述传递对准误差模型包括所述子系统的惯导误差模型、固定安装误差角模型和机体挠曲变形角模型;
第二建立模块,用于建立所述子系统传递对准滤波估计的数学模型,所述数学模型包括状态方程和量测方程,其中,所述状态方程根据所述传递对准误差模型获得,所述量测方程根据光学设备量测得到的变形位移与所述状态方程中的位置误差之间的约束关系、所述光学设备量测得到的挠曲变形角与所述状态方程中的挠曲变形角之间的约束关系、以及所述主系统与所述子系统的姿态之间的关系、所述主系统的速度与所述子系统的速度之间的关系确定的量测变量获得;
修正模块,用于利用卡尔曼滤波和所述子系统的对准滤波估计的数学模型估计所述子系统的预设状态变量,并根据所述预设状态变量的估计值修正所述子系统的捷联解算结果。
9.根据权利要求8所述的装置,其特征在于,所述第二建立模块具体用于:
根据所述子系统的预设状态变量建立状态方程
<mrow>
<mover>
<mi>X</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>=</mo>
<mi>F</mi>
<mi>X</mi>
<mo>+</mo>
<mi>G</mi>
<mi>W</mi>
</mrow>
其中,X为所述子系统预设状态变量;所述子系统的转移矩阵F由所述传递对准误差模型确定;系统噪声其中分别为所述子系统载体坐标系x轴、y轴和z轴陀螺的随机误差,分别为所述子系统载体坐标系x轴、y轴和z轴加速度计的随机误差;G为所述子系统的系统噪声:
<mrow>
<mi>G</mi>
<mo>=</mo>
<msub>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msubsup>
<mi>C</mi>
<mi>b</mi>
<msub>
<mi>n</mi>
<mn>1</mn>
</msub>
</msubsup>
</mtd>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>3</mn>
<mo>&times;</mo>
<mn>3</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>3</mn>
<mo>&times;</mo>
<mn>3</mn>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>3</mn>
<mo>&times;</mo>
<mn>3</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msubsup>
<mi>C</mi>
<mi>b</mi>
<msub>
<mi>n</mi>
<mn>1</mn>
</msub>
</msubsup>
</mtd>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>3</mn>
<mo>&times;</mo>
<mn>3</mn>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>15</mn>
<mo>&times;</mo>
<mn>3</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>15</mn>
<mo>&times;</mo>
<mn>3</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>13</mn>
<mo>&times;</mo>
<mn>3</mn>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>3</mn>
<mo>&times;</mo>
<mn>3</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>3</mn>
<mo>&times;</mo>
<mn>3</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>I</mi>
<mrow>
<mn>3</mn>
<mo>&times;</mo>
<mn>3</mn>
</mrow>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mrow>
<mn>24</mn>
<mo>&times;</mo>
<mn>9</mn>
</mrow>
</msub>
</mrow>
其中,为所述子系统载体坐标系到所述子系统导航坐标系的姿态转换矩阵。
10.根据权利要求9所述的装置,其特征在于,所述预设状态变量X包含位置变量和挠曲变形角变量;
所述第二建立模块具体用于:
接收光学设备量测得到的变形位移和挠曲变形角;
建立所述状态方程中的位置误差与所述光学设备测量得到的变形位移之间的约束关系:其中,Pm和Ps分别为所述主系统和所述子系统的位置,固定杆臂rb为载机飞行前静止时测量得到的所述主系统和所述子系统间的空间距离在子系统载体坐标系上的投影,子系统变形位移rb′为所述光学设备测量得到的所述子系统相对所述主系统的位移在子系统载体坐标系上的投影;为所述主系统载体坐标系到所述主系统导航坐标系的姿态转换矩阵;δPs为子系统位置误差;δPm为主系统位置误差,δrb′为子系统变形位移rb′的误差,
建立所述状态方程中的挠曲变形角与所述挠曲变形角之间的约束关系:θ′=θ-vθ′,其中θ′为光学设备测量得到的挠曲变形角,vθ′为光学设备挠曲变形角测量误差;
建立所述主系统的姿态与所述子系统的姿态之间的关系,以及所述主系统的速度与所述子系统的速度之间的关系;
根据所述状态方程中的位置误差与所述光学设备测量得到的变形位移之间的约束关系、所述状态方程中的挠曲变形角与所述挠曲变形角之间的约束关系,以及所述主系统的姿态与所述子系统的姿态之间的关系,以及所述主系统的速度与所述子系统的速度之间的关系确定所述子系统的量测变量;
根据所述量测变量建立所述子系统的量测方程。
11.一种计算机可读存储介质,其上存储有计算机程序,其特征在于:所述计算机程序被处理器执行时实现如权利要求1-7中任一项所述方法的步骤。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710953526.5A CN107764268B (zh) | 2017-10-13 | 2017-10-13 | 一种机载分布式pos传递对准的方法和装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710953526.5A CN107764268B (zh) | 2017-10-13 | 2017-10-13 | 一种机载分布式pos传递对准的方法和装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107764268A true CN107764268A (zh) | 2018-03-06 |
CN107764268B CN107764268B (zh) | 2020-03-24 |
Family
ID=61269562
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710953526.5A Expired - Fee Related CN107764268B (zh) | 2017-10-13 | 2017-10-13 | 一种机载分布式pos传递对准的方法和装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107764268B (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109724624A (zh) * | 2018-12-29 | 2019-05-07 | 湖北航天技术研究院总体设计所 | 一种适用于机翼挠曲变形的机载自适应传递对准算法 |
CN110501024A (zh) * | 2019-04-11 | 2019-11-26 | 同济大学 | 一种车载ins/激光雷达组合导航系统的量测误差补偿方法 |
CN113188565A (zh) * | 2021-03-23 | 2021-07-30 | 北京航空航天大学 | 一种机载分布式pos传递对准量测异常处理方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103278178A (zh) * | 2013-04-26 | 2013-09-04 | 哈尔滨工程大学 | 在传递对准中考虑传输延迟的挠曲变形测量方法 |
CN104165640A (zh) * | 2014-08-11 | 2014-11-26 | 东南大学 | 基于星敏感器的近空间弹载捷联惯导系统传递对准方法 |
CN104567930A (zh) * | 2014-12-30 | 2015-04-29 | 南京理工大学 | 一种能够估计和补偿机翼挠曲变形的传递对准方法 |
CN104655152A (zh) * | 2015-02-11 | 2015-05-27 | 北京航空航天大学 | 一种基于联邦滤波的机载分布式pos实时传递对准方法 |
CN106289246A (zh) * | 2016-07-25 | 2017-01-04 | 北京航空航天大学 | 一种基于位置和姿态测量系统的柔性杆臂测量方法 |
CN106989742A (zh) * | 2017-03-01 | 2017-07-28 | 北京控制工程研究所 | 一种基于多场耦合分析的脉冲星探测器多目标优化方法 |
-
2017
- 2017-10-13 CN CN201710953526.5A patent/CN107764268B/zh not_active Expired - Fee Related
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103278178A (zh) * | 2013-04-26 | 2013-09-04 | 哈尔滨工程大学 | 在传递对准中考虑传输延迟的挠曲变形测量方法 |
CN104165640A (zh) * | 2014-08-11 | 2014-11-26 | 东南大学 | 基于星敏感器的近空间弹载捷联惯导系统传递对准方法 |
CN104567930A (zh) * | 2014-12-30 | 2015-04-29 | 南京理工大学 | 一种能够估计和补偿机翼挠曲变形的传递对准方法 |
CN104655152A (zh) * | 2015-02-11 | 2015-05-27 | 北京航空航天大学 | 一种基于联邦滤波的机载分布式pos实时传递对准方法 |
CN106289246A (zh) * | 2016-07-25 | 2017-01-04 | 北京航空航天大学 | 一种基于位置和姿态测量系统的柔性杆臂测量方法 |
CN106989742A (zh) * | 2017-03-01 | 2017-07-28 | 北京控制工程研究所 | 一种基于多场耦合分析的脉冲星探测器多目标优化方法 |
Non-Patent Citations (7)
Title |
---|
刘占超等: "基于双捷联算法的POS误差在线标定方法", 《航空学报》 * |
周大旺: "主/子惯导标定中挠曲变形误差综合补偿方法", 《控制与决策》 * |
宫晓琳等: "一种机载遥感成像用分布式POS传递对准方法", 《北京航空航天大学学报》 * |
宫晓琳等: "固定区间平滑算法及其在组合导航系统中的应用", 《中国惯性技术学报》 * |
宫晓琳等: "机载对地观测飞行轨迹设计与对比分析", 《北京航空航天大学学报》 * |
程建华等: "舰船捷联惯导传递对准的改进自适应滤波算法", 《系统工程与电子技术》 * |
管叙军等: "捷联惯导系统动基座传递对准匹配方法", 《航空兵器》 * |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109724624A (zh) * | 2018-12-29 | 2019-05-07 | 湖北航天技术研究院总体设计所 | 一种适用于机翼挠曲变形的机载自适应传递对准算法 |
CN110501024A (zh) * | 2019-04-11 | 2019-11-26 | 同济大学 | 一种车载ins/激光雷达组合导航系统的量测误差补偿方法 |
CN113188565A (zh) * | 2021-03-23 | 2021-07-30 | 北京航空航天大学 | 一种机载分布式pos传递对准量测异常处理方法 |
CN113188565B (zh) * | 2021-03-23 | 2023-09-29 | 北京航空航天大学 | 一种机载分布式pos传递对准量测异常处理方法 |
Also Published As
Publication number | Publication date |
---|---|
CN107764268B (zh) | 2020-03-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110501024B (zh) | 一种车载ins/激光雷达组合导航系统的量测误差补偿方法 | |
CN108387227B (zh) | 机载分布式pos的多节点信息融合方法及系统 | |
CN103913181B (zh) | 一种基于参数辨识的机载分布式pos传递对准方法 | |
CN106289246B (zh) | 一种基于位置和姿态测量系统的柔性杆臂测量方法 | |
CN104655152B (zh) | 一种基于联邦滤波的机载分布式pos实时传递对准方法 | |
CN108413887B (zh) | 光纤光栅辅助分布式pos的机翼形变测量方法、装置和平台 | |
CN101949703B (zh) | 一种捷联惯性/卫星组合导航滤波方法 | |
CN107728182B (zh) | 基于相机辅助的柔性多基线测量方法和装置 | |
CN100476360C (zh) | 一种基于星敏感器标定的深综合组合导航方法 | |
CN108375383B (zh) | 多相机辅助的机载分布式pos柔性基线测量方法和装置 | |
CN102621565A (zh) | 一种机载分布式pos的传递对准方法 | |
CN102538792A (zh) | 一种位置姿态系统的滤波方法 | |
CN103217159A (zh) | 一种sins/gps/偏振光组合导航系统建模及动基座初始对准方法 | |
CN104698486A (zh) | 一种分布式pos用数据处理计算机系统实时导航方法 | |
Xue et al. | In-motion alignment algorithm for vehicle carried SINS based on odometer aiding | |
CN102116628A (zh) | 一种着陆或附着深空天体探测器的高精度导航方法 | |
CN101603833A (zh) | 稳瞄吊舱的比力差积分匹配传递对准及其组合导航方法 | |
CN108303120B (zh) | 一种机载分布式pos的实时传递对准的方法及装置 | |
CN112146655A (zh) | 一种BeiDou/SINS紧组合导航系统弹性模型设计方法 | |
CN107764268B (zh) | 一种机载分布式pos传递对准的方法和装置 | |
CN109489661B (zh) | 一种卫星初始入轨时陀螺组合常值漂移估计方法 | |
CN103884340A (zh) | 一种深空探测定点软着陆过程的信息融合导航方法 | |
CN116222551A (zh) | 一种融合多种数据的水下导航方法及装置 | |
CN114964222A (zh) | 一种车载imu姿态初始化方法、安装角估计方法及装置 | |
CN110296719A (zh) | 一种在轨标定方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20200324 |