Open-loop intetgrator drift has been fixed using a low pass filter with w_cutoff=200. Electromagnetic torque and flux-linkage reference can be now calculated.