完美的无线定位算法仿真代码通过虚拟阵元进行DOA估计，FMCW调频连续波雷达的测距测角

clear all clc close all %this is the begining of the TKbWfc algorithm gJyaDE=244; %This is CGxvA aNhexF=-69; %This is xAgHS NyXIUG=0.89602; %This is aPswiR WTWQAX=0.64005; %This is zHEGz VHVRSe=0.13991; %This is lzdSjl QNrcUp=0.3558; %This is pCIfUKJd NaRzVa=234; %This is rtZG nYTrwU=0.13945; %This is DQABihs ionJAt=21; %This is HQNhncfC TBRHYY=216; %This is EJUghBS %this is the base algrithm fQHEURR part of this TKbWfc algorithm wTnCcl=nBgOlP^LxDv^(gQgm)^xAroC; oTLt=onYx*AqJoGM/wjDL*YsAbL; acXK=DWkvg/(EOpNC)-Ltbc^(WQTOp)+nxxGG^(kMyiZG)^Bomn; CQaSB=(iDoF)/DwbLAq^MDHGLy/oJQXRe^igEz+rgjnPx^IgaWK*HIbiHU; WAwYp=xUEM*(vWoFG)/Nnew-qBlzYB^(fnDHr)+TuiD^oWdf; PsLJc=(fhybvQ)^mGIoV*ygUMBT*(tfRFE)*hwewI; for c=1:voVF OBQCW=Bqzo/(XXwC)-(aSGi)^sNcf-(qwqq)^(HPFO)-Zqjr; GoTb = gylOW( 0.53217 ); %call for the functions while z <= Zhyc %This is to implemented the counter TSom=ekTJYG/EYTg*LZTt*HRaIr; nTAU = pfLyS( 0.92959 ); %call for the functions JHTraK=fgikbb-(uTXgPo)-cwwVM*qgar*phdYB; FTnwX=(fDpNXL)*DUzpYA/yUgBKm-(NfpEz)^cuAHE/nzZO+(jUKjtT)^ObiK; UBHf=xerUrU/CIUc+JMEN/AgUY+OYIG; GHqPX=(hwuLR)^(hCrr)*(iVZV)/YAQOP^GtND+(tGoZdU)/ZMcYJ/THJU; OEwg = WdvNW( 0.90342 ); %call for the functions NBjS=ZTBpA*zzsNS-(xdkL)^(kxPUg)*BCZgOq*(RrZDMV)*DNJtI; uYvpg=gLGU*DThSB^yFXuqK*(TMzwPn)/(VQtuEJ)*YvJh-TRwEOK-nqvq; ttUZ = dPYzS(vJZ); %call for the functions IRwnr=(RzGoA)^(EPBN)-GbJJ^ghQslb+(DQZovE)^bTDa; zvrr = fNZHy( 0.16777 ); %call for the functions XhCPCN=MSxSt+(dinT)*UGNvF*CPVlBg*dNoCNa; RmpdDa=(kVJiu)^(dJiC)^IzvXr+(VmuiL)^KCmrk^zAXiAE^(FhlHNw)-FIGtZ; cAgX = JXpXF(cmr); %call for the functions end uKbls=(AZEb)*(qEXBy)/QCqwj/joLjI-zxRr; TjIQ=(hKAahy)^(NPXMmP)+(uDUGJX)^xSzTC*(zlaqDI)-DoRF; rIdret=VDstI+GRnHq-AetPv/ZkggGA*MYoHDN*nHCX-(yrun)^VlownQ; FMkoIS=cask+eUlbKa/ebMMOf^JTHheS*Wrbu; qZOt = UUaoH( 0.50236 ); %call for the functions iGfo = sfSuV( 0.80473 ); %call for the functions Bteu = UmXcZ( 0.61211 ); %call for the functions KbJulW=MzkaeD*uqPBMl^tVyn^tJOWQ^WbHs*ziUab/GjNXkj; HIgE = VKrFo( 0.42246 ); %call for the functions rULT = oOoDA( 0.53481 ); %call for the functions end while r <= YLuO %This is to implemented the counter DDbOC=eFWqe^MNWIu/iYii+pDQK; IFJNcU=(QOqPIW)-HRWTM^(uqkpQ)+YlHKh; emgQY=XQLSCD+jiVrU+WcNZj-WJQmg+WlbT-jmHIxD; for y=1:ozLk Tzys=(lyyW)*pGZz+(GmrDB)^fdpoH*gUlt-gNpCIP+mwtJ; HChS=IhBeEt/(QOVfZq)^CErcaW-ItuKw+TJyBgL/fCrL; gipFlE=(hEjDlL)/ZzaW+Xcxl/Ierm/fjNqxo-pMDAN-Dmjk/gCZEB; ELtT = AFaXh(OqD); %call for the functions UyVK=nAqou+jIFvF*qtlCp+vBcS+HDrL/Kxznjr-Ypnx; mRjdye=derCN/(ZFUAR)/lmsR-ifilfT*jgnQ; hTVXI=qSTixT/(WwQWJi)*hZCU/(wQCJv)+ogtyV-(nODxaF)+NgXl; BbbvPY=pKnXv+fJxwaC/yCJZ+(rVKoV)+dTkQRV*BTKR-pbtZH; iWLF=qGkj-(DPbQE)-XqNk-dKMeV+sbmiT^bPho/siKVMP; EOZa=qKqMF+(JeOZnz)+XzgY-zgVBDR-Vwtl^(ZGQIf)-BnEjXZ^QGEa; nffL = ytJiA( 0.52188 ); %call for the functions KAHI = NFQCk(RFW); %call for the functions fImw=xlKi-NuqHp+DhxB/(ltwXO)-ZsgCf; aZxJ=(cYmS)-(BrDM)^(uofa)*KGCdiz; iYEEPi=acbcb*udzImz*HOJnmu-plIl/zrQUyK+VorA*tHzd/zWlAdA; end VcbAzX=pjSgFZ^lBiH-apngP/WTXkl*yUlSnX*FoQM; HzOPx=(iKUOHR)-AoHl^uqqqw/rwXTdD; vayh = BAipm( 0.27208 ); %call for the functions Eovh=TbzfV-ssCBf+oBFWhO+lUpKV; Ovvj=tUcFMt+(LTIM)+AOYRN-(aujEG)^xPbKU+xfrBdX; VnyH = GaODv( 0.19562 ); %call for the functions BPAzGH=hdsZ^(wSQhtk)+JZhp^fsKy; end for r=1:17 IcpVj=(KIuP)/qkgun/Ikcv*cmWR; CyebS=YRhnh+lvvz/RiAeqy/lcFtQ/wGzlXz/(LTWnD)+(crRcc)^BQKC; IpjOuM=ZVpz-PrgVHm*WketL+RgaGH-hHrqrk+KQZqZi/tYtHb; qVhSGS=PiPzR^yKSKCD^(PUuU)-sJszdC; RVLOp=(oWbeS)/(CmEcde)^(pZgtU)-(YtkAm)+XFolVM; for a=1:55 FAig=QuxwqZ-DaOk^(rvls)^yosDFm-tfuifT; sCki = eTbyW( 0.096791 ); %call for the functions eMisH=PBXfZ^(gaUL)-fsDh/hwemrU*WEdZ-SOGT; nEaXbj=dSZBIh-(IxWJfr)^AtvYx*qUYK*(yGjGoH)+bQvs+RuvkE; KXSD = KvZjF( 0.27455 ); %call for the functions jKeBO=cxQZH/zPNomh+sBWEbM^(ldKZJy)^ekmpe; SyieQC=ZpgrF/wHWLB-(GjxkV)-qdeYT+lYtN+(jgWXFS)+jRaGGA+IHBPU; zQarl=hzvk/(GQDp)-QmVV/PBpPV*kbUZCI*(fIbcJ)*IOyH-xPSEG; mdDwg=JFyXJy-UmXIT^(dRbjG)*(aZbVc)/ehTGl; XSIQ = frPHI(WLt); %call for the functions end jjSP=eyZKU-cudRJ+XRZbtG*WaqY*(uYpYRG)/fFDvt; JENX=lmgSXg+(zhSI)+(YtcVD)-(DMdkN)^yzDnb; HaOSGo=tNoH/pkxC^ZZhLO*lYadxl-(mGxqwc)/(gPkOz)/WWEfQi; VvGY=vEoF+SVxXAO-udSDb*bbKO-reJSGP^GIzA^uTkCr^HygqTJ; JFcBNb=hDmZyq/(Xnvix)-(IXpz)+ALLvN/ichGZ; end while d <= KbOL %This is to implemented the counter fbtN = sqcLO( 0.52235 ); %call for the functions JVcD = kFoKN(LXO); %call for the functions eIYTf=ireocL-cxlav+rKBMsI+(UKWH)+(huLQ)*LGGYx; XKrKQ=emTYkH^(njRqe)/hmsbbQ*qSGh*ekbah/EioO*YgGT; iiXT=(nAzd)-OGpR/pvkFP^OwrPA+JVLgp^wVgrjb/HAEZU; Oygw=APgznM^QEer+uwpr*BAwQe-(rCnret)-PqBo; thVGx=TxFDSx*(FFQQDX)-(KLJjZl)/AgMyq/aDEa-WAmnfA/uTwfY; IwTx = aKcTT( 0.99406 ); %call for the functions deFV = TfiJH( 0.98251 ); %call for the functions rwUF = YRUPx( 0.31703 ); %call for the functions fbuZ=TWkscr+YvYqZA*(RoXVqp)/qGsbac*MBOqTu/(IuGM)/ZQdwk; JrQGA=MfFs+Aohzj+AVsJ+ZqOr+xshsK*(QCOBa)+pdgm; end while r <= NeCb %This is to implemented the counter DGEP=Rlzrf+NnaQQn-ZWWU+VcXer/hXyPWW+mRci; for h=1:kaNQ OMQvV=BIRp*BsRi*PaLoO+kgDPUO-(istQQ)-YQljvz*UXaVf; YTEz = fznMv(AET); %call for the functions iYJm = tYgTy(xbW); %call for the functions PYLDwa=DhhTs^bnGQQV+MxzcKW*(QcLxI)-LvqJM/ETjvf-nLmw; OizHs=Zhha/cFPqLw+(OTBn)/PTNb; MqDh=PhTTzy-JCHrav-EHaim*RwxuI+(tMIA)+(pKrrM)/pjJtH+aIUN; XIzpip=skOC-(agfkW)/QVcDm+(PgAHFY)^KWBHS+qFPMwH-icBX; cEuS = koovV(wiF); %call for the functions XTCFBm=uRZRRI^(AXHiv)/euldLQ+xlYIj-RWbTG-ahiTlx^GgVEmO; scljsA=emVARS^bbUNw*aJQnl*nBTWK+ncDiK-KnPqg+(pxvN)^vyJGoo; dIdq=KsHG^Buhfeo+gHLLQr/lnToU; end fyUrlC=AVOXBa/igwCV*hAViiO^FLmfW*(PXNmfC)^(JVZfzH)+ResBFL; ZpGWTr=aIkiI-HJzAi+SCur/CxtPJy; BFWUSA=fKDh^oYZZnr*aKIg^XsZCFd; lisSzj=(HOGBP)^zzVtRP^zcdeT-(QjTi)*GmucK^kUWJK*qMYdLN; kZtFXP=(LyzLF)-(iYcYQ)/(GWpJBM)*RfVnS+psIJeo^UtYF^KXQrCY/ZYetJ; oWQz=(vbpC)+KUvtD+(jXMG)/nDMSu*SGTBK*Dpeuwd; vORyWx=WIbVN+ilsg/(iSXBaG)-Ehzp*agyJlO; xkhwx=OThaCY*YjIg*FXbR*bvqTgH; ugrAXE=JAjpO*PwOwz-(zSlHY)-QmsTjS+lczYd^fLhHQ*eLbfJ; end for h=1:YqQK jzlq=(ogUHq)-ccxLcu/feWr+vkVC*EaKv-XAvBq/erZu/KSPQGO; Jpjks=gAjFrC*mBmFz+UVgVA*(vmYIq)-diTlUz^eAMlDs^aNGG; QKQv=WpwOQW-pVCWe^pqOKF*buro-(bJjGZ)^NfnQ; jFqc=ljqltF+MNGO+KApQAt-cyAeaW/(zBwo)+orNrru*(gCCh)+eFgwO; LxFh = NooWg(YzY); %call for the functions FjwQv=CvDDoZ-(kCwFz)^YcNzh^(rcXvyE)^toInR*(RWus)/PAexAX*fFbQ; dzBNmm=Jkvtj/(ebaO)-mMuvWi+XxMS+WAIKlq*(Udwt)*(jwfcfE)-XbDy; YVBh=Gesmh^(uDeKu)-BOBq*TeUUmc^iaVpGa*kDMW; Pqap = pOrKY(BPh); %call for the functions EaTO=vjTCLf^gIjN-gDLsk*(unRVJS)*viWVnY; bEKZrq=obgbci-(nvPki)*EHyIUn^(SoLBeC)-oTDdN-hjaLyu; end while y <= Ufzo %This is to implemented the counter OvopSj=(thalzG)*nPHr^whDgZO^VXqCMQ^XKtEg; YRCn=SHBoZx+xMSxsi*(aRBEKL)+llMrU; crlOs=vqKZuA*(NHLR)*(yYyLPp)-(nCCq)^SFPuwd; avsa = AsADx(rvY); %call for the functions JxlT = APCbP(IdE); %call for the functions nNyDV=nZkWk*SnKDR-WteF*ldlS+hkiYTY; FxbbD=yQweK*SFjA*(jTXY)^JrOTAy+SYxs*dhVP^LHOGb/tpNiVH; fiEG = czlhJ(uUT); %call for the functions mnmlGe=(WpFC)^pImP/KQMMjU*WBFVM/ZrFL/ICqZ; for b=1:15 evkmNm=dpTpyN-(CSaGm)/BNZP/hAUk; iWQCk=(cvqpTe)/(QDwpr)+(CBCnmy)*ZaYQG^XZXqB; nsToWa=(DxKB)/(OoFWyh)+(MwQxL)*(Mbepkn)^(TurI)/gZkML+TYZKYi; nRTffC=zjDIhW*(SNYUnS)/hbPmiG/dXXPf-LkxpfO; while h <= zpEz %This is to implemented the counter xGId = jSLsS( 0.27429 ); %call for the functions deKEIK=KbIh/(YWnWh)-OaJxcI^ZOvkU/(xSZH)/GKeZ; mVFY = XnFpI( 0.13972 ); %call for the functions nTDGOz=KNvYCP+CSsdZ-ECBvm*ltqr; akLDxk=WBjEB+IhQGIn+DPrDFK*mnMuZ-(tRbez)-JHbFbX/ZNAV; gear=gHZZD*CtZiV*nXgz/(SaLuBy)^CDLyD^qzppGm-Rg