误差四元数及其在航天器姿态控制中的应用

以四元数作为定位参数对航天器进行姿态控制。首先导出了误差四元数矢量,从而解决了航天器姿态控制中最终姿态表示的非单值性问题;其次,通过一个典型例子提出了非线性三轴姿态控制方法,该方法以误差四元数作为反馈量,以控制力矩陀螺作为执行元件,利用李亚普诺夫函数对非线性系统进行控制,为大型航天器的姿态控制开辟了新的途径;最后,给出了仿真结果,从而说明了以误差四元数作为定位参数的航天器姿态控制法具有计算速度快、计算精度高等优点。     

四旋翼无人机建模及其四元数控制律设计

对四旋翼无人机进行建模与控制.在建模时采用了物理机理建模方法,尤其是对电机和螺旋桨进行了详细的建模,然后应用四元数对所建的模型进行了姿态角的控制.首先将欧拉角转换为四元数,然后求出误差四元数,接着由误差四元数推导出所要转动的角度和所要绕的轴.在此基础上,又对各个方向上的速度进行了控制,并与PID控制结果进行了对比.仿真结果表明,基于四元数的控制律更能有效地控制四旋翼速度较大的情况.     

旋转三子样高精度捷联惯性导航算法

针对捷联惯导系统高精度导航的需求,以螺旋理论为基础,采用螺旋补偿三子样推导出对偶四元数所表示的捷联惯导算法,并同时对载体的姿态、速度、位置进行更新,并以四阶截断三角级数近似三角函数进行对偶四元数更新和螺旋矢量更新。仿真和跑车实验结果表明：螺旋三子样捷联惯性导航算法的导航精度比一般四元数算法提高约15%,为相关领域的研究与实际应用提供参考。     

基于四元数误差模型的捷联惯导系统对准方法

传统的小干扰方程并不能描述捷联惯导系统在大失准角下的误差传播特性 ,推导了姿态误差为大角度时的四元数误差方程 ,并指出当姿态误差为小量时 ,所推导的误差模型与小干扰方程是等价的。仿真结果表明在大失准角下的空中对准过程中 ,采用四元数误差方程以及非线性滤波技术能有效地提高对准精度     

双欧法与四元数法的应用比较

对解决欧拉方程奇异性的双欧拉和四元数法进行了对比研究，四元数法从理论上讲比较完美，但实际应用中存在较大的累积计算误差，从而影响计算精度；双欧法利用正、反欧拉方程间精华区倒挂关系进行分区交替运算，把精华区扩展到全域，不仅根除了奇异性，而且计算误差小。因此，对于解决欧拉方程奇异性来讲，双欧法要优于四元数法。     

捷联惯导系统初始四元数提取的新算法

给出了捷联惯导系统初始四元数提取的两种新算法。其中算法1的推导是基于方向余弦矩阵和四元数的代数关系式，而算法2则利用了姿态转动的几何特点。与经典的四元数提取算法相比，所给出的算法具有简单、可靠、无奇异的特点，而且所得四元数的归一化程度也优于传统方法。利用数值仿真对所提算法的优越性进行了验证，结果表明，方法是合理的、可行的。     

弹道导弹中段飞行调姿规划技术

目前弹道导弹组合中制导飞行段存在多种调姿时序要求。为了协调各种要求,提出了一种弹道导弹中段飞行调姿规划方法。首先,采用四元数姿态控制方法推导了最小时间和给定时间条件下的姿态角速度指令以及程序四元数,求出四元数姿态控制偏差量作为最优调姿时序规划的基础;然后,确定了中制导各阶段的时序约束条件,建立了优化中段飞行调姿时序的规划模型;最后,采用随机方向搜索法对仿真算例进行了优化计算。仿真结果表明,调姿规划模型可以实现中段飞行姿态时序的协调。     

基于对偶四元数的INS/GPS组合导航算法研究

在基于对偶四元数的捷联惯导解算方法的基础上,推导了以惯性系作为导航系的惯导误差方程,在此基础上设计了卡尔曼滤波组合导航算法。通过激光惯导跑车采集数据,进行了仿真分析,试验结果表明,该组合导航算法能有效的消除惯导累积的速度误差和位置误差,相比于目前广泛应用的INS/GPS组合导航算法,本文描述了INS/GPS组合导航的另一种实现方式,获得了相当的精度,具有一定的工程应用价值。     

空间站姿态控制的一种新算法

以四元数作为定位参数对空间站进行姿态控制。首先给出了以四元数表示的系统动力学西式其次提出了非线性三轴姿态控制方法,该方法是以四元数作为反馈量,控制力矩陀螺作为执行元件,利用李亚普诺夫函数对非线性系统进行控制,为大型航天器的姿态控制开辟了新的途径;最后以一空间粘为例进行了姿态控制仿真计算,从而说明以四元数为定位参数的空间站姿态控制方法具有计算速度快、计算精度高等优点。     

