( − 3 d B p o i n t ) = 1 2 π ( R 1 ∗ R 2 ∗ C 1 ∗ C 2 ) 1 2 {\displaystyle (-3dBpoint)={\frac {1}{2\pi }}(R1*R2*C1*C2)^{\frac {1}{2}}}
x [ n + 1 ] = x [ n ] + γ ( u [ n ] − x [ n ] ) − K P ∑ j = 1 N ( 1 N x j [ n ] ) + K I ∑ j = 1 N ( 1 N w j [ n ] ) {\displaystyle x[n+1]=x[n]+\gamma (u[n]-x[n])-K_{P}\sum _{j=1}^{N}({\frac {1}{N}}x_{j}[n])+K_{I}\sum _{j=1}^{N}({\frac {1}{N}}w_{j}[n])}
w [ n + 1 ] = w [ n ] − K I ∑ j = 1 N ( 1 N x j [ n ] ) {\displaystyle w[n+1]=w[n]-K_{I}\sum _{j=1}^{N}({\frac {1}{N}}x_{j}[n])}
[ u ˙ x u ˙ y ] = [ 1 0 2 ( R x − x M x ) ( R y − x M y ) 0 0 1 0 ( R x − x M x ) 2 ( R y − x M y ) ] {\displaystyle {\begin{bmatrix}{\dot {u}}_{x}\\{\dot {u}}_{y}\\\end{bmatrix}}={\begin{bmatrix}1&0&2(R_{x}-x_{Mx})&(R_{y}-x_{My})&0\\0&1&0&(R_{x}-x_{Mx})&2(R_{y}-x_{My})\\\end{bmatrix}}}