TDOA定位 chan算法和Taylor算法比较仿真 matlab

最近在学习TDOA定位算法，需要比较chan（查恩算法）和Taylor（泰勒级数算法）的定位效果。
分别实现的效果图：


运动目标从零点开始沿x=y做匀速运动。
观测站坐标如下：

在不同的雷达测距误差下的定位误差为：

其实仿真代码还有不足，Taylor算法初值的确定非常重要，仿真中直接把真实值作为了初值，实际上需要改为第一次LS定位点或WLS定位点，比较符合真实情况。
不过，到此已经能比较明显的比较出两种算法的不同之处了。
需要源码的同学可以到我的主页下载

感谢 Iam_Flash的提问，上传程序中chan算法的pos应在第二次WLS定位中选择，由于参考基站的位置会影响第二次WLS的求解结果，所以建议把参考基站设置为（0，0），保证待测目标出现在以参考基站为原点的第一象限上，保证第二次求解WLS不会出现虚数。当然也可以对WLS出现虚数的值进行处理还原出估计值。
未修改参考基站的坐标，直接改