CN203364836U - 一种系留飞艇姿态测量装置 - Google Patents
一种系留飞艇姿态测量装置 Download PDFInfo
- Publication number
- CN203364836U CN203364836U CN2013204929107U CN201320492910U CN203364836U CN 203364836 U CN203364836 U CN 203364836U CN 2013204929107 U CN2013204929107 U CN 2013204929107U CN 201320492910 U CN201320492910 U CN 201320492910U CN 203364836 U CN203364836 U CN 203364836U
- Authority
- CN
- China
- Prior art keywords
- airship
- inertial navigation
- delta
- fpga
- sin
- 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.)
- Expired - Lifetime
Links
- 238000005259 measurement Methods 0.000 title claims abstract description 19
- 238000012545 processing Methods 0.000 claims abstract description 18
- 230000001133 acceleration Effects 0.000 claims description 20
- 238000006243 chemical reaction Methods 0.000 claims description 4
- 230000001360 synchronised effect Effects 0.000 claims description 2
- 239000011159 matrix material Substances 0.000 description 22
- 238000001914 filtration Methods 0.000 description 6
- 238000000034 method Methods 0.000 description 6
- 238000012937 correction Methods 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 3
- 239000010453 quartz Substances 0.000 description 3
- VYPSYNLAJGMNEJ-UHFFFAOYSA-N silicon dioxide Inorganic materials O=[Si]=O VYPSYNLAJGMNEJ-UHFFFAOYSA-N 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
- 238000005096 rolling process Methods 0.000 description 2
- 230000007704 transition Effects 0.000 description 2
- 230000000007 visual effect Effects 0.000 description 2
- NCGICGYLBXGBGN-UHFFFAOYSA-N 3-morpholin-4-yl-1-oxa-3-azonia-2-azanidacyclopent-3-en-5-imine;hydrochloride Chemical compound Cl.[N-]1OC(=N)C=[N+]1N1CCOCC1 NCGICGYLBXGBGN-UHFFFAOYSA-N 0.000 description 1
- 230000003321 amplification Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 150000001875 compounds Chemical class 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 230000004927 fusion Effects 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 238000000691 measurement method Methods 0.000 description 1
- 238000003199 nucleic acid amplification method Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- 238000007493 shaping process Methods 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
Images
Landscapes
- Navigation (AREA)
Abstract
本实用新型公开了一种系留飞艇姿态测量装置,包括激光陀螺捷联惯导、导航处理模块、GPS定位定向模块,所述导航处理模块包括FPGA、DSP,所述FPGA与所述DSP双向连接,所述FPGA与所述激光陀螺捷联惯导、GPS定位定向模块、系留飞艇控制系统连接。本实用新型的测量装置结构简单,精度高、功耗低、环境适用性好、可靠性高。
Description
技术领域
本实用新型涉及组合导航与制导、姿态测量与控制领域,特别是一种系留飞艇姿态测量装置。
背景技术
系留艇升空后长期漂浮在空中进行工作,需要实时获得系留艇的高精度姿态信息,用于对系留艇进行姿态控制。为此需要研制姿态测量装置用于对系留艇的姿态等信息进行高精度的测量。
目前通常在系留艇上使用捷联惯性导航系统或多天线GPS测姿系统两种方式进行。捷联惯导不依赖任何外界信息,能测量出载体的真北航向、俯仰和滚动,但在初始对准期间要求载体相对静止,在一定时间内测量精度高,随着时间的推移精度会逐渐下降。多天线GPS测姿系统精度高,但完全依赖于GPS信息,易受干扰,GPS信息中断则测量中断。
实用新型内容
本实用新型所要解决的技术问题是,针对现有技术不足,提供一种系留飞艇姿态测量装置及测量方法,解决系留艇在空中长时间工作的姿态测量问题,提高测量精度。
为解决上述技术问题,本实用新型所采用的技术方案是:一种系留飞艇姿态测量装置,包括安装在系留飞艇桁架上的激光陀螺捷联惯导,还包括导航处理模块、GPS定位定向模块,所述导航处理模块包括FPGA、DSP,所述FPGA与所述DSP双向连接,所述FPGA与所述激光陀螺捷联惯导、GPS定位定向模块、系留飞艇控制系统连接。
作为优选方案,所述FPGA通过数字隔离器与所述GPS定位定向模块连接,所述激光陀螺捷联惯导的输出的三路加速度信号和三路角速度信号依次通过光耦接收隔离器、电平转换电路输入FPGA,所述FPGA通过RS422差分驱动器将同步采集脉冲送入所述激光陀螺捷联惯导,所述FPGA通过RS422接口与所述系留飞艇控制系统连接。
作为优选方案,所述GPS定位定向模块采用OEM模块。
系留飞艇姿态测量方法为:
其中,θ、γ、ψ分别为系留飞艇俯仰角、横滚角和方位角;
即: ;
3)由步骤2)确定ψ、θ、γ,完成系留飞艇姿态的初始对准:
4)利用激光陀螺捷联惯导测量的角速度和加速度,计算得到系留飞艇在东北天地理坐标系上的速度ve_ins、vn_ins、vu_ins、方位角ψu_ins和系留飞艇所在位置的经度λ、纬度L、高度h,其中ψu_ins=ψ;
5)建立激光陀螺捷联惯导速度误差模型:
其中,fe、fn、fu分别为加表在东向、北向、天向测量的比力;δve、δvn、δvu分别为惯导系统东向、北向、天向速度误差, 分别为δve、δvn、δvu的微分,φe、φn、φu分别为系留飞艇俯仰、横滚、方位角误差,ωie为地球自转角速度,分别为东向加速度计、北向加速度计、天向加速度计的零偏;
6)建立激光陀螺捷联惯导姿态误差模型:
其中, 分别为φe、φn、φu的微分,Rxp为地球纬度圈半径,Ryp为地球经度圈半径,ωie为地球自转角速度,δλ、δL、δh分别为激光陀螺捷联惯导计算的系留飞艇位置的经度误差、纬度误差、高度误差;εe、εn、εu分别为东向陀螺、北向陀螺、天向陀螺的零漂;
7)建立激光陀螺捷联惯导位置误差模型:
8)建立激光陀螺捷联惯导三个加速度计的零偏误差模型:
9)建立激光陀螺捷联惯导三个陀螺的零偏误差模型:
10)令 其中ve_gps、vn_gps、vu_gps、ψu_gps分别为GPS定位定向模块测量的系留飞艇在东北天地理坐标系上的速度和方位角,δVe、δVn、δVu、δψ分别为捷联惯导与GPS定位定向模块测量的系留飞艇的东向速度、北向速度、天向速度和方位角的差值,将Z作为kalman滤波器的输入;
11)根据步骤5)~10),得到kalman滤波模型维:
由kalman滤波模型维解算出X,从而对激光陀螺捷联惯导的各项导航误差进行实时估计;其中A为15×15维状态转移矩阵;H为4×15维观测矩阵;G为15×6维噪声输入矩阵;W为6维噪声向量,由陀螺和加速度计噪声构成;V为4维观测噪声,
12)对系留飞艇在东北天地理坐标系上的速度ve_ins、vn_ins、vu_ins、方位角ψu_ins进行反馈校正,克服姿态角误差发散;
13)导航处理模块将当前时刻系留飞艇的位置、速度、姿态信息发送至系留飞艇控制系统,并返回5)。
其中,A可以表示为:
其中,ψ、θ、γ分别为惯导测量的飞艇方位角、俯仰角、滚动角。
(15)
其中,MvE,MvN,MvU分别为GPS定位定向模块速度测量白噪声,MφU为GPS定位定向模块方位测量白噪声。
03×3定义为3×3维的零矩阵,I3×3定义为3×3维的单位矩阵,依次类推,以06×9和I3×3为例:
用滤波得到的误差估计量来校正导航方程的位置、速度、姿态以及惯性元件误差。捷联惯导的位置、速度、姿态角等信号都是数字量,可以直接从惯导输出中减去相应的滤波值。
与现有技术相比,本实用新型所具有的有益效果为:本实用新型的装置结合了捷联惯导与GPS定位定向模块,结构简单,精度高、功耗低、环境适用性好、可靠性高;本实用新型的方法采用捷联惯导/GPS组合导航技术来克服惯导系统误差的发散,保证系留飞艇长时间保持导航精度;采用Kalman滤波技术进行捷联惯导/GPS的信息融合技术研究,考虑到GPS定位定向设备能实时输出准确的速度和方位信息,选择捷联惯导的速度、方位和GPS的速度、方位之差作为kalman滤波器的观测量,对激光陀螺捷联惯导的各项导航误差进行实时估计和反馈校正,有效提高了系留飞艇姿态测量精度。
附图说明
图1为本实用新型一实施例系留飞艇姿态测量装置结构示意图;
图2为本实用新型一实施例导航处理模块结构框图;
图3为导航处理模块计算系留飞艇的位置、速度、姿态信息原理图。
具体实施方式
如图1和图2所示,本实用新型一实施例系留飞艇姿态测量装置包括激光陀螺捷联惯导、导航处理模块、GPS定位定向模块,所述导航处理模块包括FPGA、DSP,所述FPGA与所述DSP双向连接,所述FPGA与所述激光陀螺捷联惯导、GPS定位定向模块、系留飞艇控制系统连接。
激光陀螺捷联惯导为现有的成熟产品,其核心器件为三只石英挠性加速度计和三只50型二频机抖激光陀螺。陀螺和加速度计正交安装在基座上,用于测量运载器沿载体坐标系的三路角速度和三路加速度信息,经惯导DSP电路误差补偿后传输给导航处理模块。
角速率信息的测量是通过在惯组台体上安装三个敏感轴相互正交的50型激光陀螺仪,利用Sagnac原理将绕弹体三个轴转动的角速度信息转换成光电流信号,其信号频率与角速度信息成正比,该光电流信号经过电流-电压转换、宽带低噪高增益放大、过零比较、脉冲整形后,变成TTL电平的脉冲信号,供给DSP系统鉴相计数器计数。
加速度信息的测量是通过三个敏感轴相互正交的石英挠性加速度计来实现的,石英挠性加速度计将弹体三个轴的视加速度信息转换成电流信号,其电流信号与视加速度信息成正比,该电流信号经过I/F转换电路和数字信号处理板(DSP)测量,还原加速度信息。DSP系统以2KHz的采样速率对激光陀螺输出的鉴相脉冲采集,并通过数字低通滤波器消除信号中的抖动分量,还原角速度信息;再将角速度和加速度信息进行数字处理、对称性补偿、非线性补偿和系统误差补偿后,传送导航处理模块。
GPS定位定向模块主要用于测量两个GPS接收天线之间的方位信息,测量点的速度、位置信息等。GPS接收天线分别测量其收到的同一组GPS卫星GPS载波信号的瞬时相位,并比较其相位差同步观测,以求解出基线(即两个GPS天线之间的连线)端点的相对位置或基线向量。
导航处理模块完成数据采集和导航解算任务,主要包括:
a)FPGA主要完成各种信息的交互,时序控制等;
b)通过RS422实时采集激光捷联惯导的加速度和角速度信息,同步采集GPS定位定向模块的方位和速度信息,并进行组合导航解算;
c)DSP板通过2路RS422接口与控制系统设备通讯。
本实用新型姿态测量方法如下:
(1)在姿态测量装置系统开机后的前6min,组合导航处理盒根据捷联惯导输出的3路加速度信息以及当地重力加速度,计算出载体的俯仰角和滚转角信息,并通过GPS定位定向设备对天线基线的方位角信息进行测量,于是得到飞艇的初始方位角ψ、俯仰角θ、滚动角γ,实现飞艇姿态的初始对准。
载体的初始俯仰角θ和滚转角γ的计算方法为:
首先要选用当地东北天地理坐标系(ENU)为参考坐标系n。而载体坐标系定义为b,载体(即系留飞艇)的捷联惯导上安装有三个激光陀螺和三个加表,由于捷联惯导是固联在载体上的,所以激光陀螺和加速度计测量得到的角速度和加速度都是在载体坐标系下的投影。
因此,我们可以得出捷联姿态矩阵为:
由上式可以看出,姿态矩阵T是ψ、θ、γ的函数,根据T的元素即可单值地确定ψ、θ、γ,即确定了载体的姿态角。
从上式可知:
式中t32、t31、t33、t12、t22等分别为姿态矩阵T的相应的元素。
初始对准时,载体的俯仰角θ和滚动角γ取捷联惯导输出信息计算值,但方位角ψ不取以捷联惯导输出信息计算的方位角,而是取GPS定位定向设备所测量的方位角。
完成初始对准以后,导航处理模块根据捷联惯导输出的3路角速度信息和3路加速度信息对系留飞艇的位置、速度、姿态信息进行实时的计算,得到系留飞艇在东北天地理坐标系上的速度ve_ins、vn_ins、vu_ins和系留飞艇所在位置的经度λ、纬度L、高度h,具体实现过程见图3,其中,fb为捷联惯导输出的3路加速度信息,ωb为捷联惯导输出的3路角速度信息;Vx、Vy、Vz为以捷联惯导输出信息计算的飞艇的3个方向的速度分量,λ、L、h分别为以捷联惯导输出信息计算的飞艇所在位置的经度、纬度、高度;ψ、θ、γ分别为以捷联惯导输出信息计算的飞艇姿态的方位角、俯仰角、滚动角。Q为四元数,T为姿态矩阵,C为位置矩阵,g为地球重力加速度,ωie为地球自转角速度。
为了提高卡尔曼滤波的精度,取SINS输出的导航参数的误差作为组合导航的状态量,因此SINS的误差方程就是组合导航系统状态方程的主要组成部分。在本实用新型中,采用东北天坐标系(ENU),以方位/速度组合模式进行组合,并采用反馈校正的方式对惯导系统进行校正。
捷联惯导速度误差模型:
捷联惯导姿态误差模型:
捷联惯导位置误差模型:
捷联惯导加表零偏误差模型:
捷联惯导陀螺零漂误差模型:
其中:δve、δvn、δvu分别为惯导系统东向、北向、天向速度误差, 分别为其微分;φe、φn、φu为俯仰、横滚、方位角误差, 分别为其微分; 为东向加表(即加速度计)、北向加表、天向加表的零偏, 分别为其微分;τai(i=x,y,z)为加表零偏相关时间;εe、εn、εu分别为东向陀螺、北向陀螺、天向陀螺的零漂,分别为其微分;τgi(i=x,y,z)为陀螺零漂相关时间;wε分别为加速度计和陀螺的马尔可夫噪声项;ωie为地球自转角速度;Rxp为地球纬度圈半径,Ryp为地球经度圈半径。
根据式(5)~(10)得到组合导航系统kalman滤波模型维:
其中,A为15×15维状态转移矩阵;H为4×15维观测矩阵;G为15×6维噪声输入矩阵;W为6维噪声向量,由陀螺和加速度噪声构成;V为4维观测噪声,ve_ins、vn_ins、vu_ins、ψu_ins分别为捷联惯导测量的载体的速度和方位,ve_gps、vn_gps、vu_gps、ψu_gps分别为GPS测量的载体的速度和方位。
解算出误差项X,即得到速度误差δve、δvn、δvu,姿态误差φe、φn、φu,将速度误差和姿态误差叠加到系留飞艇的速度、俯仰角、横滚角和方位角上,然后以校正后的速度、俯仰角、横滚角和方位角为参考,不断地进行误差校正,直至误差最小。
Claims (3)
1.一种系留飞艇姿态测量装置,包括安装在系留飞艇桁架上的激光陀螺捷联惯导,其特征在于,还包括导航处理模块、GPS定位定向模块,所述导航处理模块包括FPGA、DSP,所述FPGA与所述DSP双向连接,所述FPGA与所述激光陀螺捷联惯导、GPS定位定向模块、系留飞艇控制系统连接。
2.根据权利要求1所述的系留飞艇姿态测量装置,其特征在于,所述FPGA通过数字隔离器与所述GPS定位定向模块连接,所述激光陀螺捷联惯导的输出的三路加速度信号和三路角速度信号依次通过光耦接收隔离器、电平转换电路输入所述FPGA,所述FPGA通过RS422差分驱动器将同步采集脉冲送入所述激光陀螺捷联惯导,所述FPGA通过RS422接口与所述系留飞艇控制系统连接。
3.根据权利要求1所述的系留飞艇姿态测量装置,其特征在于,所述GPS定位定向模块采用OEM模块。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2013204929107U CN203364836U (zh) | 2013-08-13 | 2013-08-13 | 一种系留飞艇姿态测量装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2013204929107U CN203364836U (zh) | 2013-08-13 | 2013-08-13 | 一种系留飞艇姿态测量装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN203364836U true CN203364836U (zh) | 2013-12-25 |
Family
ID=49812584
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2013204929107U Expired - Lifetime CN203364836U (zh) | 2013-08-13 | 2013-08-13 | 一种系留飞艇姿态测量装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN203364836U (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103389092A (zh) * | 2013-08-13 | 2013-11-13 | 湖南航天机电设备与特种材料研究所 | 一种系留飞艇姿态测量装置及测量方法 |
CN105627982A (zh) * | 2014-11-05 | 2016-06-01 | 北京航天计量测试技术研究所 | 一种远程运载器倾斜瞄准方法 |
-
2013
- 2013-08-13 CN CN2013204929107U patent/CN203364836U/zh not_active Expired - Lifetime
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103389092A (zh) * | 2013-08-13 | 2013-11-13 | 湖南航天机电设备与特种材料研究所 | 一种系留飞艇姿态测量装置及测量方法 |
CN103389092B (zh) * | 2013-08-13 | 2016-03-02 | 湖南航天机电设备与特种材料研究所 | 一种系留飞艇姿态测量装置及测量方法 |
CN105627982A (zh) * | 2014-11-05 | 2016-06-01 | 北京航天计量测试技术研究所 | 一种远程运载器倾斜瞄准方法 |
CN105627982B (zh) * | 2014-11-05 | 2019-02-26 | 北京航天计量测试技术研究所 | 一种远程运载器倾斜瞄准方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103389092B (zh) | 一种系留飞艇姿态测量装置及测量方法 | |
CN103090870B (zh) | 一种基于mems传感器的航天器姿态测量方法 | |
CN107270893B (zh) | 面向不动产测量的杆臂、时间不同步误差估计与补偿方法 | |
CN102176041B (zh) | 一种基于gnss/sins组合的车辆导航监控系统 | |
CN100356139C (zh) | 用于微小卫星的微型组合姿态测量系统 | |
CN103900611B (zh) | 一种惯导天文高精度复合两位置对准及误差标定方法 | |
CN108594283B (zh) | Gnss/mems惯性组合导航系统的自由安装方法 | |
CN101881619B (zh) | 基于姿态测量的船用捷联惯导与天文定位方法 | |
CN102393201B (zh) | 航空遥感用位置和姿态测量系统(pos)动态杆臂补偿方法 | |
CN101109959A (zh) | 一种适用于任意运动微小型系统的定姿系统 | |
CN105928515B (zh) | 一种无人机导航系统 | |
CN103900565A (zh) | 一种基于差分gps的惯导系统姿态获取方法 | |
CN103471616A (zh) | 一种动基座sins大方位失准角条件下初始对准方法 | |
CN102853837B (zh) | 一种mimu和gnss信息融合的方法 | |
CN103217174B (zh) | 一种基于低精度微机电系统的捷联惯导系统初始对准方法 | |
CN104698485A (zh) | 基于bd、gps及mems的组合导航系统及导航方法 | |
CN106405592B (zh) | 车载北斗载波相位周跳检测与修复方法及系统 | |
CN105091907A (zh) | Sins/dvl组合中dvl方位安装误差估计方法 | |
CN102707080B (zh) | 一种星敏感器模拟捷联惯导陀螺的方法 | |
CN103278165A (zh) | 基于剩磁标定的磁测及星光备份的自主导航方法 | |
CN105910623B (zh) | 利用磁强计辅助gnss/mins紧组合系统进行航向校正的方法 | |
CN107677292A (zh) | 基于重力场模型的垂线偏差补偿方法 | |
CN108151765B (zh) | 一种在线实时估计补偿磁强计误差的定位测姿方法 | |
CN103575297B (zh) | 基于卫星导航接收机的gnss和mimu组合导航航向角估计方法 | |
CN105928519B (zh) | 基于ins惯性导航与gps导航以及磁力计的导航算法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CX01 | Expiry of patent term |
Granted publication date: 20131225 |
|
CX01 | Expiry of patent term |