谱峰搜索类算法计算RMSE

PINKASTEROID

最近看论文对比测角算法（2个角度）的RMSE时，发现我的RMSE总是比论文中要大，我觉得是估计值的选择部分出了问题，所以想问一下有没有懂的大佬

目前我的想法是选取最大的两个峰值，如果峰值与真实值的差小于角度间隔的一半，选择该峰值作为估计值，如果大于的话，表示测角失败，则选择谱峰搜索范围内最大值作为估计值