$W_{\mathrm{g}}=W_{\mathrm{g}}^{\text{int}}$ % initialize Wg to its nominal value (e.g., 0.2)

If ${\left|\text{SD}\right|}_{\text{LP}}\ge {\epsilon }_{\text{SD}}$

Compute $W_{{\mathrm{g}}_{\text{int}}}(t)$ According to Eq 6

If $(W_{{\mathrm{g}}_{\text{int}}}(t)-W_{\mathrm{g}}(t))<\delta$

$W_{\mathrm{g}}(t)=W_{{\mathrm{g}}_{{\text{int}}_{\text{LP}}}}(t)=(\frac{1}{\tau s+1})\cdot W_{{\mathrm{g}}_{\text{int}}}(t)\text{\%}\text{with}{f}_c=\frac{1}{2\pi \tau }=0.04\text{ Hz}$

Else

$W_{\mathrm{g}}(t)=W_{{\mathrm{g}}_{\text{int}}}(t)$

Else

$W_{\mathrm{g}}\text{(}t)=(\frac{1}{\tau s+1})\cdot W_{\mathrm{g}}^{\text{ini}}\text{\%}\text{with}{f}_c=\frac{1}{2\pi \tau }=0.04\text{ Hz or }0.02\text{ Hz}$

End