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

站内搜索

一组14小时的IMU和地磁测试数据

一组14小时的IMU/地磁测试数据

MEMS-IMU3轴地磁静止放置,采集频10Hz输出姿/航向、三轴陀螺、三轴加计、三轴磁数据,总采集时间14小时640到第二天900

PSINS读取和作图程序如下:

glvs

ts = 1/10; t0 = hms2s(184000);

load subway_disturb_imu_mag.mat;

imu = imurfu([[data(:,7:9)*glv.dps, data(:,4:6)*glv.g0]*ts, (1:length(data))'*ts],'frd'); imuplot(imu);

% imumeanplot(imu, 100, glv.dph');

% avars(imu(:,1:3)/ts/glv.dph, ts);

mag = imurfu([data(:,10:12)*10,imu(:,end)], 'frd'); magplot(mag);

% myfig; plot(mod((t0+mag(:,end))/3600,24), mag(:,1:3), '.'); xygo('t / h', 'mag / mG');

att = [data(:,[3,2,1])*glv.deg,imu(:,end)]; insplot(att);

% att = yawcvt([data(:,[3,2,1])*glv.deg,imu(:,end)]); insplot(att);

 

作图结果如下:

img1

1 IMU 10s平滑(加计有点斜0.2mg/14h,算是不错了)

img2

2  Allan方差(由于陀螺在不断利用静态判断扣零偏,所以没有呈现出趋势项)

img3

3  采用航姿算法解算的姿/航向

img4

4  地磁数据(凌1:00-6:00红色天向波动相比其它时间段明显小,其它时段可能是受环境影响,测试地点离地100m左右)

 

感谢热心网友提供数据下载地址:

链接:https://pan.baidu.com/s/1d-LC7A_cujQweIGn2Ifq6Q   提取码d8py