欧美在线观看视频网站,亚洲熟妇色自偷自拍另类,啪啪伊人网,中文字幕第13亚洲另类,中文成人久久久久影院免费观看 ,精品人妻人人做人人爽,亚洲a视频

基于GNSS的慣性導航加速度計漂移實時補償方法與流程

文檔序號:11130730閱讀:來源:國知局

技術(shù)特征:

1.一種基于GNSS的慣性導航的加速度計漂移實時補償方法,包括:

S1.獲取慣性導航系統(tǒng)INS輸出的X軸方向加速度信號ax1和Y軸方向加速度信號ay1,并在上一時刻t0到當前時刻t1內(nèi)對加速度信號進行積分,計算當前時刻慣性導航系統(tǒng)INS的X軸方向速度值vx1和Y軸方向速度值vy1;

S2.獲取全球衛(wèi)星導航系統(tǒng)GNSS當前時刻t1的定位信息(x1,y1)與上一時刻t0輸出的定位信息(x0,y0),計算全球衛(wèi)星導航系統(tǒng)GNSS的X軸方向速度值vx和Y軸方向速度值vy;

S3.計算慣性導航系統(tǒng)INS的X軸方向加速度漂移值ax與Y軸方向加速度漂移值ay

S31)根據(jù)慣性導航系統(tǒng)INS測得的速度值vx1與vy1和全球衛(wèi)星導航系統(tǒng)GNSS測得的速度值vx和vy,得到慣性導航系統(tǒng)INS的X軸方向速度變化斜率vxd與Y軸方向速度變化斜率vyd

<mrow> <mtable> <mtr> <mtd> <mrow> <msub> <mi>v</mi> <mrow> <mi>x</mi> <mi>d</mi> </mrow> </msub> <mo>=</mo> <mfrac> <mrow> <msub> <mi>v</mi> <mi>x</mi> </msub> <mo>-</mo> <msub> <mi>v</mi> <mrow> <mi>x</mi> <mn>1</mn> </mrow> </msub> </mrow> <mrow> <msub> <mi>t</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>t</mi> <mn>0</mn> </msub> </mrow> </mfrac> </mrow> </mtd> <mtd> <mrow> <msub> <mi>v</mi> <mrow> <mi>y</mi> <mi>d</mi> </mrow> </msub> <mo>=</mo> <mfrac> <mrow> <msub> <mi>v</mi> <mi>y</mi> </msub> <mo>-</mo> <msub> <mi>v</mi> <mrow> <mi>y</mi> <mn>1</mn> </mrow> </msub> </mrow> <mrow> <msub> <mi>t</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>t</mi> <mn>0</mn> </msub> </mrow> </mfrac> </mrow> </mtd> </mtr> </mtable> <mo>;</mo> </mrow>

S32)對慣性導航系統(tǒng)INS的X軸方向速度變化斜率vxd與Y軸方向速度變化斜率vyd進行求導,計算t0到t1時間段內(nèi)慣性導航系統(tǒng)INS的X軸方向加速度漂移值ax與Y軸方向加速度漂移值ay;

S4.計算慣性導航系統(tǒng)INS的X軸方向加速度漂移值變化斜率axd與Y軸方向加速度漂移值變化斜率ayd

S5.利用S4的結(jié)果分別對慣性導航系統(tǒng)INS在下一時刻t2的X軸方向加速度值ax2和Y軸方向加速度值ay2進行補償,得到補償后的X軸方向加速度值和Y軸方向加速度值

