Check repeatedly (#1066)

I made it so that it is checked multiple times instead of just once.

- fix #1052

camera_calibration/src/camera_calibration/camera_checker.py

@@ -71,10 +71,10 @@ def __init__(self, queue, function):
 
     def run(self):
         while rclpy.ok():
-            m = self.queue.get()
             if self.queue.empty():
-                break
-        self.function(m)
+                continue
+            m = self.queue.get()
+            self.function(m)
 
 class CameraCheckerNode(Node):
 
@@ -179,9 +179,9 @@ def handle_monocular(self, msg):
             reprojection_rms = numpy.sqrt(numpy.sum(numpy.array(reprojection_errors) ** 2) / numpy.product(reprojection_errors.shape))
 
             # Print the results
-            print("Linearity RMS Error: %.3f Pixels      Reprojection RMS Error: %.3f Pixels" % (linearity_rms, reprojection_rms))
+            self.get_logger().info("Linearity RMS Error: %.3f Pixels      Reprojection RMS Error: %.3f Pixels" % (linearity_rms, reprojection_rms))
         else:
-            print('no chessboard')
+            self.get_logger().info('no chessboard')
 
     def handle_stereo(self, msg):
 
@@ -196,6 +196,6 @@ def handle_stereo(self, msg):
 
             dimension = self.sc.chessboard_size(L, R, self.board, msg=(lcmsg, rcmsg))
 
-            print("epipolar error: %f pixels   dimension: %f m" % (epipolar, dimension))
+            self.get_logger().info("epipolar error: %f pixels   dimension: %f m" % (epipolar, dimension))
         else:
-            print("no chessboard")
+            self.get_logger().info("no chessboard")