OpenCV Camera Calibration 示例使用

本文主要介绍OpenCV自带标定例子的使用方法。

OpenCV包含标定文件：calibration.cpp：是通过用户输入可选参数进行相机标定的程序；

（1）新建项目 test_Calibration

File->New -> Project,点击ok，next，选择Empty project，点击finish。

（2）添加源文件

将OpenCV安装目录下的OpenCV\opencv\sources\samples\cpp文件夹中的calibration.cpp文件复制到港创建的工程目录下....\Test_Calibration\test_Calibration\test_Calibration文件夹下。作者为了区分两者，所以将其重命名为TestCalibration.cpp

在VS中右击工程名，右键点击工程中的Source Files->Add ->Existing Item ,选择刚复制的TestCalibration.cpp文件。

（3）运行

点击Debug->Start Without Debugging，运行。生成test_Calibration.exe，在。。。Test_Calibration\test_Calibration\x64\Debug文件夹下。

（4）标定

打开所有程序中的“运行”，或直接按键Win+R，打开“运行”，输入“cmd”回车，打开命令行窗口

输入文件地址，如作者的地址输入 “E：”回车->cd paper_and_code\code20180507\C++\Test_Calibration\test_Calibration\x64\Debug 进入文件夹。

输入命令：“test_Calibration.exe -w=8 -h=6”回车

程序开始运行。

并生成out_camera_data.yml文件

利用事先拍好的图片标定的方法在下一篇会讲到

OpenCV Camera Calibration 示例使用（二） - CSDN博客
 https://blog.csdn.net/panpan_jiang1/article/details/80429937

TestCalibration.cpp的代码如下

#include "opencv2/core.hpp"
#include
#include "opencv2/imgproc.hpp"
#include "opencv2/calib3d.hpp"
#include "opencv2/imgcodecs.hpp"
#include "opencv2/videoio.hpp"
#include "opencv2/highgui.hpp"


#include
#include
#include
#include


using namespace cv;
using namespace std;


const char * usage =
" \nexample command line for calibration from a live feed.\n"
"   calibration  -w=4 -h=5 -s=0.025 -o=camera.yml -op -oe\n"
" \n"
" example command line for calibration from a list of stored images:\n"
"   imagelist_creator image_list.xml *.png\n"
"   calibration -w=4 -h=5 -s=0.025 -o=camera.yml -op -oe image_list.xml\n"
" where image_list.xml is the standard OpenCV XML/YAML\n"
" use imagelist_creator to create the xml or yaml list\n"
" file consisting of the list of strings, e.g.:\n"
" \n"
"\n"
"\n"
"\n"
"view000.png\n"
"view001.png\n"
"\n"
"view003.png\n"
"view010.png\n"
"one_extra_view.jpg\n"
"\n"
"\n";

const char* liveCaptureHelp =
    "When the live video from camera is used as input, the following hot-keys may be used:\n"
        "  , 'q' - quit the program\n"
        "  'g' - start capturing images\n"
        "  'u' - switch undistortion on/off\n";


static void help()
{
    printf( "This is a camera calibration sample.\n"
        "Usage: calibration\n"
        "     -w=         # the number of inner corners per one of board dimension\n"
        "     -h=        # the number of inner corners per another board dimension\n"
        "     [-pt=]          # the type of pattern: chessboard or circles' grid\n"
        "     [-n=]  # the number of frames to use for calibration\n"
        "                              # (if not specified, it will be set to the number\n"
        "                              #  of board views actually available)\n"
        "     [-d=]             # a minimum delay in ms between subsequent attempts to capture a next view\n"
        "                              # (used only for video capturing)\n"
        "     [-s=]       # square size in some user-defined units (1 by default)\n"
        "     [-o=] # the output filename for intrinsic [and extrinsic] parameters\n"
        "     [-op]                    # write detected feature points\n"
        "     [-oe]                    # write extrinsic parameters\n"
        "     [-zt]                    # assume zero tangential distortion\n"
        "     [-a=]      # fix aspect ratio (fx/fy)\n"
        "     [-p]                     # fix the principal point at the center\n"
        "     [-v]                     # flip the captured images around the horizontal axis\n"
        "     [-V]                     # use a video file, and not an image list, uses\n"
        "                              # [input_data] string for the video file name\n"
        "     [-su]                    # show undistorted images after calibration\n"
        "     [input_data]             # input data, one of the following:\n"
        "                              #  - text file with a list of the images of the board\n"
        "                              #    the text file can be generated with imagelist_creator\n"
        "                              #  - name of video file with a video of the board\n"
        "                              # if input_data not specified, a live view from the camera is used\n"
        "\n" );
    printf("\n%s",usage);
    printf( "\n%s", liveCaptureHelp );
}


