一种基于差分MEMS陀螺仪的高精度测量方法与流程

文档序号:12356373阅读:来源:国知局

技术特征:

1.一种基于差分MEMS陀螺仪的高精度测量方法,其特征在于,包括:

选取陀螺仪构建至少两个差分对,所述差分对中包括一个正向陀螺仪和一个反向陀螺仪,所述正向陀螺仪和所述反向陀螺仪分别置于同一转台敏感轴的正侧和反侧,使所述正向陀螺仪和所述反向陀螺仪以相同角速率分别正向旋转和反向旋转,使外部信号对所述正向陀螺仪和所述反向陀螺仪表现为共模差分信号;

采集正向陀螺仪的各阶系数和反向陀螺仪的各阶系数;依据所述正向陀螺仪的各阶系数和反向陀螺仪的各阶系数,计算各阶拟合系数;

依据各个所述各阶拟合系数,计算各个所述各阶拟合系数的平均数;

依据所述平均数,计算各阶拟合系数方差;

选取所述各阶拟合系数方差最小的差分对,测量输入角速度。

2.根据权利要求1所述的方法,其特征在于,所述测量输入角速度w的过程如下所示:

<mrow> <mi>w</mi> <mo>=</mo> <mfrac> <mrow> <mo>(</mo> <msub> <mi>G</mi> <mi>p</mi> </msub> <mo>-</mo> <munderover> <mo>&Sigma;</mo> <mrow> <mi>i</mi> <mo>=</mo> <mn>1</mn> </mrow> <mi>n</mi> </munderover> <mrow> <msub> <mi>K</mi> <mrow> <mi>p</mi> <mi>w</mi> <mi>i</mi> </mrow> </msub> <mo>&CenterDot;</mo> <msub> <mi>W</mi> <mrow> <mi>p</mi> <mi>i</mi> </mrow> </msub> <mo>)</mo> </mrow> <mo>-</mo> <mrow> <mo>(</mo> <mrow> <msub> <mi>K</mi> <mrow> <mi>b</mi> <mi>d</mi> </mrow> </msub> <mo>&CenterDot;</mo> <msub> <mi>G</mi> <mi>n</mi> </msub> <mo>-</mo> <munderover> <mo>&Sigma;</mo> <mrow> <mi>i</mi> <mo>=</mo> <mn>1</mn> </mrow> <mi>n</mi> </munderover> <mrow> <msub> <mi>K</mi> <mrow> <mi>b</mi> <mi>d</mi> </mrow> </msub> <mo>&CenterDot;</mo> <msub> <mi>K</mi> <mrow> <mi>n</mi> <mi>w</mi> <mi>i</mi> </mrow> </msub> <mo>&CenterDot;</mo> <msub> <mi>W</mi> <mrow> <mi>n</mi> <mi>i</mi> </mrow> </msub> </mrow> </mrow> <mo>)</mo> </mrow> </mrow> <mrow> <msub> <mi>K</mi> <mi>p</mi> </msub> <mo>+</mo> <msub> <mi>K</mi> <mrow> <mi>b</mi> <mi>d</mi> </mrow> </msub> <mo>&CenterDot;</mo> <msub> <mi>K</mi> <mi>n</mi> </msub> </mrow> </mfrac> <mo>-</mo> <msub> <mi>N</mi> <mi>c</mi> </msub> </mrow>

其中,Nc为高斯白噪声,Kbd为正向陀螺和反向陀螺仪的环境系数比值,Kp为正向陀螺仪的标定因数,Kn为反向陀螺仪的标定因数,Gp为正向陀螺仪的输出值,Gn为反向陀螺仪的输出值,Kpwi为正向陀螺仪第i个采样点的确定性误差项系数,Kpwi表示负向陀螺仪第i个采样点的确定性误差项系数,Wpi表示正向陀螺仪测试时刻第i个确定性误差项,Wni表示负向陀螺仪测试时刻第i个确定性误差项,i=1,...n,n=2~7。

3.根据权利要求2所述的方法,其特征在于,所述高斯白噪声Nc的计算过程如下所示:

