【PSINS工具箱】无时间戳时，IMU数据解算与绘图（带源码）

MATLAB卡尔曼

已于 2024-03-31 22:04:53 修改

阅读量673

点赞数 7

CC 4.0 BY-SA版权

分类专栏：基于PSINS工具箱的程序设计文章标签： matlab PSINS工具箱

于 2024-03-28 21:15:20 首次发布

本文链接：https://blog.csdn.net/callmeup/article/details/137124653

基于PSINS工具箱的程序设计专栏收录该内容

36 篇文章 ¥49.90 ¥99.00

订阅专栏

本文介绍了在IMU数据缺乏时间戳的情况下，如何通过补充采样周期来完成数据解算与绘图的过程。提供的程序源码详细展示了这一操作，输入的IMU数据包括3列角速度和3列加速度。

摘要生成于 C知道，由 DeepSeek-R1 满血版支持，前往体验 >

背景

遇到一个例子，在IMU没有时间戳时，先根据采样周期（或采样频率）将时间戳补齐，然后再进行解算的程序。
要求：输入的imu信息前6列分别为：3列角速度、3列加速度。

程序源码

% 基于PSINS工具箱的IMU数据解算（无时间戳）
% Evand(evandworld@qq.com)/Ver1/2024-3-28
clc;clear;close all;
ts = 0.008;
glvs;
% 在这里需要输入imu信息
imu(:,7) = [ts:ts:ts*size(imu,1)];
avp0 = [[0;0;0]; [0;0;0]; glv.pos0]; % init avp
ins_pure = insinit(avp0, ts);
for k=1:size(imu,1)
    wvm = imu(k,:);
    ins_pure = insupdate(ins_pure, wvm);
    avp(:,k) = ins_pure.avp;
end
insplot(avp');