本发明提出一种适用于NLOS(Non Line of Sight,NLOS)环境的室内ToA(Time of Arrival)与AoA(Angle of Arrival)联合定位算法,它能有效地利用ToA与AoA对目标进行定位。首先通过利用测量值丢弃法卡尔曼滤波更加准确识别出ToA中的NLOS误差,然后根据测量得到的ToA和AoA,构建改进门限比较加权算法(Threshold comparative weighted,TCW),通过改进TCW算法,进行目标节点的初始位置计算,实验结果表明,定位精度达到90%误差在1.5m以内。
展开▼