CN101413800B - 导航/稳瞄一体化系统的导航、稳瞄方法 - Google Patents
导航/稳瞄一体化系统的导航、稳瞄方法 Download PDFInfo
- Publication number
- CN101413800B CN101413800B CN2008100192932A CN200810019293A CN101413800B CN 101413800 B CN101413800 B CN 101413800B CN 2008100192932 A CN2008100192932 A CN 2008100192932A CN 200810019293 A CN200810019293 A CN 200810019293A CN 101413800 B CN101413800 B CN 101413800B
- Authority
- CN
- China
- Prior art keywords
- error
- sin
- delta
- cos
- platform
- 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 - Fee Related
Links
- 238000000034 method Methods 0.000 title claims abstract description 62
- 239000011159 matrix material Substances 0.000 claims description 63
- 230000007704 transition Effects 0.000 claims description 45
- 230000008569 process Effects 0.000 claims description 26
- 238000005259 measurement Methods 0.000 claims description 25
- 238000004364 calculation method Methods 0.000 claims description 12
- 238000004458 analytical method Methods 0.000 claims description 11
- 238000001914 filtration Methods 0.000 claims description 11
- 239000013598 vector Substances 0.000 claims description 11
- 230000009897 systematic effect Effects 0.000 claims description 8
- 239000013307 optical fiber Substances 0.000 claims description 7
- 230000001133 acceleration Effects 0.000 claims description 6
- 238000005070 sampling Methods 0.000 claims description 6
- 230000010354 integration Effects 0.000 claims description 5
- 230000036528 appetite Effects 0.000 claims description 3
- 235000019789 appetite Nutrition 0.000 claims description 3
- 230000001915 proofreading effect Effects 0.000 claims description 3
- 238000012937 correction Methods 0.000 claims description 2
- 239000000969 carrier Substances 0.000 abstract 1
- 230000007547 defect Effects 0.000 abstract 1
- 230000035899 viability Effects 0.000 abstract 1
- 230000005622 photoelectricity Effects 0.000 description 7
- 230000006870 function Effects 0.000 description 5
- 230000007246 mechanism Effects 0.000 description 5
- 238000006243 chemical reaction Methods 0.000 description 4
- 230000000694 effects Effects 0.000 description 4
- 230000006641 stabilisation Effects 0.000 description 4
- 238000011105 stabilization Methods 0.000 description 4
- 238000009825 accumulation Methods 0.000 description 3
- 238000009434 installation Methods 0.000 description 3
- NJPPVKZQTLUDBO-UHFFFAOYSA-N novaluron Chemical compound C1=C(Cl)C(OC(F)(F)C(OC(F)(F)F)F)=CC=C1NC(=O)NC(=O)C1=C(F)C=CC=C1F NJPPVKZQTLUDBO-UHFFFAOYSA-N 0.000 description 3
- 238000012545 processing Methods 0.000 description 3
- 230000009466 transformation Effects 0.000 description 3
- 230000008901 benefit Effects 0.000 description 2
- 230000008859 change Effects 0.000 description 2
- 230000001419 dependent effect Effects 0.000 description 2
- 238000013178 mathematical model Methods 0.000 description 2
- 241001269238 Data Species 0.000 description 1
- 230000015572 biosynthetic process Effects 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- DMBHHRLKUKUOEG-UHFFFAOYSA-N diphenylamine Chemical compound C=1C=CC=CC=1NC1=CC=CC=C1 DMBHHRLKUKUOEG-UHFFFAOYSA-N 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000002708 enhancing effect Effects 0.000 description 1
- 239000013604 expression vector Substances 0.000 description 1
- 239000000835 fiber Substances 0.000 description 1
- 238000010304 firing Methods 0.000 description 1
- 230000004927 fusion Effects 0.000 description 1
- 238000003384 imaging method Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000003331 infrared imaging Methods 0.000 description 1
- 230000008447 perception Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000000087 stabilizing effect Effects 0.000 description 1
- 238000003786 synthesis reaction Methods 0.000 description 1
Images
Landscapes
- Navigation (AREA)
Abstract
一种导航/稳瞄一体化系统的导航、稳瞄方法,属惯性导航领域。该导航方法是利用安装在光电稳瞄平台上的惯性测量单元实现载体定姿、定位。具体步骤是:采集惯性测量单元的信号;稳瞄平台下的快速精确初始对准;基于车载稳瞄平台的惯性导航算法;车辆航姿信息解算及误差分析;惯导系统与惯性器件的误差分析、建模与补偿;惯导/里程仪/GPS多信息容错组合导航。本导航方法改进了已有技术中稳瞄和导航系统不能同时工作,以及一体化系统无法提供全面导航信息的不足,能为载体(战车)提供实时、精确、完整的导航姿态信息和导航定位信息,能提高战车的战场生存能力和综合作战能力。
Description
技术领域
本发明是一种应用于战车导航/稳瞄一体化系统的导航定位、定姿方法,属于惯性导航领域。
背景技术
瞄准线稳定系统和惯性导航系统是近年来广泛应用于坦克等地面战车的两种高精度惯性系统。瞄准线稳定系统主要组成部分为光电稳瞄平台,通过它稳定瞄准线,为战车在行进中提供精确的射击或制导基准,增强了战车的机动性;惯导系统能适时提供载体姿态、速度以及所在位置,引导坦克隐蔽进入战场与打击目标,其自主性是其他定位定向系统无法比拟的。
瞄准线稳定系统主要组成部分为光电稳瞄平台,光电稳瞄平台的功能是捕获、跟踪、瞄准战车所处地域内的目标,如车辆、房屋等。平台主要由光电探测器、跟踪伺服平台、电子设备和惯性元件组成。其中光电探测器一般包括红外成像、激光测距、电视成像系统;跟踪伺服平台是多轴多环架伺服系统,光电探测器安装在平台的内环;惯性元件由陀螺仪、加速度计等组成,用来在车载环境下建立惯性基准。
车载惯性导航系统(Strapdown Inertial Navigation System)是一种基于牛顿运动定律以推算的方式实现导航功能的系统,其核心传感器是由陀螺仪(角运动传感器)和加速度计(线运动传感器)等两类惯性传感器构成的测量单元,由上述两类传感器构成的测量单元直接固联在战车稳瞄平台上。惯性导航系统中的处理器通过模拟/数字转换电路或者直接采用数字接口,读取上述测量单元内角运动和线运动传感器的数据,按惯性导航算法的原理流程,对原始的测量数据进行加工,解算出运动载体的姿态、速度和位置等参数。
针对未来作战环境战车装备的潜在要求,有展开信息感知和火控稳瞄综合运用的强烈需求,但由于涉及到惯性器件、精密光机结构、高精度伺服和复杂的解析算法,在我国现有装备的系统中,稳瞄、导航这两套系统只能分时使用,即稳瞄和导航不能同时工作,且精度不高。国内有稳瞄/寻北一体化系统的相关技术研究,但该系统只能解算车体航向,无法提供全方位的姿态信息以及速度、位置信息,即无法进行完整的导航工作。
惯性导航系统一般在静基座下进行系统初始化,初始化过程中姿态对准特别是航向失准角的精度与对准速度难以满足要求;车载稳瞄平台上的惯性导航系统算法,在光电稳瞄平台进行瞄准线稳定的过程中,解算机理类似于平台惯导系统,而在稳瞄平台进行目标跟踪与人工调转过程中,惯性传感器构成的测量单元跟随稳瞄平台一起转动,此过程中惯性导航系统解算机理类似于捷联惯导,目前常规的平台惯导与捷联惯导解算机理均不适用于车载稳瞄平台上的惯性导航系统,惯导系统与惯性器件的误差分析、建模、补偿方式也需要进一步改进。
发明内容
本发明的主要目的是,改进已有方案中稳瞄和导航系统不能同时工作,以及一体化系统无法提供全面导航信息的不足,在随机旋转的光电稳瞄平台上,安装光纤捷联惯性测量单元,通过提取惯性测量单元的输出信息,结合车载测角机构与导航计算机,探索适用于导航/稳瞄一体化系统的惯导解算方法的新途径,为载体提供实时、精确、完整的导航定位信息。
本发明的内容是导航/稳瞄一体化系统通过光电稳瞄平台上安装完整的惯性测量单元实现载体定姿、定位的方法,其特点通过以下步骤实现:
(1)惯性测量单元信号采集步骤:采集惯性测量单元中光纤陀螺与MEMS加速度计的输出信号,得到惯导系统的角速度和比力;
(2)稳瞄平台下的快速精确初始对准步骤:利用稳瞄平台具有的随机调转特性,设计了一种快速而精确的转动基座初始对准方法,即在稳瞄平台绕其航向轴连续转动的条件下,建立系统状态方程 误差状态量X=[δVN δVE φN φE φD x y εx εy εz],其中δVN、δVE为水平速度误差沿北、东方向的分量,φN、φE、φD为平台误差角在北、东、地方向的分量; x、 y为加速度计的零偏;εx、εy、εz为陀螺漂移状态转移矩阵,状态转移矩阵 其中 ΩD,ΩN为地球自转角速度在地向与北向的分量,c11′=cosγcosφ+sinγsinθsinφ、c12′=cosθsinφ、c13′-sinγcosφ-cosγsinθsinφ、c21′=-cosγsinφ+sinγsinθcosφ、c22′=cosθcosφ、c23′=-sinγsinφ-cosγsinθcosφ、c31′=-sinγcosθ、c32′=sinθ、c33′=cosγcosθ分别为Cb n中的各元素,γ为平台横滚角、θ为平台俯仰角、φ为平台航向角,Cb n为平台姿态转移矩阵Cn b的转置矩阵,Cn b由横滚角γ、俯仰角θ、航向角φ的三角函数构成, 即 g为当地重力加速度,W=[w1 w2 w3 w4 w5],式中w1、w2为等效北向、东向的加速度计白噪声分量,w3、w4、w5为等效北向、东向、地向的陀螺仪白噪声分量,再建立系统观测方程 式中δVN、δVE分别为水平速度误差沿北、东方向的分量,X定义同上,V为观测噪声矢量,通过增加东向与北向加速度计输出fN、fE作为观测量,扩展观测方程为 式中 X定义同上,V′为观测量扩展后的观测噪声矢量,c11′、c12、c21′、c22′定义同上,运用卡尔曼滤波器,快速估计惯导系统的初始平台误差角φN、φE、φD并反馈给导航系统进行补偿,得到惯导系统精确的初始横滚角、俯仰角、航向角信息;
(3)基于车载稳瞄平台的惯性导航解算步骤:该步骤由高精度姿态解算与速度、位置解算组成,惯导系统姿态解算首先利用公式 计算机体相对导航坐标系角速度ωnb b,式中ωib b为稳瞄平台上陀螺仪的直接输出,ωin b可通过车体速度在导航下投影、地球自转角速度ωie以及上个周期的姿态转移矩阵Cn b求得,然后采用四元数微分方程 求解姿态转移矩阵Cn b对应的的四元数,式中 l为四元数计算的时间间隔, ω1、ω2、ω3分别为在一次姿态解算周期内对陀螺仪输出进行3次采样的角速度,即采用3子样采样方法补偿陀螺非定轴转动时,角速度矢量积分产生的计算误差。姿态更新周期h=0.02s, 将得到的四元数利用公式 i=0,1,2,3进行规范化,式中 为直接由四元数微分方程计算得到的四元数,而设规范化后的四元数为 其中为相互正交的单位食量,然后将规范化后的四元数通过公式 生成姿态转移矩阵Cn b,Cn b定义同上,最后利用公式 从Cn b中提取横滚角γ、俯仰角θ、航向角φ信息,其中c′11、c′12、c′13、c′21、c′22、c′23、c′31、c′32、c′33分别为姿态转移矩阵Cn b的各元素,定义同上。惯导系统(即车辆)速度、位置解算方法则将加速度计输出通过平台Cn b的转置矩阵Cb n从载体坐标系转换到导航坐标系,并通过解算比力微分方程 得到导航系统速度vep,再将导航系统速度vep经过一次积分得到导航系统位置,式中f为加速度计输出,ωie为地球自转角速度,ωep为稳瞄平台相对于地球的角速度;
(4)车辆航姿信息解算及误差分析步骤:借助稳定平台的测角元件和炮塔转角测量元件,测量出平台相对于炮塔姿态转移矩阵CB b, ΨP,θP,γP为稳瞄平台相对于炮塔的三个转角;炮塔相对于车辆的姿态转移矩阵CV B, ΨVB为炮塔相对于车体的航向角;同时稳定平台上的惯导系统输出上述平台的姿态转移矩阵Cn b,利用上述平台相对于炮塔姿态转移矩阵CB b、炮塔相对于车辆的姿态转移矩阵CV B、平台的姿态转移矩阵Cn b三个矩阵信息可以解算出车辆的横滚角、俯仰角、航向角信息,并对姿态误差进行分析与修正;
(5)惯导系统和惯性器件的误差分析、建模和补偿步骤:惯导系统的误差分为数学平台误差、速度误差和位置误差,数学平台误差模型为 ,式中φn、φe和φd分别为北向、东向、地向的平台误差角;ve、vn分别为东向与北向速度;ωie为地球自转角速度,L为当地纬度,δL为纬度误差,RM为地球子午圈半径,RN为地球卯酉圈半径,h为当地海拔高度,εn n、εe n、εd n分别为北向、东向和地向陀螺仪噪声,速度误差模型为 ,式中δVn、δVe、δVd为北向、东向、地向的速度误差,fn、fe、fd分别为北向、东向、地向的加速度计输出,δh为海拔高度误差; n、 e、 d分别为北向、东向、天向加速度计误差,其余变量定义同上,
位置误差方程为 式中
δλ为经度误差,其他变量定义同上,惯性器件误差则是一类强非线性误差,陀螺漂移误差考虑主要由三部分组成:εb=ωg+εc+εr,式中ωg为随机白噪声漂移,其均方差为σg,εc为随机常值漂移,εr为随机一阶马尔柯夫过程漂移,设三个轴向的陀螺误差模型相同,均为: 式中Tr为相关时间,ωr是均方差为σr的马尔柯夫过程驱动白噪声,加速度计误差模型 a一般考虑为一阶马尔柯夫过程,且三个轴向的加速度计误差模型相同: 式中Ta是马尔柯夫过程的相关时间,ωa是均方差为σa的驱动白噪声,本发明采用里程仪(或GPS)与惯导之间的速度误差、位置误差作为观测量,以卡尔曼滤波的方式对姿态、速度、位置等系统误差以及陀螺仪漂移、加速度计偏置等惯性器件误差进行零均值最小方差估计,通过闭环反馈修正进行误差补偿;
(6)惯导/里程仪/GPS多信息容错组合导航步骤:该步骤采用两种方案实现,第一种方案采用间断地利用GPS信息对惯导/里程仪组合导航系统进行重调,首先构建一套捷联惯导与里程仪进行速度/位置组合的组合导航系统,实时输出位置与速度信息,在GPS信号可用时,将GPS的位置、速度信息对捷联惯导/里程仪组合导航系统输出进行校正,提高整体导航精度。经过一次校正,间隔一定时间后继续运用上述方法校正系统;第二种方案采用惯导/里程仪/GPS多信息组合联邦滤波结构,该方案将捷联惯导与里程仪进行了位置速度组合滤波解算,同时将捷联惯导与GPS进行了位置、速度组合滤波解算,最后将两个子滤波器的误差状态量估计值经过主滤波器加权平均,求得误差状态量的零均值最小方差估计,并反馈至捷联惯导系统进行闭环校正,提高惯导系统导航定位精度。
说明书附图
图1是导航/稳瞄一体化系统结构原理图。
图2是捷联式惯导系统原理。
图3捷联惯导系统的算法流程。图中γ0、θ0、Ψ0分别为稳瞄平台的初始横滚角、初始俯仰角与初始航向角,Q(Λ0)为初始化四元数,Cb n(0)为初始化姿态转移矩阵的转置矩阵,ωib b为陀螺仪输出,ωin b为导航坐标系相对于惯性坐标系的角速度,Q(Λk)为前一时刻的四元数,Q(Λk+1)为当前时刻的四元数,Cb n为当前时刻姿态转移矩阵的转置矩阵,γ、θ、Ψ分别为当前时刻平台的横滚角、俯仰角以及航向角,fib b为加速度计输出,fib n为加速度计输出在导航坐标系中的投影,L(0)、λ(0)、h(0)、Vt(0)分别为上一时刻载体的纬度、经度、高度与速度,ωin n为当前时刻导航坐标系相对于惯性坐标系的角速度在导航坐标系中的投影,L、λ、h、Vt分别为当前时刻载体的纬度、经度、高度以及速度。
图4 GPS间断对惯导/里程仪组合导航系统重调方式结构图。
图5惯导/里程仪/GPS多信息组合联邦滤波结构图
具体实施方式
传统的车载一体化系统中,或无法提供全方位的姿态信息以及速度、位置信息,或导航系统与稳瞄系统无法同时工作。本发明在传统的一体化系统基础上进行改进,如图1所示,将惯性测量组件(IMU)安装在随机调转的光电稳瞄平台上,IMU由3个正交安装的光纤陀螺与3个正交安装的加速度计组成,稳瞄平台具有3自由度的转动功能,IMU中的陀螺信号输出给平台稳定回路,以实现对稳瞄平台稳定的功能。同时,IMU中的陀螺仪和加速度计的信号输出给惯导解算部分解算出稳瞄平台的姿态、速度和位置信息,并适时与里程仪与GPS进行组合导航。利用平台测角机构测量出平台和车体之间的角位置,并利用惯导输出的稳瞄平台的姿态角信息,进一步解算出车辆的的姿态信息。
为了完成导航/稳瞄一体化系统的精确定位与测姿,需要完成工作:
5.1惯性测量单元信号采集步骤
采集惯性测量单元中光纤陀螺与MEMS加速度计的输出信号,得到惯导系统的角速度和比力。
5.2稳瞄平台下的快速精确初始对准步骤
在稳瞄控制单元的输入口处,设立一个转换开关,当综合体需要初始对准时,该开关拨向导航单元,惯导控制单元根据IMU检测的地球自转和重力加速度变化信息,判断概略稳瞄平台的姿态和航向,以此为依据,向稳瞄控制单元发出旋转指令,后者立即控制伺服电路将平台旋转和调平,实现快速初始粗对准。
瞄平台的水平对准精度较高,初始精确对准的关键是方位对准。由于稳瞄平台可以相对车体在方位上转动,本发明提出了一种采用转动稳瞄准平台的快速初始精对准方法,该方法通过以一定角速度连续转动稳瞄平台的方位轴,以使整个初始精对准在航向角不断改变的过程中完成,从而在提高精度的同时又提高了对准的速度。这种方法的理论分析如下所示。
采用北-东-地地理坐标系为导航坐标系,惯导系统初始对准误差模型的状态方程为:
δVN、δVE为水平速度误差沿北、东方向的分量;φN、φE、φD为平台误差角在北、东、地方向的分量; x、 y为加速度计的零偏;εx、εy、εz为陀螺漂移;ΩD,ΩN为地球自转角速度在地向与北向的分量c′11、c′12、c′13、c′21、c′22、c′23、c′31、c′32、c′33为姿态转移矩阵的转置矩阵Cb n的各元素,c11′=cosγcosφ+sinγsinθsinφ、c12′=cosθsinφ、c13′-sinγcosφ-cosγsinθsinφ、c21′=-cosγsinφ+sinγsinθcosφ、c22′=cosθcosφ、c23′=-sinγsinφ-cosγsinθcosφ、c31′=-sinγcosθ、c32′=sinθ、c33′=cosγcosθ,γ为平台的横滚角,θ为平台的俯仰角,φ为平台航向角,姿态转移矩阵 g为当地重力加速度,W=[w1 w2 w3 w4 w5],w1、w2为等效北向、东向的加速度计白噪声分量,w3、w4、w5为等效北向、东向、地向的陀螺仪白噪声分量。
应用卡尔曼滤波器进行状态矢量的零均值最小方差估计,建立系统观测方程。首先选取两个水平速度误差δVN、δVE作为观测量,所建立的系统观测方程为:
其中,δVN、δVE、X的定义同上。V是系统观测噪声矢量,为高斯白噪声过程。
初步仿真中发现,基于转动基座的初始对准精度受到加速度计偏置影响较大,为了提高加速度计随机常值偏置的估计精度,利用关系式:
将观测方程扩展为“速度+比力”匹配方式。其中fE和fN分别为等效东向和北向加速度计输出,可利用稳瞄平台加速度计输出并通过Cb n转换得到,φN和φE的定义同上, E与 N为等效东向和北向加速度计误差,从而观测方程可扩展为
式中,Z为两个水平速度误差δVN、δVE,与等效东向和北向加速度计输出fE和fN组成的观测矢量,V′为原观测噪声V与等效东向与北向加速度计白噪声分量组成的总测噪声,也考虑为高斯白噪声过程,服从正态分布。对上述系统误差方程与观测方程,应用线性Kalman滤波器对姿态失准角与惯性器件误差进行最优估计与补偿。
5.3基于车载稳瞄平台的惯性导航解算步骤
导航稳瞄一体化系统将IMU放在稳瞄平台上,稳瞄平台在控制回路的作用下按照要求进行三维的角运动,同时稳瞄平台随着车辆的运动进行三维的线运动,其中车辆三维的角运动被稳瞄平台的框架所隔离。因此,可以将该系统近似看作是一个装载在稳瞄平台上的捷联惯导系统,而捷联惯导系统的载体是稳瞄平台,通过捷联惯性导航算法可以解算出稳瞄平台的姿态转移矩阵及其在地理坐标系下的速度和位置。由于稳瞄平台和载车之间只有角运动,因此,通过稳瞄平台上的惯导系统解算出来的稳瞄平台在地理坐标系下的速度和位置就是载车在同一坐标系下的速度和位置。由此可以实现对车辆的速度测量和导航定位。
5.3.1捷联式惯导系统基本原理
由于稳瞄平台上的惯导系统近似于捷联式惯导系统,其基本原理如图2所示,该原理图主要突出表明了数学平台在捷联导航系统中的作用和关系。在捷联惯导系统中把陀螺仪和加速度计的组合体通常称为惯性组件(IMU-InertialMeasuring Unit)。三轴陀螺仪和加速度计的指向安装时要保持严格正交,该组件直接安装在载体上时也要保持与机体坐标系完全一致。同时还可以看到,IMU对捷联惯导系统而言是开环式的,仅起到了惯性传感器信号输入的作用,不需要任何信号再对IMU进行反馈控制,所有的信号处理也都在计算机内实现,因此工程实现方便。
捷联惯导系统的算法主要包括姿态转移矩阵的计算(即数学平台的计算部分)和导航计算(包括位置与速度的计算)两部分组成,其中姿态转移矩阵的计算是捷联惯性导航系统算法的核心。由于四元素姿态算法具有运算量小和全姿态解算的优点,因此,一般采用四元素法进行姿态转移矩阵的解算。
5.3.2基于车载稳瞄平台的捷联式惯导系统高精度姿态解算
导航/稳瞄一体化系统的特征是利用同一个IMU同时实现导航和稳瞄功能,因此需要将IMU安装在稳瞄平台上。虽然稳瞄平台可以将车辆的颠簸抖动隔离掉,但是稳瞄平台在其搜索过程中,具有很高的机动性,角速度可达400度/秒。因此,要保证高动态下的高精度的姿态解算是本系统姿态解算的关键技术。通常姿态转移矩阵的求解有欧拉角法、方向余弦法和四元数法。由于四元数法具有可以全姿态工作、计算工作量小等特点,故本系统采用四元数法。四元数法解姿态角主要有以下几个步骤:
1)机体相对导航坐标系角速度ωnb b的计算
其中ωib b为稳瞄平台上陀螺仪的直接输出,ωin b可通过车体速度在导航下投影、地球自转角速度ωie以及上个周期的姿态转移矩阵Cn b求得。
2)四元数微分方程的求解
四元数微分方程可以获得四元数迭代计算公式。
其中, ω1、ω2、ω3分别为在一次姿态解算周期内对陀螺仪输出进行3次采样的角速度,即采用3子样采样方法补偿陀螺非定轴转动时,角速度矢量积分产生的计算误差。姿态更新周期h=0.02s。
上式中[]表示向量的矩阵扩展,
3)四元数规范化
由于计算误差使得计算的变换四元数的范数不再等于1,即计算的四元数失去规范性,因此对计算的四元数必须周期地进行规范化处理。设 为直接由四元数微分方程计算得到的四元数,而设规范化后的四元数为 其中为相互正交的单位食量,利用最小二乘判据可以求得最优规范化的变换四元数。计算公式如下:
4)由四元数计算姿态转移矩阵Cn b
依据四元数表示的固定矢量之间的变换关系,可以获得四元数矩阵与方向余弦的关系为:
5)由姿态转移矩阵Cn b提取姿态角
其中θ、γ、φ分别为捷联惯导系统的俯仰角、横滚角以及航向角,c′11c′12、c′13、c′21、c′22、c′23、c′31、c′32、c′33分别为姿态转移矩阵Cn b的各元素,定义同上。
5.3.3速度与位置计算
a)速度计算
由于加速度计固连在稳瞄平台上,它的输出是稳瞄平台系相对于惯性空间的加速度在稳瞄平台系上的投影。因此需要把稳瞄平台上的加速度计原始输出fib b通过姿态转移矩阵Cb n转换到导航坐标系中,记为fib n,即
从而可以解算出载体在地理系中的速度,其微分方程为:
上式中,fe n、fn n、fd m分别是fib n在东向、北向和地向的投影分量,Ve、Vn、Vd分别是东向、北向和地向的速度分量,λ、L分别为当地的精度与纬度,g为当地重力加速度。
b)位置计算
由于载体在地球表面运动,因此导航计算时必须考虑地球曲率的影响。以经纬度和高度作为导航定位单位,由位置微分方程可求得载体的实时位置,其中要用到地球子午面内的曲率半径Rn,垂直于子午面的法线平面内的曲率半径Rm。
在北东地指向的地理坐标系下,水平指北编排的捷联惯导系统的算法流程如图3所示,捷联惯导系统算法流程分为3个部分,即惯性测量单元部分,“数学平台”计算部分以及导航计算部分。捷联系统经过初始对准解算已得到了稳瞄平台的初始横滚角γ0,初始俯仰角θ0,初始航向角Ψ0,并得到初始化四元数Q(Λ0)与初始化姿态转移矩阵的转置矩阵Cb n(0),通过四元数微分方程与四元数规范化,结合陀螺仪输出ωib b、导航坐标系相对于惯性坐标系的角速度ωin b以及前一时刻的四元数Q(Λk)得到当前时刻的四元数Q(Λk+1),从而由Q(Λk+1)四元数求解得到姿态转移矩阵的转置矩阵Cb n,并求解出平台的横滚角γ,俯仰角θ以及航向角Ψ。将加速度计输出fib b通过矩阵Cb n转换至fib n,结合上个时刻载体的纬度L(0)、经度λ(0)、高度h(0)与速度Vt(0)求解当前时刻导航坐标系相对于惯性坐标系的角速度在导航坐标系中的投影ωin n、载体的纬度L、经度λ、高度h以及速度Vt,完成整个捷联惯导系统的算法流程。
5.4车辆航姿信息解算及误差分析步骤
在利用里程仪信息进行车辆航位推算过程中,由于里程仪输出的是车体坐标系下的信息,因此必须转换到地理坐标系下才能进行航位推算。因此,在进行基于里程仪信息的车辆航位推算以前,需要确定车辆的姿态角,即确定车辆的姿态转移矩阵Cb n。
借助稳定平台的测角元件和炮塔转角测量元件,可以测量出平台相对于稳定平台相对于炮塔的姿态角以及炮塔相对于车辆的航向角;同时,稳定平台上的捷联惯导可以输出平台的姿态角,利用上述信息可以解算出车辆的姿态角信息。在解算姿态角时所用的坐标系如下:
b系:稳瞄平台坐标系;
B系:炮塔坐标系;
V系:车辆坐标系。
5.4.1车辆航姿信息求解
根据上述各坐标系的物理连接和运动关系,可以得到车辆坐标系和稳瞄平台坐标系之间的变换关系:
式中,CV B由炮塔相对于车体的航向角ΨVB来确定,该数值可由炮塔的测角元件测定,所以
CB b由稳瞄平台相对于炮塔的三个转角(ΨP,θP,γP)来确定,该三个数值可由稳瞄平台的测角元件输出,所以
捷联惯导解算出来的姿态阵为稳瞄平台的姿态,即Cn b,与Cb n互为转置,而车辆在姿态阵为CV n,因此
由式(16)可以解算出车辆的姿态转移矩阵,从而可以实现在车辆坐标系内输出的里程仪信息转化为导航坐标系内处理,完成车辆的航位推算。
5.4.2车辆姿态误差分析
在车辆姿态解算过程中,由于稳瞄平台的航姿角、稳瞄平台的测角元件输出的数值和炮塔的测角元件输出的数值都存在误差,即存在稳瞄平台误差角Ψn、稳瞄平台相对于炮塔的转角误差角Ψb以及炮塔的航向误差角ΨB,因此,利用式(16)进行车辆姿态解算将会把上述误差传递给车辆的姿态转移矩阵,即解算出来的车辆姿态也存在误差。该误差会对利用里程仪解算得到的速度和位置产生影响,因此需要对该姿态误差进行分析。
由式(16)可知:
上式中Ψ为车辆总的姿态误差角,其他变量同上。
5.5惯导系统和惯性器件的误差分析、建模和补偿步骤
高精度的导航定位需要对整个系统和惯性器件进行误差分析,并建立合理的数学模型,采用合适的方式对误差进行估计和补偿,以进一步提高和确保高精度惯导系统的实现,满足载体对系统的导航定位的精度要求。因此,对惯导系统及其惯性器件进行误差分析和建模是导航定位过程中重要的内容。
捷联惯性导航系统的误差包括两个方面:惯性传感器误差和捷联惯导系统的基本导航参数误差。因此对误差的建模也就是对这两类的误差建模。
1.惯性传感器的误差模型
捷联惯性传感器是一类随机性非常强的器件,因此模型主要是对随机误差建模。该随机误差在物理上主要来源于标定、正交、温度、原理等多方面,通常采取抽象的方法进行处理,对IMU的随机误差进行建模处理后,再根据大量的实测数据进行校核以保证模型及其参数的正确性。
a)陀螺仪漂移数学模型
对于光纤陀螺,陀螺漂移误差考虑主要由三部分组成:
εb=ωg+εc+εr (19)
其中:ωg——随机白噪声漂移,其均方差为σg;
εc——随机常值漂移;
εr——随机一阶马尔柯夫过程漂移。
假定三个轴向的陀螺误差模型均相同,均为:
上式中,Tr为是相关时间,ωr是均方差为σr的马尔柯夫过程驱动白噪声。
b)加速度计误差模型
其中,Ta是马尔柯夫过程的相关时间,ωa是均方差为σa的驱动白噪声。
2.捷联惯性导航系统的误差模型
捷联惯导系统导航参数误差可分为三部分:姿态误差、速度误差和位置误差,对应的误差模型分别为:平台误差角模型、速度误差模型和位置误差模型。当采用当地水平坐标系为北、东、地时,其误差模型为:
a)数学平台误差模型:
(22)
上式中φn、φe和φd分别为北向、东向、地向的平台误差角;ve、vn分别为东向与北向速度;ωie为地球自转角速度;L为当地纬度,δL为纬度误差;RM为地球子午圈半径,RN为地球卯酉圈半径;h为当地海拔高度;εn n、εe n、εd n分别为北向、东向和地向陀螺仪噪声。
b)速度误差模型:
(23)
c)位置误差模型:
上式中,δλ为经度误差,其他变量同上。
在得到惯性器件和捷联导航系统的误差模型以后,就可以在系统中设法消除或减小各种误差对导航系统精度的影响,从而提高系统的导航定位精度。一般采用外观测量的方式对系统误差和器件误差进行最优估计,将估计结果反馈到系统解算过程中进行误差补偿。
5.6惯导/里程仪/GPS多信息容错组合导航步骤
由于里程仪具有长距离工作时误差积累的缺点,因此捷联惯导/里程仪组合导航系统在长距离工作时其导航定位精度会下降。如果利用卫星导航系统误差不随时间和地点积累的优点进行进一步组合,组成捷联惯导/里程仪/GPS多信息组合导航系统,可始终保持对车辆的导航定位性能。为方便起见,在研究阶段,采用GPS系统作为卫星导航系统。考虑到卫星导航系统在实用时的可用性,捷联惯导/里程仪/GPS多信息组合导航可以采用以下两种方案来实现。
1.第一种方案:间断地利用GPS信息对捷联惯导/里程仪组合导航系统进行重调。该方案简单易行,比较适合于GPS间歇工作模式。在GPS工作期间,采用GPS信息对该组合导航系统进行一步校正,使导航定位误差减小到卫星定位系统的误差;GPS不工作时,捷联惯导/里程仪在此基础上继续进行组合导航。该方案的系统结构图如图4所示,首先构建一套捷联惯导与里程仪进行速度/位置组合的组合导航系统,实时输出位置与速度信息,在该组合导航系统因长距离工作误差积累超出性能指标要求,且GPS信号可用时,将GPS的位置、速度信息对捷联惯导/里程仪组合导航系统进行一步校正,即将GPS的位置、速度信息对捷联惯导/里程仪组合导航系统相应输出进行重置,提高整体导航精度。经过一次校正,间隔一定时间后可继续运用上述方法校正系统。
2.第二种方案:捷联惯导/里程仪/GPS多信息组合联邦滤波结构。该种方案适合于GPS可以持续使用的环境,也适用于GPS可以间断地持续工作一段时间的环境。在联邦滤波结构中,原捷联惯导/里程仪组合导航系统作为子系统1,捷联惯导/GPS组合导航系统作为子系统2,两个子系统分别进行分布式滤波,然后对子系统1和子系统2的滤波结果进行数据融合(联邦滤波),给出捷联惯导系统的误差估计,最后利用估计误差反馈校正惯导系统。
联邦滤波算法的结构图如图5所示,该方案将捷联惯导与里程仪进行了位置速度组合滤波解算,同时将捷联惯导与GPS进行了位置、速度组合滤波解算,最后将两个子滤波器的误差状态量估计值经过主滤波器加权平均,求得误差状态量的零均值最小方差估计,并反馈至捷联惯导系统进行闭环校正,提高惯导系统导航定位精度。该方案相对第一种方案具有更强的容错能力。当GPS信息不可用或GPS系统出现故障时,通过联邦滤波器的故障检测与隔离单元检测GPS信号的合理性,并将子系统2隔离掉,这样整个系统就变为捷联惯导/里程仪组合导航系统;当GPS信号可用时,再次将子系统2恢复使用,构成捷联惯导/里程仪/GPS多信息组合联邦滤波系统。该方案不仅使原捷联惯导/里程仪组合导航系统改造方便,而且可以实现在有无GPS信号时整个系统可以平滑地进行组合状态的转换,特别适合于卫星定位系统可用性差的环境,由于GPS的权限问题,该系统中的GPS接收机还可以换成北斗或伽利略卫星定位系统的接收机,以增强信号的可靠性。
同理,当里程仪出现故障时,也采用同样的方式隔离捷联惯导/里程仪组合导航子系统1,使系统转换成捷联惯导/GPS组合导航系统。
发明的效果
本发明从未来作战环境战车的导航/稳瞄一体化系统的性能需求入手,基于卡尔曼滤波最优加权平均的本质,结合稳瞄平台的转动,通过对惯导速度和比力输出的观测,实现对惯导系统平台失准角的最优估计与补偿,为战车提供高精度的姿态信息,并通过与里程仪和卫星导航系统的组合,为战车提供高精度的定位信息,提高战车的战场生存与综合作战能力。
对于中高精度光纤陀螺惯性导航系统,静基座初始对准的时间一般在10分钟以上,对准精度一般在十几角分。本发明在稳瞄平台上安装了0.01°/h光纤陀螺与1×10-4g的加速度计的惯导系统,初始对准方案采取了转动惯导系统基座的方法,大大提高了平台失准角的可观测性,对准时间在5分钟左右,对准精度高于5.4角分。与GPS、里程仪进行组合后,定位精度可达8米以上,速度精度0.4米/秒,完全满足战车车载导航系统的定位精度要求。本发明具有很强的工程应用价值。
Claims (1)
1.一种导航/稳瞄一体化系统的导航、稳瞄方法,其特征在于稳瞄平台上安装惯性测量单元实现载体定姿、定位,通过以下步骤实现:
(1)惯性测量单元信号采集步骤:采集惯性测量单元中光纤陀螺与MEMS加速度计的输出信号,得到惯导系统的角速度和比力;
(2)稳瞄平台下的快速精确初始对准步骤:利用稳瞄平台具有的随机调转特性,设计了一种快速而精确的转动基座初始对准方法,即在稳瞄平台绕其航向轴连续转动的条件下,建立系统状态方程误差状态量其中δVN、δVE为水平速度误差沿北、东方向的分量,φN、φE、φD为平台误差角在北、东、地方向的分量;为加速度计的零偏;εx、εy、εz为陀螺漂移状态转移矩阵,状态转移矩阵其中 ΩD,ΩN为地球自转角速度在地向与北向的分量,c11′=cosγcosφ+sinγsinθsinφ、c12′=cosθsinφ、c13′-sinγcosφ-cosγsinθsinφ、c21′=-cosγsinφ+sinγsinθcosφ、c22′=cosθcosφ、c23′=-sinγsinφ-cosγsinθcosφ、c31′=-sinγcosθ、c32′=sinθ、c33′=cosγcosθ分别为Cb n中的各元素,γ为平台横滚角、θ为平台俯仰角、φ为平台航向角,Cb n为平台姿态转移矩阵Cn b的转置矩阵,Cn b由横滚角γ、俯仰角θ、航向角φ的三角函数构成,即g为当地重力加速度,W=[w1 w2 w3 w4 w5],式中w1、w2为等效北向、东向的加速度计白噪声分量,w3、w4、w5为等效北向、东向、地向的陀螺仪白噪声分量,再建立系统观测方程式中δVN、δVE分别为水平速度误差沿北、东方向的分量,X定义同上,V为观测噪声矢量,通过增加东向与北向加速度计输出fN、fE作为观测量,扩展观测方程为式中X定义同上,V′为观测量扩展后的观测噪声矢量,c11′、c12、
c21′、c22′定义同上,运用卡尔曼滤波器,快速估计惯导系统的初始平台误差角φN、φE、φD并反馈给导航系统进行补偿,得到惯导系统精确的初始横滚角、俯仰角、航向角信息;
(3)基于车载稳瞄平台的惯性导航解算步骤:该步骤由高精度姿态解算与速度、位置解算组成,惯导系统姿态解算首先利用公式计算机体相对导航坐标系角速率ωnb b,式中ωib b为稳瞄平台上陀螺仪的直接输出,ωin b可通过车体速度在导航下投影、地球自转角速度ωie以及上个周期的姿态转移矩阵Cn b求得,然后采用四元数微分方程求解姿态转移矩阵Cn b对应的的四元数,式中l为四元数计算的时间间隔,分别为在一次姿态解算周期内对陀螺仪输出进行3次采样的角速率,即采用3子样采样方法补偿陀螺非定轴转动时,角速度矢量积分产生的计算误差。姿态更新周期h=0.02s, 将得到的四元数利用公式进行规范化,式中为直接由四元数微分方程计算得到的四元数,而设规范化后的四元数为其中为相互正交的单位食量,然后将规范化后的四元数通过公式生成姿态转移矩阵Cn b,Cn b定义同上,最后利用公式 从Cn b中提取横滚角γ、俯仰角θ、航向角φ信息,其中c′11、c′12、c′13、c′21、c′22、c′23、c′31、c′32、c′33分别为姿态转移矩阵Cn b的各元素,定义同上,惯导系统速度、位置解算方法则将加速度计输出通过平台Cn b的转置矩阵Cb n从载体坐标系转换到导航坐标系,并通过解算比力微分方程得到导航系统速度vep,再将导航系统速度vep经过一次积分得到导航系统位置,式中f为加速度计输出,ωie为地球自转角速度,ωep为稳瞄平台相对于地球的角速度;
(4)车辆航姿信息解算及误差分析步骤:借助稳定平台的测角元件和炮塔转角测量元件,测量出平台相对于炮塔姿态转移矩阵CB b, ψP,θP,γP为稳瞄平台相对于炮塔的三个转角;炮塔相对于车辆的姿态转移矩阵CV B,ψVB为炮塔相对于车体的航向角;同时稳定平台上的惯导系统输出上述平台的姿态转移矩阵Cn b,利用上述平台相对于炮塔姿态转移矩阵CB b、炮塔相对于车辆的姿态转移矩阵CV B、平台的姿态转移矩阵Cn b三个矩阵信息可以解算出车辆的横滚角、俯仰角、航向角信息,并对姿态误差进行分析与修正;
(5)惯导系统和惯性器件的误差分析、建模和补偿步骤:惯导系统的误差分为数学平台误差、速度误差和位置误差,数学平台误差模型为 ,式中φn、φe和φd分别为北向、东向、地向的平台误差角;ve、vn分别为东向与北向速度;ωie为地球自转角速度;L为当地纬度,δL为纬度误差;RM为地球子午圈半径,RN为地球卯酉圈半径;h为当地海拔高度;εn n、εe n、εd n分别为北向、东向和地向陀螺仪噪声,速度误差模型为 ,式中δVn、δVe、δVd为北向、东向、地向的速度误差,fn、fe、fd分别为北向、东向、地向的加速度计输出;δh为海拔高度误差; 分别为北向、东向、天向加速度计误差;其余变量定义同上, 位置误差方程为,式中δλ为经度误差,其他变量定义同上,惯性器件误差则是一类强非线性误差,陀螺漂移误差考虑主要由三部分组成:εb=ωg+εc+εr,式中ωg为随机白噪声漂移,其均方差为σg,εc为随机常值漂移,εr为随机一阶马尔柯夫过程漂移,设三个轴向的陀螺误差模型相同,均为:式中Tr为相关时间,ωr是均方差为σr的马尔柯夫过程驱动白噪声,加速度计误差模型一般考虑为一阶马尔柯夫过程,且三个轴向的加速度计误差模型相同:式中,Ta是马尔柯夫过程的相关时间,ωa是均方差为σa的驱动白噪声,采用里程仪与惯导之间的速度误差、位置误差作为观测量,以卡尔曼滤波的方式对姿态、速度、位置等系统误差以及陀螺仪漂移、加速度计偏置等惯性器件误差进行零均值最小方差估计,通过闭环反馈修正进行误差补偿;
(6)惯导/里程仪/GPS多信息容错组合导航步骤:该步骤采用两种方案实现,第一种方案采用间断地利用GPS信息对惯导/里程仪组合导航系统进行重调,首先构建一套捷联惯导与里程仪进行速度/位置组合的组合导航系统,实时输出位置与速度信息,在GPS信号可用时,将GPS的位置、速度信息对捷联惯导/里程仪组合导航系统输出进行校正,提高整体导航精度,经过一次校正,间隔一定时间后继续运用上述方法校正系统;第二种方案采用惯导/里程仪/GPS多信息组合联邦滤波结构,该方案将捷联惯导与里程仪进行了位置速度组合滤波解算,同时将捷联惯导与GPS进行了位置、速度组合滤波解算,最后将两个子滤波器的误差状态量估计值经过主滤波器加权平均,求得误差状态量的零均值最小方差估计,并反馈至捷联惯导系统进行闭环校正,提高惯导系统导航定位精度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2008100192932A CN101413800B (zh) | 2008-01-18 | 2008-01-18 | 导航/稳瞄一体化系统的导航、稳瞄方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2008100192932A CN101413800B (zh) | 2008-01-18 | 2008-01-18 | 导航/稳瞄一体化系统的导航、稳瞄方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN101413800A CN101413800A (zh) | 2009-04-22 |
CN101413800B true CN101413800B (zh) | 2010-09-29 |
Family
ID=40594442
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2008100192932A Expired - Fee Related CN101413800B (zh) | 2008-01-18 | 2008-01-18 | 导航/稳瞄一体化系统的导航、稳瞄方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN101413800B (zh) |
Families Citing this family (59)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5445082B2 (ja) * | 2009-12-03 | 2014-03-19 | ソニー株式会社 | 速度算出装置及び速度算出方法並びにナビゲーション装置及びナビゲーション機能付携帯電話機 |
CN101793523B (zh) * | 2010-03-10 | 2011-08-17 | 北京航空航天大学 | 一种组合导航和光电探测一体化系统 |
CN101949710B (zh) * | 2010-07-28 | 2013-01-02 | 北京泰豪联星技术有限公司 | Gnss辅助mems惯性传感器零偏的快速在线动态标定方法 |
CN101936738B (zh) * | 2010-08-19 | 2012-10-10 | 中国航空工业第六一八研究所 | 对平台式惯性导航系统速率通道的改进方法 |
CN102060105B (zh) * | 2010-11-23 | 2012-12-26 | 中国兵器工业第二〇五研究所 | 带倾斜补偿的航向校准装置 |
CN102243315A (zh) * | 2011-04-25 | 2011-11-16 | 惠州Tcl移动通信有限公司 | 具有辅助定位功能的移动终端及方法 |
CN102261033A (zh) * | 2011-05-03 | 2011-11-30 | 北京航空航天大学 | 一种基于惯性测量单元的车载路面检测系统的运补算法 |
CN102426373A (zh) * | 2011-09-01 | 2012-04-25 | 中国航空工业第六一八研究所 | 一种惯性/卫星组合导航系统开闭环混合修正方法 |
CN102999048B (zh) * | 2011-09-08 | 2016-05-18 | 中国航天科工集团第二研究院二0七所 | 一种车载动基座光电搜索跟踪转台的伺服控制方法 |
CN102997916B (zh) * | 2011-09-15 | 2015-08-05 | 北京自动化控制设备研究所 | 一种自主提高定位定向系统惯性姿态解算精度的方法 |
CN102506858B (zh) * | 2011-10-21 | 2014-07-02 | 北京北方联星科技有限公司 | 卫星导航系统辅助的惯性传感器轴向快速识别方法 |
CN102520726B (zh) * | 2011-12-19 | 2013-07-03 | 南京航空航天大学 | 大攻角飞行状态下的大气攻角及侧滑角估计方法 |
CN102636081B (zh) * | 2011-12-29 | 2014-10-15 | 南京航空航天大学 | 一种基于视觉运动建模的传递对准方法及装置 |
CN102520735B (zh) * | 2011-12-29 | 2014-07-09 | 中国科学院长春光学精密机械与物理研究所 | 一种抑制单杆跟踪零位漂移的有效方法 |
CN102556122A (zh) * | 2012-01-18 | 2012-07-11 | 张卫国 | 列车导航监控预警系统及其预警方法 |
CN102607556B (zh) * | 2012-01-18 | 2015-03-18 | 北京自动化控制设备研究所 | 一种基于雷速的中精度航姿系统组合导航方法 |
WO2013139168A1 (zh) * | 2012-03-19 | 2013-09-26 | Zhao Wenzhi | 一种自动瞄准二次加速矩阵炮 |
CN102706365B (zh) * | 2012-06-19 | 2014-09-10 | 北京航空航天大学 | 一种基于导航系统的三波束激光测速仪标定方法 |
CN102706367B (zh) * | 2012-06-19 | 2014-12-24 | 北京航空航天大学 | 一种用于组合导航的单波束激光测速仪精度测试与计算方法 |
US10228263B2 (en) * | 2013-03-15 | 2019-03-12 | Google Llc | System and method for attitude correction |
CN103353310B (zh) * | 2013-06-01 | 2017-06-09 | 西北工业大学 | 一种激光捷联惯性导航系统 |
CN104296598A (zh) * | 2013-07-18 | 2015-01-21 | 贵州贵航飞机设计研究所 | 一种无人机载光电稳瞄系统抗烟雾稳定跟踪照射目标的方法 |
CN104635251B (zh) * | 2013-11-08 | 2017-07-07 | 中国地质大学(北京) | 一种ins/gps组合定位定姿新方法 |
CN103743414B (zh) * | 2014-01-02 | 2016-07-06 | 东南大学 | 一种里程计辅助车载捷联惯导系统行进间初始对准方法 |
CN103759730B (zh) * | 2014-01-16 | 2016-06-29 | 南京师范大学 | 一种基于导航信息双向融合的行人与智能移动载体的协同导航系统及其导航方法 |
CN104848842B (zh) * | 2014-03-25 | 2017-08-29 | 北京空间机电研究所 | 一种利用寻北仪实现航空相机航迹跟踪成像的方法 |
CN103940422A (zh) * | 2014-05-08 | 2014-07-23 | 中北大学 | 射击射箭运动复合姿态参数获取系统 |
CN104180821B (zh) * | 2014-08-27 | 2017-04-19 | 北京航空航天大学 | 一种基于同步测量与定位计算的里程计标定方法 |
CN104317217B (zh) * | 2014-10-09 | 2016-11-16 | 西安应用光学研究所 | 航空相机稳定平台无超调伺服控制方法 |
CN104359492B (zh) * | 2014-11-03 | 2017-03-01 | 中国科学院合肥物质科学研究院 | 惯性导航和轮速计组成的航迹推算定位系统误差估算算法 |
CN104567888A (zh) * | 2014-12-25 | 2015-04-29 | 大连楼兰科技股份有限公司 | 基于速度在线修正的惯性导航车辆姿态测量方法 |
CN104503487B (zh) * | 2014-12-25 | 2017-04-05 | 湖南中电天恒信息科技股份有限公司 | 一种升降平台的测量控制系统及测量控制方法 |
CN104697526A (zh) * | 2015-03-26 | 2015-06-10 | 上海华测导航技术股份有限公司 | 用于农业机械的捷联惯导系统以及控制方法 |
CN106297361B (zh) * | 2015-05-20 | 2018-08-28 | 无锡卓信信息科技有限公司 | 一种车机和惯性导航结合的区域精确定位系统及定位方法 |
CN105421200B (zh) * | 2015-11-06 | 2017-06-27 | 苏交科集团股份有限公司 | 一种基于振动检测的平整度检测方法与检测装置 |
CN106482734A (zh) * | 2016-09-28 | 2017-03-08 | 湖南优象科技有限公司 | 一种用于imu多传感器数据融合的滤波方法 |
CN106780699B (zh) * | 2017-01-09 | 2020-10-16 | 东南大学 | 一种基于sins/gps和里程计辅助的视觉slam方法 |
CN108051839B (zh) * | 2017-10-27 | 2021-11-05 | 成都天合世纪科技有限责任公司 | 一种车载三维定位装置及三维定位的方法 |
CN108051787A (zh) * | 2017-12-05 | 2018-05-18 | 上海无线电设备研究所 | 一种弹载雷达挂飞试验方法 |
CN108375997B (zh) * | 2018-02-15 | 2021-03-30 | 西安应用光学研究所 | 一种用于车载光电观瞄系统的两轴伺服控制系统正交性补偿方法 |
CN108896045B (zh) * | 2018-06-25 | 2020-08-04 | 南京航空航天大学 | 一种无加速度计的惯性导航系统和导航方法 |
CN109001829B (zh) * | 2018-07-12 | 2019-11-05 | 中国人民解放军国防科技大学 | 一种捷联式水下动态重力测量仪 |
CN109211230B (zh) * | 2018-09-07 | 2022-02-15 | 东南大学 | 一种基于牛顿迭代法的炮弹姿态和加速度计常值误差估计方法 |
CN109211231B (zh) * | 2018-09-07 | 2022-02-15 | 东南大学 | 一种基于牛顿迭代法的炮弹姿态估计方法 |
CN109945857B (zh) * | 2019-03-18 | 2022-08-26 | 东南大学 | 一种面向不动产实地测量的车载惯性定位方法及其装置 |
CN110006421B (zh) * | 2019-03-27 | 2021-03-09 | 湖北三江航天万峰科技发展有限公司 | 一种基于mems和gps的车载导航方法及系统 |
CN109917440B (zh) * | 2019-04-09 | 2021-07-13 | 广州小鹏汽车科技有限公司 | 一种组合导航方法、系统及车辆 |
CN112859138B (zh) * | 2019-11-28 | 2023-09-05 | 中移物联网有限公司 | 一种姿态测量方法、装置及电子设备 |
CN111623772B (zh) * | 2019-12-18 | 2023-02-28 | 西北工业大学 | 一种用于目标方位预测的非线性瞄准线建模方法 |
CN111521177B (zh) * | 2020-04-28 | 2021-01-05 | 中国人民解放军国防科技大学 | 管长信息辅助测速的钻探用定位定向仪孔内定位方法 |
CN111504313B (zh) * | 2020-04-28 | 2021-01-05 | 中国人民解放军国防科技大学 | 基于速度信息辅助的钻探用定位定向仪孔内定位方法 |
CN111637883B (zh) * | 2020-04-28 | 2022-04-12 | 北京航天控制仪器研究所 | 基于速度和位置误差闭环反馈的提高惯性制导精度的方法 |
CN112083465A (zh) * | 2020-09-18 | 2020-12-15 | 德明通讯(上海)有限责任公司 | 位置信息获取系统及方法 |
CN112197792A (zh) * | 2020-10-10 | 2021-01-08 | 江西洪都航空工业集团有限责任公司 | 一种用于教练机航姿系统的提升航向精度方法 |
CN112332917A (zh) * | 2020-10-23 | 2021-02-05 | 军事科学院系统工程研究院网络信息研究所 | 惯性导航控制的激光通信自主跟瞄方法 |
CN112346485B (zh) * | 2020-12-24 | 2021-05-25 | 华中光电技术研究所(中国船舶重工集团公司第七一七研究所) | 一种光电跟踪控制方法、系统、电子设备及存储介质 |
CN113280678A (zh) * | 2021-05-19 | 2021-08-20 | 中国人民解放军63966部队 | 一种火炮瞄准性能参数测试系统的标校方法 |
CN113465570B (zh) * | 2021-06-17 | 2023-05-12 | 北京控制工程研究所 | 一种基于高精度imu的气浮台初始对准方法及系统 |
CN115356965B (zh) * | 2022-08-29 | 2023-11-28 | 中国兵器科学研究院 | 一种松散耦合实装数据采集装置及数据处理方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1924606A (zh) * | 2006-09-04 | 2007-03-07 | 南京航空航天大学 | 基于北斗双星系统的快速测量载体姿态的方法 |
US7257512B1 (en) * | 2006-04-07 | 2007-08-14 | Honeywell International Inc. | Methods and systems for vibropendulous error compensation of acceleration sensors |
CN101033973A (zh) * | 2007-04-10 | 2007-09-12 | 南京航空航天大学 | 微小型飞行器微惯性组合导航系统的姿态确定方法 |
-
2008
- 2008-01-18 CN CN2008100192932A patent/CN101413800B/zh not_active Expired - Fee Related
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7257512B1 (en) * | 2006-04-07 | 2007-08-14 | Honeywell International Inc. | Methods and systems for vibropendulous error compensation of acceleration sensors |
CN1924606A (zh) * | 2006-09-04 | 2007-03-07 | 南京航空航天大学 | 基于北斗双星系统的快速测量载体姿态的方法 |
CN101033973A (zh) * | 2007-04-10 | 2007-09-12 | 南京航空航天大学 | 微小型飞行器微惯性组合导航系统的姿态确定方法 |
Also Published As
Publication number | Publication date |
---|---|
CN101413800A (zh) | 2009-04-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN101413800B (zh) | 导航/稳瞄一体化系统的导航、稳瞄方法 | |
CN101788296B (zh) | 一种sins/cns深组合导航系统及其实现方法 | |
CN101319902B (zh) | 一种低成本组合式定位定向装置及组合定位方法 | |
CN111156994B (zh) | 一种基于mems惯性组件的ins/dr&gnss松组合导航方法 | |
CN101793523B (zh) | 一种组合导航和光电探测一体化系统 | |
CN113311436B (zh) | 一种移动平台上激光测风雷达运动姿态测风订正方法 | |
CN100476360C (zh) | 一种基于星敏感器标定的深综合组合导航方法 | |
CN106932804A (zh) | 天文辅助的惯性/北斗紧组合导航系统及其导航方法 | |
CN101701825A (zh) | 高精度激光陀螺单轴旋转惯性导航系统 | |
CN103575299A (zh) | 利用外观测信息的双轴旋转惯导系统对准及误差修正方法 | |
Gao et al. | Study on integration of FOG single-axis rotational INS and odometer for land vehicle | |
CN104697520B (zh) | 一体化无陀螺捷联惯导系统与gps系统组合导航方法 | |
CN103076015A (zh) | 一种基于全面最优校正的sins/cns组合导航系统及其导航方法 | |
CN103674030A (zh) | 基于天文姿态基准保持的垂线偏差动态测量装置和方法 | |
CN101603833A (zh) | 稳瞄吊舱的比力差积分匹配传递对准及其组合导航方法 | |
CN104698486A (zh) | 一种分布式pos用数据处理计算机系统实时导航方法 | |
Cai et al. | Multi-antenna GNSS and INS integrated position and attitude determination without base station for land vehicles | |
CN101261130A (zh) | 一种船用光纤捷联惯导系统传递对准精度评估方法 | |
Fu et al. | In-motion alignment for a velocity-aided SINS with latitude uncertainty | |
CN113503892A (zh) | 一种基于里程计和回溯导航的惯导系统动基座初始对准方法 | |
CN104501809A (zh) | 一种基于姿态耦合的捷联惯导/星敏感器组合导航方法 | |
Bose et al. | Modern inertial sensors and systems | |
Al-Jlailaty et al. | Efficient attitude estimators: A tutorial and survey | |
CN204255368U (zh) | 一种适用于火星车的sins/cns深组合导航系统 | |
CN105300407A (zh) | 一种用于单轴调制激光陀螺惯导系统的海上动态启动方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
C17 | Cessation of patent right | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20100929 Termination date: 20140118 |