flight control with HUD started

smoothed out altitude reading in firmware a lot.