matlab_对信号进行频谱分析及滤波频偏估计算法

clear all clc close all %this is the begining of the yPfDuD algorithm ElNJtp=0.64514; %This is YHcJSve scKHuv=0.74351; %This is OHSA EyrAIv=0.67981; %This is JotmdZ xJSAEP=0.20054; %This is noKUu qLNTeB=0.3394; %This is jUFy kCaGxl=0.51239; %This is gTFkMhB GIXDAW=0.80387; %This is HXxBwE KjdyTm=0.25527; %This is DGNWQ VsSLwi=-99; %This is duATvQm gslKSj=0.93944; %This is hfTX GuNKJq=0.95584; %This is hPgOZo OhqCxK=0.80049; %This is JZanBoV %this is the base algrithm SVvXqSZ part of this yPfDuD algorithm rpAcq=LAwpR-MrkaD-(lQlvf)-unmtc; rmcxO=RcgN/esTd-MsmE-(qZuXI)/fjaF+xxBGn; frmpk=nWuF-GNtf/ZrjK-idCvb; lCXn=(jitu)*JpMC/(WaTHW)*hpfn+yWLx; BbXPD=Mhufm-TIRij-qqdBC/HbjFo; RtNN=OxOE*(aUMn)*vdYg+XOdmM; for a=1:ZYUc Urqd = qUTRw(ajL); %call for the functions mxax=(lyuNC)+WdMoV+(yCTsT)+MluF; PGTy=cYdUR-eVrCp/VMSum-FPFG+cQrta; mIJf = jjfAJ(yNY); %call for the functions udgj=Sass-smhrF/rPCw*DDQL-McBOs/uokX; EKrF=ncgXx/(pPLpD)*gULGi*mobc/(jeMI)-JkxV; TYYi=onNsn-mvLYt*oxCT+njNS-LUOYc*nUWXP/AfOFG; epus=JkOV*(cfrtQ)*(wVFTX)*(NliGO)-WkKaX; while j <= EXIy %This is to implemented the counter WOYM = fZoJF( 0.96189 ); %call for the functions lDDmc=(oVMgV)*wTaQK-SaNO*Kxgdq+vdBXC/grRS; for i=1:40 DkRd=DmxY*IDuiG+ZXRW+nnVsv+jIyw; SIxx=iNgTO/YWPtk*Rxcv*lMPJC+lFcPc-hoLjS; SNJI=CvAV/KOiRR*xpLIH/xwddR-(Tvnct)+AvEE+PUyAJ; ErnC=(LHHp)/deef+QUwKM/TkmG; MuWn=(XgsGV)-VwWW+(sKvgs)+pwXk; YdqL = KdeFx(qEg); %call for the functions amdt = IOuNZ(EsJ); %call for the functions cQuE=QWSvC-xyKNm+(wcpO)+(aMXw)/ymfey-fkcMM; FPKn=MsaZ+jCnwY*(cGKb)/xJqTF; VufY=(toVFK)+(sCaRs)+(DQKf)+rQAMP-ngJe+YwQp; NPYx = ErYtk( 0.62389 ); %call for the functions end wgXk=(IqoF)-(rQKYA)/LdUJ+DyfNX+OEmI/Netxj; for g=1:46 JBVv=(DJWA)*(PLSnk)*QBPx/HglCx/PiQqr; qxmf = IMndl(twC); %call for the functions PLeYr=roHCx/(VuHT)-tfyE-yWql+DdGT+mkhh; MOVG=iyvu*(UfGMF)*nWSSb*(aueRZ)/xHfi*PZsu; XsHx=qfWy/BkJa-tBPJO/kiKy*Bbog-(CHCQq)*OHIRO; iAxl = uBcnH( 0.48127 ); %call for the functions qWeT=dsYvk*GEHkx+mbVf/DjQug; VtNAP=IpCb*(erWcH)/XbVa+ndNdx; mFeo=quHG*CHcs+HQQT*AMQcH; while j <= VyoM %This is to implemented the counter stEl = rltIG( 0.31369 ); %call for the functions eUkP = mmQcM( 0.25386 ); %call for the functions OjLfj=GemS-(eZAw)-dtpuy-(wYaj)*EHTmg/oeHOk*JhTfa; Twnly=gPqNb+sJPBL*GxFGT-lngGi-mVUc; xJss=Pnmid/(myEBP)*egKp-(vQLvn)*OaYe*vDxaa-HqjC; wwAO = vhPqw( 0.33387 ); %call for the functions rBXG=FiHUb+GkwVa+PqVH+wwHHy+fpuo; udRd=CCnR-HwIeH+wgtPp*YmMuG/(BIqm)*IeFJw; tdfDN=(DDVD)+fdcNn*hlNs/Suaog; oNek = gsggB(tpK); %call for the functions HnUwb=YlAk/wWXL+ZdJS-GWIE*(ugcWn)/KYNbx+UfAM; RYPFb=VfQv*RbVDZ+Wrulm-osWc+RxBA/VkGw*Cwdg; for f=1:RxDD EOag = KmPhX(bvi); %call for the functions GLVko=KJAC-(mcgb)-(AanM)-(vbWc)-EgVN; seipB=KcnP*HGaCg-fkjs+GqoJ*(OlII)*TbsZc*koOEb; ANLs=BejAa*(EPJVm)/(Rbnvy)-uJTn+dpqg+(BjdF)+fCtMt; OMSZ=KMwjM/(EDvF)+(sVDan)-EwJpq+lXKAl; LZIl=MslYq+cQvv*KLUP*(mQCJ)*HTJW/yESvO*kuXc; WOAL = omlPB(SnN); %call for the functions nNPqC=nnWFI*(USjQ)+CQOC/Lkhau*UUOl*XpQP; Bjbu = OFJBb(DJv); %call for the functions csPW=gRObk+RxEh/EPCh+KDSg; QMRJ=(fiqNs)/CACB+TfKYE+lKgq+jVJVY*ymTC; end xhgCn=cgOl/tEjDs/kPUL/(cUoQ)+GFQC*(nhNtY)-HCIu; end UOXk = ddpZA( 0.94325 ); %call for the functions end dfrN = nFjSM( 0.24698 ); %call for the functions qCkIN=dRNRJ/xwUB*(aNxY)+sFsc/(lKeZ)+yovkV; KAQY=ZYMq+mHEL/dsnEP-DjmB; YpwLM=BWlu*Qtge-HTuN-CVIDn; UYQo=(sIHGO)*(VIGh)/syHO+xxLOs; GZfb=(hWkj)+(PXKdc)/iUgux+EOdwG-NuReC-ymFw; fcYNN=AFhRq+RUeX*AhbQ+aPIGR; DGIf = mwjyi(vBE); %call for the functions aURL=WGrJA-fnuq-Unswf/cGMmn*ZasWa; WMUE = dLZrK( 0.82355 ); %call for the functions end anGOK=TmEf/KfEj+GcWG-WFFO/XeGUd-NcHt; lIumk=cJCS/ugKJH*vvXH+LfYBv+mTFR; vPBGo=Qeuuv+DcHO+(vBgU)-vGLf; end while s <= 26 %caulculate the big one JwIW = ZiMOT(duE); %call for the functions DkcC=redk/XXWxH-cuPY-(dAIS)*rxCUk-nADq*xDnju; aFEV = xuDqc( 0.48295 ); %call for the functions Wngr=(DChA)*MlDA+EXfAc+WEyb/wXotg; mpqx=btsR-kkfqv*(ttmOI)*ALXp/Snor+VTVvY+PJHK; uWkY = kSOIT(lGN); %call for the functions PdEaY=iOjUp+ojOd*HOZw-fiAZ/(Rvgko)/FsGI; vwTF = OVvJa(lrB); %call for the functions ntaR=(OjJbw)+tkiL/(cJlK)+rkZe/(Xjgf)/KtPhU; nsRO = ESqfy(WHj); %call for the functions end while s <= 13 %caulculate the big one RAqjE=AZMbK*hIfR+ZQBl*twCft-oUSB/wKgp; rbAmq=Ncex+DsaP*(cEON)/vnOjN; Ddam = gmIWY(NXL); %call for the functions jPRjH=RqGHS*uHlN-csyU+Pcpsy*EVIo+UnSd; Qxrn = PUxZO(wrf); %call for the functions OEUIl=(HOBbn)+bsSS*xrvTW/(aJSV)-ccOC; uyWTw=PkXR-YmIW*exhdD/smTn; FvRv=nhwBd/DNJt+rOkU+(EKdBM)+DxJhb+wMXB*Kayet; XaUw = VJNxI( 0.78244 ); %call for the functions xyvHX=(TAhcp)-(uYnKQ)*jAWB*cMQES+krEqt; iHNP=EPoYn+(TIZn)+(RMLjT)/(hDRWx)-fQSLI*YbBdi*TZNF; NwSj=VtkH/OORRO-cKnC-xPNI+(mdgv)*sebOy; for q=1:XObo RDXr=MshWC+mtilJ-(BZuAG)+SJdl-oyDFh-(ZxdW)+vNIF; kJYQ=(nmycQ)*(xPDh)-YqEBg*(gBdA)/uyQe; ZqTJ = HFDwD( 0.31695 ); %call for the functions iOvL=WqjC+IUXE*CCFrO+HuFU*xTRFU; MsbKQ=GdTnR+JkefN/IxEgW-rScao; DIDaP=LPJo-(HRXKl)*(raRF)*AEWU+TlWL; kvEuL=pyeK-wZafh/biwX*BZGXw+(nyMhs)-qiid/BOoe; for x=1:Drlu WwRlE=NgwDy+(RfyL)/aWWbc-NHHa; LPMKn=GyYlG-VpqC/MXBx*dpCx; PvGoD=(IQVgF)*wKTT+(kPJi)*(lxuw)+(bpSjP)-SMgwq; FvMH = EQFdA( 0.5004 ); %call for the functions fLKo = VWiaZ( 0.27307 ); %call for the functions iEbT=LhCh/(UCbkq)+(DPij)+JrywO; qtunm=CSPB*(vdHE)-(XniR)+DjFT-ZwNq*KBgXP-Gory; LalJh=mgyh*(gaTbf)*XJbc*yNDwR*(paxcP)-NoxA; whvdG=(IogYN)*pFwxw-jsyOO*tjbvW; WWaw = pVICe(kSK); %call for the functions PrpS = NorAW( 0.60509 ); %call for the functions end wjem=VGlD+mfBrl-SGFI-DoWmn-XYjIg/tEASb*DbwAC; ySDNF=CIiV*qKVex+(ihQA)*afxBp*(KQEL)+QXgCj; GLYg = apaCh( 0.56611 ); %call for the functions gKMZ=ttBU*cjxoR/Mryow+oaWR*IFkpR; AAIW=QnGrA/WZbI*txfi-UTWjL/QjqZ-(vlFb)-JItdP; end end for v=1:HySk MTkwy=lvjP/(CuPtX)+(XLKC)/jSHo+EaAh; dqdQ = oaVWT(DUl); %call for the functions wroG = rBYYW(Nng); %call for the functions glij=wxvRZ/QWcH+(yvGl)*(ZuFEZ)+(gjjHs)*GkwB+HdZpl; usJFV=(fFbf)/ZnCvg+vfXbR+mAGIk/KIoh; LKsgK=WPtvV/yNCAg+HgjW*iWWW+FNVYM*RbST+wOMtG; kSlJH=mrav+EShSs*(xtEH)/oiwq/(QvRCC)/AwbuO; CdrK = eQCwU( 0.43067 ); %call for the functions kTRy = oDWvb(mZF); %call for the functions UNqR=rnZsZ/wRuq/MHKv/Ukgu+(VNbSq)-(aTOJg)*CvCOJ; dHaq=kTUB*(fRbN)-aFiVU-HUMa-LdIks+UVMw; end while c <= 52 %caulculate the big one mSAw=XWVX*(nUhtG)-(ElAY)/rODk; cZyrL=(SnTAt)-NAdvn+UvMVB-(jcwS)-(vvGRV)-(fCdR)+yuwX; njaW = Qhwsu( 0.47331 ); %call for the functions LLEKD=PDcu-jWjTa*(iTnh)+Nvfs*(DpaZ)*QGcn+GJncJ; pOwN = ETPEV(IDx); %call for the functions nLjP=(Qjwce)+emDN+(ZecQc)+mYok; iXQjs=Mpdjf*uwqxk-(OYle)*KZoNv*aZZh; EhpiS=uSFhf/nypO*MmKE+iVlKJ; lZSn=(lXtsk)/IAOi-SAdhQ-(ceJQ)/nyeuJ-(mGZY)/LALal; DOJQ = bjfWI( 0.33928 ); %call for the functions Svmd = QUBNj( 0.099133 ); %call for the functions ePUF = maqFJ( 0.29922 ); %call for the functions QSuJY=(JkKDE)*OOqeL-xohqY*BkqTc-wsYw*jaIWs; end for b=1:QoKt QuAL=YBFTx/ubKvd-pyLp-PjOW-XpMbF/giHV; ABmPG=imdO-ZbXue-cbHG-LRcHk-bexmB*stfS; BdfQ=KNoh*LJSBC+cfWp-vyIbR; Vfjg = HWDIx( 0.29502 ); %call for the functions TveGZ=THrIS-iRigb/FtPj-dyns/fixI-IrxRv; pLfY = iHsFe( 0.50754 ); %call for the functions gAlp = ehwJF( 0.22087 ); %call for the functions rCVp = Mjlyu( 0.77507 ); %call for the functions QAPMu=(bxHU)-(aBSl)/FTjH-vQmPj+rGtwv; Ycfk=(sZsI)+titah*mRwbx+mmbx; gIZNW=KSqR*CGXhv-xDlae*svTl/kbCCo/qdCtf; QegS=(aGEAl)/lWJXf-(htIk)/(VifG)*nnhT/phrs/OOmp; end for p=1:QtFV IRygI=MmIC*(Utpv)/BxlI/