小型卫星姿态控制的MPC方法与实践

1. 卫星姿态控制的MPC方法概述

在CubeSat等小型卫星的姿控系统中，磁力矩执行器因其无活动部件、低功耗特性成为理想选择。但磁控存在两个固有挑战：一是力矩强度有限（典型值仅0.01-0.1 N·m量级），二是磁场方向随轨道位置变化。我们采用模型预测控制(MPC)框架，通过滚动优化克服这些限制。具体实现中，预测模型精度直接影响控制性能——简单的线性时不变(LTI)模型会导致高达5°的姿态误差，而本文提出的非线性传播方法可将误差控制在0.2°以内。

关键设计权衡：预测时域长度与计算负载的平衡。实测表明，90秒预测时域配合6秒控制周期，在3U CubeSat的STM32H7处理器上单次求解耗时约300ms，满足实时性需求。

2. 磁控系统动力学建模

2.1 双自旋卫星运动方程

对于带反作用轮的3U CubeSat（惯量矩阵I=diag{0.01,0.02,0.02} kg·m²），其非线性动力学方程为：

# 非线性动力学伪代码示例 def attitude_dynamics(x, u): ω = x[0:3] # 角速度(rad/s) q = x[3:7] # 四元数 τ_mag = cross(u, B_ECI2Body(q)) # 磁力矩(N·m) ω_dot = inv(I) @ (τ_mag - cross(ω, I@ω)) q_dot = 0.5 * quat_mult(q, [0, ω]) return concatenate([ω_dot, q_dot])

其中磁场向量B的轨道周期特性是关键。在420km高度ISS轨道，磁场强度约30-50μT，每90分钟完成一次极性反转。我们采用2020世界磁场模型(WMM)进行预测，其球谐展开式到12阶：

B(r,θ,φ) = -∇[R∑(R/r)^(n+1)∑(g_n^m cos(mφ)+h_n^m sin(mφ))P_n^m(cosθ)]

2.2 线性时变(LTV)近似方法

为实现实时MPC求解，需对非线性方程进行线性化。在滚动时域内，采用一阶泰勒展开：

A(t) = ∂f/∂x|_(x̄,ū), B(t) = ∂f/∂u|_(x̄,ū)

特别注意雅可比矩阵中磁场方向对控制效率的影响。当磁矩方向与B场夹角小于10°时，有效力矩下降超过98%，此时需启动反作用轮辅助（本方案中飞轮最大加速度10 rad/s²）。

3. 三种预测方法对比

3.1 轨道传播(OrbProp)方法

假设卫星姿态在预测时域内恒定，仅考虑轨道运动引起的磁场变化。该方法计算量最小（单次求解约150ms），但存在明显缺陷：

1. 磁矢量预测误差：最大达8°（见图5b）
2. 无法预判姿态耦合效应
3. 长期仿真中68%案例出现滚转角超限

3.2 线性传播(LinProp)方法

通过迭代线性化改进预测精度。关键步骤包括：

1. 初始猜测：采用OrbProp结果
2. 状态轨迹线性化：更新A(t), B(t)矩阵
3. 收敛条件：相邻迭代磁场角差ξ<0.1°

实测显示该方法磁预测误差降至3°，但20%案例因线性累积误差导致控制失效（图10）。

3.3 非线性传播(NonProp)方法

采用序列凸优化(SCP)框架，算法流程如图6所示：

1. 非线性传播：ODE45求解完整动力学
2. 轨迹线性化：保留一阶扰动项
3. 凸优化求解：转化为二阶锥规划(SOCP)

300轨道（19.3天）长期仿真表明：

• 姿态误差<0.2°（图15b）
• 磁矩消耗降低17% vs OrbProp
• 100%任务完成率

4. 实现细节与调参经验

4.1 权重矩阵设计

代价函数权重需平衡控制消耗与状态误差：

Q = diag([1e-12, 1, 1, 10, 1e-2, 1e-2]) * Δt/7.5e3; R = diag([10, 1, 1, 1]) * 7.5e5/Δt; % 抑制飞轮使用

软约束权重选择要点：

• 滚转速率约束ψ=1e4
• 指向锥约束ψ=1e5（更严格）

4.2 计算加速技巧

1. 热启动(Warm-start)：复用上一时刻解作为初始猜测，减少40%迭代次数
2. 稀疏化处理：利用雅可比矩阵带状结构，求解时间降低35%
3. 定点运算：将QP求解器移植到STM32H7的Cortex-M7内核，相比MATLAB提速8倍

5. 典型问题排查指南

5.1 发散问题处理

现象：优化器返回不可行解

• 检查预测时域内磁场可观测性：需满足rank([B, AB,... A^{n-1}B])=3
• 验证惯量参数误差：实测值与模型偏差应<5%
• 放宽软约束边界：临时增大α_max至20°

5.2 计算超时应对

1. 降阶处理：采用Galerkin投影将状态维度从6降至4
2. 事件触发：当误差<阈值时保持上一控制量
3. 代码优化：使用ARM CMSIS-DSP库加速矩阵运算

6. 扩展应用方向

本方法经修改后可适用于：

1. 磁悬浮控制：将B场模型替换为线圈磁场方程
2. 深空探测：结合星历扩展至行星磁场
3. 集群控制：分布式MPC协调多星姿态

实测中发现一个反直觉现象：在晨昏轨道面，由于磁场-速度矢量正交关系，控制效率比预期高23%。这提示我们环境特性可被主动利用——通过轨道参数优化进一步提升性能。