陷波器的DSP实现

陷波器的DSP实现陷波器传递函数11)(22bsascsassH其中20/1a，01/kb，02/kc0为陷波器中心频率点，1k为陷波器带宽，2k为陷波器作用程度(取0)采用双线性变换把传递函数离散化，带入11211zsTz有22212222212224242482124)4()82(4)()()(zbTTabTaTzbTTaaTbTTazaTzaTTazXzYzF2211221101zbzbzazaa其中bTTaTaa244220，bTTaaTa2482221，bTTaTaa244222，bTTaaTb2482221，bTTabTTab2424222带入参数：wc=4.398;T=0.0001;k1=40;20/1a，01/kb得a0=0.991280695424675a1=-1.982561199111843a2=0.991280695424675b1=-1.982561199111843b2=0.982561390849351转化为差分方程为)2(2)1()()2()1()(1021kxakxakxakybkybky即0)1()0(,0)1()0()2()1()2(2)1()()(2110yyxxkybkybkxakxakxaky编程：floatx_k;floatx_k1=0;floatx_k2=0;floaty_k;floaty_k1=0;floaty_k2=0;floata0=0.991280695424675;floata1=-1.982561199111843;floata2=0.991280695424675;floatb1=-1.982561199111843;floatb2=0.982561390849351;x_k=t.DT;y_k=a0*x_k+a1*x_k1+a2*x_k2-b1*y_k1-b2*y_k2;x_k2=x_k1;x_k1=x_k;y_k2=y_k1;y_k1=y_k;EPwm1Regs.CMPA.half.CMPA=t.DT;EPwm3Regs.CMPA.half.CMPA=y_k;//+3750;//EPwm4Regs.CMPA.half.CMPA=x_k+3750;仿真波形1961971981992002012022032046.16.26.36.46.56.66.76.86.97x105实验波形