直接上code吧,注意采用数组设置矩阵比较方便
#include<highgui.h>
#include<cvaux.h>
#include<cxcore.h>
#include<iostream>
#include<fstream>
using namespace std;
#pragma comment(lib,"cv.lib");
#pragma comment(lib,"cvaux.lib");
#pragma comment(lib,"cxcore.lib");
#pragma comment(lib,"highgui.lib");
int main()
{
/*double objPoints[24] = { 3.5, 60, 0,
-3.5, 60, 0,
-175, 3.5, 0,
-175, -3.5, 0,
175, -3.5, 0,
175, +3.5, 0,