Added noise filter - Calculates vertical displacement correctly