Plane : APM_Control/AP_PitchController : Modified noise filter to use FOH discretisation and cleaned up code