diff --git a/Firmware/xyzcal.cpp b/Firmware/xyzcal.cpp
index 767024db..7179996d 100644
--- a/Firmware/xyzcal.cpp
+++ b/Firmware/xyzcal.cpp
@@ -495,20 +495,22 @@ int8_t xyzcal_find_point_center2(uint16_t delay_us)
 	xyzcal_lineXYZ_to(_X, _Y, z0 - 400, 500, 1);
 
     if (has_temperature_compensation()){
-	    z0 = _Z - 20; // normal PINDA
+        z0 = _Z - 20; // normal PINDA
         return xyzcal_find_point_center2A(x0, y0, z0, delay_us);
     } else {
         // try searching harder, each PINDA is different
+        int8_t rv = 0;
         for(z0 = _Z - 20; z0 <= _Z + 140; z0 += 20 ){ // alternate PINDA
-            int8_t rv = xyzcal_find_point_center2A(x0, y0, z0, delay_us);
+            rv = xyzcal_find_point_center2A(x0, y0, z0, delay_us);
             printf_P(PSTR(" z0=%d"), z0);
             if( rv != 0 ){
-                printf_P(PSTR("ok\n"));
-                return rv;
+                puts_P(PSTR("ok"));
+                break;
             } else {
-                printf_P(PSTR("fail\n"));
+                puts_P(PSTR("fail"));
             }
         }
+        return rv;
     }
 }