• 大小: 2.27KB
    文件类型: .m
    金币: 1
    下载: 0 次
    发布日期: 2021-03-28
  • 语言: Matlab
  • 标签: matlab  

资源简介


陀螺仪静态标定的matlab源程序,六位置法,希望对大家有帮助

资源截图

代码片段和文件信息

%%%%%%%%%%陀螺仪标定程序
clear;
clc;
%%%导入原始数据
w11=importdata(‘1.txt‘);
w21=importdata(‘2.txt‘); %%%第一组数据
w12=importdata(‘3.txt‘);
w22=importdata(‘4.txt‘); %%%第二组数据
w13=importdata(‘5.txt‘);
w23=importdata(‘6.txt‘); %%%第三组数据

%陀螺仪模型系数
L=39.97911667*pi/180;      %当地地理纬度         
wie=7.292115147e-5*180/pi;      %地球自转角速率
%陀螺仪每组测量数据的计算变量
wx11=w11(1:600005);
wx21=w21(1:600005);
wx12=w12(1:600005);
wx22=w22(1:600005);
wx13=w13(1:600005);
wx23=w23(1:600005);

wmx11=mean(wx11);
wmx21=mean(wx21);
wmx12=mean(wx12);
wmx22=mean(wx22);
wmx13=mean(wx13);
wmx23=mean(wx23);

wmx1=(wmx11-wmx21)/2;
wmx2=(wmx12-wmx22)/2;
wmx3=(wmx13-wmx23)/2;

wy11=w11(1:600006);
wy21=w21(1:600006);
wy12=w12(1:600006);
wy22=w22(1:600006);
wy13=w13(1:600006);
wy23=w23(1:600006);

wmy11=mean(wy11);
wmy21=mean(wy21);
wmy12=mean(wy12);
wmy22=mean(wy22);
wmy13=mean(wy13);
wmy23=mean(wy23);

wmy1=(wmy11-wmy21)/2;
wmy2=(wmy12-wmy22)/2;
wmy3=(wmy13-wmy23)/2;

wz11=w11(1:6000

评论

共有 条评论