请各路英雄豪杰帮忙看看这个代码的问题出现在哪儿了？

    我是想做一个极化测向的算法，先拿了一本书上的步骤做了一个复现（参考的书目是徐友根等人编写的极化敏感阵列信号处理，北京理工大学出版社）。在MATLAB中，算法没有出现逻辑问题，但是算法的结果是不对的，极化信息精度在-3~3°，也算是基本估计出来了，但是方位角和俯仰角却没有结果，现象就是SP矩阵从左到右从上到下数据逐渐变小，小生实在是不明白出现这个问题的原因是什么。请各路英雄豪杰帮忙解决一下这个问题，感激不尽啊！    我把我的导向矢量放在别的二维测向算法中，结果也是估计不出来，：（    代码如下：

请各路英雄豪杰进来帮帮忙吧