室内定位算法,将距离差经过kalman滤波后,通过chan算法得到初始解,再用加权质心修正误差