資源簡介
關于IMU慣導標定的matlab實現,為學習大作業。程序中使用了六位置法進行標定,數據格式為加速度計和陀螺儀輸出數據,經過數據篩選進行標定
代碼片段和文件信息
clear;?
A=load(‘Calibration_Data.txt‘);?%??清除環境并加載觀測文件?
X=A(:5);
Y=A(:6);
Z=A(:7);?%?提取三軸加速度計輸出數據
z1=zeros(31);
z2=zeros(31);
x1=zeros(31);
x2=zeros(31);
y1=zeros(31);
y2=zeros(31);
z1(11)=sum(Z(1:75000:)1)/75000;
z1(21)=sum(X(1:75000:)1)/75000;
z1(31)=sum(Y(1:75000:)1)/75000;
z2(11)=sum(Z(103000:183000:)1)/80000;
z2(21)=sum(X(103000:183000:)1)/80000;
z2(31)=sum(Y(103000:183000:)1)/80000;
x1(11)=sum(Z(186000:236000:)1)/50000;
x1(21)=sum(X(186000:236000:)1)/50000;
x1(31)=sum(Y(186000:236000:)1)/50000;
x2(11)=sum(Z(245000:2950
- 上一篇:LBF模型matlab代碼
- 下一篇:基于matlab的潮流計算PQ分解法4節點
評論
共有 條評論