一种单陀螺单加速度计旋转调制寻北方法技术

本发明专利技术属于光学陀螺寻北技术领域，具体涉及一种单陀螺单加速度计旋转调制寻北方法。本方法以单轴光学陀螺和单轴加速度计为敏感器件，利用连续旋转的方法消除陀螺漂移等因素对寻北结果的影响，通过设定中间变量建立起陀螺仪输出的角速度及加速度计输出的加速度与初始纬度及航向角之间的关系，用单个加速度计的输出结果补偿初始滚动角及俯仰角的影响；并通过建立以中间变量、陀螺漂移和加速度计零偏为状态量的Kalman滤波误差模型，经滤波估计获得中间变量的数值；并通过数值计算获得初始纬度及航向角的数值。本方法利用单轴陀螺、单轴加速度计以及旋转机构即可完成寻北，不需要初始纬度信息、不需要精确调平，具有简单、实用、可靠性高、成本低等特点。

【技术实现步骤摘要】
一种单陀螺单加速度计旋转调制寻北方法
本专利技术属于光学陀螺寻北
，具体涉及一种单陀螺单加速度计旋转调制寻北方法。
技术介绍
寻北仪在陆军战车、火炮等军事领域得到广泛的应用。寻北仪的基本原理是在静态条件下，采用陀螺仪测量北向地球自转角速度，来获得陀螺敏感轴相对北向的偏角，即航向角。寻北原理决定了其精度容易受到陀螺零位、不水平角等因素的影响，需要采取一定措施来消除各种因素对寻北精度的影响。通常采用的寻北方法是利用两个陀螺仪，配合旋转机构，在0°～360°范围内等间距位置采集陀螺测量输出的角速度值，来获得陀螺敏感轴相对北向的偏角，即航向角。常用的寻北方案包括两位置方案、三位置方案以及四位置方案等。近年来开始出现利用连续旋转调制的方法，来消除陀螺零位等因素的影响。文献《一种实用旋转调制式陀螺寻北仪的设计》（徐海刚等，兵工学报，第31卷第5期，2010年5月）以及《采用旋转调制技术的高精度陀螺寻北方案》（白云超等，中国惯性技术学报，第18卷第4期，2010年8月）都提出利用连续旋转调制的方案消除陀螺漂移等因素对寻北精度的影响，两篇文献的共同点都是采用单轴陀螺和两个加速度计并利用旋转机构的连续旋转来完成寻北计算。
技术实现思路
本专利技术需要解决的技术问题为：提出一种利用单轴光学陀螺、单轴加速度计以及连续旋转调制技术即可实现寻北的方法。本专利技术的技术方案如下所述：一种单陀螺单加速度计旋转调制寻北方法，包括以下步骤：步骤1.滤波估计步骤1.1.误差模型通过对旋转调制下陀螺仪及加速度计输出进行公式推导得如下输出数据关系：其中，A′、B′、C′及D′为中间变量；ε′为陀螺漂移；为加速度计零偏；α为转台旋转角速度，范围可以为5°/s～40°/s；为陀螺仪输出的角速度信息；加速度计输出的加速度计信息；利用上述误差方程，建立Kalman滤波器，取状态量如下：状态方程由各状态量的定义得Φ=0；得观测方程：对上式在滤波周期内进行积分，得新的观测方程：其中，观测量为：步骤1.2.Kalman滤波方程建立上述误差模型后，利用Kalman滤波方法作为参数辨识方法，完成对状态量的估计：状态一步预测：状态估计：滤波增益矩阵：一步预测误差方差阵：估计误差方差阵：Pk=[I-KkHk]Pk,k-1(10)其中，为一步状态预测值；为状态估计矩阵；Φk,k-1为状态一步转移矩阵；Hk为量测矩阵；Zk为量测量；Kk为滤波增益矩阵；Rk为观测噪声阵；Pk,k-1为一步预测误差方差阵；Pk为估计误差方差阵；Γk,k-1为系统噪声驱动阵；Qk-1为系统噪声阵；步骤2.寻北计算由步骤1的Kalman滤波得到中间变量A′、B′、C′、D′的数值，由安装误差角经下式计算获得新的中间变量A、B、C、D：其中，θ1为陀螺仪敏感轴与转台平面的夹角；θ2为加速度计敏感轴与转台平面的夹角；则初始姿态角由下式计算获得：其中，φ为陀螺仪敏感轴与加速度计敏感轴在转台平面投影的夹角；θ为初始俯仰角；γ为初始滚动角；通过下式计算纬度和初始航向角：其中，其中，ωie为地球自转角速率；L为寻北计算获得的纬度信息；ψ为寻北计算获得的初始航向角信息。本专利技术的有益效果为：本专利技术的一种单陀螺单加速度计旋转调制寻北方法，利用单轴陀螺、单轴加速度计以及旋转机构即可完成寻北。本专利技术的方法通过旋转机构的连续旋转补偿陀螺漂移等因素对寻北计算的影响，通过加速度计输出补偿不水平角的影响，并建立中间变量与纬度及初始航向角之间的关系，通过Kalman滤波估计中间变量的数值，完成寻北计算。本专利技术的方法不需输入初始纬度信息，不需对台面进行精确调平，具有简单、实用、可靠性高以及成本低的特点，可满足不同精度寻北仪的需求。附图说明图1为实现本专利技术方法的陀螺仪及加速度计与转台平面的安装关系示意图。具体实施方式下面结合附图和实施例对本专利技术的一种单陀螺单加速度计旋转调制寻北方法进行详细说明。本专利技术的方法利用旋转调制技术消除陀螺漂移等因素对寻北精度的影响，通过加速度计零偏计算并补偿不水平角对寻北结果的影响。本寻北方法主要分两个步骤：一是滤波估计，主要是通过Kalman滤波完成中间变量的估计；二是寻北计算，即利用滤波估计出的中间变量的数值，经过公式计算获得寻北结果。步骤1.滤波估计滤波估计主要是建立中间变量的误差模型，利用Kalman滤波方法完成中间变量的数值估计。步骤1.1.误差模型通过对旋转调制下陀螺仪及加速度计输出进行公式推导可得输出数据关系如下：其中，A′、B′、C′及D′为中间变量，没有特定物理意义，均为定值；ε′为陀螺漂移；为加速度计零偏；α为转台旋转角速度，该值的选取与所用的陀螺仪精度相关，稳定性差的陀螺α的取值应稍大，范围通常在5°/s～40°/s；为陀螺仪输出的角速度信息；加速度计输出的加速度计信息。利用上述误差方程，建立Kalman滤波器，取状态量如下：状态方程由各状态量的定义可知Φ=0。可得观测方程：为了消除角速率及加速度噪声对滤波器的影响，对上式在滤波周期内进行积分，可得新的观测方程为：其中，如当陀螺仪和加速度计的输出周期为0.005s，滤波周期为1s时，n的取值为200。观测量为：步骤1.2.Kalman滤波方程建立上述误差模型后，利用Kalman滤波方法作为参数辨识方法，完成对状态量的估计。Kalman滤波方程采用文献《卡尔曼滤波和组合导航原理》（第一版，秦永元等编著）中的形式，具体公式如下：状态一步预测：状态估计：滤波增益矩阵：一步预测误差方差阵：估计误差方差阵：Pk=[I-KkHk]Pk,k-1(22)其中，为一步状态预测值；为状态估计矩阵；Φk,k-1为状态一步转移矩阵；Hk为量测矩阵；Zk为量测量；Kk为滤波增益矩阵；Rk为观测噪声阵；Pk,k-1为一步预测误差方差阵；Pk为估计误差方差阵；Γk,k-1为系统噪声驱动阵；Qk-1为系统噪声阵。步骤2.寻北计算由步骤1的Kalman滤波可得中间变量A′、B′、C′、D′的数值，接下来即可进行寻北结果的计算。设θ1，θ2及φ为陀螺仪和加速度计敏感轴与转台平面之间的安装误差角，可由标定获得，安装误差角的定义如图1所示：θ1为陀螺仪敏感轴与转台平面的夹角，θ2为加速度计敏感轴与转台平面的夹角，φ为陀螺仪敏感轴与加速度计敏感轴在转台平面投影的夹角。由安装误差角经下式计算获得新的中间变量A、B、C、D。则初始姿态角可由下式计算获得：其中θ为初始俯仰角，γ为初始滚动角。按如下方法计算如下变量：其中，a、b、d、e、f以及m、n、l都为中间变量，没有特定物理意义，均为定值；ωie为地球自转角速率。由上述中间变量作如下计算：其中L及ψ即为寻北计算获得的纬度及初始航向角信息。本专利技术的关键是通过设定中间变量建立起陀螺仪输出的角速度及加速度计输出的加速度与初始纬度及航向角之间的关系，利用旋转过程中俯仰角和滚动角存在相关转换的特点，用单个加速度计的输出结果补偿初始滚动角及俯仰角的影响，并通过建立以中间变量、陀螺漂移和加速度计零偏为状态量的Kalman滤波误差模型，经过滤波估计获得中间变量的数值，并通过数值计算获得初始纬度及航向角的数值，实现单轴陀螺仪及单轴加速度计连续旋转的寻北计算。本方法在实施时首先建立Kalman滤波器的误差模型，通过滤波计算完成对中间变量的本文档来自技高网...

