- iOS/Objective-C 元类和类别
- objective-c - -1001 错误,当 NSURLSession 通过 httpproxy 和/etc/hosts
- java - 使用网络类获取 url 地址
- ios - 推送通知中不播放声音
环境
手头的任务
解决图像 A 和图像 B(上图)之间的相对相机姿势,期望导致 Z 轴上的诱导 25 度旋转
实现
选项 A:
选项 B:
结果
以上两个选项都不能正确恢复相对相机位姿(预计在 Z 轴上旋转 25 度)
如有任何帮助,我们将不胜感激。
完整代码
#define RAD2DEG(rad) (((rad) * 180)/M_PI)
#define DEG2RAD(deg) (((deg) * M_PI)/180)
#define FOV2FOCAL(pixelssensorsize, fov) ((pixelssensorsize) / (2 * tan((fov) / 2)))// http://books.google.co.il/books?id=bXzAlkODwa8C&pg=PA48&lpg=PA48&dq=expressing+focal+length+in+pixels&source=bl&ots=gY4972kxAC&sig=U1BUeNHhOHmYIrDrO0YDb1DrNng&hl=en&sa=X&ei=45dLU9u9DIyv7QbN2oGIDA&ved=0CGsQ6AEwCA#v=onepage&q=expressing%20focal%20length%20in%20pixels&f=false
// http://nghiaho.com/?page_id=846
void DecomposeRotation(IN const cv::Mat& R, OUT float& fX, OUT float& fY, OUT float& fZ) {// Taken from MatLab
fX = (float)atan2(R.at<double>(2, 1), R.at<double>(2, 2));
fY = (float)atan2(-R.at<double>(2, 0), sqrt(R.at<double>(2, 1)*R.at<double>(2, 1) + R.at<double>(2, 2)*R.at<double>(2, 2)));
fZ = (float)atan2(R.at<double>(1, 0), R.at<double>(0, 0));
}
int _tmain(int argc, _TCHAR* argv[])
{
// 25 deg rotation in the Z axis (800x600)
const cv::Point2f rotZ0[] = { { 109, 250 }, { 175, 266 }, { 204, 279 }, { 221, 253 }, { 324, 281 }, { 312, 319 }, { 328, 352 }, { 322, 365 } };
const cv::Point2f rotZ25[] = { { 510, 234 }, { 569, 622 }, { 593, 278 }, { 616, 257 }, { 716, 303 }, { 698, 340 }, { 707, 377 }, { 697, 390 } };
const cv::Point2f rotZminus15[] = { { 37, 260 }, { 106, 275 }, { 135, 286 }, { 152, 260 }, { 258, 284 }, { 248, 324 }, { 266, 356 }, { 260, 370 } };
const double dFOV = DEG2RAD(45);
const cv::Point2d res(800, 600);
const cv::Point2d pntPriciplePoint(res.x / 2, res.y / 2);
const cv::Point2d pntFocal(FOV2FOCAL(res.x, dFOV), FOV2FOCAL(res.y, dFOV));
//transfer the vector of points to the appropriate opencv matrix structures
const int numPoints = sizeof(rotZ0) / sizeof(rotZ0[0]);
std::vector<cv::Point2f> vecPnt1(numPoints);
std::vector<cv::Point2f> vecPnt2(numPoints);
for (int i = 0; i < numPoints; i++) {
vecPnt2[i] = rotZ0[i];
//vecPnt2[i] = rotZminus15[i];
vecPnt1[i] = rotZ25[i];
}
//// Normalize points
//for (int i = 0; i < numPoints; i++) {
// vecPnt1[i].x = (vecPnt1[i].x - pntPriciplePoint.x) / pntFocal.x;
// vecPnt1[i].y = (vecPnt1[i].y - pntPriciplePoint.y) / pntFocal.y;
// vecPnt2[i].x = (vecPnt2[i].x - pntPriciplePoint.x) / pntFocal.x;
// vecPnt2[i].y = (vecPnt2[i].y - pntPriciplePoint.y) / pntFocal.y;
//}
try {
// http://docs.opencv.org/modules/calib3d/doc/camera_calibration_and_3d_reconstruction.html
cv::Mat matK = cv::Mat::zeros(3, 3, CV_64F);
matK.at<double>(0, 0) = pntFocal.x;
matK.at<double>(1, 1) = pntFocal.y;
matK.at<double>(0, 2) = pntPriciplePoint.x;
matK.at<double>(1, 2) = pntPriciplePoint.y;
matK.at<double>(2, 2) = 1;
float x, y, z;
cv::Mat R1, R2, R3, R4;
cv::Mat t;
cv::Mat matE;
#if 1 // Option [A]
cv::Mat matF = cv::findFundamentalMat(vecPnt1, vecPnt2);
matE = matK.t() * matF * matK; // http://en.wikipedia.org/wiki/Essential_matrix
cv::Mat _tmp;
cv::Mat U;
cv::Mat Vt;
cv::SVD::compute(matE, _tmp, U, Vt);
cv::Matx33d W(0, -1, 0,
1, 0, 0,
0, 0, 1);
R1 = U*cv::Mat(W)*Vt; // See http://stackoverflow.com/questions/14150152/extract-translation-and-rotation-from-fundamental-matrix for details
R2 = U*cv::Mat(W)*Vt.t();
R3 = U*cv::Mat(W).t()*Vt;
R4 = U*cv::Mat(W).t()*Vt.t();
#else // Option [B]
matE = cv::findEssentialMat(vecPnt1, vecPnt2, pntFocal.x, pntPriciplePoint);// http://docs.opencv.org/trunk/modules/calib3d/doc/camera_calibration_and_3d_reconstruction.html
cv::decomposeEssentialMat(matE, R1, R2, t);
int iInliers = cv::recoverPose(matE, vecPnt1, vecPnt2, R4, t);// , pntFocal.x, pntPriciplePoint);
R3 = cv::Mat::zeros(3, 3, CV_64F);
#endif
DecomposeRotation(R1, x, y, z);
std::cout << "Euler Angles R1 (X,Y,Z): " << RAD2DEG(x) << ", " << RAD2DEG(y) << ", " << RAD2DEG(z) << std::endl;
DecomposeRotation(R2, x, y, z);
std::cout << " R2 (X,Y,Z): " << RAD2DEG(x) << ", " << RAD2DEG(y) << ", " << RAD2DEG(z) << std::endl;
DecomposeRotation(R3, x, y, z);
std::cout << " R3 (X,Y,Z): " << RAD2DEG(x) << ", " << RAD2DEG(y) << ", " << RAD2DEG(z) << std::endl;
DecomposeRotation(R4, x, y, z);
std::cout << " R4 (X,Y,Z): " << RAD2DEG(x) << ", " << RAD2DEG(y) << ", " << RAD2DEG(z) << std::endl;
//cv::Mat res = matFrom.t() * matF * matTo;// Results in a null vector ( as it should ) http://en.wikipedia.org/wiki/Fundamental_matrix_(computer_vision)
//res = matFrom.t() * matE * matTo;// Results in a null vector ( as it should )
}
catch (cv::Exception e) {
_ASSERT(FALSE);
}
return 0;
}
执行结果
选项 A:
Euler Angles R1 (X,Y,Z): -26.2625, 8.70029, 163.643
R2 (X,Y,Z): 16.6929, -29.9901, -3.81642
R3 (X,Y,Z): 5.59033, -20.841, -19.9316
R4 (X,Y,Z): -5.76906, 7.25413, -179.086
选项 B:
Euler Angles R1 (X,Y,Z): -13.8355, 3.0098, 171.451
R2 (X,Y,Z): 2.22802, -22.3479, -11.332
R3 (X,Y,Z): 0, -0, 0
R4 (X,Y,Z): 2.22802, -22.3479, -11.332
最佳答案
首先,校准您的相机而不是使用预定义的值。它总是会产生很大的影响。由 8-pt 或 5-pt 计算的相对位姿会受到很多噪音的影响,绝不意味着最终结果。话虽如此,重建点然后捆绑调整整个场景是个好主意。优化你的外部力量,你应该想出一个更好的姿势。
关于c++ - OpenCV>>相机相对位姿估计,我们在Stack Overflow上找到一个类似的问题: https://stackoverflow.com/questions/23114047/
我正在尝试从我的系统中完全删除 opencv。我试图学习 ROS,而在教程中我遇到了一个问题。创建空工作区后,我调用catkin_make 它给出了一个常见错误,我在 answers.ros 中搜索并
我在尝试逐步转移对warpAffine的调用时遇到崩溃(不是异常): void rotateImage( const Mat& source, double degree, Mat& output )
如何处理opencv gpu异常?是否有用于opencvgpu异常处理的特定错误代码集api? 我尝试了很多搜索,但只有1个错误代码,即CV_GpuNotSupported。 请帮帮我。 最佳答案 虽
笔记 我是 OpenCV(或计算机视觉)的新手,所以告诉我搜索查询会很有帮助! 我想问什么 我想编写一个从图片中提取名片的程序。 我能够提取粗略的轮廓,但反射光会变成噪点,我无法提取准确的轮廓。请告诉
我想根据像素的某个阈值将Mono16类型的Mat转换为二进制图像。我尝试使用以下内容: 阈值(img,ret,0.1,1,CV_THRESH_BINARY); 尝试编译时,出现make错误,提示: 错
我对使用GPU加速的OpenCV中的卷积函数有疑问。 使用GPU的卷积速度大约快3.5 运行时: convolve(src_32F, kernel, cresult, false, cbuffer);
我正在尝试使用非对称圆圈网格执行相机校准。 我通常找不到适合CirclesGridFinder的文档,尤其是findHoles()函数的文档。 如果您有关于此功能如何工作以及其参数含义的信息,将不胜感
在计算机上绘图和在 OpenCV 的投影仪上投影之间有什么区别吗? 一种选择是投影显示所有内容的计算机屏幕。但也许也有这样的选择,即在投影仪上精确地绘制和投影图像,仅使用计算机作为计算机器。如果我能做
我将Processing(processing.org)用于需要人脸跟踪的项目。现在的问题是由于for循环,程序将耗尽内存。我想停止循环或至少解决内存不足的问题。这是代码。 import hyperm
我有下面的代码: // Image Processing.cpp : Defines the entry point for the console application. // //Save
我正在为某些项目使用opencv。并有应解决的任务。 任务很简单。我有一张主图片,并且有一个模板,而不是将主图片与模板进行比较。我使用matchTemplate()函数。我只是好奇一下。 在文档中,我
我正在尝试使用以下命令创建级联分类器: haartraining -data haarcascade -vec samples.vec -bg negatives.dat -nstages 20 -n
我试图使用OpenCV检测黑色图像中一组形状的颜色,为此我使用了Canny检测。但是,颜色输出总是返回为黑色。 std::vector > Asteroids::DetectPoints(const
我正在尝试使用OpenCv 2.4.5从边缘查找渐变方向,但是我在使用cvSobel()时遇到问题,以下是错误消息和我的代码。我在某处读到它可能是由于浮点(??)之间的转换,但我不知道如何解决它。有帮
我正在尝试构建循环关闭算法,但是在开始开发之前,我想测试哪种功能描述符在真实数据集上效果更好。 我有两个在两个方向拍摄的走廊图像,一个进入房间,另一个离开同一个房间。因此它们代表相同的场景,但具有2个
有没有一种方法可以比较直方图,但例如要排除白色,因此白色不会影响比较。 最佳答案 白色像素有 饱和度 , S = 0 .因此,在创建直方图时很容易从计数中删除白色像素。请执行下列操作: 从 BGR 转
就像本主题的标题一样,如何在OpenCV中确定图像的特定像素(灰度或彩色)是否饱和(例如,亮度过高)? 先感谢您。 最佳答案 根据定义,饱和像素是指与强度(即灰度值或颜色分量之一)等于255相关联的像
我是OpenCV的新用户,正在从事大学项目。程序会获取输入图像,对其进行综合模糊处理,然后对其进行模糊处理。当对合成模糊图像进行反卷积时,会生成边界伪像,因为...好吧,到目前为止,我还没有实现边界条
我想知道OpenCV是haar特征还是lbp是在多尺度搜索过程中缩放图像还是像论文中提到的那样缩放特征本身? 编辑:事实证明,检测器可以缩放图像,而不是功能。有人知道为什么吗?通过缩放功能可以更快。
我在openCv中使用SVM.train命令(已定义了适当的参数)。接下来,我要使用我的算法进行分类,而不是使用svm.predict。 可能吗?我可以访问训练时生成的支持 vector 吗?如果是这
我是一名优秀的程序员,十分优秀!