CN101413800A - 导航/稳瞄一体化系统的导航、稳瞄方法 - Google Patents

导航/稳瞄一体化系统的导航、稳瞄方法 Download PDF

Info

Publication number
CN101413800A
CN101413800A CNA2008100192932A CN200810019293A CN101413800A CN 101413800 A CN101413800 A CN 101413800A CN A2008100192932 A CNA2008100192932 A CN A2008100192932A CN 200810019293 A CN200810019293 A CN 200810019293A CN 101413800 A CN101413800 A CN 101413800A
Authority
CN
China
Prior art keywords
delta
phi
sin
cos
omega
Prior art date
Application number
CNA2008100192932A
Other languages
English (en)
Other versions
CN101413800B (zh
Inventor
钱伟行
刘建业
赵伟
李荣冰
赖际舟
祝燕华
赵文芳
Original Assignee
南京航空航天大学
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by 南京航空航天大学 filed Critical 南京航空航天大学
Priority to CN2008100192932A priority Critical patent/CN101413800B/zh
Publication of CN101413800A publication Critical patent/CN101413800A/zh
Application granted granted Critical
Publication of CN101413800B publication Critical patent/CN101413800B/zh

Links

Abstract

一种导航/稳瞄一体化系统的导航、稳瞄方法,属惯性导航领域。该导航方法是利用安装在光电稳瞄平台上的惯性测量单元实现载体定姿、定位。具体步骤是:采集惯性测量单元的信号;稳瞄平台下的快速精确初始对准;基于车载稳瞄平台的惯性导航算法;车辆航姿信息解算及误差分析;惯导系统与惯性器件的误差分析、建模与补偿;惯导/里程仪/GPS多信息容错组合导航。本导航方法改进了已有技术中稳瞄和导航系统不能同时工作,以及一体化系统无法提供全面导航信息的不足,能为载体(战车)提供实时、精确、完整的导航姿态信息和导航定位信息,能提高战车的战场生存能力和综合作战能力。

Description

导航/稳瞄一体化系统的导航、稳瞄方法

[0001] 技术领域

[0002] 本发明是一种应用于战车导航/稳瞄一体化系统的导航定位、定姿方法,属于惯性导航领域。

[0003] 背景技术

[0004] 瞄准线稳定系统和惯性导航系统是近年来广泛应用于坦克等地面战车的两种高精度惯性系统。瞄准线稳定系统主要组成部分为光电稳瞄平台,通过它稳定瞄准线,为战车在行进中提供精确的射击或制导基准,增强了战车的机动性;惯导系统能适时提供载体姿态、速度以及所在位置,引导坦克隐蔽进入战场与打击目标,其自主性是其他定位定向系统无法比拟的。

[0005] 瞄准线稳定系统主要组成部分为光电稳瞄平台,光电稳瞄平台的功能是捕获、跟踪、瞄准战车所处地域内的目标,如车辆、房屋等。平台主要由光电探测器、跟踪伺服平台、电子设备和惯性元件组成。其中光电探测器一般包括红外成像、激光测距、电视成像系统;跟踪伺服平台是多轴多环架伺服系统,光电探测器安装在平台的内环;惯性元件由陀螺仪、加速度计等组成,用来在车载环境下建立惯性基准。

[0006] 车载惯性导航系统(Strapdown Inertial Navigation System)是一种基于牛顿运动定律以推算的方式实现导航功能的系统,其核心传感器是由陀螺仪(角运动传感器)和加速度计(线运动传感器)等两类惯性传感器构成的测量单元,由上述两类传感器构成的测量单元直接固联在战车稳瞄平台上。惯性导航系统中的处理器通过模拟/数字转换电路或者直接采用数字接口,读取上述测量单元内角运动和线运动传感器的数据,按惯性导航算法的原理流程,对原始的测量数据进行加工,解算出运动载体的姿态、速度和位置等参数。

[0007] 针对未来作战环境战车装备的潜在要求,有展开信息感知和火控稳瞄综合运用的强烈需求,但由于涉及到惯性器件、精密光机结构、高精度伺服和复杂的解析算法,在我国现有装备的系统中,稳瞄、导航这两套系统只能分时使用,即稳瞄和导航不能同时工作,且精度不高。国内有稳瞄/寻北一体化系统的相关技术研究,但该系统只能解算车体航向,无法提供全方位的姿态信息以及速度、位置信息,即无法进行完整的导航工作。

[0008] 惯性导航系统一般在静基座下进行系统初始化,初始化过程中姿态对准特别是航向失准角的精度与对准速度难以满足要求;车载稳瞄平台上的惯性导航系统算法,在光电稳瞄平台进行瞄准线稳定的过程中,解算机理类似于平台惯导系统,而在稳瞄平台进行目标跟踪与人工调转过程中,惯性传感器构成的测量单元跟随稳瞄平台一起转动,此过程中惯性导航系统解算机理类似于捷联惯导,目前常规的平台惯导与捷联惯导解算机理均不适用于车载稳瞄平台上的惯性导航系统,惯导系统与惯性器件的误差分析、建模、补偿方式也需要进一步改进。

[0009] 发明内容

[0010] 本发明的主要目的是,改进已有方案中稳瞄和导航系统不能同时工作,以及一体化系统无法提供全面导航信息的不足,在随机旋转的光电稳瞄平台上,安装光纤捷联惯性测量单元,通过提取惯性测量单元的输出信息,结合车载测角机构与导航计算机,探索适用于导航/稳瞄一体化系统的惯导解算方法的新途径,为载体提供实时、精确、完整的导航定位信息。

[0011] 本发明的内容是导航/稳瞄一体化系统通过光电稳瞄平台上安装完整的惯性测量单元实现载体定姿、定位的方法,其特点通过以下步骤实现:

[0012]

惯性测量单元信号采集步骤:采集惯性测量单元中光纤陀螺与MEMS加速度计的输出信号,得到惯导系统的角速度和比力;

[0013]

稳瞄平台下的快速精确初始对准步骤:利用稳瞄平台具有的随机调转特性,设计了一种快速而精确的转动基座初始对准方法,即在稳瞄平台绕其航向轴连续转动的条件下,建立系统状态方程,误差状态量其中δ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θ分别为

中的各元素,γ为平台横滚角、θ为平台俯仰角、φ为平台航向角,

为平台姿态转移矩阵

的转置矩阵,

由横滚角γ、俯仰角θ、航向角φ的三角函数构成,即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并反馈给导航系统进行补偿,得到惯导系统精确的初始横滚角、俯仰角、航向角信息;

[0014]

基于车载稳瞄平台的惯性导航解算步骤:该步骤由高精度姿态解算与速度、位置解算组成,惯导系统姿态解算首先利用公式计算机体相对导航坐标系角速度

,式中

为稳瞄平台上陀螺仪的直接输出,

可通过车体速度在导航下投影、地球自转角速度ωie以及上个周期的姿态转移矩阵

求得,然后采用四元数微分方程求解姿态转移矩阵

对应的的四元数,式中l为四元数计算的时间间隔,ω1、ω2、ω3分别为在一次姿态解算周期内对陀螺仪输出进行3次采样的角速度,即采用3子样采样方法补偿陀螺非定轴转动时,角速度矢量积分产生的计算误差。姿态更新周期h=0.02s,将得到的四元数利用公式i=0,1,2,3进行规范化,式中为直接由四元数微分方程计算得到的四元数,而设规范化后的四元数为其中

为相互正交的单位食量,然后将规范化后的四元数通过公式生成姿态转移矩阵

定义同上,最后利用公式从

中提取横滚角γ、俯仰角θ、航向角φ信息,其中c′11、c′12、c′13、c′21、c′22、c′23、c′31、c′32、c′33分别为姿态转移矩阵

的各元素,定义同上。惯导系统(即车辆)速度、位置解算方法则将加速度计输出通过平台

的转置矩阵

从载体坐标系转换到导航坐标系,并通过解算比力微分方程得到导航系统速度vep,再将导航系统速度vep经过一次积分得到导航系统位置,式中f为加速度计输出,ωie为地球自转角速度,ωep为稳瞄平台相对于地球的角速度;

[0015]

车辆航姿信息解算及误差分析步骤:借助稳定平台的测角元件和炮塔转角测量元件,测量出平台相对于炮塔姿态转移矩阵

ψP,θP,γP为稳瞄平台相对于炮塔的三个转角;炮塔相对于车辆的姿态转移矩阵

ψVB为炮塔相对于车体的航向角;同时稳定平台上的惯导系统输出上述平台的姿态转移矩阵

利用上述平台相对于炮塔姿态转移矩阵

、炮塔相对于车辆的姿态转移矩阵

、平台的姿态转移矩阵

三个矩阵信息可以解算出车辆的横滚角、俯仰角、航向角信息,并对姿态误差进行分析与修正;

[0016] (5)惯导系统和惯性器件的误差分析、建模和补偿步骤:惯导系统的误差分为数学平台误差、速度误差和位置误差,数学平台误差模型为,式中φn、φe和φd分别为北向、东向、地向的平台误差角;ve、vn分别为东向与北向速度;ωie为地球自转角速度,L为当地纬度,δL为纬度误差,RM为地球子午圈半径,RN为地球卯酉圈半径,h为当地海拔高度,

分别为北向、东向和地向陀螺仪噪声,速度误差模型为,式中δVn、δVe、δVd为北向、东向、地向的速度误差,fn、fe、fd分别为北向、东向、地向的加速度计输出,δh为海拔高度误差;

分别为北向、东向、天向加速度计误差,其余变量定义同上,位置误差方程为,式中δλ为经度误差,其他变量定义同上,惯性器件误差则是一类强非线性误差,陀螺漂移误差考虑主要由三部分组成:εb=ωg+εc+εr,式中ωg为随机白噪声漂移,其均方差为σg,εc为随机常值漂移,εr为随机一阶马尔柯夫过程漂移,设三个轴向的陀螺误差模型相同,均为:式中Tr为相关时间,ωr是均方差为σr的马尔柯夫过程驱动白噪声,加速度计误差模型

一般考虑为一阶马尔柯夫过程,且三个轴向的加速度计误差模型相同:,式中Ta是马尔柯夫过程的相关时间,ωa是均方差为σa的驱动白噪声,本发明采用里程仪(或GPS)与惯导之间的速度误差、位置误差作为观测量,以卡尔曼滤波的方式对姿态、速度、位置等系统误差以及陀螺仪漂移、加速度计偏置等惯性器件误差进行零均值最小方差估计,通过闭环反馈修正进行误差补偿;

[0017]

惯导/里程仪/GPS多信息容错组合导航步骤:该步骤采用两种方案实现,第一种方案采用间断地利用GPS信息对惯导/里程仪组合导航系统进行重调,首先构建一套捷联惯导与里程仪进行速度/位置组合的组合导航系统,实时输出位置与速度信息,在GPS信号可用时,将GPS的位置、速度信息对捷联惯导/里程仪组合导航系统输出进行校正,提高整体导航精度。经过一次校正,间隔一定时间后继续运用上述方法校正系统;第二种方案采用惯导/里程仪/GPS多信息组合联邦滤波结构,该方案将捷联惯导与里程仪进行了位置速度组合滤波解算,同时将捷联惯导与GPS进行了位置、速度组合滤波解算,最后将两个子滤波器的误差状态量估计值经过主滤波器加权平均,求得误差状态量的零均值最小方差估计,并反馈至捷联惯导系统进行闭环校正,提高惯导系统导航定位精度。

[0018] 说明书附图

[0019] 图1是导航/稳瞄一体化系统结构原理图。

[0020] 图2是捷联式惯导系统原理。

[0021] 图3捷联惯导系统的算法流程。图中γ0、θ0、ψ0分别为稳瞄平台的初始横滚角、初始俯仰角与初始航向角,Q(Λ0)为初始化四元数,

为初始化姿态转移矩阵的转置矩阵,

为陀螺仪输出,

为导航坐标系相对于惯性坐标系的角速度,Q(Λk)为前一时刻的四元数,Q(Λk+1)为当前时刻的四元数,

为当前时刻姿态转移矩阵的转置矩阵,γ、θ、ψ分别为当前时刻平台的横滚角、俯仰角以及航向角,

为加速度计输出,

为加速度计输出在导航坐标系中的投影,L(0)、λ(0)、h(0)、Vt(0)分别为上一时刻载体的纬度、经度、高度与速度,

为当前时刻导航坐标系相对于惯性坐标系的角速度在导航坐标系中的投影,L、λ、h、Vt分别为当前时刻载体的纬度、经度、高度以及速度。

[0022] 图4GPS间断对惯导/里程仪组合导航系统重调方式结构图。

[0023] 图5惯导/里程仪/GPS多信息组合联邦滤波结构图

[0024] 具体实施方式

[0025] 传统的车载一体化系统中,或无法提供全方位的姿态信息以及速度、位置信息,或导航系统与稳瞄系统无法同时工作。本发明在传统的一体化系统基础上进行改进,如图1所示,将惯性测量组件(IMU)安装在随机调转的光电稳瞄平台上,IMU由3个正交安装的光纤陀螺与3个正交安装的加速度计组成,稳瞄平台具有3自由度的转动功能,IMU中的陀螺信号输出给平台稳定回路,以实现对稳瞄平台稳定的功能。同时,IMU中的陀螺仪和加速度计的信号输出给惯导解算部分解算出稳瞄平台的姿态、速度和位置信息,并适时与里程仪与GPS进行组合导航。利用平台测角机构测量出平台和车体之间的角位置,并利用惯导输出的稳瞄平台的姿态角信息,进一步解算出车辆的的姿态信息。

[0026] 为了完成导航/稳瞄一体化系统的精确定位与测姿,需要完成工作:

[0027] 5.1 惯性测量单元信号采集步骤

[0028] 采集惯性测量单元中光纤陀螺与MEMS加速度计的输出信号,得到惯导系统的角速度和比力。

[0029] 5.2 稳瞄平台下的快速精确初始对准步骤

[0030] 在稳瞄控制单元的输入口处,设立一个转换开关,当综合体需要初始对准时,该开关拨向导航单元,惯导控制单元根据IMU检测的地球自转和重力加速度变化信息,判断概略稳瞄平台的姿态和航向,以此为依据,向稳瞄控制单元发出旋转指令,后者立即控制伺服电路将平台旋转和调平,实现快速初始粗对准。

[0031] 瞄平台的水平对准精度较高,初始精确对准的关键是方位对准。由于稳瞄平台可以相对车体在方位上转动,本发明提出了一种采用转动稳瞄准平台的快速初始精对准方法,该方法通过以一定角速度连续转动稳瞄平台的方位轴,以使整个初始精对准在航向角不断改变的过程中完成,从而在提高精度的同时又提高了对准的速度。这种方法的理论分析如下所示。

[0032] 采用北-东-地地理坐标系为导航坐标系,惯导系统初始对准误差模型的状态方程为:

[0033]

[0034] 式中,误差状态量

[0035]

[0036] δVN、δVE为水平速度误差沿北、东方向的分量;φN、φE、φD为平台误差角在北、东、地方向的分量;

为加速度计的零偏;εx、εy、εz为陀螺漂移;ΩD,ΩN为地球自转角速度在地向与北向的分量c′11、c′12、c′13、c′21、c′22、c′23、c′31、c′32、c′33为姿态转移矩阵的转置矩阵

的各元素,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为等效北向、东向、地向的陀螺仪白噪声分量。

[0037] 应用卡尔曼滤波器进行状态矢量的零均值最小方差估计,建立系统观测方程。首先选取两个水平速度误差δVN、δVE作为观测量,所建立的系统观测方程为:

[0038]

[0039] 其中,δVN、δVE、X的定义同上。V是系统观测噪声矢量,为高斯白噪声过程。

[0040] 初步仿真中发现,基于转动基座的初始对准精度受到加速度计偏置影响较大,为了提高加速度计随机常值偏置的估计精度,利用关系式:

[0041]

[0042] 将观测方程扩展为“速度+比力”匹配方式。其中fE和fN分别为等效东向和北向加速度计输出,可利用稳瞄平台加速度计输出并通过

转换得到,φN和φE的定义同上,

为等效东向和北向加速度计误差,从而观测方程可扩展为

[0043]

[0044] 式中,Z为两个水平速度误差δVN、δVE,与等效东向和北向加速度计输出fE和fN组成的观测矢量,V'为原观测噪声V与等效东向与北向加速度计白噪声分量组成的总测噪声,也考虑为高斯白噪声过程,服从正态分布。对上述系统误差方程与观测方程,应用线性Kalman滤波器对姿态失准角与惯性器件误差进行最优估计与补偿。

[0045] 5.3 基于车载稳瞄平台的惯性导航解算步骤

[0046] 导航稳瞄一体化系统将IMU放在稳瞄平台上,稳瞄平台在控制回路的作用下按照要求进行三维的角运动,同时稳瞄平台随着车辆的运动进行三维的线运动,其中车辆三维的角运动被稳瞄平台的框架所隔离。因此,可以将该系统近似看作是一个装载在稳瞄平台上的捷联惯导系统,而捷联惯导系统的载体是稳瞄平台,通过捷联惯性导航算法可以解算出稳瞄平台的姿态转移矩阵及其在地理坐标系下的速度和位置。由于稳瞄平台和载车之间只有角运动,因此,通过稳瞄平台上的惯导系统解算出来的稳瞄平台在地理坐标系下的速度和位置就是载车在同一坐标系下的速度和位置。由此可以实现对车辆的速度测量和导航定位。

[0047] 5.3.1 捷联式惯导系统基本原理

[0048] 由于稳瞄平台上的惯导系统近似于捷联式惯导系统,其基本原理如图2所示,该原理图主要突出表明了数学平台在捷联导航系统中的作用和关系。在捷联惯导系统中把陀螺仪和加速度计的组合体通常称为惯性组件(IMU—InertialMeasuring Unit)。三轴陀螺仪和加速度计的指向安装时要保持严格正交,该组件直接安装在载体上时也要保持与机体坐标系完全一致。同时还可以看到,IMU对捷联惯导系统而言是开环式的,仅起到了惯性传感器信号输入的作用,不需要任何信号再对IMU进行反馈控制,所有的信号处理也都在计算机内实现,因此工程实现方便。

[0049] 捷联惯导系统的算法主要包括姿态转移矩阵的计算(即数学平台的计算部分)和导航计算(包括位置与速度的计算)两部分组成,其中姿态转移矩阵的计算是捷联惯性导航系统算法的核心。由于四元素姿态算法具有运算量小和全姿态解算的优点,因此,一般采用四元素法进行姿态转移矩阵的解算。

[0050] 5.3.2 基于车载稳瞄平台的捷联式惯导系统高精度姿态解算

[0051] 导航/稳瞄一体化系统的特征是利用同一个IMU同时实现导航和稳瞄功能,因此需要将IMU安装在稳瞄平台上。虽然稳瞄平台可以将车辆的颠簸抖动隔离掉,但是稳瞄平台在其搜索过程中,具有很高的机动性,角速度可达400度/秒。因此,要保证高动态下的高精度的姿态解算是本系统姿态解算的关键技术。通常姿态转移矩阵的求解有欧拉角法、方向余弦法和四元数法。由于四元数法具有可以全姿态工作、计算工作量小等特点,故本系统采用四元数法。四元数法解姿态角主要有以下几个步骤:

[0052] 1)机体相对导航坐标系角速度

的计算

[0053]

[0054] 其中

为稳瞄平台上陀螺仪的直接输出,

可通过车体速度在导航下投影、地球自转角速度ωie以及上个周期的姿态转移矩阵

求得。

[0055] 2)四元数微分方程的求解

[0056] 四元数微分方程可以获得四元数迭代计算公式。

[0057]

[0058] 其中,ω1、ω2、ω3分别为在一次姿态解算周期内对陀螺仪输出进行3次采样的角速度,即采用3子样采样方法补偿陀螺非定轴转动时,角速度矢量积分产生的计算误差。姿态更新周期h=0.02s。

[0059]

[0060]

[0061] 上式中[]表示向量的矩阵扩展,ΔΦ02=ΔΦx2+ΔΦy2+ΔΦz2。

[0062] 3)四元数规范化

[0063] 由于计算误差使得计算的变换四元数的范数不再等于1,即计算的四元数失去规范性,因此对计算的四元数必须周期地进行规范化处理。设为直接由四元数微分方程计算得到的四元数,而设规范化后的四元数为其中

为相互正交的单位食量,利用最小二乘判据可以求得最优规范化的变换四元数。计算公式如下:

[0064]

[0065] 4)由四元数计算姿态转移矩阵

[0066] 依据四元数表示的固定矢量之间的变换关系,可以获得四元数矩阵与方向余弦的关系为:

[0067]

[0068] 5)由姿态转移矩阵

提取姿态角

[0069]

[0070]

[0071]

[0072] 其中θ、γ、φ分别为捷联惯导系统的俯仰角、横滚角以及航向角,c′11、c′12、c′13、c′21、c′22、c′23、c′31、c′32、c′33分别为姿态转移矩阵

的各元素,定义同上。

[0073] 5.3.3 速度与位置计算

[0074] a)速度计算

[0075] 由于加速度计固连在稳瞄平台上,它的输出是稳瞄平台系相对于惯性空间的加速度在稳瞄平台系上的投影。因此需要把稳瞄平台上的加速度计原始输出

通过姿态转移矩阵

转换到导航坐标系中,记为

[0076]

[0077] 从而可以解算出载体在地理系中的速度,其微分方程为:

[0078]

[0079] 上式中,

分别是

在东向、北向和地向的投影分量,Ve、Vn、Vd分别是东向、北向和地向的速度分量,λ、L分别为当地的精度与纬度,g为当地重力加速度。

[0080] b)位置计算

[0081] 由于载体在地球表面运动,因此导航计算时必须考虑地球曲率的影响。以经纬度和高度作为导航定位单位,由位置微分方程可求得载体的实时位置,其中要用到地球子午面内的曲率半径Rn,垂直于子午面的法线平面内的曲率半径Rm。