enum { DETECTION = 0, CAPTURING = 1, CALIBRATED = 2 };
enum Pattern { CHESSBOARD, CIRCLES_GRID, ASYMMETRIC_CIRCLES_GRID };


//计算重投影误差  返回标准差
static double computeReprojectionErrors(
        const vector >& objectPoints,
        const vector >& imagePoints,
        const vector& rvecs, const vector& tvecs,
        const Mat& cameraMatrix, const Mat& distCoeffs,
        vector& perViewErrors )
{
    vector imagePoints2;
    int i, totalPoints = 0;
    double totalErr = 0, err;
    perViewErrors.resize(objectPoints.size());


    for( i = 0; i < (int)objectPoints.size(); i++ )
    {
        projectPoints(Mat(objectPoints[i]), rvecs[i], tvecs[i],
                      cameraMatrix, distCoeffs, imagePoints2);//根据给定的固有和外部参数，计算3D点对图像平面的投影
        err = norm(Mat(imagePoints[i]), Mat(imagePoints2), NORM_L2);
        int n = (int)objectPoints[i].size();
        perViewErrors[i] = (float)std::sqrt(err*err/n);
        totalErr += err*err;
        totalPoints += n;
    }


    return std::sqrt(totalErr/totalPoints);
}


//计算棋盘标定板的角点
static void calcChessboardCorners(Size boardSize, float squareSize, vector& corners, Pattern patternType = CHESSBOARD)
{
    corners.resize(0);


    switch(patternType)
    {
      case CHESSBOARD://棋盘格
      case CIRCLES_GRID://圆形网格
        for( int i = 0; i < boardSize.height; i++ )
            for( int j = 0; j < boardSize.width; j++ )
                corners.push_back(Point3f(float(j*squareSize),
                                          float(i*squareSize), 0));//遍历棋盘格的角点，三维坐标，写入corners。   每一个角点的行列数乘以每个网格里的像素数等于角点的像素坐标？？？？？
        break;


      case ASYMMETRIC_CIRCLES_GRID://非对称圆形网格
        for( int i = 0; i < boardSize.height; i++ )
            for( int j = 0; j < boardSize.width; j++ )
                corners.push_back(Point3f(float((2*j + i % 2)*squareSize),
                                          float(i*squareSize), 0));//float()强制类型转换
        break;


      default:
        CV_Error(Error::StsBadArg, "Unknown pattern type\n");
    }
}



static bool runCalibration( vector > imagePoints,
                    Size imageSize, Size boardSize, Pattern patternType,
                    float squareSize, float aspectRatio,
                    int flags, Mat& cameraMatrix, Mat& distCoeffs,
                    vector& rvecs, vector& tvecs,
                    vector& reprojErrs,
                    double& totalAvgErr)
{
    cameraMatrix = Mat::eye(3, 3, CV_64F);//CV_64F 64-bit floating-point numbers 对角矩阵
    if( flags & CALIB_FIX_ASPECT_RATIO )
        cameraMatrix.at(0,0) = aspectRatio;//第1行，第1列的元素，纵横比


    distCoeffs = Mat::zeros(8, 1, CV_64F);//全零矩阵


    vector > objectPoints(1);//point3f类型的二维数组
    calcChessboardCorners(boardSize, squareSize, objectPoints[0], patternType);


    objectPoints.resize(imagePoints.size(),objectPoints[0]);


    double rms = calibrateCamera(objectPoints, imagePoints, imageSize, cameraMatrix,
                    distCoeffs, rvecs, tvecs, flags|CALIB_FIX_K4|CALIB_FIX_K5);//estimates the intrinsic camera parameters and extrinsic parameters for each of the views.
                    ///*|CALIB_FIX_K3*/|CALIB_FIX_K4|CALIB_FIX_K5);
    printf("RMS error reported by calibrateCamera: %g\n", rms);


    bool ok = checkRange(cameraMatrix) && checkRange(distCoeffs);//checkRange 检查矩阵的每个元素的取值是否在最小值与最大值之间，返回验证结果bool


    totalAvgErr = computeReprojectionErrors(objectPoints, imagePoints,
                rvecs, tvecs, cameraMatrix, distCoeffs, reprojErrs);


    return ok;
}


