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:
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軸方向加速度值
2.根據(jù)權(quán)利要求1所述的方法,其特征在于,步驟S1中計算當前時刻慣性導航系統(tǒng)INS的X軸方向速度值vx1和Y軸方向速度值vy1,按如下公式計算:
3.根據(jù)權(quán)利要求1所述的方法,其特征在于,步驟S2中計算全球衛(wèi)星導航系統(tǒng)GNSS的X軸方向速度值vx和Y軸方向速度值vy,按如下公式計算:
4.根據(jù)權(quán)利要求1所述的方法,其特征在于,步驟S3中t0到t1時間段內(nèi)慣性導航系統(tǒng)INS的X軸方向加速度漂移值ax與Y軸方向加速度漂移值ay,按如下公式計算:
5.根據(jù)權(quán)利要求1所述的方法,其特征在于,步驟S4中計算慣性導航系統(tǒng)INS的X軸方向加速度漂移值變化斜率axd與Y軸方向加速度漂移值變化斜率ayd,按如下公式計算: