solvePNP() - Assertion failed

edit

Hello!

I am trying to get the pose of the camera with the help of solvePNP().

After running my program I get the following errors:

OpenCV Error: Assertion failed (0 <= i && i < (int)vv.size()) in getMat, file /opt/local/var/macports/build/_opt_local_var_macports_sources_rsync.macports.org_release_tarballs_ports_graphics_opencv/opencv/work/OpenCV-2.4.2/modules/core/src/matrix.cpp, line 971
libc++abi.dylib: terminate called throwing an exception

I tried to search how to solve these errors, but I couldn't resolve it unfortunately!

Here is my code, all comment/help is much appreciated:

enum Pattern { NOT_EXISTING, CHESSBOARD, CIRCLES_GRID, ASYMMETRIC_CIRCLES_GRID };

void calcBoardCornerPositions(Size boardSize, float squareSize, vector<Point3f>& corners,
                          Pattern patternType)
{
    corners.clear();

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));
    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));
    break;
}

}

int main(int argc, char* argv[])
{
    float squareSize = 50.f;

Pattern calibrationPattern = CHESSBOARD;

vector<Point2f> boardCorners;
vector<vector<Point2f> > imagePoints;
vector<vector<Point3f> > boardPoints(1);

Size boardSize;
boardSize.width = 9;
boardSize.height = 6;

vector<Mat> intrinsics, distortion;
string filename = "out_camera_xml.xml";
FileStorage fs(filename, FileStorage::READ);
fs["camera_matrix"] >> intrinsics;
fs["distortion_coefficients"] >> distortion;
fs.release();

vector<Mat> rvec, tvec;
Mat img = imread(argv[1], CV_LOAD_IMAGE_GRAYSCALE); // at kell adnom egy kepet

bool found = findChessboardCorners(img, boardSize, boardCorners, CV_CALIB_CB_ADAPTIVE_THRESH);

calcBoardCornerPositions(boardSize, squareSize, boardPoints[0], calibrationPattern);
boardPoints.resize(imagePoints.size(),boardPoints[0]);

solvePnP(boardPoints, boardCorners, intrinsics, distortion, rvec, tvec);

for(int i=0; i<rvec.size(); i++) {
        cout << rvec[i] << endl;
}

return 0;

}