简化超球体SRUKF的GPS/MIMU组合姿态估计

针对加速度计、磁强计易受机动加速度和周围环境影响的问题,提出了一种单基线GPS/MIMU组合姿态估计方法。该方法利用单基线GPS天线代替磁强计提供航向信息,并利用GPS的速度信息对加速度计输出的机动加速度分量进行补偿,构成单基线GPS/MIMU组合姿态确定单元。同时考虑实时性要求,在SRUKF的基础上,引入加性非扩展形式和超球体单形采样,提出了简化超球体平方根UKF算法,通过减少状态维数和采样点的数量,降低算法计算量。建立加性噪声下的单基线GPS/MIMU姿态模型,并采用简化超球体平方根UKF算法进行姿态估计。实验结果表明,单基线GPS的速度信息可以有效提高加速度计对水平倾角的确定精度,姿态估计算法收敛后的最大误差小于0.8°,估计精度与UKF相当,且执行时间仅是UKF的42%。     

基于互补滤波的动中通天线姿态估计

为了满足低动态下天线稳定的要求,构建了一个基于微机械陀螺、加速度计和磁强计组合的动中通低成本姿态测量系统.该系统利用加速度计重力场分量估计的倾角和磁强计地磁场分量估计的航向角作为辅助信息,校正陀螺漂移误差.根据陀螺与辅助传感器的互补特性,设计一个多轴互补滤波器,利用陀螺的高频分量和辅助信息的低频分量估计姿态角.根据载体机动状态调整控制器参数,使滤波器能自适应选择交接频率,减小机动加速度对姿态估计的影响.实验结果表明,互补滤波能有效地估计出姿态,系统的动态估计精度在±2°内.