diff --git a/ArduCopter/commands_logic.pde b/ArduCopter/commands_logic.pde
index df18e6a43a..8c988c6160 100644
--- a/ArduCopter/commands_logic.pde
+++ b/ArduCopter/commands_logic.pde
@@ -363,8 +363,7 @@ static bool verify_takeoff()
 		return false;
 	}
 	// are we above our target altitude?
-	//return (current_loc.alt > next_WP.alt);
-	return (current_loc.alt > target_altitude);
+	return (current_loc.alt > next_WP.alt);
 }
 
 // called at 10hz