测距定位方程参数估计的Frozen-Barycentre算法

针对传统病态非线性最小二乘求解不稳定且可靠性低的特点,基于测距定位方程最小二乘解性质,提出了一种Frozen-Barycentre迭代法。该方法将萨玛斯基应用于重心迭代法,实现了内迭代和外迭代的转换,通过减少导数计算量节省运算时间,提高重心迭代法的收敛效率。并采用模拟数据和水下定位实测数据,验证了该方法的数值收敛解优于线性化平差估计解,收敛效率优于重心迭代法。