Difference between revisions of "Example Fiducial Square Binary"

From BoofCV
Jump to navigationJump to search
m
m
Line 8: Line 8:


Example Code:
Example Code:
* [https://github.com/lessthanoptimal/BoofCV/blob/v0.23/examples/src/boofcv/examples/fiducial/ExampleFiducialBinary.java ExampleFiducialBinary.java]
* [https://github.com/lessthanoptimal/BoofCV/blob/v0.25/examples/src/boofcv/examples/fiducial/ExampleFiducialBinary.java ExampleFiducialBinary.java]


Concepts:
Concepts:
Line 18: Line 18:
* [[Example_Fiducial_Square_Image|Example Fiducial Square Image]]
* [[Example_Fiducial_Square_Image|Example Fiducial Square Image]]
* [[Example_Calibration_Target_Pose|Example Fiducial Calibration Target]]
* [[Example_Calibration_Target_Pose|Example Fiducial Calibration Target]]
Relevant Applets:
* [[Applet Fiducials| Applet Fiducials]]


Videos
Videos
Line 40: Line 37:


// load the lens distortion parameters and the input image
// load the lens distortion parameters and the input image
IntrinsicParameters param = UtilIO.loadXML(directory , "intrinsic.xml");
CameraPinholeRadial param = CalibrationIO.load(new File(directory , "intrinsic.yaml"));
LensDistortionNarrowFOV lensDistortion = new LensDistortionRadialTangential(param);
 
BufferedImage input = UtilImageIO.loadImage(directory , "image0000.jpg");
BufferedImage input = UtilImageIO.loadImage(directory , "image0000.jpg");
// BufferedImage input = UtilImageIO.loadImage(directory , "image0001.jpg");
// BufferedImage input = UtilImageIO.loadImage(directory , "image0001.jpg");
Line 51: Line 50:
// new ConfigFiducialBinary(0.1), ConfigThreshold.fixed(100),GrayF32.class);
// new ConfigFiducialBinary(0.1), ConfigThreshold.fixed(100),GrayF32.class);


detector.setIntrinsic(param);
detector.setLensDistortion(lensDistortion);
 
detector.detect(original);
detector.detect(original);


Line 58: Line 56:
Graphics2D g2 = input.createGraphics();
Graphics2D g2 = input.createGraphics();
Se3_F64 targetToSensor = new Se3_F64();
Se3_F64 targetToSensor = new Se3_F64();
Point2D_F64 locationPixel = new Point2D_F64();
for (int i = 0; i < detector.totalFound(); i++) {
for (int i = 0; i < detector.totalFound(); i++) {
System.out.println("Target ID = "+detector.getId(i));
detector.getImageLocation(i, locationPixel);
detector.getFiducialToCamera(i, targetToSensor);
 
System.out.println("Location:");
if( detector.hasUniqueID() )
System.out.println(targetToSensor);
System.out.println("Target ID = "+detector.getId(i));
if( detector.hasMessage() )
System.out.println("Message  = "+detector.getMessage(i));
System.out.println("2D Image Location = "+locationPixel);


VisualizeFiducial.drawCube(targetToSensor,param,detector.getWidth(i), 3, g2);
if( detector.is3D() ) {
VisualizeFiducial.drawLabelCenter(targetToSensor,param,""+detector.getId(i), g2);
detector.getFiducialToCamera(i, targetToSensor);
System.out.println("3D Location:");
System.out.println(targetToSensor);
VisualizeFiducial.drawCube(targetToSensor, param, detector.getWidth(i), 3, g2);
VisualizeFiducial.drawLabelCenter(targetToSensor, param, "" + detector.getId(i), g2);
} else {
VisualizeFiducial.drawLabel(locationPixel, "" + detector.getId(i), g2);
}
}
}



Revision as of 15:23, 1 December 2016

Demonstration how to detect square binary fiducials. Square binary fiducials encode a pattern in the fiducial's center which can describe up to 4096 unique targets.

Example Code:

Concepts:

  • Fiducials
  • Pose estimation

Relevant Examples/Tutorials:

Videos

Example Code

/**
 * Detects square binary fiducials inside an image, writes out there pose, and visualizes a virtual flat cube
 * above them in the input image.
 *
 * @author Peter Abeles
 */
public class ExampleFiducialBinary {
	public static void main(String[] args) {

		String directory = UtilIO.pathExample("fiducial/binary");

		// load the lens distortion parameters and the input image
		CameraPinholeRadial param = CalibrationIO.load(new File(directory , "intrinsic.yaml"));
		LensDistortionNarrowFOV lensDistortion = new LensDistortionRadialTangential(param);

		BufferedImage input = UtilImageIO.loadImage(directory , "image0000.jpg");
//		BufferedImage input = UtilImageIO.loadImage(directory , "image0001.jpg");
//		BufferedImage input = UtilImageIO.loadImage(directory , "image0002.jpg");
		GrayF32 original = ConvertBufferedImage.convertFrom(input,true, ImageType.single(GrayF32.class));

		// Detect the fiducial
		FiducialDetector<GrayF32> detector = FactoryFiducial.squareBinary(
				new ConfigFiducialBinary(0.1), ConfigThreshold.local(ThresholdType.LOCAL_SQUARE, 10), GrayF32.class);
//				new ConfigFiducialBinary(0.1), ConfigThreshold.fixed(100),GrayF32.class);

		detector.setLensDistortion(lensDistortion);
		detector.detect(original);

		// print the results
		Graphics2D g2 = input.createGraphics();
		Se3_F64 targetToSensor = new Se3_F64();
		Point2D_F64 locationPixel = new Point2D_F64();
		for (int i = 0; i < detector.totalFound(); i++) {
			detector.getImageLocation(i, locationPixel);

			if( detector.hasUniqueID() )
				System.out.println("Target ID = "+detector.getId(i));
			if( detector.hasMessage() )
				System.out.println("Message   = "+detector.getMessage(i));
			System.out.println("2D Image Location = "+locationPixel);

			if( detector.is3D() ) {
				detector.getFiducialToCamera(i, targetToSensor);
				System.out.println("3D Location:");
				System.out.println(targetToSensor);
				VisualizeFiducial.drawCube(targetToSensor, param, detector.getWidth(i), 3, g2);
				VisualizeFiducial.drawLabelCenter(targetToSensor, param, "" + detector.getId(i), g2);
			} else {
				VisualizeFiducial.drawLabel(locationPixel, "" + detector.getId(i), g2);
			}
		}

		ShowImages.showWindow(input,"Fiducials",true);

	}
}