double setpoint_phi = DEGREE2RADIAN(drone_config.getControllerPid("angle", "phi", "setpoint")); double Kp_theta = drone_config.getControllerPid("angle", "theta", "Kp ...