2.21.2.2 A1

float32_t A1

Derived gain: A1 = -Kp - 2*Kd