drawDetectedDiamonds.cpp

Go to the documentation of this file.

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

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

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

    // Option processing
    vector<Vec4i> diamondIds;
    Scalar borderColor(0, 0, 255);
    for (int i=2; i<nrhs; i+=2) {
        string key(rhs[i].toString());
        if (key == "IDs")
            //diamondIds = MxArrayToVectorVec<int,4>(rhs[i+1]);
            diamondIds = rhs[i+1].toVector<Vec4i>();
        else if (key == "BorderColor")
            borderColor = (rhs[i+1].isChar()) ?
                ColorType[rhs[i+1].toString()] : rhs[i+1].toScalar();
        else
            mexErrMsgIdAndTxt("mexopencv:error",
                "Unrecognized option %s", key.c_str());
    }

    // Process
    Mat image(rhs[0].toMat());
    vector<vector<Point2f> > diamondCorners(MxArrayToVectorVectorPoint<float>(rhs[1]));
    drawDetectedDiamonds(image, diamondCorners,
        (!diamondIds.empty()) ? diamondIds : noArray(), borderColor);
    plhs[0] = MxArray(image);
}