[0082] 在北东地指向的地理坐标系下,水平指北编排的捷联惯导系统的算法流程如图3所示,捷联惯导系统算法流程分为3个部分,即惯性测量单元部分,“数学平台”计算部分以及导航计算部分。捷联系统经过初始对准解算已得到了稳瞄平台的初始横滚角γ0,初始俯仰角θ0,初始航向角ψ0,并得到初始化四元数Q(Λ0)与初始化姿态转移矩阵的转置矩阵

,通过四元数微分方程与四元数规范化,结合陀螺仪输出

、导航坐标系相对于惯性坐标系的角速度

以及前一时刻的四元数Q(Λk)得到当前时刻的四元数Q(Λk+1),从而由Q(Λk+1)四元数求解得到姿态转移矩阵的转置矩阵

,并求解出平台的横滚角γ,俯仰角θ以及航向角ψ。将加速度计输出

通过矩阵

转换至

,结合上个时刻载体的纬度L(0)、经度λ(0)、高度h(0)与速度Vt(0)求解当前时刻导航坐标系相对于惯性坐标系的角速度在导航坐标系中的投影

载体的纬度L、经度λ、高度h以及速度Vt,完成整个捷联惯导系统的算法流程。

[0083] 5.4 车辆航姿信息解算及误差分析步骤

[0084] 在利用里程仪信息进行车辆航位推算过程中,由于里程仪输出的是车体坐标系下的信息,因此必须转换到地理坐标系下才能进行航位推算。因此,在进行基于里程仪信息的车辆航位推算以前,需要确定车辆的姿态角,即确定车辆的姿态转移矩阵

[0085] 借助稳定平台的测角元件和炮塔转角测量元件,可以测量出平台相对于稳定平台相对于炮塔的姿态角以及炮塔相对于车辆的航向角;同时,稳定平台上的捷联惯导可以输出平台的姿态角,利用上述信息可以解算出车辆的姿态角信息。在解算姿态角时所用的坐标系如下:

[0086] b系:稳瞄平台坐标系;

[0087] B系:炮塔坐标系;

[0088] V系:车辆坐标系。

[0089] 5.4.1 车辆航姿信息求解

[0090] 根据上述各坐标系的物理连接和运动关系,可以得到车辆坐标系和稳瞄平台坐标系之间的变换关系:

[0091]

[0092] 式中,

由炮塔相对于车体的航向角ψVB来确定,该数值可由炮塔的测角元件测定,所以

[0093]

[0094]

由稳瞄平台相对于炮塔的三个转角(ψP,θP,γP)来确定,该三个数值可由稳瞄平台的测角元件输出,所以

[0095]

[0096] 捷联惯导解算出来的姿态阵为稳瞄平台的姿态,即

互为转置,而车辆在姿态阵为

因此

[0097]

[0098] 由式(16)可以解算出车辆的姿态转移矩阵,从而可以实现在车辆坐标系内输出的里程仪信息转化为导航坐标系内处理,完成车辆的航位推算。

[0099] 5.4.2 车辆姿态误差分析

[0100] 在车辆姿态解算过程中,由于稳瞄平台的航姿角、稳瞄平台的测角元件输出的数值和炮塔的测角元件输出的数值都存在误差,即存在稳瞄平台误差角ψn、稳瞄平台相对于炮塔的转角误差角ψb以及炮塔的航向误差角ψB,因此,利用式(16)进行车辆姿态解算将会把上述误差传递给车辆的姿态转移矩阵,即解算出来的车辆姿态也存在误差。该误差会对利用里程仪解算得到的速度和位置产生影响,因此需要对该姿态误差进行分析。

[0101] 由式(16)可知:

[0102]

[0103]

[0104]

[0105] 其中

为带有误差角的车辆姿态转移矩阵,

为带有误差角ψn的稳瞄平台姿态转移矩阵,

为带有误差角ψb的稳瞄平台相对于炮塔的姿态转移矩阵,

为带有误差角ψB的炮塔相对于车体的姿态转移矩阵,故车辆姿态误差方程为:

[0106]

[0107] 上式中ψ为车辆总的姿态误差角,其他变量同上。

[0108] 5.5 惯导系统和惯性器件的误差分析、建模和补偿步骤

[0109] 高精度的导航定位需要对整个系统和惯性器件进行误差分析,并建立合理的数学模型,采用合适的方式对误差进行估计和补偿,以进一步提高和确保高精度惯导系统的实现,满足载体对系统的导航定位的精度要求。因此,对惯导系统及其惯性器件进行误差分析和建模是导航定位过程中重要的内容。

[0110] 捷联惯性导航系统的误差包括两个方面:惯性传感器误差和捷联惯导系统的基本导航参数误差。因此对误差的建模也就是对这两类的误差建模。

[0111] 1.惯性传感器的误差模型

[0112] 捷联惯性传感器是一类随机性非常强的器件,因此模型主要是对随机误差建模。该随机误差在物理上主要来源于标定、正交、温度、原理等多方面,通常采取抽象的方法进行处理,对IMU的随机误差进行建模处理后,再根据大量的实测数据进行校核以保证模型及其参数的正确性。

[0113] a)陀螺仪漂移数学模型

[0114] 对于光纤陀螺,陀螺漂移误差考虑主要由三部分组成:

[0115] εb=ωg+εc+εr            (19)

[0116] 其中:ωg——随机白噪声漂移,其均方差为σg;

[0117]       εc——随机常值漂移;

