一种鲁棒的矿井接近探测定位算法研究

针对现有矿井接近探测定位算法由于非视距等因素导致测距误差较大及复杂情况下测距方程组的解不收敛的问题,将高斯牛顿法、加权最小二乘法及Levenberg-Marquardt法相结合,提出了一种鲁棒的矿井接近探测定位算法,即加权LM法。该算法将测距误差信息通过增加权值的方法加入非线性迭代求解中,并在迭代过程加入阻尼系数,在保证迭代收敛速度的前提下大大提高了定位稳定性和鲁棒性。测试结果表明,加权LM法的定位效率和精度较高。