Simulink - 6DOF (Euler Angles)

6DOF模块分为很多种类型,本次主要先介绍基于欧拉角的六自由度模块-6DOF (Euler Angles) 。模块是整个无人机物理仿真模型的绝对核心 。如果你把前面的 Rotor 模块比作无人机的"肌肉"(产生力量),那么这个模块就是"物理定律引擎",将会决定机身如何响应这些力量。该模块专门用于求解刚体六自由度空间运动的 牛顿-欧拉方程。

1.模块输入

模块只有两个输入,力与力矩,两者均为为3维的向量

: 这是当前时刻,无人机在机体坐标系 (Body Frame) 下受到的总合力 。它包含了所有旋翼的推力分量、空气阻尼力,以及重力在机体轴上的投影。

:这是当前时刻,无人机在机体坐标系下受到的总力矩。它包含了旋翼反扭矩、推力偏置力矩以及气动阻尼力矩。

2. 模块的核心物理引擎

在这个黑盒内部,Simulink 以极高的频率(比如你之前设置的 0.01 秒步长)疯狂求解以下两组非线性微分方程

2.1 平动动力学 (牛顿第二定律扩展版)

解算无人机的三轴线速度倒数

这里面巧妙地包含了 科氏加速度项,这是空间六自由度运动特有的

2.2 转动动力学 (欧拉方程)

解算角加速度

3. 模块输出

模块右侧吐出了一大排数据,这些数据将作为传感器的"真实值",反馈给你的控制算法

3.1 导航与轨迹观测系 (Earth Frame / 惯性系):

:在地球坐标系下的北-东-地 (NED) 速度。这是判断无人机往哪个地理方向飞的依据。

: 在地球坐标系下的绝对位置 \[x, y, z\]。其中 z 通常是负值,代表飞行高度(因为 Z 轴向下)。

3.2 姿态观测系

:欧拉角(滚转角、俯仰角、偏航角)

:方向余弦矩阵 (Direction Cosine Matrix),这是比欧拉角更底层的旋转矩阵,用于在机体坐标系和地球坐标系之间转换向量,能有效避免欧拉角在90度时的"万向节死锁"问题。

3.3 机载传感器反馈系

:机体三轴线速度 。正如我们之前所见,它被反馈给了 Rotor 模块去计算风速。

:机体三轴旋转角速度。它是你内环姿态控制(特征建模)最直接的被控变量,也是陀螺仪量测的真实值。

3.4 加速度反馈

:角加速度

:分别是机体坐标系和地球坐标系下的线加速度。这相当于机载加速度计 (IMU) 读取到的原始数据。

4. 参数设置

决定了它对推力和力矩的响应有多"迟钝"或多"灵敏"。

Initial Position (初始位置),

Initial Velocity (初始线速度),

Initial Euler Angles (初始欧拉角),

Initial Body Rotation Rates (初始机体角速度),

Initial mass (初始质量)

对角惯量矩阵设计 (Inertia)

相关推荐
码农三叔1 天前
(10-1)大模型时代的人形机器人感知:视觉-语言模型在机器人中的应用
人工智能·机器人·人机交互·人形机器人
视***间1 天前
视程空间(VisionSpace):以音视频技术创新,构筑全行业智能化新基座
人工智能·音视频·边缘计算·传感器·视程空间
Storynone1 天前
【Day26】LeetCode:452. 用最少数量的箭引爆气球,435. 无重叠区间,763. 划分字母区间
python·算法·leetcode
deephub1 天前
高级 RAG 技术:查询转换与查询分解
人工智能·深度学习·大语言模型·agent·rag
光羽隹衡1 天前
计算机视觉——Opencv(模块风格迁移)
人工智能·opencv·计算机视觉
信鸽爱好者1 天前
RTX5060 GPU CUDA12.8 +vscode 设计一个torch实例程序
人工智能·vscode·深度学习·编辑器
月明长歌1 天前
【码道初阶-Hot100】LeetCode 3. 无重复字符的最长子串:从错误直觉到滑动窗口,彻底讲透为什么必须判断 `map.get(c) >= left`
java·算法·leetcode·哈希算法
瑞瑞小安1 天前
Unity功能篇:PCVR开发(设备:HTC Vive Pro)更新中。。。
unity·游戏引擎
piao9618271 天前
Agentic AI时代来临:企业如何构建“数据挖掘-分析-决策”的端到端闭环?
人工智能·数据挖掘
xuxie991 天前
N4 传感器
人工智能