Example Calibrate Planar Stereo

From BoofCV
Revision as of 19:05, 8 October 2021 by Peter (talk | contribs)
Jump to navigationJump to search

This example demonstrate how to calibrate a stereo camera system using a high level interface which automatically detects calibration targets in a set of stereo images. After calibration the intrinsic parameters of each camera is found as well as their extrinsic relationship with each other. Both the square grid and chessboard patterns are supported by this example. For a full description of the calibration process and instruction on how to do it yourself see the tutorial linked to below.

Example File: ExampleCalibrateStereo.java

Calibration Tutorial: Wikipage

Concepts:

  • Camera calibration
  • Lens distortion
  • Intrinsic parameters
  • Stereo Vision

Related Examples:

Example Code

/**
 * Example of how to calibrate a stereo camera system using a planar calibration grid given a set of images.
 * Intrinsic camera parameters are estimated for both cameras individually, then extrinsic parameters
 * for the two cameras relative to each other are found   This example does not rectify the images, which is
 * required for some algorithms. See {@link boofcv.examples.stereo.ExampleRectifyCalibratedStereo}. Both square grid and chessboard targets
 * are demonstrated in this example. See calibration tutorial for a discussion of different target types and how to
 * collect good calibration images.
 *
 * All the image processing and calibration is taken care of inside of {@link CalibrateStereoPlanar}. The code below
 * loads calibration images as inputs, calibrates, and saves results to an XML file. See in code comments for tuning
 * and implementation issues.
 *
 * @author Peter Abeles
 * @see boofcv.examples.stereo.ExampleRectifyCalibratedStereo
 * @see CalibrateStereoPlanar
 */
public class ExampleCalibrateStereo {

	// Detects the target and calibration point inside the target
	DetectSingleFiducialCalibration detector;

	// List of calibration images
	List<String> left;
	List<String> right;

	/**
	 * ECoCheck target taken by a Zed stereo camera
	 */
	public void setupECoCheck() {
		// Creates a detector and specifies its physical characteristics
		detector = new MultiToSingleFiducialCalibration(FactoryFiducialCalibration.
				ecocheck(null, ConfigECoCheckMarkers.singleShape(9, 7, 1, 30)));

		String directory = UtilIO.pathExample("calibration/stereo/Zed_ecocheck");

		left = UtilIO.listByPrefix(directory, "left", null);
		right = UtilIO.listByPrefix(directory, "right", null);
	}

	/**
	 * Square grid target taken by a PtGrey Bumblebee camera.
	 */
	public void setupSquareGrid() {
		// Creates a detector and specifies its physical characteristics
		detector = FactoryFiducialCalibration.squareGrid(null, new ConfigGridDimen(4, 3, 30, 30));

		String directory = UtilIO.pathExample("calibration/stereo/Bumblebee2_Square");

		left = UtilIO.listByPrefix(directory, "left", null);
		right = UtilIO.listByPrefix(directory, "right", null);
	}

	/**
	 * Chessboard target taken by a PtGrey Bumblebee camera.
	 */
	public void setupChessboard() {
		// Creates a detector and specifies its physical characteristics
		detector = FactoryFiducialCalibration.chessboardX(null, new ConfigGridDimen(7, 5, 30));

		String directory = UtilIO.pathExample("calibration/stereo/Bumblebee2_Chess");

		left = UtilIO.listByPrefix(directory, "left", null);
		right = UtilIO.listByPrefix(directory, "right", null);
	}

	/**
	 * Process calibration images, compute intrinsic parameters, save to a file
	 */
	public void process() {
		// Declare and setup the calibration algorithm
		var calibratorAlg = new CalibrateStereoPlanar(detector.getLayout());
		calibratorAlg.configure(/*zero skew*/true, /* radial */4, /* tangential */false);

		// Uncomment to print more information to stdout
//		calibratorAlg.setVerbose(System.out,null);

		// ensure the lists are in the same order
		Collections.sort(left);
		Collections.sort(right);

		for (int i = 0; i < left.size(); i++) {
			BufferedImage l = UtilImageIO.loadImage(left.get(i));
			BufferedImage r = UtilImageIO.loadImage(right.get(i));

			GrayF32 imageLeft = ConvertBufferedImage.convertFrom(l, (GrayF32)null);
			GrayF32 imageRight = ConvertBufferedImage.convertFrom(r, (GrayF32)null);

			CalibrationObservation calibLeft, calibRight;
			if (!detector.process(imageLeft)) {
				System.out.println("Failed to detect target in " + left.get(i));
				continue;
			}
			calibLeft = detector.getDetectedPoints();
			if (!detector.process(imageRight)) {
				System.out.println("Failed to detect target in " + right.get(i));
				continue;
			}
			calibRight = detector.getDetectedPoints();

			calibratorAlg.addPair(calibLeft, calibRight);
		}

		// Process and compute calibration parameters
		StereoParameters stereoCalib = calibratorAlg.process();

		// print out information on its accuracy and errors
		calibratorAlg.printStatistics();

		// save results to a file and print out
		CalibrationIO.save(stereoCalib, "stereo.yaml");
		stereoCalib.print();

		// Note that the stereo baseline translation will be specified in the same units as the calibration grid.
		// Which is in millimeters (mm) in this example.
	}

	public static void main( String[] args ) {
		var alg = new ExampleCalibrateStereo();

		// Strongly recommended that ECoCheck target is used as it allows you to entirely fill in left and right
		// stereo images since it allows for partially observed targets
		alg.setupECoCheck();
//		alg.setupChessboard();
//		alg.setupSquareGrid();

		// compute and save results
		alg.process();
	}
}