<mrow> <msubsup> <mi>a</mi> <mrow> <mi>x</mi> <mn>2</mn> </mrow> <mi>g</mi> </msubsup> <mo>=</mo> <msub> <mi>a</mi> <mrow> <mi>x</mi> <mi>d</mi> </mrow> </msub> <mrow> <mo>(</mo> <msub> <mi>t</mi> <mn>2</mn> </msub> <mo>-</mo> <msub> <mi>t</mi> <mn>1</mn> </msub> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>a</mi> <mrow> <mi>x</mi> <mn>2</mn> </mrow> </msub> <mo>,</mo> </mrow>

<mrow> <msubsup> <mi>a</mi> <mrow> <mi>y</mi> <mn>2</mn> </mrow> <mi>g</mi> </msubsup> <mo>=</mo> <msub> <mi>a</mi> <mrow> <mi>y</mi> <mi>d</mi> </mrow> </msub> <mrow> <mo>(</mo> <msub> <mi>t</mi> <mn>2</mn> </msub> <mo>-</mo> <msub> <mi>t</mi> <mn>1</mn> </msub> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>a</mi> <mrow> <mi>y</mi> <mn>2</mn> </mrow> </msub> <mo>.</mo> </mrow>

2.根據(jù)權(quán)利要求1所述的方法,其特征在于,步驟S1中計算當前時刻慣性導航系統(tǒng)INS的X軸方向速度值vx1和Y軸方向速度值vy1,按如下公式計算:

<mrow> <msub> <mi>v</mi> <mrow> <mi>x</mi> <mn>1</mn> </mrow> </msub> <mo>=</mo> <msubsup> <mo>&Integral;</mo> <msub> <mi>t</mi> <mn>0</mn> </msub> <msub> <mi>t</mi> <mn>1</mn> </msub> </msubsup> <msub> <mi>a</mi> <mrow> <mi>x</mi> <mn>1</mn> </mrow> </msub> <mi>d</mi> <mi>x</mi> </mrow>

<mrow> <msub> <mi>v</mi> <mrow> <mi>y</mi> <mn>1</mn> </mrow> </msub> <mo>=</mo> <msubsup> <mo>&Integral;</mo> <msub> <mi>t</mi> <mn>0</mn> </msub> <msub> <mi>t</mi> <mn>1</mn> </msub> </msubsup> <msub> <mi>a</mi> <mrow> <mi>y</mi> <mn>1</mn> </mrow> </msub> <mi>d</mi> <mi>y</mi> <mo>.</mo> </mrow>

3.根據(jù)權(quán)利要求1所述的方法,其特征在于,步驟S2中計算全球衛(wèi)星導航系統(tǒng)GNSS的X軸方向速度值vx和Y軸方向速度值vy,按如下公式計算:

<mrow> <msub> <mi>v</mi> <mi>x</mi> </msub> <mo>=</mo> <mfrac> <mrow> <msub> <mi>x</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>x</mi> <mn>0</mn> </msub> </mrow> <mrow> <msub> <mi>t</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>t</mi> <mn>0</mn> </msub> </mrow> </mfrac> </mrow>

<mrow> <msub> <mi>v</mi> <mi>y</mi> </msub> <mo>=</mo> <mfrac> <mrow> <msub> <mi>y</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>y</mi> <mn>0</mn> </msub> </mrow> <mrow> <msub> <mi>t</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>t</mi> <mn>0</mn> </msub> </mrow> </mfrac> <mo>.</mo> </mrow>

4.根據(jù)權(quán)利要求1所述的方法,其特征在于,步驟S3中t0到t1時間段內(nèi)慣性導航系統(tǒng)INS的X軸方向加速度漂移值ax與Y軸方向加速度漂移值ay,按如下公式計算:

<mrow> <msub> <mi>a</mi> <mi>x</mi> </msub> <mo>=</mo> <mfrac> <mrow> <mo>&part;</mo> <msub> <mi>v</mi> <mrow> <mi>x</mi> <mi>d</mi> </mrow> </msub> </mrow> <mrow> <mo>&part;</mo> <mi>x</mi> </mrow> </mfrac> </mrow>

<mrow> <msub> <mi>a</mi> <mi>y</mi> </msub> <mo>=</mo> <mfrac> <mrow> <mo>&part;</mo> <msub> <mi>v</mi> <mrow> <mi>y</mi> <mi>d</mi> </mrow> </msub> </mrow> <mrow> <mo>&part;</mo> <mi>y</mi> </mrow> </mfrac> <mo>.</mo> </mrow>

5.根據(jù)權(quán)利要求1所述的方法,其特征在于,步驟S4中計算慣性導航系統(tǒng)INS的X軸方向加速度漂移值變化斜率axd與Y軸方向加速度漂移值變化斜率ayd,按如下公式計算:

<mrow> <msub> <mi>a</mi> <mrow> <mi>x</mi> <mi>d</mi> </mrow> </msub> <mo>=</mo> <mfrac> <msub> <mi>a</mi> <mi>x</mi> </msub> <mrow> <msub> <mi>t</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>t</mi> <mn>0</mn> </msub> </mrow> </mfrac> </mrow>

<mrow> <msub> <mi>a</mi> <mrow> <mi>y</mi> <mi>d</mi> </mrow> </msub> <mo>=</mo> <mfrac> <msub> <mi>a</mi> <mi>y</mi> </msub> <mrow> <msub> <mi>t</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>t</mi> <mn>0</mn> </msub> </mrow> </mfrac> <mo>.</mo> </mrow>

當前第2頁1 2 3 
網(wǎng)友詢問留言 已有0條留言
  • 還沒有人留言評論。精彩留言會獲得點贊!
1
房山区| 襄樊市| 和顺县| 镶黄旗| 安远县| 福泉市| 宜州市| 新竹县| 日土县| 武鸣县| 屏东县| 绥棱县| 连州市| 遵化市| 呼和浩特市| 绥宁县| 珠海市| 平阴县| 铜陵市| 迭部县| 丁青县| 正阳县| 武邑县| 来凤县| 丰原市| 大化| 博客| 塘沽区| 闽清县| 仁化县| 镇江市| 淮安市| 建阳市| 锡林浩特市| 合江县| 永胜县| 玛曲县| 峨山| 蒙自县| 曲沃县| 札达县|