基于函数迭代积分的刚体姿态解算方法及系统
知识产权简介
一种基于函数迭代积分的刚体姿态解算方法及系统,包括:根据时间区间上的陀螺测量值,拟合出角速度的切比雪夫多项式函数;利用得到的角速度的切比雪夫多项式系数以及罗德里格向量积分方程,迭代计算罗德里格向量的切比雪夫多项式系数,并对每次迭代的结果按照预设的阶数进行多项式截断;根据得到的罗德里格向量的切比雪夫多项式系数以及对应的切比雪夫多项式计算得到罗德里格向量,以四元数的形式给出时间区间上的姿态变化。基于函数迭代积分的技术,利用罗德里格向量,实现从陀螺测量快速重建姿态,在不显著降低计算精度的情况下提高计算速度。