資源簡介
關(guān)于IMU慣導(dǎo)標(biāo)定的matlab實現(xiàn),為學(xué)習(xí)大作業(yè)。程序中使用了六位置法進(jìn)行標(biāo)定,數(shù)據(jù)格式為加速度計和陀螺儀輸出數(shù)據(jù),經(jīng)過數(shù)據(jù)篩選進(jìn)行標(biāo)定
代碼片段和文件信息
clear;?
A=load(‘Calibration_Data.txt‘);?%??清除環(huán)境并加載觀測文件?
X=A(:5);
Y=A(:6);
Z=A(:7);?%?提取三軸加速度計輸出數(shù)據(jù)
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
評論
共有 條評論