diff --git a/Demo.cpp b/Demo.cpp
index 51c3a8d25d261aaa04ec1a6ac1c6ca51730a6f45..a2d4ae2962fba7edbf4cf5aa5c2f2ecdcaaf4494 100644
--- a/Demo.cpp
+++ b/Demo.cpp
@@ -378,12 +378,13 @@ int main(int argc, char * argv[])
             {
                 //! step 0 we take care about the lense distortion
                 //! correct lense distortion
-                //Mat imgLenseCorrection = img_input.clone();
-                cv::undistort(img_input, img_input, intrinsicsCameraMatrix, distortionCoeff);
+                Mat imgLenseCorrection = img_input.clone();
+                //see https://docs.opencv.org/2.4/modules/imgproc/doc/geometric_transformations.html#undistort
+                cv::undistort(img_input, imgLenseCorrection, intrinsicsCameraMatrix, distortionCoeff);
 
                 //! we cut out a smaller ROI,
                 //! step 1)
-                img_input = TToolBox::cropImageCircle(img_input,circleCenterX,circleCenterY,circleRadius);
+                img_input = TToolBox::cropImageCircle(imgLenseCorrection,circleCenterX,circleCenterY,circleRadius);
 
                 //!  normal bgs processing
                 //! step 2)