static void saveCameraParams( const string& filename,
                       Size imageSize, Size boardSize,
                       float squareSize, float aspectRatio, int flags,
                       const Mat& cameraMatrix, const Mat& distCoeffs,
                       const vector& rvecs, const vector& tvecs,
                       const vector& reprojErrs,
                       const vector >& imagePoints,
                       double totalAvgErr )
{
    FileStorage fs( filename, FileStorage::WRITE );


    time_t tt;
    time( &tt );
    struct tm *t2 = localtime( &tt );
    char buf[1024];
    strftime( buf, sizeof(buf)-1, "%c", t2 );


    fs << "calibration_time" << buf;


    if( !rvecs.empty() || !reprojErrs.empty() )
        fs << "nframes" << (int)std::max(rvecs.size(), reprojErrs.size());
    fs << "image_width" << imageSize.width;
    fs << "image_height" << imageSize.height;
    fs << "board_width" << boardSize.width;
    fs << "board_height" << boardSize.height;
    fs << "square_size" << squareSize;


    if( flags & CALIB_FIX_ASPECT_RATIO )
        fs << "aspectRatio" << aspectRatio;


    if( flags != 0 )
    {
        sprintf( buf, "flags: %s%s%s%s",
            flags & CALIB_USE_INTRINSIC_GUESS ? "+use_intrinsic_guess" : "",
            flags & CALIB_FIX_ASPECT_RATIO ? "+fix_aspectRatio" : "",
            flags & CALIB_FIX_PRINCIPAL_POINT ? "+fix_principal_point" : "",
            flags & CALIB_ZERO_TANGENT_DIST ? "+zero_tangent_dist" : "" );
        //cvWriteComment( *fs, buf, 0 );
    }


    fs << "flags" << flags;


    fs << "camera_matrix" << cameraMatrix;
    fs << "distortion_coefficients" << distCoeffs;


    fs << "avg_reprojection_error" << totalAvgErr;
    if( !reprojErrs.empty() )
        fs << "per_view_reprojection_errors" << Mat(reprojErrs);


    if( !rvecs.empty() && !tvecs.empty() )
    {
        CV_Assert(rvecs[0].type() == tvecs[0].type());
        Mat bigmat((int)rvecs.size(), 6, rvecs[0].type());
        for( int i = 0; i < (int)rvecs.size(); i++ )
        {
            Mat r = bigmat(Range(i, i+1), Range(0,3));
            Mat t = bigmat(Range(i, i+1), Range(3,6));


            CV_Assert(rvecs[i].rows == 3 && rvecs[i].cols == 1);
            CV_Assert(tvecs[i].rows == 3 && tvecs[i].cols == 1);
            //*.t() is MatExpr (not Mat) so we can use assignment operator
            r = rvecs[i].t();
            t = tvecs[i].t();
        }
        //cvWriteComment( *fs, "a set of 6-tuples (rotation vector + translation vector) for each view", 0 );
        fs << "extrinsic_parameters" << bigmat;
    }


    if( !imagePoints.empty() )
    {
        Mat imagePtMat((int)imagePoints.size(), (int)imagePoints[0].size(), CV_32FC2);
        for( int i = 0; i < (int)imagePoints.size(); i++ )
        {
            Mat r = imagePtMat.row(i).reshape(2, imagePtMat.cols);
            Mat imgpti(imagePoints[i]);
            imgpti.copyTo(r);
        }
        fs << "image_points" << imagePtMat;
    }
}


