(−3dBpoint)=12π(R1*R2*C1*C2)12
x[n+1]=x[n]+γ(u[n]−x[n])−KP∑j=1N(1Nxj[n])+KI∑j=1N(1Nwj[n])
w[n+1]=w[n]−KI∑j=1N(1Nxj[n])
[u˙xu˙y]=[102(Rx−xMx)(Ry−xMy)0010(Rx−xMx)2(Ry−xMy)][kMx00000kMy00000kMxx00000kMyy00000kMxy][gMx−xMxgMy−xMygMxx−xMxxgMyy−xMyygMxy−xMxy]