Added discrete TF implementation and altitude reference smoother