estimateGlobalMotionLeastSquares.cpp

Go to the documentation of this file.

#include "mexopencv.hpp"
#include "opencv2/videostab.hpp"
using namespace std;
using namespace cv;
using namespace cv::videostab;

namespace {
const ConstMap<string,MotionModel> MotionModelMap = ConstMap<string,MotionModel>
    ("Translation",         cv::videostab::MM_TRANSLATION)
    ("TranslationAndScale", cv::videostab::MM_TRANSLATION_AND_SCALE)
    ("Rotation",            cv::videostab::MM_ROTATION)
    ("Rigid",               cv::videostab::MM_RIGID)
    ("Similarity",          cv::videostab::MM_SIMILARITY)
    ("Affine",              cv::videostab::MM_AFFINE)
    ("Homography",          cv::videostab::MM_HOMOGRAPHY)
    ("Unknown",             cv::videostab::MM_UNKNOWN);
}

void mexFunction(int nlhs, mxArray *plhs[], int nrhs, const mxArray *prhs[])
{
    // Check the number of arguments
    nargchk(nrhs>=2 && (nrhs%2)==0 && nlhs<=2);

    // Argument vector
    vector<MxArray> rhs(prhs, prhs+nrhs);

    // Option processing
    int model = cv::videostab::MM_AFFINE;
    for (int i=2; i<nrhs; i+=2) {
        string key(rhs[i].toString());
        if (key == "MotionModel")
            model = MotionModelMap[rhs[i+1].toString()];
        else
            mexErrMsgIdAndTxt("mexopencv:error",
                "Unrecognized option %s", key.c_str());
    }

    // Process
    Mat M;
    float rmse = 0;
    if (rhs[0].isNumeric() && rhs[1].isNumeric()) {
        Mat points0(rhs[0].toMat(CV_32F)),
            points1(rhs[1].toMat(CV_32F));
        M = estimateGlobalMotionLeastSquares(points0, points1, model, &rmse);
    }
    else if (rhs[0].isCell() && rhs[1].isCell()) {
        vector<Point2f> points0(rhs[0].toVector<Point2f>()),
                        points1(rhs[1].toVector<Point2f>());
        M = estimateGlobalMotionLeastSquares(points0, points1, model, &rmse);
    }
    else
        mexErrMsgIdAndTxt("mexopencv:error","Invalid argument");
    plhs[0] = MxArray(M);
    if (nlhs > 1)
        plhs[1] = MxArray(rmse);
}