一种基于牛顿迭代法的DVL误差标定方法及系统
摘要:
本发明公开了一种基于牛顿迭代法的DVL误差标定方法及系统,其包括:步骤1,构建DVL误差损失函数f(Φ,δ);步骤2,通过牛顿迭代法逼近损失极小值点获得Φ和δ的最优估计值,其具体包括:步骤21,令X=[Φ,δ],将所述非线性优化函数f(X)进行在初始点二阶泰勒展开;步骤22,根据所述步骤21二阶泰勒展开后的结果,确定迭代方程:步骤23,给定初始值通过i次迭代,求出每次迭代中不同的海森矩阵A(X)及其逆矩阵,从而得到Xi,如果Xi小于预设值,或者迭代次数达到设定的最大值,则Xi作为最优解,停止迭代;否则返回方程(3)继续迭代运行。
公开/授权文献
0/0