<mrow> <msub> <mi>N</mi> <mi>c</mi> </msub> <mo>=</mo> <mfrac> <mrow> <msub> <mi>N</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>K</mi> <mrow> <mi>b</mi> <mi>d</mi> </mrow> </msub> <mo>&CenterDot;</mo> <msub> <mi>N</mi> <mn>2</mn> </msub> </mrow> <mrow> <msub> <mi>K</mi> <mi>p</mi> </msub> <mo>+</mo> <msub> <mi>K</mi> <mrow> <mi>b</mi> <mi>d</mi> </mrow> </msub> <mo>&CenterDot;</mo> <msub> <mi>K</mi> <mi>n</mi> </msub> </mrow> </mfrac> </mrow>

其中,N1为正向陀螺仪测试时的测量噪声,N2为负向陀螺仪测试时的测量噪声。

4.根据权利要求2所述的方法,其特征在于,所述为正向陀螺和反向 陀螺仪的环境系数比值Kbd的计算过程如下所示:

<mrow> <msub> <mi>K</mi> <mrow> <mi>b</mi> <mi>d</mi> </mrow> </msub> <mo>=</mo> <mfrac> <mrow> <mfrac> <mn>1</mn> <mi>m</mi> </mfrac> <munderover> <mo>&Sigma;</mo> <mrow> <mi>j</mi> <mo>=</mo> <mn>1</mn> </mrow> <mi>m</mi> </munderover> <mrow> <mo>(</mo> <msub> <mi>G</mi> <mrow> <mi>p</mi> <mi>j</mi> </mrow> </msub> <mo>-</mo> <munderover> <mo>&Sigma;</mo> <mrow> <mi>i</mi> <mo>=</mo> <mn>1</mn> </mrow> <mi>n</mi> </munderover> <msub> <mi>K</mi> <mrow> <mi>p</mi> <mi>w</mi> <mi>i</mi> </mrow> </msub> <mo>&CenterDot;</mo> <msub> <mi>W</mi> <mrow> <mi>p</mi> <mi>i</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>K</mi> <mi>p</mi> </msub> <mo>&CenterDot;</mo> <mi>w</mi> <mo>)</mo> </mrow> </mrow> <mrow> <mfrac> <mn>1</mn> <mi>m</mi> </mfrac> <munderover> <mo>&Sigma;</mo> <mrow> <mi>j</mi> <mo>=</mo> <mn>1</mn> </mrow> <mi>m</mi> </munderover> <mrow> <mo>(</mo> <msub> <mi>G</mi> <mrow> <mi>n</mi> <mi>j</mi> </mrow> </msub> <mo>-</mo> <munderover> <mo>&Sigma;</mo> <mrow> <mi>i</mi> <mo>=</mo> <mn>1</mn> </mrow> <mi>n</mi> </munderover> <msub> <mi>K</mi> <mrow> <mi>n</mi> <mi>w</mi> <mi>i</mi> </mrow> </msub> <mo>&CenterDot;</mo> <msub> <mi>W</mi> <mrow> <mi>n</mi> <mi>i</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>K</mi> <mi>n</mi> </msub> <mo>&CenterDot;</mo> <mi>w</mi> <mo>)</mo> </mrow> </mrow> </mfrac> </mrow>

其中,j表示每次参与数据平滑处理的数据个数,j=1,...m,m=8~30,Gpj表示正向陀螺仪第j个采样点的输出值,Gnj表示负向陀螺仪第j个采样点的输出值,w为测试时刻的输入角速度。

5.根据权利要求1所述的方法,其特征在于,所述选取陀螺仪构建至少两个差分对包括:

从相同批次、相同工艺和相同量程的陀螺仪中选取陀螺仪构建至少两个差分对。

6.根据权利要求1所述的方法,其特征在于,所述依据所述正向陀螺仪的各阶系数和反向陀螺仪的各阶系数,计算各阶拟合系数包括:

将所述正向陀螺仪的各阶系数和反向陀螺仪的各阶系数做商,获得所述各阶拟合系数。

当前第2页1 2 3 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1