4. 坐标系与运动学
电动垂直起降飞行器(eVTOL)的建模与辨识工作,其首要任务是在不同的参考坐标系下准确描述飞行器的运动状态。无论是气动力的计算、惯性导航的解算,还是控制律的设计,都依赖于对坐标系和姿态描述方法的深刻理解。本章将系统梳理地面坐标系、机体坐标系和速度坐标系(风轴系)的定义及其转换关系,深入剖析欧拉角与四元数两种姿态描述方法的数学本质与工程适用场景,并推导核心的姿态运动学方程。这些内容构成了后续动力学建模、传感器辨识与飞控算法验证的数学基石。
在eVTOL的研发流程中,坐标系定义不统一或姿态描述方法选择不当,往往会导致辨识数据混乱、控制律设计失效等严重问题。本节将从数学定义出发,结合工程实践,深入剖析这三个核心坐标系的内在联系与转换逻辑。
4.1 三大坐标系的定义与工程语义
核心原理:坐标系是描述飞行器运动状态的参考基准。在eVTOL建模中,我们通常使用右手直角坐标系。地面坐标系(G系,NED)固定于地球表面,为惯性导航提供位置参考;机体坐标系(B系)固连于飞行器,是惯性测量单元(IMU)和飞控系统的直接参考;速度坐标系(W系)则与来流方向对齐,是气动系数辨识的核心基准。
工程要点:对于eVTOL这类包含多旋翼与固定翼混合模式的飞行器,坐标系的选择直接影响动力学方程的复杂度。例如,在悬停模态下,机体轴系与地面系之间的转换频繁,采用四元数可避免欧拉角的万向锁问题;而在高速巡航模态下,速度系下的气动模型更为直观。
判断方法:在实际建模中,可通过以下步骤确定坐标系使用策略:
- 明确任务阶段:导航与制导优先使用G系;姿态控制与IMU数据处理使用B系;气动参数辨识与风洞实验数据处理使用W系。
- 检查转换链路:确保从G系到B系的旋转矩阵(由姿态角构成)与从B系到W系的气动角(攻角α、侧滑角β)定义一致,避免符号混淆。
- 验证右手定则:所有坐标系必须满足 X×Y=Z 的右手法则,否则后续的叉乘运算(如力矩方程)将出现符号错误。
| 坐标系 | 原点 | X轴 | Y轴 | Z轴 | 典型传感器/数据源 |
|---|---|---|---|---|---|
| 地面系 (G) | 起飞点/参考点 | 北向 | 东向 | 地向 | GPS、北斗、视觉定位 |
| 机体系 (B) | 飞行器质心 | 机头方向 | 右翼方向 | 机体下方 | IMU(陀螺仪+加速度计) |
| 速度系 (W) | 飞行器质心 | 来流方向 | 垂直于Xw向右 | 对称面内向下 | 空速管、迎角/侧滑角传感器 |
在eVTOL的建模实践中,地面系通常被定义为局部切平面坐标系,忽略地球曲率影响,这在中短程城市空中交通(UAM)场景下是合理的近似。机体系的原点必须与IMU的安装位置严格对齐,否则会引入杆臂效应误差,这一点在辨识实验中尤为重要。
4.2 欧拉角与四元数:姿态描述的数学工具
核心原理:欧拉角通过三次连续旋转(通常为Z-Y-X顺序)描述姿态,物理意义直观,但存在万向锁奇异点。四元数是一种超复数,用四个参数描述三维旋转,无奇异点,且微分方程是线性的,非常适合计算机数值积分。
对比分析:在eVTOL的飞控计算机中,姿态解算几乎全部采用四元数。然而,在气动数据辨识的输出环节,工程师更倾向于将四元数转换为欧拉角,以便与风洞实验数据或CFD仿真结果进行直观对比。
// 四元数转欧拉角(Z-Y-X顺序)伪代码示例
// 输入: q0, q1, q2, q3 (归一化四元数)
// 输出: roll(φ), pitch(θ), yaw(ψ)
roll = atan2(2*(q0*q1 + q2*q3), 1 - 2*(q1*q1 + q2*q2));
pitch = asin(2*(q0*q2 - q3*q1));
yaw = atan2(2*(q0*q3 + q1*q2), 1 - 2*(q2*q2 + q3*q3));
风险提示:当俯仰角接近±90°时,欧拉角转换公式中的asin函数参数会超出[-1,1]区间,导致NaN输出。在eVTOL的垂直起降阶段,俯仰角变化剧烈,必须对转换函数进行边界保护,或直接使用四元数进行控制律解算。
操作流程:在MATLAB/Simulink或C++代码中实现姿态解算时,建议遵循以下流程:
- 陀螺仪输出角速度(rad/s),在B系下表示为 ω = [p, q, r]ᵀ。
- 使用四元数微分方程 q̇ = 0.5 · q ⊗ ω(四元数乘法)进行积分。
- 周期性对四元数进行归一化处理,防止数值漂移。
- 仅在需要显示或记录时,将四元数转换为欧拉角。
4.3 姿态运动学方程的推导与工程应用
核心原理:姿态运动学描述了姿态参数随时间的变化率与机体角速度之间的关系。对于欧拉角,其运动学方程为:
[φ̇, θ̇, ψ̇]ᵀ = E⁻¹(φ,θ) · [p, q, r]ᵀ
其中变换矩阵E在θ=±90°时奇异。而四元数运动学方程为:
q̇ = 0.5 · Ω(ω) · q
其中Ω(ω)是由角速度分量构成的反对称矩阵。该方程是线性的,无奇异点,且计算效率高。
案例拆解:在某eVTOL原型机的辨识试飞中,试飞员执行了“悬停-前飞-过渡”的机动。在过渡阶段,俯仰角从0°迅速拉升至25°,随后进入固定翼模式。若采用欧拉角运动学方程进行姿态解算,在俯仰角接近90°的瞬间(虽然该机型未达到),系统将面临数值发散风险。工程团队最终采用四元数解算,并在数据后处理中,利用四元数球面线性插值(SLERP)对缺失的IMU数据进行重构,成功获得了完整的姿态变化曲线。
| 特性 | 欧拉角 | 四元数 |
|---|---|---|
| 参数数量 | 3 | 4(1个标量+3个矢量) |
| 奇异点 | 有(θ=±90°) | 无 |
| 微分方程 | 非线性,含三角函数 | 线性,仅含四元数乘法 |
| 计算开销 | 较低(但需处理三角函数) | 略高(但数值稳定性好) |
| 物理直观性 | 强 | 弱 |
| 工程首选 | 显示、报告 | 解算、控制、滤波 |
常见误区:初学者常将欧拉角速率 [φ̇, θ̇, ψ̇]ᵀ 直接等同于机体角速度 [p, q, r]ᵀ,这是完全错误的。前者是欧拉角对时间的导数,后者是机体坐标系下的物理角速度矢量,二者通过变换矩阵E联系。在辨识实验中,若混淆这两个概念,将导致气动阻尼项的辨识结果出现数量级错误。
经验总结:在eVTOL建模与辨识项目中,建议建立统一的“坐标系与姿态”数据字典,明确每个变量的定义域、单位和参考系。在代码层面,封装独立的坐标转换函数库,并编写单元测试用例(如已知欧拉角[30°, 20°, 10°]验证四元数转换结果)。这能显著减少因坐标系混乱导致的集成调试时间。
综上所述,地面系、机体系与速度系构成了eVTOL运动描述的物理框架,而欧拉角与四元数则提供了数学语言。掌握姿态运动学方程的推导与数值实现,是后续开展气动参数辨识、飞控律设计及半物理仿真的前提。在下一阶段的动力学建模中,我们将基于本章的坐标系定义,引入力与力矩方程,构建完整的六自由度运动模型。