求解，雷达双曲线定位的程序编写（基于BLUE或WLSE）

在看一篇论文，是关于双曲线定位的，它是基于BLUE算法的，但我在编写程序上，出现问题，出现不了我预期的结果和图像，求助求助，，，