Yaw -> smaller deadband
Altitude -> deadband for D
height calc -> fix atmosphere temperature 15 degrees