OpenCV_Undistort.java
import java.util.ArrayList;
import org.opencv.calib3d.Calib3d;
import org.opencv.core.Core;
import org.opencv.core.CvType;
import org.opencv.core.Mat;
import org.opencv.core.MatOfPoint2f;
import org.opencv.core.MatOfPoint3f;
import org.opencv.core.Point3;
import org.opencv.core.Size;
import org.opencv.core.TermCriteria;
import org.opencv.imgcodecs.Imgcodecs;
import org.opencv.imgproc.Imgproc;
public class OpenCV_Undistort {
    static{ System.loadLibrary(Core.NATIVE_LIBRARY_NAME); }
    public static void main( String[] args )
    {
        try{
            Mat source = Imgcodecs.imread("D:\\projects\\Java\\OpenCV_Samples\\resource\\imgs\\005.jpg ",
                    Imgcodecs.CV_LOAD_IMAGE_COLOR);
            Mat destination=source.clone();
            // Mat destination1=new Mat();
            Imgproc.cvtColor(source, destination, Imgproc.COLOR_BGR2GRAY);
            Size boarderSize=new Size(9,6);
            MatOfPoint2f imageCorners=new MatOfPoint2f();
            boolean found=Calib3d.findChessboardCorners(destination, boarderSize, imageCorners,Calib3d.CALIB_CB_ADAPTIVE_THRESH+Calib3d.CALIB_CB_NORMALIZE_IMAGE+Calib3d.CALIB_CB_FAST_CHECK);
            if (found){
                TermCriteria term =new TermCriteria(TermCriteria.EPS|TermCriteria.MAX_ITER,30,0.1);
                Imgproc.cornerSubPix(destination, imageCorners, new Size(11,11), new Size(-1,-1),term);
                Calib3d.drawChessboardCorners(source, boarderSize, imageCorners, found);
            }
            ArrayList<Mat> rvecs = new ArrayList<Mat>();
            ArrayList<Mat> tvecs = new ArrayList<Mat>();
            ArrayList<Mat> objectPoints=new ArrayList<Mat>();
            ArrayList<Mat> imagePoints=new ArrayList<Mat>();
            MatOfPoint3f obj=new MatOfPoint3f();
            Mat cameraMatrix=new Mat(3,3,CvType.CV_32FC1);
            cameraMatrix.put(0, 0, 1);
            cameraMatrix.put(1, 1, 1);
            Mat distCoeffs=new Mat();
            Mat undistort=new Mat(source.size(), source.type());
            for(int j=0;j<54;j++){
                //obj.push_back(new MatOfPoint3f(new Point3(j/6,j%9,0.0f)));
                obj.push_back(new MatOfPoint3f(new Point3(j/6,j%9,0.0f)));//º§º¬3,3
            }
            objectPoints.add(obj);
            imagePoints.add(imageCorners);
            Calib3d.calibrateCamera(objectPoints, imagePoints, destination.size(), cameraMatrix, distCoeffs, rvecs, tvecs);
            Imgproc.undistort(source, undistort, cameraMatrix, distCoeffs);
            Imgcodecs.imwrite("D:\\projects\\Java\\OpenCV_Samples\\resource\\imgs\\Calib3d-undistort.jpg ", undistort);
        }catch (Exception e) {
            System.out.println("error: " + e.getMessage());
        }
    }
}
Recommended Posts