基于Rodrigues参数的姿态估计算法

 以Rodrigues参数作为姿态描述参数提出一种快速的全姿态估计算法。Rodrigues参数具有简洁高效的特点,但它具有奇异性,不适用于大角度情况。首先将序贯旋转方法和Rodrigues参数相结合,提出了一种简洁、无奇异的姿态描述方法。然后应用该姿态描述方法,针对“矢量观测+陀螺”这种典型的姿态测量方案,讨论飞行器的姿态估计问题。在姿态估计算法设计中,给出了陀螺模型和观测矢量模型,推导了状态和状态误差协方差阵的预测方程和量测更新方程,并提出了预测方程的一种高效积分方法。仿真结果表明在估计精度等同的条件下,该姿态估计算法比四元数算法效率大约提高10%。     

An improved quaternion Gauss–Newton algorithm for attitude determination using magnetometer and accelerometer

For the vector attitude determination, the traditional optimal algorithms which are based on quaternion estimator(QUEST) measurement noise model are complicated for just two observations. In our application, the magnetometer and accelerometer are not two comparable kinds of sensors and both are not small field-of-view sensors as well. So in this paper a new unit measurement model is derived. According to the Wahba problem, the optimal weights for each measurement are obtained by the error variance researches. Then an improved quaternion Gauss–Newton method is presented and adopted to acquire attitude. Eventually, simulation results and experimental validation employed to test the proposed method demonstrate the usefulness of the improved algorithm.     

Comparison of strapdown inertial navigation algorithm based on rotation vector and dual quaternion

 For the navigation algorithm of the strapdown inertial navigation system, by comparing to the equations of the dual quaternion and quaternion, the superiority of the attitude algorithm based on dual quaternion over the ones based on rotation vector in accuracy is analyzed in the case of the rotation of navigation frame. By comparing the update algorithm of the gravitational velocity in dual quaternion solution with the compensation algorithm of the harmful acceleration in traditional velocity solution, the accuracy advantage of the gravitational velocity based on dual quaternion is addressed. In view of the idea of the attitude and velocity algorithm based on dual quaternion, an improved navigation algorithm is proposed, which is as much as the rotation vector algorithm in computational complexity. According to this method, the attitude quaternion does not require compensating as the navigation frame rotates. In order to verify the correctness of the theoretical analysis, simulations are carried out utilizing the software, and the simulation results show that the accuracy of the improved algorithm is approximately equal to the dual quaternion algorithm.     

基于声波传播时间估计的气流速度测量方法

 为实现对亚声速和超声速气流速度的统一测量,提出了一种基于声传感器的新型测量方法。首先,根据声波在亚声速和超声速气流中的传播特性,利用特定的测量装置建立了声波传播时间与气流速度之间的数学模型,从而将气流速度的测量问题转化为声波传播时间的测量问题。然后,在此基础上,利用计时法和最大似然估计(MLE)方法来估计声波传播时间;其中,计时法在实时性上优势明显,而MLE方法则在可靠性上优于前者。最后,分别从阵元位置扰动性、计时误差和克拉美-罗界(CRB)3个方面对所提算法的性能进行了分析与仿真验证。结果表明,该算法能够实现对亚声速和超声速气流速度的精确测量。     

Adaptive robust cubature Kalman filtering for satellite attitude estimation

This paper is concerned with the adaptive robust cubature Kalman filtering problem for the case that the dynamics model error and the measurement model error exist simultaneously in the satellite attitude estimation system. By using Hubel-based robust filtering methodology to correct the measurement covariance formulation of cubature Kalman filter, the proposed filtering algorithm could effectively suppress the measurement model error. To further enhance this effect and reduce the impact of the dynamics model error, two different adaptively robust filtering algorithms, one with the optimal adaptive factor based on the estimated covariance matrix of the predicted residuals and the other with multiple fading factors based on strong tracking algorithm, are developed and applied for the satellite attitude estimation. The quaternion is employed to represent the global attitude parameter, and three-dimensional generalized Rodrigues parameters are introduced to define the local attitude error. A multiplicative quaternion error is derived from the local attitude error to maintain quaternion normalization constraint in the filter. Simulation results indicate that the proposed novel algorithm could exhibit higher accuracy and faster convergence compared with the multiplicative extended Kalman filter, the unscented quaternion estimator, and the adaptive robust unscented Kalman filter.     

捷联惯性导航传统比力积分算法与对偶四元数算法的比较研究

捷联惯性导航速度更新算法中,将载体坐标系中的比力积分增量变换到导航参考坐标系中,载体姿态变化的影响通常采用一阶近似模型进行计算。本文分析了包括角振动和加速运动的动态运动下一阶近似模型的局限,在典型角振动及加速运动条件下对忽略姿态变化二阶项造成的速度更新误差进行了理论分析。通过比较,揭示了对偶四元数比力积分算法精度高于传统比力积分算法的原因,即和传统比力积分算法相比,对偶四元数比力积分算法等价于考虑了载体姿态变化影响的二阶项。通过典型角振动及加速运动条件下传统捷联惯性导航算法和对偶四元数导航算法的仿真比较,对理论分析结果进行了验证。     

