基于加权最小二乘法的多舰定位算法

针对双舰定位存在的定位态势要求高、定位精度低等,提出了基于加权最小二乘法的多舰定位算法.该算法的实质是基于多舰侦察设备的测向角度、位置信息,利用纯方位交叉定位原理,建立非线性观测方程;通过泰勒展开将非线性系统转化为线性系统;利用最小二乘原理并考虑测向精度的权重因素,提出了多舰的定位模型.仿真结果表明,定位结果与测向精度和初始态势有关.

An Algorithm of Multiple-Vessel Localization Based on Weighting Least Squares

On account of the defects of rigid localization condition and low localization accuracy in double-vessel localization,the paper gives an algorithm of multiple-vessel localization based on weighted least squares.On the theory of bearing cross localization,the algorithm puts forward nonlinear equations of bearing and position variables,then convert the nonlinear equations to linear equations,and finally gives multiple-vessel localization algorithm based on least squares theory and considering bearing accuracy factors.With the help of computer simulation,the algorithm is proved to be feasible and of better localization accuracy and bearing accuracy of reconnaissance equipment and initial vessel formation affects the results of localization.