From 0ca427bdd9677717023bc8105813b92f5531d310 Mon Sep 17 00:00:00 2001
From: Jason Short <jasonshort@sdsfcm02.smartdesign.com>
Date: Tue, 8 Nov 2011 14:41:21 -0800
Subject: [PATCH] Removed debugging code from APM_PI

---
 libraries/APM_PI/APM_PI.cpp | 12 ++++++------
 1 file changed, 6 insertions(+), 6 deletions(-)

diff --git a/libraries/APM_PI/APM_PI.cpp b/libraries/APM_PI/APM_PI.cpp
index 230956c00b..d6efc6fb29 100644
--- a/libraries/APM_PI/APM_PI.cpp
+++ b/libraries/APM_PI/APM_PI.cpp
@@ -10,15 +10,15 @@
 long
 APM_PI::get_pi(int32_t error, float dt, bool calc_i)
 {
-	if(true)
+	if(calc_i){
 		_integrator += ((float)error * _ki) * dt;
 
-	if (_integrator < -_imax) {
-		_integrator = -_imax;
-	} else if (_integrator > _imax) {
-		_integrator = _imax;
+		if (_integrator < -_imax) {
+			_integrator = -_imax;
+		} else if (_integrator > _imax) {
+			_integrator = _imax;
+		}
 	}
-
 	return (float)error * _kp + _integrator;
 }