Plane : AP_L1_Control.cpp : Cleaned up calculation of damping to reduce computations