• 大小: 1KB
    文件类型: .m
    金币: 2
    下载: 1 次
    发布日期: 2021-05-13
  • 语言: Matlab
  • 标签: 惯性导      matla  IMU  

资源简介

关于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

评论

共有 条评论