-
公开(公告)号:CN110440746A
公开(公告)日:2019-11-12
申请号:CN201910718440.3
申请日:2019-08-05
Applicant: 桂林电子科技大学
Abstract: 本发明公开了一种用于非开挖地下钻头姿态融合的四元数梯度下降方法,包括如下步骤:1)根据采集的钻头内部的陀螺仪数据求解出四元数;2)利用采集的加速度计的数据建立加速度计的误差函数;3)对磁强计进行地磁补偿;4)利用补偿后的磁强计的数据,建立磁强计的误差函数;5)根据加速度计、磁强计两组误差函数求解出四元数;6)根据梯度下降算法融合策略,将步骤1)求解得出的四元数和步骤5)求解出的四元数进行融合,解算出准确的姿态四元数;7)根据步骤6)得到的姿态四元数,求解出偏航角、横滚角和俯仰角。该方法简化了算法的复杂度,解决了陀螺仪数据漂移问题,适用于低成本姿态解算的嵌入式系统。