static bool readStringList( const string& filename, vector& l )
{
    l.resize(0);
    FileStorage fs(filename, FileStorage::READ);
    if( !fs.isOpened() )
        return false;
    FileNode n = fs.getFirstTopLevelNode();
    if( n.type() != FileNode::SEQ )
        return false;
    FileNodeIterator it = n.begin(), it_end = n.end();
    for( ; it != it_end; ++it )
        l.push_back((string)*it);
    return true;
}


static bool runAndSave(const string& outputFilename,
                const vector >& imagePoints,
                Size imageSize, Size boardSize, Pattern patternType, float squareSize,
                float aspectRatio, int flags, Mat& cameraMatrix,
                Mat& distCoeffs, bool writeExtrinsics, bool writePoints )
{
    vector rvecs, tvecs;
    vector reprojErrs;
    double totalAvgErr = 0;


    bool ok = runCalibration(imagePoints, imageSize, boardSize, patternType, squareSize,
                   aspectRatio, flags, cameraMatrix, distCoeffs,
                   rvecs, tvecs, reprojErrs, totalAvgErr);
    printf("%s. avg reprojection error = %.2f\n",
           ok ? "Calibration succeeded" : "Calibration failed",
           totalAvgErr);


    if( ok )
        saveCameraParams( outputFilename, imageSize,
                         boardSize, squareSize, aspectRatio,
                         flags, cameraMatrix, distCoeffs,
                         writeExtrinsics ? rvecs : vector(),
                         writeExtrinsics ? tvecs : vector(),
                         writeExtrinsics ? reprojErrs : vector(),
                         writePoints ? imagePoints : vector >(),
                         totalAvgErr );
    return ok;
}