Strapdown inertial navigation system algorithms based on dual quaternions

The design of strapdown inertial navigation system (INS) algorithms based on dual quaternions is addressed. Dual quaternion is a most concise and efficient mathematical tool to represent rotation and translation simultaneously, i.e., the general displacement of a rigid body. The principle of strapdown inertial navigation is represented using the tool of dual quaternion. It is shown that the principle can be expressed by three continuous kinematic equations in dual quaternion. These equations take the same form as the attitude quaternion rate equation. Subsequently, one new numerical integration algorithm is structured to solve the three kinematic equations, utilizing the traditional two-speed approach originally developed in attitude integration. The duality between the coning and sculling corrections, raised in the recent literature, can be essentially explained by splitting the new algorithm into the corresponding rotational and translational parts. The superiority of the new algorithm over conventional ones in accuracy is analytically derived. A variety of simulations are carried out to support the analytic results. The numerical results agree well with the analyses. The new algorithm turns out to be a better choice than any conventional algorithm for high-precision navigation systems and high-maneuver applications. Several guidelines in choosing a suitable navigation algorithm are also provided.     

修正容积卡尔曼滤波数据域直接定位算法

为解决数据域直接定位（DPD）算法面临的计算压力,提高算法效率,提出一种基于修正的容积卡尔曼滤波（MCKF）的DPD算法。首先,融合各观测信号波达方向信息,利用子空间数据融合方法建立一种基于间接观测量的DPD滤波模型;然后,根据模型特点设计MCKF算法进行求解,解决间接观测量带来的噪声累积问题;最后,对算法计算量进行分析和对比,说明计算效率的提升。仿真结果表明,所提算法与基于最大似然遍历搜索和遗传算法的DPD算法相比,在相同的估计性能下,计算量下降明显,时效性显著提升,增加了算法实用价值。     

Multi-coset angular sampling-based compressed sensing of blade tip-timing vibration signals under variable speeds

Blade Tip-Timing (BTT) has been regarded as a promising way of on-line blade vibration monitoring. But blind multi-band BTT vibration reconstruction is a big challenge under variable speeds and under-sampling. In order to deal with it, a novel Compressed Sensing (CS) method is proposed based on Multi-Coset Angular Sampling (MCAS) in this paper. First, multi-coset sampling scheme of BTT vibration signals is presented. Then the CS model of BTT vibration signals is derived in order domain. A sufficient condition of the number of BTT sensors is derived for perfect reconstruction and optimal placement of BTT sensors is determined by minimizing the condition number. In the end, numerical simulations are done to validate the proposed method and the performances of four reconstruction algorithms are compared, i.e., Orthogonal Matching Pursuit (OMP), Multiple Signal Classification (MUSIC), Basis Pursuit Denoising (BPDN) and Modified Focal Underdetermined System Solver (MFOCUSS). Influences of the sensor placement, the number of BTT sensors and measurement noises on the reconstruction performances are also testified. The results demonstrate that the proposed method is feasible and the overall performance of the BPDN algorithm is the best among the four algorithms. Also the reconstruction performance decreases with the accelerations of rotating speed.     

MIMO雷达DOD和DOA联合估计算法: RTR-ESPRIT

 针对双基地多输入多输出(MIMO)雷达多目标波离角(DOD)和波达角(DOA)的联合估计问题,提出一种接收-发射-接收(RTR)-ESPRIT算法。该算法首先利用一维接收ESPRIT(R-ESPRIT)预估计目标DOA,随后分别利用一维发射ESPRIT(T-ESPRIT)和一维接收ESPRIT得到目标的高精度DOD和DOA估计,在每两次ESPRIT算法之间分别构造正交投影算子对接收信号进行接收波束形成和发射波束形成。与传统ESPRIT算法相比,该算法大大降低了数据协方差矩阵维数和计算复杂度,无需额外的配对算法,且理论证明了该方法还可以用于相干目标和单快拍情况下DOD和DOA的联合估计。仿真结果表明了该算法的正确性及良好的估计性能。     

基于杂波子空间估计的MIMO雷达降维STAP研究

 多输入多输出(MIMO)雷达是近年来出现的一种新体制雷达,针对MIMO体制的机载雷达开展空时自适应处理（STAP）技术研究是值得进一步努力的方向。本文研究了机载MIMO雷达STAP技术的降维算法,通过对STAP技术杂波抑制原理进行分析,推导并得到一种基于杂波子空间的降维算法。结合扁长椭球波函数（PSWF）的特点,提出了一种基于杂波子空间估计的降维算法,并与若干降维算法的杂波抑制性能进行比较。结果表明,当存在阵元幅相误差时,该算法在保持杂波抑制性能的同时能够有效地降低STAP算法的运算量。