【技术保护点】
一种单陀螺单加速度计旋转调制寻北方法，其特征在于：包括以下步骤：步骤1.滤波估计步骤1.1.误差模型通过对旋转调制下陀螺仪及加速度计输出进行公式推导得如下输出数据关系： ω x g = cos ( α ) A ′ + sin ( α ) B ′ + ϵ ′ f x a = cos ( α ) C ′ + sin ( α ) D ′ + ▿ ′ - - - ( 1 ) 其中，A′、B′、C′及D′为中间变量；ε′为陀螺漂移；为加速度计零偏；α为转台旋转角速度；为陀螺仪输出的角速度信息；加速度计输出的加速度计信息；利用上述误差方程，建立Kalman滤波器，取状态量如下： X = A ′ B ′ ϵ ′ C ′ D ′ ▿ ′ - - - ( 2 ) 状态方程由各状态量的定义得Φ=0；得观测方程： hk = cos ...

【技术特征摘要】
1.一种单陀螺单加速度计旋转调制寻北方法，其特征在于：包括以下步骤：步骤1.滤波估计步骤1.1.误差模型通过对旋转调制下陀螺仪及加速度计输出进行公式推导得如下输出数据关系：其中，A′、B′、C′及D′为中间变量；ε′为陀螺漂移；为加速度计零偏；α为转台旋转角速度；为陀螺仪输出的角速度信息；加速度计输出的加速度计信息；利用上述误差方程，建立Kalman滤波器，取状态量如下：状态方程由各状态量的定义得Φ＝0；得观测方程：对上式在滤波周期内进行积分，得新的观测方程：其中，n0的取值等于观测量为：步骤1.2.Kalman滤波方程建立上述误差模型后，利用Kalman滤波方法作为参数辨识方法，完成对状态量的估计：状态一步预测：状态估计：滤波增益矩阵：一步预测误差方差阵：估计误...

【专利技术属性】
技术研发人员：李海军，徐海刚，姜述明，李昂，裴玉锋，许一汀，郭元江，刘冲，
申请(专利权)人：北京自动化控制设备研究所，
类型：发明
国别省市：北京;11