Fixed wrong IIR filter implementation and factored gravity into resul