基于距离几何约束的二次加权质心定位算法算法