一种刚体空间运动状态的任意阶输出方法

摘要

本发明公开了一种刚体空间运动状态的任意阶输出方法，该方法通过定义三元数，使得机体轴系三个速度分量和三元数构成线性微分方程组，可以按照任意阶保持器的方式求解系统的状态转移矩阵，进而得到刚体运动离散状态方程的表达式，避免了姿态方程奇异问题，从而得到刚体主要运动状态；本发明通过引入三元数使得状态转移矩阵为分块上三角形式，可以降阶求解状态转移矩阵，大大简化了计算复杂度，便于工程使用。

主权项

1.一种刚体空间运动状态的任意阶输出方法，其特征包括以下步骤：机体轴系三个速度分量输出为：其中：u，v，w分别为沿刚体机体轴系x，y，z轴的速度分量，n_x，n_y，n_z分别为沿x，y，z轴的过载，g为重力加速度，s₁、s₂、s₃为定义的三元数，且以上两式中可取t₀＝kT，t＝(k+1)T；p，q，r分别为滚转、俯仰、偏航角速度，T为采样周期；全文参数定义相同；高度输出为：其中：h为高度；姿态角的输出为：其中：，ψ分别表示滚转、俯仰、偏航角，