Plane : APM_Control : Added maths so that K_P, K_I and K_D can use the same values as previous PID controllers