int main( int argc, char** argv )
{
    Size boardSize, imageSize;//boardSize棋盘格内部角点的行列数 imageSize未畸变的图片尺寸
    float squareSize, aspectRatio; // The size of a square in your defined unit (point, millimeter,etc).       The aspect ratio
    Mat cameraMatrix, distCoeffs;//cameraMatrix 相机内参矩阵A   distCoeffs相机的畸变系数(k1,k2,p1,p2[,k3[,k4,k5,k6[,s1,s2,s3,s4[,τx,τy]]]])(k1,k2,p1,p2[,k3[,k4,k5,k6[,s1,s2,s3,s4[,τx,τy]]]])
    string outputFilename;//// The name of the file where to write 
    string inputFilename = "";


    int i, nframes; //The number of frames to use from the input for calibration
    bool writeExtrinsics, writePoints; // Write extrinsic parameters       Write detected feature points 
    bool undistortImage = false;//
    int flags = 0;
    VideoCapture capture;//捕获摄像机传来的视频
    bool flipVertical;
    bool showUndistorted;
    bool videofile;
    int delay;   // In case of a video input  
    clock_t prevTimestamp = 0;
    int mode = DETECTION;
    int cameraId = 0;
    vector > imagePoints;
    vector imageList;//图像文件名称序列
    Pattern pattern = CHESSBOARD;//标定板的标定图案的类型// One of the Chessboard, circles, or asymmetric circle pattern


    cv::CommandLineParser parser(argc, argv,
        "{help ||}{w||}{h||}{pt|chessboard|}{n|10|}{d|1000|}{s|1|}{o|out_camera_data.yml|}"
        "{op||}{oe||}{zt||}{a|1|}{p||}{v||}{V||}{su||}"
        "{@input_data|0|}");
    if (parser.has("help"))
    {
        help();
        return 0;
    }
    boardSize.width = parser.get( "w" );
    boardSize.height = parser.get( "h" );
    if ( parser.has("pt") )
    {
        string val = parser.get("pt");
        if( val == "circles" )
            pattern = CIRCLES_GRID;
        else if( val == "acircles" )
            pattern = ASYMMETRIC_CIRCLES_GRID;
        else if( val == "chessboard" )
            pattern = CHESSBOARD;
        else
            return fprintf( stderr, "Invalid pattern type: must be chessboard or circles\n" ), -1;
    }
    squareSize = parser.get("s");
    nframes = parser.get("n");
    aspectRatio = parser.get("a");
    delay = parser.get("d");
    writePoints = parser.has("op");
    writeExtrinsics = parser.has("oe");
    if (parser.has("a"))
        flags |= CALIB_FIX_ASPECT_RATIO;
    if ( parser.has("zt") )
        flags |= CALIB_ZERO_TANGENT_DIST;
    if ( parser.has("p") )
        flags |= CALIB_FIX_PRINCIPAL_POINT;
    flipVertical = parser.has("v");
    videofile = parser.has("V");
    if ( parser.has("o") )
        outputFilename = parser.get("o");
    showUndistorted = parser.has("su");
    if ( isdigit(parser.get("@input_data")[0]) )
        cameraId = parser.get("@input_data");
    else
        inputFilename = parser.get("@input_data");
    if (!parser.check())
    {
        help();
        parser.printErrors();
        return -1;
    }
    if ( squareSize <= 0 )
        return fprintf( stderr, "Invalid board square width\n" ), -1;
    if ( nframes <= 3 )
        return printf("Invalid number of images\n" ), -1;
    if ( aspectRatio <= 0 )
        return printf( "Invalid aspect ratio\n" ), -1;
    if ( delay <= 0 )
        return printf( "Invalid delay\n" ), -1;
    if ( boardSize.width <= 0 )
        return fprintf( stderr, "Invalid board width\n" ), -1;
    if ( boardSize.height <= 0 )
        return fprintf( stderr, "Invalid board height\n" ), -1;


//选择打开文件或是摄像头
    if( !inputFilename.empty() )
    {
        if( !videofile && readStringList(inputFilename, imageList) )
            mode = CAPTURING;
        else
            capture.open(inputFilename);
    }
    else
        capture.open(cameraId);


//摄像机没打开且图像序列为空，则返回initialize video 结束程序
    if( !capture.isOpened() && imageList.empty() )
        return fprintf( stderr, "Could not initialize video (%d) capture\n",cameraId ), -2;


    if( !imageList.empty() )
        nframes = (int)imageList.size();


    if( capture.isOpened() )
        printf( "%s", liveCaptureHelp );


    namedWindow( "Image View", 1 );


    for(i = 0;;i++)//无限循环至标定完且保存相机参数
    {
        Mat view, viewGray;//view 暂时存储棋盘格图像
        bool blink = false;


        if( capture.isOpened() )
        {
            Mat view0;
            capture >> view0;
            view0.copyTo(view);
        }
        else if( i < (int)imageList.size() )
            view = imread(imageList[i], 1);


//若存在棋盘格图像，则进行标定且保存相机参数，并结束循环
        if(view.empty())
        {
            if( imagePoints.size() > 0 )
                runAndSave(outputFilename, imagePoints, imageSize,
                           boardSize, pattern, squareSize, aspectRatio,
                           flags, cameraMatrix, distCoeffs,
                           writeExtrinsics, writePoints);
            break;
        }


        imageSize = view.size();


        if( flipVertical )
            flip( view, view, 0 );//切换所有元素


        vector pointbuf;//棋盘格角点二维坐标
        cvtColor(view, viewGray, COLOR_BGR2GRAY);


        bool found;
        switch( pattern )
        {
            case CHESSBOARD:
                found = findChessboardCorners( view, boardSize, pointbuf,  //第一个参数输入棋盘格图像 第二个参数棋盘格内部角点的行列数 第三个参数输出棋盘格角点 
                    CALIB_CB_ADAPTIVE_THRESH | CALIB_CB_FAST_CHECK | CALIB_CB_NORMALIZE_IMAGE);//角点检测 如果找到角点则返回true  第四个参数用于指定在检测棋盘格角点的过程中所应用的一种或多种过滤方法，两个方法之间用|隔开
                break;
            case CIRCLES_GRID: //圆
                found = findCirclesGrid( view, boardSize, pointbuf );
                break;
            case ASYMMETRIC_CIRCLES_GRID: //非对称圆
                found = findCirclesGrid( view, boardSize, pointbuf, CALIB_CB_ASYMMETRIC_GRID );
                break;
            default:
                return fprintf( stderr, "Unknown pattern type\n" ), -1;
        }


       // improve the found corners' coordinate accuracy
        if( pattern == CHESSBOARD && found) cornerSubPix( viewGray, pointbuf, Size(11,11),
            Size(-1,-1), TermCriteria( TermCriteria::EPS+TermCriteria::COUNT, 30, 0.1 ));//cornerSubPix定位之前角点的亚像素精确定位


        if( mode == CAPTURING && found &&
           (!capture.isOpened() || clock() - prevTimestamp > delay*1e-3*CLOCKS_PER_SEC) )
        {
            imagePoints.push_back(pointbuf);
            prevTimestamp = clock();
            blink = capture.isOpened();
        }


        if(found)
            drawChessboardCorners( view, boardSize, Mat(pointbuf), found );


        string msg = mode == CAPTURING ? "100/100" :
            mode == CALIBRATED ? "Calibrated" : "Press 'g' to start";
        int baseLine = 0;
        Size textSize = getTextSize(msg, 1, 1, 1, &baseLine);
        Point textOrigin(view.cols - 2*textSize.width - 10, view.rows - 2*baseLine - 10);


        if( mode == CAPTURING )
        {
            if(undistortImage)
                msg = format( "%d/%d Undist", (int)imagePoints.size(), nframes );
            else
                msg = format( "%d/%d", (int)imagePoints.size(), nframes );
        }


        putText( view, msg, textOrigin, 1, 1,
                 mode != CALIBRATED ? Scalar(0,0,255) : Scalar(0,255,0));


        if( blink )
            bitwise_not(view, view);


        if( mode == CALIBRATED && undistortImage )
        {
            Mat temp = view.clone();
            undistort(temp, view, cameraMatrix, distCoeffs);
        }


        imshow("Image View", view);
        char key = (char)waitKey(capture.isOpened() ? 50 : 500);


        if( key == 27 )
            break;


        if( key == 'u' && mode == CALIBRATED )
            undistortImage = !undistortImage;


        if( capture.isOpened() && key == 'g' )
        {
            mode = CAPTURING;
            imagePoints.clear();
        }


        if( mode == CAPTURING && imagePoints.size() >= (unsigned)nframes )
        {
            if( runAndSave(outputFilename, imagePoints, imageSize,
                       boardSize, pattern, squareSize, aspectRatio,
                       flags, cameraMatrix, distCoeffs,
                       writeExtrinsics, writePoints))
                mode = CALIBRATED;
            else
                mode = DETECTION;
            if( !capture.isOpened() )
                break;
        }
    }


    if( !capture.isOpened() && showUndistorted )
    {
        Mat view, rview, map1, map2;
//计算无畸变和修正转换映射 imageSize未畸变的图片尺寸  输出的映射的类型，可以为 CV_32FC1, CV_32FC2或CV_16SC2    map1：第一个输出映射  map2：第二个输出映射。
//该函数实际上为反向映射算法构建映射，供反向映射使用。也就是，对于在已经修正畸变的图像中的每个像素(u,v)(u,v)，该函数计算原来图像（从相机中获得的原始图像）中对应的坐标系。
        initUndistortRectifyMap(cameraMatrix, distCoeffs, Mat(),
                                getOptimalNewCameraMatrix(cameraMatrix, distCoeffs, imageSize, 1, imageSize, 0),//返回基于 alpha Free scaling parameter的新相机内参矩阵，1 是 alpha Free scaling parameter，
                                imageSize, CV_16SC2, map1, map2);


        for( i = 0; i < (int)imageList.size(); i++ )
        {
            view = imread(imageList[i], 1);
            if(view.empty())
                continue;
            //undistort( view, rview, cameraMatrix, distCoeffs, cameraMatrix );
            remap(view, rview, map1, map2, INTER_LINEAR);//重映射就是把一幅图像中某位置的像素放置到另一个图片指定位置的过程。双线性插值
            imshow("Image View", rview);
            char c = (char)waitKey();
            if( c == 27 || c == 'q' || c == 'Q' )
                break;
        }
    }


    return 0;
}