- Fixed FP-controller like it was suggested.