[0118]       εr——随机一阶马尔柯夫过程漂移。

[0119] 假定三个轴向的陀螺误差模型均相同,均为:

[0120]

[0121] 上式中,Tr为是相关时间,ωr是均方差为σr的马尔柯夫过程驱动白噪声。

[0122] b)加速度计误差模型

[0123] 对IMU中的加速度计,其误差模型

一般考虑为一阶马尔柯夫过程,且三个轴向的加速度计误差模型相同:

[0124]

[0125] 其中,Ta是马尔柯夫过程的相关时间,ωa是均方差为σa的驱动白噪声。

[0126] 2.捷联惯性导航系统的误差模型

[0127] 捷联惯导系统导航参数误差可分为三部分:姿态误差、速度误差和位置误差,对应的误差模型分别为:平台误差角模型、速度误差模型和位置误差模型。当采用当地水平坐标系为北、东、地时,其误差模型为:

[0128] a)数学平台误差模型:

[0129]

[0130] 上式中φn、φe和φd分别为北向、东向、地向的平台误差角;ve、vn分别为东向与北向速度;ωie为地球自转角速度;L为当地纬度,δL为纬度误差;RM为地球子午圈半径,RN为地球卯酉圈半径;h为当地海拔高度;

分别为北向、东向和地向陀螺仪噪声。

[0131] b)速度误差模型:

[0132] δVn、δVe、δVd为北向、东向、地向的速度误差,fn、fe、fd分别为北向、东向、地向的加速度计输出;δh为海拔高度误差;

分别为北向、东向、天向加速度计误差;其余变量同上。

[0133] c)位置误差模型:

[0134]

[0135] 上式中,δλ为经度误差,其他变量同上。

[0136] 在得到惯性器件和捷联导航系统的误差模型以后,就可以在系统中设法消除或减小各种误差对导航系统精度的影响,从而提高系统的导航定位精度。一般采用外观测量的方式对系统误差和器件误差进行最优估计,将估计结果反馈到系统解算过程中进行误差补偿。

[0137] 5.6 惯导/里程仪/GPS多信息容错组合导航步骤

[0138] 由于里程仪具有长距离工作时误差积累的缺点,因此捷联惯导/里程仪组合导航系统在长距离工作时其导航定位精度会下降。如果利用卫星导航系统误差不随时间和地点积累的优点进行进一步组合,组成捷联惯导/里程仪/GPS多信息组合导航系统,可始终保持对车辆的导航定位性能。为方便起见,在研究阶段,采用GPS系统作为卫星导航系统。考虑到卫星导航系统在实用时的可用性,捷联惯导/里程仪/GPS多信息组合导航可以采用以下两种方案来实现。

[0139] 1.第一种方案:间断地利用GPS信息对捷联惯导/里程仪组合导航系统进行重调。该方案简单易行,比较适合于GPS间歇工作模式。在GPS工作期间,采用GPS信息对该组合导航系统进行一步校正,使导航定位误差减小到卫星定位系统的误差;GPS不工作时,捷联惯导/里程仪在此基础上继续进行组合导航。该方案的系统结构图如图4所示,首先构建一套捷联惯导与里程仪进行速度/位置组合的组合导航系统,实时输出位置与速度信息,在该组合导航系统因长距离工作误差积累超出性能指标要求,且GPS信号可用时,将GPS的位置、速度信息对捷联惯导/里程仪组合导航系统进行一步校正,即将GPS的位置、速度信息对捷联惯导/里程仪组合导航系统相应输出进行重置,提高整体导航精度。经过一次校正,间隔一定时间后可继续运用上述方法校正系统。

[0140] 2.第二种方案:捷联惯导/里程仪/GPS多信息组合联邦滤波结构。该种方案适合于GPS可以持续使用的环境,也适用于GPS可以间断地持续工作一段时间的环境。在联邦滤波结构中,原捷联惯导/里程仪组合导航系统作为子系统1,捷联惯导/GPS组合导航系统作为子系统2,两个子系统分别进行分布式滤波,然后对子系统1和子系统2的滤波结果进行数据融合(联邦滤波),给出捷联惯导系统的误差估计,最后利用估计误差反馈校正惯导系统。

[0141] 联邦滤波算法的结构图如图5所示,该方案将捷联惯导与里程仪进行了位置速度组合滤波解算,同时将捷联惯导与GPS进行了位置、速度组合滤波解算,最后将两个子滤波器的误差状态量估计值经过主滤波器加权平均,求得误差状态量的零均值最小方差估计,并反馈至捷联惯导系统进行闭环校正,提高惯导系统导航定位精度。该方案相对第一种方案具有更强的容错能力。当GPS信息不可用或GPS系统出现故障时,通过联邦滤波器的故障检测与隔离单元检测GPS信号的合理性,并将子系统2隔离掉,这样整个系统就变为捷联惯导/里程仪组合导航系统;当GPS信号可用时,再次将子系统2恢复使用,构成捷联惯导/里程仪/GPS多信息组合联邦滤波系统。该方案不仅使原捷联惯导/里程仪组合导航系统改造方便,而且可以实现在有无GPS信号时整个系统可以平滑地进行组合状态的转换,特别适合于卫星定位系统可用性差的环境,由于GPS的权限问题,该系统中的GPS接收机还可以换成北斗或伽利略卫星定位系统的接收机,以增强信号的可靠性。

[0142] 同理,当里程仪出现故障时,也采用同样的方式隔离捷联惯导/里程仪组合导航子系统1,使系统转换成捷联惯导/GPS组合导航系统。

[0143] 发明的效果

[0144] 本发明从未来作战环境战车的导航/稳瞄一体化系统的性能需求入手,基于卡尔曼滤波最优加权平均的本质,结合稳瞄平台的转动,通过对惯导速度和比力输出的观测,实现对惯导系统平台失准角的最优估计与补偿,为战车提供高精度的姿态信息,并通过与里程仪和卫星导航系统的组合,为战车提供高精度的定位信息,提高战车的战场生存与综合作战能力。

