CN106525034B - 一种基于对偶四元数的惯导***传递对准建模方法 - Google Patents
一种基于对偶四元数的惯导***传递对准建模方法 Download PDFInfo
- Publication number
- CN106525034B CN106525034B CN201610948668.8A CN201610948668A CN106525034B CN 106525034 B CN106525034 B CN 106525034B CN 201610948668 A CN201610948668 A CN 201610948668A CN 106525034 B CN106525034 B CN 106525034B
- Authority
- CN
- China
- Prior art keywords
- navigation system
- inertial navigation
- sub
- main
- rotation
- 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
- 230000009977 dual effect Effects 0.000 title claims abstract description 182
- 238000000034 method Methods 0.000 title claims abstract description 64
- 238000012546 transfer Methods 0.000 title claims abstract description 46
- 238000013519 translation Methods 0.000 claims abstract description 25
- 230000014509 gene expression Effects 0.000 claims abstract description 24
- 238000001914 filtration Methods 0.000 claims abstract description 11
- 238000005259 measurement Methods 0.000 claims abstract description 7
- 238000010276 construction Methods 0.000 claims abstract description 5
- 230000009897 systematic effect Effects 0.000 claims abstract description 4
- 238000004364 calculation method Methods 0.000 claims description 92
- 239000013598 vector Substances 0.000 claims description 62
- 230000001133 acceleration Effects 0.000 claims description 23
- 239000011159 matrix material Substances 0.000 claims description 18
- 230000008569 process Effects 0.000 claims description 17
- 238000009795 derivation Methods 0.000 claims description 4
- 229910000831 Steel Inorganic materials 0.000 claims description 3
- 239000010959 steel Substances 0.000 claims description 3
- 230000003068 static effect Effects 0.000 claims description 2
- 238000004422 calculation algorithm Methods 0.000 abstract description 7
- 238000000926 separation method Methods 0.000 abstract description 3
- 238000011160 research Methods 0.000 description 7
- 238000006243 chemical reaction Methods 0.000 description 4
- 230000000694 effects Effects 0.000 description 4
- 230000010354 integration Effects 0.000 description 4
- 238000004088 simulation Methods 0.000 description 3
- 230000009466 transformation Effects 0.000 description 3
- 238000011161 development Methods 0.000 description 2
- 101150091111 ACAN gene Proteins 0.000 description 1
- 230000002411 adverse Effects 0.000 description 1
- 230000008901 benefit Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 230000010365 information processing Effects 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000010606 normalization Methods 0.000 description 1
- 238000005096 rolling process Methods 0.000 description 1
- 239000004576 sand Substances 0.000 description 1
- 230000026676 system process Effects 0.000 description 1
- 238000012795 verification Methods 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/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
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Navigation (AREA)
Abstract
本发明提出了一种基于对偶四元数的惯导***传递对准建模方法,构造主惯导***和子惯导***间的标称对偶四元数、计算对偶四元数分别来描述子惯导***载体系相对于主惯导***载体系、计算载体系的旋转和平移运动,通过推理主惯导***与子惯导***的相对旋转和平移运动的旋量表达式,构建传递对准的标称对偶四元数微分方程和计算对偶四元数的微分方程;联合加速度计参数误差方程和陀螺仪误差微分方程获得对偶四元数误差方程;利用加速度计的线速度和陀螺仪的旋转角速度构造***观测量方程,由kalman滤波迭代计算获得子惯导***的初始标定参数,摆脱了旋转和平移分离计算带来的圆锥误差和划船误差的影响,有效提高了计算精度和计算效率。
Description
技术领域
本发明涉及航空航天***信息处理的技术领域,具体涉及一种基于对偶四元数的惯导***传递对准建模方法。
背景技术
惯性导航***是一套复杂的高精度机电综合***,历经了平台式惯性导航***和捷联式惯性导航***,其中早期的平台式惯导***的姿态信息是由陀螺力矩为主的万向支架构建的稳定平台直接提供,而捷联式惯导***(捷联式惯导***)将惯性组件(InertialMeasurement Unit,IMU)直接固连在载体上,利用计算机平台替代物理平台,具备了体积小、成本低和可靠性高等特点。但是,捷联惯性导航***对IMU组件的性能提出了更高的要求,必须根据陀螺仪输出的角速度计算并维持一个数学平台,在此数学平台上由加速度计输出积分获得速度和位置信息。因此,捷联惯性导航方法在捷联式惯导***中具有非常重要的作用。
在捷联式惯性导航***中导航计算机的主要任务是实现角速度积分计算获取载体姿态信息,即姿态解算,利用获取的姿态信息将加速度变换到合适的导航坐标系,再进行加速度积分计算获取载体的速度信息,进而对速度积分获取载***置信息,这两步也称为导航解算。为了保证导航方法误差与惯性组件引入的误差相比足够小以致可以忽略不计,上述三个积分过程必须采用高精度的数值积分方法,如选用四阶以上的Runge-Kutta法才能满足捷联式惯导***微分方程的数值积分精度要求,以此来降低转动的不可交换性带来的负面影响,如圆锥(Coning)效应、划船(Sculling)效应和卷轴(Scrolling)效应等影响,也可以说捷联惯性导航方法的发展过程就是一个寻求高动态环境下的高精度数值积分方法的发展史。
捷联式惯性导航***不同于平台式惯导***的重要特点就是以计算机实现数学平台替代物理平台,数学平台根据IMU组件感测的数据信息计算和描述坐标系间的转换关系,这种转换关系中有三个转动自由度和三个平移自由度。通常的坐标转换关系采用方向余弦法(DCM),利用DCM表示转动,向量表示平移运动,它需要九个未知元素,计算量较大;而四元数法有四个元素,计算量小、精度较高,目前大多采用四元数法实现载体姿态转动的最简洁表达方式。但是,这些传统的姿态描述方法都把载体旋转运动和平移运动割裂开来,实际上Charles定理表明任何刚体运动都可以通过绕某个轴的旋转和沿相同轴的平移运动实现。因此,这种旋转和平移组合运动很像是一种螺旋运动,可以用螺旋变换或者螺旋运动来描述一般性刚体运动。1873年Clifford提出了对偶数(Dual number)概念,并构建了对偶四元数代数(Dual Quaternion)来描述螺旋变换,其特点是对偶四元数把刚体的旋转与平移运动统一考虑,数学表达直观明了。
同时,20世纪90年代Branets把对偶四元数代数应用于惯性导航***的领域,首次论述了捷联式惯性导航***理论分析中对偶四元数代数建模的可行性,并勾画了利用对偶四元数描述捷联式惯性导航***中坐标系转换的基本框架。实际上利用对偶四元数开展捷联式惯性导航***建模研究还带来一个优势,就是可以实现捷联式惯性导航***的无平台计算。利用对偶四元数建立捷联式惯导***模型的过程中,基于推力坐标系T、引力坐标系I和位置坐标系U来实现,摈弃了以前物理平台或者数学平台的不利影响,这对于现代的无平台惯导***理论研究将会开辟一条新的途径。
本发明基于对偶四元数描述方法,在推力坐标系、引力坐标系和位置坐标系基础上研究一种新型的对偶四元数描述的捷联式惯导***传递对准模型算法。通过查阅已发表文献可知利用对偶四元数建立惯导***导航方法和捷联式惯导***的初始对准模型方法都已经出现了,但是对于现代导航***在载体运动情形下的传递对准过程的建模研究还没有相关文献资料,更多的是利用四元数、修正罗德里格斯参数或者欧拉角法实现传递对准***建模研究分析。基于前人文献资料的分析研究,本发明采用对偶四元数法构建传递对准模型算法具有较强的创新性,并且与传统的姿态描述方法建模获得的传递对准模型算法相比,传递对准的对偶四元数模型计算量小,计算效率高,并且脱离了捷联平台的影响,能够有效扩展对偶四元数在惯导***中的应用,也开辟了捷联惯导***模型研究的新途径。传递对准是解决舰载机捷联式惯导***在舰船载体运动情况下海上对准问题的主要方法,它是利用舰船惯导装置导航参数与机载惯导***相应导航参数匹配计算,利用滤波算法估计机载惯导***失准角等导航参数,进而对机载惯导***导航参数初始化。
发明内容
为了解决上述技术问题,本发明提出一种基于对偶四元数的惯导***传递对准建模方法,基于对偶四元数描述,在推力坐标系、引力坐标系和位置坐标系下构建传递对准模型,脱离了捷联平台影响;利用对偶四元数来统一描述载体姿态转动和平移运动过程,摆脱了传统方法的旋转和平移分离计算带来的捷联计算中圆锥误差和划船误差的影响,有效提高了的计算精度和计算效率。
为了达到上述目的,本发明的技术方案是:一种基于对偶四元数的惯导***传递对准建模方法,其步骤如下:
步骤一:设定舰船主惯导***的载体坐标系为m,舰载机子惯导***的标称载体坐标系为s,舰载机子惯导***的计算载体坐标系为s’;利用对偶四元数定义主惯导***载体系m与子惯导***的标称载体坐标系s间的标称对偶四元数向量利用对偶四元数定义主惯导***载体坐标系m相对于子惯导***计算载体系s’间的计算对偶四元数向量其中,表示主惯导***载体坐标系m相对于导航坐标系n在子惯导***的标称载体坐标系s中的投影四元数,表示对偶算子,r表示主惯导***与子惯导***标称载体坐标系间的杆臂矢量,表示主惯导***载体坐标系m相对于导航坐标系n在子惯导***的计算载体坐标系s′中的投影四元数,r'表示主惯导***相对于子惯导***的计算载体坐标系s′间的杆臂矢量;
步骤二:在传递对准过程中,标称子惯导***相对于主惯导***是静止的,构造主惯导***载体系m与子惯导***的标称载体坐标系s间的标称对偶四元数向量误差微分方程:把标称对偶四元数向量误差微分方程作为***模型方程的一部分参与***状态变量的最优滤波计算;
步骤三:考虑主惯导***载体系m与子惯导***的标称载体坐标系s旋量间的关系,主惯导***载体系m与子惯导***的标称载体坐标系s相对旋转与平移的对偶四元数旋量 其中,表示主惯导***载体坐标系m相对于导航坐标系n的对偶四元数旋量,表示子惯导***的标称载体坐标系相对于导航坐标系n的对偶四元数旋量,εs表示子惯导***中的陀螺零漂移误差量;
步骤四:构造主惯导***载体系m与子惯导***的计算载体坐标系为s’间的标称对偶四元数向量误差微分方程:其中,表示子惯导***的计算载体坐标系相对于主惯导***的旋量在导航坐标系中的投影,(.)*表示向量的逆;
步骤五:联合加速度计误差微分方程:陀螺仪误差微分方程:主惯导***和子惯导***间的杆臂矢量微分方程:构建主惯导***和子惯导***间的传递对准***误差模型方程:
其中,ε表示***中陀螺仪随机漂移的三维矢量,表示***中加速度计的三维零漂移误差量;连同三维杆臂矢量和八维的标称对偶四元数微分方程,***模型中需要添加017×17的零矩阵;
步骤六:考虑线速度误差和旋转角速度误差,构造主惯导***与子惯导***传递对准过程中的对偶四元数旋量的观测方程:
其中,表示观测模型中的计算子惯导***相对于主惯导***在导航坐标系中观测到的对偶旋量,表示计算子惯导***相对于主惯导***的旋量在导航系中的投影的观测量;Bω表示***陀螺仪和加速度计的偏差的对偶量,ηω表示***速度旋量的观测噪声;
步骤七:利用Kalman滤波方法求解传递对准***误差模型方程和观测旋量方程,获得***状态变量:标称姿态失准角、计算姿态失准角、加速度计和陀螺仪参数的计算。
所述主惯导***载体系m与子惯导***的计算载体坐标系为s’间的标称对偶四元数向量误差微分方程的构建方法是:
根据对偶四元数的微分表达式计算对偶四元数向量的微分方程表达式:其中,表示主惯导***与计算子惯导***间的旋量,且
其中,表示主惯导***相对于导航坐标系的旋转角速度在计算子惯导***中的投影,表示主惯导***相对于导航坐标系的线速度在计算子惯导***中的投影的微分,表示主惯导***相对于导航坐标系的旋转四元数在计算子惯导***中的投影的共轭;
主惯导***相对于导航坐标系的线速度在计算子惯导***中的投影的微分可表示为其中表示主惯导***的线加速度,表示计算子惯导***的线加速度,表示杆臂矢量的加速度,根据惯导***速度方程得:
其中,fm表示主惯导***的比力,表示主惯导***的旋转四元数,表示主惯导***的地球自转角速度,表示主惯导***相对于地球坐标系e的旋转角速度,Vm表示主惯导***的速度,gm表示导航坐标系中的重力加速度;
主惯导***和子惯导***间的杆臂误差速度表达为其微分方程为:
其中,表示主惯导***相对于导航坐标系的旋转角速度,rm表示杆臂矢量,表示主惯导***相对于地球坐标系的旋转角速度的微分;
那么可以获得主惯导***与子惯导***速度误差表达式:
其中,是的逆,表示主子惯导***间的相对速度误差在导航坐标系中的投影,表示计算子惯导***相对于导航系的旋转四元数,fs表示子惯导***的测量比力,表示主惯导***相对于计算子惯导***的旋转四元数,主子惯导***间的旋转四元数,表示主惯导***相对于计算子惯导***的旋转四元数的逆,表示地球自转角速度,表示地球自转角速度在导航坐标系中的投影,表示主惯导***相对于地球坐标系的旋转角速度,表示计算子惯导***和主惯导***间的相对线速度在导航系中的投影,rn表示导航系中的杆臂矢量,表示子惯导***的加速度计测量偏差;
针对主惯导***的对偶四元数以及子惯导***的对偶四元数的微分方程分别为:
其中,表示主惯导***的对偶四元数的微分,表示主惯导***的对偶四元数,表示主惯导***的旋量;
主惯导***与子惯导***的旋转对偶四元数间的关系:其中,表示子惯导***的旋量,表示主子惯导***间的对偶四元数的共轭,表示主子惯导***间的相对旋量在导航系中的投影,表示主子惯导***间的对偶四元数;
利用方向余弦矩阵表达旋转角速度与间的关系为:其中,表示主子惯导***间的方向余弦矩阵;对主惯导***的对偶四元数分解得:对其两边同时求导整理得:
其中,表示主惯导***相对于导航坐标系的对偶四元数在计算子惯导***的投影,表示计算子惯导***相对于导航系的对偶四元数,表示主惯导***的对偶四元数的微分,表示计算子惯导***的对偶四元数的微分,表示主惯导***相对于导航坐标系的对偶四元数;
结合主惯导***与子惯导***的姿态对偶四元数微分方程获得:
其中,表示标称子惯导***相对于导航系的旋量,表示主惯导***相对于导航系的旋量;
考虑主惯导***与子惯导***间的旋量间的关系,主惯导***与子惯导***间的相对旋转与平移的对偶四元数旋量为:
从而得那么其逆为:
获得主惯导***与子惯导***的姿态平移对偶四元数误差方程为:
所述加速度计误差微分方程和陀螺仪误差微分方程的构建方法是:
***观测旋量表达的是主子惯导***与惯导***间的相对旋转与平移误差对偶四元数向量,其显性表达式为:
其中,是主惯导***与子惯导***间的旋转误差矢量,且: 表示主子惯导***间的相对线速度误差,且:
子惯导***敏感到的角速度和加速度可分别表示为:
其中,表示能被主惯导***敏感到的载体角速度在子惯导***惯性系i中的投影,ε为陀螺零偏误差,为主惯导***敏感到的载体加速度在子惯导***惯性系i中的投影,为载体转动引起的子惯导***杆臂加速度,为加速度计的零偏误差,ng和na为随机噪声;
待标参数误差为常值误差,随机噪声为零均值不相关白噪声,则有:
所述主惯导***与子惯导***传递对准过程中的对偶四元数旋量的观测旋量方程的构建方法是:采用角速度+线速度的匹配模式获取子惯导***解算的线速度,主惯导***提供的经过刚性杆臂补偿后的速度,将其与子惯导***输出速度相减获得速度差作为线速度观测量;取角速度误差观测量为可表达为:
相应的线速度误差可表达为:
其中,表示主惯导***与计算子惯导***的速度误差,表示子惯导***的输出速度,表示主惯导***的输出速度,表示主惯导***的姿态矩阵,表示主惯导***相对于地球系的旋转角速度,表示加速度计的偏差;
则***观测旋量可统一表示为:
其中, 表示计算子惯导***相对于主惯导***的旋转角速度在导航系中的投影, 表示计算子惯导***相对于主惯导***的线速度在导航系中的投影;Bω=bω+εbv, 是角速度观测量的偏差, 表示***线速度的偏差;ηω=ηω+εηv, 表示***角速度观测噪声, 表示***线速度观测噪声,和均为高斯白噪声。
本发明利用对偶四元数构造主惯导***和子惯导***间的标称对偶四元数来描述子惯导***载体系相对于主惯导***载体系的旋转和平移运动,构造计算对偶四元数来描述主惯导***载体系相对于子惯导***计算载体系的旋转和平移运动,再通过推理主惯导***相对于子惯导***的相对旋转和平移运动的旋量表达式、传递对准的标称对偶四元数微分方程,联合***加速度计参数误差方程和陀螺仪误差微分方程,获得传递对准***的对偶四元数误差方程;利用加速度计的线速度和陀螺仪的旋转角速度构造***旋量对偶四元数观测量方程,从而获得一种基于对偶四元数的传递对准***误差模型,经由kalman滤波迭代计算获得子惯导***的初始标定参数操作。本发明摆脱了旋转和平移分离计算带来的圆锥误差和划船误差的影响,有效提高了计算精度和计算效率。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为本发明主惯导***与子惯导***见传递对准原理图。
图2为本发明标称姿态失准角计算误差数据曲线。
图3为本发明计算姿态失准角计算误差数据曲线。
图4为本发明四元数误差模型的标称姿态失准角计算误差数据曲线。
图5为本发明四元数误差模型的计算姿态失准角计算误差数据曲线。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有付出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
本发明首先论述对偶四元数的基本概念及其运算规则,接着利用对偶四元数建立传递对准在推力坐标系下的推力速度微分方程、在引力坐标系下的引力速度微分方程以及在位置坐标系下的位置坐标微分方程;再对这三组微分方程计算求解获得捷联惯导***的姿态角、速度和位置量,经由坐标转换获得舰载机载体在当地地理坐标系下的导航初始参数;最后对偶四元数的解算精度做出说明与论证。最后给出***初始参数进行仿真验证算法的有效性与计算效能。
一种基于对偶四元数的惯导***传递对准建模方法,其步骤如下:
步骤一:设定舰船主惯导***的载体坐标系为m,舰载机子惯导***的标称载体坐标系为s,舰载机子惯导***的计算载体坐标系为s’;利用对偶四元数定义主惯导***载体系m与子惯导***的标称载体坐标系s间的标称对偶四元数向量利用对偶四元数定义主惯导***的载体坐标系m相对于子惯导***计算载体系s’间的计算对偶四元数向量其中,表示主惯导***m相对于导航坐标系n在子惯导***的标称载体坐标系s中的投影四元数,表示对偶算子,r表示主惯导***与标称子惯导***间的杆臂矢量,表示主惯导***的载体坐标系m相对于导航坐标系n在计算子惯导***s′中的投影四元数,r'表示主惯导***相对于子惯导***的计算载体坐标系s′间的杆臂矢量。
对偶四元数是一种元素为对偶数的特殊四元数,其定义为其中Q称为实部,Q'称为对偶部,它们都是四元数,对偶部中的是对偶单位数,满足且对偶四元数的范数定义为:
其中,表示对偶四元数的共轭,其表达为:若对偶四元数的实部非零,那么对偶四元数的逆存在,且表示为对于单位对偶四元数来说其逆等于对偶四元数的共轭,即对偶四元数作为一类特殊的四元数,它完全继承了四元数的性质,但是其有一些独特的运算规则。
对偶四元数加法定义:
对偶四元数与一个标量相乘的乘法定义:
对偶四元数间的乘法定义:
且其交换律满足
对偶四元数的点乘乘法定义:
对偶四元数叉乘乘法定义:
且其交换律满足
对偶四元数与矩阵的乘积定义:设矩阵M∈R8×8,且那么矩阵与一个对偶四元数的乘积为
对偶四元数的圈乘定义:
在本发明中舰船主惯导***的载体坐标系为m,舰载机子惯导***的标称载体坐标系为s,舰载机子惯导***的计算载体坐标系为s’。在传递对准过程中,主惯导***是一个无误差信源的基准***,在舰船行进过程中,舰船主惯导***的载体坐标系m与舰载机子惯导***的标称载体坐标系s之间的相对位置是固定不变的,那么可以定义一个标称对偶四元数表示子惯导***相对于主惯导***的相对旋转与平移运动:其中,是主惯导***与子惯导***间的旋转四元数,矢量r表示主惯导***与子惯导***间的位移矢量。同时主惯导***相对于子惯导***的计算载体坐标系定义一个计算对偶四元数那么
步骤二:构造主惯导***载体系m与子惯导***的标称载体坐标系s间的标称对偶四元数向量误差微分方程:
本发明利用微小扰动摄动法来推导传递对准***的误差方程。在传递对准过程中一般认为,标称子惯导***相对于主惯导***是静止的,标称对偶四元数可以认为是一个常值,因此其微分可表示为:把标称对偶四元数向量误差微分方程作为***模型方程的一部分参与***状态变量的最优滤波计算。
步骤三:考虑主惯导***载体系m与子惯导***的标称载体坐标系s旋量间的关系,主惯导***载体系m与子惯导***的标称载体坐标系s相对旋转与平移的对偶四元数旋量 其中,表示主惯导***相对于导航坐标系n的对偶四元数旋量,表示标称子惯导***相对于导航坐标系的对偶四元数旋量,εs表示子惯导***中的陀螺零漂移误差量。
主惯导***与子惯导***的旋转对偶四元数间具有这样的关系:若是利用方向余弦矩阵表达则有旋转角速度与间有可以对主惯导***的对偶四元数分解获得并且对其两边同时求导整理获得:
结合主惯导***和子惯导***的姿态对偶四元数微分方程获得
可以考虑主惯导***与子惯导***的旋量间的关系,定义一个表达主子惯导***间的相对旋转与平移的对偶四元数旋量其表达式为
步骤四:构造主惯导***载体系m与子惯导***的计算载体坐标系为s’间的标称对偶四元数向量误差微分方程:其中,表示计算子惯导***相对于主惯导***的旋量在导航坐标系中的投影,(.)*表示向量的逆。
根据对偶四元数的微分表达式定义计算对偶四元数向量的微分方程表达式:其中,表示主惯导***与子惯导***间的旋量,也是一个对偶四元数,其一般表达式为:
其中,表示主惯导***相对于导航坐标系的旋转角速度在计算子惯导***中的投影,表示主惯导***相对于导航坐标系的线速度在计算子惯导***中的投影的微分,表示主惯导***相对于导航坐标系的旋转四元数在计算子惯导***中的投影的共轭。
其中,主惯导***相对于导航坐标系的线速度在计算子惯导***中的投影的微分可表示为其中表示主惯导***的线加速度,表示计算子惯导***的线加速度,表示杆臂矢量的加速度。根据惯导***速度方程可得到:
其中,fm表示主惯导***的比力,表示主惯导***的旋转四元数,表示主惯导***的地球自转角速度,表示主惯导***相对于地球坐标系e的旋转角速度,Vm表示主惯导***的速度,gm表示导航坐标系中的重力加速度。
主惯导***和子惯导***间的杆臂误差速度可表达为其微分方程为:
其中,表示主惯导***相对于导航坐标系的旋转角速度,rm表示杆臂矢量,表示主惯导***相对于地球坐标系的旋转角速度的微分。
那么可以获得主惯导***与子惯导***速度误差表达式:
其中,是的逆,表示主子惯导***间的相对速度误差在导航坐标系中的投影,表示计算子惯导***相对于导航系的旋转四元数,fs表示子惯导***的测量比力,表示主惯导***相对于计算子惯导***的旋转四元数,主子惯导***间的旋转四元数,表示主惯导***相对于计算子惯导***的旋转四元数的逆,表示地球自转角速度,表示地球自转角速度在导航坐标系中的投影,表示主惯导***相对于地球坐标系的旋转角速度,表示计算子惯导***和主惯导***间的相对线速度在导航系中的投影,rn表示导航系中的杆臂矢量,表示子惯导***的加速度计测量偏差。
针对主惯导***的对偶四元数以及子惯导***的对偶四元数的微分方程分别为:
其中,表示主惯导***的对偶四元数的微分,表示主惯导***的对偶四元数,表示主惯导***的旋量。
主惯导***与子惯导***的旋转对偶四元数间的关系:其中,表示子惯导***的旋量,表示主子惯导***间的对偶四元数的共轭,表示主子惯导***间的相对旋量在导航系中的投影,表示主子惯导***间的对偶四元数。
利用方向余弦矩阵表达旋转角速度与间的关系为:其中,表示主子惯导***间的方向余弦矩阵;对主惯导***的对偶四元数分解得:对其两边同时求导整理得:
其中,表示主惯导***相对于导航坐标系的对偶四元数在计算子惯导***的投影,表示计算子惯导***相对于导航系的对偶四元数,表示主惯导***的对偶四元数的微分、表示计算子惯导***的对偶四元数的微分,表示主惯导***相对于导航坐标系的对偶四元数。
结合主惯导***与子惯导***的姿态对偶四元数微分方程获得:
其中,表示标称子惯导***相对于导航系的旋量,表示主惯导***相对于导航系的旋量。
考虑主惯导***与子惯导***间的旋量间的关系,主惯导***与子惯导***间的相对旋转与平移的对偶四元数旋量为:
从而得那么其逆为:
因此,获得主惯导***与子惯导***的姿态平移对偶四元数误差方程为:
步骤五:联合加速度计误差微分方程:陀螺仪误差微分方程:主惯导***和子惯导***间的杆臂矢量微分方程:构建主惯导***和子惯导***间的传递对准***误差模型方程:
其中,ε表示***中陀螺仪随机漂移的三维矢量,表示***中加速度计的三维零漂移误差量;连同三维杆臂矢量和八维的标称对偶四元数微分方程,***模型中需要添加017×17的零矩阵阵。
***观测旋量表达的是主子惯导***与惯导***间的相对旋转与平移误差对偶四元数向量,其显性表达式为:
其中,是主惯导***与子惯导***间的旋转误差矢量,且: 表示主子惯导***间的相对线速度误差,且
子惯导***敏感到的角速度和加速度可分别表示为:
其中,表示能被主惯导***敏感到的载体角速度在子惯导***惯性系中的投影,ε为陀螺零偏误差,为主惯导***敏感到的载体加速度在子惯导***惯性系中的投影,为载体转动引起的子惯导***杆臂加速度,为加速度计的零偏误差,ng和na为随机噪声;
待标参数误差为常值误差,随机噪声为零均值不相关白噪声,则有:
主惯导***与子惯导***间传递对准过程中杆臂矢量rn是不变的,其微分方程为
步骤六:考虑线速度误差和旋转角速度误差,构造主惯导***与子惯导***传递对准过程中的对偶四元数旋量的观测旋量方程:
其中,表示观测模型中的计算子惯导***相对于主惯导***在导航坐标系中观测到的对偶旋量,表示计算子惯导***相对于主惯导***的旋量在导航系中的投影的观测量,其表达式为 表示计算子惯导***相对于主惯导***的旋转角速度在导航系中的投影, 表示计算子惯导***相对于主惯导***的线速度在导航系中的投影、Bω表示***陀螺仪和加速度计的偏差的对偶量,可表示为Bω=bω+εbv, 是角速度观测量的偏差, 表示***线速度的偏差、ηω=ηω+εηv表示***速度旋量的观测噪声, 表示***角速度观测噪声, 表示***线速度观测噪声,我们都假设为高斯白噪声。
本发明采用角速度+线速度的匹配模式获取子惯导***解算的线速度,主惯导***提供的经过刚性杆臂补偿后的速度,将其与子惯导***输出速度相减获得速度差作为线速度观测量;取角速度误差观测量为可表达为:
相应的线速度误差可表达为:
其中,表示主惯导***与计算子惯导***的速度误差、表示子惯导***的输出速度、表示主惯导***的输出速度、表示主惯导***的姿态矩阵、表示主惯导***相对于地球系的旋转角速度、表示加速度计的偏差。
则***观测旋量可进一步整理为:
步骤七:利用Kalman滤波方法求解传递对准***误差模型方程和观测旋量方程,获得***状态变量:标称姿态失准角、计算姿态失准角、加速度计和陀螺仪参数的计算。
根据前面的子惯导***状态参数对偶四元数传递对准模型的推理过程,可以总结获得***过程模型方程为
和对偶数旋量的***观测旋量方程为
下面考虑迭代递推过程中***噪声和观测噪声方差矩阵计算问题。
针对对偶速度的***观测旋量方程:
其中,对偶速度是一个对偶数向量,且 是主惯导***和子惯导***的旋转角速度误差的观测量在导航坐标系中的投影,其中,是主子惯导***在导航坐标系中投影的线速度误差观测量。针对前面已经推导出的主惯导***和子惯导***的角速度误差和线速度误差的表达形式,将其观测量偏差以及噪声整理为Bω和ηω,且并且 是角速度误差量的偏差,其中,是线速度观测量的偏差;其中,ηω表示角速度误差噪声,ηv表示线速度误差噪声,且假设其为高斯白噪声向量,且具有噪声方差矩阵
在迭代递推计算过程中,每一步迭代计算后都需要考虑对偶四元数的强制规范化问题。对于对偶四元数的实部部分,根据对偶四元数定义式:则其实部部分的规范化计算式:
相应的对偶四元数的对偶部分量部分Q'可以采用计算表达式
利用对偶四元数的强制规范化计算结果参与下一次迭代计算,从而保证迭代滤波计算的稳定性。
根据前面***状态方程,可知***状态变量为状态变量的初始值都设为0,利用舰船三轴摇摆运动模型仿真舰载机惯导***,舰船纵摇、横摇和航向摇摆幅度分别为6°,5°和7°;摇摆频率分别为0.05,0.10,和0.05Hz;初始角分别设为0°,0°和90°;舰船东向和北向初始速度取值为10m/s,舰船所在地理位置设为北纬45.60°,东经124.75°。为了验证本发明传递对准***对偶四元数误差模型的鲁棒性,初始姿态误差角设为15°,45°和60°,陀螺常值漂移为5°/h,随机漂移为0.01°/h;加速度计初始偏差为0.09g,随机漂移为0.004g,忽略惯性组件安装误差以及刻度因子误差,线速度测量误差0.01m/s。从而对传递对准***的对偶四元数误差模型展开仿真计算,获得仿真结果如图2-5所示。本发明展示了主惯导***与子惯导***间的标称姿态失准角、计算姿态失准角在对偶四元数误差模型迭代递推计算的结果,并且和四元数误差模型进行对比验证。由图2-5可得,本发明计算的标称姿态失准角误差数据比较稳定,能够快速收敛于零轴附近,计算效能明显优于传统的四元数模型算法。
本发明综合利用对偶四元数构建的传递对准***的对偶四元数误差模型,以及利用线速度和角速度构建的观测旋量方程,可以采用Kalman滤波方法,最终获得***状态变量,如标称姿态失准角、计算姿态失准角以及加速度计和陀螺仪参数的估计计算,完成传递对准***参数的初始标定操作。
本发明说明书中未作详细描述的内容属于本领域专业技术人员所公知的现有技术。以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (4)
1.一种基于对偶四元数的惯导***传递对准建模方法,其特征在于,其步骤如下:
步骤一:设定舰船主惯导***的载体坐标系为m,舰载机子惯导***的标称载体坐标系为s,舰载机子惯导***的计算载体坐标系为s’;利用对偶四元数定义主惯导***载体系m与子惯导***的标称载体坐标系s间的标称对偶四元数向量利用对偶四元数定义主惯导***载体坐标系m相对于子惯导***计算载体系s’间的计算对偶四元数向量其中,表示主惯导***载体坐标系m相对于导航坐标系n在子惯导***的标称载体坐标系s中的投影四元数,∈表示对偶算子,r表示主惯导***与子惯导***标称载体坐标系间的杆臂矢量,表示主惯导***载体坐标系m相对于导航坐标系n在子惯导***的计算载体坐标系s′中的投影四元数,r'表示主惯导***相对于子惯导***的计算载体坐标系s′间的杆臂矢量;
步骤二:在传递对准过程中,标称子惯导***相对于主惯导***是静止的,构造主惯导***载体系m与子惯导***的标称载体坐标系s间的标称对偶四元数向量误差微分方程:把标称对偶四元数向量误差微分方程作为***模型方程的一部分参与***状态变量的最优滤波计算;
步骤三:考虑主惯导***载体系m与子惯导***的标称载体坐标系s旋量间的关系,主惯导***载体系m与子惯导***的标称载体坐标系s相对旋转与平移的对偶四元数旋量 其中,表示主惯导***载体坐标系m相对于导航坐标系n的对偶四元数旋量,表示子惯导***的标称载体坐标系相对于导航坐标系n的对偶四元数旋量,εs表示子惯导***中的陀螺零漂移误差量;
步骤四:构造主惯导***载体系m与子惯导***的计算载体坐标系为s’间的标称对偶四元数向量误差微分方程:其中,表示子惯导***的计算载体坐标系相对于主惯导***的旋量在导航坐标系中的投影,旋量是旋量的逆,(.)*表示向量的逆;
步骤五:联合加速度计误差微分方程:陀螺仪误差微分方程:主惯导***和子惯导***间的杆臂矢量微分方程:构建主惯导***和子惯导***间的传递对准***误差模型方程:
其中,ε表示***中陀螺仪随机漂移的三维矢量,表示***中加速度计的三维零漂移误差量;连同三维杆臂矢量和八维的标称对偶四元数微分方程,***模型中需要添加017×17的零矩阵;
步骤六:考虑线速度误差和旋转角速度误差,构造主惯导***与子惯导***传递对准过程中的对偶四元数旋量的观测方程:
其中,表示观测模型中的计算子惯导***相对于主惯导***在导航坐标系中观测到的对偶旋量,表示计算子惯导***相对于主惯导***的旋量在导航系中的投影的观测量;Bω表示***陀螺仪和加速度计的偏差的对偶量,ηω表示***速度旋量的观测噪声;
步骤七:利用Kalman滤波方法求解传递对准***误差模型方程和观测旋量方程,获得***状态变量:标称姿态失准角、计算姿态失准角、加速度计和陀螺仪参数的计算。
2.根据权利要求1所述的基于对偶四元数的惯导***传递对准建模方法,其特征在于,所述主惯导***载体系m与子惯导***的计算载体坐标系为s’间的标称对偶四元数向量误差微分方程的构建方法是:
根据对偶四元数的微分表达式计算对偶四元数向量的微分方程表达式:其中,表示主惯导***与计算子惯导***间的旋量,且
其中,表示主惯导***相对于导航坐标系的旋转角速度在计算子惯导***中的投影,表示主惯导***相对于导航坐标系的线速度在计算子惯导***中的投影的微分,表示主惯导***相对于导航坐标系的旋转四元数在计算子惯导***中的投影的共轭;
主惯导***相对于导航坐标系的线速度在计算子惯导***中的投影的微分可表示为其中表示主惯导***的线加速度,表示计算子惯导***的线加速度,表示杆臂矢量的加速度,根据惯导***速度方程得:
其中,fm表示主惯导***的比力,表示主惯导***的旋转四元数,表示主惯导***的地球自转角速度,表示主惯导***相对于地球坐标系e的旋转角速度,Vm表示主惯导***的速度,gm表示导航坐标系中的重力加速度;
主惯导***和子惯导***间的杆臂误差速度表达为其微分方程为:
其中,表示主惯导***相对于导航坐标系的旋转角速度,rm表示杆臂矢量,表示主惯导***相对于地球坐标系的旋转角速度的微分;
那么可以获得主惯导***与子惯导***速度误差表达式:
其中,是的逆,表示主子惯导***间的相对速度误差在导航坐标系中的投影,表示计算子惯导***相对于导航系的旋转四元数,fs表示子惯导***的测量比力,表示主惯导***相对于计算子惯导***的旋转四元数,主子惯导***间的旋转四元数,表示主惯导***相对于计算子惯导***的旋转四元数的逆,表示地球自转角速度,表示地球自转角速度在导航坐标系中的投影,表示主惯导***相对于地球坐标系的旋转角速度,表示计算子惯导***和主惯导***间的相对线速度在导航系中的投影,rn表示导航系中的杆臂矢量,表示子惯导***的加速度计测量偏差;
针对主惯导***的对偶四元数以及子惯导***的对偶四元数的微分方程分别为:
其中,表示主惯导***的对偶四元数的微分,表示主惯导***的对偶四元数,表示主惯导***的旋量;
主惯导***与子惯导***的旋转对偶四元数间的关系:其中,表示子惯导***的旋量,表示主子惯导***间的对偶四元数的共轭,表示主子惯导***间的相对旋量在导航系中的投影,表示主子惯导***间的对偶四元数;
利用方向余弦矩阵表达旋转角速度与间的关系为:其中,表示主子惯导***间的方向余弦矩阵;对主惯导***的对偶四元数分解得:对其两边同时求导整理得:
其中,表示主惯导***相对于导航坐标系的对偶四元数在计算子惯导***的投影,表示计算子惯导***相对于导航系的对偶四元数,表示主惯导***的对偶四元数的微分, 表示计算子惯导***的对偶四元数的微分,表示主惯导***相对于导航坐标系的对偶四元数;
结合主惯导***与子惯导***的姿态对偶四元数微分方程获得:
其中,表示标称子惯导***相对于导航系的旋量,表示主惯导***相对于导航系的旋量;
考虑主惯导***与子惯导***间的旋量间的关系,主惯导***与子惯导***间的相对旋转与平移的对偶四元数旋量为:
从而得那么其逆为:
其中,旋量是旋量的逆;
获得主惯导***与子惯导***的姿态平移对偶四元数误差方程为:
3.根据权利要求1所述的基于对偶四元数的惯导***传递对准建模方法,其特征在于,所述加速度计误差微分方程和陀螺仪误差微分方程的构建方法是:
***观测旋量表达的是主子惯导***与惯导***间的相对旋转与平移误差对偶四元数向量,其显性表达式为:
其中,是主惯导***与子惯导***间的旋转误差矢量,且: 表示主子惯导***间的相对线速度误差,且:
其中,表示计算子惯导***相对于导航系的旋转四元数,fs表示子惯导***的测量比力,表示主惯导***相对于计算子惯导***的旋转四元数,表示主子惯导***间的旋转四元数,表示主惯导***相对于计算子惯导***的旋转四元数的逆,表示地球自转角速度,表示地球自转角速度在导航坐标系中的投影,表示主惯导***相对于地球坐标系的旋转角速度,表示计算子惯导***和主惯导***间的相对线速度在导航系中的投影,rn表示导航系中的杆臂矢量,表示子惯导***的加速度计测量偏差;
子惯导***敏感到的角速度和加速度可分别表示为:
其中,表示能被主惯导***敏感到的载体角速度在子惯导***惯性系i中的投影,εs为子惯导***的陀螺零偏误差,为主惯导***敏感到的载体加速度在子惯导***惯性系i中的投影,为载体转动引起的子惯导***杆臂加速度,表示子惯导***的加速度计的零偏误差向量,ng和na为随机噪声;
待标参数误差为常值误差,随机噪声为零均值不相关白噪声,则有:
4.根据权利要求1所述的基于对偶四元数的惯导***传递对准建模方法,其特征在于,所述主惯导***与子惯导***传递对准过程中的对偶四元数旋量的观测旋量方程的构建方法是:采用角速度+线速度的匹配模式获取子惯导***解算的线速度,主惯导***提供的经过刚 性杆臂补偿后的速度,将其与子惯导***输出速度相减获得速度差作为线速度观测量;取角速度误差观测量为可表达为:
相应的线速度误差可表达为:
其中,表示主惯导***与计算子惯导***的速度误差,表示子惯导***的输出速度,表示主惯导***的输出速度,表示主惯导***的姿态矩阵,表示主惯导***相对于惯性系的旋转角速度,表示加速度计的偏差;
则***观测旋量可统一表示为:
其中, 表示计算子惯导***相对于主惯导***的旋转角速度在导航系中的投影, 表示计算子惯导***相对于主惯导***的线速度在导航系中的投影;Bω=bω+εbv, 是角速度观测量的偏差, 表示***线速度的偏差;ηω=ηω+εηv, 表示***角速度观测噪声, 表示***线速度观测噪声,和均为高斯白噪声。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610948668.8A CN106525034B (zh) | 2016-10-26 | 2016-10-26 | 一种基于对偶四元数的惯导***传递对准建模方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610948668.8A CN106525034B (zh) | 2016-10-26 | 2016-10-26 | 一种基于对偶四元数的惯导***传递对准建模方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106525034A CN106525034A (zh) | 2017-03-22 |
CN106525034B true CN106525034B (zh) | 2017-09-08 |
Family
ID=58293395
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610948668.8A Expired - Fee Related CN106525034B (zh) | 2016-10-26 | 2016-10-26 | 一种基于对偶四元数的惯导***传递对准建模方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106525034B (zh) |
Families Citing this family (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107167127A (zh) * | 2017-03-29 | 2017-09-15 | 中央电视台 | 一种载体姿态获取方法、装置及设备 |
CN107036598A (zh) * | 2017-03-30 | 2017-08-11 | 南京航空航天大学 | 基于陀螺误差修正的对偶四元数惯性/天文组合导航方法 |
US20210404811A1 (en) * | 2017-04-21 | 2021-12-30 | Shanghai Jiao Tong University | Method for solving attitude of rigid body based on function iterative integration |
CN107330862B (zh) * | 2017-06-30 | 2020-07-07 | 广州幻境科技有限公司 | 基于四元数的两个独立***坐标系之间的转换方法 |
CN108446497A (zh) * | 2018-03-21 | 2018-08-24 | 郑州大学 | 一种舰载机集群运动建模仿真方法 |
CN109084756B (zh) * | 2018-06-20 | 2021-08-24 | 东南大学 | 一种重力视运动参数辨识与加速度计零偏分离方法 |
CN110146079A (zh) * | 2019-06-20 | 2019-08-20 | 郑州轻工业学院 | 一种基于主副imu和气压计的三维行人导航方法 |
CN111474938A (zh) * | 2020-04-30 | 2020-07-31 | 内蒙古工业大学 | 一种惯性导航自动导引小车及其航迹确定方法 |
CN114397480B (zh) * | 2022-01-04 | 2022-10-14 | 湖南大学 | 声学多普勒测速仪误差估计方法、装置及*** |
CN116787443B (zh) * | 2023-07-26 | 2023-11-21 | 中国科学院宁波材料技术与工程研究所 | 基于单位对偶四元数的并联机构运动学标定方法和*** |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2893073B1 (ja) * | 1998-03-31 | 1999-05-17 | 防衛庁技術研究本部長 | 慣性航法システム |
CN101825468B (zh) * | 2010-04-23 | 2012-02-01 | 东南大学 | 基于频域分析方法的对偶四元数捷联惯导方法 |
CN103983267A (zh) * | 2014-06-03 | 2014-08-13 | 中北大学 | 基于螺旋矢量的捷联姿态位置一体化更新算法 |
-
2016
- 2016-10-26 CN CN201610948668.8A patent/CN106525034B/zh not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
CN106525034A (zh) | 2017-03-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106525034B (zh) | 一种基于对偶四元数的惯导***传递对准建模方法 | |
Rhudy et al. | Evaluation of matrix square root operations for UKF within a UAV GPS/INS sensor fusion application | |
Crassidis et al. | Survey of nonlinear attitude estimation methods | |
CN103090867B (zh) | 相对地心惯性系旋转的光纤陀螺捷联惯性导航***误差抑制方法 | |
CN104655131B (zh) | 基于istssrckf的惯性导航初始对准方法 | |
CN103389088B (zh) | 一种四冗余rfins最优配置方案的确定方法 | |
CN105806363B (zh) | 基于srqkf的sins/dvl水下大失准角对准方法 | |
CN103090866B (zh) | 一种单轴旋转光纤陀螺捷联惯导***速度误差抑制方法 | |
CN103575299A (zh) | 利用外观测信息的双轴旋转惯导***对准及误差修正方法 | |
CN103913181A (zh) | 一种基于参数辨识的机载分布式pos传递对准方法 | |
CN103256928A (zh) | 一种分布式惯性导航***及其姿态传递对准方法 | |
Jwo et al. | Development of a strapdown inertial navigation system simulation platform | |
Le Bras et al. | Output feedback observation and control for visual servoing of VTOL UAVs | |
Fresk et al. | A generalized reduced-complexity inertial navigation system for unmanned aerial vehicles | |
CN108827288A (zh) | 一种基于对偶四元数的降维捷联惯性导航***初始对准方法及*** | |
CN104864875B (zh) | 一种基于非线性h∞滤波的航天器自主定位方法 | |
CN104296747B (zh) | 基于火箭橇轨道坐标系的惯性测量***一维定位方法 | |
Ko et al. | Lie group approach to dynamic-model-aided navigation of multirotor unmanned aerial vehicles | |
CN101769743B (zh) | 一种适用于微惯性与全球定位组合导航***的分布式滤波装置 | |
CN110940336B (zh) | 捷联惯导仿真定位解算方法、装置及终端设备 | |
Luo et al. | An attitude compensation technique for a MEMS motion sensor based digital writing instrument | |
CN102436437A (zh) | 基于角速度的飞行器极限飞行时四元数傅里埃近似输出方法 | |
Benziane | Attitude estimation & control of autonomous aerial vehicles | |
Xia et al. | Low-cost MEMS-INS/GNSS integration using quaternion-based nonlinear filtering methods for USV | |
CN103616026A (zh) | 一种基于h∞滤波的auv操纵模型辅助捷联惯导组合导航方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | 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 |
Granted publication date: 20170908 |
|
CF01 | Termination of patent right due to non-payment of annual fee |