[发明专利]一种姿态机动的轨迹规划方法

权利要求书

1.一种姿态机动的轨迹规划方法，其特征在于包括下列步骤：

(1)、根据机动起点的姿态四元数q_B和机动目标点的姿态四元数q_T，确定误差四元数q_BT、欧拉角Φ和特征主轴具体计算方法如下：

qBT=qB-1⊗qT]]>

Φ＝2acos(N_BT)

其中，代表四元数乘积计算，机动起点的姿态四元数q_B的矢量部分和标量部分分别为V_B和N_B，则的矢量部分V_B′＝-V_B，的标量部分N_B′＝N_B；acos()代表反余弦函数，N_BT为误差四元数q_BT的标量部分；V_BT为误差四元数q_BT的矢量部分；

(2)、对沿特征主轴的欧拉角Φ进行轨迹规划，得到特征主轴方向上的规划角速度函数和规划角度函数Φ_r(t)，其中t为时间变量；

(3)、根据步骤(2)得到的规划角速度函数和规划角度函数Φ_r(t)，并利用机动特征主轴和机动起点四元数q_B，得到姿态机动过程中的规划四元数函数q_r(t)和规划目标角速度函数ω_r(t)，具体计算过程如下：

(3a)、根据机动特征主轴和规划角度函数Φ_r(t)得到第一规划四元数函数q_m(t)，其中，第一规划四元数函数q_m(t)矢量部分和标量部分分别为V_m(t)和N_m(t)：

Nm(t)=cos(Φr(t)2)]]>

(3b)、根据步骤(3a)计算得到的第一规划四元数函数q_m(t)和机动起点四元数q_B计算得到姿态机动过程中的规划四元数函数q_r(t)：

qr(t)=qB⊗qm(t)]]>

(3c)、根据机动特征主轴和规划角速度函数计算得到姿态机动过程中的规划目标角速度函数ω_r(t)：

(4)、输出步骤(3)得到的姿态机动过程中的规划四元数函数q_r(t)和规划目标角速度函数ω_r(t)到外部姿态控制系统。

2.根据权利要求1所述的一种姿态机动的轨迹规划方法，其特征在于，姿态机动为单轴、双轴或三轴姿态机动。