[0145] 对于中高精度光纤陀螺惯性导航系统,静基座初始对准的时间一般在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θ分别为
中的各元素,γ为平台横滚角、θ为平台俯仰角、φ为平台航向角,
为平台姿态转移矩阵
的转置矩阵,
由横滚角γ、俯仰角θ、航向角φ的三角函数构成,即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)基于车载稳瞄平台的惯性导航解算步骤:该步骤由高精度姿态解算与速度、位置解算组成,惯导系统姿态解算首先利用公式计算机体相对导航坐标系角速率
式中
为稳瞄平台上陀螺仪的直接输出,
可通过车体速度在导航下投影、地球自转角速度ωie以及上个周期的姿态转移矩阵
求得,然后采用四元数微分方程求解姿态转移矩阵
对应的的四元数,式中l为四元数计算的时间间隔,ω1、ω2、ω3分别为在一次姿态解算周期内对陀螺仪输出进行3次采样的角速率,即采用3子样采样方法补偿陀螺非定轴转动时,角速度矢量积分产生的计算误差。姿态更新周期h=0.02s,将得到的四元数利用公式i=0,1,2,3进行规范化,式中为直接由四元数微分方程计算得到的四元数,而设规范化后的四元数为其中
为相互正交的单位食量,然后将规范化后的四元数通过公式生成姿态转移矩阵
定义同上,最后利用公式从
中提取横滚角γ、俯仰角θ、航向角φ信息,其中c′11、c′12、c′13、c′21、c′22、c′23、c′31、c′32、c′33分别为姿态转移矩阵
的各元素,定义同上。惯导系统(即车辆)速度、位置解算方法则将加速度计输出通过平台
的转置矩阵
从载体坐标系转换到导航坐标系,并通过解算比力微分方程得到导航系统速度vep,再将导航系统速度vep经过一次积分得到导航系统位置,式中f为加速度计输出,ωie为地球自转角速度,ωep为稳瞄平台相对于地球的角速度;
(4)车辆航姿信息解算及误差分析步骤:借助稳定平台的测角元件和炮塔转角测量元件,测量出平台相对于炮塔姿态转移矩阵
ψP,θP,γP为稳瞄平台相对于炮塔的三个转角;炮塔相对于车辆的姿态转移矩阵
ψVB为炮塔相对于车体的航向角;同时稳定平台上的惯导系统输出上述平台的姿态转移矩阵
利用上述平台相对于炮塔姿态转移矩阵
炮塔相对于车辆的姿态转移矩阵
平台的姿态转移矩阵
三个矩阵信息可以解算出车辆的横滚角、俯仰角、航向角信息,并对姿态误差进行分析与修正;
(5)惯导系统和惯性器件的误差分析、建模和补偿步骤:惯导系统的误差分为数学平台误差、速度误差和位置误差,数学平台误差模型为,式中φn、φe和φd分别为北向、东向、地向的平台误差角;ve、vn分别为东向与北向速度;ωie为地球自转角速度;L为当地纬度,δL为纬度误差;RM为地球子午圈半径,RN为地球卯酉圈半径;h为当地海拔高度;
分别为北向、东向和地向陀螺仪噪声,速度误差模型为,式中δVn、δVe、δVd为北向、东向、地向的速度误差,fn、fe、fd分别为北向、东向、地向的加速度计输出;δh为海拔高度误差;
分别为北向、东向、天向加速度计误差;其余变量定义同上,
位置误差方程为,式中δλ为经度误差,其他变量定义同上,惯性器件误差则是一类强非线性误差,陀螺漂移误差考虑主要由三部分组成:εb=ωg+εc+εr,式中ωg为随机白噪声漂移,其均方差为σg,εc为随机常值漂移,εr为随机一阶马尔柯夫过程漂移,设三个轴向的陀螺误差模型相同,均为:式中Tr为相关时间,ωr是均方差为σr的马尔柯夫过程驱动白噪声,加速度计误差模型
一般考虑为一阶马尔柯夫过程,且三个轴向的加速度计误差模型相同:式中,Ta是马尔柯夫过程的相关时间,ωa是均方差为σa的驱动白噪声,本发明采用里程仪(或GPS)与惯导之间的速度误差、位置误差作为观测量,以卡尔曼滤波的方式对姿态、速度、位置等系统误差以及陀螺仪漂移、加速度计偏置等惯性器件误差进行零均值最小方差估计,通过闭环反馈修正进行误差补偿;
(6)惯导/里程仪/GPS多信息容错组合导航步骤:该步骤采用两种方案实现,第一种方案采用间断地利用GPS信息对惯导/里程仪组合导航系统进行重调,首先构建一套捷联惯导与里程仪进行速度/位置组合的组合导航系统,实时输出位置与速度信息,在GPS信号可用时,将GPS的位置、速度信息对捷联惯导/里程仪组合导航系统输出进行校正,提高整体导航精度。经过一次校正,间隔一定时间后继续运用上述方法校正系统;第二种方案采用惯导/里程仪/GPS多信息组合联邦滤波结构,该方案将捷联惯导与里程仪进行了位置速度组合滤波解算,同时将捷联惯导与GPS进行了位置、速度组合滤波解算,最后将两个子滤波器的误差状态量估计值经过主滤波器加权平均,求得误差状态量的零均值最小方差估计,并反馈至捷联惯导系统进行闭环校正,提高惯导系统导航定位精度。
CN2008100192932A 2008-01-18 2008-01-18 导航/稳瞄一体化系统的导航、稳瞄方法 CN101413800B (zh)

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 true CN101413800A (zh) 2009-04-22
CN101413800B CN101413800B (zh) 2010-09-29

Family

ID=40594442

Family Applications (1)

Application Number Title Priority Date Filing Date
CN2008100192932A CN101413800B (zh) 2008-01-18 2008-01-18 导航/稳瞄一体化系统的导航、稳瞄方法

Country Status (1)

Country Link
CN (1) CN101413800B (zh)

Cited By (39)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101793523A (zh) * 2010-03-10 2010-08-04 北京航空航天大学 一种组合导航和光电探测一体化系统
CN101936738A (zh) * 2010-08-19 2011-01-05 中国航空工业第六一八研究所 对平台式惯性导航系统速率通道的改进方法
CN101949710A (zh) * 2010-07-28 2011-01-19 北京泰豪联星技术有限公司 Gnss辅助mems惯性传感器零偏的快速在线动态标定方法
CN102060105A (zh) * 2010-11-23 2011-05-18 中国兵器工业第二〇五研究所 带倾斜补偿的航向校准装置
CN102087299A (zh) * 2009-12-03 2011-06-08 索尼公司 速度计算设备、速度计算方法、导航设备和带导航功能的移动电话机
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 中国航空工业第六一八研究所 一种惯性/卫星组合导航系统开闭环混合修正方法
CN102506858A (zh) * 2011-10-21 2012-06-20 北京泰豪联星技术有限公司 卫星导航系统辅助的惯性传感器轴向快速识别方法
CN102520726A (zh) * 2011-12-19 2012-06-27 南京航空航天大学 大攻角飞行状态下的大气攻角及侧滑角估计方法
CN102520735A (zh) * 2011-12-29 2012-06-27 中国科学院长春光学精密机械与物理研究所 一种抑制单杆跟踪零位漂移的有效方法
CN102556122A (zh) * 2012-01-18 2012-07-11 张卫国 列车导航监控预警系统及其预警方法
CN102607556A (zh) * 2012-01-18 2012-07-25 北京自动化控制设备研究所 一种基于雷速的中精度航姿系统组合导航方法
CN102636081A (zh) * 2011-12-29 2012-08-15 南京航空航天大学 一种基于视觉运动建模的传递对准方法及装置
CN102706367A (zh) * 2012-06-19 2012-10-03 北京航空航天大学 一种用于组合导航的单波束激光测速仪精度测试与计算方法
CN102706365A (zh) * 2012-06-19 2012-10-03 北京航空航天大学 一种基于导航系统的三波束激光测速仪标定方法
CN102997916A (zh) * 2011-09-15 2013-03-27 北京自动化控制设备研究所 一种自主提高定位定向系统惯性姿态解算精度的方法
CN102999048A (zh) * 2011-09-08 2013-03-27 中国航天科工集团第二研究院二0七所 一种车载动基座光电搜索跟踪转台的伺服控制方法
WO2013139168A1 (zh) * 2012-03-19 2013-09-26 Zhao Wenzhi 一种自动瞄准二次加速矩阵炮
CN103353310A (zh) * 2013-06-01 2013-10-16 西北工业大学 一种激光捷联惯性导航系统
CN103743414A (zh) * 2014-01-02 2014-04-23 东南大学 一种里程计辅助车载捷联惯导系统行进间初始对准方法
CN103759730A (zh) * 2014-01-16 2014-04-30 南京师范大学 一种基于导航信息双向融合的行人与智能移动载体的协同导航系统及其导航方法
CN103940422A (zh) * 2014-05-08 2014-07-23 中北大学 射击射箭运动复合姿态参数获取系统
CN104296598A (zh) * 2013-07-18 2015-01-21 贵州贵航飞机设计研究所 一种无人机载光电稳瞄系统抗烟雾稳定跟踪照射目标的方法
CN104317217A (zh) * 2014-10-09 2015-01-28 西安应用光学研究所 航空相机稳定平台无超调伺服控制方法
CN104359492A (zh) * 2014-11-03 2015-02-18 中国科学院合肥物质科学研究院 惯性导航和轮速计组成的航迹推算定位系统误差估算算法
CN104567888A (zh) * 2014-12-25 2015-04-29 大连楼兰科技股份有限公司 基于速度在线修正的惯性导航车辆姿态测量方法
CN104635251A (zh) * 2013-11-08 2015-05-20 中国地质大学(北京) 一种ins/gps组合定位定姿新方法
CN104697526A (zh) * 2015-03-26 2015-06-10 上海华测导航技术股份有限公司 用于农业机械的捷联惯导系统以及控制方法
CN104848842A (zh) * 2014-03-25 2015-08-19 北京空间机电研究所 一种利用寻北仪实现航空相机航迹跟踪成像的方法
CN105378432A (zh) * 2013-03-15 2016-03-02 谷歌公司 用于姿态校正的系统和方法
CN105421200A (zh) * 2015-11-06 2016-03-23 苏交科集团股份有限公司 一种基于振动检测的平整度检测方法与检测装置
CN106297361A (zh) * 2015-05-20 2017-01-04 无锡卓信信息科技有限公司 一种车机和惯性导航结合的区域精确定位系统及定位方法
CN106482734A (zh) * 2016-09-28 2017-03-08 湖南优象科技有限公司 一种用于imu多传感器数据融合的滤波方法
CN104503487B (zh) * 2014-12-25 2017-04-05 湖南中电天恒信息科技股份有限公司 一种升降平台的测量控制系统及测量控制方法
CN104180821B (zh) * 2014-08-27 2017-04-19 北京航空航天大学 一种基于同步测量与定位计算的里程计标定方法
CN106780699A (zh) * 2017-01-09 2017-05-31 东南大学 一种基于sins/gps和里程计辅助的视觉slam方法
CN108896045A (zh) * 2018-06-25 2018-11-27 南京航空航天大学 一种无加速度计的惯性导航系统和导航方法
CN109001829A (zh) * 2018-07-12 2018-12-14 中国人民解放军国防科技大学 一种捷联式水下动态重力测量仪

Family Cites Families (3)

* Cited by examiner, † Cited by third party
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
CN100593731C (zh) * 2006-09-04 2010-03-10 南京航空航天大学 基于北斗双星系统的快速测量载体姿态的方法
CN101033973B (zh) * 2007-04-10 2010-05-19 南京航空航天大学 微小型飞行器微惯性组合导航系统的姿态确定方法

