Implemented MFB filter calculation