基于反作用飞轮的卫星三轴姿态控制系统仿真

资 源 简 介

本项目构建了一个完整的卫星三轴姿态控制仿真平台，重点在于模拟使用反作用飞轮（Reaction Wheels）作为主要执行机构的姿态稳定与机动过程。首先，基于欧拉动力学方程和四元数运动学方程建立了卫星刚体动力学模型，避免了欧拉角描述中的奇异性问题。其次，详细建立了飞轮执行机构的数学模型，包括电机电特性、转子动力学以及力矩饱和与转速饱和的非线性特性。控制系统设计部分采用了PID控制算法或滑模变结构控制（SMC）算法，计算所需的三轴控制力矩，并通过伪逆法或其他分配逻辑将控制指令映射到具体的飞轮阵列上（如正交四轮配置或金字塔构型）。仿真环境还引入了外部环境扰动（如重力梯度力矩、气动力矩等）以及传感器测量噪声，以验证控制系统的鲁棒性和指向精度。该项目能够演示卫星从任意初始姿态机动至目标姿态的全过程，并监测飞轮的卸载需求与能量消耗情况。

详 情 说 明

基于飞轮执行机构的卫星姿态控制系统仿真

项目简介

本项目构建了一个高精度的卫星三轴姿态控制仿真平台，基于MATLAB环境开发。项目模拟了卫星利用反作用飞轮（Reaction Wheels）作为主要执行机构，从初始随机姿态机动并稳定至目标姿态的全过程。

仿真核心包含了刚体动力学、四元数运动学、执行机构非线性特性以及环境扰动模型，旨在验证姿态控制算法的有效性和鲁棒性。

功能特性

• 全姿态动力学建模：采用欧拉动力学方程描述卫星刚体运动，使用四元数（Quaternion）描述姿态运动学，有效避免了欧拉角描述中的奇异性问题（Gimbal Lock）。
• 高保真执行机构模型：

* 构型：采用4个飞轮组成的金字塔构型（Pyramid Configuration），安装倾角设定为 53.13°。 * 分配算法：通过伪逆矩阵（Pseudo-Inverse）将三轴控制力矩指令映射到4个飞轮的转矩指令上。 * 非线性饱和：内置了飞轮输出力矩限幅（0.5 Nm）和最大转速饱和（5000 rpm）模型，模拟真实物理限制。

• 控制算法：

* 内置 PID控制（基于四元数误差反馈的PD控制）作为默认控制策略。 * 内置 滑模变结构控制（SMC） 代码实现，可通过参数切换。

• 环境扰动模拟：引入了综合环境力矩，包括重力梯度力矩（近似模型）、传感器测量白噪声以及周期性的气动力矩扰动。
• 高精度数值解算：采用四阶龙格-库塔法（Runge-Kutta 4th Order, RK4）进行系统状态的数值积分。

系统要求

• MATLAB R2016a 或更高版本。
• 无需额外工具箱（核心运算基于基础矩阵操作）。

算法与实现细节

本仿真脚本通过单一入口函数管理参数设置、物理建模、控制解算与数值积分，具体实现逻辑如下：

1. 物理模型与参数

• 卫星本体：定义了非对角主惯性量矩阵，模拟一般的非对称刚体卫星。
• 飞轮阵列：定义了金字塔构型的安装矩阵 $A$。该矩阵不仅用于将飞轮力矩投影到卫星体坐标系，也用于计算飞轮组在体坐标系下的总角动量 $H_{rw}$，从而在动力学方程中正确体现陀螺耦合效应。

2. 状态定义

系统状态向量 $X$ 为11维向量：

• $X(1:4)$：姿态四元数 $q$（标量首项）。
• $X(5:7)$：卫星角速度 $omega$。
• $X(8:11)$：4个飞轮的转子转速 $Omega_{rw}$。

3. 控制与分配逻辑

在每个仿真步长内，执行以下闭环控制流程：

1. 误差计算：计算目标四元数与当前四元数的误差，并确保标量部分非负以寻找最短旋转路径（Shortest path logic）。
2. 控制律计算：

* PID模式：$T_{cmd} = -K_p cdot q_{err_{vec}} - K_d cdot omega_{err}$，利用四元数的矢量部分进行比例反馈。 * SMC模式：基于滑模面 $s = omega_{err} + c cdot q_{err_{vec}}$ 计算控制力矩。

1. 力矩分配：利用安装矩阵的伪逆 $A^dagger$，将控制力矩分配给4个飞轮。
2. 饱和处理：

* 检查指令力矩是否超过最大输出力矩。 * 转速保护：如果飞轮已达到最大转速且指令力矩试图令其继续加速，则强制该飞轮输出力矩为0。

4. 动力学核心 (SatDynamics)

这是系统演化的核心函数，处理耦合动力学方程：

• 运动学：$dot{q} = frac{1}{2} Omega_{mat} cdot q$。
• 飞轮动力学：$dot{Omega}_{rw} = T_{rw} / J_{rw}$。
• 姿态动力学：完整考虑了欧拉方程中的交叉乘积项，即 $J dot{omega} + omega times (Jomega + H_{rw}) = T_{ext} - T_{reaction}$。其中 $H_{rw}$ 是飞轮组的总角动量，体现了飞轮高速旋转对卫星本体产生的陀螺刚度影响。

5. 数值积分 (RK4)

主循环不依赖 ode45，而是手动实现了定步长（0.05s）的 RK4 算法。这确保了在每一步积分中，飞轮饱和状态、随机噪声和控制指令都能被精确更新。每一步积分后都会对四元数进行归一化处理，防止数值漂移。

使用方法

1. 打开 MATLAB，定位到项目所在目录。
2. 直接运行主函数。
3. 参数调整：

* 在代码的 参数设置 部分可以修改控制增益 Ctrl.Kp, Ctrl.Kd。 * 通过修改 Ctrl.Type 变量为 'SMC' 可切换至滑模控制算法。 * 可以调整 Sat.J 或 RW.A 来模拟不同构型的卫星。

结果演示

程序运行结束后，将自动生成可视化图表：

• 三轴欧拉角响应图：显示 Roll, Pitch, Yaw 随时间变化的曲线，展示姿态收敛过程。
• 角速度误差图：展示三轴角速度趋于零的过程。
• 力矩输出图：记录4个飞轮的实际输出力矩，从中可以观察到力矩分配情况及是否触发饱和限制。
• 3D动画（如代码完整）：通过 PlayAnimation 函数演示卫星在空间中的转动过程。