PSINS(高精度捷联惯导算法)

站内搜索

一组memsfoggps跑车测试

一组MEMS/FOG/GPS跑车测试

 

MEMS惯组为MTI710工作在垂直陀螺模式下(含水平姿态输出),FOG惯组为惯性级别,两IMU采样频率均为100Hz;GPS采用差分,输出频率5Hz。先静止730s,再跑车约3小时,车速较慢约3.5m/s,行车范围约方圆10km内,外行再返回。该数据可用作FOG纯惯性、MEMS/GPS组合、FOG/GPS组合、MEMS/FOG传递对准、MEMS航姿对比等试验。

利用Matlab/PSINS Toolbox进行数据加载和一些简单测试程序如下:

glvs;

ts = 1/100;

t1 = 700; t2 = 1300;

load lb_memsfoggps;

imuplot(imuFOG); imuplot(imuMTI); gpsplot(gps); insplot(attMTI, 'a');

att0 = aligni0(imuFOG(400/ts:t1/ts,:), gps(1,4:6)');

avp = inspure(imuFOG(t1/ts:1700/ts,:), [att0; getat(gps,t1)], 'H');

avpcmpplot(avp(:,[1:3,end]), datacut(attMTI,700,1700), 'a', 'datt');

 

avp0 = [att0; getat(gps,t1)];

ins = insinit(avp0, ts);

avperr = avperrset([10*60;30*60], 10, 100);

imuerr = imuerrset(1000, 10000, 0.1, 100);

Pmin = [avperrset([0.5,2],0.01,0.01); gabias(1, [100,100]); [0.01;0.01;0.01]; 0.01].^2;

Rmin = vperrset(0.1, 0.1).^2;

[avp1, xkpk1, zkrk1, sk] = sinsgps(imuMTI(t1/ts:t2/ts,:), gps, ins, avperr, imuerr, rep3(1), 0.1, vperrset(1,10), Pmin, Rmin, 'avped');

avpcmpplot(avp, avp1, 'avp', 'mu');

avpcmpplot(gps, avp1, 'vp');

 

 

img1

 

img2

跑车及试验设备图

img3

IMU输出

img4

GPS输出

img5

二维行车轨迹平面图

img6

光纤惯导初始对准(400-700s)

img7

光纤纯惯性导航(700-1700s)

img8

MTI输出水平姿态与光纤对比(显示MTI最大差约50角分)

img9

MEMS/GPS组合(700-1300s)

 

数据(由大连理工大学刘兵提供)下载地址:

https://pan.baidu.com/s/1_goFSDMRDYRv1L3Xx7Uqtg  (提取码5v6s)