function [qT,qM,rhoT,rhoM,R,eq,erho] = fcn_radarMeasure(rT,rM) rt=norm(rT); rm=norm(rM); rRel=rT-rM; R=norm(rRel); qT=asin(rT(2)/rt); qM=asin(rM(2)/rm); rhoT=atan2(rT(1),rT(3)); rhoM=atan2(rM(1),rM(3)); if(R>5000) %高低角 %rhoT=asin(rT(1)/(rt*sin(qT))); %rhoM=asin(rM(1)/(rm*sin(qM))); eq=(qT-qM); erho=-(rhoT-rhoM); else eq = asin(rRel(2)/R); erho= -atan2(rRel(1),rRel(3)); end
时间: 2023-10-11 16:10:36 浏览: 120
这个函数是用来计算雷达测量的一些参数的,其中输入参数rT和rM是雷达和目标之间的位置向量。函数的输出包括qT和qM(雷达和目标的俯仰角),rhoT和rhoM(雷达和目标的方位角),R(雷达和目标之间的距离),eq(俯仰角差),erho(方位角差)。
在函数中,首先计算了雷达和目标之间的相对位置向量rRel,然后根据相对距离R是否大于5000米来分别计算雷达和目标的高低角和方位角,最后计算出eq和erho。需要注意的是,由于asin和atan2函数的取值范围有限,因此在计算过程中可能会存在一些限制。
阅读全文