最近在学习TDOA定位算法,需要比较chan(查恩算法)和Taylor(泰勒级数算法)的定位效果。 分别实现的效果图: 运动目标从零点开始沿x=y做匀速运动。 观测站坐标如下: 在不同的雷达测距误差下的定位误差为: 其实仿真代码还有不足,Taylor算法初值的确定非常重要,仿真中直接把真实值作为了初值,实际上需要改为第一次LS定位点或WLS定位点,比较符合真实情况。 不过,到此已经能比较明显的比较出两种算法的不同之处了。 需要源码的同学可以到我的主页下载 感谢 Iam_Flash的提问,上传程序中chan算法的pos应在第二次WLS定位