一种基于四元数法的超短基线安装误差校准方法

摘要

本发明涉及一种超短基线安装误差校准算法，尤其为一种基于四元数法的超短基线安装误差校准方法，包括根据坐标变换公式和应答器在地理坐标系下的坐标，求解得到应答器在船坐标系下的坐标；根据四元数与旋转矩阵的变换关系，求解得到基阵坐标系向船坐标系转换的旋转矩阵；根据基阵坐标系向船坐标系转换的旋转矩阵并进行坐标变换和最小二乘原理可求解得到基阵坐标系与船坐标系之间的四元数参数；基于四元数法，求解得到坐标系旋转后的坐标；根据坐标变换公式，求解得到超短基线安装误差校准后的应答器地理坐标。本发明基于四元数法，利用最小二乘原理求解四元数微分方程得到姿态角，实现超短基线安装误差校准。