本人翻遍了CSDN都找不到一个正确的TOA定位算法程序,唯一找到的一个是用最小二乘解的(参考文献N.Patwari,J.N.Ash,S.Kyperountas,A.O.Hero,R.L.Moses,andN.S.Correal,"Locatingthenodes:cooperativelocalizationinwirelesssensornetworks,"IEEESignalProcessingMagazine,vol.22,no.4,pp.54-69,2005.),性能无法达到克拉美罗界。
因此本人自己重新写了一个程序,参考该领域著名学者K.C.Ho的文章(参考文献Z.MaandK.C.Ho,"TOAlocalizationinthepresenceofrandomsensorpositionerrors,"in2011IEEEInternationalConferenceonAcoustics,SpeechandSignalProcessing(ICASSP),2011,pp.2468-2471.)。
该算法适用于传感器位置有误差/无误差的情况,算法性能能够达到克拉美罗界。
示例程序中给出了CRLB的程序,场景为传感器有误差的情况。
程序运行结果与参考文献一致。
(搞不懂现在的人都是要什么50积分,多分享下不好吗?)******特别提示******:本代码多处使用了Matlab2016a以后支持的新语法,旧版本无法正常运行的,请自行修改代码或更新Matlab版本!!!
1