基于静态和和动态倾角仪校正的陀螺仪线形测量方法与系统与流程

文档序号:19347072发布日期:2019-12-06 20:58阅读:来源:国知局

技术特征:

1.一种基于静态和和动态倾角仪校正的陀螺仪线形测量方法,其特征在于:本方法包括以下步骤:

s1、数据采集:

载有标定后的陀螺仪和第一倾角仪的运载体,在待测轨道上匀速运动;分别通过陀螺仪和第一倾角仪,得到实时的陀螺仪测量的轨道角度信息和第一倾角仪测量的轨道角度信息;

s2、倾角计算:

将同一时刻的陀螺仪测量的轨道角度信息和第一倾角仪测量的轨道角度信息相减,得到同一时刻陀螺仪和第一倾角仪测量的角度偏差,进一步计算卡尔曼滤波增益;运用卡尔曼滤波算法,对同一时刻陀螺仪测量的轨道角度信息和第一倾角仪测量的轨道角度信息进行融合修正,得到该时刻的轨道倾角数据;

s3、数据修正:

待测轨道上间隔设置若干个标定后的第二倾角仪,每当运载体经过其中一个第二倾角仪时,将该第二倾角仪测得的轨道倾角值作为修正值,赋予给s2所得到该时刻的轨道倾角数据。

2.根据权利要求1所述的方法,其特征在于:所述的陀螺仪在标定时,得到标定时所输出的静态角速度ω0,并查询到进行测量处地球自转产生的角速度ωi;在运载体在待测轨道上匀速运动时,陀螺仪所输出的任意时刻的角度信息θ,由下述公式得到:

假定(t1-t0)无限小,θ可无限的接近于式:

θ=θ0+(ω-ω0-ωi)(t1-t0)

其中ω为陀螺仪所输出的角速度,θ0是上一时刻陀螺仪计算得到的角度值,t1为所得角度时刻的时间信息,t0为初始时时间信息。

3.根据权利要求1所述的方法,其特征在于:所述的卡尔曼滤波算法具体如下:

动态系统的状态方程:

x(k)=a·x(k—1)+b·u(k)+w(k)

动态系统的测量方程:

z(k)=h·x(k)+v(k)

式中a和b表示系统参数,h表示测量系统参数,均为矩阵;u(k)表示k时刻系统的控制量,x(k)表示k时刻的系统状态;z(k)表示k时刻的测量值,w(k)和v(k)分别表示过程噪声和测量噪声,并设w(k)和v(k)的协方差分别是q和r;

根据以下方程求出k时刻的状态估计值x(k):

进一步预测:x(k|k-1)=a·x(k-1|k-1)+b·u(k);

一步预测误差方阵:p(k|k-1)=a·p(k-1|k-1)·a’+q;

状态估计:x(k|k)=x(k|k-1)+kg(k)·(z(k)一hx(k|k一1));

滤波增益矩阵:kg(k)=p(k|k-1)h’/(hp(k|k-l)h’+r);

估计误差方差阵:p(k|k)=(1-kg(k)h)p(k|k-1);

x(k|k)表示k时刻的后验状态估计值,x(k-1|k-1)表示k-1时刻的后验状态估计值,x(k|k-1)表示k时刻的先验状态估计值,p(k-1|k-1)和p(k|k)分别表示k-1时刻和k时刻的后验估计协方差,p(k|k-1)表示k时刻的先验估计协方差,h表示的是状态变量到测量的转换矩阵,z(k)表示测量值,kg(k)表示滤波增益矩阵,a’和h’分别表示a和h的转置矩阵;

给定两个零时刻的初始值x(0|0)和p(0|0),根据k时刻的观测值z(k),递推计算得k时刻的状态估计值x(k),即陀螺仪测量的轨道角度信息和第一倾角仪测量的轨道角度信息进行融合后得到的轨道倾角数据。

4.一种用于实现权利要求1至3中任意一项所述的方法的系统,其特征在于:本系统包括运载体,设置在运载体上的标定后的陀螺仪和第一倾角仪,用于倾角计算和数据修正的处理器,以及待测轨道上间隔设置的若干个标定后的第二倾角仪;

每个第二倾角仪上设有无线发送模块,运载体上还设有用于无线接收第二倾角仪测得的轨道倾角值的无线接收模块,无线接收模块与所述的处理器连接。

5.根据权利要求4所述的系统,其特征在于:所述的运载体上设有驱动单元,用于驱动运载体沿待测轨道匀速运动。

6.根据权利要求5所述的系统,其特征在于:本系统还包括无线遥控器,所述的驱动单元受无线遥控器的远程信号遥控驱动。

7.根据权利要求4所述的系统,其特征在于:所述的第一倾角仪和第二倾角仪,通过放置于高精度转台上进行静态稳定性测试,从而进行标定;所述的高精度根据本系统所要求的精度范围而选择。

8.根据权利要求4所述的系统,其特征在于:所述的陀螺仪为光纤陀螺仪。


技术总结
本发明提供一种基于静态和和动态倾角仪校正的陀螺仪线形测量方法及系统,载有标定后的陀螺仪和第一倾角仪的运载体,在待测轨道上匀速运动;得到陀螺仪和第一倾角仪测量的轨道角度信息;将同一时刻的陀螺仪和第一倾角仪测量的轨道角度信息相减,得到角度偏差,计算卡尔曼滤波增益;运用卡尔曼滤波算法,对同一时刻陀螺仪和第一倾角仪测量的轨道角度信息进行融合修正,得到该时刻的轨道倾角数据;待测轨道上间隔设置若干个标定后的第二倾角仪,每当运载体经过其中一个第二倾角仪时,将该第二倾角仪测得的轨道倾角值作为修正值,赋予给该时刻的轨道倾角数据。本发明弥补了陀螺仪随时间推移累加误差逐渐增加的缺点,提高了轨道角度测量的精确性。

技术研发人员:胡文彬;禚明芝;甘维兵;刘芳;李盛;唐健冠
受保护的技术使用者:武汉理工大学
技术研发日:2019.09.05
技术公布日:2019.12.06
当前第2页1 2 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1