MATLAB - 读取双摆杆上的 IMU 数据

系列文章目录


前言

本示例展示了如何从安装在双摆杆上的两个 IMU 传感器生成惯性测量单元 (IMU) 读数。双摆使用 Simscape Multibody™ 进行建模。有关使用 Simscape Multibody™ 构建简易摆的分步示例,请参阅简易摆建模(Simscape Multibody)。

Matlab 复制代码
open_system("doublePendulumIMU.slx");

一、模型

Simscape Multibody™ 中的惯性参考框架(或世界框架)默认为右手笛卡尔坐标框架。旋进式关节仅可围绕主体参考框架的 Z 轴进行旋转。起初,惯性框架和车身参考框架是对齐的。刚性变换块将身体参照系的 X 轴旋转-90 度,这样变换后的 Y 轴就指向重力矢量的方向,而链接可以沿变换后的 Z 轴自由旋转。

将两个链接的末端帧作为模拟 IMU 的传感器帧。每个 IMU 都定义在一个 IMU 子系统中。

二、IMU 子系统

打开第一个 IMU 子系统。

您可以选择 IMU 输入的参考框架为 NED(北-东-下)或 ENU(东-北-上)框架。在本模拟中,您选择的是 ENU 框架,该框架与右手坐标框架对齐。第一个传感器变换块测量传感器框架和惯性框架之间的相对空间关系。重力加速度值将从总加速度中减去,因为 IMU 模块默认将重力加速度纳入惯性框架。IMU 模块将此信息转化为加速度计、陀螺仪和磁力计传感器数据。

第二个变换传感器模块提供 IMU 的预期地面实况测量数据。它测量惯性帧与传感器帧之间的相对空间关系,传感器帧的测量方法与 IMU 类似。加速度被否定,以补偿 IMU 模型中对加速度的否定。在 IMU 模型中这样做是为了在加速度计处于自由落体状态时获得零总加速度读数。有关 IMU 建模的更多详情,请参阅 imuSensor。

三、模拟和可视化 IMU 数据

由于双摆的主要旋转沿传感器框架的 Z 轴进行,因此 IMU 测量的主要加速度沿 X 轴和 Y 轴进行,主要旋转沿 Z 轴进行。下图显示了来自第二个 IMU 的模拟 IMU 数据,并将这些数据与地面实况进行了比较。

Matlab 复制代码
out = sim("doublePendulumIMU.slx");

% Simulated measurement data for the second IMU
wz = out.logsout{4}.Values.wz;
ax = out.logsout{4}.Values.ax;
ay = out.logsout{4}.Values.ay;

% Ground truth for the second IMU
wzgt = out.logsout{3}.Values.wz;
axgt = out.logsout{3}.Values.ax;
aygt = out.logsout{3}.Values.ay;

plot(wz);
hold on;
plot(wzgt);
legend("Measurement data","Ground truth");
ylabel("Angular velocity, w_z (rad/s)",Interpreter="tex")
xlabel("Time (s)")
title("Angular velocity along the Z axis")
pbaspect([2 1 1])
hold off;
Matlab 复制代码
plot(ax);
hold on;
plot(axgt);
legend("Measurement data","Ground truth");
ylabel("Linear acceleration, a_x (m/s^2)",Interpreter="tex")
xlabel("Time (s)")
title("Linear acceleration along the X axis")
pbaspect([2 1 1])
hold off;
Matlab 复制代码
plot(ay);
hold on;
plot(aygt);
legend("Measurement data","Ground truth");
ylabel("Linear acceleration, a_{y} (m/s^{2})",Interpreter="tex")
xlabel("Time (s)")
title("Linear acceleration along the Y axis")
pbaspect([2 1 1])
hold off;
相关推荐
一点媛艺2 小时前
Kotlin函数由易到难
开发语言·python·kotlin
姑苏风2 小时前
《Kotlin实战》-附录
android·开发语言·kotlin
奋斗的小花生3 小时前
c++ 多态性
开发语言·c++
魔道不误砍柴功3 小时前
Java 中如何巧妙应用 Function 让方法复用性更强
java·开发语言·python
闲晨3 小时前
C++ 继承:代码传承的魔法棒,开启奇幻编程之旅
java·c语言·开发语言·c++·经验分享
老猿讲编程3 小时前
一个例子来说明Ada语言的实时性支持
开发语言·ada
Chrikk4 小时前
Go-性能调优实战案例
开发语言·后端·golang
幼儿园老大*4 小时前
Go的环境搭建以及GoLand安装教程
开发语言·经验分享·后端·golang·go
canyuemanyue4 小时前
go语言连续监控事件并回调处理
开发语言·后端·golang
杜杜的man4 小时前
【go从零单排】go语言中的指针
开发语言·后端·golang