Cited By (60)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102087299B (zh) * 2009-12-03 2012-11-21 索尼公司 速度计算设备、速度计算方法、导航设备和带导航功能的移动电话机
CN102087299A (zh) * 2009-12-03 2011-06-08 索尼公司 速度计算设备、速度计算方法、导航设备和带导航功能的移动电话机
CN101793523A (zh) * 2010-03-10 2010-08-04 北京航空航天大学 一种组合导航和光电探测一体化系统
CN101793523B (zh) * 2010-03-10 2011-08-17 北京航空航天大学 一种组合导航和光电探测一体化系统
CN101949710A (zh) * 2010-07-28 2011-01-19 北京泰豪联星技术有限公司 Gnss辅助mems惯性传感器零偏的快速在线动态标定方法
CN101949710B (zh) * 2010-07-28 2013-01-02 北京泰豪联星技术有限公司 Gnss辅助mems惯性传感器零偏的快速在线动态标定方法
CN101936738A (zh) * 2010-08-19 2011-01-05 中国航空工业第六一八研究所 对平台式惯性导航系统速率通道的改进方法
CN102060105A (zh) * 2010-11-23 2011-05-18 中国兵器工业第二〇五研究所 带倾斜补偿的航向校准装置
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七所 一种车载动基座光电搜索跟踪转台的伺服控制方法
CN102999048A (zh) * 2011-09-08 2013-03-27 中国航天科工集团第二研究院二0七所 一种车载动基座光电搜索跟踪转台的伺服控制方法
CN102997916B (zh) * 2011-09-15 2015-08-05 北京自动化控制设备研究所 一种自主提高定位定向系统惯性姿态解算精度的方法
CN102997916A (zh) * 2011-09-15 2013-03-27 北京自动化控制设备研究所 一种自主提高定位定向系统惯性姿态解算精度的方法
CN102506858B (zh) * 2011-10-21 2014-07-02 北京北方联星科技有限公司 卫星导航系统辅助的惯性传感器轴向快速识别方法
CN102506858A (zh) * 2011-10-21 2012-06-20 北京泰豪联星技术有限公司 卫星导航系统辅助的惯性传感器轴向快速识别方法
CN102520726A (zh) * 2011-12-19 2012-06-27 南京航空航天大学 大攻角飞行状态下的大气攻角及侧滑角估计方法
CN102520735B (zh) * 2011-12-29 2014-07-09 中国科学院长春光学精密机械与物理研究所 一种抑制单杆跟踪零位漂移的有效方法
CN102636081A (zh) * 2011-12-29 2012-08-15 南京航空航天大学 一种基于视觉运动建模的传递对准方法及装置
CN102520735A (zh) * 2011-12-29 2012-06-27 中国科学院长春光学精密机械与物理研究所 一种抑制单杆跟踪零位漂移的有效方法
CN102607556A (zh) * 2012-01-18 2012-07-25 北京自动化控制设备研究所 一种基于雷速的中精度航姿系统组合导航方法
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 一种自动瞄准二次加速矩阵炮
CN102706365A (zh) * 2012-06-19 2012-10-03 北京航空航天大学 一种基于导航系统的三波束激光测速仪标定方法
CN102706367B (zh) * 2012-06-19 2014-12-24 北京航空航天大学 一种用于组合导航的单波束激光测速仪精度测试与计算方法
CN102706365B (zh) * 2012-06-19 2014-09-10 北京航空航天大学 一种基于导航系统的三波束激光测速仪标定方法
CN102706367A (zh) * 2012-06-19 2012-10-03 北京航空航天大学 一种用于组合导航的单波束激光测速仪精度测试与计算方法
CN105378432A (zh) * 2013-03-15 2016-03-02 谷歌公司 用于姿态校正的系统和方法
CN105378432B (zh) * 2013-03-15 2019-06-18 谷歌有限责任公司 用于姿态校正的系统和方法
CN103353310B (zh) * 2013-06-01 2017-06-09 西北工业大学 一种激光捷联惯性导航系统
CN103353310A (zh) * 2013-06-01 2013-10-16 西北工业大学 一种激光捷联惯性导航系统
CN104296598A (zh) * 2013-07-18 2015-01-21 贵州贵航飞机设计研究所 一种无人机载光电稳瞄系统抗烟雾稳定跟踪照射目标的方法
CN104635251A (zh) * 2013-11-08 2015-05-20 中国地质大学(北京) 一种ins/gps组合定位定姿新方法
CN104635251B (zh) * 2013-11-08 2017-07-07 中国地质大学(北京) 一种ins/gps组合定位定姿新方法
CN103743414A (zh) * 2014-01-02 2014-04-23 东南大学 一种里程计辅助车载捷联惯导系统行进间初始对准方法
CN103743414B (zh) * 2014-01-02 2016-07-06 东南大学 一种里程计辅助车载捷联惯导系统行进间初始对准方法
CN103759730A (zh) * 2014-01-16 2014-04-30 南京师范大学 一种基于导航信息双向融合的行人与智能移动载体的协同导航系统及其导航方法
CN103759730B (zh) * 2014-01-16 2016-06-29 南京师范大学 一种基于导航信息双向融合的行人与智能移动载体的协同导航系统及其导航方法
CN104848842A (zh) * 2014-03-25 2015-08-19 北京空间机电研究所 一种利用寻北仪实现航空相机航迹跟踪成像的方法
CN103940422A (zh) * 2014-05-08 2014-07-23 中北大学 射击射箭运动复合姿态参数获取系统
CN104180821B (zh) * 2014-08-27 2017-04-19 北京航空航天大学 一种基于同步测量与定位计算的里程计标定方法
CN104317217B (zh) * 2014-10-09 2016-11-16 西安应用光学研究所 航空相机稳定平台无超调伺服控制方法
CN104317217A (zh) * 2014-10-09 2015-01-28 西安应用光学研究所 航空相机稳定平台无超调伺服控制方法
CN104359492B (zh) * 2014-11-03 2017-03-01 中国科学院合肥物质科学研究院 惯性导航和轮速计组成的航迹推算定位系统误差估算算法
CN104359492A (zh) * 2014-11-03 2015-02-18 中国科学院合肥物质科学研究院 惯性导航和轮速计组成的航迹推算定位系统误差估算算法
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 无锡卓信信息科技有限公司 一种车机和惯性导航结合的区域精确定位系统及定位方法
CN106297361A (zh) * 2015-05-20 2017-01-04 无锡卓信信息科技有限公司 一种车机和惯性导航结合的区域精确定位系统及定位方法
CN105421200A (zh) * 2015-11-06 2016-03-23 苏交科集团股份有限公司 一种基于振动检测的平整度检测方法与检测装置
CN105421200B (zh) * 2015-11-06 2017-06-27 苏交科集团股份有限公司 一种基于振动检测的平整度检测方法与检测装置
CN106482734A (zh) * 2016-09-28 2017-03-08 湖南优象科技有限公司 一种用于imu多传感器数据融合的滤波方法
CN106780699A (zh) * 2017-01-09 2017-05-31 东南大学 一种基于sins/gps和里程计辅助的视觉slam方法
CN108896045B (zh) * 2018-06-25 2020-08-04 南京航空航天大学 一种无加速度计的惯性导航系统和导航方法
CN108896045A (zh) * 2018-06-25 2018-11-27 南京航空航天大学 一种无加速度计的惯性导航系统和导航方法
CN109001829A (zh) * 2018-07-12 2018-12-14 中国人民解放军国防科技大学 一种捷联式水下动态重力测量仪

Also Published As

Publication number Publication date
CN101413800B (zh) 2010-09-29

Similar Documents

Publication Publication Date Title
US9488480B2 (en) Method and apparatus for improved navigation of a moving platform
US9784582B2 (en) Method and apparatus for navigation with nonlinear models
CN103675861B (zh) 一种基于星载gnss多天线的卫星自主定轨方法
Georgy et al. Low-cost three-dimensional navigation solution for RISS/GPS integration using mixture particle filter
Bar-Itzhack et al. Control theoretic approach to inertial navigation systems
AU2010201337B2 (en) North finding device, system and method
CN102829777B (zh) 自主式水下机器人组合导航系统及方法
CA2837179C (en) Determining spatial orientation information of a body from multiple electromagnetic signals
US8311757B2 (en) Miniaturized smart self-calibration electronic pointing method and system
Wang et al. Integration of GPS/INS/vision sensors to navigate unmanned aerial vehicles
Titterton et al. Strapdown inertial navigation technology
Shin et al. Accuracy improvement of low cost INS/GPS for land applications
Georgy et al. Modeling the stochastic drift of a MEMS-based gyroscope in gyro/odometer/GPS integrated navigation
CN201266089Y (zh) Ins/gps组合导航系统
US5506588A (en) Attitude determining system for use with global positioning system, and laser range finder
CA2537961C (en) Inertial gps navigation system using injected alignment data for the inertial system
CN106289246B (zh) 一种基于位置和姿态测量系统的柔性杆臂测量方法
CN102621565B (zh) 一种机载分布式pos的传递对准方法
Hasan et al. A review of navigation systems (integration and algorithms)
CN102506857B (zh) 一种基于双imu/dgps组合的相对姿态测量实时动态滤波方法
US8005635B2 (en) Self-calibrated azimuth and attitude accuracy enhancing method and system (SAAAEMS)
CN103575299B (zh) 利用外观测信息的双轴旋转惯导系统对准及误差修正方法
CN104635251B (zh) 一种ins/gps组合定位定姿新方法
CN103245359B (zh) 一种惯性导航系统中惯性传感器固定误差实时标定方法
Fakharian et al. Adaptive Kalman filtering based navigation: An IMU/GPS integration approach

Legal Events

Date Code Title Description
PB01 Publication
C06 Publication
SE01 Entry into force of request for substantive examination
C10 Entry into substantive examination
GR01 Patent grant
C14 Grant of patent or utility model
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20100929

Termination date: 20140118

C17 Cessation of patent right